max77802.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586
  1. /*
  2. * max77802.c - Regulator driver for the Maxim 77802
  3. *
  4. * Copyright (C) 2013-2014 Google, Inc
  5. * Simon Glass <sjg@chromium.org>
  6. *
  7. * Copyright (C) 2012 Samsung Electronics
  8. * Chiwoong Byun <woong.byun@smasung.com>
  9. * Jonghwa Lee <jonghwa3.lee@samsung.com>
  10. *
  11. * This program is free software; you can redistribute it and/or modify
  12. * it under the terms of the GNU General Public License as published by
  13. * the Free Software Foundation; either version 2 of the License, or
  14. * (at your option) any later version.
  15. *
  16. * This program is distributed in the hope that it will be useful,
  17. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  19. * GNU General Public License for more details.
  20. *
  21. * This driver is based on max8997.c
  22. */
  23. #include <linux/kernel.h>
  24. #include <linux/bug.h>
  25. #include <linux/err.h>
  26. #include <linux/gpio.h>
  27. #include <linux/slab.h>
  28. #include <linux/gpio/consumer.h>
  29. #include <linux/platform_device.h>
  30. #include <linux/regulator/driver.h>
  31. #include <linux/regulator/machine.h>
  32. #include <linux/regulator/of_regulator.h>
  33. #include <linux/mfd/max77686.h>
  34. #include <linux/mfd/max77686-private.h>
  35. /* Default ramp delay in case it is not manually set */
  36. #define MAX77802_RAMP_DELAY 100000 /* uV/us */
  37. #define MAX77802_OPMODE_SHIFT_LDO 6
  38. #define MAX77802_OPMODE_BUCK234_SHIFT 4
  39. #define MAX77802_OPMODE_MASK 0x3
  40. #define MAX77802_VSEL_MASK 0x3F
  41. #define MAX77802_DVS_VSEL_MASK 0xFF
  42. #define MAX77802_RAMP_RATE_MASK_2BIT 0xC0
  43. #define MAX77802_RAMP_RATE_SHIFT_2BIT 6
  44. #define MAX77802_RAMP_RATE_MASK_4BIT 0xF0
  45. #define MAX77802_RAMP_RATE_SHIFT_4BIT 4
  46. /* MAX77802 has two register formats: 2-bit and 4-bit */
  47. static const unsigned int ramp_table_77802_2bit[] = {
  48. 12500,
  49. 25000,
  50. 50000,
  51. 100000,
  52. };
  53. static unsigned int ramp_table_77802_4bit[] = {
  54. 1000, 2000, 3030, 4000,
  55. 5000, 5880, 7140, 8330,
  56. 9090, 10000, 11110, 12500,
  57. 16670, 25000, 50000, 100000,
  58. };
  59. struct max77802_regulator_prv {
  60. unsigned int opmode[MAX77802_REG_MAX];
  61. };
  62. static int max77802_get_opmode_shift(int id)
  63. {
  64. if (id == MAX77802_BUCK1 || (id >= MAX77802_BUCK5 &&
  65. id <= MAX77802_BUCK10))
  66. return 0;
  67. if (id >= MAX77802_BUCK2 && id <= MAX77802_BUCK4)
  68. return MAX77802_OPMODE_BUCK234_SHIFT;
  69. if (id >= MAX77802_LDO1 && id <= MAX77802_LDO35)
  70. return MAX77802_OPMODE_SHIFT_LDO;
  71. return -EINVAL;
  72. }
  73. /*
  74. * Some BUCKS supports Normal[ON/OFF] mode during suspend
  75. *
  76. * BUCK 1, 6, 2-4, 5, 7-10 (all)
  77. *
  78. * The other mode (0x02) will make PWRREQ switch between normal
  79. * and low power.
  80. */
  81. static int max77802_buck_set_suspend_disable(struct regulator_dev *rdev)
  82. {
  83. unsigned int val = MAX77802_OPMODE_STANDBY;
  84. struct max77802_regulator_prv *max77802 = rdev_get_drvdata(rdev);
  85. int id = rdev_get_id(rdev);
  86. int shift = max77802_get_opmode_shift(id);
  87. max77802->opmode[id] = val;
  88. return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
  89. rdev->desc->enable_mask, val << shift);
  90. }
  91. /*
  92. * Some LDOs supports LPM-ON/OFF/Normal-ON mode during suspend state
  93. * (Enable Control Logic1 by PWRREQ)
  94. *
  95. * LDOs 2, 4-19, 22-35.
  96. *
  97. */
  98. static int max77802_ldo_set_suspend_mode_logic1(struct regulator_dev *rdev,
  99. unsigned int mode)
  100. {
  101. struct max77802_regulator_prv *max77802 = rdev_get_drvdata(rdev);
  102. int id = rdev_get_id(rdev);
  103. unsigned int val;
  104. int shift = max77802_get_opmode_shift(id);
  105. switch (mode) {
  106. case REGULATOR_MODE_IDLE: /* ON in LP Mode */
  107. val = MAX77802_OPMODE_LP;
  108. break;
  109. case REGULATOR_MODE_NORMAL: /* ON in Normal Mode */
  110. val = MAX77802_OPMODE_NORMAL;
  111. break;
  112. case REGULATOR_MODE_STANDBY: /* ON/OFF by PWRREQ */
  113. val = MAX77802_OPMODE_STANDBY;
  114. break;
  115. default:
  116. dev_warn(&rdev->dev, "%s: regulator mode: 0x%x not supported\n",
  117. rdev->desc->name, mode);
  118. return -EINVAL;
  119. }
  120. max77802->opmode[id] = val;
  121. return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
  122. rdev->desc->enable_mask, val << shift);
  123. }
  124. /*
  125. * Mode 1 (Output[ON/OFF] by PWRREQ) is not supported on some LDOs
  126. * (Enable Control Logic2 by PWRREQ)
  127. *
  128. * LDOs 1, 20, 21, and 3,
  129. *
  130. */
  131. static int max77802_ldo_set_suspend_mode_logic2(struct regulator_dev *rdev,
  132. unsigned int mode)
  133. {
  134. struct max77802_regulator_prv *max77802 = rdev_get_drvdata(rdev);
  135. int id = rdev_get_id(rdev);
  136. unsigned int val;
  137. int shift = max77802_get_opmode_shift(id);
  138. switch (mode) {
  139. case REGULATOR_MODE_IDLE: /* ON in LP Mode */
  140. val = MAX77802_OPMODE_LP;
  141. break;
  142. case REGULATOR_MODE_NORMAL: /* ON in Normal Mode */
  143. val = MAX77802_OPMODE_NORMAL;
  144. break;
  145. default:
  146. dev_warn(&rdev->dev, "%s: regulator mode: 0x%x not supported\n",
  147. rdev->desc->name, mode);
  148. return -EINVAL;
  149. }
  150. max77802->opmode[id] = val;
  151. return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
  152. rdev->desc->enable_mask, val << shift);
  153. }
  154. static int max77802_enable(struct regulator_dev *rdev)
  155. {
  156. struct max77802_regulator_prv *max77802 = rdev_get_drvdata(rdev);
  157. int id = rdev_get_id(rdev);
  158. int shift = max77802_get_opmode_shift(id);
  159. return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
  160. rdev->desc->enable_mask,
  161. max77802->opmode[id] << shift);
  162. }
  163. static int max77802_find_ramp_value(struct regulator_dev *rdev,
  164. const unsigned int limits[], int size,
  165. unsigned int ramp_delay)
  166. {
  167. int i;
  168. for (i = 0; i < size; i++) {
  169. if (ramp_delay <= limits[i])
  170. return i;
  171. }
  172. /* Use maximum value for no ramp control */
  173. dev_warn(&rdev->dev, "%s: ramp_delay: %d not supported, setting 100000\n",
  174. rdev->desc->name, ramp_delay);
  175. return size - 1;
  176. }
  177. /* Used for BUCKs 2-4 */
  178. static int max77802_set_ramp_delay_2bit(struct regulator_dev *rdev,
  179. int ramp_delay)
  180. {
  181. int id = rdev_get_id(rdev);
  182. unsigned int ramp_value;
  183. if (id > MAX77802_BUCK4) {
  184. dev_warn(&rdev->dev,
  185. "%s: regulator: ramp delay not supported\n",
  186. rdev->desc->name);
  187. return -EINVAL;
  188. }
  189. ramp_value = max77802_find_ramp_value(rdev, ramp_table_77802_2bit,
  190. ARRAY_SIZE(ramp_table_77802_2bit), ramp_delay);
  191. return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
  192. MAX77802_RAMP_RATE_MASK_2BIT,
  193. ramp_value << MAX77802_RAMP_RATE_SHIFT_2BIT);
  194. }
  195. /* For BUCK1, 6 */
  196. static int max77802_set_ramp_delay_4bit(struct regulator_dev *rdev,
  197. int ramp_delay)
  198. {
  199. unsigned int ramp_value;
  200. ramp_value = max77802_find_ramp_value(rdev, ramp_table_77802_4bit,
  201. ARRAY_SIZE(ramp_table_77802_4bit), ramp_delay);
  202. return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
  203. MAX77802_RAMP_RATE_MASK_4BIT,
  204. ramp_value << MAX77802_RAMP_RATE_SHIFT_4BIT);
  205. }
  206. /*
  207. * LDOs 2, 4-19, 22-35
  208. */
  209. static struct regulator_ops max77802_ldo_ops_logic1 = {
  210. .list_voltage = regulator_list_voltage_linear,
  211. .map_voltage = regulator_map_voltage_linear,
  212. .is_enabled = regulator_is_enabled_regmap,
  213. .enable = max77802_enable,
  214. .disable = regulator_disable_regmap,
  215. .get_voltage_sel = regulator_get_voltage_sel_regmap,
  216. .set_voltage_sel = regulator_set_voltage_sel_regmap,
  217. .set_voltage_time_sel = regulator_set_voltage_time_sel,
  218. .set_suspend_mode = max77802_ldo_set_suspend_mode_logic1,
  219. };
  220. /*
  221. * LDOs 1, 20, 21, 3
  222. */
  223. static struct regulator_ops max77802_ldo_ops_logic2 = {
  224. .list_voltage = regulator_list_voltage_linear,
  225. .map_voltage = regulator_map_voltage_linear,
  226. .is_enabled = regulator_is_enabled_regmap,
  227. .enable = max77802_enable,
  228. .disable = regulator_disable_regmap,
  229. .get_voltage_sel = regulator_get_voltage_sel_regmap,
  230. .set_voltage_sel = regulator_set_voltage_sel_regmap,
  231. .set_voltage_time_sel = regulator_set_voltage_time_sel,
  232. .set_suspend_mode = max77802_ldo_set_suspend_mode_logic2,
  233. };
  234. /* BUCKS 1, 6 */
  235. static struct regulator_ops max77802_buck_16_dvs_ops = {
  236. .list_voltage = regulator_list_voltage_linear,
  237. .map_voltage = regulator_map_voltage_linear,
  238. .is_enabled = regulator_is_enabled_regmap,
  239. .enable = max77802_enable,
  240. .disable = regulator_disable_regmap,
  241. .get_voltage_sel = regulator_get_voltage_sel_regmap,
  242. .set_voltage_sel = regulator_set_voltage_sel_regmap,
  243. .set_voltage_time_sel = regulator_set_voltage_time_sel,
  244. .set_ramp_delay = max77802_set_ramp_delay_4bit,
  245. .set_suspend_disable = max77802_buck_set_suspend_disable,
  246. };
  247. /* BUCKs 2-4, 5, 7-10 */
  248. static struct regulator_ops max77802_buck_dvs_ops = {
  249. .list_voltage = regulator_list_voltage_linear,
  250. .map_voltage = regulator_map_voltage_linear,
  251. .is_enabled = regulator_is_enabled_regmap,
  252. .enable = max77802_enable,
  253. .disable = regulator_disable_regmap,
  254. .get_voltage_sel = regulator_get_voltage_sel_regmap,
  255. .set_voltage_sel = regulator_set_voltage_sel_regmap,
  256. .set_voltage_time_sel = regulator_set_voltage_time_sel,
  257. .set_ramp_delay = max77802_set_ramp_delay_2bit,
  258. .set_suspend_disable = max77802_buck_set_suspend_disable,
  259. };
  260. /* LDOs 3-7, 9-14, 18-26, 28, 29, 32-34 */
  261. #define regulator_77802_desc_p_ldo(num, supply, log) { \
  262. .name = "LDO"#num, \
  263. .id = MAX77802_LDO##num, \
  264. .supply_name = "inl"#supply, \
  265. .ops = &max77802_ldo_ops_logic##log, \
  266. .type = REGULATOR_VOLTAGE, \
  267. .owner = THIS_MODULE, \
  268. .min_uV = 800000, \
  269. .uV_step = 50000, \
  270. .ramp_delay = MAX77802_RAMP_DELAY, \
  271. .n_voltages = 1 << 6, \
  272. .vsel_reg = MAX77802_REG_LDO1CTRL1 + num - 1, \
  273. .vsel_mask = MAX77802_VSEL_MASK, \
  274. .enable_reg = MAX77802_REG_LDO1CTRL1 + num - 1, \
  275. .enable_mask = MAX77802_OPMODE_MASK << MAX77802_OPMODE_SHIFT_LDO, \
  276. }
  277. /* LDOs 1, 2, 8, 15, 17, 27, 30, 35 */
  278. #define regulator_77802_desc_n_ldo(num, supply, log) { \
  279. .name = "LDO"#num, \
  280. .id = MAX77802_LDO##num, \
  281. .supply_name = "inl"#supply, \
  282. .ops = &max77802_ldo_ops_logic##log, \
  283. .type = REGULATOR_VOLTAGE, \
  284. .owner = THIS_MODULE, \
  285. .min_uV = 800000, \
  286. .uV_step = 25000, \
  287. .ramp_delay = MAX77802_RAMP_DELAY, \
  288. .n_voltages = 1 << 6, \
  289. .vsel_reg = MAX77802_REG_LDO1CTRL1 + num - 1, \
  290. .vsel_mask = MAX77802_VSEL_MASK, \
  291. .enable_reg = MAX77802_REG_LDO1CTRL1 + num - 1, \
  292. .enable_mask = MAX77802_OPMODE_MASK << MAX77802_OPMODE_SHIFT_LDO, \
  293. }
  294. /* BUCKs 1, 6 */
  295. #define regulator_77802_desc_16_buck(num) { \
  296. .name = "BUCK"#num, \
  297. .id = MAX77802_BUCK##num, \
  298. .supply_name = "inb"#num, \
  299. .ops = &max77802_buck_16_dvs_ops, \
  300. .type = REGULATOR_VOLTAGE, \
  301. .owner = THIS_MODULE, \
  302. .min_uV = 612500, \
  303. .uV_step = 6250, \
  304. .ramp_delay = MAX77802_RAMP_DELAY, \
  305. .n_voltages = 1 << 8, \
  306. .vsel_reg = MAX77802_REG_BUCK ## num ## DVS1, \
  307. .vsel_mask = MAX77802_DVS_VSEL_MASK, \
  308. .enable_reg = MAX77802_REG_BUCK ## num ## CTRL, \
  309. .enable_mask = MAX77802_OPMODE_MASK, \
  310. }
  311. /* BUCKS 2-4 */
  312. #define regulator_77802_desc_234_buck(num) { \
  313. .name = "BUCK"#num, \
  314. .id = MAX77802_BUCK##num, \
  315. .supply_name = "inb"#num, \
  316. .ops = &max77802_buck_dvs_ops, \
  317. .type = REGULATOR_VOLTAGE, \
  318. .owner = THIS_MODULE, \
  319. .min_uV = 600000, \
  320. .uV_step = 6250, \
  321. .ramp_delay = MAX77802_RAMP_DELAY, \
  322. .n_voltages = 0x91, \
  323. .vsel_reg = MAX77802_REG_BUCK ## num ## DVS1, \
  324. .vsel_mask = MAX77802_DVS_VSEL_MASK, \
  325. .enable_reg = MAX77802_REG_BUCK ## num ## CTRL1, \
  326. .enable_mask = MAX77802_OPMODE_MASK << \
  327. MAX77802_OPMODE_BUCK234_SHIFT, \
  328. }
  329. /* BUCK 5 */
  330. #define regulator_77802_desc_buck5(num) { \
  331. .name = "BUCK"#num, \
  332. .id = MAX77802_BUCK##num, \
  333. .supply_name = "inb"#num, \
  334. .ops = &max77802_buck_dvs_ops, \
  335. .type = REGULATOR_VOLTAGE, \
  336. .owner = THIS_MODULE, \
  337. .min_uV = 750000, \
  338. .uV_step = 50000, \
  339. .ramp_delay = MAX77802_RAMP_DELAY, \
  340. .n_voltages = 1 << 6, \
  341. .vsel_reg = MAX77802_REG_BUCK5OUT, \
  342. .vsel_mask = MAX77802_VSEL_MASK, \
  343. .enable_reg = MAX77802_REG_BUCK5CTRL, \
  344. .enable_mask = MAX77802_OPMODE_MASK, \
  345. }
  346. /* BUCKs 7-10 */
  347. #define regulator_77802_desc_buck7_10(num) { \
  348. .name = "BUCK"#num, \
  349. .id = MAX77802_BUCK##num, \
  350. .supply_name = "inb"#num, \
  351. .ops = &max77802_buck_dvs_ops, \
  352. .type = REGULATOR_VOLTAGE, \
  353. .owner = THIS_MODULE, \
  354. .min_uV = 750000, \
  355. .uV_step = 50000, \
  356. .ramp_delay = MAX77802_RAMP_DELAY, \
  357. .n_voltages = 1 << 6, \
  358. .vsel_reg = MAX77802_REG_BUCK7OUT + (num - 7) * 3, \
  359. .vsel_mask = MAX77802_VSEL_MASK, \
  360. .enable_reg = MAX77802_REG_BUCK7CTRL + (num - 7) * 3, \
  361. .enable_mask = MAX77802_OPMODE_MASK, \
  362. }
  363. static struct regulator_desc regulators[] = {
  364. regulator_77802_desc_16_buck(1),
  365. regulator_77802_desc_234_buck(2),
  366. regulator_77802_desc_234_buck(3),
  367. regulator_77802_desc_234_buck(4),
  368. regulator_77802_desc_buck5(5),
  369. regulator_77802_desc_16_buck(6),
  370. regulator_77802_desc_buck7_10(7),
  371. regulator_77802_desc_buck7_10(8),
  372. regulator_77802_desc_buck7_10(9),
  373. regulator_77802_desc_buck7_10(10),
  374. regulator_77802_desc_n_ldo(1, 10, 2),
  375. regulator_77802_desc_n_ldo(2, 10, 1),
  376. regulator_77802_desc_p_ldo(3, 3, 2),
  377. regulator_77802_desc_p_ldo(4, 6, 1),
  378. regulator_77802_desc_p_ldo(5, 3, 1),
  379. regulator_77802_desc_p_ldo(6, 3, 1),
  380. regulator_77802_desc_p_ldo(7, 3, 1),
  381. regulator_77802_desc_n_ldo(8, 1, 1),
  382. regulator_77802_desc_p_ldo(9, 5, 1),
  383. regulator_77802_desc_p_ldo(10, 4, 1),
  384. regulator_77802_desc_p_ldo(11, 4, 1),
  385. regulator_77802_desc_p_ldo(12, 9, 1),
  386. regulator_77802_desc_p_ldo(13, 4, 1),
  387. regulator_77802_desc_p_ldo(14, 4, 1),
  388. regulator_77802_desc_n_ldo(15, 1, 1),
  389. regulator_77802_desc_n_ldo(17, 2, 1),
  390. regulator_77802_desc_p_ldo(18, 7, 1),
  391. regulator_77802_desc_p_ldo(19, 5, 1),
  392. regulator_77802_desc_p_ldo(20, 7, 2),
  393. regulator_77802_desc_p_ldo(21, 6, 2),
  394. regulator_77802_desc_p_ldo(23, 9, 1),
  395. regulator_77802_desc_p_ldo(24, 6, 1),
  396. regulator_77802_desc_p_ldo(25, 9, 1),
  397. regulator_77802_desc_p_ldo(26, 9, 1),
  398. regulator_77802_desc_n_ldo(27, 2, 1),
  399. regulator_77802_desc_p_ldo(28, 7, 1),
  400. regulator_77802_desc_p_ldo(29, 7, 1),
  401. regulator_77802_desc_n_ldo(30, 2, 1),
  402. regulator_77802_desc_p_ldo(32, 9, 1),
  403. regulator_77802_desc_p_ldo(33, 6, 1),
  404. regulator_77802_desc_p_ldo(34, 9, 1),
  405. regulator_77802_desc_n_ldo(35, 2, 1),
  406. };
  407. #ifdef CONFIG_OF
  408. static int max77802_pmic_dt_parse_pdata(struct platform_device *pdev,
  409. struct max77686_platform_data *pdata)
  410. {
  411. struct max77686_dev *iodev = dev_get_drvdata(pdev->dev.parent);
  412. struct device_node *pmic_np, *regulators_np;
  413. struct max77686_regulator_data *rdata;
  414. struct of_regulator_match rmatch;
  415. unsigned int i;
  416. pmic_np = iodev->dev->of_node;
  417. regulators_np = of_get_child_by_name(pmic_np, "regulators");
  418. if (!regulators_np) {
  419. dev_err(&pdev->dev, "could not find regulators sub-node\n");
  420. return -EINVAL;
  421. }
  422. pdata->num_regulators = ARRAY_SIZE(regulators);
  423. rdata = devm_kzalloc(&pdev->dev, sizeof(*rdata) *
  424. pdata->num_regulators, GFP_KERNEL);
  425. if (!rdata) {
  426. of_node_put(regulators_np);
  427. return -ENOMEM;
  428. }
  429. for (i = 0; i < pdata->num_regulators; i++) {
  430. rmatch.name = regulators[i].name;
  431. rmatch.init_data = NULL;
  432. rmatch.of_node = NULL;
  433. if (of_regulator_match(&pdev->dev, regulators_np, &rmatch,
  434. 1) != 1) {
  435. dev_warn(&pdev->dev, "No matching regulator for '%s'\n",
  436. rmatch.name);
  437. continue;
  438. }
  439. rdata[i].initdata = rmatch.init_data;
  440. rdata[i].of_node = rmatch.of_node;
  441. rdata[i].id = regulators[i].id;
  442. }
  443. pdata->regulators = rdata;
  444. of_node_put(regulators_np);
  445. return 0;
  446. }
  447. #else
  448. static int max77802_pmic_dt_parse_pdata(struct platform_device *pdev,
  449. struct max77686_platform_data *pdata)
  450. {
  451. return 0;
  452. }
  453. #endif /* CONFIG_OF */
  454. static int max77802_pmic_probe(struct platform_device *pdev)
  455. {
  456. struct max77686_dev *iodev = dev_get_drvdata(pdev->dev.parent);
  457. struct max77686_platform_data *pdata = dev_get_platdata(iodev->dev);
  458. struct max77802_regulator_prv *max77802;
  459. int i, ret = 0, val;
  460. struct regulator_config config = { };
  461. /* This is allocated by the MFD driver */
  462. if (!pdata) {
  463. dev_err(&pdev->dev, "no platform data found for regulator\n");
  464. return -ENODEV;
  465. }
  466. max77802 = devm_kzalloc(&pdev->dev,
  467. sizeof(struct max77802_regulator_prv),
  468. GFP_KERNEL);
  469. if (!max77802)
  470. return -ENOMEM;
  471. if (iodev->dev->of_node) {
  472. ret = max77802_pmic_dt_parse_pdata(pdev, pdata);
  473. if (ret)
  474. return ret;
  475. }
  476. config.dev = iodev->dev;
  477. config.regmap = iodev->regmap;
  478. config.driver_data = max77802;
  479. platform_set_drvdata(pdev, max77802);
  480. for (i = 0; i < MAX77802_REG_MAX; i++) {
  481. struct regulator_dev *rdev;
  482. int id = pdata->regulators[i].id;
  483. int shift = max77802_get_opmode_shift(id);
  484. config.init_data = pdata->regulators[i].initdata;
  485. config.of_node = pdata->regulators[i].of_node;
  486. ret = regmap_read(iodev->regmap, regulators[i].enable_reg, &val);
  487. val = val >> shift & MAX77802_OPMODE_MASK;
  488. /*
  489. * If the regulator is disabled and the system warm rebooted,
  490. * the hardware reports OFF as the regulator operating mode.
  491. * Default to operating mode NORMAL in that case.
  492. */
  493. if (val == MAX77802_OPMODE_OFF)
  494. max77802->opmode[id] = MAX77802_OPMODE_NORMAL;
  495. else
  496. max77802->opmode[id] = val;
  497. rdev = devm_regulator_register(&pdev->dev,
  498. &regulators[i], &config);
  499. if (IS_ERR(rdev)) {
  500. dev_err(&pdev->dev,
  501. "regulator init failed for %d\n", i);
  502. return PTR_ERR(rdev);
  503. }
  504. }
  505. return 0;
  506. }
  507. static const struct platform_device_id max77802_pmic_id[] = {
  508. {"max77802-pmic", 0},
  509. { },
  510. };
  511. MODULE_DEVICE_TABLE(platform, max77802_pmic_id);
  512. static struct platform_driver max77802_pmic_driver = {
  513. .driver = {
  514. .name = "max77802-pmic",
  515. .owner = THIS_MODULE,
  516. },
  517. .probe = max77802_pmic_probe,
  518. .id_table = max77802_pmic_id,
  519. };
  520. module_platform_driver(max77802_pmic_driver);
  521. MODULE_DESCRIPTION("MAXIM 77802 Regulator Driver");
  522. MODULE_AUTHOR("Simon Glass <sjg@chromium.org>");
  523. MODULE_LICENSE("GPL");