use std::sync::Arc;
use acpi_tables::aml;
use acpi_tables::aml::Aml;
use anyhow::bail;
use anyhow::Context;
use base::error;
use base::warn;
use base::AsRawDescriptor;
use base::Event;
use base::EventToken;
use base::RawDescriptor;
use base::Tube;
use base::WaitContext;
use base::WorkerThread;
use power_monitor::BatteryStatus;
use power_monitor::CreatePowerClientFn;
use power_monitor::CreatePowerMonitorFn;
use remain::sorted;
use serde::Deserialize;
use serde::Serialize;
use sync::Mutex;
use thiserror::Error;
use vm_control::BatConfig;
use vm_control::BatControlCommand;
use vm_control::BatControlResult;
use crate::pci::CrosvmDeviceId;
use crate::BusAccessInfo;
use crate::BusDevice;
use crate::DeviceId;
use crate::IrqLevelEvent;
use crate::Suspendable;
#[sorted]
#[derive(Error, Debug)]
pub enum BatteryError {
#[error("Non 32-bit mmio address space")]
Non32BitMmioAddress,
}
type Result<T> = std::result::Result<T, BatteryError>;
pub const GOLDFISHBAT_MMIO_LEN: u64 = 0x1000;
#[derive(Clone, Serialize, Deserialize)]
struct GoldfishBatteryState {
int_status: u32,
int_enable: u32,
ac_online: u32,
status: u32,
health: u32,
present: u32,
capacity: u32,
voltage: u32,
current: u32,
charge_counter: u32,
charge_full: u32,
initialized: bool,
}
macro_rules! create_battery_func {
($fn:ident, $property:ident, $int:ident) => {
pub(crate) fn $fn(&mut self, value: u32) -> bool {
let old = std::mem::replace(&mut self.$property, value);
old != self.$property && self.set_int_status($int)
}
};
}
impl GoldfishBatteryState {
fn set_int_status(&mut self, mask: u32) -> bool {
if ((self.int_enable & mask) != 0) && ((self.int_status & mask) == 0) {
self.int_status |= mask;
return true;
}
false
}
fn int_status(&self) -> u32 {
self.int_status
}
create_battery_func!(set_ac_online, ac_online, AC_STATUS_CHANGED);
create_battery_func!(set_status, status, BATTERY_STATUS_CHANGED);
create_battery_func!(set_health, health, BATTERY_STATUS_CHANGED);
create_battery_func!(set_present, present, BATTERY_STATUS_CHANGED);
create_battery_func!(set_capacity, capacity, BATTERY_STATUS_CHANGED);
create_battery_func!(set_voltage, voltage, BATTERY_STATUS_CHANGED);
create_battery_func!(set_current, current, BATTERY_STATUS_CHANGED);
create_battery_func!(set_charge_counter, charge_counter, BATTERY_STATUS_CHANGED);
create_battery_func!(set_charge_full, charge_full, BATTERY_STATUS_CHANGED);
}
pub struct GoldfishBattery {
state: Arc<Mutex<GoldfishBatteryState>>,
mmio_base: u32,
irq_num: u32,
irq_evt: IrqLevelEvent,
activated: bool,
monitor_thread: Option<WorkerThread<()>>,
tube: Option<Tube>,
create_power_monitor: Option<Box<dyn CreatePowerMonitorFn>>,
create_powerd_client: Option<Box<dyn CreatePowerClientFn>>,
battery_config: Arc<Mutex<BatConfig>>,
}
#[derive(Serialize, Deserialize)]
struct GoldfishBatterySnapshot {
state: GoldfishBatteryState,
mmio_base: u32,
irq_num: u32,
activated: bool,
}
const BATTERY_INT_STATUS: u32 = 0;
const BATTERY_INT_ENABLE: u32 = 0x4;
const BATTERY_AC_ONLINE: u32 = 0x8;
const BATTERY_STATUS: u32 = 0xC;
const BATTERY_HEALTH: u32 = 0x10;
const BATTERY_PRESENT: u32 = 0x14;
const BATTERY_CAPACITY: u32 = 0x18;
const BATTERY_VOLTAGE: u32 = 0x1C;
const BATTERY_TEMP: u32 = 0x20;
const BATTERY_CHARGE_COUNTER: u32 = 0x24;
const BATTERY_VOLTAGE_MAX: u32 = 0x28;
const BATTERY_CURRENT_MAX: u32 = 0x2C;
const BATTERY_CURRENT_NOW: u32 = 0x30;
const BATTERY_CURRENT_AVG: u32 = 0x34;
const BATTERY_CHARGE_FULL_UAH: u32 = 0x38;
const BATTERY_CYCLE_COUNT: u32 = 0x40;
const BATTERY_STATUS_CHANGED: u32 = 1 << 0;
const AC_STATUS_CHANGED: u32 = 1 << 1;
const BATTERY_INT_MASK: u32 = BATTERY_STATUS_CHANGED | AC_STATUS_CHANGED;
const BATTERY_STATUS_VAL_UNKNOWN: u32 = 0;
const BATTERY_STATUS_VAL_CHARGING: u32 = 1;
const BATTERY_STATUS_VAL_DISCHARGING: u32 = 2;
const BATTERY_STATUS_VAL_NOT_CHARGING: u32 = 3;
const BATTERY_HEALTH_VAL_UNKNOWN: u32 = 0;
const AC_ONLINE_VAL_OFFLINE: u32 = 0;
#[derive(EventToken)]
pub(crate) enum Token {
Commands,
Resample,
Kill,
Monitor,
}
fn command_monitor(
tube: Tube,
irq_evt: IrqLevelEvent,
kill_evt: Event,
state: Arc<Mutex<GoldfishBatteryState>>,
create_power_monitor: Option<Box<dyn CreatePowerMonitorFn>>,
battery_config: Arc<Mutex<BatConfig>>,
) {
let wait_ctx: WaitContext<Token> = match WaitContext::build_with(&[
(&tube, Token::Commands),
(irq_evt.get_resample(), Token::Resample),
(&kill_evt, Token::Kill),
]) {
Ok(pc) => pc,
Err(e) => {
error!("failed to build WaitContext: {}", e);
return;
}
};
let mut power_monitor = match create_power_monitor {
Some(f) => match f() {
Ok(p) => match wait_ctx.add(p.get_read_notifier(), Token::Monitor) {
Ok(()) => Some(p),
Err(e) => {
error!("failed to add power monitor to poll context: {}", e);
None
}
},
Err(e) => {
error!("failed to create power monitor: {}", e);
None
}
},
None => None,
};
'poll: loop {
let events = match wait_ctx.wait() {
Ok(v) => v,
Err(e) => {
error!("error while polling for events: {}", e);
break;
}
};
for event in events.iter().filter(|e| e.is_readable) {
match event.token {
Token::Commands => {
let req = match tube.recv() {
Ok(req) => req,
Err(e) => {
error!("failed to receive request: {}", e);
continue;
}
};
let mut bat_config = battery_config.lock();
let mut bat_state = state.lock();
let inject_irq = match req {
BatControlCommand::SetStatus(status) => bat_state.set_status(status.into()),
BatControlCommand::SetHealth(health) => bat_state.set_health(health.into()),
BatControlCommand::SetPresent(present) => {
let v = present != 0;
bat_state.set_present(v.into())
}
BatControlCommand::SetCapacity(capacity) => {
let v = std::cmp::min(capacity, 100);
bat_state.set_capacity(v)
}
BatControlCommand::SetACOnline(ac_online) => {
let v = ac_online != 0;
bat_state.set_ac_online(v.into())
}
BatControlCommand::SetFakeBatConfig(max_capacity) => {
let max_capacity = std::cmp::min(max_capacity, 100);
*bat_config = BatConfig::Fake { max_capacity };
true
}
BatControlCommand::CancelFakeConfig => {
*bat_config = BatConfig::Real;
true
}
};
if inject_irq {
let _ = irq_evt.trigger();
}
if let Err(e) = tube.send(&BatControlResult::Ok) {
error!("failed to send response: {}", e);
}
}
Token::Monitor => {
let power_monitor = power_monitor.as_mut().unwrap();
let data = match power_monitor.read_message() {
Ok(Some(d)) => d,
Ok(None) => continue,
Err(e) => {
error!("failed to read new power data: {}", e);
continue;
}
};
let mut bat_state = state.lock();
let mut inject_irq = bat_state.set_ac_online(data.ac_online.into());
match data.battery {
Some(battery_data) => {
inject_irq |= bat_state.set_capacity(battery_data.percent);
let battery_status = match battery_data.status {
BatteryStatus::Unknown => BATTERY_STATUS_VAL_UNKNOWN,
BatteryStatus::Charging => BATTERY_STATUS_VAL_CHARGING,
BatteryStatus::Discharging => BATTERY_STATUS_VAL_DISCHARGING,
BatteryStatus::NotCharging => BATTERY_STATUS_VAL_NOT_CHARGING,
};
inject_irq |= bat_state.set_status(battery_status);
inject_irq |= bat_state.set_voltage(battery_data.voltage);
inject_irq |= bat_state.set_current(battery_data.current);
inject_irq |= bat_state.set_charge_counter(battery_data.charge_counter);
inject_irq |= bat_state.set_charge_full(battery_data.charge_full);
}
None => {
inject_irq |= bat_state.set_present(0);
}
}
if inject_irq {
let _ = irq_evt.trigger();
}
}
Token::Resample => {
irq_evt.clear_resample();
if state.lock().int_status() != 0 {
let _ = irq_evt.trigger();
}
}
Token::Kill => break 'poll,
}
}
}
}
impl GoldfishBattery {
pub fn new(
mmio_base: u64,
irq_num: u32,
irq_evt: IrqLevelEvent,
tube: Tube,
create_power_monitor: Option<Box<dyn CreatePowerMonitorFn>>,
create_powerd_client: Option<Box<dyn CreatePowerClientFn>>,
) -> Result<Self> {
if mmio_base + GOLDFISHBAT_MMIO_LEN - 1 > u32::MAX as u64 {
return Err(BatteryError::Non32BitMmioAddress);
}
let state = Arc::new(Mutex::new(GoldfishBatteryState {
capacity: 50,
health: BATTERY_HEALTH_VAL_UNKNOWN,
present: 1,
status: BATTERY_STATUS_VAL_UNKNOWN,
ac_online: 1,
int_enable: 0,
int_status: 0,
voltage: 0,
current: 0,
charge_counter: 0,
charge_full: 0,
initialized: false,
}));
let battery_config = Arc::new(Mutex::new(BatConfig::default()));
Ok(GoldfishBattery {
state,
mmio_base: mmio_base as u32,
irq_num,
irq_evt,
activated: false,
monitor_thread: None,
tube: Some(tube),
create_power_monitor,
create_powerd_client,
battery_config,
})
}
pub fn keep_rds(&self) -> Vec<RawDescriptor> {
let mut rds = vec![
self.irq_evt.get_trigger().as_raw_descriptor(),
self.irq_evt.get_resample().as_raw_descriptor(),
];
if let Some(tube) = &self.tube {
rds.push(tube.as_raw_descriptor());
}
rds
}
fn start_monitor(&mut self) {
if self.activated {
return;
}
if let Some(tube) = self.tube.take() {
let irq_evt = self.irq_evt.try_clone().unwrap();
let bat_state = self.state.clone();
let create_monitor_fn = self.create_power_monitor.take();
let battery_config = self.battery_config.clone();
self.monitor_thread = Some(WorkerThread::start(self.debug_label(), move |kill_evt| {
command_monitor(
tube,
irq_evt,
kill_evt,
bat_state,
create_monitor_fn,
battery_config,
)
}));
self.activated = true;
}
}
fn initialize_battery_state(&mut self) -> anyhow::Result<()> {
let mut power_client = match &self.create_powerd_client {
Some(f) => match f() {
Ok(c) => c,
Err(e) => bail!("failed to connect to the powerd: {:#}", e),
},
None => return Ok(()),
};
match power_client.get_power_data() {
Ok(data) => {
let mut bat_state = self.state.lock();
bat_state.set_ac_online(data.ac_online.into());
match data.battery {
Some(battery_data) => {
bat_state.set_capacity(battery_data.percent);
let battery_status = match battery_data.status {
BatteryStatus::Unknown => BATTERY_STATUS_VAL_UNKNOWN,
BatteryStatus::Charging => BATTERY_STATUS_VAL_CHARGING,
BatteryStatus::Discharging => BATTERY_STATUS_VAL_DISCHARGING,
BatteryStatus::NotCharging => BATTERY_STATUS_VAL_NOT_CHARGING,
};
bat_state.set_status(battery_status);
bat_state.set_voltage(battery_data.voltage);
bat_state.set_current(battery_data.current);
bat_state.set_charge_counter(battery_data.charge_counter);
bat_state.set_charge_full(battery_data.charge_full);
}
None => {
bat_state.set_present(0);
}
}
Ok(())
}
Err(e) => {
bail!("failed to get response from powerd: {:#}", e);
}
}
}
}
impl Drop for GoldfishBattery {
fn drop(&mut self) {
if let Err(e) = self.sleep() {
error!("{}", e);
};
}
}
impl BusDevice for GoldfishBattery {
fn device_id(&self) -> DeviceId {
CrosvmDeviceId::GoldfishBattery.into()
}
fn debug_label(&self) -> String {
"GoldfishBattery".to_owned()
}
fn read(&mut self, info: BusAccessInfo, data: &mut [u8]) {
if data.len() != std::mem::size_of::<u32>() {
warn!(
"{}: unsupported read length {}, only support 4bytes read",
self.debug_label(),
data.len()
);
return;
}
if !self.state.lock().initialized {
match self.initialize_battery_state() {
Ok(()) => self.state.lock().initialized = true,
Err(e) => {
error!(
"{}: failed to get power data and update: {:#}",
self.debug_label(),
e
);
}
}
}
let val = match info.offset as u32 {
BATTERY_INT_STATUS => {
std::mem::replace(&mut self.state.lock().int_status, 0)
}
BATTERY_INT_ENABLE => self.state.lock().int_enable,
BATTERY_AC_ONLINE => match *self.battery_config.lock() {
BatConfig::Real => self.state.lock().ac_online,
BatConfig::Fake { max_capacity: _ } => AC_ONLINE_VAL_OFFLINE,
},
BATTERY_STATUS => match *self.battery_config.lock() {
BatConfig::Real => self.state.lock().status,
BatConfig::Fake { max_capacity: _ } => BATTERY_STATUS_VAL_DISCHARGING,
},
BATTERY_HEALTH => self.state.lock().health,
BATTERY_PRESENT => self.state.lock().present,
BATTERY_CAPACITY => {
let max_capacity = match *self.battery_config.lock() {
BatConfig::Real => 100,
BatConfig::Fake { max_capacity } => max_capacity,
};
std::cmp::min(max_capacity, self.state.lock().capacity)
}
BATTERY_VOLTAGE => self.state.lock().voltage,
BATTERY_TEMP => 0,
BATTERY_CHARGE_COUNTER => self.state.lock().charge_counter,
BATTERY_VOLTAGE_MAX => 0,
BATTERY_CURRENT_MAX => 0,
BATTERY_CURRENT_NOW => self.state.lock().current,
BATTERY_CURRENT_AVG => 0,
BATTERY_CHARGE_FULL_UAH => self.state.lock().charge_full,
BATTERY_CYCLE_COUNT => 0,
_ => {
warn!("{}: unsupported read address {}", self.debug_label(), info);
return;
}
};
let val_arr = val.to_ne_bytes();
data.copy_from_slice(&val_arr);
}
fn write(&mut self, info: BusAccessInfo, data: &[u8]) {
if data.len() != std::mem::size_of::<u32>() {
warn!(
"{}: unsupported write length {}, only support 4bytes write",
self.debug_label(),
data.len()
);
return;
}
let mut val_arr = u32::to_ne_bytes(0u32);
val_arr.copy_from_slice(data);
let val = u32::from_ne_bytes(val_arr);
match info.offset as u32 {
BATTERY_INT_ENABLE => {
self.state.lock().int_enable = val;
if (val & BATTERY_INT_MASK) != 0 && !self.activated {
self.start_monitor();
}
}
_ => {
warn!("{}: Bad write to address {}", self.debug_label(), info);
}
};
}
}
impl Aml for GoldfishBattery {
fn to_aml_bytes(&self, bytes: &mut Vec<u8>) {
aml::Device::new(
"GFBY".into(),
vec![
&aml::Name::new("_HID".into(), &"GFSH0001"),
&aml::Name::new(
"_CRS".into(),
&aml::ResourceTemplate::new(vec![
&aml::Memory32Fixed::new(true, self.mmio_base, GOLDFISHBAT_MMIO_LEN as u32),
&aml::Interrupt::new(true, false, false, true, self.irq_num),
]),
),
],
)
.to_aml_bytes(bytes);
}
}
impl Suspendable for GoldfishBattery {
fn sleep(&mut self) -> anyhow::Result<()> {
if let Some(thread) = self.monitor_thread.take() {
thread.stop();
}
Ok(())
}
fn wake(&mut self) -> anyhow::Result<()> {
if self.activated {
self.activated = false;
self.start_monitor();
}
Ok(())
}
fn snapshot(&mut self) -> anyhow::Result<serde_json::Value> {
serde_json::to_value(GoldfishBatterySnapshot {
state: self.state.lock().clone(),
mmio_base: self.mmio_base,
irq_num: self.irq_num,
activated: self.activated,
})
.context("failed to snapshot GoldfishBattery")
}
fn restore(&mut self, data: serde_json::Value) -> anyhow::Result<()> {
let deser: GoldfishBatterySnapshot =
serde_json::from_value(data).context("failed to deserialize GoldfishBattery")?;
{
let mut locked_state = self.state.lock();
*locked_state = deser.state;
}
self.mmio_base = deser.mmio_base;
self.irq_num = deser.irq_num;
self.activated = deser.activated;
Ok(())
}
}
#[cfg(test)]
mod tests {
use super::*;
use crate::suspendable_tests;
fn modify_device(battery: &mut GoldfishBattery) {
let mut state = battery.state.lock();
state.set_capacity(70);
}
suspendable_tests! {
battery, GoldfishBattery::new(
0,
0,
IrqLevelEvent::new().unwrap(),
Tube::pair().unwrap().1,
None,
None,
).unwrap(),
modify_device
}
}