da9052-battery.c 15 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Batttery Driver for Dialog DA9052 PMICs
  4. *
  5. * Copyright(c) 2011 Dialog Semiconductor Ltd.
  6. *
  7. * Author: David Dajun Chen <dchen@diasemi.com>
  8. */
  9. #include <linux/delay.h>
  10. #include <linux/freezer.h>
  11. #include <linux/fs.h>
  12. #include <linux/jiffies.h>
  13. #include <linux/module.h>
  14. #include <linux/timer.h>
  15. #include <linux/uaccess.h>
  16. #include <linux/platform_device.h>
  17. #include <linux/power_supply.h>
  18. #include <linux/mfd/da9052/da9052.h>
  19. #include <linux/mfd/da9052/pdata.h>
  20. #include <linux/mfd/da9052/reg.h>
  21. /* STATIC CONFIGURATION */
  22. #define DA9052_BAT_CUTOFF_VOLT 2800
  23. #define DA9052_BAT_TSH 62000
  24. #define DA9052_BAT_LOW_CAP 4
  25. #define DA9052_AVG_SZ 4
  26. #define DA9052_VC_TBL_SZ 68
  27. #define DA9052_VC_TBL_REF_SZ 3
  28. #define DA9052_ISET_USB_MASK 0x0F
  29. #define DA9052_CHG_USB_ILIM_MASK 0x40
  30. #define DA9052_CHG_LIM_COLS 16
  31. #define DA9052_MEAN(x, y) ((x + y) / 2)
  32. enum charger_type_enum {
  33. DA9052_NOCHARGER = 1,
  34. DA9052_CHARGER,
  35. };
  36. static const u16 da9052_chg_current_lim[2][DA9052_CHG_LIM_COLS] = {
  37. {70, 80, 90, 100, 110, 120, 400, 450,
  38. 500, 550, 600, 650, 700, 900, 1100, 1300},
  39. {80, 90, 100, 110, 120, 400, 450, 500,
  40. 550, 600, 800, 1000, 1200, 1400, 1600, 1800},
  41. };
  42. static const u16 vc_tbl_ref[3] = {10, 25, 40};
  43. /* Lookup table for voltage vs capacity */
  44. static u32 const vc_tbl[3][68][2] = {
  45. /* For temperature 10 degree Celsius */
  46. {
  47. {4082, 100}, {4036, 98},
  48. {4020, 96}, {4008, 95},
  49. {3997, 93}, {3983, 91},
  50. {3964, 90}, {3943, 88},
  51. {3926, 87}, {3912, 85},
  52. {3900, 84}, {3890, 82},
  53. {3881, 80}, {3873, 79},
  54. {3865, 77}, {3857, 76},
  55. {3848, 74}, {3839, 73},
  56. {3829, 71}, {3820, 70},
  57. {3811, 68}, {3802, 67},
  58. {3794, 65}, {3785, 64},
  59. {3778, 62}, {3770, 61},
  60. {3763, 59}, {3756, 58},
  61. {3750, 56}, {3744, 55},
  62. {3738, 53}, {3732, 52},
  63. {3727, 50}, {3722, 49},
  64. {3717, 47}, {3712, 46},
  65. {3708, 44}, {3703, 43},
  66. {3700, 41}, {3696, 40},
  67. {3693, 38}, {3691, 37},
  68. {3688, 35}, {3686, 34},
  69. {3683, 32}, {3681, 31},
  70. {3678, 29}, {3675, 28},
  71. {3672, 26}, {3669, 25},
  72. {3665, 23}, {3661, 22},
  73. {3656, 21}, {3651, 19},
  74. {3645, 18}, {3639, 16},
  75. {3631, 15}, {3622, 13},
  76. {3611, 12}, {3600, 10},
  77. {3587, 9}, {3572, 7},
  78. {3548, 6}, {3503, 5},
  79. {3420, 3}, {3268, 2},
  80. {2992, 1}, {2746, 0}
  81. },
  82. /* For temperature 25 degree Celsius */
  83. {
  84. {4102, 100}, {4065, 98},
  85. {4048, 96}, {4034, 95},
  86. {4021, 93}, {4011, 92},
  87. {4001, 90}, {3986, 88},
  88. {3968, 87}, {3952, 85},
  89. {3938, 84}, {3926, 82},
  90. {3916, 81}, {3908, 79},
  91. {3900, 77}, {3892, 76},
  92. {3883, 74}, {3874, 73},
  93. {3864, 71}, {3855, 70},
  94. {3846, 68}, {3836, 67},
  95. {3827, 65}, {3819, 64},
  96. {3810, 62}, {3801, 61},
  97. {3793, 59}, {3786, 58},
  98. {3778, 56}, {3772, 55},
  99. {3765, 53}, {3759, 52},
  100. {3754, 50}, {3748, 49},
  101. {3743, 47}, {3738, 46},
  102. {3733, 44}, {3728, 43},
  103. {3724, 41}, {3720, 40},
  104. {3716, 38}, {3712, 37},
  105. {3709, 35}, {3706, 34},
  106. {3703, 33}, {3701, 31},
  107. {3698, 30}, {3696, 28},
  108. {3693, 27}, {3690, 25},
  109. {3687, 24}, {3683, 22},
  110. {3680, 21}, {3675, 19},
  111. {3671, 18}, {3666, 17},
  112. {3660, 15}, {3654, 14},
  113. {3647, 12}, {3639, 11},
  114. {3630, 9}, {3621, 8},
  115. {3613, 6}, {3606, 5},
  116. {3597, 4}, {3582, 2},
  117. {3546, 1}, {2747, 0}
  118. },
  119. /* For temperature 40 degree Celsius */
  120. {
  121. {4114, 100}, {4081, 98},
  122. {4065, 96}, {4050, 95},
  123. {4036, 93}, {4024, 92},
  124. {4013, 90}, {4002, 88},
  125. {3990, 87}, {3976, 85},
  126. {3962, 84}, {3950, 82},
  127. {3939, 81}, {3930, 79},
  128. {3921, 77}, {3912, 76},
  129. {3902, 74}, {3893, 73},
  130. {3883, 71}, {3874, 70},
  131. {3865, 68}, {3856, 67},
  132. {3847, 65}, {3838, 64},
  133. {3829, 62}, {3820, 61},
  134. {3812, 59}, {3803, 58},
  135. {3795, 56}, {3787, 55},
  136. {3780, 53}, {3773, 52},
  137. {3767, 50}, {3761, 49},
  138. {3756, 47}, {3751, 46},
  139. {3746, 44}, {3741, 43},
  140. {3736, 41}, {3732, 40},
  141. {3728, 38}, {3724, 37},
  142. {3720, 35}, {3716, 34},
  143. {3713, 33}, {3710, 31},
  144. {3707, 30}, {3704, 28},
  145. {3701, 27}, {3698, 25},
  146. {3695, 24}, {3691, 22},
  147. {3686, 21}, {3681, 19},
  148. {3676, 18}, {3671, 17},
  149. {3666, 15}, {3661, 14},
  150. {3655, 12}, {3648, 11},
  151. {3640, 9}, {3632, 8},
  152. {3622, 6}, {3616, 5},
  153. {3611, 4}, {3604, 2},
  154. {3594, 1}, {2747, 0}
  155. }
  156. };
  157. struct da9052_battery {
  158. struct da9052 *da9052;
  159. struct power_supply *psy;
  160. struct notifier_block nb;
  161. int charger_type;
  162. int status;
  163. int health;
  164. };
  165. static inline int volt_reg_to_mV(int value)
  166. {
  167. return ((value * 1000) / 512) + 2500;
  168. }
  169. static inline int ichg_reg_to_mA(int value)
  170. {
  171. return (value * 3900) / 1000;
  172. }
  173. static int da9052_read_chgend_current(struct da9052_battery *bat,
  174. int *current_mA)
  175. {
  176. int ret;
  177. if (bat->status == POWER_SUPPLY_STATUS_DISCHARGING)
  178. return -EINVAL;
  179. ret = da9052_reg_read(bat->da9052, DA9052_ICHG_END_REG);
  180. if (ret < 0)
  181. return ret;
  182. *current_mA = ichg_reg_to_mA(ret & DA9052_ICHGEND_ICHGEND);
  183. return 0;
  184. }
  185. static int da9052_read_chg_current(struct da9052_battery *bat, int *current_mA)
  186. {
  187. int ret;
  188. if (bat->status == POWER_SUPPLY_STATUS_DISCHARGING)
  189. return -EINVAL;
  190. ret = da9052_reg_read(bat->da9052, DA9052_ICHG_AV_REG);
  191. if (ret < 0)
  192. return ret;
  193. *current_mA = ichg_reg_to_mA(ret & DA9052_ICHGAV_ICHGAV);
  194. return 0;
  195. }
  196. static int da9052_bat_check_status(struct da9052_battery *bat, int *status)
  197. {
  198. u8 v[2] = {0, 0};
  199. u8 bat_status;
  200. u8 chg_end;
  201. int ret;
  202. int chg_current;
  203. int chg_end_current;
  204. bool dcinsel;
  205. bool dcindet;
  206. bool vbussel;
  207. bool vbusdet;
  208. bool dc;
  209. bool vbus;
  210. ret = da9052_group_read(bat->da9052, DA9052_STATUS_A_REG, 2, v);
  211. if (ret < 0)
  212. return ret;
  213. bat_status = v[0];
  214. chg_end = v[1];
  215. dcinsel = bat_status & DA9052_STATUSA_DCINSEL;
  216. dcindet = bat_status & DA9052_STATUSA_DCINDET;
  217. vbussel = bat_status & DA9052_STATUSA_VBUSSEL;
  218. vbusdet = bat_status & DA9052_STATUSA_VBUSDET;
  219. dc = dcinsel && dcindet;
  220. vbus = vbussel && vbusdet;
  221. /* Preference to WALL(DCIN) charger unit */
  222. if (dc || vbus) {
  223. bat->charger_type = DA9052_CHARGER;
  224. /* If charging end flag is set and Charging current is greater
  225. * than charging end limit then battery is charging
  226. */
  227. if ((chg_end & DA9052_STATUSB_CHGEND) != 0) {
  228. ret = da9052_read_chg_current(bat, &chg_current);
  229. if (ret < 0)
  230. return ret;
  231. ret = da9052_read_chgend_current(bat, &chg_end_current);
  232. if (ret < 0)
  233. return ret;
  234. if (chg_current >= chg_end_current)
  235. bat->status = POWER_SUPPLY_STATUS_CHARGING;
  236. else
  237. bat->status = POWER_SUPPLY_STATUS_NOT_CHARGING;
  238. } else {
  239. /* If Charging end flag is cleared then battery is
  240. * charging
  241. */
  242. bat->status = POWER_SUPPLY_STATUS_CHARGING;
  243. }
  244. } else if (dcindet || vbusdet) {
  245. bat->charger_type = DA9052_CHARGER;
  246. bat->status = POWER_SUPPLY_STATUS_NOT_CHARGING;
  247. } else {
  248. bat->charger_type = DA9052_NOCHARGER;
  249. bat->status = POWER_SUPPLY_STATUS_DISCHARGING;
  250. }
  251. if (status != NULL)
  252. *status = bat->status;
  253. return 0;
  254. }
  255. static int da9052_bat_read_volt(struct da9052_battery *bat, int *volt_mV)
  256. {
  257. int volt;
  258. volt = da9052_adc_manual_read(bat->da9052, DA9052_ADC_MAN_MUXSEL_VBAT);
  259. if (volt < 0)
  260. return volt;
  261. *volt_mV = volt_reg_to_mV(volt);
  262. return 0;
  263. }
  264. static int da9052_bat_check_presence(struct da9052_battery *bat, int *illegal)
  265. {
  266. int bat_temp;
  267. bat_temp = da9052_adc_read_temp(bat->da9052);
  268. if (bat_temp < 0)
  269. return bat_temp;
  270. if (bat_temp > DA9052_BAT_TSH)
  271. *illegal = 1;
  272. else
  273. *illegal = 0;
  274. return 0;
  275. }
  276. static int da9052_bat_interpolate(int vbat_lower, int vbat_upper,
  277. int level_lower, int level_upper,
  278. int bat_voltage)
  279. {
  280. int tmp;
  281. tmp = ((level_upper - level_lower) * 1000) / (vbat_upper - vbat_lower);
  282. tmp = level_lower + (((bat_voltage - vbat_lower) * tmp) / 1000);
  283. return tmp;
  284. }
  285. static unsigned char da9052_determine_vc_tbl_index(unsigned char adc_temp)
  286. {
  287. int i;
  288. if (adc_temp <= vc_tbl_ref[0])
  289. return 0;
  290. if (adc_temp > vc_tbl_ref[DA9052_VC_TBL_REF_SZ - 1])
  291. return DA9052_VC_TBL_REF_SZ - 1;
  292. for (i = 0; i < DA9052_VC_TBL_REF_SZ - 1; i++) {
  293. if ((adc_temp > vc_tbl_ref[i]) &&
  294. (adc_temp <= DA9052_MEAN(vc_tbl_ref[i], vc_tbl_ref[i + 1])))
  295. return i;
  296. if ((adc_temp > DA9052_MEAN(vc_tbl_ref[i], vc_tbl_ref[i + 1]))
  297. && (adc_temp <= vc_tbl_ref[i]))
  298. return i + 1;
  299. }
  300. /*
  301. * For some reason authors of the driver didn't presume that we can
  302. * end up here. It might be OK, but might be not, no one knows for
  303. * sure. Go check your battery, is it on fire?
  304. */
  305. WARN_ON(1);
  306. return 0;
  307. }
  308. static int da9052_bat_read_capacity(struct da9052_battery *bat, int *capacity)
  309. {
  310. int adc_temp;
  311. int bat_voltage;
  312. int vbat_lower;
  313. int vbat_upper;
  314. int level_upper;
  315. int level_lower;
  316. int ret;
  317. int flag;
  318. int i = 0;
  319. int j;
  320. ret = da9052_bat_read_volt(bat, &bat_voltage);
  321. if (ret < 0)
  322. return ret;
  323. adc_temp = da9052_adc_read_temp(bat->da9052);
  324. if (adc_temp < 0)
  325. return adc_temp;
  326. i = da9052_determine_vc_tbl_index(adc_temp);
  327. if (bat_voltage >= vc_tbl[i][0][0]) {
  328. *capacity = 100;
  329. return 0;
  330. }
  331. if (bat_voltage <= vc_tbl[i][DA9052_VC_TBL_SZ - 1][0]) {
  332. *capacity = 0;
  333. return 0;
  334. }
  335. flag = 0;
  336. for (j = 0; j < (DA9052_VC_TBL_SZ-1); j++) {
  337. if ((bat_voltage <= vc_tbl[i][j][0]) &&
  338. (bat_voltage >= vc_tbl[i][j + 1][0])) {
  339. vbat_upper = vc_tbl[i][j][0];
  340. vbat_lower = vc_tbl[i][j + 1][0];
  341. level_upper = vc_tbl[i][j][1];
  342. level_lower = vc_tbl[i][j + 1][1];
  343. flag = 1;
  344. break;
  345. }
  346. }
  347. if (!flag)
  348. return -EIO;
  349. *capacity = da9052_bat_interpolate(vbat_lower, vbat_upper, level_lower,
  350. level_upper, bat_voltage);
  351. return 0;
  352. }
  353. static int da9052_bat_check_health(struct da9052_battery *bat, int *health)
  354. {
  355. int ret;
  356. int bat_illegal;
  357. int capacity;
  358. ret = da9052_bat_check_presence(bat, &bat_illegal);
  359. if (ret < 0)
  360. return ret;
  361. if (bat_illegal) {
  362. bat->health = POWER_SUPPLY_HEALTH_UNKNOWN;
  363. return 0;
  364. }
  365. if (bat->health != POWER_SUPPLY_HEALTH_OVERHEAT) {
  366. ret = da9052_bat_read_capacity(bat, &capacity);
  367. if (ret < 0)
  368. return ret;
  369. if (capacity < DA9052_BAT_LOW_CAP)
  370. bat->health = POWER_SUPPLY_HEALTH_DEAD;
  371. else
  372. bat->health = POWER_SUPPLY_HEALTH_GOOD;
  373. }
  374. *health = bat->health;
  375. return 0;
  376. }
  377. static irqreturn_t da9052_bat_irq(int irq, void *data)
  378. {
  379. struct da9052_battery *bat = data;
  380. int virq;
  381. virq = regmap_irq_get_virq(bat->da9052->irq_data, irq);
  382. irq -= virq;
  383. if (irq == DA9052_IRQ_CHGEND)
  384. bat->status = POWER_SUPPLY_STATUS_FULL;
  385. else
  386. da9052_bat_check_status(bat, NULL);
  387. if (irq == DA9052_IRQ_CHGEND || irq == DA9052_IRQ_DCIN ||
  388. irq == DA9052_IRQ_VBUS || irq == DA9052_IRQ_TBAT) {
  389. power_supply_changed(bat->psy);
  390. }
  391. return IRQ_HANDLED;
  392. }
  393. static int da9052_USB_current_notifier(struct notifier_block *nb,
  394. unsigned long events, void *data)
  395. {
  396. u8 row;
  397. u8 col;
  398. int *current_mA = data;
  399. int ret;
  400. struct da9052_battery *bat = container_of(nb, struct da9052_battery,
  401. nb);
  402. if (bat->status == POWER_SUPPLY_STATUS_DISCHARGING)
  403. return -EPERM;
  404. ret = da9052_reg_read(bat->da9052, DA9052_CHGBUCK_REG);
  405. if (ret & DA9052_CHG_USB_ILIM_MASK)
  406. return -EPERM;
  407. if (bat->da9052->chip_id == DA9052)
  408. row = 0;
  409. else
  410. row = 1;
  411. if (*current_mA < da9052_chg_current_lim[row][0] ||
  412. *current_mA > da9052_chg_current_lim[row][DA9052_CHG_LIM_COLS - 1])
  413. return -EINVAL;
  414. for (col = 0; col <= DA9052_CHG_LIM_COLS - 1 ; col++) {
  415. if (*current_mA <= da9052_chg_current_lim[row][col])
  416. break;
  417. }
  418. return da9052_reg_update(bat->da9052, DA9052_ISET_REG,
  419. DA9052_ISET_USB_MASK, col);
  420. }
  421. static int da9052_bat_get_property(struct power_supply *psy,
  422. enum power_supply_property psp,
  423. union power_supply_propval *val)
  424. {
  425. int ret;
  426. int illegal;
  427. struct da9052_battery *bat = power_supply_get_drvdata(psy);
  428. ret = da9052_bat_check_presence(bat, &illegal);
  429. if (ret < 0)
  430. return ret;
  431. if (illegal && psp != POWER_SUPPLY_PROP_PRESENT)
  432. return -ENODEV;
  433. switch (psp) {
  434. case POWER_SUPPLY_PROP_STATUS:
  435. ret = da9052_bat_check_status(bat, &val->intval);
  436. break;
  437. case POWER_SUPPLY_PROP_ONLINE:
  438. val->intval =
  439. (bat->charger_type == DA9052_NOCHARGER) ? 0 : 1;
  440. break;
  441. case POWER_SUPPLY_PROP_PRESENT:
  442. ret = da9052_bat_check_presence(bat, &val->intval);
  443. break;
  444. case POWER_SUPPLY_PROP_HEALTH:
  445. ret = da9052_bat_check_health(bat, &val->intval);
  446. break;
  447. case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
  448. val->intval = DA9052_BAT_CUTOFF_VOLT * 1000;
  449. break;
  450. case POWER_SUPPLY_PROP_VOLTAGE_AVG:
  451. ret = da9052_bat_read_volt(bat, &val->intval);
  452. break;
  453. case POWER_SUPPLY_PROP_CURRENT_AVG:
  454. ret = da9052_read_chg_current(bat, &val->intval);
  455. break;
  456. case POWER_SUPPLY_PROP_CAPACITY:
  457. ret = da9052_bat_read_capacity(bat, &val->intval);
  458. break;
  459. case POWER_SUPPLY_PROP_TEMP:
  460. val->intval = da9052_adc_read_temp(bat->da9052);
  461. ret = val->intval;
  462. break;
  463. case POWER_SUPPLY_PROP_TECHNOLOGY:
  464. val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
  465. break;
  466. default:
  467. return -EINVAL;
  468. }
  469. return ret;
  470. }
  471. static enum power_supply_property da9052_bat_props[] = {
  472. POWER_SUPPLY_PROP_STATUS,
  473. POWER_SUPPLY_PROP_ONLINE,
  474. POWER_SUPPLY_PROP_PRESENT,
  475. POWER_SUPPLY_PROP_HEALTH,
  476. POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
  477. POWER_SUPPLY_PROP_VOLTAGE_AVG,
  478. POWER_SUPPLY_PROP_CURRENT_AVG,
  479. POWER_SUPPLY_PROP_CAPACITY,
  480. POWER_SUPPLY_PROP_TEMP,
  481. POWER_SUPPLY_PROP_TECHNOLOGY,
  482. };
  483. static struct power_supply_desc psy_desc = {
  484. .name = "da9052-bat",
  485. .type = POWER_SUPPLY_TYPE_BATTERY,
  486. .properties = da9052_bat_props,
  487. .num_properties = ARRAY_SIZE(da9052_bat_props),
  488. .get_property = da9052_bat_get_property,
  489. };
  490. static char *da9052_bat_irqs[] = {
  491. "BATT TEMP",
  492. "DCIN DET",
  493. "DCIN REM",
  494. "VBUS DET",
  495. "VBUS REM",
  496. "CHG END",
  497. };
  498. static int da9052_bat_irq_bits[] = {
  499. DA9052_IRQ_TBAT,
  500. DA9052_IRQ_DCIN,
  501. DA9052_IRQ_DCINREM,
  502. DA9052_IRQ_VBUS,
  503. DA9052_IRQ_VBUSREM,
  504. DA9052_IRQ_CHGEND,
  505. };
  506. static s32 da9052_bat_probe(struct platform_device *pdev)
  507. {
  508. struct da9052_pdata *pdata;
  509. struct da9052_battery *bat;
  510. struct power_supply_config psy_cfg = {};
  511. int ret;
  512. int i;
  513. bat = devm_kzalloc(&pdev->dev, sizeof(struct da9052_battery),
  514. GFP_KERNEL);
  515. if (!bat)
  516. return -ENOMEM;
  517. psy_cfg.drv_data = bat;
  518. bat->da9052 = dev_get_drvdata(pdev->dev.parent);
  519. bat->charger_type = DA9052_NOCHARGER;
  520. bat->status = POWER_SUPPLY_STATUS_UNKNOWN;
  521. bat->health = POWER_SUPPLY_HEALTH_UNKNOWN;
  522. bat->nb.notifier_call = da9052_USB_current_notifier;
  523. pdata = bat->da9052->dev->platform_data;
  524. if (pdata != NULL && pdata->use_for_apm)
  525. psy_desc.use_for_apm = pdata->use_for_apm;
  526. else
  527. psy_desc.use_for_apm = 1;
  528. for (i = 0; i < ARRAY_SIZE(da9052_bat_irqs); i++) {
  529. ret = da9052_request_irq(bat->da9052,
  530. da9052_bat_irq_bits[i], da9052_bat_irqs[i],
  531. da9052_bat_irq, bat);
  532. if (ret != 0) {
  533. dev_err(bat->da9052->dev,
  534. "DA9052 failed to request %s IRQ: %d\n",
  535. da9052_bat_irqs[i], ret);
  536. goto err;
  537. }
  538. }
  539. bat->psy = power_supply_register(&pdev->dev, &psy_desc, &psy_cfg);
  540. if (IS_ERR(bat->psy)) {
  541. ret = PTR_ERR(bat->psy);
  542. goto err;
  543. }
  544. platform_set_drvdata(pdev, bat);
  545. return 0;
  546. err:
  547. while (--i >= 0)
  548. da9052_free_irq(bat->da9052, da9052_bat_irq_bits[i], bat);
  549. return ret;
  550. }
  551. static int da9052_bat_remove(struct platform_device *pdev)
  552. {
  553. int i;
  554. struct da9052_battery *bat = platform_get_drvdata(pdev);
  555. for (i = 0; i < ARRAY_SIZE(da9052_bat_irqs); i++)
  556. da9052_free_irq(bat->da9052, da9052_bat_irq_bits[i], bat);
  557. power_supply_unregister(bat->psy);
  558. return 0;
  559. }
  560. static struct platform_driver da9052_bat_driver = {
  561. .probe = da9052_bat_probe,
  562. .remove = da9052_bat_remove,
  563. .driver = {
  564. .name = "da9052-bat",
  565. },
  566. };
  567. module_platform_driver(da9052_bat_driver);
  568. MODULE_DESCRIPTION("DA9052 BAT Device Driver");
  569. MODULE_AUTHOR("David Dajun Chen <dchen@diasemi.com>");
  570. MODULE_LICENSE("GPL");
  571. MODULE_ALIAS("platform:da9052-bat");