max8998.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679
  1. /*
  2. * max8998.c - Voltage regulator driver for the Maxim 8998
  3. *
  4. * Copyright (C) 2009-2010 Samsung Electronics
  5. * Kyungmin Park <kyungmin.park@samsung.com>
  6. * Marek Szyprowski <m.szyprowski@samsung.com>
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation; either version 2 of the License, or
  11. * (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  21. */
  22. #include <linux/module.h>
  23. #include <linux/init.h>
  24. #include <linux/i2c.h>
  25. #include <linux/err.h>
  26. #include <linux/gpio.h>
  27. #include <linux/slab.h>
  28. #include <linux/interrupt.h>
  29. #include <linux/mutex.h>
  30. #include <linux/delay.h>
  31. #include <linux/platform_device.h>
  32. #include <linux/regulator/driver.h>
  33. #include <linux/mfd/max8998.h>
  34. #include <linux/mfd/max8998-private.h>
  35. struct max8998_data {
  36. struct device *dev;
  37. struct max8998_dev *iodev;
  38. int num_regulators;
  39. struct regulator_dev **rdev;
  40. };
  41. struct voltage_map_desc {
  42. int min;
  43. int max;
  44. int step;
  45. };
  46. /* Voltage maps */
  47. static const struct voltage_map_desc ldo23_voltage_map_desc = {
  48. .min = 800, .step = 50, .max = 1300,
  49. };
  50. static const struct voltage_map_desc ldo456711_voltage_map_desc = {
  51. .min = 1600, .step = 100, .max = 3600,
  52. };
  53. static const struct voltage_map_desc ldo8_voltage_map_desc = {
  54. .min = 3000, .step = 100, .max = 3600,
  55. };
  56. static const struct voltage_map_desc ldo9_voltage_map_desc = {
  57. .min = 2800, .step = 100, .max = 3100,
  58. };
  59. static const struct voltage_map_desc ldo10_voltage_map_desc = {
  60. .min = 950, .step = 50, .max = 1300,
  61. };
  62. static const struct voltage_map_desc ldo1213_voltage_map_desc = {
  63. .min = 800, .step = 100, .max = 3300,
  64. };
  65. static const struct voltage_map_desc ldo1415_voltage_map_desc = {
  66. .min = 1200, .step = 100, .max = 3300,
  67. };
  68. static const struct voltage_map_desc ldo1617_voltage_map_desc = {
  69. .min = 1600, .step = 100, .max = 3600,
  70. };
  71. static const struct voltage_map_desc buck12_voltage_map_desc = {
  72. .min = 750, .step = 25, .max = 1525,
  73. };
  74. static const struct voltage_map_desc buck3_voltage_map_desc = {
  75. .min = 1600, .step = 100, .max = 3600,
  76. };
  77. static const struct voltage_map_desc buck4_voltage_map_desc = {
  78. .min = 800, .step = 100, .max = 2300,
  79. };
  80. static const struct voltage_map_desc *ldo_voltage_map[] = {
  81. NULL,
  82. NULL,
  83. &ldo23_voltage_map_desc, /* LDO2 */
  84. &ldo23_voltage_map_desc, /* LDO3 */
  85. &ldo456711_voltage_map_desc, /* LDO4 */
  86. &ldo456711_voltage_map_desc, /* LDO5 */
  87. &ldo456711_voltage_map_desc, /* LDO6 */
  88. &ldo456711_voltage_map_desc, /* LDO7 */
  89. &ldo8_voltage_map_desc, /* LDO8 */
  90. &ldo9_voltage_map_desc, /* LDO9 */
  91. &ldo10_voltage_map_desc, /* LDO10 */
  92. &ldo456711_voltage_map_desc, /* LDO11 */
  93. &ldo1213_voltage_map_desc, /* LDO12 */
  94. &ldo1213_voltage_map_desc, /* LDO13 */
  95. &ldo1415_voltage_map_desc, /* LDO14 */
  96. &ldo1415_voltage_map_desc, /* LDO15 */
  97. &ldo1617_voltage_map_desc, /* LDO16 */
  98. &ldo1617_voltage_map_desc, /* LDO17 */
  99. &buck12_voltage_map_desc, /* BUCK1 */
  100. &buck12_voltage_map_desc, /* BUCK2 */
  101. &buck3_voltage_map_desc, /* BUCK3 */
  102. &buck4_voltage_map_desc, /* BUCK4 */
  103. };
  104. static inline int max8998_get_ldo(struct regulator_dev *rdev)
  105. {
  106. return rdev_get_id(rdev);
  107. }
  108. static int max8998_list_voltage(struct regulator_dev *rdev,
  109. unsigned int selector)
  110. {
  111. const struct voltage_map_desc *desc;
  112. int ldo = max8998_get_ldo(rdev);
  113. int val;
  114. if (ldo >= ARRAY_SIZE(ldo_voltage_map))
  115. return -EINVAL;
  116. desc = ldo_voltage_map[ldo];
  117. if (desc == NULL)
  118. return -EINVAL;
  119. val = desc->min + desc->step * selector;
  120. if (val > desc->max)
  121. return -EINVAL;
  122. return val * 1000;
  123. }
  124. static int max8998_get_enable_register(struct regulator_dev *rdev,
  125. int *reg, int *shift)
  126. {
  127. int ldo = max8998_get_ldo(rdev);
  128. switch (ldo) {
  129. case MAX8998_LDO2 ... MAX8998_LDO5:
  130. *reg = MAX8998_REG_ONOFF1;
  131. *shift = 3 - (ldo - MAX8998_LDO2);
  132. break;
  133. case MAX8998_LDO6 ... MAX8998_LDO13:
  134. *reg = MAX8998_REG_ONOFF2;
  135. *shift = 7 - (ldo - MAX8998_LDO6);
  136. break;
  137. case MAX8998_LDO14 ... MAX8998_LDO17:
  138. *reg = MAX8998_REG_ONOFF3;
  139. *shift = 7 - (ldo - MAX8998_LDO14);
  140. break;
  141. case MAX8998_BUCK1 ... MAX8998_BUCK4:
  142. *reg = MAX8998_REG_ONOFF1;
  143. *shift = 7 - (ldo - MAX8998_BUCK1);
  144. break;
  145. case MAX8998_EN32KHZ_AP ... MAX8998_ENVICHG:
  146. *reg = MAX8998_REG_ONOFF4;
  147. *shift = 7 - (ldo - MAX8998_EN32KHZ_AP);
  148. break;
  149. case MAX8998_ESAFEOUT1 ... MAX8998_ESAFEOUT2:
  150. *reg = MAX8998_REG_CHGR2;
  151. *shift = 7 - (ldo - MAX8998_ESAFEOUT1);
  152. break;
  153. default:
  154. return -EINVAL;
  155. }
  156. return 0;
  157. }
  158. static int max8998_ldo_is_enabled(struct regulator_dev *rdev)
  159. {
  160. struct max8998_data *max8998 = rdev_get_drvdata(rdev);
  161. struct i2c_client *i2c = max8998->iodev->i2c;
  162. int ret, reg, shift = 8;
  163. u8 val;
  164. ret = max8998_get_enable_register(rdev, &reg, &shift);
  165. if (ret)
  166. return ret;
  167. ret = max8998_read_reg(i2c, reg, &val);
  168. if (ret)
  169. return ret;
  170. return val & (1 << shift);
  171. }
  172. static int max8998_ldo_enable(struct regulator_dev *rdev)
  173. {
  174. struct max8998_data *max8998 = rdev_get_drvdata(rdev);
  175. struct i2c_client *i2c = max8998->iodev->i2c;
  176. int reg, shift = 8, ret;
  177. ret = max8998_get_enable_register(rdev, &reg, &shift);
  178. if (ret)
  179. return ret;
  180. return max8998_update_reg(i2c, reg, 1<<shift, 1<<shift);
  181. }
  182. static int max8998_ldo_disable(struct regulator_dev *rdev)
  183. {
  184. struct max8998_data *max8998 = rdev_get_drvdata(rdev);
  185. struct i2c_client *i2c = max8998->iodev->i2c;
  186. int reg, shift = 8, ret;
  187. ret = max8998_get_enable_register(rdev, &reg, &shift);
  188. if (ret)
  189. return ret;
  190. return max8998_update_reg(i2c, reg, 0, 1<<shift);
  191. }
  192. static int max8998_get_voltage_register(struct regulator_dev *rdev,
  193. int *_reg, int *_shift, int *_mask)
  194. {
  195. int ldo = max8998_get_ldo(rdev);
  196. int reg, shift = 0, mask = 0xff;
  197. switch (ldo) {
  198. case MAX8998_LDO2 ... MAX8998_LDO3:
  199. reg = MAX8998_REG_LDO2_LDO3;
  200. mask = 0xf;
  201. if (ldo == MAX8998_LDO2)
  202. shift = 4;
  203. else
  204. shift = 0;
  205. break;
  206. case MAX8998_LDO4 ... MAX8998_LDO7:
  207. reg = MAX8998_REG_LDO4 + (ldo - MAX8998_LDO4);
  208. break;
  209. case MAX8998_LDO8 ... MAX8998_LDO9:
  210. reg = MAX8998_REG_LDO8_LDO9;
  211. mask = 0xf;
  212. if (ldo == MAX8998_LDO8)
  213. shift = 4;
  214. else
  215. shift = 0;
  216. break;
  217. case MAX8998_LDO10 ... MAX8998_LDO11:
  218. reg = MAX8998_REG_LDO10_LDO11;
  219. if (ldo == MAX8998_LDO10) {
  220. shift = 5;
  221. mask = 0x7;
  222. } else {
  223. shift = 0;
  224. mask = 0x1f;
  225. }
  226. break;
  227. case MAX8998_LDO12 ... MAX8998_LDO17:
  228. reg = MAX8998_REG_LDO12 + (ldo - MAX8998_LDO12);
  229. break;
  230. case MAX8998_BUCK1:
  231. reg = MAX8998_REG_BUCK1_DVSARM1;
  232. break;
  233. case MAX8998_BUCK2:
  234. reg = MAX8998_REG_BUCK2_DVSINT1;
  235. break;
  236. case MAX8998_BUCK3:
  237. reg = MAX8998_REG_BUCK3;
  238. break;
  239. case MAX8998_BUCK4:
  240. reg = MAX8998_REG_BUCK4;
  241. break;
  242. default:
  243. return -EINVAL;
  244. }
  245. *_reg = reg;
  246. *_shift = shift;
  247. *_mask = mask;
  248. return 0;
  249. }
  250. static int max8998_get_voltage(struct regulator_dev *rdev)
  251. {
  252. struct max8998_data *max8998 = rdev_get_drvdata(rdev);
  253. struct i2c_client *i2c = max8998->iodev->i2c;
  254. int reg, shift = 0, mask, ret;
  255. u8 val;
  256. ret = max8998_get_voltage_register(rdev, &reg, &shift, &mask);
  257. if (ret)
  258. return ret;
  259. ret = max8998_read_reg(i2c, reg, &val);
  260. if (ret)
  261. return ret;
  262. val >>= shift;
  263. val &= mask;
  264. return max8998_list_voltage(rdev, val);
  265. }
  266. static int max8998_set_voltage_ldo(struct regulator_dev *rdev,
  267. int min_uV, int max_uV)
  268. {
  269. struct max8998_data *max8998 = rdev_get_drvdata(rdev);
  270. struct i2c_client *i2c = max8998->iodev->i2c;
  271. int min_vol = min_uV / 1000, max_vol = max_uV / 1000;
  272. const struct voltage_map_desc *desc;
  273. int ldo = max8998_get_ldo(rdev);
  274. int reg, shift = 0, mask, ret;
  275. int i = 0;
  276. if (ldo >= ARRAY_SIZE(ldo_voltage_map))
  277. return -EINVAL;
  278. desc = ldo_voltage_map[ldo];
  279. if (desc == NULL)
  280. return -EINVAL;
  281. if (max_vol < desc->min || min_vol > desc->max)
  282. return -EINVAL;
  283. while (desc->min + desc->step*i < min_vol &&
  284. desc->min + desc->step*i < desc->max)
  285. i++;
  286. if (desc->min + desc->step*i > max_vol)
  287. return -EINVAL;
  288. ret = max8998_get_voltage_register(rdev, &reg, &shift, &mask);
  289. if (ret)
  290. return ret;
  291. ret = max8998_update_reg(i2c, reg, i<<shift, mask<<shift);
  292. return ret;
  293. }
  294. static int max8998_set_voltage_buck(struct regulator_dev *rdev,
  295. int min_uV, int max_uV)
  296. {
  297. struct max8998_data *max8998 = rdev_get_drvdata(rdev);
  298. struct i2c_client *i2c = max8998->iodev->i2c;
  299. int min_vol = min_uV / 1000, max_vol = max_uV / 1000;
  300. int previous_vol = 0;
  301. const struct voltage_map_desc *desc;
  302. int ldo = max8998_get_ldo(rdev);
  303. int reg, shift = 0, mask, ret;
  304. int i = 0;
  305. u8 val;
  306. bool en_ramp = false;
  307. if (ldo >= ARRAY_SIZE(ldo_voltage_map))
  308. return -EINVAL;
  309. desc = ldo_voltage_map[ldo];
  310. if (desc == NULL)
  311. return -EINVAL;
  312. if (max_vol < desc->min || min_vol > desc->max)
  313. return -EINVAL;
  314. while (desc->min + desc->step*i < min_vol &&
  315. desc->min + desc->step*i < desc->max)
  316. i++;
  317. if (desc->min + desc->step*i > max_vol)
  318. return -EINVAL;
  319. ret = max8998_get_voltage_register(rdev, &reg, &shift, &mask);
  320. if (ret)
  321. return ret;
  322. /* wait for RAMP_UP_DELAY if rdev is BUCK1/2 and
  323. * ENRAMP is ON */
  324. if (ldo == MAX8998_BUCK1 || ldo == MAX8998_BUCK2) {
  325. max8998_read_reg(i2c, MAX8998_REG_ONOFF4, &val);
  326. if (val & (1 << 4)) {
  327. en_ramp = true;
  328. previous_vol = max8998_get_voltage(rdev);
  329. }
  330. }
  331. ret = max8998_update_reg(i2c, reg, i<<shift, mask<<shift);
  332. if (en_ramp == true) {
  333. int difference = desc->min + desc->step*i - previous_vol/1000;
  334. if (difference > 0)
  335. udelay(difference / ((val & 0x0f) + 1));
  336. }
  337. return ret;
  338. }
  339. static struct regulator_ops max8998_ldo_ops = {
  340. .list_voltage = max8998_list_voltage,
  341. .is_enabled = max8998_ldo_is_enabled,
  342. .enable = max8998_ldo_enable,
  343. .disable = max8998_ldo_disable,
  344. .get_voltage = max8998_get_voltage,
  345. .set_voltage = max8998_set_voltage_ldo,
  346. .set_suspend_enable = max8998_ldo_enable,
  347. .set_suspend_disable = max8998_ldo_disable,
  348. };
  349. static struct regulator_ops max8998_buck_ops = {
  350. .list_voltage = max8998_list_voltage,
  351. .is_enabled = max8998_ldo_is_enabled,
  352. .enable = max8998_ldo_enable,
  353. .disable = max8998_ldo_disable,
  354. .get_voltage = max8998_get_voltage,
  355. .set_voltage = max8998_set_voltage_buck,
  356. .set_suspend_enable = max8998_ldo_enable,
  357. .set_suspend_disable = max8998_ldo_disable,
  358. };
  359. static struct regulator_ops max8998_others_ops = {
  360. .is_enabled = max8998_ldo_is_enabled,
  361. .enable = max8998_ldo_enable,
  362. .disable = max8998_ldo_disable,
  363. .set_suspend_enable = max8998_ldo_enable,
  364. .set_suspend_disable = max8998_ldo_disable,
  365. };
  366. static struct regulator_desc regulators[] = {
  367. {
  368. .name = "LDO2",
  369. .id = MAX8998_LDO2,
  370. .ops = &max8998_ldo_ops,
  371. .type = REGULATOR_VOLTAGE,
  372. .owner = THIS_MODULE,
  373. }, {
  374. .name = "LDO3",
  375. .id = MAX8998_LDO3,
  376. .ops = &max8998_ldo_ops,
  377. .type = REGULATOR_VOLTAGE,
  378. .owner = THIS_MODULE,
  379. }, {
  380. .name = "LDO4",
  381. .id = MAX8998_LDO4,
  382. .ops = &max8998_ldo_ops,
  383. .type = REGULATOR_VOLTAGE,
  384. .owner = THIS_MODULE,
  385. }, {
  386. .name = "LDO5",
  387. .id = MAX8998_LDO5,
  388. .ops = &max8998_ldo_ops,
  389. .type = REGULATOR_VOLTAGE,
  390. .owner = THIS_MODULE,
  391. }, {
  392. .name = "LDO6",
  393. .id = MAX8998_LDO6,
  394. .ops = &max8998_ldo_ops,
  395. .type = REGULATOR_VOLTAGE,
  396. .owner = THIS_MODULE,
  397. }, {
  398. .name = "LDO7",
  399. .id = MAX8998_LDO7,
  400. .ops = &max8998_ldo_ops,
  401. .type = REGULATOR_VOLTAGE,
  402. .owner = THIS_MODULE,
  403. }, {
  404. .name = "LDO8",
  405. .id = MAX8998_LDO8,
  406. .ops = &max8998_ldo_ops,
  407. .type = REGULATOR_VOLTAGE,
  408. .owner = THIS_MODULE,
  409. }, {
  410. .name = "LDO9",
  411. .id = MAX8998_LDO9,
  412. .ops = &max8998_ldo_ops,
  413. .type = REGULATOR_VOLTAGE,
  414. .owner = THIS_MODULE,
  415. }, {
  416. .name = "LDO10",
  417. .id = MAX8998_LDO10,
  418. .ops = &max8998_ldo_ops,
  419. .type = REGULATOR_VOLTAGE,
  420. .owner = THIS_MODULE,
  421. }, {
  422. .name = "LDO11",
  423. .id = MAX8998_LDO11,
  424. .ops = &max8998_ldo_ops,
  425. .type = REGULATOR_VOLTAGE,
  426. .owner = THIS_MODULE,
  427. }, {
  428. .name = "LDO12",
  429. .id = MAX8998_LDO12,
  430. .ops = &max8998_ldo_ops,
  431. .type = REGULATOR_VOLTAGE,
  432. .owner = THIS_MODULE,
  433. }, {
  434. .name = "LDO13",
  435. .id = MAX8998_LDO13,
  436. .ops = &max8998_ldo_ops,
  437. .type = REGULATOR_VOLTAGE,
  438. .owner = THIS_MODULE,
  439. }, {
  440. .name = "LDO14",
  441. .id = MAX8998_LDO14,
  442. .ops = &max8998_ldo_ops,
  443. .type = REGULATOR_VOLTAGE,
  444. .owner = THIS_MODULE,
  445. }, {
  446. .name = "LDO15",
  447. .id = MAX8998_LDO15,
  448. .ops = &max8998_ldo_ops,
  449. .type = REGULATOR_VOLTAGE,
  450. .owner = THIS_MODULE,
  451. }, {
  452. .name = "LDO16",
  453. .id = MAX8998_LDO16,
  454. .ops = &max8998_ldo_ops,
  455. .type = REGULATOR_VOLTAGE,
  456. .owner = THIS_MODULE,
  457. }, {
  458. .name = "LDO17",
  459. .id = MAX8998_LDO17,
  460. .ops = &max8998_ldo_ops,
  461. .type = REGULATOR_VOLTAGE,
  462. .owner = THIS_MODULE,
  463. }, {
  464. .name = "BUCK1",
  465. .id = MAX8998_BUCK1,
  466. .ops = &max8998_buck_ops,
  467. .type = REGULATOR_VOLTAGE,
  468. .owner = THIS_MODULE,
  469. }, {
  470. .name = "BUCK2",
  471. .id = MAX8998_BUCK2,
  472. .ops = &max8998_buck_ops,
  473. .type = REGULATOR_VOLTAGE,
  474. .owner = THIS_MODULE,
  475. }, {
  476. .name = "BUCK3",
  477. .id = MAX8998_BUCK3,
  478. .ops = &max8998_buck_ops,
  479. .type = REGULATOR_VOLTAGE,
  480. .owner = THIS_MODULE,
  481. }, {
  482. .name = "BUCK4",
  483. .id = MAX8998_BUCK4,
  484. .ops = &max8998_buck_ops,
  485. .type = REGULATOR_VOLTAGE,
  486. .owner = THIS_MODULE,
  487. }, {
  488. .name = "EN32KHz AP",
  489. .id = MAX8998_EN32KHZ_AP,
  490. .ops = &max8998_others_ops,
  491. .type = REGULATOR_VOLTAGE,
  492. .owner = THIS_MODULE,
  493. }, {
  494. .name = "EN32KHz CP",
  495. .id = MAX8998_EN32KHZ_CP,
  496. .ops = &max8998_others_ops,
  497. .type = REGULATOR_VOLTAGE,
  498. .owner = THIS_MODULE,
  499. }, {
  500. .name = "ENVICHG",
  501. .id = MAX8998_ENVICHG,
  502. .ops = &max8998_others_ops,
  503. .type = REGULATOR_VOLTAGE,
  504. .owner = THIS_MODULE,
  505. }, {
  506. .name = "ESAFEOUT1",
  507. .id = MAX8998_ESAFEOUT1,
  508. .ops = &max8998_others_ops,
  509. .type = REGULATOR_VOLTAGE,
  510. .owner = THIS_MODULE,
  511. }, {
  512. .name = "ESAFEOUT2",
  513. .id = MAX8998_ESAFEOUT2,
  514. .ops = &max8998_others_ops,
  515. .type = REGULATOR_VOLTAGE,
  516. .owner = THIS_MODULE,
  517. }
  518. };
  519. static __devinit int max8998_pmic_probe(struct platform_device *pdev)
  520. {
  521. struct max8998_dev *iodev = dev_get_drvdata(pdev->dev.parent);
  522. struct max8998_platform_data *pdata = dev_get_platdata(iodev->dev);
  523. struct regulator_dev **rdev;
  524. struct max8998_data *max8998;
  525. int i, ret, size;
  526. if (!pdata) {
  527. dev_err(pdev->dev.parent, "No platform init data supplied\n");
  528. return -ENODEV;
  529. }
  530. max8998 = kzalloc(sizeof(struct max8998_data), GFP_KERNEL);
  531. if (!max8998)
  532. return -ENOMEM;
  533. size = sizeof(struct regulator_dev *) * pdata->num_regulators;
  534. max8998->rdev = kzalloc(size, GFP_KERNEL);
  535. if (!max8998->rdev) {
  536. kfree(max8998);
  537. return -ENOMEM;
  538. }
  539. rdev = max8998->rdev;
  540. max8998->dev = &pdev->dev;
  541. max8998->iodev = iodev;
  542. max8998->num_regulators = pdata->num_regulators;
  543. platform_set_drvdata(pdev, max8998);
  544. for (i = 0; i < pdata->num_regulators; i++) {
  545. const struct voltage_map_desc *desc;
  546. int id = pdata->regulators[i].id;
  547. int index = id - MAX8998_LDO2;
  548. desc = ldo_voltage_map[id];
  549. if (desc && regulators[index].ops != &max8998_others_ops) {
  550. int count = (desc->max - desc->min) / desc->step + 1;
  551. regulators[index].n_voltages = count;
  552. }
  553. rdev[i] = regulator_register(&regulators[index], max8998->dev,
  554. pdata->regulators[i].initdata, max8998);
  555. if (IS_ERR(rdev[i])) {
  556. ret = PTR_ERR(rdev[i]);
  557. dev_err(max8998->dev, "regulator init failed\n");
  558. rdev[i] = NULL;
  559. goto err;
  560. }
  561. }
  562. return 0;
  563. err:
  564. for (i = 0; i < max8998->num_regulators; i++)
  565. if (rdev[i])
  566. regulator_unregister(rdev[i]);
  567. kfree(max8998->rdev);
  568. kfree(max8998);
  569. return ret;
  570. }
  571. static int __devexit max8998_pmic_remove(struct platform_device *pdev)
  572. {
  573. struct max8998_data *max8998 = platform_get_drvdata(pdev);
  574. struct regulator_dev **rdev = max8998->rdev;
  575. int i;
  576. for (i = 0; i < max8998->num_regulators; i++)
  577. if (rdev[i])
  578. regulator_unregister(rdev[i]);
  579. kfree(max8998->rdev);
  580. kfree(max8998);
  581. return 0;
  582. }
  583. static struct platform_driver max8998_pmic_driver = {
  584. .driver = {
  585. .name = "max8998-pmic",
  586. .owner = THIS_MODULE,
  587. },
  588. .probe = max8998_pmic_probe,
  589. .remove = __devexit_p(max8998_pmic_remove),
  590. };
  591. static int __init max8998_pmic_init(void)
  592. {
  593. return platform_driver_register(&max8998_pmic_driver);
  594. }
  595. subsys_initcall(max8998_pmic_init);
  596. static void __exit max8998_pmic_cleanup(void)
  597. {
  598. platform_driver_unregister(&max8998_pmic_driver);
  599. }
  600. module_exit(max8998_pmic_cleanup);
  601. MODULE_DESCRIPTION("MAXIM 8998 voltage regulator driver");
  602. MODULE_AUTHOR("Kyungmin Park <kyungmin.park@samsung.com>");
  603. MODULE_LICENSE("GPL");