/* * nvec_power: power supply driver for a NVIDIA compliant embedded controller * * Copyright (C) 2011 The AC100 Kernel Team <ac100@lists.launchpad.net> * * Authors: Ilya Petrov <ilya.muromec@gmail.com> * Marc Dietrich <marvin24@gmx.de> * * This file is subject to the terms and conditions of the GNU General Public * License. See the file "COPYING" in the main directory of this archive * for more details. * */ #include <linux/module.h> #include <linux/platform_device.h> #include <linux/err.h> #include <linux/power_supply.h> #include <linux/slab.h> #include <linux/workqueue.h> #include <linux/delay.h> #include "nvec.h" #define GET_SYSTEM_STATUS 0x00 struct nvec_power { struct notifier_block notifier; struct delayed_work poller; struct nvec_chip *nvec; int on; int bat_present; int bat_status; int bat_voltage_now; int bat_current_now; int bat_current_avg; int time_remain; int charge_full_design; int charge_last_full; int critical_capacity; int capacity_remain; int bat_temperature; int bat_cap; int bat_type_enum; char bat_manu[30]; char bat_model[30]; char bat_type[30]; }; enum { SLOT_STATUS, VOLTAGE, TIME_REMAINING, CURRENT, AVERAGE_CURRENT, AVERAGING_TIME_INTERVAL, CAPACITY_REMAINING, LAST_FULL_CHARGE_CAPACITY, DESIGN_CAPACITY, CRITICAL_CAPACITY, TEMPERATURE, MANUFACTURER, MODEL, TYPE, }; enum { AC, BAT, }; struct bat_response { u8 event_type; u8 length; u8 sub_type; u8 status; /* payload */ union { char plc[30]; u16 plu; s16 pls; }; }; static struct power_supply *nvec_bat_psy; static struct power_supply *nvec_psy; static int nvec_power_notifier(struct notifier_block *nb, unsigned long event_type, void *data) { struct nvec_power *power = container_of(nb, struct nvec_power, notifier); struct bat_response *res = (struct bat_response *)data; if (event_type != NVEC_SYS) return NOTIFY_DONE; if (res->sub_type == 0) { if (power->on != res->plu) { power->on = res->plu; power_supply_changed(nvec_psy); } return NOTIFY_STOP; } return NOTIFY_OK; } static const int bat_init[] = { LAST_FULL_CHARGE_CAPACITY, DESIGN_CAPACITY, CRITICAL_CAPACITY, MANUFACTURER, MODEL, TYPE, }; static void get_bat_mfg_data(struct nvec_power *power) { int i; char buf[] = { NVEC_BAT, SLOT_STATUS }; for (i = 0; i < ARRAY_SIZE(bat_init); i++) { buf[1] = bat_init[i]; nvec_write_async(power->nvec, buf, 2); } } static int nvec_power_bat_notifier(struct notifier_block *nb, unsigned long event_type, void *data) { struct nvec_power *power = container_of(nb, struct nvec_power, notifier); struct bat_response *res = (struct bat_response *)data; int status_changed = 0; if (event_type != NVEC_BAT) return NOTIFY_DONE; switch (res->sub_type) { case SLOT_STATUS: if (res->plc[0] & 1) { if (power->bat_present == 0) { status_changed = 1; get_bat_mfg_data(power); } power->bat_present = 1; switch ((res->plc[0] >> 1) & 3) { case 0: power->bat_status = POWER_SUPPLY_STATUS_NOT_CHARGING; break; case 1: power->bat_status = POWER_SUPPLY_STATUS_CHARGING; break; case 2: power->bat_status = POWER_SUPPLY_STATUS_DISCHARGING; break; default: power->bat_status = POWER_SUPPLY_STATUS_UNKNOWN; } } else { if (power->bat_present == 1) status_changed = 1; power->bat_present = 0; power->bat_status = POWER_SUPPLY_STATUS_UNKNOWN; } power->bat_cap = res->plc[1]; if (status_changed) power_supply_changed(nvec_bat_psy); break; case VOLTAGE: power->bat_voltage_now = res->plu * 1000; break; case TIME_REMAINING: power->time_remain = res->plu * 3600; break; case CURRENT: power->bat_current_now = res->pls * 1000; break; case AVERAGE_CURRENT: power->bat_current_avg = res->pls * 1000; break; case CAPACITY_REMAINING: power->capacity_remain = res->plu * 1000; break; case LAST_FULL_CHARGE_CAPACITY: power->charge_last_full = res->plu * 1000; break; case DESIGN_CAPACITY: power->charge_full_design = res->plu * 1000; break; case CRITICAL_CAPACITY: power->critical_capacity = res->plu * 1000; break; case TEMPERATURE: power->bat_temperature = res->plu - 2732; break; case MANUFACTURER: memcpy(power->bat_manu, &res->plc, res->length - 2); power->bat_model[res->length - 2] = '\0'; break; case MODEL: memcpy(power->bat_model, &res->plc, res->length - 2); power->bat_model[res->length - 2] = '\0'; break; case TYPE: memcpy(power->bat_type, &res->plc, res->length - 2); power->bat_type[res->length - 2] = '\0'; /* this differs a little from the spec fill in more if you find some */ if (!strncmp(power->bat_type, "Li", 30)) power->bat_type_enum = POWER_SUPPLY_TECHNOLOGY_LION; else power->bat_type_enum = POWER_SUPPLY_TECHNOLOGY_UNKNOWN; break; default: return NOTIFY_STOP; } return NOTIFY_STOP; } static int nvec_power_get_property(struct power_supply *psy, enum power_supply_property psp, union power_supply_propval *val) { struct nvec_power *power = dev_get_drvdata(psy->dev.parent); switch (psp) { case POWER_SUPPLY_PROP_ONLINE: val->intval = power->on; break; default: return -EINVAL; } return 0; } static int nvec_battery_get_property(struct power_supply *psy, enum power_supply_property psp, union power_supply_propval *val) { struct nvec_power *power = dev_get_drvdata(psy->dev.parent); switch (psp) { case POWER_SUPPLY_PROP_STATUS: val->intval = power->bat_status; break; case POWER_SUPPLY_PROP_CAPACITY: val->intval = power->bat_cap; break; case POWER_SUPPLY_PROP_PRESENT: val->intval = power->bat_present; break; case POWER_SUPPLY_PROP_VOLTAGE_NOW: val->intval = power->bat_voltage_now; break; case POWER_SUPPLY_PROP_CURRENT_NOW: val->intval = power->bat_current_now; break; case POWER_SUPPLY_PROP_CURRENT_AVG: val->intval = power->bat_current_avg; break; case POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW: val->intval = power->time_remain; break; case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN: val->intval = power->charge_full_design; break; case POWER_SUPPLY_PROP_CHARGE_FULL: val->intval = power->charge_last_full; break; case POWER_SUPPLY_PROP_CHARGE_EMPTY: val->intval = power->critical_capacity; break; case POWER_SUPPLY_PROP_CHARGE_NOW: val->intval = power->capacity_remain; break; case POWER_SUPPLY_PROP_TEMP: val->intval = power->bat_temperature; break; case POWER_SUPPLY_PROP_MANUFACTURER: val->strval = power->bat_manu; break; case POWER_SUPPLY_PROP_MODEL_NAME: val->strval = power->bat_model; break; case POWER_SUPPLY_PROP_TECHNOLOGY: val->intval = power->bat_type_enum; break; default: return -EINVAL; } return 0; } static enum power_supply_property nvec_power_props[] = { POWER_SUPPLY_PROP_ONLINE, }; static enum power_supply_property nvec_battery_props[] = { POWER_SUPPLY_PROP_STATUS, POWER_SUPPLY_PROP_PRESENT, POWER_SUPPLY_PROP_CAPACITY, POWER_SUPPLY_PROP_VOLTAGE_NOW, POWER_SUPPLY_PROP_CURRENT_NOW, #ifdef EC_FULL_DIAG POWER_SUPPLY_PROP_CURRENT_AVG, POWER_SUPPLY_PROP_TEMP, POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW, #endif POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN, POWER_SUPPLY_PROP_CHARGE_FULL, POWER_SUPPLY_PROP_CHARGE_EMPTY, POWER_SUPPLY_PROP_CHARGE_NOW, POWER_SUPPLY_PROP_MANUFACTURER, POWER_SUPPLY_PROP_MODEL_NAME, POWER_SUPPLY_PROP_TECHNOLOGY, }; static char *nvec_power_supplied_to[] = { "battery", }; static const struct power_supply_desc nvec_bat_psy_desc = { .name = "battery", .type = POWER_SUPPLY_TYPE_BATTERY, .properties = nvec_battery_props, .num_properties = ARRAY_SIZE(nvec_battery_props), .get_property = nvec_battery_get_property, }; static const struct power_supply_desc nvec_psy_desc = { .name = "ac", .type = POWER_SUPPLY_TYPE_MAINS, .properties = nvec_power_props, .num_properties = ARRAY_SIZE(nvec_power_props), .get_property = nvec_power_get_property, }; static int counter; static int const bat_iter[] = { SLOT_STATUS, VOLTAGE, CURRENT, CAPACITY_REMAINING, #ifdef EC_FULL_DIAG AVERAGE_CURRENT, TEMPERATURE, TIME_REMAINING, #endif }; static void nvec_power_poll(struct work_struct *work) { char buf[] = { NVEC_SYS, GET_SYSTEM_STATUS }; struct nvec_power *power = container_of(work, struct nvec_power, poller.work); if (counter >= ARRAY_SIZE(bat_iter)) counter = 0; /* AC status via sys req */ nvec_write_async(power->nvec, buf, 2); msleep(100); /* select a battery request function via round robin doing it all at once seems to overload the power supply */ buf[0] = NVEC_BAT; buf[1] = bat_iter[counter++]; nvec_write_async(power->nvec, buf, 2); schedule_delayed_work(to_delayed_work(work), msecs_to_jiffies(5000)); }; static int nvec_power_probe(struct platform_device *pdev) { struct power_supply **psy; const struct power_supply_desc *psy_desc; struct nvec_power *power; struct nvec_chip *nvec = dev_get_drvdata(pdev->dev.parent); struct power_supply_config psy_cfg = {}; power = devm_kzalloc(&pdev->dev, sizeof(struct nvec_power), GFP_NOWAIT); if (!power) return -ENOMEM; dev_set_drvdata(&pdev->dev, power); power->nvec = nvec; switch (pdev->id) { case AC: psy = &nvec_psy; psy_desc = &nvec_psy_desc; psy_cfg.supplied_to = nvec_power_supplied_to; psy_cfg.num_supplicants = ARRAY_SIZE(nvec_power_supplied_to); power->notifier.notifier_call = nvec_power_notifier; INIT_DELAYED_WORK(&power->poller, nvec_power_poll); schedule_delayed_work(&power->poller, msecs_to_jiffies(5000)); break; case BAT: psy = &nvec_bat_psy; psy_desc = &nvec_bat_psy_desc; power->notifier.notifier_call = nvec_power_bat_notifier; break; default: return -ENODEV; } nvec_register_notifier(nvec, &power->notifier, NVEC_SYS); if (pdev->id == BAT) get_bat_mfg_data(power); *psy = power_supply_register(&pdev->dev, psy_desc, &psy_cfg); return PTR_ERR_OR_ZERO(*psy); } static int nvec_power_remove(struct platform_device *pdev) { struct nvec_power *power = platform_get_drvdata(pdev); cancel_delayed_work_sync(&power->poller); nvec_unregister_notifier(power->nvec, &power->notifier); switch (pdev->id) { case AC: power_supply_unregister(nvec_psy); break; case BAT: power_supply_unregister(nvec_bat_psy); } return 0; } static struct platform_driver nvec_power_driver = { .probe = nvec_power_probe, .remove = nvec_power_remove, .driver = { .name = "nvec-power", } }; module_platform_driver(nvec_power_driver); MODULE_AUTHOR("Ilya Petrov <ilya.muromec@gmail.com>"); MODULE_LICENSE("GPL"); MODULE_DESCRIPTION("NVEC battery and AC driver"); MODULE_ALIAS("platform:nvec-power");