| /* |
| * Copyright (C) 2011 Samsung Electronics Co., Ltd. |
| * MyungJoo Ham <myungjoo.ham@samsung.com> |
| * |
| * This driver enables to monitor battery health and control charger |
| * during suspend-to-mem. |
| * Charger manager depends on other devices. register this later than |
| * the depending devices. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| **/ |
| |
| #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> |
| |
| static const char * const default_event_names[] = { |
| [CM_EVENT_UNKNOWN] = "Unknown", |
| [CM_EVENT_BATT_FULL] = "Battery Full", |
| [CM_EVENT_BATT_IN] = "Battery Inserted", |
| [CM_EVENT_BATT_OUT] = "Battery Pulled Out", |
| [CM_EVENT_EXT_PWR_IN_OUT] = "External Power Attach/Detach", |
| [CM_EVENT_CHG_START_STOP] = "Charging Start/Stop", |
| [CM_EVENT_OTHERS] = "Other battery events" |
| }; |
| |
| /* |
| * 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) |
| |
| #define UEVENT_BUF_SIZE 32 |
| |
| static LIST_HEAD(cm_list); |
| static DEFINE_MUTEX(cm_list_mtx); |
| |
| /* About in-suspend (suspend-again) monitoring */ |
| static struct rtc_device *rtc_dev; |
| /* |
| * Backup RTC alarm |
| * Save the wakeup alarm before entering suspend-to-RAM |
| */ |
| static struct rtc_wkalrm rtc_wkalarm_save; |
| /* Backup RTC alarm time in terms of seconds since 01-01-1970 00:00:00 */ |
| static unsigned long rtc_wkalarm_save_time; |
| static bool cm_suspended; |
| static bool cm_rtc_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 */ |
| |
| /* Global charger-manager description */ |
| static struct charger_global_desc *g_desc; /* init with setup_charger_manager */ |
| |
| /** |
| * 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; |
| 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: |
| ret = cm->fuel_gauge->get_property(cm->fuel_gauge, |
| POWER_SUPPLY_PROP_PRESENT, &val); |
| if (ret == 0 && val.intval) |
| present = true; |
| break; |
| case CM_CHARGER_STAT: |
| for (i = 0; cm->charger_stat[i]; i++) { |
| ret = cm->charger_stat[i]->get_property( |
| cm->charger_stat[i], |
| POWER_SUPPLY_PROP_PRESENT, &val); |
| 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; |
| bool online = false; |
| int i, ret; |
| |
| /* If at least one of them has one, it's yes. */ |
| for (i = 0; cm->charger_stat[i]; i++) { |
| ret = cm->charger_stat[i]->get_property( |
| cm->charger_stat[i], |
| POWER_SUPPLY_PROP_ONLINE, &val); |
| 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; |
| int ret; |
| |
| if (!cm->fuel_gauge) |
| return -ENODEV; |
| |
| ret = cm->fuel_gauge->get_property(cm->fuel_gauge, |
| POWER_SUPPLY_PROP_VOLTAGE_NOW, &val); |
| 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; |
| 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->charger_stat[i]; i++) { |
| /* 1. The charger sholuld not be DISABLED */ |
| if (cm->emergency_stop) |
| continue; |
| if (!cm->charger_enabled) |
| continue; |
| |
| /* 2. The charger should be online (ext-power) */ |
| ret = cm->charger_stat[i]->get_property( |
| cm->charger_stat[i], |
| POWER_SUPPLY_PROP_ONLINE, &val); |
| if (ret) { |
| dev_warn(cm->dev, "Cannot read ONLINE value from %s.\n", |
| cm->desc->psy_charger_stat[i]); |
| continue; |
| } |
| if (val.intval == 0) |
| continue; |
| |
| /* |
| * 3. The charger should not be FULL, DISCHARGING, |
| * or NOT_CHARGING. |
| */ |
| ret = cm->charger_stat[i]->get_property( |
| cm->charger_stat[i], |
| POWER_SUPPLY_PROP_STATUS, &val); |
| 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_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 |
| * bacause 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 redundent command */ |
| if (enable == cm->charger_enabled) |
| return 0; |
| |
| if (enable) { |
| if (cm->emergency_stop) |
| return -EAGAIN; |
| for (i = 0 ; i < desc->num_charger_regulators ; i++) |
| regulator_enable(desc->charger_regulators[i].consumer); |
| } else { |
| /* |
| * 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; |
| } |
| |
| /** |
| * try_charger_restart - Restart charging. |
| * @cm: the Charger Manager representing the battery. |
| * |
| * Restart charging by turning off and on the charger. |
| */ |
| static int try_charger_restart(struct charger_manager *cm) |
| { |
| int err; |
| |
| if (cm->emergency_stop) |
| return -EAGAIN; |
| |
| err = try_charger_enable(cm, false); |
| if (err) |
| return err; |
| |
| return try_charger_enable(cm, true); |
| } |
| |
| /** |
| * uevent_notify - Let users know something has changed. |
| * @cm: the Charger Manager representing the battery. |
| * @event: the event string. |
| * |
| * If @event is null, it implies that uevent_notify is called |
| * by resume function. When called in the resume function, cm_suspended |
| * should be already reset to false in order to let uevent_notify |
| * notify the recent event during the suspend to users. While |
| * suspended, uevent_notify does not notify users, but tracks |
| * events so that uevent_notify can notify users later after resumed. |
| */ |
| static void uevent_notify(struct charger_manager *cm, const char *event) |
| { |
| static char env_str[UEVENT_BUF_SIZE + 1] = ""; |
| static char env_str_save[UEVENT_BUF_SIZE + 1] = ""; |
| |
| if (cm_suspended) { |
| /* Nothing in suspended-event buffer */ |
| if (env_str_save[0] == 0) { |
| if (!strncmp(env_str, event, UEVENT_BUF_SIZE)) |
| return; /* status not changed */ |
| strncpy(env_str_save, event, UEVENT_BUF_SIZE); |
| return; |
| } |
| |
| if (!strncmp(env_str_save, event, UEVENT_BUF_SIZE)) |
| return; /* Duplicated. */ |
| strncpy(env_str_save, event, UEVENT_BUF_SIZE); |
| return; |
| } |
| |
| if (event == NULL) { |
| /* No messages pending */ |
| if (!env_str_save[0]) |
| return; |
| |
| strncpy(env_str, env_str_save, UEVENT_BUF_SIZE); |
| kobject_uevent(&cm->dev->kobj, KOBJ_CHANGE); |
| env_str_save[0] = 0; |
| |
| return; |
| } |
| |
| /* status not changed */ |
| if (!strncmp(env_str, event, UEVENT_BUF_SIZE)) |
| return; |
| |
| /* save the status and notify the update */ |
| strncpy(env_str, event, UEVENT_BUF_SIZE); |
| kobject_uevent(&cm->dev->kobj, KOBJ_CHANGE); |
| |
| dev_info(cm->dev, event); |
| } |
| |
| /** |
| * fullbatt_vchk - Check voltage drop some times after "FULL" event. |
| * @work: the work_struct appointing the function |
| * |
| * If a user has designated "fullbatt_vchkdrop_ms/uV" values with |
| * charger_desc, Charger Manager checks voltage drop after the battery |
| * "FULL" event. It checks whether the voltage has dropped more than |
| * fullbatt_vchkdrop_uV by calling this function after fullbatt_vchkrop_ms. |
| */ |
| static void fullbatt_vchk(struct work_struct *work) |
| { |
| struct delayed_work *dwork = to_delayed_work(work); |
| struct charger_manager *cm = container_of(dwork, |
| struct charger_manager, fullbatt_vchk_work); |
| struct charger_desc *desc = cm->desc; |
| int batt_uV, err, diff; |
| |
| /* remove the appointment for fullbatt_vchk */ |
| cm->fullbatt_vchk_jiffies_at = 0; |
| |
| if (!desc->fullbatt_vchkdrop_uV || !desc->fullbatt_vchkdrop_ms) |
| return; |
| |
| err = get_batt_uV(cm, &batt_uV); |
| if (err) { |
| dev_err(cm->dev, "%s: get_batt_uV error(%d).\n", __func__, err); |
| return; |
| } |
| |
| diff = cm->fullbatt_vchk_uV; |
| diff -= batt_uV; |
| |
| dev_dbg(cm->dev, "VBATT dropped %duV after full-batt.\n", diff); |
| |
| if (diff > desc->fullbatt_vchkdrop_uV) { |
| try_charger_restart(cm); |
| uevent_notify(cm, "Recharge"); |
| } |
| } |
| |
| /** |
| * _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) |
| { |
| struct charger_desc *desc = cm->desc; |
| int temp = desc->temperature_out_of_range(&cm->last_temp_mC); |
| |
| dev_dbg(cm->dev, "monitoring (%2.2d.%3.3dC)\n", |
| cm->last_temp_mC / 1000, cm->last_temp_mC % 1000); |
| |
| /* It has been stopped or charging already */ |
| if (!!temp == !!cm->emergency_stop) |
| return false; |
| |
| if (temp) { |
| cm->emergency_stop = temp; |
| if (!try_charger_enable(cm, false)) { |
| if (temp > 0) |
| uevent_notify(cm, "OVERHEAT"); |
| else |
| uevent_notify(cm, "COLD"); |
| } |
| } else { |
| cm->emergency_stop = 0; |
| if (!try_charger_enable(cm, true)) |
| uevent_notify(cm, "CHARGING"); |
| } |
| |
| return true; |
| } |
| |
| /** |
| * 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__); |
| |
| _next_polling = jiffies + polling_jiffy; |
| |
| if (!delayed_work_pending(&cm_monitor_work) || |
| (delayed_work_pending(&cm_monitor_work) && |
| time_after(next_polling, _next_polling))) { |
| next_polling = jiffies + polling_jiffy; |
| mod_delayed_work(cm_wq, &cm_monitor_work, polling_jiffy); |
| } |
| |
| 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); |
| } |
| |
| /** |
| * fullbatt_handler - Event handler for CM_EVENT_BATT_FULL |
| * @cm: the Charger Manager representing the battery. |
| */ |
| static void fullbatt_handler(struct charger_manager *cm) |
| { |
| struct charger_desc *desc = cm->desc; |
| |
| if (!desc->fullbatt_vchkdrop_uV || !desc->fullbatt_vchkdrop_ms) |
| goto out; |
| |
| if (cm_suspended) |
| device_set_wakeup_capable(cm->dev, true); |
| |
| mod_delayed_work(cm_wq, &cm->fullbatt_vchk_work, |
| msecs_to_jiffies(desc->fullbatt_vchkdrop_ms)); |
| cm->fullbatt_vchk_jiffies_at = jiffies + msecs_to_jiffies( |
| desc->fullbatt_vchkdrop_ms); |
| |
| if (cm->fullbatt_vchk_jiffies_at == 0) |
| cm->fullbatt_vchk_jiffies_at = 1; |
| |
| out: |
| dev_info(cm->dev, "EVENT_HANDLE: Battery Fully Charged.\n"); |
| uevent_notify(cm, default_event_names[CM_EVENT_BATT_FULL]); |
| } |
| |
| /** |
| * battout_handler - Event handler for CM_EVENT_BATT_OUT |
| * @cm: the Charger Manager representing the battery. |
| */ |
| static void battout_handler(struct charger_manager *cm) |
| { |
| if (cm_suspended) |
| device_set_wakeup_capable(cm->dev, true); |
| |
| if (!is_batt_present(cm)) { |
| dev_emerg(cm->dev, "Battery Pulled Out!\n"); |
| uevent_notify(cm, default_event_names[CM_EVENT_BATT_OUT]); |
| } else { |
| uevent_notify(cm, "Battery Reinserted?"); |
| } |
| } |
| |
| /** |
| * misc_event_handler - Handler for other evnets |
| * @cm: the Charger Manager representing the battery. |
| * @type: the Charger Manager representing the battery. |
| */ |
| static void misc_event_handler(struct charger_manager *cm, |
| enum cm_event_types type) |
| { |
| if (cm_suspended) |
| device_set_wakeup_capable(cm->dev, true); |
| |
| if (!delayed_work_pending(&cm_monitor_work) && |
| is_polling_required(cm) && cm->desc->polling_interval_ms) |
| schedule_work(&setup_polling); |
| uevent_notify(cm, default_event_names[type]); |
| } |
| |
| static int charger_get_property(struct power_supply *psy, |
| enum power_supply_property psp, |
| union power_supply_propval *val) |
| { |
| struct charger_manager *cm = container_of(psy, |
| struct charger_manager, charger_psy); |
| struct charger_desc *desc = cm->desc; |
| int ret = 0; |
| int uV; |
| |
| switch (psp) { |
| case POWER_SUPPLY_PROP_STATUS: |
| if (is_charging(cm)) |
| val->intval = POWER_SUPPLY_STATUS_CHARGING; |
| else if (is_ext_pwr_online(cm)) |
| val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING; |
| else |
| val->intval = POWER_SUPPLY_STATUS_DISCHARGING; |
| break; |
| case POWER_SUPPLY_PROP_HEALTH: |
| if (cm->emergency_stop > 0) |
| val->intval = POWER_SUPPLY_HEALTH_OVERHEAT; |
| else if (cm->emergency_stop < 0) |
| val->intval = POWER_SUPPLY_HEALTH_COLD; |
| else |
| val->intval = POWER_SUPPLY_HEALTH_GOOD; |
| break; |
| case POWER_SUPPLY_PROP_PRESENT: |
| if (is_batt_present(cm)) |
| val->intval = 1; |
| else |
| val->intval = 0; |
| break; |
| case POWER_SUPPLY_PROP_VOLTAGE_NOW: |
| ret = get_batt_uV(cm, &val->intval); |
| break; |
| case POWER_SUPPLY_PROP_CURRENT_NOW: |
| ret = cm->fuel_gauge->get_property(cm->fuel_gauge, |
| POWER_SUPPLY_PROP_CURRENT_NOW, val); |
| break; |
| case POWER_SUPPLY_PROP_TEMP: |
| /* in thenth of centigrade */ |
| if (cm->last_temp_mC == INT_MIN) |
| desc->temperature_out_of_range(&cm->last_temp_mC); |
| val->intval = cm->last_temp_mC / 100; |
| if (!desc->measure_battery_temp) |
| ret = -ENODEV; |
| break; |
| case POWER_SUPPLY_PROP_TEMP_AMBIENT: |
| /* in thenth of centigrade */ |
| if (cm->last_temp_mC == INT_MIN) |
| desc->temperature_out_of_range(&cm->last_temp_mC); |
| val->intval = cm->last_temp_mC / 100; |
| if (desc->measure_battery_temp) |
| ret = -ENODEV; |
| break; |
| case POWER_SUPPLY_PROP_CAPACITY: |
| if (!cm->fuel_gauge) { |
| ret = -ENODEV; |
| break; |
| } |
| |
| if (!is_batt_present(cm)) { |
| /* There is no battery. Assume 100% */ |
| val->intval = 100; |
| break; |
| } |
| |
| ret = cm->fuel_gauge->get_property(cm->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: |
| if (cm->fuel_gauge) { |
| if (cm->fuel_gauge->get_property(cm->fuel_gauge, |
| POWER_SUPPLY_PROP_CHARGE_FULL, val) == 0) |
| break; |
| } |
| |
| if (is_ext_pwr_online(cm)) { |
| /* Not full if it's charging. */ |
| if (is_charging(cm)) { |
| val->intval = 0; |
| break; |
| } |
| /* |
| * Full if it's powered but not charging andi |
| * not forced stop by emergency |
| */ |
| if (!cm->emergency_stop) { |
| val->intval = 1; |
| break; |
| } |
| } |
| |
| /* Full if it's over the fullbatt voltage */ |
| ret = get_batt_uV(cm, &uV); |
| if (!ret && desc->fullbatt_uV > 0 && uV >= desc->fullbatt_uV && |
| !is_charging(cm)) { |
| val->intval = 1; |
| break; |
| } |
| |
| /* Full if the cap is 100 */ |
| if (cm->fuel_gauge) { |
| ret = cm->fuel_gauge->get_property(cm->fuel_gauge, |
| POWER_SUPPLY_PROP_CAPACITY, val); |
| if (!ret && val->intval >= 100 && !is_charging(cm)) { |
| val->intval = 1; |
| break; |
| } |
| } |
| |
| val->intval = 0; |
| ret = 0; |
| break; |
| case POWER_SUPPLY_PROP_CHARGE_NOW: |
| if (is_charging(cm)) { |
| ret = cm->fuel_gauge->get_property(cm->fuel_gauge, |
| POWER_SUPPLY_PROP_CHARGE_NOW, |
| val); |
| if (ret) { |
| val->intval = 1; |
| ret = 0; |
| } else { |
| /* If CHARGE_NOW is supplied, use it */ |
| val->intval = (val->intval > 0) ? |
| val->intval : 1; |
| } |
| } else { |
| val->intval = 0; |
| } |
| break; |
| default: |
| return -EINVAL; |
| } |
| 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, |
| POWER_SUPPLY_PROP_CHARGE_FULL, |
| /* |
| * Optional properties are: |
| * POWER_SUPPLY_PROP_CHARGE_NOW, |
| * POWER_SUPPLY_PROP_CURRENT_NOW, |
| * POWER_SUPPLY_PROP_TEMP, and |
| * POWER_SUPPLY_PROP_TEMP_AMBIENT, |
| */ |
| }; |
| |
| static struct power_supply 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, |
| }; |
| |
| /** |
| * 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; |
| bool ret = false; |
| |
| mutex_lock(&cm_list_mtx); |
| |
| list_for_each_entry(cm, &cm_list, entry) { |
| unsigned int fbchk_ms = 0; |
| |
| /* fullbatt_vchk is required. setup timer for that */ |
| if (cm->fullbatt_vchk_jiffies_at) { |
| fbchk_ms = jiffies_to_msecs(cm->fullbatt_vchk_jiffies_at |
| - jiffies); |
| if (time_is_before_eq_jiffies( |
| cm->fullbatt_vchk_jiffies_at) || |
| msecs_to_jiffies(fbchk_ms) < CM_JIFFIES_SMALL) { |
| fullbatt_vchk(&cm->fullbatt_vchk_work.work); |
| fbchk_ms = 0; |
| } |
| } |
| CM_MIN_VALID(wakeup_ms, fbchk_ms); |
| |
| /* Skip if polling is not required for this CM */ |
| if (!is_polling_required(cm) && !cm->emergency_stop) |
| continue; |
| if (cm->desc->polling_interval_ms == 0) |
| continue; |
| CM_MIN_VALID(wakeup_ms, cm->desc->polling_interval_ms); |
| } |
| |
| mutex_unlock(&cm_list_mtx); |
| |
| if (wakeup_ms < UINT_MAX && wakeup_ms > 0) { |
| pr_info("Charger Manager wakeup timer: %u ms.\n", wakeup_ms); |
| if (rtc_dev) { |
| struct rtc_wkalrm tmp; |
| unsigned long time, now; |
| unsigned long add = DIV_ROUND_UP(wakeup_ms, 1000); |
| |
| /* |
| * Set alarm with the polling interval (wakeup_ms) |
| * except when rtc_wkalarm_save comes first. |
| * However, the alarm time should be NOW + |
| * CM_RTC_SMALL or later. |
| */ |
| tmp.enabled = 1; |
| rtc_read_time(rtc_dev, &tmp.time); |
| rtc_tm_to_time(&tmp.time, &now); |
| if (add < CM_RTC_SMALL) |
| add = CM_RTC_SMALL; |
| time = now + add; |
| |
| ret = true; |
| |
| if (rtc_wkalarm_save.enabled && |
| rtc_wkalarm_save_time && |
| rtc_wkalarm_save_time < time) { |
| if (rtc_wkalarm_save_time < now + CM_RTC_SMALL) |
| time = now + CM_RTC_SMALL; |
| else |
| time = rtc_wkalarm_save_time; |
| |
| /* The timer is not appointed by CM */ |
| ret = false; |
| } |
| |
| pr_info("Waking up after %lu secs.\n", |
| time - now); |
| |
| rtc_time_to_tm(time, &tmp.time); |
| rtc_set_alarm(rtc_dev, &tmp); |
| cm_suspend_duration_ms += wakeup_ms; |
| return ret; |
| } |
| } |
| |
| if (rtc_dev) |
| rtc_set_alarm(rtc_dev, &rtc_wkalarm_save); |
| return false; |
| } |
| |
| static void _cm_fbchk_in_suspend(struct charger_manager *cm) |
| { |
| unsigned long jiffy_now = jiffies; |
| |
| if (!cm->fullbatt_vchk_jiffies_at) |
| return; |
| |
| if (g_desc && g_desc->assume_timer_stops_in_suspend) |
| jiffy_now += msecs_to_jiffies(cm_suspend_duration_ms); |
| |
| /* Execute now if it's going to be executed not too long after */ |
| jiffy_now += CM_JIFFIES_SMALL; |
| |
| if (time_after_eq(jiffy_now, cm->fullbatt_vchk_jiffies_at)) |
| fullbatt_vchk(&cm->fullbatt_vchk_work.work); |
| } |
| |
| /** |
| * cm_suspend_again - Determine whether suspend again or not |
| * |
| * Returns true if the system should be suspended again |
| * Returns false if the system should be woken up |
| */ |
| bool cm_suspend_again(void) |
| { |
| struct charger_manager *cm; |
| bool ret = false; |
| |
| if (!g_desc || !g_desc->rtc_only_wakeup || !g_desc->rtc_only_wakeup() || |
| !cm_rtc_set) |
| return false; |
| |
| if (cm_monitor()) |
| goto out; |
| |
| ret = true; |
| mutex_lock(&cm_list_mtx); |
| list_for_each_entry(cm, &cm_list, entry) { |
| _cm_fbchk_in_suspend(cm); |
| |
| if (cm->status_save_ext_pwr_inserted != is_ext_pwr_online(cm) || |
| cm->status_save_batt != is_batt_present(cm)) { |
| ret = false; |
| break; |
| } |
| } |
| mutex_unlock(&cm_list_mtx); |
| |
| cm_rtc_set = cm_setup_timer(); |
| out: |
| /* It's about the time when the non-CM appointed timer goes off */ |
| if (rtc_wkalarm_save.enabled) { |
| unsigned long now; |
| struct rtc_time tmp; |
| |
| rtc_read_time(rtc_dev, &tmp); |
| rtc_tm_to_time(&tmp, &now); |
| |
| if (rtc_wkalarm_save_time && |
| now + CM_RTC_SMALL >= rtc_wkalarm_save_time) |
| return false; |
| } |
| return ret; |
| } |
| EXPORT_SYMBOL_GPL(cm_suspend_again); |
| |
| /** |
| * setup_charger_manager - initialize charger_global_desc data |
| * @gd: pointer to instance of charger_global_desc |
| */ |
| int setup_charger_manager(struct charger_global_desc *gd) |
| { |
| if (!gd) |
| return -EINVAL; |
| |
| if (rtc_dev) |
| rtc_class_close(rtc_dev); |
| rtc_dev = NULL; |
| g_desc = NULL; |
| |
| if (!gd->rtc_only_wakeup) { |
| pr_err("The callback rtc_only_wakeup is not given.\n"); |
| return -EINVAL; |
| } |
| |
| if (gd->rtc_name) { |
| rtc_dev = rtc_class_open(gd->rtc_name); |
| if (IS_ERR_OR_NULL(rtc_dev)) { |
| rtc_dev = NULL; |
| /* Retry at probe. RTC may be not registered yet */ |
| } |
| } else { |
| pr_warn("No wakeup timer is given for charger manager." |
| "In-suspend monitoring won't work.\n"); |
| } |
| |
| g_desc = gd; |
| return 0; |
| } |
| EXPORT_SYMBOL_GPL(setup_charger_manager); |
| |
| /** |
| * 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); |
| } |
| |
| try_charger_enable(cable->cm, cable->attached); |
| } |
| |
| /** |
| * 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); |
| |
| cable->attached = event; |
| 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 = 0; |
| |
| /* |
| * 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; |
| ret = extcon_register_interest(&cable->extcon_dev, |
| cable->extcon_name, cable->name, &cable->nb); |
| if (ret < 0) { |
| pr_info("Cannot register extcon_dev for %s(cable: %s).\n", |
| cable->extcon_name, |
| cable->name); |
| ret = -EINVAL; |
| } |
| |
| return ret; |
| } |
| |
| static int charger_manager_probe(struct platform_device *pdev) |
| { |
| struct charger_desc *desc = dev_get_platdata(&pdev->dev); |
| struct charger_manager *cm; |
| int ret = 0, i = 0; |
| int j = 0; |
| union power_supply_propval val; |
| |
| if (g_desc && !rtc_dev && g_desc->rtc_name) { |
| rtc_dev = rtc_class_open(g_desc->rtc_name); |
| if (IS_ERR_OR_NULL(rtc_dev)) { |
| rtc_dev = NULL; |
| dev_err(&pdev->dev, "Cannot get RTC %s.\n", |
| g_desc->rtc_name); |
| ret = -ENODEV; |
| goto err_alloc; |
| } |
| } |
| |
| if (!desc) { |
| dev_err(&pdev->dev, "No platform data (desc) found.\n"); |
| ret = -ENODEV; |
| goto err_alloc; |
| } |
| |
| cm = kzalloc(sizeof(struct charger_manager), GFP_KERNEL); |
| if (!cm) { |
| dev_err(&pdev->dev, "Cannot allocate memory.\n"); |
| ret = -ENOMEM; |
| goto err_alloc; |
| } |
| |
| /* Basic Values. Unspecified are Null or 0 */ |
| cm->dev = &pdev->dev; |
| cm->desc = kzalloc(sizeof(struct charger_desc), GFP_KERNEL); |
| if (!cm->desc) { |
| dev_err(&pdev->dev, "Cannot allocate memory.\n"); |
| ret = -ENOMEM; |
| goto err_alloc_desc; |
| } |
| memcpy(cm->desc, desc, sizeof(struct charger_desc)); |
| cm->last_temp_mC = INT_MIN; /* denotes "unmeasured, yet" */ |
| |
| /* |
| * The following two do not need to be errors. |
| * Users may intentionally ignore those two features. |
| */ |
| if (desc->fullbatt_uV == 0) { |
| dev_info(&pdev->dev, "Ignoring full-battery voltage threshold" |
| " as it is not supplied."); |
| } |
| if (!desc->fullbatt_vchkdrop_ms || !desc->fullbatt_vchkdrop_uV) { |
| dev_info(&pdev->dev, "Disabling full-battery voltage drop " |
| "checking mechanism as it is not supplied."); |
| desc->fullbatt_vchkdrop_ms = 0; |
| desc->fullbatt_vchkdrop_uV = 0; |
| } |
| |
| if (!desc->charger_regulators || desc->num_charger_regulators < 1) { |
| ret = -EINVAL; |
| dev_err(&pdev->dev, "charger_regulators undefined.\n"); |
| goto err_no_charger; |
| } |
| |
| if (!desc->psy_charger_stat || !desc->psy_charger_stat[0]) { |
| dev_err(&pdev->dev, "No power supply defined.\n"); |
| ret = -EINVAL; |
| goto err_no_charger_stat; |
| } |
| |
| /* Counting index only */ |
| while (desc->psy_charger_stat[i]) |
| i++; |
| |
| cm->charger_stat = kzalloc(sizeof(struct power_supply *) * (i + 1), |
| GFP_KERNEL); |
| if (!cm->charger_stat) { |
| ret = -ENOMEM; |
| goto err_no_charger_stat; |
| } |
| |
| for (i = 0; desc->psy_charger_stat[i]; i++) { |
| cm->charger_stat[i] = power_supply_get_by_name( |
| desc->psy_charger_stat[i]); |
| if (!cm->charger_stat[i]) { |
| dev_err(&pdev->dev, "Cannot find power supply " |
| "\"%s\"\n", |
| desc->psy_charger_stat[i]); |
| ret = -ENODEV; |
| goto err_chg_stat; |
| } |
| } |
| |
| cm->fuel_gauge = power_supply_get_by_name(desc->psy_fuel_gauge); |
| if (!cm->fuel_gauge) { |
| dev_err(&pdev->dev, "Cannot find power supply \"%s\"\n", |
| desc->psy_fuel_gauge); |
| ret = -ENODEV; |
| goto err_chg_stat; |
| } |
| |
| if (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"); |
| ret = -EINVAL; |
| goto err_chg_stat; |
| } |
| |
| if (!desc->temperature_out_of_range) { |
| dev_err(&pdev->dev, "there is no temperature_out_of_range\n"); |
| ret = -EINVAL; |
| goto err_chg_stat; |
| } |
| |
| platform_set_drvdata(pdev, cm); |
| |
| memcpy(&cm->charger_psy, &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.name = cm->psy_name_buf; |
| |
| /* Allocate for psy properties because they may vary */ |
| cm->charger_psy.properties = kzalloc(sizeof(enum power_supply_property) |
| * (ARRAY_SIZE(default_charger_props) + |
| NUM_CHARGER_PSY_OPTIONAL), |
| GFP_KERNEL); |
| if (!cm->charger_psy.properties) { |
| dev_err(&pdev->dev, "Cannot allocate for psy properties.\n"); |
| ret = -ENOMEM; |
| goto err_chg_stat; |
| } |
| memcpy(cm->charger_psy.properties, default_charger_props, |
| sizeof(enum power_supply_property) * |
| ARRAY_SIZE(default_charger_props)); |
| cm->charger_psy.num_properties = psy_default.num_properties; |
| |
| /* Find which optional psy-properties are available */ |
| if (!cm->fuel_gauge->get_property(cm->fuel_gauge, |
| POWER_SUPPLY_PROP_CHARGE_NOW, &val)) { |
| cm->charger_psy.properties[cm->charger_psy.num_properties] = |
| POWER_SUPPLY_PROP_CHARGE_NOW; |
| cm->charger_psy.num_properties++; |
| } |
| if (!cm->fuel_gauge->get_property(cm->fuel_gauge, |
| POWER_SUPPLY_PROP_CURRENT_NOW, |
| &val)) { |
| cm->charger_psy.properties[cm->charger_psy.num_properties] = |
| POWER_SUPPLY_PROP_CURRENT_NOW; |
| cm->charger_psy.num_properties++; |
| } |
| |
| if (desc->measure_battery_temp) { |
| cm->charger_psy.properties[cm->charger_psy.num_properties] = |
| POWER_SUPPLY_PROP_TEMP; |
| cm->charger_psy.num_properties++; |
| } else { |
| cm->charger_psy.properties[cm->charger_psy.num_properties] = |
| POWER_SUPPLY_PROP_TEMP_AMBIENT; |
| cm->charger_psy.num_properties++; |
| } |
| |
| INIT_DELAYED_WORK(&cm->fullbatt_vchk_work, fullbatt_vchk); |
| |
| ret = power_supply_register(NULL, &cm->charger_psy); |
| if (ret) { |
| dev_err(&pdev->dev, "Cannot register charger-manager with" |
| " name \"%s\".\n", cm->charger_psy.name); |
| goto err_register; |
| } |
| |
| for (i = 0 ; i < desc->num_charger_regulators ; i++) { |
| struct charger_regulator *charger |
| = &desc->charger_regulators[i]; |
| |
| charger->consumer = regulator_get(&pdev->dev, |
| charger->regulator_name); |
| if (charger->consumer == NULL) { |
| dev_err(&pdev->dev, "Cannot find charger(%s)n", |
| charger->regulator_name); |
| ret = -EINVAL; |
| goto err_chg_get; |
| } |
| |
| 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(&pdev->dev, "Cannot find charger(%s)n", |
| charger->regulator_name); |
| goto err_extcon; |
| } |
| cable->charger = charger; |
| cable->cm = cm; |
| } |
| } |
| |
| ret = try_charger_enable(cm, true); |
| if (ret) { |
| dev_err(&pdev->dev, "Cannot enable charger regulators\n"); |
| goto err_chg_enable; |
| } |
| |
| /* Add to the list */ |
| mutex_lock(&cm_list_mtx); |
| list_add(&cm->entry, &cm_list); |
| mutex_unlock(&cm_list_mtx); |
| |
| /* |
| * Charger-manager is capable of waking up the systme from sleep |
| * when event is happend through cm_notify_event() |
| */ |
| device_init_wakeup(&pdev->dev, true); |
| device_set_wakeup_capable(&pdev->dev, false); |
| |
| schedule_work(&setup_polling); |
| |
| return 0; |
| |
| err_chg_enable: |
| err_extcon: |
| for (i = 0 ; i < desc->num_charger_regulators ; i++) { |
| struct charger_regulator *charger |
| = &desc->charger_regulators[i]; |
| for (j = 0 ; j < charger->num_cables ; j++) { |
| struct charger_cable *cable = &charger->cables[j]; |
| extcon_unregister_interest(&cable->extcon_dev); |
| } |
| } |
| err_chg_get: |
| for (i = 0 ; i < desc->num_charger_regulators ; i++) |
| regulator_put(desc->charger_regulators[i].consumer); |
| |
| power_supply_unregister(&cm->charger_psy); |
| err_register: |
| kfree(cm->charger_psy.properties); |
| err_chg_stat: |
| kfree(cm->charger_stat); |
| err_no_charger_stat: |
| err_no_charger: |
| kfree(cm->desc); |
| err_alloc_desc: |
| kfree(cm); |
| err_alloc: |
| return ret; |
| } |
| |
| static int __devexit charger_manager_remove(struct platform_device *pdev) |
| { |
| struct charger_manager *cm = platform_get_drvdata(pdev); |
| struct charger_desc *desc = cm->desc; |
| int i = 0; |
| int j = 0; |
| |
| /* Remove from the list */ |
| mutex_lock(&cm_list_mtx); |
| list_del(&cm->entry); |
| mutex_unlock(&cm_list_mtx); |
| |
| if (work_pending(&setup_polling)) |
| cancel_work_sync(&setup_polling); |
| if (delayed_work_pending(&cm_monitor_work)) |
| cancel_delayed_work_sync(&cm_monitor_work); |
| |
| for (i = 0 ; i < desc->num_charger_regulators ; i++) { |
| struct charger_regulator *charger |
| = &desc->charger_regulators[i]; |
| for (j = 0 ; j < charger->num_cables ; j++) { |
| struct charger_cable *cable = &charger->cables[j]; |
| extcon_unregister_interest(&cable->extcon_dev); |
| } |
| } |
| |
| 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); |
| |
| kfree(cm->charger_psy.properties); |
| kfree(cm->charger_stat); |
| kfree(cm->desc); |
| kfree(cm); |
| |
| 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) |
| { |
| int ret = 0; |
| |
| if (device_may_wakeup(dev)) { |
| device_set_wakeup_capable(dev, false); |
| ret = -EAGAIN; |
| } |
| |
| return ret; |
| } |
| |
| static int cm_suspend_prepare(struct device *dev) |
| { |
| struct charger_manager *cm = dev_get_drvdata(dev); |
| |
| if (!cm_suspended) { |
| if (rtc_dev) { |
| struct rtc_time tmp; |
| unsigned long now; |
| |
| rtc_read_alarm(rtc_dev, &rtc_wkalarm_save); |
| rtc_read_time(rtc_dev, &tmp); |
| |
| if (rtc_wkalarm_save.enabled) { |
| rtc_tm_to_time(&rtc_wkalarm_save.time, |
| &rtc_wkalarm_save_time); |
| rtc_tm_to_time(&tmp, &now); |
| if (now > rtc_wkalarm_save_time) |
| rtc_wkalarm_save_time = 0; |
| } else { |
| rtc_wkalarm_save_time = 0; |
| } |
| } |
| cm_suspended = true; |
| } |
| |
| if (delayed_work_pending(&cm->fullbatt_vchk_work)) |
| cancel_delayed_work(&cm->fullbatt_vchk_work); |
| cm->status_save_ext_pwr_inserted = is_ext_pwr_online(cm); |
| cm->status_save_batt = is_batt_present(cm); |
| |
| if (!cm_rtc_set) { |
| cm_suspend_duration_ms = 0; |
| cm_rtc_set = cm_setup_timer(); |
| } |
| |
| return 0; |
| } |
| |
| static void cm_suspend_complete(struct device *dev) |
| { |
| struct charger_manager *cm = dev_get_drvdata(dev); |
| |
| if (cm_suspended) { |
| if (rtc_dev) { |
| struct rtc_wkalrm tmp; |
| |
| rtc_read_alarm(rtc_dev, &tmp); |
| rtc_wkalarm_save.pending = tmp.pending; |
| rtc_set_alarm(rtc_dev, &rtc_wkalarm_save); |
| } |
| cm_suspended = false; |
| cm_rtc_set = false; |
| } |
| |
| /* Re-enqueue delayed work (fullbatt_vchk_work) */ |
| if (cm->fullbatt_vchk_jiffies_at) { |
| unsigned long delay = 0; |
| unsigned long now = jiffies + CM_JIFFIES_SMALL; |
| |
| if (time_after_eq(now, cm->fullbatt_vchk_jiffies_at)) { |
| delay = (unsigned long)((long)now |
| - (long)(cm->fullbatt_vchk_jiffies_at)); |
| delay = jiffies_to_msecs(delay); |
| } else { |
| delay = 0; |
| } |
| |
| /* |
| * Account for cm_suspend_duration_ms if |
| * assume_timer_stops_in_suspend is active |
| */ |
| if (g_desc && g_desc->assume_timer_stops_in_suspend) { |
| if (delay > cm_suspend_duration_ms) |
| delay -= cm_suspend_duration_ms; |
| else |
| delay = 0; |
| } |
| |
| queue_delayed_work(cm_wq, &cm->fullbatt_vchk_work, |
| msecs_to_jiffies(delay)); |
| } |
| device_set_wakeup_capable(cm->dev, false); |
| uevent_notify(cm, NULL); |
| } |
| |
| 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", |
| .owner = THIS_MODULE, |
| .pm = &charger_manager_pm, |
| }, |
| .probe = charger_manager_probe, |
| .remove = __devexit_p(charger_manager_remove), |
| .id_table = charger_manager_id, |
| }; |
| |
| static int __init charger_manager_init(void) |
| { |
| cm_wq = create_freezable_workqueue("charger_manager"); |
| 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); |
| |
| /** |
| * find_power_supply - find the associated power_supply of charger |
| * @cm: the Charger Manager representing the battery |
| * @psy: pointer to instance of charger's power_supply |
| */ |
| static bool find_power_supply(struct charger_manager *cm, |
| struct power_supply *psy) |
| { |
| int i; |
| bool found = false; |
| |
| for (i = 0; cm->charger_stat[i]; i++) { |
| if (psy == cm->charger_stat[i]) { |
| found = true; |
| break; |
| } |
| } |
| |
| return found; |
| } |
| |
| /** |
| * cm_notify_event - charger driver notify Charger Manager of charger event |
| * @psy: pointer to instance of charger's power_supply |
| * @type: type of charger event |
| * @msg: optional message passed to uevent_notify fuction |
| */ |
| void cm_notify_event(struct power_supply *psy, enum cm_event_types type, |
| char *msg) |
| { |
| struct charger_manager *cm; |
| bool found_power_supply = false; |
| |
| if (psy == NULL) |
| return; |
| |
| mutex_lock(&cm_list_mtx); |
| list_for_each_entry(cm, &cm_list, entry) { |
| found_power_supply = find_power_supply(cm, psy); |
| if (found_power_supply) |
| break; |
| } |
| mutex_unlock(&cm_list_mtx); |
| |
| if (!found_power_supply) |
| return; |
| |
| switch (type) { |
| case CM_EVENT_BATT_FULL: |
| fullbatt_handler(cm); |
| break; |
| case CM_EVENT_BATT_OUT: |
| battout_handler(cm); |
| break; |
| case CM_EVENT_BATT_IN: |
| case CM_EVENT_EXT_PWR_IN_OUT ... CM_EVENT_CHG_START_STOP: |
| misc_event_handler(cm, type); |
| break; |
| case CM_EVENT_UNKNOWN: |
| case CM_EVENT_OTHERS: |
| uevent_notify(cm, msg ? msg : default_event_names[type]); |
| break; |
| default: |
| dev_err(cm->dev, "%s type not specified.\n", __func__); |
| break; |
| } |
| } |
| EXPORT_SYMBOL_GPL(cm_notify_event); |
| |
| MODULE_AUTHOR("MyungJoo Ham <myungjoo.ham@samsung.com>"); |
| MODULE_DESCRIPTION("Charger Manager"); |
| MODULE_LICENSE("GPL"); |