m5stack_core/driver/
axp2101.rs1use thiserror_no_std::Error;
18
19use crate::io::shared_i2c::SharedI2cBus;
20
21const REG_PWR_STATUS: u8 = 0x00;
22const REG_COMMON_CONFIG: u8 = 0x10;
23const REG_ADC_EN: u8 = 0x30; const REG_LDO_EN: u8 = 0x90;
25const REG_DLDO1_VOL: u8 = 0x99;
26const REG_VBAT_H: u8 = 0x34;
27
28const DLDO1_VOL_MIN_MV: u16 = 500;
29const DLDO1_VOL_MAX_MV: u16 = 3400;
30const DLDO1_VOL_STEP_MV: u16 = 100;
31const DLDO1_EN_BIT: u8 = 0x80; const VBUS_GOOD_BIT: u8 = 0x20; const VBAT_ADC_EN_BIT: u8 = 0x01; const SOFT_PWROFF_BIT: u8 = 0x01; #[derive(Debug, Error)]
37pub enum Axp2101Error {
38 #[error("I2C error: {0:?}")]
39 I2cError(#[from] esp_hal::i2c::master::Error),
40
41 #[error("Voltage out of range")]
42 VoltageOutOfRange,
43}
44
45pub struct Axp2101Driver {
46 i2c: &'static SharedI2cBus,
47 address: u8,
48}
49
50impl Axp2101Driver {
51 pub fn new(i2c: &'static SharedI2cBus, address: u8) -> Self {
52 Self { i2c, address }
53 }
54
55 async fn read_reg(&mut self, reg: u8) -> Result<u8, Axp2101Error> {
56 let mut buf = [0u8; 1];
57 self.i2c
58 .lock()
59 .await
60 .write_read_async(self.address, &[reg], &mut buf)
61 .await?;
62 debug!("AXP2101 rd 0x{:02x} = 0x{:02x}", reg, buf[0]);
63 Ok(buf[0])
64 }
65
66 async fn write_reg(&mut self, reg: u8, value: u8) -> Result<(), Axp2101Error> {
67 debug!("AXP2101 wr 0x{:02x} = 0x{:02x}", reg, value);
68 self.i2c
69 .lock()
70 .await
71 .write_async(self.address, &[reg, value])
72 .await?;
73 Ok(())
74 }
75
76 pub async fn set_dldo1(&mut self, enabled: bool, mv: u16) -> Result<(), Axp2101Error> {
78 if !(DLDO1_VOL_MIN_MV..=DLDO1_VOL_MAX_MV).contains(&mv)
79 || !(mv - DLDO1_VOL_MIN_MV).is_multiple_of(DLDO1_VOL_STEP_MV)
80 {
81 return Err(Axp2101Error::VoltageOutOfRange);
82 }
83 let vol_val = ((mv - DLDO1_VOL_MIN_MV) / DLDO1_VOL_STEP_MV) as u8;
84 debug!(
85 "AXP2101 DLDO1 enabled={} {}mV (reg_val={})",
86 enabled, mv, vol_val
87 );
88 self.write_reg(REG_DLDO1_VOL, vol_val).await?;
89
90 let en_reg = self.read_reg(REG_LDO_EN).await?;
91 let en_val = if enabled {
92 en_reg | DLDO1_EN_BIT
93 } else {
94 en_reg & !DLDO1_EN_BIT
95 };
96 self.write_reg(REG_LDO_EN, en_val).await?;
97 Ok(())
98 }
99
100 pub async fn power_off(&mut self) -> Result<(), Axp2101Error> {
119 let cfg = self.read_reg(REG_COMMON_CONFIG).await?;
120 self.write_reg(REG_COMMON_CONFIG, cfg | SOFT_PWROFF_BIT)
121 .await
122 }
123
124 pub async fn enable_battery_adc(&mut self) -> Result<(), Axp2101Error> {
128 let en = self.read_reg(REG_ADC_EN).await?;
129 self.write_reg(REG_ADC_EN, en | VBAT_ADC_EN_BIT).await?;
130 Ok(())
131 }
132
133 pub async fn battery_voltage_mv(&mut self) -> Result<u16, Axp2101Error> {
135 let hi = self.read_reg(REG_VBAT_H).await?;
136 let mut lo_buf = [0u8; 1];
137 self.i2c
138 .lock()
139 .await
140 .write_read_async(self.address, &[REG_VBAT_H + 1], &mut lo_buf)
141 .await?;
142 debug!("AXP2101 rd 0x{:02x} = 0x{:02x}", REG_VBAT_H + 1, lo_buf[0]);
143 let raw = ((hi as u16 & 0x3F) << 8) | lo_buf[0] as u16;
144 Ok(raw)
145 }
146
147 pub async fn vbus_present(&mut self) -> Result<bool, Axp2101Error> {
149 let status = self.read_reg(REG_PWR_STATUS).await?;
150 Ok(status & VBUS_GOOD_BIT != 0)
151 }
152}