123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101 |
- #include "bootloader.h"
- #include <ch.h>
- #include <hal.h>
- #include "wait.h"
- extern uint32_t __ram0_end__;
- #ifndef STM32_BOOTLOADER_DUAL_BANK
- # define STM32_BOOTLOADER_DUAL_BANK FALSE
- #endif
- #if 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 100
- # endif
- __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(STM32_BOOTLOADER_DUAL_BANK_DELAY);
-
- NVIC_SystemReset();
- }
- __attribute__((weak)) void mcu_reset(void) {
- NVIC_SystemReset();
- }
- void enter_bootloader_mode_if_requested(void) {}
- #else
- # define SYMVAL(sym) (uint32_t)(((uint8_t *)&(sym)) - ((uint8_t *)0))
- # define BOOTLOADER_MAGIC 0xDEADBEEF
- # define MAGIC_ADDR (unsigned long *)(SYMVAL(__ram0_end__) - 4)
- __attribute__((weak)) void bootloader_jump(void) {
- *MAGIC_ADDR = BOOTLOADER_MAGIC;
- NVIC_SystemReset();
- }
- __attribute__((weak)) void mcu_reset(void) {
- 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)
- ;
- }
- }
- #endif
|