charger-manager.c 27 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072
  1. /*
  2. * Copyright (C) 2011 Samsung Electronics Co., Ltd.
  3. * MyungJoo Ham <myungjoo.ham@samsung.com>
  4. *
  5. * This driver enables to monitor battery health and control charger
  6. * during suspend-to-mem.
  7. * Charger manager depends on other devices. register this later than
  8. * the depending devices.
  9. *
  10. * This program is free software; you can redistribute it and/or modify
  11. * it under the terms of the GNU General Public License version 2 as
  12. * published by the Free Software Foundation.
  13. **/
  14. #include <linux/io.h>
  15. #include <linux/module.h>
  16. #include <linux/irq.h>
  17. #include <linux/interrupt.h>
  18. #include <linux/rtc.h>
  19. #include <linux/slab.h>
  20. #include <linux/workqueue.h>
  21. #include <linux/platform_device.h>
  22. #include <linux/power/charger-manager.h>
  23. #include <linux/regulator/consumer.h>
  24. /*
  25. * Regard CM_JIFFIES_SMALL jiffies is small enough to ignore for
  26. * delayed works so that we can run delayed works with CM_JIFFIES_SMALL
  27. * without any delays.
  28. */
  29. #define CM_JIFFIES_SMALL (2)
  30. /* If y is valid (> 0) and smaller than x, do x = y */
  31. #define CM_MIN_VALID(x, y) x = (((y > 0) && ((x) > (y))) ? (y) : (x))
  32. /*
  33. * Regard CM_RTC_SMALL (sec) is small enough to ignore error in invoking
  34. * rtc alarm. It should be 2 or larger
  35. */
  36. #define CM_RTC_SMALL (2)
  37. #define UEVENT_BUF_SIZE 32
  38. static LIST_HEAD(cm_list);
  39. static DEFINE_MUTEX(cm_list_mtx);
  40. /* About in-suspend (suspend-again) monitoring */
  41. static struct rtc_device *rtc_dev;
  42. /*
  43. * Backup RTC alarm
  44. * Save the wakeup alarm before entering suspend-to-RAM
  45. */
  46. static struct rtc_wkalrm rtc_wkalarm_save;
  47. /* Backup RTC alarm time in terms of seconds since 01-01-1970 00:00:00 */
  48. static unsigned long rtc_wkalarm_save_time;
  49. static bool cm_suspended;
  50. static bool cm_rtc_set;
  51. static unsigned long cm_suspend_duration_ms;
  52. /* Global charger-manager description */
  53. static struct charger_global_desc *g_desc; /* init with setup_charger_manager */
  54. /**
  55. * is_batt_present - See if the battery presents in place.
  56. * @cm: the Charger Manager representing the battery.
  57. */
  58. static bool is_batt_present(struct charger_manager *cm)
  59. {
  60. union power_supply_propval val;
  61. bool present = false;
  62. int i, ret;
  63. switch (cm->desc->battery_present) {
  64. case CM_FUEL_GAUGE:
  65. ret = cm->fuel_gauge->get_property(cm->fuel_gauge,
  66. POWER_SUPPLY_PROP_PRESENT, &val);
  67. if (ret == 0 && val.intval)
  68. present = true;
  69. break;
  70. case CM_CHARGER_STAT:
  71. for (i = 0; cm->charger_stat[i]; i++) {
  72. ret = cm->charger_stat[i]->get_property(
  73. cm->charger_stat[i],
  74. POWER_SUPPLY_PROP_PRESENT, &val);
  75. if (ret == 0 && val.intval) {
  76. present = true;
  77. break;
  78. }
  79. }
  80. break;
  81. }
  82. return present;
  83. }
  84. /**
  85. * is_ext_pwr_online - See if an external power source is attached to charge
  86. * @cm: the Charger Manager representing the battery.
  87. *
  88. * Returns true if at least one of the chargers of the battery has an external
  89. * power source attached to charge the battery regardless of whether it is
  90. * actually charging or not.
  91. */
  92. static bool is_ext_pwr_online(struct charger_manager *cm)
  93. {
  94. union power_supply_propval val;
  95. bool online = false;
  96. int i, ret;
  97. /* If at least one of them has one, it's yes. */
  98. for (i = 0; cm->charger_stat[i]; i++) {
  99. ret = cm->charger_stat[i]->get_property(
  100. cm->charger_stat[i],
  101. POWER_SUPPLY_PROP_ONLINE, &val);
  102. if (ret == 0 && val.intval) {
  103. online = true;
  104. break;
  105. }
  106. }
  107. return online;
  108. }
  109. /**
  110. * get_batt_uV - Get the voltage level of the battery
  111. * @cm: the Charger Manager representing the battery.
  112. * @uV: the voltage level returned.
  113. *
  114. * Returns 0 if there is no error.
  115. * Returns a negative value on error.
  116. */
  117. static int get_batt_uV(struct charger_manager *cm, int *uV)
  118. {
  119. union power_supply_propval val;
  120. int ret;
  121. if (cm->fuel_gauge)
  122. ret = cm->fuel_gauge->get_property(cm->fuel_gauge,
  123. POWER_SUPPLY_PROP_VOLTAGE_NOW, &val);
  124. else
  125. return -ENODEV;
  126. if (ret)
  127. return ret;
  128. *uV = val.intval;
  129. return 0;
  130. }
  131. /**
  132. * is_charging - Returns true if the battery is being charged.
  133. * @cm: the Charger Manager representing the battery.
  134. */
  135. static bool is_charging(struct charger_manager *cm)
  136. {
  137. int i, ret;
  138. bool charging = false;
  139. union power_supply_propval val;
  140. /* If there is no battery, it cannot be charged */
  141. if (!is_batt_present(cm))
  142. return false;
  143. /* If at least one of the charger is charging, return yes */
  144. for (i = 0; cm->charger_stat[i]; i++) {
  145. /* 1. The charger sholuld not be DISABLED */
  146. if (cm->emergency_stop)
  147. continue;
  148. if (!cm->charger_enabled)
  149. continue;
  150. /* 2. The charger should be online (ext-power) */
  151. ret = cm->charger_stat[i]->get_property(
  152. cm->charger_stat[i],
  153. POWER_SUPPLY_PROP_ONLINE, &val);
  154. if (ret) {
  155. dev_warn(cm->dev, "Cannot read ONLINE value from %s.\n",
  156. cm->desc->psy_charger_stat[i]);
  157. continue;
  158. }
  159. if (val.intval == 0)
  160. continue;
  161. /*
  162. * 3. The charger should not be FULL, DISCHARGING,
  163. * or NOT_CHARGING.
  164. */
  165. ret = cm->charger_stat[i]->get_property(
  166. cm->charger_stat[i],
  167. POWER_SUPPLY_PROP_STATUS, &val);
  168. if (ret) {
  169. dev_warn(cm->dev, "Cannot read STATUS value from %s.\n",
  170. cm->desc->psy_charger_stat[i]);
  171. continue;
  172. }
  173. if (val.intval == POWER_SUPPLY_STATUS_FULL ||
  174. val.intval == POWER_SUPPLY_STATUS_DISCHARGING ||
  175. val.intval == POWER_SUPPLY_STATUS_NOT_CHARGING)
  176. continue;
  177. /* Then, this is charging. */
  178. charging = true;
  179. break;
  180. }
  181. return charging;
  182. }
  183. /**
  184. * is_polling_required - Return true if need to continue polling for this CM.
  185. * @cm: the Charger Manager representing the battery.
  186. */
  187. static bool is_polling_required(struct charger_manager *cm)
  188. {
  189. switch (cm->desc->polling_mode) {
  190. case CM_POLL_DISABLE:
  191. return false;
  192. case CM_POLL_ALWAYS:
  193. return true;
  194. case CM_POLL_EXTERNAL_POWER_ONLY:
  195. return is_ext_pwr_online(cm);
  196. case CM_POLL_CHARGING_ONLY:
  197. return is_charging(cm);
  198. default:
  199. dev_warn(cm->dev, "Incorrect polling_mode (%d)\n",
  200. cm->desc->polling_mode);
  201. }
  202. return false;
  203. }
  204. /**
  205. * try_charger_enable - Enable/Disable chargers altogether
  206. * @cm: the Charger Manager representing the battery.
  207. * @enable: true: enable / false: disable
  208. *
  209. * Note that Charger Manager keeps the charger enabled regardless whether
  210. * the charger is charging or not (because battery is full or no external
  211. * power source exists) except when CM needs to disable chargers forcibly
  212. * bacause of emergency causes; when the battery is overheated or too cold.
  213. */
  214. static int try_charger_enable(struct charger_manager *cm, bool enable)
  215. {
  216. int err = 0, i;
  217. struct charger_desc *desc = cm->desc;
  218. /* Ignore if it's redundent command */
  219. if (enable && cm->charger_enabled)
  220. return 0;
  221. if (!enable && !cm->charger_enabled)
  222. return 0;
  223. if (enable) {
  224. if (cm->emergency_stop)
  225. return -EAGAIN;
  226. err = regulator_bulk_enable(desc->num_charger_regulators,
  227. desc->charger_regulators);
  228. } else {
  229. /*
  230. * Abnormal battery state - Stop charging forcibly,
  231. * even if charger was enabled at the other places
  232. */
  233. err = regulator_bulk_disable(desc->num_charger_regulators,
  234. desc->charger_regulators);
  235. for (i = 0; i < desc->num_charger_regulators; i++) {
  236. if (regulator_is_enabled(
  237. desc->charger_regulators[i].consumer)) {
  238. regulator_force_disable(
  239. desc->charger_regulators[i].consumer);
  240. dev_warn(cm->dev,
  241. "Disable regulator(%s) forcibly.\n",
  242. desc->charger_regulators[i].supply);
  243. }
  244. }
  245. }
  246. if (!err)
  247. cm->charger_enabled = enable;
  248. return err;
  249. }
  250. /**
  251. * uevent_notify - Let users know something has changed.
  252. * @cm: the Charger Manager representing the battery.
  253. * @event: the event string.
  254. *
  255. * If @event is null, it implies that uevent_notify is called
  256. * by resume function. When called in the resume function, cm_suspended
  257. * should be already reset to false in order to let uevent_notify
  258. * notify the recent event during the suspend to users. While
  259. * suspended, uevent_notify does not notify users, but tracks
  260. * events so that uevent_notify can notify users later after resumed.
  261. */
  262. static void uevent_notify(struct charger_manager *cm, const char *event)
  263. {
  264. static char env_str[UEVENT_BUF_SIZE + 1] = "";
  265. static char env_str_save[UEVENT_BUF_SIZE + 1] = "";
  266. if (cm_suspended) {
  267. /* Nothing in suspended-event buffer */
  268. if (env_str_save[0] == 0) {
  269. if (!strncmp(env_str, event, UEVENT_BUF_SIZE))
  270. return; /* status not changed */
  271. strncpy(env_str_save, event, UEVENT_BUF_SIZE);
  272. return;
  273. }
  274. if (!strncmp(env_str_save, event, UEVENT_BUF_SIZE))
  275. return; /* Duplicated. */
  276. else
  277. strncpy(env_str_save, event, UEVENT_BUF_SIZE);
  278. return;
  279. }
  280. if (event == NULL) {
  281. /* No messages pending */
  282. if (!env_str_save[0])
  283. return;
  284. strncpy(env_str, env_str_save, UEVENT_BUF_SIZE);
  285. kobject_uevent(&cm->dev->kobj, KOBJ_CHANGE);
  286. env_str_save[0] = 0;
  287. return;
  288. }
  289. /* status not changed */
  290. if (!strncmp(env_str, event, UEVENT_BUF_SIZE))
  291. return;
  292. /* save the status and notify the update */
  293. strncpy(env_str, event, UEVENT_BUF_SIZE);
  294. kobject_uevent(&cm->dev->kobj, KOBJ_CHANGE);
  295. dev_info(cm->dev, event);
  296. }
  297. /**
  298. * _cm_monitor - Monitor the temperature and return true for exceptions.
  299. * @cm: the Charger Manager representing the battery.
  300. *
  301. * Returns true if there is an event to notify for the battery.
  302. * (True if the status of "emergency_stop" changes)
  303. */
  304. static bool _cm_monitor(struct charger_manager *cm)
  305. {
  306. struct charger_desc *desc = cm->desc;
  307. int temp = desc->temperature_out_of_range(&cm->last_temp_mC);
  308. dev_dbg(cm->dev, "monitoring (%2.2d.%3.3dC)\n",
  309. cm->last_temp_mC / 1000, cm->last_temp_mC % 1000);
  310. /* It has been stopped or charging already */
  311. if (!!temp == !!cm->emergency_stop)
  312. return false;
  313. if (temp) {
  314. cm->emergency_stop = temp;
  315. if (!try_charger_enable(cm, false)) {
  316. if (temp > 0)
  317. uevent_notify(cm, "OVERHEAT");
  318. else
  319. uevent_notify(cm, "COLD");
  320. }
  321. } else {
  322. cm->emergency_stop = 0;
  323. if (!try_charger_enable(cm, true))
  324. uevent_notify(cm, "CHARGING");
  325. }
  326. return true;
  327. }
  328. /**
  329. * cm_monitor - Monitor every battery.
  330. *
  331. * Returns true if there is an event to notify from any of the batteries.
  332. * (True if the status of "emergency_stop" changes)
  333. */
  334. static bool cm_monitor(void)
  335. {
  336. bool stop = false;
  337. struct charger_manager *cm;
  338. mutex_lock(&cm_list_mtx);
  339. list_for_each_entry(cm, &cm_list, entry)
  340. stop = stop || _cm_monitor(cm);
  341. mutex_unlock(&cm_list_mtx);
  342. return stop;
  343. }
  344. static int charger_get_property(struct power_supply *psy,
  345. enum power_supply_property psp,
  346. union power_supply_propval *val)
  347. {
  348. struct charger_manager *cm = container_of(psy,
  349. struct charger_manager, charger_psy);
  350. struct charger_desc *desc = cm->desc;
  351. int i, ret = 0, uV;
  352. switch (psp) {
  353. case POWER_SUPPLY_PROP_STATUS:
  354. if (is_charging(cm))
  355. val->intval = POWER_SUPPLY_STATUS_CHARGING;
  356. else if (is_ext_pwr_online(cm))
  357. val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
  358. else
  359. val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
  360. break;
  361. case POWER_SUPPLY_PROP_HEALTH:
  362. if (cm->emergency_stop > 0)
  363. val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
  364. else if (cm->emergency_stop < 0)
  365. val->intval = POWER_SUPPLY_HEALTH_COLD;
  366. else
  367. val->intval = POWER_SUPPLY_HEALTH_GOOD;
  368. break;
  369. case POWER_SUPPLY_PROP_PRESENT:
  370. if (is_batt_present(cm))
  371. val->intval = 1;
  372. else
  373. val->intval = 0;
  374. break;
  375. case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  376. ret = get_batt_uV(cm, &i);
  377. val->intval = i;
  378. break;
  379. case POWER_SUPPLY_PROP_CURRENT_NOW:
  380. ret = cm->fuel_gauge->get_property(cm->fuel_gauge,
  381. POWER_SUPPLY_PROP_CURRENT_NOW, val);
  382. break;
  383. case POWER_SUPPLY_PROP_TEMP:
  384. /* in thenth of centigrade */
  385. if (cm->last_temp_mC == INT_MIN)
  386. desc->temperature_out_of_range(&cm->last_temp_mC);
  387. val->intval = cm->last_temp_mC / 100;
  388. if (!desc->measure_battery_temp)
  389. ret = -ENODEV;
  390. break;
  391. case POWER_SUPPLY_PROP_TEMP_AMBIENT:
  392. /* in thenth of centigrade */
  393. if (cm->last_temp_mC == INT_MIN)
  394. desc->temperature_out_of_range(&cm->last_temp_mC);
  395. val->intval = cm->last_temp_mC / 100;
  396. if (desc->measure_battery_temp)
  397. ret = -ENODEV;
  398. break;
  399. case POWER_SUPPLY_PROP_CAPACITY:
  400. if (!cm->fuel_gauge) {
  401. ret = -ENODEV;
  402. break;
  403. }
  404. if (!is_batt_present(cm)) {
  405. /* There is no battery. Assume 100% */
  406. val->intval = 100;
  407. break;
  408. }
  409. ret = cm->fuel_gauge->get_property(cm->fuel_gauge,
  410. POWER_SUPPLY_PROP_CAPACITY, val);
  411. if (ret)
  412. break;
  413. if (val->intval > 100) {
  414. val->intval = 100;
  415. break;
  416. }
  417. if (val->intval < 0)
  418. val->intval = 0;
  419. /* Do not adjust SOC when charging: voltage is overrated */
  420. if (is_charging(cm))
  421. break;
  422. /*
  423. * If the capacity value is inconsistent, calibrate it base on
  424. * the battery voltage values and the thresholds given as desc
  425. */
  426. ret = get_batt_uV(cm, &uV);
  427. if (ret) {
  428. /* Voltage information not available. No calibration */
  429. ret = 0;
  430. break;
  431. }
  432. if (desc->fullbatt_uV > 0 && uV >= desc->fullbatt_uV &&
  433. !is_charging(cm)) {
  434. val->intval = 100;
  435. break;
  436. }
  437. break;
  438. case POWER_SUPPLY_PROP_ONLINE:
  439. if (is_ext_pwr_online(cm))
  440. val->intval = 1;
  441. else
  442. val->intval = 0;
  443. break;
  444. case POWER_SUPPLY_PROP_CHARGE_FULL:
  445. if (cm->fuel_gauge) {
  446. if (cm->fuel_gauge->get_property(cm->fuel_gauge,
  447. POWER_SUPPLY_PROP_CHARGE_FULL, val) == 0)
  448. break;
  449. }
  450. if (is_ext_pwr_online(cm)) {
  451. /* Not full if it's charging. */
  452. if (is_charging(cm)) {
  453. val->intval = 0;
  454. break;
  455. }
  456. /*
  457. * Full if it's powered but not charging andi
  458. * not forced stop by emergency
  459. */
  460. if (!cm->emergency_stop) {
  461. val->intval = 1;
  462. break;
  463. }
  464. }
  465. /* Full if it's over the fullbatt voltage */
  466. ret = get_batt_uV(cm, &uV);
  467. if (!ret && desc->fullbatt_uV > 0 && uV >= desc->fullbatt_uV &&
  468. !is_charging(cm)) {
  469. val->intval = 1;
  470. break;
  471. }
  472. /* Full if the cap is 100 */
  473. if (cm->fuel_gauge) {
  474. ret = cm->fuel_gauge->get_property(cm->fuel_gauge,
  475. POWER_SUPPLY_PROP_CAPACITY, val);
  476. if (!ret && val->intval >= 100 && !is_charging(cm)) {
  477. val->intval = 1;
  478. break;
  479. }
  480. }
  481. val->intval = 0;
  482. ret = 0;
  483. break;
  484. case POWER_SUPPLY_PROP_CHARGE_NOW:
  485. if (is_charging(cm)) {
  486. ret = cm->fuel_gauge->get_property(cm->fuel_gauge,
  487. POWER_SUPPLY_PROP_CHARGE_NOW,
  488. val);
  489. if (ret) {
  490. val->intval = 1;
  491. ret = 0;
  492. } else {
  493. /* If CHARGE_NOW is supplied, use it */
  494. val->intval = (val->intval > 0) ?
  495. val->intval : 1;
  496. }
  497. } else {
  498. val->intval = 0;
  499. }
  500. break;
  501. default:
  502. return -EINVAL;
  503. }
  504. return ret;
  505. }
  506. #define NUM_CHARGER_PSY_OPTIONAL (4)
  507. static enum power_supply_property default_charger_props[] = {
  508. /* Guaranteed to provide */
  509. POWER_SUPPLY_PROP_STATUS,
  510. POWER_SUPPLY_PROP_HEALTH,
  511. POWER_SUPPLY_PROP_PRESENT,
  512. POWER_SUPPLY_PROP_VOLTAGE_NOW,
  513. POWER_SUPPLY_PROP_CAPACITY,
  514. POWER_SUPPLY_PROP_ONLINE,
  515. POWER_SUPPLY_PROP_CHARGE_FULL,
  516. /*
  517. * Optional properties are:
  518. * POWER_SUPPLY_PROP_CHARGE_NOW,
  519. * POWER_SUPPLY_PROP_CURRENT_NOW,
  520. * POWER_SUPPLY_PROP_TEMP, and
  521. * POWER_SUPPLY_PROP_TEMP_AMBIENT,
  522. */
  523. };
  524. static struct power_supply psy_default = {
  525. .name = "battery",
  526. .type = POWER_SUPPLY_TYPE_BATTERY,
  527. .properties = default_charger_props,
  528. .num_properties = ARRAY_SIZE(default_charger_props),
  529. .get_property = charger_get_property,
  530. };
  531. /**
  532. * cm_setup_timer - For in-suspend monitoring setup wakeup alarm
  533. * for suspend_again.
  534. *
  535. * Returns true if the alarm is set for Charger Manager to use.
  536. * Returns false if
  537. * cm_setup_timer fails to set an alarm,
  538. * cm_setup_timer does not need to set an alarm for Charger Manager,
  539. * or an alarm previously configured is to be used.
  540. */
  541. static bool cm_setup_timer(void)
  542. {
  543. struct charger_manager *cm;
  544. unsigned int wakeup_ms = UINT_MAX;
  545. bool ret = false;
  546. mutex_lock(&cm_list_mtx);
  547. list_for_each_entry(cm, &cm_list, entry) {
  548. /* Skip if polling is not required for this CM */
  549. if (!is_polling_required(cm) && !cm->emergency_stop)
  550. continue;
  551. if (cm->desc->polling_interval_ms == 0)
  552. continue;
  553. CM_MIN_VALID(wakeup_ms, cm->desc->polling_interval_ms);
  554. }
  555. mutex_unlock(&cm_list_mtx);
  556. if (wakeup_ms < UINT_MAX && wakeup_ms > 0) {
  557. pr_info("Charger Manager wakeup timer: %u ms.\n", wakeup_ms);
  558. if (rtc_dev) {
  559. struct rtc_wkalrm tmp;
  560. unsigned long time, now;
  561. unsigned long add = DIV_ROUND_UP(wakeup_ms, 1000);
  562. /*
  563. * Set alarm with the polling interval (wakeup_ms)
  564. * except when rtc_wkalarm_save comes first.
  565. * However, the alarm time should be NOW +
  566. * CM_RTC_SMALL or later.
  567. */
  568. tmp.enabled = 1;
  569. rtc_read_time(rtc_dev, &tmp.time);
  570. rtc_tm_to_time(&tmp.time, &now);
  571. if (add < CM_RTC_SMALL)
  572. add = CM_RTC_SMALL;
  573. time = now + add;
  574. ret = true;
  575. if (rtc_wkalarm_save.enabled &&
  576. rtc_wkalarm_save_time &&
  577. rtc_wkalarm_save_time < time) {
  578. if (rtc_wkalarm_save_time < now + CM_RTC_SMALL)
  579. time = now + CM_RTC_SMALL;
  580. else
  581. time = rtc_wkalarm_save_time;
  582. /* The timer is not appointed by CM */
  583. ret = false;
  584. }
  585. pr_info("Waking up after %lu secs.\n",
  586. time - now);
  587. rtc_time_to_tm(time, &tmp.time);
  588. rtc_set_alarm(rtc_dev, &tmp);
  589. cm_suspend_duration_ms += wakeup_ms;
  590. return ret;
  591. }
  592. }
  593. if (rtc_dev)
  594. rtc_set_alarm(rtc_dev, &rtc_wkalarm_save);
  595. return false;
  596. }
  597. /**
  598. * cm_suspend_again - Determine whether suspend again or not
  599. *
  600. * Returns true if the system should be suspended again
  601. * Returns false if the system should be woken up
  602. */
  603. bool cm_suspend_again(void)
  604. {
  605. struct charger_manager *cm;
  606. bool ret = false;
  607. if (!g_desc || !g_desc->rtc_only_wakeup || !g_desc->rtc_only_wakeup() ||
  608. !cm_rtc_set)
  609. return false;
  610. if (cm_monitor())
  611. goto out;
  612. ret = true;
  613. mutex_lock(&cm_list_mtx);
  614. list_for_each_entry(cm, &cm_list, entry) {
  615. if (cm->status_save_ext_pwr_inserted != is_ext_pwr_online(cm) ||
  616. cm->status_save_batt != is_batt_present(cm))
  617. ret = false;
  618. }
  619. mutex_unlock(&cm_list_mtx);
  620. cm_rtc_set = cm_setup_timer();
  621. out:
  622. /* It's about the time when the non-CM appointed timer goes off */
  623. if (rtc_wkalarm_save.enabled) {
  624. unsigned long now;
  625. struct rtc_time tmp;
  626. rtc_read_time(rtc_dev, &tmp);
  627. rtc_tm_to_time(&tmp, &now);
  628. if (rtc_wkalarm_save_time &&
  629. now + CM_RTC_SMALL >= rtc_wkalarm_save_time)
  630. return false;
  631. }
  632. return ret;
  633. }
  634. EXPORT_SYMBOL_GPL(cm_suspend_again);
  635. /**
  636. * setup_charger_manager - initialize charger_global_desc data
  637. * @gd: pointer to instance of charger_global_desc
  638. */
  639. int setup_charger_manager(struct charger_global_desc *gd)
  640. {
  641. if (!gd)
  642. return -EINVAL;
  643. if (rtc_dev)
  644. rtc_class_close(rtc_dev);
  645. rtc_dev = NULL;
  646. g_desc = NULL;
  647. if (!gd->rtc_only_wakeup) {
  648. pr_err("The callback rtc_only_wakeup is not given.\n");
  649. return -EINVAL;
  650. }
  651. if (gd->rtc_name) {
  652. rtc_dev = rtc_class_open(gd->rtc_name);
  653. if (IS_ERR_OR_NULL(rtc_dev)) {
  654. rtc_dev = NULL;
  655. /* Retry at probe. RTC may be not registered yet */
  656. }
  657. } else {
  658. pr_warn("No wakeup timer is given for charger manager."
  659. "In-suspend monitoring won't work.\n");
  660. }
  661. g_desc = gd;
  662. return 0;
  663. }
  664. EXPORT_SYMBOL_GPL(setup_charger_manager);
  665. static int charger_manager_probe(struct platform_device *pdev)
  666. {
  667. struct charger_desc *desc = dev_get_platdata(&pdev->dev);
  668. struct charger_manager *cm;
  669. int ret = 0, i = 0;
  670. union power_supply_propval val;
  671. if (g_desc && !rtc_dev && g_desc->rtc_name) {
  672. rtc_dev = rtc_class_open(g_desc->rtc_name);
  673. if (IS_ERR_OR_NULL(rtc_dev)) {
  674. rtc_dev = NULL;
  675. dev_err(&pdev->dev, "Cannot get RTC %s.\n",
  676. g_desc->rtc_name);
  677. ret = -ENODEV;
  678. goto err_alloc;
  679. }
  680. }
  681. if (!desc) {
  682. dev_err(&pdev->dev, "No platform data (desc) found.\n");
  683. ret = -ENODEV;
  684. goto err_alloc;
  685. }
  686. cm = kzalloc(sizeof(struct charger_manager), GFP_KERNEL);
  687. if (!cm) {
  688. dev_err(&pdev->dev, "Cannot allocate memory.\n");
  689. ret = -ENOMEM;
  690. goto err_alloc;
  691. }
  692. /* Basic Values. Unspecified are Null or 0 */
  693. cm->dev = &pdev->dev;
  694. cm->desc = kzalloc(sizeof(struct charger_desc), GFP_KERNEL);
  695. if (!cm->desc) {
  696. dev_err(&pdev->dev, "Cannot allocate memory.\n");
  697. ret = -ENOMEM;
  698. goto err_alloc_desc;
  699. }
  700. memcpy(cm->desc, desc, sizeof(struct charger_desc));
  701. cm->last_temp_mC = INT_MIN; /* denotes "unmeasured, yet" */
  702. if (!desc->charger_regulators || desc->num_charger_regulators < 1) {
  703. ret = -EINVAL;
  704. dev_err(&pdev->dev, "charger_regulators undefined.\n");
  705. goto err_no_charger;
  706. }
  707. if (!desc->psy_charger_stat || !desc->psy_charger_stat[0]) {
  708. dev_err(&pdev->dev, "No power supply defined.\n");
  709. ret = -EINVAL;
  710. goto err_no_charger_stat;
  711. }
  712. /* Counting index only */
  713. while (desc->psy_charger_stat[i])
  714. i++;
  715. cm->charger_stat = kzalloc(sizeof(struct power_supply *) * (i + 1),
  716. GFP_KERNEL);
  717. if (!cm->charger_stat) {
  718. ret = -ENOMEM;
  719. goto err_no_charger_stat;
  720. }
  721. for (i = 0; desc->psy_charger_stat[i]; i++) {
  722. cm->charger_stat[i] = power_supply_get_by_name(
  723. desc->psy_charger_stat[i]);
  724. if (!cm->charger_stat[i]) {
  725. dev_err(&pdev->dev, "Cannot find power supply "
  726. "\"%s\"\n",
  727. desc->psy_charger_stat[i]);
  728. ret = -ENODEV;
  729. goto err_chg_stat;
  730. }
  731. }
  732. cm->fuel_gauge = power_supply_get_by_name(desc->psy_fuel_gauge);
  733. if (!cm->fuel_gauge) {
  734. dev_err(&pdev->dev, "Cannot find power supply \"%s\"\n",
  735. desc->psy_fuel_gauge);
  736. ret = -ENODEV;
  737. goto err_chg_stat;
  738. }
  739. if (desc->polling_interval_ms == 0 ||
  740. msecs_to_jiffies(desc->polling_interval_ms) <= CM_JIFFIES_SMALL) {
  741. dev_err(&pdev->dev, "polling_interval_ms is too small\n");
  742. ret = -EINVAL;
  743. goto err_chg_stat;
  744. }
  745. if (!desc->temperature_out_of_range) {
  746. dev_err(&pdev->dev, "there is no temperature_out_of_range\n");
  747. ret = -EINVAL;
  748. goto err_chg_stat;
  749. }
  750. platform_set_drvdata(pdev, cm);
  751. memcpy(&cm->charger_psy, &psy_default,
  752. sizeof(psy_default));
  753. if (!desc->psy_name) {
  754. strncpy(cm->psy_name_buf, psy_default.name,
  755. PSY_NAME_MAX);
  756. } else {
  757. strncpy(cm->psy_name_buf, desc->psy_name, PSY_NAME_MAX);
  758. }
  759. cm->charger_psy.name = cm->psy_name_buf;
  760. /* Allocate for psy properties because they may vary */
  761. cm->charger_psy.properties = kzalloc(sizeof(enum power_supply_property)
  762. * (ARRAY_SIZE(default_charger_props) +
  763. NUM_CHARGER_PSY_OPTIONAL),
  764. GFP_KERNEL);
  765. if (!cm->charger_psy.properties) {
  766. dev_err(&pdev->dev, "Cannot allocate for psy properties.\n");
  767. ret = -ENOMEM;
  768. goto err_chg_stat;
  769. }
  770. memcpy(cm->charger_psy.properties, default_charger_props,
  771. sizeof(enum power_supply_property) *
  772. ARRAY_SIZE(default_charger_props));
  773. cm->charger_psy.num_properties = psy_default.num_properties;
  774. /* Find which optional psy-properties are available */
  775. if (!cm->fuel_gauge->get_property(cm->fuel_gauge,
  776. POWER_SUPPLY_PROP_CHARGE_NOW, &val)) {
  777. cm->charger_psy.properties[cm->charger_psy.num_properties] =
  778. POWER_SUPPLY_PROP_CHARGE_NOW;
  779. cm->charger_psy.num_properties++;
  780. }
  781. if (!cm->fuel_gauge->get_property(cm->fuel_gauge,
  782. POWER_SUPPLY_PROP_CURRENT_NOW,
  783. &val)) {
  784. cm->charger_psy.properties[cm->charger_psy.num_properties] =
  785. POWER_SUPPLY_PROP_CURRENT_NOW;
  786. cm->charger_psy.num_properties++;
  787. }
  788. if (!desc->measure_battery_temp) {
  789. cm->charger_psy.properties[cm->charger_psy.num_properties] =
  790. POWER_SUPPLY_PROP_TEMP_AMBIENT;
  791. cm->charger_psy.num_properties++;
  792. }
  793. if (desc->measure_battery_temp) {
  794. cm->charger_psy.properties[cm->charger_psy.num_properties] =
  795. POWER_SUPPLY_PROP_TEMP;
  796. cm->charger_psy.num_properties++;
  797. }
  798. ret = power_supply_register(NULL, &cm->charger_psy);
  799. if (ret) {
  800. dev_err(&pdev->dev, "Cannot register charger-manager with"
  801. " name \"%s\".\n", cm->charger_psy.name);
  802. goto err_register;
  803. }
  804. ret = regulator_bulk_get(&pdev->dev, desc->num_charger_regulators,
  805. desc->charger_regulators);
  806. if (ret) {
  807. dev_err(&pdev->dev, "Cannot get charger regulators.\n");
  808. goto err_bulk_get;
  809. }
  810. ret = try_charger_enable(cm, true);
  811. if (ret) {
  812. dev_err(&pdev->dev, "Cannot enable charger regulators\n");
  813. goto err_chg_enable;
  814. }
  815. /* Add to the list */
  816. mutex_lock(&cm_list_mtx);
  817. list_add(&cm->entry, &cm_list);
  818. mutex_unlock(&cm_list_mtx);
  819. return 0;
  820. err_chg_enable:
  821. if (desc->charger_regulators)
  822. regulator_bulk_free(desc->num_charger_regulators,
  823. desc->charger_regulators);
  824. err_bulk_get:
  825. power_supply_unregister(&cm->charger_psy);
  826. err_register:
  827. kfree(cm->charger_psy.properties);
  828. err_chg_stat:
  829. kfree(cm->charger_stat);
  830. err_no_charger_stat:
  831. err_no_charger:
  832. kfree(cm->desc);
  833. err_alloc_desc:
  834. kfree(cm);
  835. err_alloc:
  836. return ret;
  837. }
  838. static int __devexit charger_manager_remove(struct platform_device *pdev)
  839. {
  840. struct charger_manager *cm = platform_get_drvdata(pdev);
  841. struct charger_desc *desc = cm->desc;
  842. /* Remove from the list */
  843. mutex_lock(&cm_list_mtx);
  844. list_del(&cm->entry);
  845. mutex_unlock(&cm_list_mtx);
  846. if (desc->charger_regulators)
  847. regulator_bulk_free(desc->num_charger_regulators,
  848. desc->charger_regulators);
  849. power_supply_unregister(&cm->charger_psy);
  850. kfree(cm->charger_psy.properties);
  851. kfree(cm->charger_stat);
  852. kfree(cm->desc);
  853. kfree(cm);
  854. return 0;
  855. }
  856. static const struct platform_device_id charger_manager_id[] = {
  857. { "charger-manager", 0 },
  858. { },
  859. };
  860. MODULE_DEVICE_TABLE(platform, charger_manager_id);
  861. static int cm_suspend_prepare(struct device *dev)
  862. {
  863. struct platform_device *pdev = container_of(dev, struct platform_device,
  864. dev);
  865. struct charger_manager *cm = platform_get_drvdata(pdev);
  866. if (!cm_suspended) {
  867. if (rtc_dev) {
  868. struct rtc_time tmp;
  869. unsigned long now;
  870. rtc_read_alarm(rtc_dev, &rtc_wkalarm_save);
  871. rtc_read_time(rtc_dev, &tmp);
  872. if (rtc_wkalarm_save.enabled) {
  873. rtc_tm_to_time(&rtc_wkalarm_save.time,
  874. &rtc_wkalarm_save_time);
  875. rtc_tm_to_time(&tmp, &now);
  876. if (now > rtc_wkalarm_save_time)
  877. rtc_wkalarm_save_time = 0;
  878. } else {
  879. rtc_wkalarm_save_time = 0;
  880. }
  881. }
  882. cm_suspended = true;
  883. }
  884. cm->status_save_ext_pwr_inserted = is_ext_pwr_online(cm);
  885. cm->status_save_batt = is_batt_present(cm);
  886. if (!cm_rtc_set) {
  887. cm_suspend_duration_ms = 0;
  888. cm_rtc_set = cm_setup_timer();
  889. }
  890. return 0;
  891. }
  892. static void cm_suspend_complete(struct device *dev)
  893. {
  894. struct platform_device *pdev = container_of(dev, struct platform_device,
  895. dev);
  896. struct charger_manager *cm = platform_get_drvdata(pdev);
  897. if (cm_suspended) {
  898. if (rtc_dev) {
  899. struct rtc_wkalrm tmp;
  900. rtc_read_alarm(rtc_dev, &tmp);
  901. rtc_wkalarm_save.pending = tmp.pending;
  902. rtc_set_alarm(rtc_dev, &rtc_wkalarm_save);
  903. }
  904. cm_suspended = false;
  905. cm_rtc_set = false;
  906. }
  907. uevent_notify(cm, NULL);
  908. }
  909. static const struct dev_pm_ops charger_manager_pm = {
  910. .prepare = cm_suspend_prepare,
  911. .complete = cm_suspend_complete,
  912. };
  913. static struct platform_driver charger_manager_driver = {
  914. .driver = {
  915. .name = "charger-manager",
  916. .owner = THIS_MODULE,
  917. .pm = &charger_manager_pm,
  918. },
  919. .probe = charger_manager_probe,
  920. .remove = __devexit_p(charger_manager_remove),
  921. .id_table = charger_manager_id,
  922. };
  923. static int __init charger_manager_init(void)
  924. {
  925. return platform_driver_register(&charger_manager_driver);
  926. }
  927. late_initcall(charger_manager_init);
  928. static void __exit charger_manager_cleanup(void)
  929. {
  930. platform_driver_unregister(&charger_manager_driver);
  931. }
  932. module_exit(charger_manager_cleanup);
  933. MODULE_AUTHOR("MyungJoo Ham <myungjoo.ham@samsung.com>");
  934. MODULE_DESCRIPTION("Charger Manager");
  935. MODULE_LICENSE("GPL");