da9052-core.c 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577
  1. /*
  2. * Device access for Dialog DA9052 PMICs.
  3. *
  4. * Copyright(c) 2011 Dialog Semiconductor Ltd.
  5. *
  6. * Author: David Dajun Chen <dchen@diasemi.com>
  7. *
  8. * This program is free software; you can redistribute it and/or modify it
  9. * under the terms of the GNU General Public License as published by the
  10. * Free Software Foundation; either version 2 of the License, or (at your
  11. * option) any later version.
  12. */
  13. #include <linux/device.h>
  14. #include <linux/delay.h>
  15. #include <linux/input.h>
  16. #include <linux/interrupt.h>
  17. #include <linux/mfd/core.h>
  18. #include <linux/slab.h>
  19. #include <linux/module.h>
  20. #include <linux/mfd/da9052/da9052.h>
  21. #include <linux/mfd/da9052/pdata.h>
  22. #include <linux/mfd/da9052/reg.h>
  23. static bool da9052_reg_readable(struct device *dev, unsigned int reg)
  24. {
  25. switch (reg) {
  26. case DA9052_PAGE0_CON_REG:
  27. case DA9052_STATUS_A_REG:
  28. case DA9052_STATUS_B_REG:
  29. case DA9052_STATUS_C_REG:
  30. case DA9052_STATUS_D_REG:
  31. case DA9052_EVENT_A_REG:
  32. case DA9052_EVENT_B_REG:
  33. case DA9052_EVENT_C_REG:
  34. case DA9052_EVENT_D_REG:
  35. case DA9052_FAULTLOG_REG:
  36. case DA9052_IRQ_MASK_A_REG:
  37. case DA9052_IRQ_MASK_B_REG:
  38. case DA9052_IRQ_MASK_C_REG:
  39. case DA9052_IRQ_MASK_D_REG:
  40. case DA9052_CONTROL_A_REG:
  41. case DA9052_CONTROL_B_REG:
  42. case DA9052_CONTROL_C_REG:
  43. case DA9052_CONTROL_D_REG:
  44. case DA9052_PDDIS_REG:
  45. case DA9052_INTERFACE_REG:
  46. case DA9052_RESET_REG:
  47. case DA9052_GPIO_0_1_REG:
  48. case DA9052_GPIO_2_3_REG:
  49. case DA9052_GPIO_4_5_REG:
  50. case DA9052_GPIO_6_7_REG:
  51. case DA9052_GPIO_14_15_REG:
  52. case DA9052_ID_0_1_REG:
  53. case DA9052_ID_2_3_REG:
  54. case DA9052_ID_4_5_REG:
  55. case DA9052_ID_6_7_REG:
  56. case DA9052_ID_8_9_REG:
  57. case DA9052_ID_10_11_REG:
  58. case DA9052_ID_12_13_REG:
  59. case DA9052_ID_14_15_REG:
  60. case DA9052_ID_16_17_REG:
  61. case DA9052_ID_18_19_REG:
  62. case DA9052_ID_20_21_REG:
  63. case DA9052_SEQ_STATUS_REG:
  64. case DA9052_SEQ_A_REG:
  65. case DA9052_SEQ_B_REG:
  66. case DA9052_SEQ_TIMER_REG:
  67. case DA9052_BUCKA_REG:
  68. case DA9052_BUCKB_REG:
  69. case DA9052_BUCKCORE_REG:
  70. case DA9052_BUCKPRO_REG:
  71. case DA9052_BUCKMEM_REG:
  72. case DA9052_BUCKPERI_REG:
  73. case DA9052_LDO1_REG:
  74. case DA9052_LDO2_REG:
  75. case DA9052_LDO3_REG:
  76. case DA9052_LDO4_REG:
  77. case DA9052_LDO5_REG:
  78. case DA9052_LDO6_REG:
  79. case DA9052_LDO7_REG:
  80. case DA9052_LDO8_REG:
  81. case DA9052_LDO9_REG:
  82. case DA9052_LDO10_REG:
  83. case DA9052_SUPPLY_REG:
  84. case DA9052_PULLDOWN_REG:
  85. case DA9052_CHGBUCK_REG:
  86. case DA9052_WAITCONT_REG:
  87. case DA9052_ISET_REG:
  88. case DA9052_BATCHG_REG:
  89. case DA9052_CHG_CONT_REG:
  90. case DA9052_INPUT_CONT_REG:
  91. case DA9052_CHG_TIME_REG:
  92. case DA9052_BBAT_CONT_REG:
  93. case DA9052_BOOST_REG:
  94. case DA9052_LED_CONT_REG:
  95. case DA9052_LEDMIN123_REG:
  96. case DA9052_LED1_CONF_REG:
  97. case DA9052_LED2_CONF_REG:
  98. case DA9052_LED3_CONF_REG:
  99. case DA9052_LED1CONT_REG:
  100. case DA9052_LED2CONT_REG:
  101. case DA9052_LED3CONT_REG:
  102. case DA9052_LED_CONT_4_REG:
  103. case DA9052_LED_CONT_5_REG:
  104. case DA9052_ADC_MAN_REG:
  105. case DA9052_ADC_CONT_REG:
  106. case DA9052_ADC_RES_L_REG:
  107. case DA9052_ADC_RES_H_REG:
  108. case DA9052_VDD_RES_REG:
  109. case DA9052_VDD_MON_REG:
  110. case DA9052_ICHG_AV_REG:
  111. case DA9052_ICHG_THD_REG:
  112. case DA9052_ICHG_END_REG:
  113. case DA9052_TBAT_RES_REG:
  114. case DA9052_TBAT_HIGHP_REG:
  115. case DA9052_TBAT_HIGHN_REG:
  116. case DA9052_TBAT_LOW_REG:
  117. case DA9052_T_OFFSET_REG:
  118. case DA9052_ADCIN4_RES_REG:
  119. case DA9052_AUTO4_HIGH_REG:
  120. case DA9052_AUTO4_LOW_REG:
  121. case DA9052_ADCIN5_RES_REG:
  122. case DA9052_AUTO5_HIGH_REG:
  123. case DA9052_AUTO5_LOW_REG:
  124. case DA9052_ADCIN6_RES_REG:
  125. case DA9052_AUTO6_HIGH_REG:
  126. case DA9052_AUTO6_LOW_REG:
  127. case DA9052_TJUNC_RES_REG:
  128. case DA9052_TSI_CONT_A_REG:
  129. case DA9052_TSI_CONT_B_REG:
  130. case DA9052_TSI_X_MSB_REG:
  131. case DA9052_TSI_Y_MSB_REG:
  132. case DA9052_TSI_LSB_REG:
  133. case DA9052_TSI_Z_MSB_REG:
  134. case DA9052_COUNT_S_REG:
  135. case DA9052_COUNT_MI_REG:
  136. case DA9052_COUNT_H_REG:
  137. case DA9052_COUNT_D_REG:
  138. case DA9052_COUNT_MO_REG:
  139. case DA9052_COUNT_Y_REG:
  140. case DA9052_ALARM_MI_REG:
  141. case DA9052_ALARM_H_REG:
  142. case DA9052_ALARM_D_REG:
  143. case DA9052_ALARM_MO_REG:
  144. case DA9052_ALARM_Y_REG:
  145. case DA9052_SECOND_A_REG:
  146. case DA9052_SECOND_B_REG:
  147. case DA9052_SECOND_C_REG:
  148. case DA9052_SECOND_D_REG:
  149. case DA9052_PAGE1_CON_REG:
  150. return true;
  151. default:
  152. return false;
  153. }
  154. }
  155. static bool da9052_reg_writeable(struct device *dev, unsigned int reg)
  156. {
  157. switch (reg) {
  158. case DA9052_PAGE0_CON_REG:
  159. case DA9052_EVENT_A_REG:
  160. case DA9052_EVENT_B_REG:
  161. case DA9052_EVENT_C_REG:
  162. case DA9052_EVENT_D_REG:
  163. case DA9052_IRQ_MASK_A_REG:
  164. case DA9052_IRQ_MASK_B_REG:
  165. case DA9052_IRQ_MASK_C_REG:
  166. case DA9052_IRQ_MASK_D_REG:
  167. case DA9052_CONTROL_A_REG:
  168. case DA9052_CONTROL_B_REG:
  169. case DA9052_CONTROL_C_REG:
  170. case DA9052_CONTROL_D_REG:
  171. case DA9052_PDDIS_REG:
  172. case DA9052_RESET_REG:
  173. case DA9052_GPIO_0_1_REG:
  174. case DA9052_GPIO_2_3_REG:
  175. case DA9052_GPIO_4_5_REG:
  176. case DA9052_GPIO_6_7_REG:
  177. case DA9052_GPIO_14_15_REG:
  178. case DA9052_ID_0_1_REG:
  179. case DA9052_ID_2_3_REG:
  180. case DA9052_ID_4_5_REG:
  181. case DA9052_ID_6_7_REG:
  182. case DA9052_ID_8_9_REG:
  183. case DA9052_ID_10_11_REG:
  184. case DA9052_ID_12_13_REG:
  185. case DA9052_ID_14_15_REG:
  186. case DA9052_ID_16_17_REG:
  187. case DA9052_ID_18_19_REG:
  188. case DA9052_ID_20_21_REG:
  189. case DA9052_SEQ_STATUS_REG:
  190. case DA9052_SEQ_A_REG:
  191. case DA9052_SEQ_B_REG:
  192. case DA9052_SEQ_TIMER_REG:
  193. case DA9052_BUCKA_REG:
  194. case DA9052_BUCKB_REG:
  195. case DA9052_BUCKCORE_REG:
  196. case DA9052_BUCKPRO_REG:
  197. case DA9052_BUCKMEM_REG:
  198. case DA9052_BUCKPERI_REG:
  199. case DA9052_LDO1_REG:
  200. case DA9052_LDO2_REG:
  201. case DA9052_LDO3_REG:
  202. case DA9052_LDO4_REG:
  203. case DA9052_LDO5_REG:
  204. case DA9052_LDO6_REG:
  205. case DA9052_LDO7_REG:
  206. case DA9052_LDO8_REG:
  207. case DA9052_LDO9_REG:
  208. case DA9052_LDO10_REG:
  209. case DA9052_SUPPLY_REG:
  210. case DA9052_PULLDOWN_REG:
  211. case DA9052_CHGBUCK_REG:
  212. case DA9052_WAITCONT_REG:
  213. case DA9052_ISET_REG:
  214. case DA9052_BATCHG_REG:
  215. case DA9052_CHG_CONT_REG:
  216. case DA9052_INPUT_CONT_REG:
  217. case DA9052_BBAT_CONT_REG:
  218. case DA9052_BOOST_REG:
  219. case DA9052_LED_CONT_REG:
  220. case DA9052_LEDMIN123_REG:
  221. case DA9052_LED1_CONF_REG:
  222. case DA9052_LED2_CONF_REG:
  223. case DA9052_LED3_CONF_REG:
  224. case DA9052_LED1CONT_REG:
  225. case DA9052_LED2CONT_REG:
  226. case DA9052_LED3CONT_REG:
  227. case DA9052_LED_CONT_4_REG:
  228. case DA9052_LED_CONT_5_REG:
  229. case DA9052_ADC_MAN_REG:
  230. case DA9052_ADC_CONT_REG:
  231. case DA9052_ADC_RES_L_REG:
  232. case DA9052_ADC_RES_H_REG:
  233. case DA9052_VDD_RES_REG:
  234. case DA9052_VDD_MON_REG:
  235. case DA9052_ICHG_THD_REG:
  236. case DA9052_ICHG_END_REG:
  237. case DA9052_TBAT_HIGHP_REG:
  238. case DA9052_TBAT_HIGHN_REG:
  239. case DA9052_TBAT_LOW_REG:
  240. case DA9052_T_OFFSET_REG:
  241. case DA9052_AUTO4_HIGH_REG:
  242. case DA9052_AUTO4_LOW_REG:
  243. case DA9052_AUTO5_HIGH_REG:
  244. case DA9052_AUTO5_LOW_REG:
  245. case DA9052_AUTO6_HIGH_REG:
  246. case DA9052_AUTO6_LOW_REG:
  247. case DA9052_TSI_CONT_A_REG:
  248. case DA9052_TSI_CONT_B_REG:
  249. case DA9052_COUNT_S_REG:
  250. case DA9052_COUNT_MI_REG:
  251. case DA9052_COUNT_H_REG:
  252. case DA9052_COUNT_D_REG:
  253. case DA9052_COUNT_MO_REG:
  254. case DA9052_COUNT_Y_REG:
  255. case DA9052_ALARM_MI_REG:
  256. case DA9052_ALARM_H_REG:
  257. case DA9052_ALARM_D_REG:
  258. case DA9052_ALARM_MO_REG:
  259. case DA9052_ALARM_Y_REG:
  260. case DA9052_PAGE1_CON_REG:
  261. return true;
  262. default:
  263. return false;
  264. }
  265. }
  266. static bool da9052_reg_volatile(struct device *dev, unsigned int reg)
  267. {
  268. switch (reg) {
  269. case DA9052_STATUS_A_REG:
  270. case DA9052_STATUS_B_REG:
  271. case DA9052_STATUS_C_REG:
  272. case DA9052_STATUS_D_REG:
  273. case DA9052_EVENT_A_REG:
  274. case DA9052_EVENT_B_REG:
  275. case DA9052_EVENT_C_REG:
  276. case DA9052_EVENT_D_REG:
  277. case DA9052_FAULTLOG_REG:
  278. case DA9052_CHG_TIME_REG:
  279. case DA9052_ADC_RES_L_REG:
  280. case DA9052_ADC_RES_H_REG:
  281. case DA9052_VDD_RES_REG:
  282. case DA9052_ICHG_AV_REG:
  283. case DA9052_TBAT_RES_REG:
  284. case DA9052_ADCIN4_RES_REG:
  285. case DA9052_ADCIN5_RES_REG:
  286. case DA9052_ADCIN6_RES_REG:
  287. case DA9052_TJUNC_RES_REG:
  288. case DA9052_TSI_X_MSB_REG:
  289. case DA9052_TSI_Y_MSB_REG:
  290. case DA9052_TSI_LSB_REG:
  291. case DA9052_TSI_Z_MSB_REG:
  292. case DA9052_COUNT_S_REG:
  293. case DA9052_COUNT_MI_REG:
  294. case DA9052_COUNT_H_REG:
  295. case DA9052_COUNT_D_REG:
  296. case DA9052_COUNT_MO_REG:
  297. case DA9052_COUNT_Y_REG:
  298. case DA9052_ALARM_MI_REG:
  299. return true;
  300. default:
  301. return false;
  302. }
  303. }
  304. /*
  305. * TBAT look-up table is computed from the R90 reg (8 bit register)
  306. * reading as below. The battery temperature is in milliCentigrade
  307. * TBAT = (1/(t1+1/298) - 273) * 1000 mC
  308. * where t1 = (1/B)* ln(( ADCval * 2.5)/(R25*ITBAT*255))
  309. * Default values are R25 = 10e3, B = 3380, ITBAT = 50e-6
  310. * Example:
  311. * R25=10E3, B=3380, ITBAT=50e-6, ADCVAL=62d calculates
  312. * TBAT = 20015 mili degrees Centrigrade
  313. *
  314. */
  315. static const int32_t tbat_lookup[255] = {
  316. 183258, 144221, 124334, 111336, 101826, 94397, 88343, 83257,
  317. 78889, 75071, 71688, 68656, 65914, 63414, 61120, 59001,
  318. 570366, 55204, 53490, 51881, 50364, 48931, 47574, 46285,
  319. 45059, 43889, 42772, 41703, 40678, 39694, 38748, 37838,
  320. 36961, 36115, 35297, 34507, 33743, 33002, 32284, 31588,
  321. 30911, 30254, 29615, 28994, 28389, 27799, 27225, 26664,
  322. 26117, 25584, 25062, 24553, 24054, 23567, 23091, 22624,
  323. 22167, 21719, 21281, 20851, 20429, 20015, 19610, 19211,
  324. 18820, 18436, 18058, 17688, 17323, 16965, 16612, 16266,
  325. 15925, 15589, 15259, 14933, 14613, 14298, 13987, 13681,
  326. 13379, 13082, 12788, 12499, 12214, 11933, 11655, 11382,
  327. 11112, 10845, 10582, 10322, 10066, 9812, 9562, 9315,
  328. 9071, 8830, 8591, 8356, 8123, 7893, 7665, 7440,
  329. 7218, 6998, 6780, 6565, 6352, 6141, 5933, 5726,
  330. 5522, 5320, 5120, 4922, 4726, 4532, 4340, 4149,
  331. 3961, 3774, 3589, 3406, 3225, 3045, 2867, 2690,
  332. 2516, 2342, 2170, 2000, 1831, 1664, 1498, 1334,
  333. 1171, 1009, 849, 690, 532, 376, 221, 67,
  334. -84, -236, -386, -535, -683, -830, -975, -1119,
  335. -1263, -1405, -1546, -1686, -1825, -1964, -2101, -2237,
  336. -2372, -2506, -2639, -2771, -2902, -3033, -3162, -3291,
  337. -3418, -3545, -3671, -3796, -3920, -4044, -4166, -4288,
  338. -4409, -4529, -4649, -4767, -4885, -5002, -5119, -5235,
  339. -5349, -5464, -5577, -5690, -5802, -5913, -6024, -6134,
  340. -6244, -6352, -6461, -6568, -6675, -6781, -6887, -6992,
  341. -7096, -7200, -7303, -7406, -7508, -7609, -7710, -7810,
  342. -7910, -8009, -8108, -8206, -8304, -8401, -8497, -8593,
  343. -8689, -8784, -8878, -8972, -9066, -9159, -9251, -9343,
  344. -9435, -9526, -9617, -9707, -9796, -9886, -9975, -10063,
  345. -10151, -10238, -10325, -10412, -10839, -10923, -11007, -11090,
  346. -11173, -11256, -11338, -11420, -11501, -11583, -11663, -11744,
  347. -11823, -11903, -11982
  348. };
  349. static const u8 chan_mux[DA9052_ADC_VBBAT + 1] = {
  350. [DA9052_ADC_VDDOUT] = DA9052_ADC_MAN_MUXSEL_VDDOUT,
  351. [DA9052_ADC_ICH] = DA9052_ADC_MAN_MUXSEL_ICH,
  352. [DA9052_ADC_TBAT] = DA9052_ADC_MAN_MUXSEL_TBAT,
  353. [DA9052_ADC_VBAT] = DA9052_ADC_MAN_MUXSEL_VBAT,
  354. [DA9052_ADC_IN4] = DA9052_ADC_MAN_MUXSEL_AD4,
  355. [DA9052_ADC_IN5] = DA9052_ADC_MAN_MUXSEL_AD5,
  356. [DA9052_ADC_IN6] = DA9052_ADC_MAN_MUXSEL_AD6,
  357. [DA9052_ADC_VBBAT] = DA9052_ADC_MAN_MUXSEL_VBBAT
  358. };
  359. int da9052_adc_manual_read(struct da9052 *da9052, unsigned char channel)
  360. {
  361. int ret;
  362. unsigned short calc_data;
  363. unsigned short data;
  364. unsigned char mux_sel;
  365. if (channel > DA9052_ADC_VBBAT)
  366. return -EINVAL;
  367. mutex_lock(&da9052->auxadc_lock);
  368. /* Channel gets activated on enabling the Conversion bit */
  369. mux_sel = chan_mux[channel] | DA9052_ADC_MAN_MAN_CONV;
  370. ret = da9052_reg_write(da9052, DA9052_ADC_MAN_REG, mux_sel);
  371. if (ret < 0)
  372. goto err;
  373. /* Wait for an interrupt */
  374. if (!wait_for_completion_timeout(&da9052->done,
  375. msecs_to_jiffies(500))) {
  376. dev_err(da9052->dev,
  377. "timeout waiting for ADC conversion interrupt\n");
  378. ret = -ETIMEDOUT;
  379. goto err;
  380. }
  381. ret = da9052_reg_read(da9052, DA9052_ADC_RES_H_REG);
  382. if (ret < 0)
  383. goto err;
  384. calc_data = (unsigned short)ret;
  385. data = calc_data << 2;
  386. ret = da9052_reg_read(da9052, DA9052_ADC_RES_L_REG);
  387. if (ret < 0)
  388. goto err;
  389. calc_data = (unsigned short)(ret & DA9052_ADC_RES_LSB);
  390. data |= calc_data;
  391. ret = data;
  392. err:
  393. mutex_unlock(&da9052->auxadc_lock);
  394. return ret;
  395. }
  396. EXPORT_SYMBOL_GPL(da9052_adc_manual_read);
  397. int da9052_adc_read_temp(struct da9052 *da9052)
  398. {
  399. int tbat;
  400. tbat = da9052_reg_read(da9052, DA9052_TBAT_RES_REG);
  401. if (tbat <= 0)
  402. return tbat;
  403. /* ARRAY_SIZE check is not needed since TBAT is a 8-bit register */
  404. return tbat_lookup[tbat - 1];
  405. }
  406. EXPORT_SYMBOL_GPL(da9052_adc_read_temp);
  407. static struct mfd_cell da9052_subdev_info[] = {
  408. {
  409. .name = "da9052-regulator",
  410. .id = 1,
  411. },
  412. {
  413. .name = "da9052-regulator",
  414. .id = 2,
  415. },
  416. {
  417. .name = "da9052-regulator",
  418. .id = 3,
  419. },
  420. {
  421. .name = "da9052-regulator",
  422. .id = 4,
  423. },
  424. {
  425. .name = "da9052-regulator",
  426. .id = 5,
  427. },
  428. {
  429. .name = "da9052-regulator",
  430. .id = 6,
  431. },
  432. {
  433. .name = "da9052-regulator",
  434. .id = 7,
  435. },
  436. {
  437. .name = "da9052-regulator",
  438. .id = 8,
  439. },
  440. {
  441. .name = "da9052-regulator",
  442. .id = 9,
  443. },
  444. {
  445. .name = "da9052-regulator",
  446. .id = 10,
  447. },
  448. {
  449. .name = "da9052-regulator",
  450. .id = 11,
  451. },
  452. {
  453. .name = "da9052-regulator",
  454. .id = 12,
  455. },
  456. {
  457. .name = "da9052-regulator",
  458. .id = 13,
  459. },
  460. {
  461. .name = "da9052-regulator",
  462. .id = 14,
  463. },
  464. {
  465. .name = "da9052-onkey",
  466. },
  467. {
  468. .name = "da9052-rtc",
  469. },
  470. {
  471. .name = "da9052-gpio",
  472. },
  473. {
  474. .name = "da9052-hwmon",
  475. },
  476. {
  477. .name = "da9052-leds",
  478. },
  479. {
  480. .name = "da9052-wled1",
  481. },
  482. {
  483. .name = "da9052-wled2",
  484. },
  485. {
  486. .name = "da9052-wled3",
  487. },
  488. {
  489. .name = "da9052-tsi",
  490. },
  491. {
  492. .name = "da9052-bat",
  493. },
  494. {
  495. .name = "da9052-watchdog",
  496. },
  497. };
  498. struct regmap_config da9052_regmap_config = {
  499. .reg_bits = 8,
  500. .val_bits = 8,
  501. .cache_type = REGCACHE_RBTREE,
  502. .max_register = DA9052_PAGE1_CON_REG,
  503. .readable_reg = da9052_reg_readable,
  504. .writeable_reg = da9052_reg_writeable,
  505. .volatile_reg = da9052_reg_volatile,
  506. };
  507. EXPORT_SYMBOL_GPL(da9052_regmap_config);
  508. int da9052_device_init(struct da9052 *da9052, u8 chip_id)
  509. {
  510. struct da9052_pdata *pdata = da9052->dev->platform_data;
  511. int ret;
  512. mutex_init(&da9052->auxadc_lock);
  513. init_completion(&da9052->done);
  514. if (pdata && pdata->init != NULL)
  515. pdata->init(da9052);
  516. da9052->chip_id = chip_id;
  517. ret = da9052_irq_init(da9052);
  518. if (ret != 0) {
  519. dev_err(da9052->dev, "da9052_irq_init failed: %d\n", ret);
  520. return ret;
  521. }
  522. ret = mfd_add_devices(da9052->dev, -1, da9052_subdev_info,
  523. ARRAY_SIZE(da9052_subdev_info), NULL, 0, NULL);
  524. if (ret) {
  525. dev_err(da9052->dev, "mfd_add_devices failed: %d\n", ret);
  526. goto err;
  527. }
  528. return 0;
  529. err:
  530. da9052_irq_exit(da9052);
  531. return ret;
  532. }
  533. void da9052_device_exit(struct da9052 *da9052)
  534. {
  535. mfd_remove_devices(da9052->dev);
  536. da9052_irq_exit(da9052);
  537. }
  538. MODULE_AUTHOR("David Dajun Chen <dchen@diasemi.com>");
  539. MODULE_DESCRIPTION("DA9052 MFD Core");
  540. MODULE_LICENSE("GPL");