123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122 |
- #include "bootloader.h"
- #include <ch.h>
- #include <hal.h>
- #include "wait.h"
- #define SYMVAL(sym) (uint32_t)(((uint8_t *)&(sym)) - ((uint8_t *)0))
- #define BOOTLOADER_MAGIC 0xDEADBEEF
- #define MAGIC_ADDR (unsigned long *)(SYMVAL(__ram0_end__) - 4)
- #ifndef STM32_BOOTLOADER_DUAL_BANK
- # define STM32_BOOTLOADER_DUAL_BANK FALSE
- #endif
- #ifdef BOOTLOADER_TINYUF2
- # define DBL_TAP_MAGIC 0xf01669ef
- extern uint32_t _board_dfu_dbl_tap[];
- # define DBL_TAP_REG _board_dfu_dbl_tap[0]
- void bootloader_jump(void) {
- DBL_TAP_REG = DBL_TAP_MAGIC;
- NVIC_SystemReset();
- }
- void enter_bootloader_mode_if_requested(void) {
- }
- #elif STM32_BOOTLOADER_DUAL_BANK
- # include "config_common.h"
- # ifndef STM32_BOOTLOADER_DUAL_BANK_GPIO
- # error "No STM32_BOOTLOADER_DUAL_BANK_GPIO defined, don't know which pin to toggle"
- # endif
- # ifndef STM32_BOOTLOADER_DUAL_BANK_POLARITY
- # define STM32_BOOTLOADER_DUAL_BANK_POLARITY 0
- # endif
- # ifndef STM32_BOOTLOADER_DUAL_BANK_DELAY
- # define STM32_BOOTLOADER_DUAL_BANK_DELAY 100000
- # endif
- extern uint32_t __ram0_end__;
- __attribute__((weak)) void bootloader_jump(void) {
-
-
-
-
-
- palSetPadMode(PAL_PORT(STM32_BOOTLOADER_DUAL_BANK_GPIO), PAL_PAD(STM32_BOOTLOADER_DUAL_BANK_GPIO), PAL_MODE_OUTPUT_PUSHPULL);
- # if STM32_BOOTLOADER_DUAL_BANK_POLARITY
- palSetPad(PAL_PORT(STM32_BOOTLOADER_DUAL_BANK_GPIO), PAL_PAD(STM32_BOOTLOADER_DUAL_BANK_GPIO));
- # else
- palClearPad(PAL_PORT(STM32_BOOTLOADER_DUAL_BANK_GPIO), PAL_PAD(STM32_BOOTLOADER_DUAL_BANK_GPIO));
- # endif
-
- wait_ms(100);
-
- NVIC_SystemReset();
- }
- void enter_bootloader_mode_if_requested(void) {}
- #elif defined(STM32_BOOTLOADER_ADDRESS)
- extern uint32_t __ram0_end__;
- __attribute__((weak)) void bootloader_jump(void) {
- *MAGIC_ADDR = BOOTLOADER_MAGIC;
- NVIC_SystemReset();
- }
- void enter_bootloader_mode_if_requested(void) {
- unsigned long *check = MAGIC_ADDR;
- if (*check == BOOTLOADER_MAGIC) {
- *check = 0;
- __set_CONTROL(0);
- __set_MSP(*(__IO uint32_t *)STM32_BOOTLOADER_ADDRESS);
- __enable_irq();
- typedef void (*BootJump_t)(void);
- BootJump_t boot_jump = *(BootJump_t *)(STM32_BOOTLOADER_ADDRESS + 4);
- boot_jump();
- while (1)
- ;
- }
- }
- #elif defined(KL2x) || defined(K20x) || defined(MK66F18)
- # if defined(BOOTLOADER_KIIBOHD)
- # define SCB_AIRCR_VECTKEY_WRITEMAGIC 0x05FA0000
- const uint8_t sys_reset_to_loader_magic[] = "\xff\x00\x7fRESET TO LOADER\x7f\x00\xff";
- __attribute__((weak)) void bootloader_jump(void) {
- __builtin_memcpy((void *)VBAT, (const void *)sys_reset_to_loader_magic, sizeof(sys_reset_to_loader_magic));
-
- SCB->AIRCR = SCB_AIRCR_VECTKEY_WRITEMAGIC | SCB_AIRCR_SYSRESETREQ_Msk;
- }
- # else
- # include "wait.h"
- __attribute__((weak)) void bootloader_jump(void) {
- wait_ms(100);
- __BKPT(0);
- }
- # endif
- #else
- __attribute__((weak)) void bootloader_jump(void) {}
- #endif
|