From 5d3975ab89e623af16573345ec0d6d665612fd1b Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Tue, 19 Mar 2013 17:53:07 +0100 Subject: Add support for static constructors and destructors --- lib/cm3/vector.c | 15 +++++++++++++++ 1 file changed, 15 insertions(+) (limited to 'lib/cm3') diff --git a/lib/cm3/vector.c b/lib/cm3/vector.c index 2706b6d..43e8917 100644 --- a/lib/cm3/vector.c +++ b/lib/cm3/vector.c @@ -29,6 +29,10 @@ /* Symbols exported by the linker script(s): */ extern unsigned _data_loadaddr, _data, _edata, _ebss, _stack; +typedef void (*funcp_t) (void); +extern funcp_t __preinit_array_start, __preinit_array_end; +extern funcp_t __init_array_start, __init_array_end; +extern funcp_t __fini_array_start, __fini_array_end; void main(void); void blocking_handler(void); @@ -55,6 +59,7 @@ vector_table_t vector_table = { void WEAK __attribute__ ((naked)) reset_handler(void) { volatile unsigned *src, *dest; + funcp_t *fp; for (src = &_data_loadaddr, dest = &_data; dest < &_edata; src++, dest++) *dest = *src; @@ -62,11 +67,21 @@ void WEAK __attribute__ ((naked)) reset_handler(void) while (dest < &_ebss) *dest++ = 0; + /* Constructors. */ + for (fp = &__preinit_array_start; fp < &__preinit_array_end; fp++) + (*fp)(); + for (fp = &__init_array_start; fp < &__init_array_end; fp++) + (*fp)(); + /* might be provided by platform specific vector.c */ pre_main(); /* Call the application's entry point. */ main(); + + /* Destructors. */ + for (fp = &__fini_array_start; fp < &__fini_array_end; fp++) + (*fp)(); } void blocking_handler(void) -- cgit v1.2.3