dfu: refactor

pull/51/head
topquark12 2021-01-18 16:45:01 +08:00
parent c4e3be1d05
commit f3661ac8e3
1 changed files with 10 additions and 14 deletions

View File

@ -1,5 +1,7 @@
use cortex_m_rt::{pre_init}; use cortex_m_rt::{pre_init};
use stm32f4xx_hal::{
stm32::{RCC, SYSCFG},
};
const DFU_TRIG_MSG: u32 = 0xDECAFBAD; const DFU_TRIG_MSG: u32 = 0xDECAFBAD;
extern "C" { extern "C" {
@ -21,22 +23,16 @@ unsafe fn __pre_init() {
_dfu_msg = 0x00000000; _dfu_msg = 0x00000000;
// Enable system config controller clock // Enable system config controller clock
const RCC_APB2ENR: *mut u32 = 0xE000_ED88 as *mut u32; let rcc = &*RCC::ptr();
const RCC_APB2ENR_ENABLE_SYSCFG_CLOCK: u32 = 0x00004000; rcc.apb2enr.modify(|_, w| w.syscfgen().set_bit());
core::ptr::write_volatile(
RCC_APB2ENR,
*RCC_APB2ENR | RCC_APB2ENR_ENABLE_SYSCFG_CLOCK,
);
// Bypass BOOT pins and remap bootloader to 0x00000000 // Bypass BOOT pins and remap bootloader to 0x00000000
const SYSCFG_MEMRMP: *mut u32 = 0x40013800 as *mut u32; let syscfg = &*SYSCFG::ptr() ;
const SYSCFG_MEMRMP_MAP_ROM: u32 = 0x00000001; syscfg.memrm.write(|w| w.mem_mode().bits(0b01));
core::ptr::write_volatile( // Impose instruction and memory barriers
SYSCFG_MEMRMP, cortex_m::asm::isb();
*SYSCFG_MEMRMP | SYSCFG_MEMRMP_MAP_ROM, cortex_m::asm::dsb();
);
asm!( asm!(
// Set stack pointer to bootloader location // Set stack pointer to bootloader location