boot: init analog wdg & power up laser after cfg

- Verified to be boot-able on Rev0_3 board
This commit is contained in:
linuswck 2024-01-24 12:14:11 +08:00
parent af283b17ac
commit 5bea3f0e5f
1 changed files with 5 additions and 9 deletions

View File

@ -1,8 +1,7 @@
use core::marker::PhantomData;
use super::{gpio, sys_timer, usb}; use super::{gpio, sys_timer, usb};
use crate::device::flash_store::{self, FlashStore}; use crate::device::flash_store::{self, FlashStore};
use crate::laser_diode::ld_ctrl::{*}; use crate::laser_diode::ld_ctrl::{*};
use crate::laser_diode::laser_diode::{self, LdDrive}; use crate::laser_diode::laser_diode::LdDrive;
use crate::thermostat::max1968::MAX1968; use crate::thermostat::max1968::MAX1968;
use crate::thermostat::thermostat::Thermostat; use crate::thermostat::thermostat::Thermostat;
use fugit::ExtU32; use fugit::ExtU32;
@ -41,7 +40,7 @@ pub fn bootup(
sys_timer::setup(core_perif.SYST, clocks); sys_timer::setup(core_perif.SYST, clocks);
let (_eth_pins, usb, current_source_phy, ad7172_phy, max1968_phy) = gpio::setup( let (_eth_pins, usb, current_source_phy, ad7172_phy, max1968_phy, pd_mon_phy) = gpio::setup(
clocks, clocks,
perif.TIM4, perif.TIM4,
perif.GPIOA, perif.GPIOA,
@ -59,17 +58,14 @@ pub fn bootup(
usb::State::setup(usb); usb::State::setup(usb);
let current_source = LdCtrl::new(current_source_phy, perif.ADC2); let current_source = LdCtrl::new(current_source_phy);
let mut laser = LdDrive::new(current_source); let mut laser = LdDrive::new(current_source, perif.ADC2, pd_mon_phy);
laser.setup(); laser.setup();
laser.ld_open(); laser.ld_open();
laser.power_up();
laser.set_ld_drive_current_limit(ElectricCurrent::new::<ampere>(0.2)); laser.set_ld_drive_current_limit(ElectricCurrent::new::<ampere>(0.2));
laser.ld_set_i(ElectricCurrent::new::<ampere>(0.15)); laser.ld_set_i(ElectricCurrent::new::<ampere>(0.15));
laser.power_up();
// Set a non-zero value so that there is a non NAN power reading
laser.set_pd_i_to_out_pwr(laser_diode::IToPowerUnit {dimension: PhantomData, units: PhantomData, value: 0.001});
let tec_driver = MAX1968::new(max1968_phy, perif.ADC1); let tec_driver = MAX1968::new(max1968_phy, perif.ADC1);