| // SPDX-License-Identifier: GPL-2.0-only |
| /* |
| * Copyright (C) 2011 Samsung Electronics Co., Ltd. |
| * MyungJoo Ham <myungjoo.ham@samsung.com> |
| * |
| * This driver enables to monitor battery health and control charger |
| * during suspend-to-mem. |
| * Charger manager depends on other devices. Register this later than |
| * the depending devices. |
| * |
| **/ |
| |
| #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| |
| #include <linux/io.h> |
| #include <linux/module.h> |
| #include <linux/irq.h> |
| #include <linux/interrupt.h> |
| #include <linux/rtc.h> |
| #include <linux/slab.h> |
| #include <linux/workqueue.h> |
| #include <linux/platform_device.h> |
| #include <linux/power/charger-manager.h> |
| #include <linux/regulator/consumer.h> |
| #include <linux/sysfs.h> |
| #include <linux/of.h> |
| #include <linux/thermal.h> |
| |
| static struct { |
| const char *name; |
| u64 extcon_type; |
| } extcon_mapping[] = { |
| /* Current textual representations */ |
| { "USB", EXTCON_USB }, |
| { "USB-HOST", EXTCON_USB_HOST }, |
| { "SDP", EXTCON_CHG_USB_SDP }, |
| { "DCP", EXTCON_CHG_USB_DCP }, |
| { "CDP", EXTCON_CHG_USB_CDP }, |
| { "ACA", EXTCON_CHG_USB_ACA }, |
| { "FAST-CHARGER", EXTCON_CHG_USB_FAST }, |
| { "SLOW-CHARGER", EXTCON_CHG_USB_SLOW }, |
| { "WPT", EXTCON_CHG_WPT }, |
| { "PD", EXTCON_CHG_USB_PD }, |
| { "DOCK", EXTCON_DOCK }, |
| { "JIG", EXTCON_JIG }, |
| { "MECHANICAL", EXTCON_MECHANICAL }, |
| /* Deprecated textual representations */ |
| { "TA", EXTCON_CHG_USB_SDP }, |
| { "CHARGE-DOWNSTREAM", EXTCON_CHG_USB_CDP }, |
| }; |
| |
| /* |
| * Default temperature threshold for charging. |
| * Every temperature units are in tenth of centigrade. |
| */ |
| #define CM_DEFAULT_RECHARGE_TEMP_DIFF 50 |
| #define CM_DEFAULT_CHARGE_TEMP_MAX 500 |
| |
| /* |
| * Regard CM_JIFFIES_SMALL jiffies is small enough to ignore for |
| * delayed works so that we can run delayed works with CM_JIFFIES_SMALL |
| * without any delays. |
| */ |
| #define CM_JIFFIES_SMALL (2) |
| |
| /* If y is valid (> 0) and smaller than x, do x = y */ |
| #define CM_MIN_VALID(x, y) x = (((y > 0) && ((x) > (y))) ? (y) : (x)) |
| |
| /* |
| * Regard CM_RTC_SMALL (sec) is small enough to ignore error in invoking |
| * rtc alarm. It should be 2 or larger |
| */ |
| #define CM_RTC_SMALL (2) |
| |
| static LIST_HEAD(cm_list); |
| static DEFINE_MUTEX(cm_list_mtx); |
| |
| /* About in-suspend (suspend-again) monitoring */ |
| static struct alarm *cm_timer; |
| |
| static bool cm_suspended; |
| static bool cm_timer_set; |
| static unsigned long cm_suspend_duration_ms; |
| |
| /* About normal (not suspended) monitoring */ |
| static unsigned long polling_jiffy = ULONG_MAX; /* ULONG_MAX: no polling */ |
| static unsigned long next_polling; /* Next appointed polling time */ |
| static struct workqueue_struct *cm_wq; /* init at driver add */ |
| static struct delayed_work cm_monitor_work; /* init at driver add */ |
| |
| /** |
| * is_batt_present - See if the battery presents in place. |
| * @cm: the Charger Manager representing the battery. |
| */ |
| static bool is_batt_present(struct charger_manager *cm) |
| { |
| union power_supply_propval val; |
| struct power_supply *psy; |
| bool present = false; |
| int i, ret; |
| |
| switch (cm->desc->battery_present) { |
| case CM_BATTERY_PRESENT: |
| present = true; |
| break; |
| case CM_NO_BATTERY: |
| break; |
| case CM_FUEL_GAUGE: |
| psy = power_supply_get_by_name(cm->desc->psy_fuel_gauge); |
| if (!psy) |
| break; |
| |
| ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_PRESENT, |
| &val); |
| if (ret == 0 && val.intval) |
| present = true; |
| power_supply_put(psy); |
| break; |
| case CM_CHARGER_STAT: |
| for (i = 0; cm->desc->psy_charger_stat[i]; i++) { |
| psy = power_supply_get_by_name( |
| cm->desc->psy_charger_stat[i]); |
| if (!psy) { |
| dev_err(cm->dev, "Cannot find power supply \"%s\"\n", |
| cm->desc->psy_charger_stat[i]); |
| continue; |
| } |
| |
| ret = power_supply_get_property(psy, |
| POWER_SUPPLY_PROP_PRESENT, &val); |
| power_supply_put(psy); |
| if (ret == 0 && val.intval) { |
| present = true; |
| break; |
| } |
| } |
| break; |
| } |
| |
| return present; |
| } |
| |
| /** |
| * is_ext_pwr_online - See if an external power source is attached to charge |
| * @cm: the Charger Manager representing the battery. |
| * |
| * Returns true if at least one of the chargers of the battery has an external |
| * power source attached to charge the battery regardless of whether it is |
| * actually charging or not. |
| */ |
| static bool is_ext_pwr_online(struct charger_manager *cm) |
| { |
| union power_supply_propval val; |
| struct power_supply *psy; |
| bool online = false; |
| int i, ret; |
| |
| /* If at least one of them has one, it's yes. */ |
| for (i = 0; cm->desc->psy_charger_stat[i]; i++) { |
| psy = power_supply_get_by_name(cm->desc->psy_charger_stat[i]); |
| if (!psy) { |
| dev_err(cm->dev, "Cannot find power supply \"%s\"\n", |
| cm->desc->psy_charger_stat[i]); |
| continue; |
| } |
| |
| ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_ONLINE, |
| &val); |
| power_supply_put(psy); |
| if (ret == 0 && val.intval) { |
| online = true; |
| break; |
| } |
| } |
| |
| return online; |
| } |
| |
| /** |
| * get_batt_uV - Get the voltage level of the battery |
| * @cm: the Charger Manager representing the battery. |
| * @uV: the voltage level returned. |
| * |
| * Returns 0 if there is no error. |
| * Returns a negative value on error. |
| */ |
| static int get_batt_uV(struct charger_manager *cm, int *uV) |
| { |
| union power_supply_propval val; |
| struct power_supply *fuel_gauge; |
| int ret; |
| |
| fuel_gauge = power_supply_get_by_name(cm->desc->psy_fuel_gauge); |
| if (!fuel_gauge) |
| return -ENODEV; |
| |
| ret = power_supply_get_property(fuel_gauge, |
| POWER_SUPPLY_PROP_VOLTAGE_NOW, &val); |
| power_supply_put(fuel_gauge); |
| if (ret) |
| return ret; |
| |
| *uV = val.intval; |
| return 0; |
| } |
| |
| /** |
| * is_charging - Returns true if the battery is being charged. |
| * @cm: the Charger Manager representing the battery. |
| */ |
| static bool is_charging(struct charger_manager *cm) |
| { |
| int i, ret; |
| bool charging = false; |
| struct power_supply *psy; |
| union power_supply_propval val; |
| |
| /* If there is no battery, it cannot be charged */ |
| if (!is_batt_present(cm)) |
| return false; |
| |
| /* If at least one of the charger is charging, return yes */ |
| for (i = 0; cm->desc->psy_charger_stat[i]; i++) { |
| /* 1. The charger sholuld not be DISABLED */ |
| if (cm->emergency_stop) |
| continue; |
| if (!cm->charger_enabled) |
| continue; |
| |
| psy = power_supply_get_by_name(cm->desc->psy_charger_stat[i]); |
| if (!psy) { |
| dev_err(cm->dev, "Cannot find power supply \"%s\"\n", |
| cm->desc->psy_charger_stat[i]); |
| continue; |
| } |
| |
| /* 2. The charger should be online (ext-power) */ |
| ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_ONLINE, |
| &val); |
| if (ret) { |
| dev_warn(cm->dev, "Cannot read ONLINE value from %s\n", |
| cm->desc->psy_charger_stat[i]); |
| power_supply_put(psy); |
| continue; |
| } |
| if (val.intval == 0) { |
| power_supply_put(psy); |
| continue; |
| } |
| |
| /* |
| * 3. The charger should not be FULL, DISCHARGING, |
| * or NOT_CHARGING. |
| */ |
| ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_STATUS, |
| &val); |
| power_supply_put(psy); |
| if (ret) { |
| dev_warn(cm->dev, "Cannot read STATUS value from %s\n", |
| cm->desc->psy_charger_stat[i]); |
| continue; |
| } |
| if (val.intval == POWER_SUPPLY_STATUS_FULL || |
| val.intval == POWER_SUPPLY_STATUS_DISCHARGING || |
| val.intval == POWER_SUPPLY_STATUS_NOT_CHARGING) |
| continue; |
| |
| /* Then, this is charging. */ |
| charging = true; |
| break; |
| } |
| |
| return charging; |
| } |
| |
| /** |
| * is_full_charged - Returns true if the battery is fully charged. |
| * @cm: the Charger Manager representing the battery. |
| */ |
| static bool is_full_charged(struct charger_manager *cm) |
| { |
| struct charger_desc *desc = cm->desc; |
| union power_supply_propval val; |
| struct power_supply *fuel_gauge; |
| bool is_full = false; |
| int ret = 0; |
| int uV; |
| |
| /* If there is no battery, it cannot be charged */ |
| if (!is_batt_present(cm)) |
| return false; |
| |
| fuel_gauge = power_supply_get_by_name(cm->desc->psy_fuel_gauge); |
| if (!fuel_gauge) |
| return false; |
| |
| /* Full, if it's over the fullbatt voltage */ |
| if (desc->fullbatt_uV > 0) { |
| ret = get_batt_uV(cm, &uV); |
| if (!ret) { |
| /* Battery is already full, checks voltage drop. */ |
| if (cm->battery_status == POWER_SUPPLY_STATUS_FULL |
| && desc->fullbatt_vchkdrop_uV) |
| uV += desc->fullbatt_vchkdrop_uV; |
| if (uV >= desc->fullbatt_uV) |
| return true; |
| } |
| } |
| |
| if (desc->fullbatt_full_capacity > 0) { |
| val.intval = 0; |
| |
| /* Not full if capacity of fuel gauge isn't full */ |
| ret = power_supply_get_property(fuel_gauge, |
| POWER_SUPPLY_PROP_CHARGE_FULL, &val); |
| if (!ret && val.intval > desc->fullbatt_full_capacity) { |
| is_full = true; |
| goto out; |
| } |
| } |
| |
| /* Full, if the capacity is more than fullbatt_soc */ |
| if (desc->fullbatt_soc > 0) { |
| val.intval = 0; |
| |
| ret = power_supply_get_property(fuel_gauge, |
| POWER_SUPPLY_PROP_CAPACITY, &val); |
| if (!ret && val.intval >= desc->fullbatt_soc) { |
| is_full = true; |
| goto out; |
| } |
| } |
| |
| out: |
| power_supply_put(fuel_gauge); |
| return is_full; |
| } |
| |
| /** |
| * is_polling_required - Return true if need to continue polling for this CM. |
| * @cm: the Charger Manager representing the battery. |
| */ |
| static bool is_polling_required(struct charger_manager *cm) |
| { |
| switch (cm->desc->polling_mode) { |
| case CM_POLL_DISABLE: |
| return false; |
| case CM_POLL_ALWAYS: |
| return true; |
| case CM_POLL_EXTERNAL_POWER_ONLY: |
| return is_ext_pwr_online(cm); |
| case CM_POLL_CHARGING_ONLY: |
| return is_charging(cm); |
| default: |
| dev_warn(cm->dev, "Incorrect polling_mode (%d)\n", |
| cm->desc->polling_mode); |
| } |
| |
| return false; |
| } |
| |
| /** |
| * try_charger_enable - Enable/Disable chargers altogether |
| * @cm: the Charger Manager representing the battery. |
| * @enable: true: enable / false: disable |
| * |
| * Note that Charger Manager keeps the charger enabled regardless whether |
| * the charger is charging or not (because battery is full or no external |
| * power source exists) except when CM needs to disable chargers forcibly |
| * because of emergency causes; when the battery is overheated or too cold. |
| */ |
| static int try_charger_enable(struct charger_manager *cm, bool enable) |
| { |
| int err = 0, i; |
| struct charger_desc *desc = cm->desc; |
| |
| /* Ignore if it's redundant command */ |
| if (enable == cm->charger_enabled) |
| return 0; |
| |
| if (enable) { |
| if (cm->emergency_stop) |
| return -EAGAIN; |
| |
| /* |
| * Save start time of charging to limit |
| * maximum possible charging time. |
| */ |
| cm->charging_start_time = ktime_to_ms(ktime_get()); |
| cm->charging_end_time = 0; |
| |
| for (i = 0 ; i < desc->num_charger_regulators ; i++) { |
| if (desc->charger_regulators[i].externally_control) |
| continue; |
| |
| err = regulator_enable(desc->charger_regulators[i].consumer); |
| if (err < 0) { |
| dev_warn(cm->dev, "Cannot enable %s regulator\n", |
| desc->charger_regulators[i].regulator_name); |
| } |
| } |
| } else { |
| /* |
| * Save end time of charging to maintain fully charged state |
| * of battery after full-batt. |
| */ |
| cm->charging_start_time = 0; |
| cm->charging_end_time = ktime_to_ms(ktime_get()); |
| |
| for (i = 0 ; i < desc->num_charger_regulators ; i++) { |
| if (desc->charger_regulators[i].externally_control) |
| continue; |
| |
| err = regulator_disable(desc->charger_regulators[i].consumer); |
| if (err < 0) { |
| dev_warn(cm->dev, "Cannot disable %s regulator\n", |
| desc->charger_regulators[i].regulator_name); |
| } |
| } |
| |
| /* |
| * Abnormal battery state - Stop charging forcibly, |
| * even if charger was enabled at the other places |
| */ |
| for (i = 0; i < desc->num_charger_regulators; i++) { |
| if (regulator_is_enabled( |
| desc->charger_regulators[i].consumer)) { |
| regulator_force_disable( |
| desc->charger_regulators[i].consumer); |
| dev_warn(cm->dev, "Disable regulator(%s) forcibly\n", |
| desc->charger_regulators[i].regulator_name); |
| } |
| } |
| } |
| |
| if (!err) |
| cm->charger_enabled = enable; |
| |
| return err; |
| } |
| |
| /** |
| * check_charging_duration - Monitor charging/discharging duration |
| * @cm: the Charger Manager representing the battery. |
| * |
| * If whole charging duration exceed 'charging_max_duration_ms', |
| * cm stop charging to prevent overcharge/overheat. If discharging |
| * duration exceed 'discharging _max_duration_ms', charger cable is |
| * attached, after full-batt, cm start charging to maintain fully |
| * charged state for battery. |
| */ |
| static int check_charging_duration(struct charger_manager *cm) |
| { |
| struct charger_desc *desc = cm->desc; |
| u64 curr = ktime_to_ms(ktime_get()); |
| u64 duration; |
| int ret = false; |
| |
| if (!desc->charging_max_duration_ms && |
| !desc->discharging_max_duration_ms) |
| return ret; |
| |
| if (cm->charger_enabled) { |
| duration = curr - cm->charging_start_time; |
| |
| if (duration > desc->charging_max_duration_ms) { |
| dev_info(cm->dev, "Charging duration exceed %ums\n", |
| desc->charging_max_duration_ms); |
| ret = true; |
| } |
| } else if (cm->battery_status == POWER_SUPPLY_STATUS_NOT_CHARGING) { |
| duration = curr - cm->charging_end_time; |
| |
| if (duration > desc->discharging_max_duration_ms) { |
| dev_info(cm->dev, "Discharging duration exceed %ums\n", |
| desc->discharging_max_duration_ms); |
| ret = true; |
| } |
| } |
| |
| return ret; |
| } |
| |
| static int cm_get_battery_temperature_by_psy(struct charger_manager *cm, |
| int *temp) |
| { |
| struct power_supply *fuel_gauge; |
| int ret; |
| |
| fuel_gauge = power_supply_get_by_name(cm->desc->psy_fuel_gauge); |
| if (!fuel_gauge) |
| return -ENODEV; |
| |
| ret = power_supply_get_property(fuel_gauge, |
| POWER_SUPPLY_PROP_TEMP, |
| (union power_supply_propval *)temp); |
| power_supply_put(fuel_gauge); |
| |
| return ret; |
| } |
| |
| static int cm_get_battery_temperature(struct charger_manager *cm, |
| int *temp) |
| { |
| int ret; |
| |
| if (!cm->desc->measure_battery_temp) |
| return -ENODEV; |
| |
| #ifdef CONFIG_THERMAL |
| if (cm->tzd_batt) { |
| ret = thermal_zone_get_temp(cm->tzd_batt, temp); |
| if (!ret) |
| /* Calibrate temperature unit */ |
| *temp /= 100; |
| } else |
| #endif |
| { |
| /* if-else continued from CONFIG_THERMAL */ |
| ret = cm_get_battery_temperature_by_psy(cm, temp); |
| } |
| |
| return ret; |
| } |
| |
| static int cm_check_thermal_status(struct charger_manager *cm) |
| { |
| struct charger_desc *desc = cm->desc; |
| int temp, upper_limit, lower_limit; |
| int ret = 0; |
| |
| ret = cm_get_battery_temperature(cm, &temp); |
| if (ret) { |
| /* FIXME: |
| * No information of battery temperature might |
| * occur hazardous result. We have to handle it |
| * depending on battery type. |
| */ |
| dev_err(cm->dev, "Failed to get battery temperature\n"); |
| return 0; |
| } |
| |
| upper_limit = desc->temp_max; |
| lower_limit = desc->temp_min; |
| |
| if (cm->emergency_stop) { |
| upper_limit -= desc->temp_diff; |
| lower_limit += desc->temp_diff; |
| } |
| |
| if (temp > upper_limit) |
| ret = CM_BATT_OVERHEAT; |
| else if (temp < lower_limit) |
| ret = CM_BATT_COLD; |
| else |
| ret = CM_BATT_OK; |
| |
| cm->emergency_stop = ret; |
| |
| return ret; |
| } |
| |
| /** |
| * cm_get_target_status - Check current status and get next target status. |
| * @cm: the Charger Manager representing the battery. |
| */ |
| static int cm_get_target_status(struct charger_manager *cm) |
| { |
| if (!is_ext_pwr_online(cm)) |
| return POWER_SUPPLY_STATUS_DISCHARGING; |
| |
| if (cm_check_thermal_status(cm)) { |
| /* Check if discharging duration exeeds limit. */ |
| if (check_charging_duration(cm)) |
| goto charging_ok; |
| return POWER_SUPPLY_STATUS_NOT_CHARGING; |
| } |
| |
| switch (cm->battery_status) { |
| case POWER_SUPPLY_STATUS_CHARGING: |
| /* Check if charging duration exeeds limit. */ |
| if (check_charging_duration(cm)) |
| return POWER_SUPPLY_STATUS_FULL; |
| fallthrough; |
| case POWER_SUPPLY_STATUS_FULL: |
| if (is_full_charged(cm)) |
| return POWER_SUPPLY_STATUS_FULL; |
| fallthrough; |
| default: |
| break; |
| } |
| |
| charging_ok: |
| /* Charging is allowed. */ |
| return POWER_SUPPLY_STATUS_CHARGING; |
| } |
| |
| /** |
| * _cm_monitor - Monitor the temperature and return true for exceptions. |
| * @cm: the Charger Manager representing the battery. |
| * |
| * Returns true if there is an event to notify for the battery. |
| * (True if the status of "emergency_stop" changes) |
| */ |
| static bool _cm_monitor(struct charger_manager *cm) |
| { |
| int target; |
| |
| target = cm_get_target_status(cm); |
| |
| try_charger_enable(cm, (target == POWER_SUPPLY_STATUS_CHARGING)); |
| |
| if (cm->battery_status != target) { |
| cm->battery_status = target; |
| power_supply_changed(cm->charger_psy); |
| } |
| |
| return (cm->battery_status == POWER_SUPPLY_STATUS_NOT_CHARGING); |
| } |
| |
| /** |
| * cm_monitor - Monitor every battery. |
| * |
| * Returns true if there is an event to notify from any of the batteries. |
| * (True if the status of "emergency_stop" changes) |
| */ |
| static bool cm_monitor(void) |
| { |
| bool stop = false; |
| struct charger_manager *cm; |
| |
| mutex_lock(&cm_list_mtx); |
| |
| list_for_each_entry(cm, &cm_list, entry) { |
| if (_cm_monitor(cm)) |
| stop = true; |
| } |
| |
| mutex_unlock(&cm_list_mtx); |
| |
| return stop; |
| } |
| |
| /** |
| * _setup_polling - Setup the next instance of polling. |
| * @work: work_struct of the function _setup_polling. |
| */ |
| static void _setup_polling(struct work_struct *work) |
| { |
| unsigned long min = ULONG_MAX; |
| struct charger_manager *cm; |
| bool keep_polling = false; |
| unsigned long _next_polling; |
| |
| mutex_lock(&cm_list_mtx); |
| |
| list_for_each_entry(cm, &cm_list, entry) { |
| if (is_polling_required(cm) && cm->desc->polling_interval_ms) { |
| keep_polling = true; |
| |
| if (min > cm->desc->polling_interval_ms) |
| min = cm->desc->polling_interval_ms; |
| } |
| } |
| |
| polling_jiffy = msecs_to_jiffies(min); |
| if (polling_jiffy <= CM_JIFFIES_SMALL) |
| polling_jiffy = CM_JIFFIES_SMALL + 1; |
| |
| if (!keep_polling) |
| polling_jiffy = ULONG_MAX; |
| if (polling_jiffy == ULONG_MAX) |
| goto out; |
| |
| WARN(cm_wq == NULL, "charger-manager: workqueue not initialized" |
| ". try it later. %s\n", __func__); |
| |
| /* |
| * Use mod_delayed_work() iff the next polling interval should |
| * occur before the currently scheduled one. If @cm_monitor_work |
| * isn't active, the end result is the same, so no need to worry |
| * about stale @next_polling. |
| */ |
| _next_polling = jiffies + polling_jiffy; |
| |
| if (time_before(_next_polling, next_polling)) { |
| mod_delayed_work(cm_wq, &cm_monitor_work, polling_jiffy); |
| next_polling = _next_polling; |
| } else { |
| if (queue_delayed_work(cm_wq, &cm_monitor_work, polling_jiffy)) |
| next_polling = _next_polling; |
| } |
| out: |
| mutex_unlock(&cm_list_mtx); |
| } |
| static DECLARE_WORK(setup_polling, _setup_polling); |
| |
| /** |
| * cm_monitor_poller - The Monitor / Poller. |
| * @work: work_struct of the function cm_monitor_poller |
| * |
| * During non-suspended state, cm_monitor_poller is used to poll and monitor |
| * the batteries. |
| */ |
| static void cm_monitor_poller(struct work_struct *work) |
| { |
| cm_monitor(); |
| schedule_work(&setup_polling); |
| } |
| |
| static int charger_get_property(struct power_supply *psy, |
| enum power_supply_property psp, |
| union power_supply_propval *val) |
| { |
| struct charger_manager *cm = power_supply_get_drvdata(psy); |
| struct charger_desc *desc = cm->desc; |
| struct power_supply *fuel_gauge = NULL; |
| int ret = 0; |
| int uV; |
| |
| switch (psp) { |
| case POWER_SUPPLY_PROP_STATUS: |
| val->intval = cm->battery_status; |
| break; |
| case POWER_SUPPLY_PROP_HEALTH: |
| if (cm->emergency_stop > 0) |
| val->intval = POWER_SUPPLY_HEALTH_OVERHEAT; |
| else if (cm->emergency_stop < 0) |
| val->intval = POWER_SUPPLY_HEALTH_COLD; |
| else |
| val->intval = POWER_SUPPLY_HEALTH_GOOD; |
| break; |
| case POWER_SUPPLY_PROP_PRESENT: |
| if (is_batt_present(cm)) |
| val->intval = 1; |
| else |
| val->intval = 0; |
| break; |
| case POWER_SUPPLY_PROP_VOLTAGE_NOW: |
| ret = get_batt_uV(cm, &val->intval); |
| break; |
| case POWER_SUPPLY_PROP_CURRENT_NOW: |
| fuel_gauge = power_supply_get_by_name(cm->desc->psy_fuel_gauge); |
| if (!fuel_gauge) { |
| ret = -ENODEV; |
| break; |
| } |
| ret = power_supply_get_property(fuel_gauge, |
| POWER_SUPPLY_PROP_CURRENT_NOW, val); |
| break; |
| case POWER_SUPPLY_PROP_TEMP: |
| return cm_get_battery_temperature(cm, &val->intval); |
| case POWER_SUPPLY_PROP_CAPACITY: |
| if (!is_batt_present(cm)) { |
| /* There is no battery. Assume 100% */ |
| val->intval = 100; |
| break; |
| } |
| |
| fuel_gauge = power_supply_get_by_name(cm->desc->psy_fuel_gauge); |
| if (!fuel_gauge) { |
| ret = -ENODEV; |
| break; |
| } |
| |
| ret = power_supply_get_property(fuel_gauge, |
| POWER_SUPPLY_PROP_CAPACITY, val); |
| if (ret) |
| break; |
| |
| if (val->intval > 100) { |
| val->intval = 100; |
| break; |
| } |
| if (val->intval < 0) |
| val->intval = 0; |
| |
| /* Do not adjust SOC when charging: voltage is overrated */ |
| if (is_charging(cm)) |
| break; |
| |
| /* |
| * If the capacity value is inconsistent, calibrate it base on |
| * the battery voltage values and the thresholds given as desc |
| */ |
| ret = get_batt_uV(cm, &uV); |
| if (ret) { |
| /* Voltage information not available. No calibration */ |
| ret = 0; |
| break; |
| } |
| |
| if (desc->fullbatt_uV > 0 && uV >= desc->fullbatt_uV && |
| !is_charging(cm)) { |
| val->intval = 100; |
| break; |
| } |
| |
| break; |
| case POWER_SUPPLY_PROP_ONLINE: |
| if (is_ext_pwr_online(cm)) |
| val->intval = 1; |
| else |
| val->intval = 0; |
| break; |
| case POWER_SUPPLY_PROP_CHARGE_FULL: |
| case POWER_SUPPLY_PROP_CHARGE_NOW: |
| fuel_gauge = power_supply_get_by_name(cm->desc->psy_fuel_gauge); |
| if (!fuel_gauge) { |
| ret = -ENODEV; |
| break; |
| } |
| ret = power_supply_get_property(fuel_gauge, psp, val); |
| break; |
| default: |
| return -EINVAL; |
| } |
| if (fuel_gauge) |
| power_supply_put(fuel_gauge); |
| return ret; |
| } |
| |
| #define NUM_CHARGER_PSY_OPTIONAL (4) |
| static enum power_supply_property default_charger_props[] = { |
| /* Guaranteed to provide */ |
| POWER_SUPPLY_PROP_STATUS, |
| POWER_SUPPLY_PROP_HEALTH, |
| POWER_SUPPLY_PROP_PRESENT, |
| POWER_SUPPLY_PROP_VOLTAGE_NOW, |
| POWER_SUPPLY_PROP_CAPACITY, |
| POWER_SUPPLY_PROP_ONLINE, |
| /* |
| * Optional properties are: |
| * POWER_SUPPLY_PROP_CHARGE_FULL, |
| * POWER_SUPPLY_PROP_CHARGE_NOW, |
| * POWER_SUPPLY_PROP_CURRENT_NOW, |
| * POWER_SUPPLY_PROP_TEMP, |
| */ |
| }; |
| |
| static const struct power_supply_desc psy_default = { |
| .name = "battery", |
| .type = POWER_SUPPLY_TYPE_BATTERY, |
| .properties = default_charger_props, |
| .num_properties = ARRAY_SIZE(default_charger_props), |
| .get_property = charger_get_property, |
| .no_thermal = true, |
| }; |
| |
| /** |
| * cm_setup_timer - For in-suspend monitoring setup wakeup alarm |
| * for suspend_again. |
| * |
| * Returns true if the alarm is set for Charger Manager to use. |
| * Returns false if |
| * cm_setup_timer fails to set an alarm, |
| * cm_setup_timer does not need to set an alarm for Charger Manager, |
| * or an alarm previously configured is to be used. |
| */ |
| static bool cm_setup_timer(void) |
| { |
| struct charger_manager *cm; |
| unsigned int wakeup_ms = UINT_MAX; |
| int timer_req = 0; |
| |
| if (time_after(next_polling, jiffies)) |
| CM_MIN_VALID(wakeup_ms, |
| jiffies_to_msecs(next_polling - jiffies)); |
| |
| mutex_lock(&cm_list_mtx); |
| list_for_each_entry(cm, &cm_list, entry) { |
| /* Skip if polling is not required for this CM */ |
| if (!is_polling_required(cm) && !cm->emergency_stop) |
| continue; |
| timer_req++; |
| if (cm->desc->polling_interval_ms == 0) |
| continue; |
| CM_MIN_VALID(wakeup_ms, cm->desc->polling_interval_ms); |
| } |
| mutex_unlock(&cm_list_mtx); |
| |
| if (timer_req && cm_timer) { |
| ktime_t now, add; |
| |
| /* |
| * Set alarm with the polling interval (wakeup_ms) |
| * The alarm time should be NOW + CM_RTC_SMALL or later. |
| */ |
| if (wakeup_ms == UINT_MAX || |
| wakeup_ms < CM_RTC_SMALL * MSEC_PER_SEC) |
| wakeup_ms = 2 * CM_RTC_SMALL * MSEC_PER_SEC; |
| |
| pr_info("Charger Manager wakeup timer: %u ms\n", wakeup_ms); |
| |
| now = ktime_get_boottime(); |
| add = ktime_set(wakeup_ms / MSEC_PER_SEC, |
| (wakeup_ms % MSEC_PER_SEC) * NSEC_PER_MSEC); |
| alarm_start(cm_timer, ktime_add(now, add)); |
| |
| cm_suspend_duration_ms = wakeup_ms; |
| |
| return true; |
| } |
| return false; |
| } |
| |
| /** |
| * charger_extcon_work - enable/diable charger according to the state |
| * of charger cable |
| * |
| * @work: work_struct of the function charger_extcon_work. |
| */ |
| static void charger_extcon_work(struct work_struct *work) |
| { |
| struct charger_cable *cable = |
| container_of(work, struct charger_cable, wq); |
| int ret; |
| |
| if (cable->attached && cable->min_uA != 0 && cable->max_uA != 0) { |
| ret = regulator_set_current_limit(cable->charger->consumer, |
| cable->min_uA, cable->max_uA); |
| if (ret < 0) { |
| pr_err("Cannot set current limit of %s (%s)\n", |
| cable->charger->regulator_name, cable->name); |
| return; |
| } |
| |
| pr_info("Set current limit of %s : %duA ~ %duA\n", |
| cable->charger->regulator_name, |
| cable->min_uA, cable->max_uA); |
| } |
| |
| cancel_delayed_work(&cm_monitor_work); |
| queue_delayed_work(cm_wq, &cm_monitor_work, 0); |
| } |
| |
| /** |
| * charger_extcon_notifier - receive the state of charger cable |
| * when registered cable is attached or detached. |
| * |
| * @self: the notifier block of the charger_extcon_notifier. |
| * @event: the cable state. |
| * @ptr: the data pointer of notifier block. |
| */ |
| static int charger_extcon_notifier(struct notifier_block *self, |
| unsigned long event, void *ptr) |
| { |
| struct charger_cable *cable = |
| container_of(self, struct charger_cable, nb); |
| |
| /* |
| * The newly state of charger cable. |
| * If cable is attached, cable->attached is true. |
| */ |
| cable->attached = event; |
| |
| /* |
| * Setup work for controlling charger(regulator) |
| * according to charger cable. |
| */ |
| schedule_work(&cable->wq); |
| |
| return NOTIFY_DONE; |
| } |
| |
| /** |
| * charger_extcon_init - register external connector to use it |
| * as the charger cable |
| * |
| * @cm: the Charger Manager representing the battery. |
| * @cable: the Charger cable representing the external connector. |
| */ |
| static int charger_extcon_init(struct charger_manager *cm, |
| struct charger_cable *cable) |
| { |
| int ret, i; |
| u64 extcon_type = EXTCON_NONE; |
| |
| /* |
| * Charger manager use Extcon framework to identify |
| * the charger cable among various external connector |
| * cable (e.g., TA, USB, MHL, Dock). |
| */ |
| INIT_WORK(&cable->wq, charger_extcon_work); |
| cable->nb.notifier_call = charger_extcon_notifier; |
| |
| cable->extcon_dev = extcon_get_extcon_dev(cable->extcon_name); |
| if (IS_ERR_OR_NULL(cable->extcon_dev)) { |
| pr_err("Cannot find extcon_dev for %s (cable: %s)\n", |
| cable->extcon_name, cable->name); |
| if (cable->extcon_dev == NULL) |
| return -EPROBE_DEFER; |
| else |
| return PTR_ERR(cable->extcon_dev); |
| } |
| |
| for (i = 0; i < ARRAY_SIZE(extcon_mapping); i++) { |
| if (!strcmp(cable->name, extcon_mapping[i].name)) { |
| extcon_type = extcon_mapping[i].extcon_type; |
| break; |
| } |
| } |
| if (extcon_type == EXTCON_NONE) { |
| pr_err("Cannot find cable for type %s", cable->name); |
| return -EINVAL; |
| } |
| |
| cable->extcon_type = extcon_type; |
| |
| ret = devm_extcon_register_notifier(cm->dev, cable->extcon_dev, |
| cable->extcon_type, &cable->nb); |
| if (ret < 0) { |
| pr_err("Cannot register extcon_dev for %s (cable: %s)\n", |
| cable->extcon_name, cable->name); |
| return ret; |
| } |
| |
| return 0; |
| } |
| |
| /** |
| * charger_manager_register_extcon - Register extcon device to receive state |
| * of charger cable. |
| * @cm: the Charger Manager representing the battery. |
| * |
| * This function support EXTCON(External Connector) subsystem to detect the |
| * state of charger cables for enabling or disabling charger(regulator) and |
| * select the charger cable for charging among a number of external cable |
| * according to policy of H/W board. |
| */ |
| static int charger_manager_register_extcon(struct charger_manager *cm) |
| { |
| struct charger_desc *desc = cm->desc; |
| struct charger_regulator *charger; |
| unsigned long event; |
| int ret; |
| int i; |
| int j; |
| |
| for (i = 0; i < desc->num_charger_regulators; i++) { |
| charger = &desc->charger_regulators[i]; |
| |
| charger->consumer = regulator_get(cm->dev, |
| charger->regulator_name); |
| if (IS_ERR(charger->consumer)) { |
| dev_err(cm->dev, "Cannot find charger(%s)\n", |
| charger->regulator_name); |
| return PTR_ERR(charger->consumer); |
| } |
| charger->cm = cm; |
| |
| for (j = 0; j < charger->num_cables; j++) { |
| struct charger_cable *cable = &charger->cables[j]; |
| |
| ret = charger_extcon_init(cm, cable); |
| if (ret < 0) { |
| dev_err(cm->dev, "Cannot initialize charger(%s)\n", |
| charger->regulator_name); |
| return ret; |
| } |
| cable->charger = charger; |
| cable->cm = cm; |
| |
| event = extcon_get_state(cable->extcon_dev, |
| cable->extcon_type); |
| charger_extcon_notifier(&cable->nb, |
| event, NULL); |
| } |
| } |
| |
| return 0; |
| } |
| |
| /* help function of sysfs node to control charger(regulator) */ |
| static ssize_t charger_name_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct charger_regulator *charger |
| = container_of(attr, struct charger_regulator, attr_name); |
| |
| return sprintf(buf, "%s\n", charger->regulator_name); |
| } |
| |
| static ssize_t charger_state_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct charger_regulator *charger |
| = container_of(attr, struct charger_regulator, attr_state); |
| int state = 0; |
| |
| if (!charger->externally_control) |
| state = regulator_is_enabled(charger->consumer); |
| |
| return sprintf(buf, "%s\n", state ? "enabled" : "disabled"); |
| } |
| |
| static ssize_t charger_externally_control_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct charger_regulator *charger = container_of(attr, |
| struct charger_regulator, attr_externally_control); |
| |
| return sprintf(buf, "%d\n", charger->externally_control); |
| } |
| |
| static ssize_t charger_externally_control_store(struct device *dev, |
| struct device_attribute *attr, const char *buf, |
| size_t count) |
| { |
| struct charger_regulator *charger |
| = container_of(attr, struct charger_regulator, |
| attr_externally_control); |
| struct charger_manager *cm = charger->cm; |
| struct charger_desc *desc = cm->desc; |
| int i; |
| int ret; |
| int externally_control; |
| int chargers_externally_control = 1; |
| |
| ret = sscanf(buf, "%d", &externally_control); |
| if (ret == 0) { |
| ret = -EINVAL; |
| return ret; |
| } |
| |
| if (!externally_control) { |
| charger->externally_control = 0; |
| return count; |
| } |
| |
| for (i = 0; i < desc->num_charger_regulators; i++) { |
| if (&desc->charger_regulators[i] != charger && |
| !desc->charger_regulators[i].externally_control) { |
| /* |
| * At least, one charger is controlled by |
| * charger-manager |
| */ |
| chargers_externally_control = 0; |
| break; |
| } |
| } |
| |
| if (!chargers_externally_control) { |
| if (cm->charger_enabled) { |
| try_charger_enable(charger->cm, false); |
| charger->externally_control = externally_control; |
| try_charger_enable(charger->cm, true); |
| } else { |
| charger->externally_control = externally_control; |
| } |
| } else { |
| dev_warn(cm->dev, |
| "'%s' regulator should be controlled in charger-manager because charger-manager must need at least one charger for charging\n", |
| charger->regulator_name); |
| } |
| |
| return count; |
| } |
| |
| /** |
| * charger_manager_prepare_sysfs - Prepare sysfs entry for each charger |
| * @cm: the Charger Manager representing the battery. |
| * |
| * This function add sysfs entry for charger(regulator) to control charger from |
| * user-space. If some development board use one more chargers for charging |
| * but only need one charger on specific case which is dependent on user |
| * scenario or hardware restrictions, the user enter 1 or 0(zero) to '/sys/ |
| * class/power_supply/battery/charger.[index]/externally_control'. For example, |
| * if user enter 1 to 'sys/class/power_supply/battery/charger.[index]/ |
| * externally_control, this charger isn't controlled from charger-manager and |
| * always stay off state of regulator. |
| */ |
| static int charger_manager_prepare_sysfs(struct charger_manager *cm) |
| { |
| struct charger_desc *desc = cm->desc; |
| struct charger_regulator *charger; |
| int chargers_externally_control = 1; |
| char *name; |
| int i; |
| |
| /* Create sysfs entry to control charger(regulator) */ |
| for (i = 0; i < desc->num_charger_regulators; i++) { |
| charger = &desc->charger_regulators[i]; |
| |
| name = devm_kasprintf(cm->dev, GFP_KERNEL, "charger.%d", i); |
| if (!name) |
| return -ENOMEM; |
| |
| charger->attrs[0] = &charger->attr_name.attr; |
| charger->attrs[1] = &charger->attr_state.attr; |
| charger->attrs[2] = &charger->attr_externally_control.attr; |
| charger->attrs[3] = NULL; |
| |
| charger->attr_grp.name = name; |
| charger->attr_grp.attrs = charger->attrs; |
| desc->sysfs_groups[i] = &charger->attr_grp; |
| |
| sysfs_attr_init(&charger->attr_name.attr); |
| charger->attr_name.attr.name = "name"; |
| charger->attr_name.attr.mode = 0444; |
| charger->attr_name.show = charger_name_show; |
| |
| sysfs_attr_init(&charger->attr_state.attr); |
| charger->attr_state.attr.name = "state"; |
| charger->attr_state.attr.mode = 0444; |
| charger->attr_state.show = charger_state_show; |
| |
| sysfs_attr_init(&charger->attr_externally_control.attr); |
| charger->attr_externally_control.attr.name |
| = "externally_control"; |
| charger->attr_externally_control.attr.mode = 0644; |
| charger->attr_externally_control.show |
| = charger_externally_control_show; |
| charger->attr_externally_control.store |
| = charger_externally_control_store; |
| |
| if (!desc->charger_regulators[i].externally_control || |
| !chargers_externally_control) |
| chargers_externally_control = 0; |
| |
| dev_info(cm->dev, "'%s' regulator's externally_control is %d\n", |
| charger->regulator_name, charger->externally_control); |
| } |
| |
| if (chargers_externally_control) { |
| dev_err(cm->dev, "Cannot register regulator because charger-manager must need at least one charger for charging battery\n"); |
| return -EINVAL; |
| } |
| |
| return 0; |
| } |
| |
| static int cm_init_thermal_data(struct charger_manager *cm, |
| struct power_supply *fuel_gauge, |
| enum power_supply_property *properties, |
| size_t *num_properties) |
| { |
| struct charger_desc *desc = cm->desc; |
| union power_supply_propval val; |
| int ret; |
| |
| /* Verify whether fuel gauge provides battery temperature */ |
| ret = power_supply_get_property(fuel_gauge, |
| POWER_SUPPLY_PROP_TEMP, &val); |
| |
| if (!ret) { |
| properties[*num_properties] = POWER_SUPPLY_PROP_TEMP; |
| (*num_properties)++; |
| cm->desc->measure_battery_temp = true; |
| } |
| #ifdef CONFIG_THERMAL |
| if (ret && desc->thermal_zone) { |
| cm->tzd_batt = |
| thermal_zone_get_zone_by_name(desc->thermal_zone); |
| if (IS_ERR(cm->tzd_batt)) |
| return PTR_ERR(cm->tzd_batt); |
| |
| /* Use external thermometer */ |
| properties[*num_properties] = POWER_SUPPLY_PROP_TEMP; |
| (*num_properties)++; |
| cm->desc->measure_battery_temp = true; |
| ret = 0; |
| } |
| #endif |
| if (cm->desc->measure_battery_temp) { |
| /* NOTICE : Default allowable minimum charge temperature is 0 */ |
| if (!desc->temp_max) |
| desc->temp_max = CM_DEFAULT_CHARGE_TEMP_MAX; |
| if (!desc->temp_diff) |
| desc->temp_diff = CM_DEFAULT_RECHARGE_TEMP_DIFF; |
| } |
| |
| return ret; |
| } |
| |
| static const struct of_device_id charger_manager_match[] = { |
| { |
| .compatible = "charger-manager", |
| }, |
| {}, |
| }; |
| |
| static struct charger_desc *of_cm_parse_desc(struct device *dev) |
| { |
| struct charger_desc *desc; |
| struct device_node *np = dev->of_node; |
| u32 poll_mode = CM_POLL_DISABLE; |
| u32 battery_stat = CM_NO_BATTERY; |
| int num_chgs = 0; |
| |
| desc = devm_kzalloc(dev, sizeof(*desc), GFP_KERNEL); |
| if (!desc) |
| return ERR_PTR(-ENOMEM); |
| |
| of_property_read_string(np, "cm-name", &desc->psy_name); |
| |
| of_property_read_u32(np, "cm-poll-mode", &poll_mode); |
| desc->polling_mode = poll_mode; |
| |
| of_property_read_u32(np, "cm-poll-interval", |
| &desc->polling_interval_ms); |
| |
| of_property_read_u32(np, "cm-fullbatt-vchkdrop-volt", |
| &desc->fullbatt_vchkdrop_uV); |
| of_property_read_u32(np, "cm-fullbatt-voltage", &desc->fullbatt_uV); |
| of_property_read_u32(np, "cm-fullbatt-soc", &desc->fullbatt_soc); |
| of_property_read_u32(np, "cm-fullbatt-capacity", |
| &desc->fullbatt_full_capacity); |
| |
| of_property_read_u32(np, "cm-battery-stat", &battery_stat); |
| desc->battery_present = battery_stat; |
| |
| /* chargers */ |
| num_chgs = of_property_count_strings(np, "cm-chargers"); |
| if (num_chgs > 0) { |
| int i; |
| |
| /* Allocate empty bin at the tail of array */ |
| desc->psy_charger_stat = devm_kcalloc(dev, |
| num_chgs + 1, |
| sizeof(char *), |
| GFP_KERNEL); |
| if (!desc->psy_charger_stat) |
| return ERR_PTR(-ENOMEM); |
| |
| for (i = 0; i < num_chgs; i++) |
| of_property_read_string_index(np, "cm-chargers", |
| i, &desc->psy_charger_stat[i]); |
| } |
| |
| of_property_read_string(np, "cm-fuel-gauge", &desc->psy_fuel_gauge); |
| |
| of_property_read_string(np, "cm-thermal-zone", &desc->thermal_zone); |
| |
| of_property_read_u32(np, "cm-battery-cold", &desc->temp_min); |
| if (of_get_property(np, "cm-battery-cold-in-minus", NULL)) |
| desc->temp_min *= -1; |
| of_property_read_u32(np, "cm-battery-hot", &desc->temp_max); |
| of_property_read_u32(np, "cm-battery-temp-diff", &desc->temp_diff); |
| |
| of_property_read_u32(np, "cm-charging-max", |
| &desc->charging_max_duration_ms); |
| of_property_read_u32(np, "cm-discharging-max", |
| &desc->discharging_max_duration_ms); |
| |
| /* battery charger regulators */ |
| desc->num_charger_regulators = of_get_child_count(np); |
| if (desc->num_charger_regulators) { |
| struct charger_regulator *chg_regs; |
| struct device_node *child; |
| |
| chg_regs = devm_kcalloc(dev, |
| desc->num_charger_regulators, |
| sizeof(*chg_regs), |
| GFP_KERNEL); |
| if (!chg_regs) |
| return ERR_PTR(-ENOMEM); |
| |
| desc->charger_regulators = chg_regs; |
| |
| desc->sysfs_groups = devm_kcalloc(dev, |
| desc->num_charger_regulators + 1, |
| sizeof(*desc->sysfs_groups), |
| GFP_KERNEL); |
| if (!desc->sysfs_groups) |
| return ERR_PTR(-ENOMEM); |
| |
| for_each_child_of_node(np, child) { |
| struct charger_cable *cables; |
| struct device_node *_child; |
| |
| of_property_read_string(child, "cm-regulator-name", |
| &chg_regs->regulator_name); |
| |
| /* charger cables */ |
| chg_regs->num_cables = of_get_child_count(child); |
| if (chg_regs->num_cables) { |
| cables = devm_kcalloc(dev, |
| chg_regs->num_cables, |
| sizeof(*cables), |
| GFP_KERNEL); |
| if (!cables) { |
| of_node_put(child); |
| return ERR_PTR(-ENOMEM); |
| } |
| |
| chg_regs->cables = cables; |
| |
| for_each_child_of_node(child, _child) { |
| of_property_read_string(_child, |
| "cm-cable-name", &cables->name); |
| of_property_read_string(_child, |
| "cm-cable-extcon", |
| &cables->extcon_name); |
| of_property_read_u32(_child, |
| "cm-cable-min", |
| &cables->min_uA); |
| of_property_read_u32(_child, |
| "cm-cable-max", |
| &cables->max_uA); |
| cables++; |
| } |
| } |
| chg_regs++; |
| } |
| } |
| return desc; |
| } |
| |
| static inline struct charger_desc *cm_get_drv_data(struct platform_device *pdev) |
| { |
| if (pdev->dev.of_node) |
| return of_cm_parse_desc(&pdev->dev); |
| return dev_get_platdata(&pdev->dev); |
| } |
| |
| static enum alarmtimer_restart cm_timer_func(struct alarm *alarm, ktime_t now) |
| { |
| cm_timer_set = false; |
| return ALARMTIMER_NORESTART; |
| } |
| |
| static int charger_manager_probe(struct platform_device *pdev) |
| { |
| struct charger_desc *desc = cm_get_drv_data(pdev); |
| struct charger_manager *cm; |
| int ret, i = 0; |
| union power_supply_propval val; |
| struct power_supply *fuel_gauge; |
| enum power_supply_property *properties; |
| size_t num_properties; |
| struct power_supply_config psy_cfg = {}; |
| |
| if (IS_ERR(desc)) { |
| dev_err(&pdev->dev, "No platform data (desc) found\n"); |
| return PTR_ERR(desc); |
| } |
| |
| cm = devm_kzalloc(&pdev->dev, sizeof(*cm), GFP_KERNEL); |
| if (!cm) |
| return -ENOMEM; |
| |
| /* Basic Values. Unspecified are Null or 0 */ |
| cm->dev = &pdev->dev; |
| cm->desc = desc; |
| psy_cfg.drv_data = cm; |
| |
| /* Initialize alarm timer */ |
| if (alarmtimer_get_rtcdev()) { |
| cm_timer = devm_kzalloc(cm->dev, sizeof(*cm_timer), GFP_KERNEL); |
| if (!cm_timer) |
| return -ENOMEM; |
| alarm_init(cm_timer, ALARM_BOOTTIME, cm_timer_func); |
| } |
| |
| /* |
| * Some of the following do not need to be errors. |
| * Users may intentionally ignore those features. |
| */ |
| if (desc->fullbatt_uV == 0) { |
| dev_info(&pdev->dev, "Ignoring full-battery voltage threshold as it is not supplied\n"); |
| } |
| if (!desc->fullbatt_vchkdrop_uV) { |
| dev_info(&pdev->dev, "Disabling full-battery voltage drop checking mechanism as it is not supplied\n"); |
| desc->fullbatt_vchkdrop_uV = 0; |
| } |
| if (desc->fullbatt_soc == 0) { |
| dev_info(&pdev->dev, "Ignoring full-battery soc(state of charge) threshold as it is not supplied\n"); |
| } |
| if (desc->fullbatt_full_capacity == 0) { |
| dev_info(&pdev->dev, "Ignoring full-battery full capacity threshold as it is not supplied\n"); |
| } |
| |
| if (!desc->charger_regulators || desc->num_charger_regulators < 1) { |
| dev_err(&pdev->dev, "charger_regulators undefined\n"); |
| return -EINVAL; |
| } |
| |
| if (!desc->psy_charger_stat || !desc->psy_charger_stat[0]) { |
| dev_err(&pdev->dev, "No power supply defined\n"); |
| return -EINVAL; |
| } |
| |
| if (!desc->psy_fuel_gauge) { |
| dev_err(&pdev->dev, "No fuel gauge power supply defined\n"); |
| return -EINVAL; |
| } |
| |
| /* Check if charger's supplies are present at probe */ |
| for (i = 0; desc->psy_charger_stat[i]; i++) { |
| struct power_supply *psy; |
| |
| psy = power_supply_get_by_name(desc->psy_charger_stat[i]); |
| if (!psy) { |
| dev_err(&pdev->dev, "Cannot find power supply \"%s\"\n", |
| desc->psy_charger_stat[i]); |
| return -ENODEV; |
| } |
| power_supply_put(psy); |
| } |
| |
| if (cm->desc->polling_mode != CM_POLL_DISABLE && |
| (desc->polling_interval_ms == 0 || |
| msecs_to_jiffies(desc->polling_interval_ms) <= CM_JIFFIES_SMALL)) { |
| dev_err(&pdev->dev, "polling_interval_ms is too small\n"); |
| return -EINVAL; |
| } |
| |
| if (!desc->charging_max_duration_ms || |
| !desc->discharging_max_duration_ms) { |
| dev_info(&pdev->dev, "Cannot limit charging duration checking mechanism to prevent overcharge/overheat and control discharging duration\n"); |
| desc->charging_max_duration_ms = 0; |
| desc->discharging_max_duration_ms = 0; |
| } |
| |
| platform_set_drvdata(pdev, cm); |
| |
| memcpy(&cm->charger_psy_desc, &psy_default, sizeof(psy_default)); |
| |
| if (!desc->psy_name) |
| strncpy(cm->psy_name_buf, psy_default.name, PSY_NAME_MAX); |
| else |
| strncpy(cm->psy_name_buf, desc->psy_name, PSY_NAME_MAX); |
| cm->charger_psy_desc.name = cm->psy_name_buf; |
| |
| /* Allocate for psy properties because they may vary */ |
| properties = devm_kcalloc(&pdev->dev, |
| ARRAY_SIZE(default_charger_props) + |
| NUM_CHARGER_PSY_OPTIONAL, |
| sizeof(*properties), GFP_KERNEL); |
| if (!properties) |
| return -ENOMEM; |
| |
| memcpy(properties, default_charger_props, |
| sizeof(enum power_supply_property) * |
| ARRAY_SIZE(default_charger_props)); |
| num_properties = ARRAY_SIZE(default_charger_props); |
| |
| /* Find which optional psy-properties are available */ |
| fuel_gauge = power_supply_get_by_name(desc->psy_fuel_gauge); |
| if (!fuel_gauge) { |
| dev_err(&pdev->dev, "Cannot find power supply \"%s\"\n", |
| desc->psy_fuel_gauge); |
| return -ENODEV; |
| } |
| if (!power_supply_get_property(fuel_gauge, |
| POWER_SUPPLY_PROP_CHARGE_FULL, &val)) { |
| properties[num_properties] = |
| POWER_SUPPLY_PROP_CHARGE_FULL; |
| num_properties++; |
| } |
| if (!power_supply_get_property(fuel_gauge, |
| POWER_SUPPLY_PROP_CHARGE_NOW, &val)) { |
| properties[num_properties] = |
| POWER_SUPPLY_PROP_CHARGE_NOW; |
| num_properties++; |
| } |
| if (!power_supply_get_property(fuel_gauge, |
| POWER_SUPPLY_PROP_CURRENT_NOW, |
| &val)) { |
| properties[num_properties] = |
| POWER_SUPPLY_PROP_CURRENT_NOW; |
| num_properties++; |
| } |
| |
| ret = cm_init_thermal_data(cm, fuel_gauge, properties, &num_properties); |
| if (ret) { |
| dev_err(&pdev->dev, "Failed to initialize thermal data\n"); |
| cm->desc->measure_battery_temp = false; |
| } |
| power_supply_put(fuel_gauge); |
| |
| cm->charger_psy_desc.properties = properties; |
| cm->charger_psy_desc.num_properties = num_properties; |
| |
| /* Register sysfs entry for charger(regulator) */ |
| ret = charger_manager_prepare_sysfs(cm); |
| if (ret < 0) { |
| dev_err(&pdev->dev, |
| "Cannot prepare sysfs entry of regulators\n"); |
| return ret; |
| } |
| psy_cfg.attr_grp = desc->sysfs_groups; |
| |
| cm->charger_psy = power_supply_register(&pdev->dev, |
| &cm->charger_psy_desc, |
| &psy_cfg); |
| if (IS_ERR(cm->charger_psy)) { |
| dev_err(&pdev->dev, "Cannot register charger-manager with name \"%s\"\n", |
| cm->charger_psy_desc.name); |
| return PTR_ERR(cm->charger_psy); |
| } |
| |
| /* Register extcon device for charger cable */ |
| ret = charger_manager_register_extcon(cm); |
| if (ret < 0) { |
| dev_err(&pdev->dev, "Cannot initialize extcon device\n"); |
| goto err_reg_extcon; |
| } |
| |
| /* Add to the list */ |
| mutex_lock(&cm_list_mtx); |
| list_add(&cm->entry, &cm_list); |
| mutex_unlock(&cm_list_mtx); |
| |
| /* |
| * Charger-manager is capable of waking up the systme from sleep |
| * when event is happened through cm_notify_event() |
| */ |
| device_init_wakeup(&pdev->dev, true); |
| device_set_wakeup_capable(&pdev->dev, false); |
| |
| /* |
| * Charger-manager have to check the charging state right after |
| * initialization of charger-manager and then update current charging |
| * state. |
| */ |
| cm_monitor(); |
| |
| schedule_work(&setup_polling); |
| |
| return 0; |
| |
| err_reg_extcon: |
| for (i = 0; i < desc->num_charger_regulators; i++) |
| regulator_put(desc->charger_regulators[i].consumer); |
| |
| power_supply_unregister(cm->charger_psy); |
| |
| return ret; |
| } |
| |
| static int charger_manager_remove(struct platform_device *pdev) |
| { |
| struct charger_manager *cm = platform_get_drvdata(pdev); |
| struct charger_desc *desc = cm->desc; |
| int i = 0; |
| |
| /* Remove from the list */ |
| mutex_lock(&cm_list_mtx); |
| list_del(&cm->entry); |
| mutex_unlock(&cm_list_mtx); |
| |
| cancel_work_sync(&setup_polling); |
| cancel_delayed_work_sync(&cm_monitor_work); |
| |
| for (i = 0 ; i < desc->num_charger_regulators ; i++) |
| regulator_put(desc->charger_regulators[i].consumer); |
| |
| power_supply_unregister(cm->charger_psy); |
| |
| try_charger_enable(cm, false); |
| |
| return 0; |
| } |
| |
| static const struct platform_device_id charger_manager_id[] = { |
| { "charger-manager", 0 }, |
| { }, |
| }; |
| MODULE_DEVICE_TABLE(platform, charger_manager_id); |
| |
| static int cm_suspend_noirq(struct device *dev) |
| { |
| if (device_may_wakeup(dev)) { |
| device_set_wakeup_capable(dev, false); |
| return -EAGAIN; |
| } |
| |
| return 0; |
| } |
| |
| static bool cm_need_to_awake(void) |
| { |
| struct charger_manager *cm; |
| |
| if (cm_timer) |
| return false; |
| |
| mutex_lock(&cm_list_mtx); |
| list_for_each_entry(cm, &cm_list, entry) { |
| if (is_charging(cm)) { |
| mutex_unlock(&cm_list_mtx); |
| return true; |
| } |
| } |
| mutex_unlock(&cm_list_mtx); |
| |
| return false; |
| } |
| |
| static int cm_suspend_prepare(struct device *dev) |
| { |
| if (cm_need_to_awake()) |
| return -EBUSY; |
| |
| if (!cm_suspended) |
| cm_suspended = true; |
| |
| cm_timer_set = cm_setup_timer(); |
| |
| if (cm_timer_set) { |
| cancel_work_sync(&setup_polling); |
| cancel_delayed_work_sync(&cm_monitor_work); |
| } |
| |
| return 0; |
| } |
| |
| static void cm_suspend_complete(struct device *dev) |
| { |
| struct charger_manager *cm = dev_get_drvdata(dev); |
| |
| if (cm_suspended) |
| cm_suspended = false; |
| |
| if (cm_timer_set) { |
| ktime_t remain; |
| |
| alarm_cancel(cm_timer); |
| cm_timer_set = false; |
| remain = alarm_expires_remaining(cm_timer); |
| cm_suspend_duration_ms -= ktime_to_ms(remain); |
| schedule_work(&setup_polling); |
| } |
| |
| _cm_monitor(cm); |
| |
| device_set_wakeup_capable(cm->dev, false); |
| } |
| |
| static const struct dev_pm_ops charger_manager_pm = { |
| .prepare = cm_suspend_prepare, |
| .suspend_noirq = cm_suspend_noirq, |
| .complete = cm_suspend_complete, |
| }; |
| |
| static struct platform_driver charger_manager_driver = { |
| .driver = { |
| .name = "charger-manager", |
| .pm = &charger_manager_pm, |
| .of_match_table = charger_manager_match, |
| }, |
| .probe = charger_manager_probe, |
| .remove = charger_manager_remove, |
| .id_table = charger_manager_id, |
| }; |
| |
| static int __init charger_manager_init(void) |
| { |
| cm_wq = create_freezable_workqueue("charger_manager"); |
| if (unlikely(!cm_wq)) |
| return -ENOMEM; |
| |
| INIT_DELAYED_WORK(&cm_monitor_work, cm_monitor_poller); |
| |
| return platform_driver_register(&charger_manager_driver); |
| } |
| late_initcall(charger_manager_init); |
| |
| static void __exit charger_manager_cleanup(void) |
| { |
| destroy_workqueue(cm_wq); |
| cm_wq = NULL; |
| |
| platform_driver_unregister(&charger_manager_driver); |
| } |
| module_exit(charger_manager_cleanup); |
| |
| MODULE_AUTHOR("MyungJoo Ham <myungjoo.ham@samsung.com>"); |
| MODULE_DESCRIPTION("Charger Manager"); |
| MODULE_LICENSE("GPL"); |