mirror of
https://github.com/torvalds/linux.git
synced 2024-12-04 01:51:34 +00:00
81f07d2b0c
strncpy() is deprecated for use on NUL-terminated destination strings [1] and as such we should prefer more robust and less ambiguous string interfaces. We expect bat->name to be NUL-terminated based on its usage with strcmp(): power_supply_core.c: 445: return strcmp(psy->desc->name, name) == 0; ... and also by the manual `... - 1` for the length argument of the original strncpy() invocation. Furthermore, no NUL-padding is needed as bat is zero-allocated before calling spwr_battery_init(): 826: bat = devm_kzalloc(&sdev->dev, sizeof(*bat), GFP_KERNEL); 827: if (!bat) 828: return -ENOMEM; 829: 830: spwr_battery_init(bat, sdev, p->registry, p->name); ... this means any further NUL-byte assignments (like the ones that strncpy() does) are redundant. Considering the above, a suitable replacement is `strscpy` [2] due to the fact that it guarantees NUL-termination on the destination buffer without unnecessarily NUL-padding. Let's also opt to use the more idiomatic strscpy() usage of: (dest, src, sizeof(dest)). Link: https://www.kernel.org/doc/html/latest/process/deprecated.html#strncpy-on-nul-terminated-strings [1] Link: https://manpages.debian.org/testing/linux-manual-4.8/strscpy.9.en.html [2] Link: https://github.com/KSPP/linux/issues/90 Cc: linux-hardening@vger.kernel.org Signed-off-by: Justin Stitt <justinstitt@google.com> Link: https://lore.kernel.org/r/20231020-strncpy-drivers-power-supply-surface_battery-c-v2-1-29ed16b2caf1@google.com Signed-off-by: Sebastian Reichel <sebastian.reichel@collabora.com>
876 lines
22 KiB
C
876 lines
22 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Battery driver for 7th-generation Microsoft Surface devices via Surface
|
|
* System Aggregator Module (SSAM).
|
|
*
|
|
* Copyright (C) 2019-2021 Maximilian Luz <luzmaximilian@gmail.com>
|
|
*/
|
|
|
|
#include <asm/unaligned.h>
|
|
#include <linux/jiffies.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/power_supply.h>
|
|
#include <linux/sysfs.h>
|
|
#include <linux/types.h>
|
|
#include <linux/workqueue.h>
|
|
|
|
#include <linux/surface_aggregator/device.h>
|
|
|
|
|
|
/* -- SAM interface. -------------------------------------------------------- */
|
|
|
|
enum sam_event_cid_bat {
|
|
SAM_EVENT_CID_BAT_BIX = 0x15,
|
|
SAM_EVENT_CID_BAT_BST = 0x16,
|
|
SAM_EVENT_CID_BAT_ADP = 0x17,
|
|
SAM_EVENT_CID_BAT_PROT = 0x18,
|
|
SAM_EVENT_CID_BAT_DPTF = 0x53,
|
|
};
|
|
|
|
enum sam_battery_sta {
|
|
SAM_BATTERY_STA_OK = 0x0f,
|
|
SAM_BATTERY_STA_PRESENT = 0x10,
|
|
};
|
|
|
|
enum sam_battery_state {
|
|
SAM_BATTERY_STATE_DISCHARGING = BIT(0),
|
|
SAM_BATTERY_STATE_CHARGING = BIT(1),
|
|
SAM_BATTERY_STATE_CRITICAL = BIT(2),
|
|
};
|
|
|
|
enum sam_battery_power_unit {
|
|
SAM_BATTERY_POWER_UNIT_mW = 0,
|
|
SAM_BATTERY_POWER_UNIT_mA = 1,
|
|
};
|
|
|
|
/* Equivalent to data returned in ACPI _BIX method, revision 0. */
|
|
struct spwr_bix {
|
|
u8 revision;
|
|
__le32 power_unit;
|
|
__le32 design_cap;
|
|
__le32 last_full_charge_cap;
|
|
__le32 technology;
|
|
__le32 design_voltage;
|
|
__le32 design_cap_warn;
|
|
__le32 design_cap_low;
|
|
__le32 cycle_count;
|
|
__le32 measurement_accuracy;
|
|
__le32 max_sampling_time;
|
|
__le32 min_sampling_time;
|
|
__le32 max_avg_interval;
|
|
__le32 min_avg_interval;
|
|
__le32 bat_cap_granularity_1;
|
|
__le32 bat_cap_granularity_2;
|
|
__u8 model[21];
|
|
__u8 serial[11];
|
|
__u8 type[5];
|
|
__u8 oem_info[21];
|
|
} __packed;
|
|
|
|
static_assert(sizeof(struct spwr_bix) == 119);
|
|
|
|
/* Equivalent to data returned in ACPI _BST method. */
|
|
struct spwr_bst {
|
|
__le32 state;
|
|
__le32 present_rate;
|
|
__le32 remaining_cap;
|
|
__le32 present_voltage;
|
|
} __packed;
|
|
|
|
static_assert(sizeof(struct spwr_bst) == 16);
|
|
|
|
#define SPWR_BIX_REVISION 0
|
|
#define SPWR_BATTERY_VALUE_UNKNOWN 0xffffffff
|
|
|
|
/* Get battery status (_STA) */
|
|
SSAM_DEFINE_SYNC_REQUEST_CL_R(ssam_bat_get_sta, __le32, {
|
|
.target_category = SSAM_SSH_TC_BAT,
|
|
.command_id = 0x01,
|
|
});
|
|
|
|
/* Get battery static information (_BIX). */
|
|
SSAM_DEFINE_SYNC_REQUEST_CL_R(ssam_bat_get_bix, struct spwr_bix, {
|
|
.target_category = SSAM_SSH_TC_BAT,
|
|
.command_id = 0x02,
|
|
});
|
|
|
|
/* Get battery dynamic information (_BST). */
|
|
SSAM_DEFINE_SYNC_REQUEST_CL_R(ssam_bat_get_bst, struct spwr_bst, {
|
|
.target_category = SSAM_SSH_TC_BAT,
|
|
.command_id = 0x03,
|
|
});
|
|
|
|
/* Set battery trip point (_BTP). */
|
|
SSAM_DEFINE_SYNC_REQUEST_CL_W(ssam_bat_set_btp, __le32, {
|
|
.target_category = SSAM_SSH_TC_BAT,
|
|
.command_id = 0x04,
|
|
});
|
|
|
|
|
|
/* -- Device structures. ---------------------------------------------------- */
|
|
|
|
struct spwr_psy_properties {
|
|
const char *name;
|
|
struct ssam_event_registry registry;
|
|
};
|
|
|
|
struct spwr_battery_device {
|
|
struct ssam_device *sdev;
|
|
|
|
char name[32];
|
|
struct power_supply *psy;
|
|
struct power_supply_desc psy_desc;
|
|
|
|
struct delayed_work update_work;
|
|
|
|
struct ssam_event_notifier notif;
|
|
|
|
struct mutex lock; /* Guards access to state data below. */
|
|
unsigned long timestamp;
|
|
|
|
__le32 sta;
|
|
struct spwr_bix bix;
|
|
struct spwr_bst bst;
|
|
u32 alarm;
|
|
};
|
|
|
|
|
|
/* -- Module parameters. ---------------------------------------------------- */
|
|
|
|
static unsigned int cache_time = 1000;
|
|
module_param(cache_time, uint, 0644);
|
|
MODULE_PARM_DESC(cache_time, "battery state caching time in milliseconds [default: 1000]");
|
|
|
|
|
|
/* -- State management. ----------------------------------------------------- */
|
|
|
|
/*
|
|
* Delay for battery update quirk. See spwr_external_power_changed() below
|
|
* for more details.
|
|
*/
|
|
#define SPWR_AC_BAT_UPDATE_DELAY msecs_to_jiffies(5000)
|
|
|
|
static bool spwr_battery_present(struct spwr_battery_device *bat)
|
|
{
|
|
lockdep_assert_held(&bat->lock);
|
|
|
|
return le32_to_cpu(bat->sta) & SAM_BATTERY_STA_PRESENT;
|
|
}
|
|
|
|
static int spwr_battery_load_sta(struct spwr_battery_device *bat)
|
|
{
|
|
lockdep_assert_held(&bat->lock);
|
|
|
|
return ssam_retry(ssam_bat_get_sta, bat->sdev, &bat->sta);
|
|
}
|
|
|
|
static int spwr_battery_load_bix(struct spwr_battery_device *bat)
|
|
{
|
|
int status;
|
|
|
|
lockdep_assert_held(&bat->lock);
|
|
|
|
if (!spwr_battery_present(bat))
|
|
return 0;
|
|
|
|
status = ssam_retry(ssam_bat_get_bix, bat->sdev, &bat->bix);
|
|
|
|
/* Enforce NULL terminated strings in case anything goes wrong... */
|
|
bat->bix.model[ARRAY_SIZE(bat->bix.model) - 1] = 0;
|
|
bat->bix.serial[ARRAY_SIZE(bat->bix.serial) - 1] = 0;
|
|
bat->bix.type[ARRAY_SIZE(bat->bix.type) - 1] = 0;
|
|
bat->bix.oem_info[ARRAY_SIZE(bat->bix.oem_info) - 1] = 0;
|
|
|
|
return status;
|
|
}
|
|
|
|
static int spwr_battery_load_bst(struct spwr_battery_device *bat)
|
|
{
|
|
lockdep_assert_held(&bat->lock);
|
|
|
|
if (!spwr_battery_present(bat))
|
|
return 0;
|
|
|
|
return ssam_retry(ssam_bat_get_bst, bat->sdev, &bat->bst);
|
|
}
|
|
|
|
static int spwr_battery_set_alarm_unlocked(struct spwr_battery_device *bat, u32 value)
|
|
{
|
|
__le32 value_le = cpu_to_le32(value);
|
|
|
|
lockdep_assert_held(&bat->lock);
|
|
|
|
bat->alarm = value;
|
|
return ssam_retry(ssam_bat_set_btp, bat->sdev, &value_le);
|
|
}
|
|
|
|
static int spwr_battery_update_bst_unlocked(struct spwr_battery_device *bat, bool cached)
|
|
{
|
|
unsigned long cache_deadline = bat->timestamp + msecs_to_jiffies(cache_time);
|
|
int status;
|
|
|
|
lockdep_assert_held(&bat->lock);
|
|
|
|
if (cached && bat->timestamp && time_is_after_jiffies(cache_deadline))
|
|
return 0;
|
|
|
|
status = spwr_battery_load_sta(bat);
|
|
if (status)
|
|
return status;
|
|
|
|
status = spwr_battery_load_bst(bat);
|
|
if (status)
|
|
return status;
|
|
|
|
bat->timestamp = jiffies;
|
|
return 0;
|
|
}
|
|
|
|
static int spwr_battery_update_bst(struct spwr_battery_device *bat, bool cached)
|
|
{
|
|
int status;
|
|
|
|
mutex_lock(&bat->lock);
|
|
status = spwr_battery_update_bst_unlocked(bat, cached);
|
|
mutex_unlock(&bat->lock);
|
|
|
|
return status;
|
|
}
|
|
|
|
static int spwr_battery_update_bix_unlocked(struct spwr_battery_device *bat)
|
|
{
|
|
int status;
|
|
|
|
lockdep_assert_held(&bat->lock);
|
|
|
|
status = spwr_battery_load_sta(bat);
|
|
if (status)
|
|
return status;
|
|
|
|
status = spwr_battery_load_bix(bat);
|
|
if (status)
|
|
return status;
|
|
|
|
status = spwr_battery_load_bst(bat);
|
|
if (status)
|
|
return status;
|
|
|
|
if (bat->bix.revision != SPWR_BIX_REVISION)
|
|
dev_warn(&bat->sdev->dev, "unsupported battery revision: %u\n", bat->bix.revision);
|
|
|
|
bat->timestamp = jiffies;
|
|
return 0;
|
|
}
|
|
|
|
static u32 sprw_battery_get_full_cap_safe(struct spwr_battery_device *bat)
|
|
{
|
|
u32 full_cap = get_unaligned_le32(&bat->bix.last_full_charge_cap);
|
|
|
|
lockdep_assert_held(&bat->lock);
|
|
|
|
if (full_cap == 0 || full_cap == SPWR_BATTERY_VALUE_UNKNOWN)
|
|
full_cap = get_unaligned_le32(&bat->bix.design_cap);
|
|
|
|
return full_cap;
|
|
}
|
|
|
|
static bool spwr_battery_is_full(struct spwr_battery_device *bat)
|
|
{
|
|
u32 state = get_unaligned_le32(&bat->bst.state);
|
|
u32 full_cap = sprw_battery_get_full_cap_safe(bat);
|
|
u32 remaining_cap = get_unaligned_le32(&bat->bst.remaining_cap);
|
|
|
|
lockdep_assert_held(&bat->lock);
|
|
|
|
return full_cap != SPWR_BATTERY_VALUE_UNKNOWN && full_cap != 0 &&
|
|
remaining_cap != SPWR_BATTERY_VALUE_UNKNOWN &&
|
|
remaining_cap >= full_cap &&
|
|
state == 0;
|
|
}
|
|
|
|
static int spwr_battery_recheck_full(struct spwr_battery_device *bat)
|
|
{
|
|
bool present;
|
|
u32 unit;
|
|
int status;
|
|
|
|
mutex_lock(&bat->lock);
|
|
unit = get_unaligned_le32(&bat->bix.power_unit);
|
|
present = spwr_battery_present(bat);
|
|
|
|
status = spwr_battery_update_bix_unlocked(bat);
|
|
if (status)
|
|
goto out;
|
|
|
|
/* If battery has been attached, (re-)initialize alarm. */
|
|
if (!present && spwr_battery_present(bat)) {
|
|
u32 cap_warn = get_unaligned_le32(&bat->bix.design_cap_warn);
|
|
|
|
status = spwr_battery_set_alarm_unlocked(bat, cap_warn);
|
|
if (status)
|
|
goto out;
|
|
}
|
|
|
|
/*
|
|
* Warn if the unit has changed. This is something we genuinely don't
|
|
* expect to happen, so make this a big warning. If it does, we'll
|
|
* need to add support for it.
|
|
*/
|
|
WARN_ON(unit != get_unaligned_le32(&bat->bix.power_unit));
|
|
|
|
out:
|
|
mutex_unlock(&bat->lock);
|
|
|
|
if (!status)
|
|
power_supply_changed(bat->psy);
|
|
|
|
return status;
|
|
}
|
|
|
|
static int spwr_battery_recheck_status(struct spwr_battery_device *bat)
|
|
{
|
|
int status;
|
|
|
|
status = spwr_battery_update_bst(bat, false);
|
|
if (!status)
|
|
power_supply_changed(bat->psy);
|
|
|
|
return status;
|
|
}
|
|
|
|
static u32 spwr_notify_bat(struct ssam_event_notifier *nf, const struct ssam_event *event)
|
|
{
|
|
struct spwr_battery_device *bat = container_of(nf, struct spwr_battery_device, notif);
|
|
int status;
|
|
|
|
/*
|
|
* We cannot use strict matching when registering the notifier as the
|
|
* EC expects us to register it against instance ID 0. Strict matching
|
|
* would thus drop events, as those may have non-zero instance IDs in
|
|
* this subsystem. So we need to check the instance ID of the event
|
|
* here manually.
|
|
*/
|
|
if (event->instance_id != bat->sdev->uid.instance)
|
|
return 0;
|
|
|
|
dev_dbg(&bat->sdev->dev, "power event (cid = %#04x, iid = %#04x, tid = %#04x)\n",
|
|
event->command_id, event->instance_id, event->target_id);
|
|
|
|
switch (event->command_id) {
|
|
case SAM_EVENT_CID_BAT_BIX:
|
|
status = spwr_battery_recheck_full(bat);
|
|
break;
|
|
|
|
case SAM_EVENT_CID_BAT_BST:
|
|
status = spwr_battery_recheck_status(bat);
|
|
break;
|
|
|
|
case SAM_EVENT_CID_BAT_PROT:
|
|
/*
|
|
* TODO: Implement support for battery protection status change
|
|
* event.
|
|
*/
|
|
status = 0;
|
|
break;
|
|
|
|
case SAM_EVENT_CID_BAT_DPTF:
|
|
/*
|
|
* TODO: Implement support for DPTF event.
|
|
*/
|
|
status = 0;
|
|
break;
|
|
|
|
default:
|
|
return 0;
|
|
}
|
|
|
|
return ssam_notifier_from_errno(status) | SSAM_NOTIF_HANDLED;
|
|
}
|
|
|
|
static void spwr_battery_update_bst_workfn(struct work_struct *work)
|
|
{
|
|
struct delayed_work *dwork = to_delayed_work(work);
|
|
struct spwr_battery_device *bat;
|
|
int status;
|
|
|
|
bat = container_of(dwork, struct spwr_battery_device, update_work);
|
|
|
|
status = spwr_battery_update_bst(bat, false);
|
|
if (status) {
|
|
dev_err(&bat->sdev->dev, "failed to update battery state: %d\n", status);
|
|
return;
|
|
}
|
|
|
|
power_supply_changed(bat->psy);
|
|
}
|
|
|
|
static void spwr_external_power_changed(struct power_supply *psy)
|
|
{
|
|
struct spwr_battery_device *bat = power_supply_get_drvdata(psy);
|
|
|
|
/*
|
|
* Handle battery update quirk: When the battery is fully charged (or
|
|
* charged up to the limit imposed by the UEFI battery limit) and the
|
|
* adapter is plugged in or removed, the EC does not send a separate
|
|
* event for the state (charging/discharging) change. Furthermore it
|
|
* may take some time until the state is updated on the battery.
|
|
* Schedule an update to solve this.
|
|
*/
|
|
|
|
schedule_delayed_work(&bat->update_work, SPWR_AC_BAT_UPDATE_DELAY);
|
|
}
|
|
|
|
|
|
/* -- Properties. ----------------------------------------------------------- */
|
|
|
|
static const enum power_supply_property spwr_battery_props_chg[] = {
|
|
POWER_SUPPLY_PROP_STATUS,
|
|
POWER_SUPPLY_PROP_PRESENT,
|
|
POWER_SUPPLY_PROP_TECHNOLOGY,
|
|
POWER_SUPPLY_PROP_CYCLE_COUNT,
|
|
POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
|
|
POWER_SUPPLY_PROP_VOLTAGE_NOW,
|
|
POWER_SUPPLY_PROP_CURRENT_NOW,
|
|
POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
|
|
POWER_SUPPLY_PROP_CHARGE_FULL,
|
|
POWER_SUPPLY_PROP_CHARGE_NOW,
|
|
POWER_SUPPLY_PROP_CAPACITY,
|
|
POWER_SUPPLY_PROP_CAPACITY_LEVEL,
|
|
POWER_SUPPLY_PROP_MODEL_NAME,
|
|
POWER_SUPPLY_PROP_MANUFACTURER,
|
|
POWER_SUPPLY_PROP_SERIAL_NUMBER,
|
|
};
|
|
|
|
static const enum power_supply_property spwr_battery_props_eng[] = {
|
|
POWER_SUPPLY_PROP_STATUS,
|
|
POWER_SUPPLY_PROP_PRESENT,
|
|
POWER_SUPPLY_PROP_TECHNOLOGY,
|
|
POWER_SUPPLY_PROP_CYCLE_COUNT,
|
|
POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
|
|
POWER_SUPPLY_PROP_VOLTAGE_NOW,
|
|
POWER_SUPPLY_PROP_POWER_NOW,
|
|
POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN,
|
|
POWER_SUPPLY_PROP_ENERGY_FULL,
|
|
POWER_SUPPLY_PROP_ENERGY_NOW,
|
|
POWER_SUPPLY_PROP_CAPACITY,
|
|
POWER_SUPPLY_PROP_CAPACITY_LEVEL,
|
|
POWER_SUPPLY_PROP_MODEL_NAME,
|
|
POWER_SUPPLY_PROP_MANUFACTURER,
|
|
POWER_SUPPLY_PROP_SERIAL_NUMBER,
|
|
};
|
|
|
|
static int spwr_battery_prop_status(struct spwr_battery_device *bat)
|
|
{
|
|
u32 state = get_unaligned_le32(&bat->bst.state);
|
|
u32 present_rate = get_unaligned_le32(&bat->bst.present_rate);
|
|
|
|
lockdep_assert_held(&bat->lock);
|
|
|
|
if (state & SAM_BATTERY_STATE_DISCHARGING)
|
|
return POWER_SUPPLY_STATUS_DISCHARGING;
|
|
|
|
if (state & SAM_BATTERY_STATE_CHARGING)
|
|
return POWER_SUPPLY_STATUS_CHARGING;
|
|
|
|
if (spwr_battery_is_full(bat))
|
|
return POWER_SUPPLY_STATUS_FULL;
|
|
|
|
if (present_rate == 0)
|
|
return POWER_SUPPLY_STATUS_NOT_CHARGING;
|
|
|
|
return POWER_SUPPLY_STATUS_UNKNOWN;
|
|
}
|
|
|
|
static int spwr_battery_prop_technology(struct spwr_battery_device *bat)
|
|
{
|
|
lockdep_assert_held(&bat->lock);
|
|
|
|
if (!strcasecmp("NiCd", bat->bix.type))
|
|
return POWER_SUPPLY_TECHNOLOGY_NiCd;
|
|
|
|
if (!strcasecmp("NiMH", bat->bix.type))
|
|
return POWER_SUPPLY_TECHNOLOGY_NiMH;
|
|
|
|
if (!strcasecmp("LION", bat->bix.type))
|
|
return POWER_SUPPLY_TECHNOLOGY_LION;
|
|
|
|
if (!strncasecmp("LI-ION", bat->bix.type, 6))
|
|
return POWER_SUPPLY_TECHNOLOGY_LION;
|
|
|
|
if (!strcasecmp("LiP", bat->bix.type))
|
|
return POWER_SUPPLY_TECHNOLOGY_LIPO;
|
|
|
|
return POWER_SUPPLY_TECHNOLOGY_UNKNOWN;
|
|
}
|
|
|
|
static int spwr_battery_prop_capacity(struct spwr_battery_device *bat)
|
|
{
|
|
u32 full_cap = sprw_battery_get_full_cap_safe(bat);
|
|
u32 remaining_cap = get_unaligned_le32(&bat->bst.remaining_cap);
|
|
|
|
lockdep_assert_held(&bat->lock);
|
|
|
|
if (full_cap == 0 || full_cap == SPWR_BATTERY_VALUE_UNKNOWN)
|
|
return -ENODATA;
|
|
|
|
if (remaining_cap == SPWR_BATTERY_VALUE_UNKNOWN)
|
|
return -ENODATA;
|
|
|
|
return remaining_cap * 100 / full_cap;
|
|
}
|
|
|
|
static int spwr_battery_prop_capacity_level(struct spwr_battery_device *bat)
|
|
{
|
|
u32 state = get_unaligned_le32(&bat->bst.state);
|
|
u32 remaining_cap = get_unaligned_le32(&bat->bst.remaining_cap);
|
|
|
|
lockdep_assert_held(&bat->lock);
|
|
|
|
if (state & SAM_BATTERY_STATE_CRITICAL)
|
|
return POWER_SUPPLY_CAPACITY_LEVEL_CRITICAL;
|
|
|
|
if (spwr_battery_is_full(bat))
|
|
return POWER_SUPPLY_CAPACITY_LEVEL_FULL;
|
|
|
|
if (remaining_cap <= bat->alarm)
|
|
return POWER_SUPPLY_CAPACITY_LEVEL_LOW;
|
|
|
|
return POWER_SUPPLY_CAPACITY_LEVEL_NORMAL;
|
|
}
|
|
|
|
static int spwr_battery_get_property(struct power_supply *psy, enum power_supply_property psp,
|
|
union power_supply_propval *val)
|
|
{
|
|
struct spwr_battery_device *bat = power_supply_get_drvdata(psy);
|
|
u32 value;
|
|
int status;
|
|
|
|
mutex_lock(&bat->lock);
|
|
|
|
status = spwr_battery_update_bst_unlocked(bat, true);
|
|
if (status)
|
|
goto out;
|
|
|
|
/* Abort if battery is not present. */
|
|
if (!spwr_battery_present(bat) && psp != POWER_SUPPLY_PROP_PRESENT) {
|
|
status = -ENODEV;
|
|
goto out;
|
|
}
|
|
|
|
switch (psp) {
|
|
case POWER_SUPPLY_PROP_STATUS:
|
|
val->intval = spwr_battery_prop_status(bat);
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_PRESENT:
|
|
val->intval = spwr_battery_present(bat);
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_TECHNOLOGY:
|
|
val->intval = spwr_battery_prop_technology(bat);
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_CYCLE_COUNT:
|
|
value = get_unaligned_le32(&bat->bix.cycle_count);
|
|
if (value != SPWR_BATTERY_VALUE_UNKNOWN)
|
|
val->intval = value;
|
|
else
|
|
status = -ENODATA;
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
|
|
value = get_unaligned_le32(&bat->bix.design_voltage);
|
|
if (value != SPWR_BATTERY_VALUE_UNKNOWN)
|
|
val->intval = value * 1000;
|
|
else
|
|
status = -ENODATA;
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_VOLTAGE_NOW:
|
|
value = get_unaligned_le32(&bat->bst.present_voltage);
|
|
if (value != SPWR_BATTERY_VALUE_UNKNOWN)
|
|
val->intval = value * 1000;
|
|
else
|
|
status = -ENODATA;
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_CURRENT_NOW:
|
|
case POWER_SUPPLY_PROP_POWER_NOW:
|
|
value = get_unaligned_le32(&bat->bst.present_rate);
|
|
if (value != SPWR_BATTERY_VALUE_UNKNOWN)
|
|
val->intval = value * 1000;
|
|
else
|
|
status = -ENODATA;
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
|
|
case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN:
|
|
value = get_unaligned_le32(&bat->bix.design_cap);
|
|
if (value != SPWR_BATTERY_VALUE_UNKNOWN)
|
|
val->intval = value * 1000;
|
|
else
|
|
status = -ENODATA;
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_CHARGE_FULL:
|
|
case POWER_SUPPLY_PROP_ENERGY_FULL:
|
|
value = get_unaligned_le32(&bat->bix.last_full_charge_cap);
|
|
if (value != SPWR_BATTERY_VALUE_UNKNOWN)
|
|
val->intval = value * 1000;
|
|
else
|
|
status = -ENODATA;
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_CHARGE_NOW:
|
|
case POWER_SUPPLY_PROP_ENERGY_NOW:
|
|
value = get_unaligned_le32(&bat->bst.remaining_cap);
|
|
if (value != SPWR_BATTERY_VALUE_UNKNOWN)
|
|
val->intval = value * 1000;
|
|
else
|
|
status = -ENODATA;
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_CAPACITY:
|
|
val->intval = spwr_battery_prop_capacity(bat);
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_CAPACITY_LEVEL:
|
|
val->intval = spwr_battery_prop_capacity_level(bat);
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_MODEL_NAME:
|
|
val->strval = bat->bix.model;
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_MANUFACTURER:
|
|
val->strval = bat->bix.oem_info;
|
|
break;
|
|
|
|
case POWER_SUPPLY_PROP_SERIAL_NUMBER:
|
|
val->strval = bat->bix.serial;
|
|
break;
|
|
|
|
default:
|
|
status = -EINVAL;
|
|
break;
|
|
}
|
|
|
|
out:
|
|
mutex_unlock(&bat->lock);
|
|
return status;
|
|
}
|
|
|
|
|
|
/* -- Alarm attribute. ------------------------------------------------------ */
|
|
|
|
static ssize_t alarm_show(struct device *dev, struct device_attribute *attr, char *buf)
|
|
{
|
|
struct power_supply *psy = dev_get_drvdata(dev);
|
|
struct spwr_battery_device *bat = power_supply_get_drvdata(psy);
|
|
int status;
|
|
|
|
mutex_lock(&bat->lock);
|
|
status = sysfs_emit(buf, "%d\n", bat->alarm * 1000);
|
|
mutex_unlock(&bat->lock);
|
|
|
|
return status;
|
|
}
|
|
|
|
static ssize_t alarm_store(struct device *dev, struct device_attribute *attr, const char *buf,
|
|
size_t count)
|
|
{
|
|
struct power_supply *psy = dev_get_drvdata(dev);
|
|
struct spwr_battery_device *bat = power_supply_get_drvdata(psy);
|
|
unsigned long value;
|
|
int status;
|
|
|
|
status = kstrtoul(buf, 0, &value);
|
|
if (status)
|
|
return status;
|
|
|
|
mutex_lock(&bat->lock);
|
|
|
|
if (!spwr_battery_present(bat)) {
|
|
mutex_unlock(&bat->lock);
|
|
return -ENODEV;
|
|
}
|
|
|
|
status = spwr_battery_set_alarm_unlocked(bat, value / 1000);
|
|
if (status) {
|
|
mutex_unlock(&bat->lock);
|
|
return status;
|
|
}
|
|
|
|
mutex_unlock(&bat->lock);
|
|
return count;
|
|
}
|
|
|
|
static DEVICE_ATTR_RW(alarm);
|
|
|
|
static struct attribute *spwr_battery_attrs[] = {
|
|
&dev_attr_alarm.attr,
|
|
NULL,
|
|
};
|
|
ATTRIBUTE_GROUPS(spwr_battery);
|
|
|
|
|
|
/* -- Device setup. --------------------------------------------------------- */
|
|
|
|
static void spwr_battery_init(struct spwr_battery_device *bat, struct ssam_device *sdev,
|
|
struct ssam_event_registry registry, const char *name)
|
|
{
|
|
mutex_init(&bat->lock);
|
|
strscpy(bat->name, name, sizeof(bat->name));
|
|
|
|
bat->sdev = sdev;
|
|
|
|
bat->notif.base.priority = 1;
|
|
bat->notif.base.fn = spwr_notify_bat;
|
|
bat->notif.event.reg = registry;
|
|
bat->notif.event.id.target_category = sdev->uid.category;
|
|
bat->notif.event.id.instance = 0; /* need to register with instance 0 */
|
|
bat->notif.event.mask = SSAM_EVENT_MASK_TARGET;
|
|
bat->notif.event.flags = SSAM_EVENT_SEQUENCED;
|
|
|
|
bat->psy_desc.name = bat->name;
|
|
bat->psy_desc.type = POWER_SUPPLY_TYPE_BATTERY;
|
|
bat->psy_desc.get_property = spwr_battery_get_property;
|
|
|
|
INIT_DELAYED_WORK(&bat->update_work, spwr_battery_update_bst_workfn);
|
|
}
|
|
|
|
static int spwr_battery_register(struct spwr_battery_device *bat)
|
|
{
|
|
struct power_supply_config psy_cfg = {};
|
|
__le32 sta;
|
|
int status;
|
|
|
|
/* Make sure the device is there and functioning properly. */
|
|
status = ssam_retry(ssam_bat_get_sta, bat->sdev, &sta);
|
|
if (status)
|
|
return status;
|
|
|
|
if ((le32_to_cpu(sta) & SAM_BATTERY_STA_OK) != SAM_BATTERY_STA_OK)
|
|
return -ENODEV;
|
|
|
|
/* Satisfy lockdep although we are in an exclusive context here. */
|
|
mutex_lock(&bat->lock);
|
|
|
|
status = spwr_battery_update_bix_unlocked(bat);
|
|
if (status) {
|
|
mutex_unlock(&bat->lock);
|
|
return status;
|
|
}
|
|
|
|
if (spwr_battery_present(bat)) {
|
|
u32 cap_warn = get_unaligned_le32(&bat->bix.design_cap_warn);
|
|
|
|
status = spwr_battery_set_alarm_unlocked(bat, cap_warn);
|
|
if (status) {
|
|
mutex_unlock(&bat->lock);
|
|
return status;
|
|
}
|
|
}
|
|
|
|
mutex_unlock(&bat->lock);
|
|
|
|
bat->psy_desc.external_power_changed = spwr_external_power_changed;
|
|
|
|
switch (get_unaligned_le32(&bat->bix.power_unit)) {
|
|
case SAM_BATTERY_POWER_UNIT_mW:
|
|
bat->psy_desc.properties = spwr_battery_props_eng;
|
|
bat->psy_desc.num_properties = ARRAY_SIZE(spwr_battery_props_eng);
|
|
break;
|
|
|
|
case SAM_BATTERY_POWER_UNIT_mA:
|
|
bat->psy_desc.properties = spwr_battery_props_chg;
|
|
bat->psy_desc.num_properties = ARRAY_SIZE(spwr_battery_props_chg);
|
|
break;
|
|
|
|
default:
|
|
dev_err(&bat->sdev->dev, "unsupported battery power unit: %u\n",
|
|
get_unaligned_le32(&bat->bix.power_unit));
|
|
return -EINVAL;
|
|
}
|
|
|
|
psy_cfg.drv_data = bat;
|
|
psy_cfg.attr_grp = spwr_battery_groups;
|
|
|
|
bat->psy = devm_power_supply_register(&bat->sdev->dev, &bat->psy_desc, &psy_cfg);
|
|
if (IS_ERR(bat->psy))
|
|
return PTR_ERR(bat->psy);
|
|
|
|
return ssam_device_notifier_register(bat->sdev, &bat->notif);
|
|
}
|
|
|
|
|
|
/* -- Driver setup. --------------------------------------------------------- */
|
|
|
|
static int __maybe_unused surface_battery_resume(struct device *dev)
|
|
{
|
|
return spwr_battery_recheck_full(dev_get_drvdata(dev));
|
|
}
|
|
static SIMPLE_DEV_PM_OPS(surface_battery_pm_ops, NULL, surface_battery_resume);
|
|
|
|
static int surface_battery_probe(struct ssam_device *sdev)
|
|
{
|
|
const struct spwr_psy_properties *p;
|
|
struct spwr_battery_device *bat;
|
|
|
|
p = ssam_device_get_match_data(sdev);
|
|
if (!p)
|
|
return -ENODEV;
|
|
|
|
bat = devm_kzalloc(&sdev->dev, sizeof(*bat), GFP_KERNEL);
|
|
if (!bat)
|
|
return -ENOMEM;
|
|
|
|
spwr_battery_init(bat, sdev, p->registry, p->name);
|
|
ssam_device_set_drvdata(sdev, bat);
|
|
|
|
return spwr_battery_register(bat);
|
|
}
|
|
|
|
static void surface_battery_remove(struct ssam_device *sdev)
|
|
{
|
|
struct spwr_battery_device *bat = ssam_device_get_drvdata(sdev);
|
|
|
|
ssam_device_notifier_unregister(sdev, &bat->notif);
|
|
cancel_delayed_work_sync(&bat->update_work);
|
|
}
|
|
|
|
static const struct spwr_psy_properties spwr_psy_props_bat1 = {
|
|
.name = "BAT1",
|
|
.registry = SSAM_EVENT_REGISTRY_SAM,
|
|
};
|
|
|
|
static const struct spwr_psy_properties spwr_psy_props_bat2_sb3 = {
|
|
.name = "BAT2",
|
|
.registry = SSAM_EVENT_REGISTRY_KIP,
|
|
};
|
|
|
|
static const struct ssam_device_id surface_battery_match[] = {
|
|
{ SSAM_SDEV(BAT, SAM, 0x01, 0x00), (unsigned long)&spwr_psy_props_bat1 },
|
|
{ SSAM_SDEV(BAT, KIP, 0x01, 0x00), (unsigned long)&spwr_psy_props_bat2_sb3 },
|
|
{ },
|
|
};
|
|
MODULE_DEVICE_TABLE(ssam, surface_battery_match);
|
|
|
|
static struct ssam_device_driver surface_battery_driver = {
|
|
.probe = surface_battery_probe,
|
|
.remove = surface_battery_remove,
|
|
.match_table = surface_battery_match,
|
|
.driver = {
|
|
.name = "surface_battery",
|
|
.pm = &surface_battery_pm_ops,
|
|
.probe_type = PROBE_PREFER_ASYNCHRONOUS,
|
|
},
|
|
};
|
|
module_ssam_device_driver(surface_battery_driver);
|
|
|
|
MODULE_AUTHOR("Maximilian Luz <luzmaximilian@gmail.com>");
|
|
MODULE_DESCRIPTION("Battery driver for Surface System Aggregator Module");
|
|
MODULE_LICENSE("GPL");
|