wm8350_power.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Battery driver for wm8350 PMIC
  4. *
  5. * Copyright 2007, 2008 Wolfson Microelectronics PLC.
  6. *
  7. * Based on OLPC Battery Driver
  8. *
  9. * Copyright 2006 David Woodhouse <[email protected]>
  10. */
  11. #include <linux/module.h>
  12. #include <linux/err.h>
  13. #include <linux/platform_device.h>
  14. #include <linux/power_supply.h>
  15. #include <linux/mfd/wm8350/supply.h>
  16. #include <linux/mfd/wm8350/core.h>
  17. #include <linux/mfd/wm8350/comparator.h>
  18. static int wm8350_read_battery_uvolts(struct wm8350 *wm8350)
  19. {
  20. return wm8350_read_auxadc(wm8350, WM8350_AUXADC_BATT, 0, 0)
  21. * WM8350_AUX_COEFF;
  22. }
  23. static int wm8350_read_line_uvolts(struct wm8350 *wm8350)
  24. {
  25. return wm8350_read_auxadc(wm8350, WM8350_AUXADC_LINE, 0, 0)
  26. * WM8350_AUX_COEFF;
  27. }
  28. static int wm8350_read_usb_uvolts(struct wm8350 *wm8350)
  29. {
  30. return wm8350_read_auxadc(wm8350, WM8350_AUXADC_USB, 0, 0)
  31. * WM8350_AUX_COEFF;
  32. }
  33. #define WM8350_BATT_SUPPLY 1
  34. #define WM8350_USB_SUPPLY 2
  35. #define WM8350_LINE_SUPPLY 4
  36. static inline int wm8350_charge_time_min(struct wm8350 *wm8350, int min)
  37. {
  38. if (!wm8350->power.rev_g_coeff)
  39. return (((min - 30) / 15) & 0xf) << 8;
  40. else
  41. return (((min - 30) / 30) & 0xf) << 8;
  42. }
  43. static int wm8350_get_supplies(struct wm8350 *wm8350)
  44. {
  45. u16 sm, ov, co, chrg;
  46. int supplies = 0;
  47. sm = wm8350_reg_read(wm8350, WM8350_STATE_MACHINE_STATUS);
  48. ov = wm8350_reg_read(wm8350, WM8350_MISC_OVERRIDES);
  49. co = wm8350_reg_read(wm8350, WM8350_COMPARATOR_OVERRIDES);
  50. chrg = wm8350_reg_read(wm8350, WM8350_BATTERY_CHARGER_CONTROL_2);
  51. /* USB_SM */
  52. sm = (sm & WM8350_USB_SM_MASK) >> WM8350_USB_SM_SHIFT;
  53. /* CHG_ISEL */
  54. chrg &= WM8350_CHG_ISEL_MASK;
  55. /* If the USB state machine is active then we're using that with or
  56. * without battery, otherwise check for wall supply */
  57. if (((sm == WM8350_USB_SM_100_SLV) ||
  58. (sm == WM8350_USB_SM_500_SLV) ||
  59. (sm == WM8350_USB_SM_STDBY_SLV))
  60. && !(ov & WM8350_USB_LIMIT_OVRDE))
  61. supplies = WM8350_USB_SUPPLY;
  62. else if (((sm == WM8350_USB_SM_100_SLV) ||
  63. (sm == WM8350_USB_SM_500_SLV) ||
  64. (sm == WM8350_USB_SM_STDBY_SLV))
  65. && (ov & WM8350_USB_LIMIT_OVRDE) && (chrg == 0))
  66. supplies = WM8350_USB_SUPPLY | WM8350_BATT_SUPPLY;
  67. else if (co & WM8350_WALL_FB_OVRDE)
  68. supplies = WM8350_LINE_SUPPLY;
  69. else
  70. supplies = WM8350_BATT_SUPPLY;
  71. return supplies;
  72. }
  73. static int wm8350_charger_config(struct wm8350 *wm8350,
  74. struct wm8350_charger_policy *policy)
  75. {
  76. u16 reg, eoc_mA, fast_limit_mA;
  77. if (!policy) {
  78. dev_warn(wm8350->dev,
  79. "No charger policy, charger not configured.\n");
  80. return -EINVAL;
  81. }
  82. /* make sure USB fast charge current is not > 500mA */
  83. if (policy->fast_limit_USB_mA > 500) {
  84. dev_err(wm8350->dev, "USB fast charge > 500mA\n");
  85. return -EINVAL;
  86. }
  87. eoc_mA = WM8350_CHG_EOC_mA(policy->eoc_mA);
  88. wm8350_reg_unlock(wm8350);
  89. reg = wm8350_reg_read(wm8350, WM8350_BATTERY_CHARGER_CONTROL_1)
  90. & WM8350_CHG_ENA_R168;
  91. wm8350_reg_write(wm8350, WM8350_BATTERY_CHARGER_CONTROL_1,
  92. reg | eoc_mA | policy->trickle_start_mV |
  93. WM8350_CHG_TRICKLE_TEMP_CHOKE |
  94. WM8350_CHG_TRICKLE_USB_CHOKE |
  95. WM8350_CHG_FAST_USB_THROTTLE);
  96. if (wm8350_get_supplies(wm8350) & WM8350_USB_SUPPLY) {
  97. fast_limit_mA =
  98. WM8350_CHG_FAST_LIMIT_mA(policy->fast_limit_USB_mA);
  99. wm8350_reg_write(wm8350, WM8350_BATTERY_CHARGER_CONTROL_2,
  100. policy->charge_mV | policy->trickle_charge_USB_mA |
  101. fast_limit_mA | wm8350_charge_time_min(wm8350,
  102. policy->charge_timeout));
  103. } else {
  104. fast_limit_mA =
  105. WM8350_CHG_FAST_LIMIT_mA(policy->fast_limit_mA);
  106. wm8350_reg_write(wm8350, WM8350_BATTERY_CHARGER_CONTROL_2,
  107. policy->charge_mV | policy->trickle_charge_mA |
  108. fast_limit_mA | wm8350_charge_time_min(wm8350,
  109. policy->charge_timeout));
  110. }
  111. wm8350_reg_lock(wm8350);
  112. return 0;
  113. }
  114. static int wm8350_batt_status(struct wm8350 *wm8350)
  115. {
  116. u16 state;
  117. state = wm8350_reg_read(wm8350, WM8350_BATTERY_CHARGER_CONTROL_2);
  118. state &= WM8350_CHG_STS_MASK;
  119. switch (state) {
  120. case WM8350_CHG_STS_OFF:
  121. return POWER_SUPPLY_STATUS_DISCHARGING;
  122. case WM8350_CHG_STS_TRICKLE:
  123. case WM8350_CHG_STS_FAST:
  124. return POWER_SUPPLY_STATUS_CHARGING;
  125. default:
  126. return POWER_SUPPLY_STATUS_UNKNOWN;
  127. }
  128. }
  129. static ssize_t charger_state_show(struct device *dev,
  130. struct device_attribute *attr, char *buf)
  131. {
  132. struct wm8350 *wm8350 = dev_get_drvdata(dev);
  133. char *charge;
  134. int state;
  135. state = wm8350_reg_read(wm8350, WM8350_BATTERY_CHARGER_CONTROL_2) &
  136. WM8350_CHG_STS_MASK;
  137. switch (state) {
  138. case WM8350_CHG_STS_OFF:
  139. charge = "Charger Off";
  140. break;
  141. case WM8350_CHG_STS_TRICKLE:
  142. charge = "Trickle Charging";
  143. break;
  144. case WM8350_CHG_STS_FAST:
  145. charge = "Fast Charging";
  146. break;
  147. default:
  148. return 0;
  149. }
  150. return sprintf(buf, "%s\n", charge);
  151. }
  152. static DEVICE_ATTR_RO(charger_state);
  153. static irqreturn_t wm8350_charger_handler(int irq, void *data)
  154. {
  155. struct wm8350 *wm8350 = data;
  156. struct wm8350_power *power = &wm8350->power;
  157. struct wm8350_charger_policy *policy = power->policy;
  158. switch (irq - wm8350->irq_base) {
  159. case WM8350_IRQ_CHG_BAT_FAIL:
  160. dev_err(wm8350->dev, "battery failed\n");
  161. break;
  162. case WM8350_IRQ_CHG_TO:
  163. dev_err(wm8350->dev, "charger timeout\n");
  164. power_supply_changed(power->battery);
  165. break;
  166. case WM8350_IRQ_CHG_BAT_HOT:
  167. case WM8350_IRQ_CHG_BAT_COLD:
  168. case WM8350_IRQ_CHG_START:
  169. case WM8350_IRQ_CHG_END:
  170. power_supply_changed(power->battery);
  171. break;
  172. case WM8350_IRQ_CHG_FAST_RDY:
  173. dev_dbg(wm8350->dev, "fast charger ready\n");
  174. wm8350_charger_config(wm8350, policy);
  175. wm8350_reg_unlock(wm8350);
  176. wm8350_set_bits(wm8350, WM8350_BATTERY_CHARGER_CONTROL_1,
  177. WM8350_CHG_FAST);
  178. wm8350_reg_lock(wm8350);
  179. break;
  180. case WM8350_IRQ_CHG_VBATT_LT_3P9:
  181. dev_warn(wm8350->dev, "battery < 3.9V\n");
  182. break;
  183. case WM8350_IRQ_CHG_VBATT_LT_3P1:
  184. dev_warn(wm8350->dev, "battery < 3.1V\n");
  185. break;
  186. case WM8350_IRQ_CHG_VBATT_LT_2P85:
  187. dev_warn(wm8350->dev, "battery < 2.85V\n");
  188. break;
  189. /* Supply change. We will overnotify but it should do
  190. * no harm. */
  191. case WM8350_IRQ_EXT_USB_FB:
  192. case WM8350_IRQ_EXT_WALL_FB:
  193. wm8350_charger_config(wm8350, policy);
  194. fallthrough;
  195. case WM8350_IRQ_EXT_BAT_FB:
  196. power_supply_changed(power->battery);
  197. power_supply_changed(power->usb);
  198. power_supply_changed(power->ac);
  199. break;
  200. default:
  201. dev_err(wm8350->dev, "Unknown interrupt %d\n", irq);
  202. }
  203. return IRQ_HANDLED;
  204. }
  205. /*********************************************************************
  206. * AC Power
  207. *********************************************************************/
  208. static int wm8350_ac_get_prop(struct power_supply *psy,
  209. enum power_supply_property psp,
  210. union power_supply_propval *val)
  211. {
  212. struct wm8350 *wm8350 = dev_get_drvdata(psy->dev.parent);
  213. int ret = 0;
  214. switch (psp) {
  215. case POWER_SUPPLY_PROP_ONLINE:
  216. val->intval = !!(wm8350_get_supplies(wm8350) &
  217. WM8350_LINE_SUPPLY);
  218. break;
  219. case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  220. val->intval = wm8350_read_line_uvolts(wm8350);
  221. break;
  222. default:
  223. ret = -EINVAL;
  224. break;
  225. }
  226. return ret;
  227. }
  228. static enum power_supply_property wm8350_ac_props[] = {
  229. POWER_SUPPLY_PROP_ONLINE,
  230. POWER_SUPPLY_PROP_VOLTAGE_NOW,
  231. };
  232. /*********************************************************************
  233. * USB Power
  234. *********************************************************************/
  235. static int wm8350_usb_get_prop(struct power_supply *psy,
  236. enum power_supply_property psp,
  237. union power_supply_propval *val)
  238. {
  239. struct wm8350 *wm8350 = dev_get_drvdata(psy->dev.parent);
  240. int ret = 0;
  241. switch (psp) {
  242. case POWER_SUPPLY_PROP_ONLINE:
  243. val->intval = !!(wm8350_get_supplies(wm8350) &
  244. WM8350_USB_SUPPLY);
  245. break;
  246. case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  247. val->intval = wm8350_read_usb_uvolts(wm8350);
  248. break;
  249. default:
  250. ret = -EINVAL;
  251. break;
  252. }
  253. return ret;
  254. }
  255. static enum power_supply_property wm8350_usb_props[] = {
  256. POWER_SUPPLY_PROP_ONLINE,
  257. POWER_SUPPLY_PROP_VOLTAGE_NOW,
  258. };
  259. /*********************************************************************
  260. * Battery properties
  261. *********************************************************************/
  262. static int wm8350_bat_check_health(struct wm8350 *wm8350)
  263. {
  264. u16 reg;
  265. if (wm8350_read_battery_uvolts(wm8350) < 2850000)
  266. return POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
  267. reg = wm8350_reg_read(wm8350, WM8350_CHARGER_OVERRIDES);
  268. if (reg & WM8350_CHG_BATT_HOT_OVRDE)
  269. return POWER_SUPPLY_HEALTH_OVERHEAT;
  270. if (reg & WM8350_CHG_BATT_COLD_OVRDE)
  271. return POWER_SUPPLY_HEALTH_COLD;
  272. return POWER_SUPPLY_HEALTH_GOOD;
  273. }
  274. static int wm8350_bat_get_charge_type(struct wm8350 *wm8350)
  275. {
  276. int state;
  277. state = wm8350_reg_read(wm8350, WM8350_BATTERY_CHARGER_CONTROL_2) &
  278. WM8350_CHG_STS_MASK;
  279. switch (state) {
  280. case WM8350_CHG_STS_OFF:
  281. return POWER_SUPPLY_CHARGE_TYPE_NONE;
  282. case WM8350_CHG_STS_TRICKLE:
  283. return POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
  284. case WM8350_CHG_STS_FAST:
  285. return POWER_SUPPLY_CHARGE_TYPE_FAST;
  286. default:
  287. return POWER_SUPPLY_CHARGE_TYPE_UNKNOWN;
  288. }
  289. }
  290. static int wm8350_bat_get_property(struct power_supply *psy,
  291. enum power_supply_property psp,
  292. union power_supply_propval *val)
  293. {
  294. struct wm8350 *wm8350 = dev_get_drvdata(psy->dev.parent);
  295. int ret = 0;
  296. switch (psp) {
  297. case POWER_SUPPLY_PROP_STATUS:
  298. val->intval = wm8350_batt_status(wm8350);
  299. break;
  300. case POWER_SUPPLY_PROP_ONLINE:
  301. val->intval = !!(wm8350_get_supplies(wm8350) &
  302. WM8350_BATT_SUPPLY);
  303. break;
  304. case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  305. val->intval = wm8350_read_battery_uvolts(wm8350);
  306. break;
  307. case POWER_SUPPLY_PROP_HEALTH:
  308. val->intval = wm8350_bat_check_health(wm8350);
  309. break;
  310. case POWER_SUPPLY_PROP_CHARGE_TYPE:
  311. val->intval = wm8350_bat_get_charge_type(wm8350);
  312. break;
  313. default:
  314. ret = -EINVAL;
  315. break;
  316. }
  317. return ret;
  318. }
  319. static enum power_supply_property wm8350_bat_props[] = {
  320. POWER_SUPPLY_PROP_STATUS,
  321. POWER_SUPPLY_PROP_ONLINE,
  322. POWER_SUPPLY_PROP_VOLTAGE_NOW,
  323. POWER_SUPPLY_PROP_HEALTH,
  324. POWER_SUPPLY_PROP_CHARGE_TYPE,
  325. };
  326. static const struct power_supply_desc wm8350_ac_desc = {
  327. .name = "wm8350-ac",
  328. .type = POWER_SUPPLY_TYPE_MAINS,
  329. .properties = wm8350_ac_props,
  330. .num_properties = ARRAY_SIZE(wm8350_ac_props),
  331. .get_property = wm8350_ac_get_prop,
  332. };
  333. static const struct power_supply_desc wm8350_battery_desc = {
  334. .name = "wm8350-battery",
  335. .properties = wm8350_bat_props,
  336. .num_properties = ARRAY_SIZE(wm8350_bat_props),
  337. .get_property = wm8350_bat_get_property,
  338. .use_for_apm = 1,
  339. };
  340. static const struct power_supply_desc wm8350_usb_desc = {
  341. .name = "wm8350-usb",
  342. .type = POWER_SUPPLY_TYPE_USB,
  343. .properties = wm8350_usb_props,
  344. .num_properties = ARRAY_SIZE(wm8350_usb_props),
  345. .get_property = wm8350_usb_get_prop,
  346. };
  347. /*********************************************************************
  348. * Initialisation
  349. *********************************************************************/
  350. static int wm8350_init_charger(struct wm8350 *wm8350)
  351. {
  352. int ret;
  353. /* register our interest in charger events */
  354. ret = wm8350_register_irq(wm8350, WM8350_IRQ_CHG_BAT_HOT,
  355. wm8350_charger_handler, 0, "Battery hot", wm8350);
  356. if (ret)
  357. goto err;
  358. ret = wm8350_register_irq(wm8350, WM8350_IRQ_CHG_BAT_COLD,
  359. wm8350_charger_handler, 0, "Battery cold", wm8350);
  360. if (ret)
  361. goto free_chg_bat_hot;
  362. ret = wm8350_register_irq(wm8350, WM8350_IRQ_CHG_BAT_FAIL,
  363. wm8350_charger_handler, 0, "Battery fail", wm8350);
  364. if (ret)
  365. goto free_chg_bat_cold;
  366. ret = wm8350_register_irq(wm8350, WM8350_IRQ_CHG_TO,
  367. wm8350_charger_handler, 0,
  368. "Charger timeout", wm8350);
  369. if (ret)
  370. goto free_chg_bat_fail;
  371. ret = wm8350_register_irq(wm8350, WM8350_IRQ_CHG_END,
  372. wm8350_charger_handler, 0,
  373. "Charge end", wm8350);
  374. if (ret)
  375. goto free_chg_to;
  376. ret = wm8350_register_irq(wm8350, WM8350_IRQ_CHG_START,
  377. wm8350_charger_handler, 0,
  378. "Charge start", wm8350);
  379. if (ret)
  380. goto free_chg_end;
  381. ret = wm8350_register_irq(wm8350, WM8350_IRQ_CHG_FAST_RDY,
  382. wm8350_charger_handler, 0,
  383. "Fast charge ready", wm8350);
  384. if (ret)
  385. goto free_chg_start;
  386. ret = wm8350_register_irq(wm8350, WM8350_IRQ_CHG_VBATT_LT_3P9,
  387. wm8350_charger_handler, 0,
  388. "Battery <3.9V", wm8350);
  389. if (ret)
  390. goto free_chg_fast_rdy;
  391. ret = wm8350_register_irq(wm8350, WM8350_IRQ_CHG_VBATT_LT_3P1,
  392. wm8350_charger_handler, 0,
  393. "Battery <3.1V", wm8350);
  394. if (ret)
  395. goto free_chg_vbatt_lt_3p9;
  396. ret = wm8350_register_irq(wm8350, WM8350_IRQ_CHG_VBATT_LT_2P85,
  397. wm8350_charger_handler, 0,
  398. "Battery <2.85V", wm8350);
  399. if (ret)
  400. goto free_chg_vbatt_lt_3p1;
  401. /* and supply change events */
  402. ret = wm8350_register_irq(wm8350, WM8350_IRQ_EXT_USB_FB,
  403. wm8350_charger_handler, 0, "USB", wm8350);
  404. if (ret)
  405. goto free_chg_vbatt_lt_2p85;
  406. ret = wm8350_register_irq(wm8350, WM8350_IRQ_EXT_WALL_FB,
  407. wm8350_charger_handler, 0, "Wall", wm8350);
  408. if (ret)
  409. goto free_ext_usb_fb;
  410. ret = wm8350_register_irq(wm8350, WM8350_IRQ_EXT_BAT_FB,
  411. wm8350_charger_handler, 0, "Battery", wm8350);
  412. if (ret)
  413. goto free_ext_wall_fb;
  414. return 0;
  415. free_ext_wall_fb:
  416. wm8350_free_irq(wm8350, WM8350_IRQ_EXT_WALL_FB, wm8350);
  417. free_ext_usb_fb:
  418. wm8350_free_irq(wm8350, WM8350_IRQ_EXT_USB_FB, wm8350);
  419. free_chg_vbatt_lt_2p85:
  420. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_VBATT_LT_2P85, wm8350);
  421. free_chg_vbatt_lt_3p1:
  422. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_VBATT_LT_3P1, wm8350);
  423. free_chg_vbatt_lt_3p9:
  424. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_VBATT_LT_3P9, wm8350);
  425. free_chg_fast_rdy:
  426. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_FAST_RDY, wm8350);
  427. free_chg_start:
  428. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_START, wm8350);
  429. free_chg_end:
  430. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_END, wm8350);
  431. free_chg_to:
  432. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_TO, wm8350);
  433. free_chg_bat_fail:
  434. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_BAT_FAIL, wm8350);
  435. free_chg_bat_cold:
  436. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_BAT_COLD, wm8350);
  437. free_chg_bat_hot:
  438. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_BAT_HOT, wm8350);
  439. err:
  440. return ret;
  441. }
  442. static void free_charger_irq(struct wm8350 *wm8350)
  443. {
  444. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_BAT_HOT, wm8350);
  445. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_BAT_COLD, wm8350);
  446. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_BAT_FAIL, wm8350);
  447. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_TO, wm8350);
  448. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_END, wm8350);
  449. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_START, wm8350);
  450. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_FAST_RDY, wm8350);
  451. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_VBATT_LT_3P9, wm8350);
  452. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_VBATT_LT_3P1, wm8350);
  453. wm8350_free_irq(wm8350, WM8350_IRQ_CHG_VBATT_LT_2P85, wm8350);
  454. wm8350_free_irq(wm8350, WM8350_IRQ_EXT_USB_FB, wm8350);
  455. wm8350_free_irq(wm8350, WM8350_IRQ_EXT_WALL_FB, wm8350);
  456. wm8350_free_irq(wm8350, WM8350_IRQ_EXT_BAT_FB, wm8350);
  457. }
  458. static int wm8350_power_probe(struct platform_device *pdev)
  459. {
  460. struct wm8350 *wm8350 = platform_get_drvdata(pdev);
  461. struct wm8350_power *power = &wm8350->power;
  462. struct wm8350_charger_policy *policy = power->policy;
  463. int ret;
  464. power->ac = power_supply_register(&pdev->dev, &wm8350_ac_desc, NULL);
  465. if (IS_ERR(power->ac))
  466. return PTR_ERR(power->ac);
  467. power->battery = power_supply_register(&pdev->dev, &wm8350_battery_desc,
  468. NULL);
  469. if (IS_ERR(power->battery)) {
  470. ret = PTR_ERR(power->battery);
  471. goto battery_failed;
  472. }
  473. power->usb = power_supply_register(&pdev->dev, &wm8350_usb_desc, NULL);
  474. if (IS_ERR(power->usb)) {
  475. ret = PTR_ERR(power->usb);
  476. goto usb_failed;
  477. }
  478. ret = device_create_file(&pdev->dev, &dev_attr_charger_state);
  479. if (ret < 0)
  480. dev_warn(wm8350->dev, "failed to add charge sysfs: %d\n", ret);
  481. ret = 0;
  482. wm8350_init_charger(wm8350);
  483. if (wm8350_charger_config(wm8350, policy) == 0) {
  484. wm8350_reg_unlock(wm8350);
  485. wm8350_set_bits(wm8350, WM8350_POWER_MGMT_5, WM8350_CHG_ENA);
  486. wm8350_reg_lock(wm8350);
  487. }
  488. return ret;
  489. usb_failed:
  490. power_supply_unregister(power->battery);
  491. battery_failed:
  492. power_supply_unregister(power->ac);
  493. return ret;
  494. }
  495. static int wm8350_power_remove(struct platform_device *pdev)
  496. {
  497. struct wm8350 *wm8350 = platform_get_drvdata(pdev);
  498. struct wm8350_power *power = &wm8350->power;
  499. free_charger_irq(wm8350);
  500. device_remove_file(&pdev->dev, &dev_attr_charger_state);
  501. power_supply_unregister(power->battery);
  502. power_supply_unregister(power->ac);
  503. power_supply_unregister(power->usb);
  504. return 0;
  505. }
  506. static struct platform_driver wm8350_power_driver = {
  507. .probe = wm8350_power_probe,
  508. .remove = wm8350_power_remove,
  509. .driver = {
  510. .name = "wm8350-power",
  511. },
  512. };
  513. module_platform_driver(wm8350_power_driver);
  514. MODULE_LICENSE("GPL");
  515. MODULE_DESCRIPTION("Power supply driver for WM8350");
  516. MODULE_ALIAS("platform:wm8350-power");