deon/gnuk
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

main.c

Browse Source
This commit is contained in:
NIIBE Yutaka
2012-05-23 17:07:30 +09:00
parent b02c6a480d
commit 4a59c73bc3
2 changed files with 14 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
ChangeLog
View File

@@ -1,5 +1,7 @@
2012-05-23 Niibe Yutaka <gniibe@fsij.org> 2012-05-23 Niibe Yutaka <gniibe@fsij.org>
* regnual/sys-stm8s-discovery.h: New.
* src/main.c (flash_mass_erase_and_exec, good_bye): New. * src/main.c (flash_mass_erase_and_exec, good_bye): New.
(main): Call good_bye. (main): Call good_bye.

19
src/main.c
View File

@@ -370,11 +370,13 @@ led_blink (int spec)
} }
#define FMEAE_SIZE 56
static void __attribute__((naked)) static void __attribute__((naked))
flash_mass_erase_and_exec (void) flash_mass_erase_and_exec (void)
{ {
asm volatile (/* r0 = <flash erase timeout>; */ asm volatile (/* r0 = <flash erase timeout>; */
"mov r0, #0x01000000\n\t" "mov r0, #0xF0000000\n\t"
/* r2 = (struct FLASH *)FLASH_R_BASE */ /* r2 = (struct FLASH *)FLASH_R_BASE */
"mov r2, #8192\n\t" "mov r2, #8192\n\t"
"movt r2, 16386\n\t" "movt r2, 16386\n\t"
@@ -383,6 +385,7 @@ flash_mass_erase_and_exec (void)
"orr r1, r1, #4\n\t" "orr r1, r1, #4\n\t"
"str r1, [r2, #16]\n\t" "str r1, [r2, #16]\n\t"
/* FLASH->CR |= FLASH_CR_STRT; */ /* FLASH->CR |= FLASH_CR_STRT; */
"ldr r1, [r2, #16]\n\t"
"orr r1, r1, #64\n\t" "orr r1, r1, #64\n\t"
"str r1, [r2, #16]\n" "str r1, [r2, #16]\n"
"0: subs r0, r0, #1\n\t" "0: subs r0, r0, #1\n\t"
@@ -408,21 +411,23 @@ flash_mass_erase_and_exec (void)
static void __attribute__((noreturn)) static void __attribute__((noreturn))
good_bye (void) good_bye (void)
{ {
register uint32_t dst __asm__ ("r0") = 0x20000000; register uint32_t dst __asm__ ("r0") = 0x20000000; /* SRAM top */
register uint32_t src __asm__ ("r1") = (uint32_t)flash_mass_erase_and_exec; register uint32_t src __asm__ ("r1") = (uint32_t)flash_mass_erase_and_exec;
register uint32_t len __asm__ ("r2") = sizeof (flash_mass_erase_and_exec); register uint32_t len __asm__ ("r2") = FMEAE_SIZE;
register void (**func )(void) __asm__ ("r3") register void (**func )(void) __asm__ ("r3")
= (void (**)(void))(&_regnual_start + 4); = (void (**)(void))(&_regnual_start + 4);
/* copy function flash_mass_erase_and_exec to SRAM and jump to it */ /* copy function flash_mass_erase_and_exec to SRAM and jump to it */
asm volatile ("mov r5, r0\n" asm volatile ("ldr r3, [r3, #4]\n\t"
"mov r5, r0\n\t"
"add r2, r2, r1\n" "add r2, r2, r1\n"
"0: ldr r4, [r1]\n\t" "0: ldr r4, [r1]\n\t"
"str r4, [r0]\n\t" "str r4, [r0]\n\t"
"adds r0, r0, #4\n\t" "add r0, r0, #4\n\t"
"adds r1, r1, #4\n\t" "add r1, r1, #4\n\t"
"cmp r2, r1\n\t" "cmp r2, r1\n\t"
"bgt 0b\n\t" "bhi 0b\n\t"
"isb\n\t"
"bx r5" "bx r5"
: /* no output */ : /* no output */
: "r" (dst), "r" (src), "r" (len), "r" (func) : "r" (dst), "r" (src), "r" (len), "r" (func)