wm831x-ldo.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731
  1. /*
  2. * wm831x-ldo.c -- LDO driver for the WM831x series
  3. *
  4. * Copyright 2009 Wolfson Microelectronics PLC.
  5. *
  6. * Author: Mark Brown <broonie@opensource.wolfsonmicro.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/module.h>
  14. #include <linux/moduleparam.h>
  15. #include <linux/init.h>
  16. #include <linux/bitops.h>
  17. #include <linux/err.h>
  18. #include <linux/i2c.h>
  19. #include <linux/platform_device.h>
  20. #include <linux/regulator/driver.h>
  21. #include <linux/slab.h>
  22. #include <linux/mfd/wm831x/core.h>
  23. #include <linux/mfd/wm831x/regulator.h>
  24. #include <linux/mfd/wm831x/pdata.h>
  25. #define WM831X_LDO_MAX_NAME 9
  26. #define WM831X_LDO_CONTROL 0
  27. #define WM831X_LDO_ON_CONTROL 1
  28. #define WM831X_LDO_SLEEP_CONTROL 2
  29. #define WM831X_ALIVE_LDO_ON_CONTROL 0
  30. #define WM831X_ALIVE_LDO_SLEEP_CONTROL 1
  31. struct wm831x_ldo {
  32. char name[WM831X_LDO_MAX_NAME];
  33. char supply_name[WM831X_LDO_MAX_NAME];
  34. struct regulator_desc desc;
  35. int base;
  36. struct wm831x *wm831x;
  37. struct regulator_dev *regulator;
  38. };
  39. /*
  40. * Shared
  41. */
  42. static irqreturn_t wm831x_ldo_uv_irq(int irq, void *data)
  43. {
  44. struct wm831x_ldo *ldo = data;
  45. regulator_notifier_call_chain(ldo->regulator,
  46. REGULATOR_EVENT_UNDER_VOLTAGE,
  47. NULL);
  48. return IRQ_HANDLED;
  49. }
  50. /*
  51. * General purpose LDOs
  52. */
  53. static const struct regulator_linear_range wm831x_gp_ldo_ranges[] = {
  54. REGULATOR_LINEAR_RANGE(900000, 0, 14, 50000),
  55. REGULATOR_LINEAR_RANGE(1700000, 15, 31, 100000),
  56. };
  57. static int wm831x_gp_ldo_set_suspend_voltage(struct regulator_dev *rdev,
  58. int uV)
  59. {
  60. struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
  61. struct wm831x *wm831x = ldo->wm831x;
  62. int sel, reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;
  63. sel = regulator_map_voltage_linear_range(rdev, uV, uV);
  64. if (sel < 0)
  65. return sel;
  66. return wm831x_set_bits(wm831x, reg, WM831X_LDO1_ON_VSEL_MASK, sel);
  67. }
  68. static unsigned int wm831x_gp_ldo_get_mode(struct regulator_dev *rdev)
  69. {
  70. struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
  71. struct wm831x *wm831x = ldo->wm831x;
  72. int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
  73. int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
  74. int ret;
  75. ret = wm831x_reg_read(wm831x, on_reg);
  76. if (ret < 0)
  77. return ret;
  78. if (!(ret & WM831X_LDO1_ON_MODE))
  79. return REGULATOR_MODE_NORMAL;
  80. ret = wm831x_reg_read(wm831x, ctrl_reg);
  81. if (ret < 0)
  82. return ret;
  83. if (ret & WM831X_LDO1_LP_MODE)
  84. return REGULATOR_MODE_STANDBY;
  85. else
  86. return REGULATOR_MODE_IDLE;
  87. }
  88. static int wm831x_gp_ldo_set_mode(struct regulator_dev *rdev,
  89. unsigned int mode)
  90. {
  91. struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
  92. struct wm831x *wm831x = ldo->wm831x;
  93. int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
  94. int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
  95. int ret;
  96. switch (mode) {
  97. case REGULATOR_MODE_NORMAL:
  98. ret = wm831x_set_bits(wm831x, on_reg,
  99. WM831X_LDO1_ON_MODE, 0);
  100. if (ret < 0)
  101. return ret;
  102. break;
  103. case REGULATOR_MODE_IDLE:
  104. ret = wm831x_set_bits(wm831x, ctrl_reg,
  105. WM831X_LDO1_LP_MODE, 0);
  106. if (ret < 0)
  107. return ret;
  108. ret = wm831x_set_bits(wm831x, on_reg,
  109. WM831X_LDO1_ON_MODE,
  110. WM831X_LDO1_ON_MODE);
  111. if (ret < 0)
  112. return ret;
  113. break;
  114. case REGULATOR_MODE_STANDBY:
  115. ret = wm831x_set_bits(wm831x, ctrl_reg,
  116. WM831X_LDO1_LP_MODE,
  117. WM831X_LDO1_LP_MODE);
  118. if (ret < 0)
  119. return ret;
  120. ret = wm831x_set_bits(wm831x, on_reg,
  121. WM831X_LDO1_ON_MODE,
  122. WM831X_LDO1_ON_MODE);
  123. if (ret < 0)
  124. return ret;
  125. break;
  126. default:
  127. return -EINVAL;
  128. }
  129. return 0;
  130. }
  131. static int wm831x_gp_ldo_get_status(struct regulator_dev *rdev)
  132. {
  133. struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
  134. struct wm831x *wm831x = ldo->wm831x;
  135. int mask = 1 << rdev_get_id(rdev);
  136. int ret;
  137. /* Is the regulator on? */
  138. ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
  139. if (ret < 0)
  140. return ret;
  141. if (!(ret & mask))
  142. return REGULATOR_STATUS_OFF;
  143. /* Is it reporting under voltage? */
  144. ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
  145. if (ret < 0)
  146. return ret;
  147. if (ret & mask)
  148. return REGULATOR_STATUS_ERROR;
  149. ret = wm831x_gp_ldo_get_mode(rdev);
  150. if (ret < 0)
  151. return ret;
  152. else
  153. return regulator_mode_to_status(ret);
  154. }
  155. static unsigned int wm831x_gp_ldo_get_optimum_mode(struct regulator_dev *rdev,
  156. int input_uV,
  157. int output_uV, int load_uA)
  158. {
  159. if (load_uA < 20000)
  160. return REGULATOR_MODE_STANDBY;
  161. if (load_uA < 50000)
  162. return REGULATOR_MODE_IDLE;
  163. return REGULATOR_MODE_NORMAL;
  164. }
  165. static struct regulator_ops wm831x_gp_ldo_ops = {
  166. .list_voltage = regulator_list_voltage_linear_range,
  167. .map_voltage = regulator_map_voltage_linear_range,
  168. .get_voltage_sel = regulator_get_voltage_sel_regmap,
  169. .set_voltage_sel = regulator_set_voltage_sel_regmap,
  170. .set_suspend_voltage = wm831x_gp_ldo_set_suspend_voltage,
  171. .get_mode = wm831x_gp_ldo_get_mode,
  172. .set_mode = wm831x_gp_ldo_set_mode,
  173. .get_status = wm831x_gp_ldo_get_status,
  174. .get_optimum_mode = wm831x_gp_ldo_get_optimum_mode,
  175. .get_bypass = regulator_get_bypass_regmap,
  176. .set_bypass = regulator_set_bypass_regmap,
  177. .is_enabled = regulator_is_enabled_regmap,
  178. .enable = regulator_enable_regmap,
  179. .disable = regulator_disable_regmap,
  180. };
  181. static int wm831x_gp_ldo_probe(struct platform_device *pdev)
  182. {
  183. struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
  184. struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
  185. struct regulator_config config = { };
  186. int id;
  187. struct wm831x_ldo *ldo;
  188. struct resource *res;
  189. int ret, irq;
  190. if (pdata && pdata->wm831x_num)
  191. id = (pdata->wm831x_num * 10) + 1;
  192. else
  193. id = 0;
  194. id = pdev->id - id;
  195. dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
  196. ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
  197. if (ldo == NULL) {
  198. dev_err(&pdev->dev, "Unable to allocate private data\n");
  199. return -ENOMEM;
  200. }
  201. ldo->wm831x = wm831x;
  202. res = platform_get_resource(pdev, IORESOURCE_REG, 0);
  203. if (res == NULL) {
  204. dev_err(&pdev->dev, "No REG resource\n");
  205. ret = -EINVAL;
  206. goto err;
  207. }
  208. ldo->base = res->start;
  209. snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
  210. ldo->desc.name = ldo->name;
  211. snprintf(ldo->supply_name, sizeof(ldo->supply_name),
  212. "LDO%dVDD", id + 1);
  213. ldo->desc.supply_name = ldo->supply_name;
  214. ldo->desc.id = id;
  215. ldo->desc.type = REGULATOR_VOLTAGE;
  216. ldo->desc.n_voltages = 32;
  217. ldo->desc.ops = &wm831x_gp_ldo_ops;
  218. ldo->desc.owner = THIS_MODULE;
  219. ldo->desc.vsel_reg = ldo->base + WM831X_LDO_ON_CONTROL;
  220. ldo->desc.vsel_mask = WM831X_LDO1_ON_VSEL_MASK;
  221. ldo->desc.enable_reg = WM831X_LDO_ENABLE;
  222. ldo->desc.enable_mask = 1 << id;
  223. ldo->desc.bypass_reg = ldo->base;
  224. ldo->desc.bypass_mask = WM831X_LDO1_SWI;
  225. ldo->desc.linear_ranges = wm831x_gp_ldo_ranges;
  226. ldo->desc.n_linear_ranges = ARRAY_SIZE(wm831x_gp_ldo_ranges);
  227. config.dev = pdev->dev.parent;
  228. if (pdata)
  229. config.init_data = pdata->ldo[id];
  230. config.driver_data = ldo;
  231. config.regmap = wm831x->regmap;
  232. ldo->regulator = regulator_register(&ldo->desc, &config);
  233. if (IS_ERR(ldo->regulator)) {
  234. ret = PTR_ERR(ldo->regulator);
  235. dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
  236. id + 1, ret);
  237. goto err;
  238. }
  239. irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "UV"));
  240. ret = request_threaded_irq(irq, NULL, wm831x_ldo_uv_irq,
  241. IRQF_TRIGGER_RISING, ldo->name,
  242. ldo);
  243. if (ret != 0) {
  244. dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
  245. irq, ret);
  246. goto err_regulator;
  247. }
  248. platform_set_drvdata(pdev, ldo);
  249. return 0;
  250. err_regulator:
  251. regulator_unregister(ldo->regulator);
  252. err:
  253. return ret;
  254. }
  255. static int wm831x_gp_ldo_remove(struct platform_device *pdev)
  256. {
  257. struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
  258. free_irq(wm831x_irq(ldo->wm831x,
  259. platform_get_irq_byname(pdev, "UV")), ldo);
  260. regulator_unregister(ldo->regulator);
  261. return 0;
  262. }
  263. static struct platform_driver wm831x_gp_ldo_driver = {
  264. .probe = wm831x_gp_ldo_probe,
  265. .remove = wm831x_gp_ldo_remove,
  266. .driver = {
  267. .name = "wm831x-ldo",
  268. .owner = THIS_MODULE,
  269. },
  270. };
  271. /*
  272. * Analogue LDOs
  273. */
  274. static const struct regulator_linear_range wm831x_aldo_ranges[] = {
  275. REGULATOR_LINEAR_RANGE(1000000, 0, 12, 50000),
  276. REGULATOR_LINEAR_RANGE(1700000, 13, 31, 100000),
  277. };
  278. static int wm831x_aldo_set_suspend_voltage(struct regulator_dev *rdev,
  279. int uV)
  280. {
  281. struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
  282. struct wm831x *wm831x = ldo->wm831x;
  283. int sel, reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;
  284. sel = regulator_map_voltage_linear_range(rdev, uV, uV);
  285. if (sel < 0)
  286. return sel;
  287. return wm831x_set_bits(wm831x, reg, WM831X_LDO7_ON_VSEL_MASK, sel);
  288. }
  289. static unsigned int wm831x_aldo_get_mode(struct regulator_dev *rdev)
  290. {
  291. struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
  292. struct wm831x *wm831x = ldo->wm831x;
  293. int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
  294. int ret;
  295. ret = wm831x_reg_read(wm831x, on_reg);
  296. if (ret < 0)
  297. return 0;
  298. if (ret & WM831X_LDO7_ON_MODE)
  299. return REGULATOR_MODE_IDLE;
  300. else
  301. return REGULATOR_MODE_NORMAL;
  302. }
  303. static int wm831x_aldo_set_mode(struct regulator_dev *rdev,
  304. unsigned int mode)
  305. {
  306. struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
  307. struct wm831x *wm831x = ldo->wm831x;
  308. int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
  309. int ret;
  310. switch (mode) {
  311. case REGULATOR_MODE_NORMAL:
  312. ret = wm831x_set_bits(wm831x, on_reg, WM831X_LDO7_ON_MODE, 0);
  313. if (ret < 0)
  314. return ret;
  315. break;
  316. case REGULATOR_MODE_IDLE:
  317. ret = wm831x_set_bits(wm831x, on_reg, WM831X_LDO7_ON_MODE,
  318. WM831X_LDO7_ON_MODE);
  319. if (ret < 0)
  320. return ret;
  321. break;
  322. default:
  323. return -EINVAL;
  324. }
  325. return 0;
  326. }
  327. static int wm831x_aldo_get_status(struct regulator_dev *rdev)
  328. {
  329. struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
  330. struct wm831x *wm831x = ldo->wm831x;
  331. int mask = 1 << rdev_get_id(rdev);
  332. int ret;
  333. /* Is the regulator on? */
  334. ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
  335. if (ret < 0)
  336. return ret;
  337. if (!(ret & mask))
  338. return REGULATOR_STATUS_OFF;
  339. /* Is it reporting under voltage? */
  340. ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
  341. if (ret < 0)
  342. return ret;
  343. if (ret & mask)
  344. return REGULATOR_STATUS_ERROR;
  345. ret = wm831x_aldo_get_mode(rdev);
  346. if (ret < 0)
  347. return ret;
  348. else
  349. return regulator_mode_to_status(ret);
  350. }
  351. static struct regulator_ops wm831x_aldo_ops = {
  352. .list_voltage = regulator_list_voltage_linear_range,
  353. .map_voltage = regulator_map_voltage_linear_range,
  354. .get_voltage_sel = regulator_get_voltage_sel_regmap,
  355. .set_voltage_sel = regulator_set_voltage_sel_regmap,
  356. .set_suspend_voltage = wm831x_aldo_set_suspend_voltage,
  357. .get_mode = wm831x_aldo_get_mode,
  358. .set_mode = wm831x_aldo_set_mode,
  359. .get_status = wm831x_aldo_get_status,
  360. .set_bypass = regulator_set_bypass_regmap,
  361. .get_bypass = regulator_get_bypass_regmap,
  362. .is_enabled = regulator_is_enabled_regmap,
  363. .enable = regulator_enable_regmap,
  364. .disable = regulator_disable_regmap,
  365. };
  366. static int wm831x_aldo_probe(struct platform_device *pdev)
  367. {
  368. struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
  369. struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
  370. struct regulator_config config = { };
  371. int id;
  372. struct wm831x_ldo *ldo;
  373. struct resource *res;
  374. int ret, irq;
  375. if (pdata && pdata->wm831x_num)
  376. id = (pdata->wm831x_num * 10) + 1;
  377. else
  378. id = 0;
  379. id = pdev->id - id;
  380. dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
  381. ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
  382. if (ldo == NULL) {
  383. dev_err(&pdev->dev, "Unable to allocate private data\n");
  384. return -ENOMEM;
  385. }
  386. ldo->wm831x = wm831x;
  387. res = platform_get_resource(pdev, IORESOURCE_REG, 0);
  388. if (res == NULL) {
  389. dev_err(&pdev->dev, "No REG resource\n");
  390. ret = -EINVAL;
  391. goto err;
  392. }
  393. ldo->base = res->start;
  394. snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
  395. ldo->desc.name = ldo->name;
  396. snprintf(ldo->supply_name, sizeof(ldo->supply_name),
  397. "LDO%dVDD", id + 1);
  398. ldo->desc.supply_name = ldo->supply_name;
  399. ldo->desc.id = id;
  400. ldo->desc.type = REGULATOR_VOLTAGE;
  401. ldo->desc.n_voltages = 32;
  402. ldo->desc.linear_ranges = wm831x_aldo_ranges;
  403. ldo->desc.n_linear_ranges = ARRAY_SIZE(wm831x_aldo_ranges);
  404. ldo->desc.ops = &wm831x_aldo_ops;
  405. ldo->desc.owner = THIS_MODULE;
  406. ldo->desc.vsel_reg = ldo->base + WM831X_LDO_ON_CONTROL;
  407. ldo->desc.vsel_mask = WM831X_LDO7_ON_VSEL_MASK;
  408. ldo->desc.enable_reg = WM831X_LDO_ENABLE;
  409. ldo->desc.enable_mask = 1 << id;
  410. ldo->desc.bypass_reg = ldo->base;
  411. ldo->desc.bypass_mask = WM831X_LDO7_SWI;
  412. config.dev = pdev->dev.parent;
  413. if (pdata)
  414. config.init_data = pdata->ldo[id];
  415. config.driver_data = ldo;
  416. config.regmap = wm831x->regmap;
  417. ldo->regulator = regulator_register(&ldo->desc, &config);
  418. if (IS_ERR(ldo->regulator)) {
  419. ret = PTR_ERR(ldo->regulator);
  420. dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
  421. id + 1, ret);
  422. goto err;
  423. }
  424. irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "UV"));
  425. ret = request_threaded_irq(irq, NULL, wm831x_ldo_uv_irq,
  426. IRQF_TRIGGER_RISING, ldo->name, ldo);
  427. if (ret != 0) {
  428. dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
  429. irq, ret);
  430. goto err_regulator;
  431. }
  432. platform_set_drvdata(pdev, ldo);
  433. return 0;
  434. err_regulator:
  435. regulator_unregister(ldo->regulator);
  436. err:
  437. return ret;
  438. }
  439. static int wm831x_aldo_remove(struct platform_device *pdev)
  440. {
  441. struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
  442. free_irq(wm831x_irq(ldo->wm831x, platform_get_irq_byname(pdev, "UV")),
  443. ldo);
  444. regulator_unregister(ldo->regulator);
  445. return 0;
  446. }
  447. static struct platform_driver wm831x_aldo_driver = {
  448. .probe = wm831x_aldo_probe,
  449. .remove = wm831x_aldo_remove,
  450. .driver = {
  451. .name = "wm831x-aldo",
  452. .owner = THIS_MODULE,
  453. },
  454. };
  455. /*
  456. * Alive LDO
  457. */
  458. #define WM831X_ALIVE_LDO_MAX_SELECTOR 0xf
  459. static int wm831x_alive_ldo_set_suspend_voltage(struct regulator_dev *rdev,
  460. int uV)
  461. {
  462. struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
  463. struct wm831x *wm831x = ldo->wm831x;
  464. int sel, reg = ldo->base + WM831X_ALIVE_LDO_SLEEP_CONTROL;
  465. sel = regulator_map_voltage_linear(rdev, uV, uV);
  466. if (sel < 0)
  467. return sel;
  468. return wm831x_set_bits(wm831x, reg, WM831X_LDO11_ON_VSEL_MASK, sel);
  469. }
  470. static int wm831x_alive_ldo_get_status(struct regulator_dev *rdev)
  471. {
  472. struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
  473. struct wm831x *wm831x = ldo->wm831x;
  474. int mask = 1 << rdev_get_id(rdev);
  475. int ret;
  476. /* Is the regulator on? */
  477. ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
  478. if (ret < 0)
  479. return ret;
  480. if (ret & mask)
  481. return REGULATOR_STATUS_ON;
  482. else
  483. return REGULATOR_STATUS_OFF;
  484. }
  485. static struct regulator_ops wm831x_alive_ldo_ops = {
  486. .list_voltage = regulator_list_voltage_linear,
  487. .map_voltage = regulator_map_voltage_linear,
  488. .get_voltage_sel = regulator_get_voltage_sel_regmap,
  489. .set_voltage_sel = regulator_set_voltage_sel_regmap,
  490. .set_suspend_voltage = wm831x_alive_ldo_set_suspend_voltage,
  491. .get_status = wm831x_alive_ldo_get_status,
  492. .is_enabled = regulator_is_enabled_regmap,
  493. .enable = regulator_enable_regmap,
  494. .disable = regulator_disable_regmap,
  495. };
  496. static int wm831x_alive_ldo_probe(struct platform_device *pdev)
  497. {
  498. struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
  499. struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
  500. struct regulator_config config = { };
  501. int id;
  502. struct wm831x_ldo *ldo;
  503. struct resource *res;
  504. int ret;
  505. if (pdata && pdata->wm831x_num)
  506. id = (pdata->wm831x_num * 10) + 1;
  507. else
  508. id = 0;
  509. id = pdev->id - id;
  510. dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
  511. ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
  512. if (ldo == NULL) {
  513. dev_err(&pdev->dev, "Unable to allocate private data\n");
  514. return -ENOMEM;
  515. }
  516. ldo->wm831x = wm831x;
  517. res = platform_get_resource(pdev, IORESOURCE_REG, 0);
  518. if (res == NULL) {
  519. dev_err(&pdev->dev, "No REG resource\n");
  520. ret = -EINVAL;
  521. goto err;
  522. }
  523. ldo->base = res->start;
  524. snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
  525. ldo->desc.name = ldo->name;
  526. snprintf(ldo->supply_name, sizeof(ldo->supply_name),
  527. "LDO%dVDD", id + 1);
  528. ldo->desc.supply_name = ldo->supply_name;
  529. ldo->desc.id = id;
  530. ldo->desc.type = REGULATOR_VOLTAGE;
  531. ldo->desc.n_voltages = WM831X_ALIVE_LDO_MAX_SELECTOR + 1;
  532. ldo->desc.ops = &wm831x_alive_ldo_ops;
  533. ldo->desc.owner = THIS_MODULE;
  534. ldo->desc.vsel_reg = ldo->base + WM831X_ALIVE_LDO_ON_CONTROL;
  535. ldo->desc.vsel_mask = WM831X_LDO11_ON_VSEL_MASK;
  536. ldo->desc.enable_reg = WM831X_LDO_ENABLE;
  537. ldo->desc.enable_mask = 1 << id;
  538. ldo->desc.min_uV = 800000;
  539. ldo->desc.uV_step = 50000;
  540. ldo->desc.enable_time = 1000;
  541. config.dev = pdev->dev.parent;
  542. if (pdata)
  543. config.init_data = pdata->ldo[id];
  544. config.driver_data = ldo;
  545. config.regmap = wm831x->regmap;
  546. ldo->regulator = regulator_register(&ldo->desc, &config);
  547. if (IS_ERR(ldo->regulator)) {
  548. ret = PTR_ERR(ldo->regulator);
  549. dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
  550. id + 1, ret);
  551. goto err;
  552. }
  553. platform_set_drvdata(pdev, ldo);
  554. return 0;
  555. err:
  556. return ret;
  557. }
  558. static int wm831x_alive_ldo_remove(struct platform_device *pdev)
  559. {
  560. struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
  561. regulator_unregister(ldo->regulator);
  562. return 0;
  563. }
  564. static struct platform_driver wm831x_alive_ldo_driver = {
  565. .probe = wm831x_alive_ldo_probe,
  566. .remove = wm831x_alive_ldo_remove,
  567. .driver = {
  568. .name = "wm831x-alive-ldo",
  569. .owner = THIS_MODULE,
  570. },
  571. };
  572. static int __init wm831x_ldo_init(void)
  573. {
  574. int ret;
  575. ret = platform_driver_register(&wm831x_gp_ldo_driver);
  576. if (ret != 0)
  577. pr_err("Failed to register WM831x GP LDO driver: %d\n", ret);
  578. ret = platform_driver_register(&wm831x_aldo_driver);
  579. if (ret != 0)
  580. pr_err("Failed to register WM831x ALDO driver: %d\n", ret);
  581. ret = platform_driver_register(&wm831x_alive_ldo_driver);
  582. if (ret != 0)
  583. pr_err("Failed to register WM831x alive LDO driver: %d\n",
  584. ret);
  585. return 0;
  586. }
  587. subsys_initcall(wm831x_ldo_init);
  588. static void __exit wm831x_ldo_exit(void)
  589. {
  590. platform_driver_unregister(&wm831x_alive_ldo_driver);
  591. platform_driver_unregister(&wm831x_aldo_driver);
  592. platform_driver_unregister(&wm831x_gp_ldo_driver);
  593. }
  594. module_exit(wm831x_ldo_exit);
  595. /* Module information */
  596. MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
  597. MODULE_DESCRIPTION("WM831x LDO driver");
  598. MODULE_LICENSE("GPL");
  599. MODULE_ALIAS("platform:wm831x-ldo");
  600. MODULE_ALIAS("platform:wm831x-aldo");
  601. MODULE_ALIAS("platform:wm831x-aliveldo");