wm831x-ldo.c 21 KB

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