#include #include #include #include #include #include #include #include #include #include // Boot request enum #define BOOT_REQUEST_NONE 0x00000000 #define BOOT_REQUEST_DFU 0xDF00B000 // Boot to DFU pin #define BOOT_DFU_PORT GPIOB #define BOOT_DFU_PIN LL_GPIO_PIN_11 // USB pins #define BOOT_USB_PORT GPIOA #define BOOT_USB_DM_PIN LL_GPIO_PIN_11 #define BOOT_USB_DP_PIN LL_GPIO_PIN_12 #define BOOT_USB_PIN (BOOT_USB_DM_PIN | BOOT_USB_DP_PIN) void target_led_set_red(uint8_t value) { } void target_led_set_green(uint8_t value) { } void target_led_set_blue(uint8_t value) { } void target_led_set_backlight(uint8_t value) { } void target_led_control(char* c) { target_led_set_red(0x00); target_led_set_green(0x00); target_led_set_blue(0x00); do { if(*c == 'R') { target_led_set_red(0xFF); } else if(*c == 'G') { target_led_set_green(0xFF); } else if(*c == 'B') { target_led_set_blue(0xFF); } else if(*c == '.') { LL_mDelay(125); target_led_set_red(0x00); target_led_set_green(0x00); target_led_set_blue(0x00); LL_mDelay(125); } else if(*c == '-') { LL_mDelay(250); target_led_set_red(0x00); target_led_set_green(0x00); target_led_set_blue(0x00); LL_mDelay(250); } else if(*c == '|') { target_led_set_red(0x00); target_led_set_green(0x00); target_led_set_blue(0x00); } c++; } while(*c != 0); } void clock_init() { LL_Init1msTick(4000000); LL_SetSystemCoreClock(4000000); } void gpio_init() { LL_AHB2_GRP1_EnableClock(LL_AHB2_GRP1_PERIPH_GPIOA); LL_AHB2_GRP1_EnableClock(LL_AHB2_GRP1_PERIPH_GPIOB); // USB D+ LL_GPIO_SetPinMode(BOOT_USB_PORT, BOOT_USB_DP_PIN, LL_GPIO_MODE_OUTPUT); LL_GPIO_SetPinSpeed(BOOT_USB_PORT, BOOT_USB_DP_PIN, LL_GPIO_SPEED_FREQ_VERY_HIGH); LL_GPIO_SetPinOutputType(BOOT_USB_PORT, BOOT_USB_DP_PIN, LL_GPIO_OUTPUT_OPENDRAIN); // USB D- LL_GPIO_SetPinMode(BOOT_USB_PORT, BOOT_USB_DM_PIN, LL_GPIO_MODE_OUTPUT); LL_GPIO_SetPinSpeed(BOOT_USB_PORT, BOOT_USB_DM_PIN, LL_GPIO_SPEED_FREQ_VERY_HIGH); LL_GPIO_SetPinOutputType(BOOT_USB_PORT, BOOT_USB_DM_PIN, LL_GPIO_OUTPUT_OPENDRAIN); // Button: back LL_GPIO_SetPinMode(BOOT_DFU_PORT, BOOT_DFU_PIN, LL_GPIO_MODE_INPUT); LL_GPIO_SetPinPull(BOOT_DFU_PORT, BOOT_DFU_PIN, LL_GPIO_PULL_UP); } void rtc_init() { // LSE and RTC LL_PWR_EnableBkUpAccess(); if(!LL_RCC_LSE_IsReady()) { // Try to start LSE normal way LL_RCC_LSE_SetDriveCapability(LL_RCC_LSEDRIVE_MEDIUMLOW); LL_RCC_LSE_Enable(); uint32_t c = 0; while(!LL_RCC_LSE_IsReady() && c < 200) { LL_mDelay(10); c++; } // Plan B: reset backup domain if(!LL_RCC_LSE_IsReady()) { target_led_control("-R.R.R."); LL_RCC_ForceBackupDomainReset(); LL_RCC_ReleaseBackupDomainReset(); NVIC_SystemReset(); } // Set RTC domain clock to LSE LL_RCC_SetRTCClockSource(LL_RCC_RTC_CLKSOURCE_LSE); } // Enable clocking LL_RCC_EnableRTC(); LL_APB1_GRP1_EnableClock(LL_APB1_GRP1_PERIPH_RTCAPB); } void usb_wire_reset() { LL_GPIO_ResetOutputPin(BOOT_USB_PORT, BOOT_USB_PIN); LL_mDelay(10); LL_GPIO_SetOutputPin(BOOT_USB_PORT, BOOT_USB_PIN); } void target_init() { clock_init(); gpio_init(); rtc_init(); usb_wire_reset(); // Errata 2.2.9, Flash OPTVERR flag is always set after system reset __HAL_FLASH_CLEAR_FLAG(FLASH_FLAG_ALL_ERRORS); } int target_is_dfu_requested() { if(LL_RTC_BAK_GetRegister(RTC, LL_RTC_BKP_DR0) == BOOT_REQUEST_DFU) { LL_RTC_BAK_SetRegister(RTC, LL_RTC_BKP_DR0, BOOT_REQUEST_NONE); return 1; } LL_mDelay(100); if(!LL_GPIO_IsInputPinSet(BOOT_DFU_PORT, BOOT_DFU_PIN)) { return 1; } return 0; } void target_switch(void* offset) { asm volatile("ldr r3, [%0] \n" "msr msp, r3 \n" "ldr r3, [%1] \n" "mov pc, r3 \n" : : "r"(offset), "r"(offset + 0x4) : "r3"); } void target_switch2dfu() { target_led_control("B"); // Remap memory to system bootloader LL_SYSCFG_SetRemapMemory(LL_SYSCFG_REMAP_SYSTEMFLASH); target_switch(0x0); } void target_switch2os() { target_led_control("G"); SCB->VTOR = BOOT_ADDRESS + OS_OFFSET; target_switch((void*)(BOOT_ADDRESS + OS_OFFSET)); }