123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * Copyright (C) 2011 Samsung Electronics Co., Ltd.
- * MyungJoo Ham <[email protected]>
- *
- * 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 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(cable->extcon_dev)) {
- pr_err("Cannot find extcon_dev for %s (cable: %s)\n",
- cable->extcon_name, cable->name);
- 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 <[email protected]>");
- MODULE_DESCRIPTION("Charger Manager");
- MODULE_LICENSE("GPL");
|