wm831x-ldo.c 19 KB

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