wm831x-ldo.c 20 KB

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