wm831x-ldo.c 18 KB

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