wm831x-ldo.c 21 KB

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