// SPDX-License-Identifier: GPL-2.0-only /* * Copyright (C) 2011 Samsung Electronics Co., Ltd. * MyungJoo Ham * * 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 #include #include #include #include #include #include #include #include #include #include #include #include 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 exceeds 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 exceeds 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 == CM_BATT_OVERHEAT) val->intval = POWER_SUPPLY_HEALTH_OVERHEAT; else if (cm->emergency_stop == CM_BATT_COLD) 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", }, {}, }; MODULE_DEVICE_TABLE(of, charger_manager_match); 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 system 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 "); MODULE_DESCRIPTION("Charger Manager"); MODULE_LICENSE("GPL");