dominic/Tactility
1
0
Fork 0
mirror of https://github.com/ByteWelder/Tactility.git synced 2026-08-17 23:55:04 +00:00
Code Issues Packages Projects Releases Wiki Activity

Add estimated power percentage

Browse Source
This commit is contained in:
Ken Van Hoeylandt 2026-07-11 02:20:41 +02:00
parent 24b12d763d
commit fcfaffd0df
1 changed files with 29 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

36
TactilityKernel/source/drivers/battery_sense.cpp
View File

@ -11,20 +11,21 @@
// Raw-to-millivolt conversion assumes a 12-bit ADC, since the generic ADC API doesn't expose resolution. // Raw-to-millivolt conversion assumes a 12-bit ADC, since the generic ADC API doesn't expose resolution.
#define ADC_MAX_RAW 4095 #define ADC_MAX_RAW 4095
// Rough LiPo discharge curve, used to estimate a charge percentage from the sensed voltage since
// this driver has no calibrated fuel gauge to read one from directly.
#define BATTERY_MIN_MV 3200
#define BATTERY_MAX_MV 4200
// The power-supply child's config pointer isn't set; it reads its settings from its parent's config instead. // The power-supply child's config pointer isn't set; it reads its settings from its parent's config instead.
#define GET_PARENT_CONFIG(device) ((const BatterySenseConfig*)device_get_parent(device)->config) #define GET_PARENT_CONFIG(device) ((const BatterySenseConfig*)device_get_parent(device)->config)
extern "C" { extern "C" {
static bool supports_property(Device*, PowerSupplyProperty property) { static bool supports_property(Device*, PowerSupplyProperty property) {
return property == POWER_SUPPLY_PROP_VOLTAGE; return property == POWER_SUPPLY_PROP_VOLTAGE || property == POWER_SUPPLY_PROP_CAPACITY;
} }
static error_t get_property(Device* device, PowerSupplyProperty property, PowerSupplyPropertyValue* out_value) { static error_t read_battery_mv(Device* device, int* out_mv) {
if (property != POWER_SUPPLY_PROP_VOLTAGE) {
return ERROR_NOT_SUPPORTED;
}
const auto* config = GET_PARENT_CONFIG(device); const auto* config = GET_PARENT_CONFIG(device);
int raw; int raw;
error_t error = adc_channel_read_raw(&config->io_channel, &raw, portMAX_DELAY); error_t error = adc_channel_read_raw(&config->io_channel, &raw, portMAX_DELAY);
@ -33,7 +34,28 @@ static error_t get_property(Device* device, PowerSupplyProperty property, PowerS
} }
int64_t adc_mv = ((int64_t)raw * config->reference_voltage_mv) / ADC_MAX_RAW; int64_t adc_mv = ((int64_t)raw * config->reference_voltage_mv) / ADC_MAX_RAW;
out_value->int_value = (int)((adc_mv * config->multiplier) / 1000); *out_mv = (int)((adc_mv * config->multiplier) / 1000);
return ERROR_NONE;
}
static int estimate_capacity_from_mv(int battery_mv) {
if (battery_mv <= BATTERY_MIN_MV) return 0;
if (battery_mv >= BATTERY_MAX_MV) return 100;
return (battery_mv - BATTERY_MIN_MV) * 100 / (BATTERY_MAX_MV - BATTERY_MIN_MV);
}
static error_t get_property(Device* device, PowerSupplyProperty property, PowerSupplyPropertyValue* out_value) {
if (property != POWER_SUPPLY_PROP_VOLTAGE && property != POWER_SUPPLY_PROP_CAPACITY) {
return ERROR_NOT_SUPPORTED;
}
int battery_mv;
error_t error = read_battery_mv(device, &battery_mv);
if (error != ERROR_NONE) {
return error;
}
out_value->int_value = (property == POWER_SUPPLY_PROP_VOLTAGE) ? battery_mv : estimate_capacity_from_mv(battery_mv);
return ERROR_NONE; return ERROR_NONE;
} }