|
5 | 5 | #define OMV_BOOTLOADER_MAGIC_ADDR (0x2001FFFCU)
|
6 | 6 | #define OMV_BOOTLOADER_MAGIC_VALUE (0xB00710ADU)
|
7 | 7 |
|
| 8 | +void board_early_init(void) { |
| 9 | + // Bring FLIR Lepton out of reset. |
| 10 | + mp_hal_pin_config(pyb_pin_LEPTON_RSTN, MP_HAL_PIN_MODE_OUTPUT, MP_HAL_PIN_PULL_NONE, 0); |
| 11 | + mp_hal_pin_config_speed(pyb_pin_LEPTON_RSTN, MP_HAL_PIN_SPEED_LOW); |
| 12 | + mp_hal_pin_write(pyb_pin_LEPTON_RSTN, 1); |
| 13 | + |
| 14 | + // Release powerdown. |
| 15 | + mp_hal_pin_config(pyb_pin_LEPTON_PWDN, MP_HAL_PIN_MODE_OUTPUT, MP_HAL_PIN_PULL_NONE, 0); |
| 16 | + mp_hal_pin_config_speed(pyb_pin_LEPTON_PWDN, MP_HAL_PIN_SPEED_LOW); |
| 17 | + mp_hal_pin_write(pyb_pin_LEPTON_PWDN, 1); |
| 18 | + |
| 19 | + // Enable FLIR Lepton MCLK. |
| 20 | + mp_hal_pin_config(pyb_pin_LEPTON_MCLK, MP_HAL_PIN_MODE_ALT, MP_HAL_PIN_PULL_NONE, 4); |
| 21 | + mp_hal_pin_config_speed(pyb_pin_LEPTON_MCLK, MP_HAL_PIN_SPEED_HIGH); |
| 22 | + |
| 23 | + // Hardcode the clock frequency as SystemClock_Config() hasn't been called yet. |
| 24 | + int tclk = 120000000 * 2; // HAL_RCC_GetPCLK2Freq() * 2 |
| 25 | + int period = (tclk / 24000000) - 1; |
| 26 | + |
| 27 | + TIM_HandleTypeDef mclk_tim_handle; |
| 28 | + mclk_tim_handle.Instance = TIM15; |
| 29 | + mclk_tim_handle.Init.Prescaler = 0; |
| 30 | + mclk_tim_handle.Init.CounterMode = TIM_COUNTERMODE_UP; |
| 31 | + mclk_tim_handle.Init.Period = period; |
| 32 | + mclk_tim_handle.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1; |
| 33 | + mclk_tim_handle.Init.RepetitionCounter = 0; |
| 34 | + mclk_tim_handle.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE; |
| 35 | + |
| 36 | + TIM_OC_InitTypeDef mclk_tim_oc_handle; |
| 37 | + mclk_tim_oc_handle.Pulse = (period + 1) / 2; |
| 38 | + mclk_tim_oc_handle.OCMode = TIM_OCMODE_PWM1; |
| 39 | + mclk_tim_oc_handle.OCPolarity = TIM_OCPOLARITY_HIGH; |
| 40 | + mclk_tim_oc_handle.OCNPolarity = TIM_OCNPOLARITY_HIGH; |
| 41 | + mclk_tim_oc_handle.OCFastMode = TIM_OCFAST_DISABLE; |
| 42 | + mclk_tim_oc_handle.OCIdleState = TIM_OCIDLESTATE_RESET; |
| 43 | + mclk_tim_oc_handle.OCNIdleState = TIM_OCNIDLESTATE_RESET; |
| 44 | + |
| 45 | + __HAL_RCC_TIM15_CLK_ENABLE(); |
| 46 | + __HAL_RCC_TIM15_CLK_SLEEP_ENABLE(); |
| 47 | + __HAL_RCC_TIM15_FORCE_RESET(); |
| 48 | + __HAL_RCC_TIM15_RELEASE_RESET(); |
| 49 | + |
| 50 | + HAL_TIM_PWM_Init(&mclk_tim_handle); |
| 51 | + HAL_TIM_PWM_ConfigChannel(&mclk_tim_handle, &mclk_tim_oc_handle, TIM_CHANNEL_2); |
| 52 | + HAL_TIM_PWM_Start(&mclk_tim_handle, TIM_CHANNEL_2); |
| 53 | +} |
| 54 | + |
8 | 55 | void board_low_power(int mode) {
|
9 | 56 | switch (mode) {
|
10 | 57 | case 0: // Leave stop mode.
|
|
0 commit comments