53 lines
1.5 KiB
C
53 lines
1.5 KiB
C
|
#include "lpc134x.h"
|
||
|
|
#include "sysdefs.h"
|
||
|
|
|
||
|
|
/* Missing from core */
|
||
|
|
|
||
|
|
#define set_MSP(x) \
|
||
|
|
__asm( "msr MSP, %0\n" : : "r" (x) )
|
||
|
|
|
||
|
|
|
||
|
|
/* Jump back into bootcode, enable mass storage firmware flashing */
|
||
|
|
|
||
|
|
void ReinvokeISP(void) {
|
||
|
|
uint32_t command[5]; //
|
||
|
|
command[0] = 57;
|
||
|
|
|
||
|
|
/* Disable SYSTICK timer and interrupt before calling into ISP */
|
||
|
|
SYSTICK_STCTRL &= ~(SYSTICK_STCTRL_ENABLE | SYSTICK_STCTRL_TICKINT);
|
||
|
|
/* make sure USB clock is turned on before calling ISP */
|
||
|
|
SCB_SYSAHBCLKCTRL |= 0x04000;
|
||
|
|
/* make sure 32-bit Timer 1 is turned on before calling ISP */
|
||
|
|
SCB_SYSAHBCLKCTRL |= 0x00400;
|
||
|
|
/* make sure GPIO clock is turned on before calling ISP */
|
||
|
|
SCB_SYSAHBCLKCTRL |= 0x00040;
|
||
|
|
/* make sure IO configuration clock is turned on before calling ISP */
|
||
|
|
SCB_SYSAHBCLKCTRL |= 0x10000;
|
||
|
|
/* make sure AHB clock divider is 1:1 */
|
||
|
|
SCB_SYSAHBCLKDIV = 1;
|
||
|
|
|
||
|
|
/* as per 19.2.1 of lpc13xx user manual, clear this byte of ram
|
||
|
|
to avoid long delay before USB becomes active */
|
||
|
|
*((uint32_t *)(0x10000054)) = 0x0;
|
||
|
|
|
||
|
|
/* Set stack pointer to ROM value (reset default) This must be the last
|
||
|
|
piece of code executed before calling ISP, because most C expressions
|
||
|
|
and function returns will fail after the stack pointer is changed. */
|
||
|
|
set_MSP(*(int*)0x1FFF0000);
|
||
|
|
|
||
|
|
/* Enter ISP. We call "iap_entry" to enter ISP because the ISP entry is done
|
||
|
|
through the same command interface as IAP. */
|
||
|
|
iap_entry(command, NULL);
|
||
|
|
|
||
|
|
/* Alternative shorter direct assembler way: */
|
||
|
|
/*
|
||
|
|
__asm(
|
||
|
|
"ldr r0, =%0\n"
|
||
|
|
"ldr lr, =0x1fff1ff1\n"
|
||
|
|
: : "i" (&command)
|
||
|
|
);
|
||
|
|
*/
|
||
|
|
|
||
|
|
/* NOTREACHED */
|
||
|
|
}
|