diff options
Diffstat (limited to 'c/src/lib/libbsp/arm/lpc32xx/misc/restart.c')
-rw-r--r-- | c/src/lib/libbsp/arm/lpc32xx/misc/restart.c | 56 |
1 files changed, 56 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/arm/lpc32xx/misc/restart.c b/c/src/lib/libbsp/arm/lpc32xx/misc/restart.c new file mode 100644 index 0000000000..b286390237 --- /dev/null +++ b/c/src/lib/libbsp/arm/lpc32xx/misc/restart.c @@ -0,0 +1,56 @@ +/** + * @file + * + * @ingroup lpc32xx + * + * @brief Restart implementation. + */ + +/* + * Copyright (c) 2010 + * embedded brains GmbH + * Obere Lagerstr. 30 + * D-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.com/license/LICENSE. + */ + +#include <rtems.h> + +#include <libcpu/arm-cp15.h> + +#include <bsp.h> + +void lpc32xx_restart(void *addr) +{ + ARM_SWITCH_REGISTERS; + rtems_interrupt_level level; + uint32_t ctrl = 0; + + /* FIXME: DMA shutdown */ + + /* FIXME: USB shutdown */ + + /* FIXME: Ethernet interface reset */ + + rtems_interrupt_disable(level); + + arm_cp15_data_cache_test_and_clean(); + arm_cp15_instruction_cache_invalidate(); + + ctrl = arm_cp15_get_control(); + ctrl &= ~(ARM_CP15_CTRL_I | ARM_CP15_CTRL_C | ARM_CP15_CTRL_M); + arm_cp15_set_control(ctrl); + + asm volatile ( + ARM_SWITCH_TO_ARM + "mov pc, %[addr]\n" + ARM_SWITCH_BACK + : ARM_SWITCH_OUTPUT + : [addr] "r" (addr) + ); +} |