mirror of
https://github.com/saymrwulf/xous-core.git
synced 2026-11-16 08:38:26 +00:00
add routine to set pwm mode on axp2101
This commit is contained in:
parent
9297879f76
commit
06d8760209
1 changed files with 34 additions and 0 deletions
|
|
@ -3,6 +3,7 @@ use cramium_api::*;
|
|||
pub const AXP2101_DEV: u8 = 0x34;
|
||||
|
||||
const REG_DCDC_ENA: usize = 0x80;
|
||||
const REG_DCDC_PWM: usize = 0x81;
|
||||
const REG_DCDC1_V: usize = 0x82;
|
||||
const REG_DCDC2_V: usize = 0x83;
|
||||
const REG_DCDC3_V: usize = 0x84;
|
||||
|
|
@ -281,6 +282,39 @@ impl Axp2101 {
|
|||
let data = VBUS_INSERT_MASK | VBUS_REMOVE_MASK;
|
||||
i2c.i2c_write(AXP2101_DEV, REG_IRQ_STATUS1, &[data]).map(|_| ())
|
||||
}
|
||||
|
||||
pub fn set_pwm_mode(
|
||||
&mut self,
|
||||
i2c: &mut dyn I2cApi,
|
||||
which: WhichDcDc,
|
||||
always: bool,
|
||||
) -> Result<(), xous::Error> {
|
||||
match which {
|
||||
WhichDcDc::Dcdc5 => Err(xous::Error::BadAddress),
|
||||
_ => {
|
||||
let mut buf = [0u8];
|
||||
i2c.i2c_read(AXP2101_DEV, REG_DCDC_PWM as u8, &mut buf, false).map(|_| ())?;
|
||||
if always {
|
||||
buf[0] |= 4u8 << (which as usize as u8);
|
||||
} else {
|
||||
buf[0] &= !(4u8 << (which as usize as u8));
|
||||
}
|
||||
i2c.i2c_write(AXP2101_DEV, REG_DCDC_PWM as u8, &buf).map(|_| ())
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
pub fn debug(&mut self, i2c: &mut dyn I2cApi) {
|
||||
let mut buf = [0u8, 0u8];
|
||||
i2c.i2c_read(AXP2101_DEV, REG_DCDC_ENA as u8, &mut buf, false).unwrap();
|
||||
crate::println!("ena|pwm bef: {:x?}", buf);
|
||||
// force CCM mode
|
||||
i2c.i2c_write(AXP2101_DEV, REG_DCDC_ENA as u8, &[buf[0] | 0b0100_0000]).unwrap();
|
||||
// disable spreading, force PWM on DCDC2
|
||||
i2c.i2c_write(AXP2101_DEV, REG_DCDC_PWM as u8, &[(buf[1] & 0b0011_1111) | 0b0000_1000]).unwrap();
|
||||
i2c.i2c_read(AXP2101_DEV, REG_DCDC_ENA as u8, &mut buf, false).unwrap();
|
||||
crate::println!("ena|pwm aft: {:x?}", buf);
|
||||
}
|
||||
}
|
||||
|
||||
pub fn parse_dcdc_ena(d: u8) -> ([bool; 4], bool, bool) {
|
||||
|
|
|
|||
Loading…
Reference in a new issue