diff options
Diffstat (limited to 'bsps/arm/lpc24xx/start/restart.c')
-rw-r--r-- | bsps/arm/lpc24xx/start/restart.c | 52 |
1 files changed, 52 insertions, 0 deletions
diff --git a/bsps/arm/lpc24xx/start/restart.c b/bsps/arm/lpc24xx/start/restart.c new file mode 100644 index 0000000000..627f79d19d --- /dev/null +++ b/bsps/arm/lpc24xx/start/restart.c @@ -0,0 +1,52 @@ +/** + * @file + * + * @ingroup lpc24xx + * + * @brief Restart implementation. + */ + +/* + * Copyright (c) 2011-2014 embedded brains GmbH. All rights reserved. + * + * embedded brains GmbH + * Dornierstr. 4 + * 82178 Puchheim + * Germany + * <rtems@embedded-brains.de> + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.org/license/LICENSE. + */ + +#include <rtems.h> + +#include <bsp.h> + +void bsp_restart(void *addr) +{ + #ifdef ARM_MULTILIB_ARCH_V4 + ARM_SWITCH_REGISTERS; + rtems_interrupt_level level; + + rtems_interrupt_disable(level); + (void) level; + + asm volatile ( + ARM_SWITCH_TO_ARM + "mov pc, %[addr]\n" + ARM_SWITCH_BACK + : ARM_SWITCH_OUTPUT + : [addr] "r" (addr) + ); + #else + rtems_interrupt_level level; + void (*start)(void) = addr; + + rtems_interrupt_disable(level); + (void) level; + + (*start)(); + #endif +} |