tps65912-regulator.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798
  1. /*
  2. * tps65912.c -- TI tps65912
  3. *
  4. * Copyright 2011 Texas Instruments Inc.
  5. *
  6. * Author: Margarita Olaya Cabrera <magi@slimlogic.co.uk>
  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. * This driver is based on wm8350 implementation.
  14. */
  15. #include <linux/kernel.h>
  16. #include <linux/module.h>
  17. #include <linux/init.h>
  18. #include <linux/err.h>
  19. #include <linux/platform_device.h>
  20. #include <linux/regulator/driver.h>
  21. #include <linux/regulator/machine.h>
  22. #include <linux/delay.h>
  23. #include <linux/slab.h>
  24. #include <linux/gpio.h>
  25. #include <linux/mfd/tps65912.h>
  26. /* DCDC's */
  27. #define TPS65912_REG_DCDC1 0
  28. #define TPS65912_REG_DCDC2 1
  29. #define TPS65912_REG_DCDC3 2
  30. #define TPS65912_REG_DCDC4 3
  31. /* LDOs */
  32. #define TPS65912_REG_LDO1 4
  33. #define TPS65912_REG_LDO2 5
  34. #define TPS65912_REG_LDO3 6
  35. #define TPS65912_REG_LDO4 7
  36. #define TPS65912_REG_LDO5 8
  37. #define TPS65912_REG_LDO6 9
  38. #define TPS65912_REG_LDO7 10
  39. #define TPS65912_REG_LDO8 11
  40. #define TPS65912_REG_LDO9 12
  41. #define TPS65912_REG_LDO10 13
  42. /* Number of step-down converters available */
  43. #define TPS65912_NUM_DCDC 4
  44. /* Number of LDO voltage regulators available */
  45. #define TPS65912_NUM_LDO 10
  46. /* Number of total regulators available */
  47. #define TPS65912_NUM_REGULATOR (TPS65912_NUM_DCDC + TPS65912_NUM_LDO)
  48. #define TPS65912_REG_ENABLED 0x80
  49. #define OP_SELREG_MASK 0x40
  50. #define OP_SELREG_SHIFT 6
  51. struct tps_info {
  52. const char *name;
  53. };
  54. static struct tps_info tps65912_regs[] = {
  55. {
  56. .name = "DCDC1",
  57. },
  58. {
  59. .name = "DCDC2",
  60. },
  61. {
  62. .name = "DCDC3",
  63. },
  64. {
  65. .name = "DCDC4",
  66. },
  67. {
  68. .name = "LDO1",
  69. },
  70. {
  71. .name = "LDO2",
  72. },
  73. {
  74. .name = "LDO3",
  75. },
  76. {
  77. .name = "LDO4",
  78. },
  79. {
  80. .name = "LDO5",
  81. },
  82. {
  83. .name = "LDO6",
  84. },
  85. {
  86. .name = "LDO7",
  87. },
  88. {
  89. .name = "LDO8",
  90. },
  91. {
  92. .name = "LDO9",
  93. },
  94. {
  95. .name = "LDO10",
  96. },
  97. };
  98. struct tps65912_reg {
  99. struct regulator_desc desc[TPS65912_NUM_REGULATOR];
  100. struct tps65912 *mfd;
  101. struct regulator_dev *rdev[TPS65912_NUM_REGULATOR];
  102. struct tps_info *info[TPS65912_NUM_REGULATOR];
  103. /* for read/write access */
  104. struct mutex io_lock;
  105. int mode;
  106. int (*get_ctrl_reg)(int);
  107. int dcdc1_range;
  108. int dcdc2_range;
  109. int dcdc3_range;
  110. int dcdc4_range;
  111. int pwm_mode_reg;
  112. int eco_reg;
  113. };
  114. static int tps65912_get_range(struct tps65912_reg *pmic, int id)
  115. {
  116. struct tps65912 *mfd = pmic->mfd;
  117. if (id > TPS65912_REG_DCDC4)
  118. return 0;
  119. switch (id) {
  120. case TPS65912_REG_DCDC1:
  121. pmic->dcdc1_range = tps65912_reg_read(mfd,
  122. TPS65912_DCDC1_LIMIT);
  123. if (pmic->dcdc1_range < 0)
  124. return pmic->dcdc1_range;
  125. pmic->dcdc1_range = (pmic->dcdc1_range &
  126. DCDC_LIMIT_RANGE_MASK) >> DCDC_LIMIT_RANGE_SHIFT;
  127. return pmic->dcdc1_range;
  128. case TPS65912_REG_DCDC2:
  129. pmic->dcdc2_range = tps65912_reg_read(mfd,
  130. TPS65912_DCDC2_LIMIT);
  131. if (pmic->dcdc2_range < 0)
  132. return pmic->dcdc2_range;
  133. pmic->dcdc2_range = (pmic->dcdc2_range &
  134. DCDC_LIMIT_RANGE_MASK) >> DCDC_LIMIT_RANGE_SHIFT;
  135. return pmic->dcdc2_range;
  136. case TPS65912_REG_DCDC3:
  137. pmic->dcdc3_range = tps65912_reg_read(mfd,
  138. TPS65912_DCDC3_LIMIT);
  139. if (pmic->dcdc3_range < 0)
  140. return pmic->dcdc3_range;
  141. pmic->dcdc3_range = (pmic->dcdc3_range &
  142. DCDC_LIMIT_RANGE_MASK) >> DCDC_LIMIT_RANGE_SHIFT;
  143. return pmic->dcdc3_range;
  144. case TPS65912_REG_DCDC4:
  145. pmic->dcdc4_range = tps65912_reg_read(mfd,
  146. TPS65912_DCDC4_LIMIT);
  147. if (pmic->dcdc4_range < 0)
  148. return pmic->dcdc4_range;
  149. pmic->dcdc4_range = (pmic->dcdc4_range &
  150. DCDC_LIMIT_RANGE_MASK) >> DCDC_LIMIT_RANGE_SHIFT;
  151. return pmic->dcdc4_range;
  152. default:
  153. return 0;
  154. }
  155. }
  156. static unsigned long tps65912_vsel_to_uv_range0(u8 vsel)
  157. {
  158. unsigned long uv;
  159. uv = ((vsel * 12500) + 500000);
  160. return uv;
  161. }
  162. static unsigned long tps65912_vsel_to_uv_range1(u8 vsel)
  163. {
  164. unsigned long uv;
  165. uv = ((vsel * 12500) + 700000);
  166. return uv;
  167. }
  168. static unsigned long tps65912_vsel_to_uv_range2(u8 vsel)
  169. {
  170. unsigned long uv;
  171. uv = ((vsel * 25000) + 500000);
  172. return uv;
  173. }
  174. static unsigned long tps65912_vsel_to_uv_range3(u8 vsel)
  175. {
  176. unsigned long uv;
  177. if (vsel == 0x3f)
  178. uv = 3800000;
  179. else
  180. uv = ((vsel * 50000) + 500000);
  181. return uv;
  182. }
  183. static unsigned long tps65912_vsel_to_uv_ldo(u8 vsel)
  184. {
  185. unsigned long uv = 0;
  186. if (vsel <= 32)
  187. uv = ((vsel * 25000) + 800000);
  188. else if (vsel > 32 && vsel <= 60)
  189. uv = (((vsel - 32) * 50000) + 1600000);
  190. else if (vsel > 60)
  191. uv = (((vsel - 60) * 100000) + 3000000);
  192. return uv;
  193. }
  194. static int tps65912_get_ctrl_register(int id)
  195. {
  196. switch (id) {
  197. case TPS65912_REG_DCDC1:
  198. return TPS65912_DCDC1_AVS;
  199. case TPS65912_REG_DCDC2:
  200. return TPS65912_DCDC2_AVS;
  201. case TPS65912_REG_DCDC3:
  202. return TPS65912_DCDC3_AVS;
  203. case TPS65912_REG_DCDC4:
  204. return TPS65912_DCDC4_AVS;
  205. case TPS65912_REG_LDO1:
  206. return TPS65912_LDO1_AVS;
  207. case TPS65912_REG_LDO2:
  208. return TPS65912_LDO2_AVS;
  209. case TPS65912_REG_LDO3:
  210. return TPS65912_LDO3_AVS;
  211. case TPS65912_REG_LDO4:
  212. return TPS65912_LDO4_AVS;
  213. case TPS65912_REG_LDO5:
  214. return TPS65912_LDO5;
  215. case TPS65912_REG_LDO6:
  216. return TPS65912_LDO6;
  217. case TPS65912_REG_LDO7:
  218. return TPS65912_LDO7;
  219. case TPS65912_REG_LDO8:
  220. return TPS65912_LDO8;
  221. case TPS65912_REG_LDO9:
  222. return TPS65912_LDO9;
  223. case TPS65912_REG_LDO10:
  224. return TPS65912_LDO10;
  225. default:
  226. return -EINVAL;
  227. }
  228. }
  229. static int tps65912_get_dcdc_sel_register(struct tps65912_reg *pmic, int id)
  230. {
  231. struct tps65912 *mfd = pmic->mfd;
  232. int opvsel = 0, sr = 0;
  233. u8 reg = 0;
  234. if (id < TPS65912_REG_DCDC1 || id > TPS65912_REG_DCDC4)
  235. return -EINVAL;
  236. switch (id) {
  237. case TPS65912_REG_DCDC1:
  238. opvsel = tps65912_reg_read(mfd, TPS65912_DCDC1_OP);
  239. sr = ((opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT);
  240. if (sr)
  241. reg = TPS65912_DCDC1_AVS;
  242. else
  243. reg = TPS65912_DCDC1_OP;
  244. break;
  245. case TPS65912_REG_DCDC2:
  246. opvsel = tps65912_reg_read(mfd, TPS65912_DCDC2_OP);
  247. sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
  248. if (sr)
  249. reg = TPS65912_DCDC2_AVS;
  250. else
  251. reg = TPS65912_DCDC2_OP;
  252. break;
  253. case TPS65912_REG_DCDC3:
  254. opvsel = tps65912_reg_read(mfd, TPS65912_DCDC3_OP);
  255. sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
  256. if (sr)
  257. reg = TPS65912_DCDC3_AVS;
  258. else
  259. reg = TPS65912_DCDC3_OP;
  260. break;
  261. case TPS65912_REG_DCDC4:
  262. opvsel = tps65912_reg_read(mfd, TPS65912_DCDC4_OP);
  263. sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
  264. if (sr)
  265. reg = TPS65912_DCDC4_AVS;
  266. else
  267. reg = TPS65912_DCDC4_OP;
  268. break;
  269. }
  270. return reg;
  271. }
  272. static int tps65912_get_ldo_sel_register(struct tps65912_reg *pmic, int id)
  273. {
  274. struct tps65912 *mfd = pmic->mfd;
  275. int opvsel = 0, sr = 0;
  276. u8 reg = 0;
  277. if (id < TPS65912_REG_LDO1 || id > TPS65912_REG_LDO10)
  278. return -EINVAL;
  279. switch (id) {
  280. case TPS65912_REG_LDO1:
  281. opvsel = tps65912_reg_read(mfd, TPS65912_LDO1_OP);
  282. sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
  283. if (sr)
  284. reg = TPS65912_LDO1_AVS;
  285. else
  286. reg = TPS65912_LDO1_OP;
  287. break;
  288. case TPS65912_REG_LDO2:
  289. opvsel = tps65912_reg_read(mfd, TPS65912_LDO2_OP);
  290. sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
  291. if (sr)
  292. reg = TPS65912_LDO2_AVS;
  293. else
  294. reg = TPS65912_LDO2_OP;
  295. break;
  296. case TPS65912_REG_LDO3:
  297. opvsel = tps65912_reg_read(mfd, TPS65912_LDO3_OP);
  298. sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
  299. if (sr)
  300. reg = TPS65912_LDO3_AVS;
  301. else
  302. reg = TPS65912_LDO3_OP;
  303. break;
  304. case TPS65912_REG_LDO4:
  305. opvsel = tps65912_reg_read(mfd, TPS65912_LDO4_OP);
  306. sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
  307. if (sr)
  308. reg = TPS65912_LDO4_AVS;
  309. else
  310. reg = TPS65912_LDO4_OP;
  311. break;
  312. case TPS65912_REG_LDO5:
  313. reg = TPS65912_LDO5;
  314. break;
  315. case TPS65912_REG_LDO6:
  316. reg = TPS65912_LDO6;
  317. break;
  318. case TPS65912_REG_LDO7:
  319. reg = TPS65912_LDO7;
  320. break;
  321. case TPS65912_REG_LDO8:
  322. reg = TPS65912_LDO8;
  323. break;
  324. case TPS65912_REG_LDO9:
  325. reg = TPS65912_LDO9;
  326. break;
  327. case TPS65912_REG_LDO10:
  328. reg = TPS65912_LDO10;
  329. break;
  330. }
  331. return reg;
  332. }
  333. static int tps65912_get_mode_regiters(struct tps65912_reg *pmic, int id)
  334. {
  335. switch (id) {
  336. case TPS65912_REG_DCDC1:
  337. pmic->pwm_mode_reg = TPS65912_DCDC1_CTRL;
  338. pmic->eco_reg = TPS65912_DCDC1_AVS;
  339. break;
  340. case TPS65912_REG_DCDC2:
  341. pmic->pwm_mode_reg = TPS65912_DCDC2_CTRL;
  342. pmic->eco_reg = TPS65912_DCDC2_AVS;
  343. break;
  344. case TPS65912_REG_DCDC3:
  345. pmic->pwm_mode_reg = TPS65912_DCDC3_CTRL;
  346. pmic->eco_reg = TPS65912_DCDC3_AVS;
  347. break;
  348. case TPS65912_REG_DCDC4:
  349. pmic->pwm_mode_reg = TPS65912_DCDC4_CTRL;
  350. pmic->eco_reg = TPS65912_DCDC4_AVS;
  351. break;
  352. default:
  353. return -EINVAL;
  354. }
  355. return 0;
  356. }
  357. static int tps65912_reg_is_enabled(struct regulator_dev *dev)
  358. {
  359. struct tps65912_reg *pmic = rdev_get_drvdata(dev);
  360. struct tps65912 *mfd = pmic->mfd;
  361. int reg, value, id = rdev_get_id(dev);
  362. if (id < TPS65912_REG_DCDC1 || id > TPS65912_REG_LDO10)
  363. return -EINVAL;
  364. reg = pmic->get_ctrl_reg(id);
  365. if (reg < 0)
  366. return reg;
  367. value = tps65912_reg_read(mfd, reg);
  368. if (value < 0)
  369. return value;
  370. return value & TPS65912_REG_ENABLED;
  371. }
  372. static int tps65912_reg_enable(struct regulator_dev *dev)
  373. {
  374. struct tps65912_reg *pmic = rdev_get_drvdata(dev);
  375. struct tps65912 *mfd = pmic->mfd;
  376. int id = rdev_get_id(dev);
  377. int reg;
  378. if (id < TPS65912_REG_DCDC1 || id > TPS65912_REG_LDO10)
  379. return -EINVAL;
  380. reg = pmic->get_ctrl_reg(id);
  381. if (reg < 0)
  382. return reg;
  383. return tps65912_set_bits(mfd, reg, TPS65912_REG_ENABLED);
  384. }
  385. static int tps65912_reg_disable(struct regulator_dev *dev)
  386. {
  387. struct tps65912_reg *pmic = rdev_get_drvdata(dev);
  388. struct tps65912 *mfd = pmic->mfd;
  389. int id = rdev_get_id(dev), reg;
  390. reg = pmic->get_ctrl_reg(id);
  391. if (reg < 0)
  392. return reg;
  393. return tps65912_clear_bits(mfd, reg, TPS65912_REG_ENABLED);
  394. }
  395. static int tps65912_set_mode(struct regulator_dev *dev, unsigned int mode)
  396. {
  397. struct tps65912_reg *pmic = rdev_get_drvdata(dev);
  398. struct tps65912 *mfd = pmic->mfd;
  399. int pwm_mode, eco, id = rdev_get_id(dev);
  400. tps65912_get_mode_regiters(pmic, id);
  401. pwm_mode = tps65912_reg_read(mfd, pmic->pwm_mode_reg);
  402. eco = tps65912_reg_read(mfd, pmic->eco_reg);
  403. pwm_mode &= DCDCCTRL_DCDC_MODE_MASK;
  404. eco &= DCDC_AVS_ECO_MASK;
  405. switch (mode) {
  406. case REGULATOR_MODE_FAST:
  407. /* Verify if mode alredy set */
  408. if (pwm_mode && !eco)
  409. break;
  410. tps65912_set_bits(mfd, pmic->pwm_mode_reg, DCDCCTRL_DCDC_MODE_MASK);
  411. tps65912_clear_bits(mfd, pmic->eco_reg, DCDC_AVS_ECO_MASK);
  412. break;
  413. case REGULATOR_MODE_NORMAL:
  414. case REGULATOR_MODE_IDLE:
  415. if (!pwm_mode && !eco)
  416. break;
  417. tps65912_clear_bits(mfd, pmic->pwm_mode_reg, DCDCCTRL_DCDC_MODE_MASK);
  418. tps65912_clear_bits(mfd, pmic->eco_reg, DCDC_AVS_ECO_MASK);
  419. break;
  420. case REGULATOR_MODE_STANDBY:
  421. if (!pwm_mode && eco)
  422. break;
  423. tps65912_clear_bits(mfd, pmic->pwm_mode_reg, DCDCCTRL_DCDC_MODE_MASK);
  424. tps65912_set_bits(mfd, pmic->eco_reg, DCDC_AVS_ECO_MASK);
  425. break;
  426. default:
  427. return -EINVAL;
  428. }
  429. return 0;
  430. }
  431. static unsigned int tps65912_get_mode(struct regulator_dev *dev)
  432. {
  433. struct tps65912_reg *pmic = rdev_get_drvdata(dev);
  434. struct tps65912 *mfd = pmic->mfd;
  435. int pwm_mode, eco, mode = 0, id = rdev_get_id(dev);
  436. tps65912_get_mode_regiters(pmic, id);
  437. pwm_mode = tps65912_reg_read(mfd, pmic->pwm_mode_reg);
  438. eco = tps65912_reg_read(mfd, pmic->eco_reg);
  439. pwm_mode &= DCDCCTRL_DCDC_MODE_MASK;
  440. eco &= DCDC_AVS_ECO_MASK;
  441. if (pwm_mode && !eco)
  442. mode = REGULATOR_MODE_FAST;
  443. else if (!pwm_mode && !eco)
  444. mode = REGULATOR_MODE_NORMAL;
  445. else if (!pwm_mode && eco)
  446. mode = REGULATOR_MODE_STANDBY;
  447. return mode;
  448. }
  449. static int tps65912_get_voltage_dcdc(struct regulator_dev *dev)
  450. {
  451. struct tps65912_reg *pmic = rdev_get_drvdata(dev);
  452. struct tps65912 *mfd = pmic->mfd;
  453. int id = rdev_get_id(dev), voltage = 0, range;
  454. int opvsel = 0, avsel = 0, sr, vsel;
  455. switch (id) {
  456. case TPS65912_REG_DCDC1:
  457. opvsel = tps65912_reg_read(mfd, TPS65912_DCDC1_OP);
  458. avsel = tps65912_reg_read(mfd, TPS65912_DCDC1_AVS);
  459. range = pmic->dcdc1_range;
  460. break;
  461. case TPS65912_REG_DCDC2:
  462. opvsel = tps65912_reg_read(mfd, TPS65912_DCDC2_OP);
  463. avsel = tps65912_reg_read(mfd, TPS65912_DCDC2_AVS);
  464. range = pmic->dcdc2_range;
  465. break;
  466. case TPS65912_REG_DCDC3:
  467. opvsel = tps65912_reg_read(mfd, TPS65912_DCDC3_OP);
  468. avsel = tps65912_reg_read(mfd, TPS65912_DCDC3_AVS);
  469. range = pmic->dcdc3_range;
  470. break;
  471. case TPS65912_REG_DCDC4:
  472. opvsel = tps65912_reg_read(mfd, TPS65912_DCDC4_OP);
  473. avsel = tps65912_reg_read(mfd, TPS65912_DCDC4_AVS);
  474. range = pmic->dcdc4_range;
  475. break;
  476. default:
  477. return -EINVAL;
  478. }
  479. sr = (opvsel & OP_SELREG_MASK) >> OP_SELREG_SHIFT;
  480. if (sr)
  481. vsel = avsel;
  482. else
  483. vsel = opvsel;
  484. vsel &= 0x3F;
  485. switch (range) {
  486. case 0:
  487. /* 0.5 - 1.2875V in 12.5mV steps */
  488. voltage = tps65912_vsel_to_uv_range0(vsel);
  489. break;
  490. case 1:
  491. /* 0.7 - 1.4875V in 12.5mV steps */
  492. voltage = tps65912_vsel_to_uv_range1(vsel);
  493. break;
  494. case 2:
  495. /* 0.5 - 2.075V in 25mV steps */
  496. voltage = tps65912_vsel_to_uv_range2(vsel);
  497. break;
  498. case 3:
  499. /* 0.5 - 3.8V in 50mV steps */
  500. voltage = tps65912_vsel_to_uv_range3(vsel);
  501. break;
  502. }
  503. return voltage;
  504. }
  505. static int tps65912_set_voltage_dcdc(struct regulator_dev *dev,
  506. unsigned selector)
  507. {
  508. struct tps65912_reg *pmic = rdev_get_drvdata(dev);
  509. struct tps65912 *mfd = pmic->mfd;
  510. int id = rdev_get_id(dev);
  511. int value;
  512. u8 reg;
  513. reg = tps65912_get_dcdc_sel_register(pmic, id);
  514. value = tps65912_reg_read(mfd, reg);
  515. value &= 0xC0;
  516. return tps65912_reg_write(mfd, reg, selector | value);
  517. }
  518. static int tps65912_get_voltage_ldo(struct regulator_dev *dev)
  519. {
  520. struct tps65912_reg *pmic = rdev_get_drvdata(dev);
  521. struct tps65912 *mfd = pmic->mfd;
  522. int id = rdev_get_id(dev);
  523. int vsel = 0;
  524. u8 reg;
  525. reg = tps65912_get_ldo_sel_register(pmic, id);
  526. vsel = tps65912_reg_read(mfd, reg);
  527. vsel &= 0x3F;
  528. return tps65912_vsel_to_uv_ldo(vsel);
  529. }
  530. static int tps65912_set_voltage_ldo(struct regulator_dev *dev,
  531. unsigned selector)
  532. {
  533. struct tps65912_reg *pmic = rdev_get_drvdata(dev);
  534. struct tps65912 *mfd = pmic->mfd;
  535. int id = rdev_get_id(dev), reg, value;
  536. reg = tps65912_get_ldo_sel_register(pmic, id);
  537. value = tps65912_reg_read(mfd, reg);
  538. value &= 0xC0;
  539. return tps65912_reg_write(mfd, reg, selector | value);
  540. }
  541. static int tps65912_list_voltage_dcdc(struct regulator_dev *dev,
  542. unsigned selector)
  543. {
  544. struct tps65912_reg *pmic = rdev_get_drvdata(dev);
  545. int range, voltage = 0, id = rdev_get_id(dev);
  546. switch (id) {
  547. case TPS65912_REG_DCDC1:
  548. range = pmic->dcdc1_range;
  549. break;
  550. case TPS65912_REG_DCDC2:
  551. range = pmic->dcdc2_range;
  552. break;
  553. case TPS65912_REG_DCDC3:
  554. range = pmic->dcdc3_range;
  555. break;
  556. case TPS65912_REG_DCDC4:
  557. range = pmic->dcdc4_range;
  558. break;
  559. default:
  560. return -EINVAL;
  561. }
  562. switch (range) {
  563. case 0:
  564. /* 0.5 - 1.2875V in 12.5mV steps */
  565. voltage = tps65912_vsel_to_uv_range0(selector);
  566. break;
  567. case 1:
  568. /* 0.7 - 1.4875V in 12.5mV steps */
  569. voltage = tps65912_vsel_to_uv_range1(selector);
  570. break;
  571. case 2:
  572. /* 0.5 - 2.075V in 25mV steps */
  573. voltage = tps65912_vsel_to_uv_range2(selector);
  574. break;
  575. case 3:
  576. /* 0.5 - 3.8V in 50mV steps */
  577. voltage = tps65912_vsel_to_uv_range3(selector);
  578. break;
  579. }
  580. return voltage;
  581. }
  582. static int tps65912_list_voltage_ldo(struct regulator_dev *dev,
  583. unsigned selector)
  584. {
  585. int ldo = rdev_get_id(dev);
  586. if (ldo < TPS65912_REG_LDO1 || ldo > TPS65912_REG_LDO10)
  587. return -EINVAL;
  588. return tps65912_vsel_to_uv_ldo(selector);
  589. }
  590. /* Operations permitted on DCDCx */
  591. static struct regulator_ops tps65912_ops_dcdc = {
  592. .is_enabled = tps65912_reg_is_enabled,
  593. .enable = tps65912_reg_enable,
  594. .disable = tps65912_reg_disable,
  595. .set_mode = tps65912_set_mode,
  596. .get_mode = tps65912_get_mode,
  597. .get_voltage = tps65912_get_voltage_dcdc,
  598. .set_voltage_sel = tps65912_set_voltage_dcdc,
  599. .list_voltage = tps65912_list_voltage_dcdc,
  600. };
  601. /* Operations permitted on LDOx */
  602. static struct regulator_ops tps65912_ops_ldo = {
  603. .is_enabled = tps65912_reg_is_enabled,
  604. .enable = tps65912_reg_enable,
  605. .disable = tps65912_reg_disable,
  606. .get_voltage = tps65912_get_voltage_ldo,
  607. .set_voltage_sel = tps65912_set_voltage_ldo,
  608. .list_voltage = tps65912_list_voltage_ldo,
  609. };
  610. static __devinit int tps65912_probe(struct platform_device *pdev)
  611. {
  612. struct tps65912 *tps65912 = dev_get_drvdata(pdev->dev.parent);
  613. struct tps_info *info;
  614. struct regulator_init_data *reg_data;
  615. struct regulator_dev *rdev;
  616. struct tps65912_reg *pmic;
  617. struct tps65912_board *pmic_plat_data;
  618. int i, err;
  619. pmic_plat_data = dev_get_platdata(tps65912->dev);
  620. if (!pmic_plat_data)
  621. return -EINVAL;
  622. reg_data = pmic_plat_data->tps65912_pmic_init_data;
  623. pmic = kzalloc(sizeof(*pmic), GFP_KERNEL);
  624. if (!pmic)
  625. return -ENOMEM;
  626. mutex_init(&pmic->io_lock);
  627. pmic->mfd = tps65912;
  628. platform_set_drvdata(pdev, pmic);
  629. pmic->get_ctrl_reg = &tps65912_get_ctrl_register;
  630. info = tps65912_regs;
  631. for (i = 0; i < TPS65912_NUM_REGULATOR; i++, info++, reg_data++) {
  632. int range = 0;
  633. /* Register the regulators */
  634. pmic->info[i] = info;
  635. pmic->desc[i].name = info->name;
  636. pmic->desc[i].id = i;
  637. pmic->desc[i].n_voltages = 64;
  638. pmic->desc[i].ops = (i > TPS65912_REG_DCDC4 ?
  639. &tps65912_ops_ldo : &tps65912_ops_dcdc);
  640. pmic->desc[i].type = REGULATOR_VOLTAGE;
  641. pmic->desc[i].owner = THIS_MODULE;
  642. range = tps65912_get_range(pmic, i);
  643. rdev = regulator_register(&pmic->desc[i],
  644. tps65912->dev, reg_data, pmic);
  645. if (IS_ERR(rdev)) {
  646. dev_err(tps65912->dev,
  647. "failed to register %s regulator\n",
  648. pdev->name);
  649. err = PTR_ERR(rdev);
  650. goto err;
  651. }
  652. /* Save regulator for cleanup */
  653. pmic->rdev[i] = rdev;
  654. }
  655. return 0;
  656. err:
  657. while (--i >= 0)
  658. regulator_unregister(pmic->rdev[i]);
  659. kfree(pmic);
  660. return err;
  661. }
  662. static int __devexit tps65912_remove(struct platform_device *pdev)
  663. {
  664. struct tps65912_reg *tps65912_reg = platform_get_drvdata(pdev);
  665. int i;
  666. for (i = 0; i < TPS65912_NUM_REGULATOR; i++)
  667. regulator_unregister(tps65912_reg->rdev[i]);
  668. kfree(tps65912_reg);
  669. return 0;
  670. }
  671. static struct platform_driver tps65912_driver = {
  672. .driver = {
  673. .name = "tps65912-pmic",
  674. .owner = THIS_MODULE,
  675. },
  676. .probe = tps65912_probe,
  677. .remove = __devexit_p(tps65912_remove),
  678. };
  679. /**
  680. * tps65912_init
  681. *
  682. * Module init function
  683. */
  684. static int __init tps65912_init(void)
  685. {
  686. return platform_driver_register(&tps65912_driver);
  687. }
  688. subsys_initcall(tps65912_init);
  689. /**
  690. * tps65912_cleanup
  691. *
  692. * Module exit function
  693. */
  694. static void __exit tps65912_cleanup(void)
  695. {
  696. platform_driver_unregister(&tps65912_driver);
  697. }
  698. module_exit(tps65912_cleanup);
  699. MODULE_AUTHOR("Margarita Olaya Cabrera <magi@slimlogic.co.uk>");
  700. MODULE_DESCRIPTION("TPS65912 voltage regulator driver");
  701. MODULE_LICENSE("GPL v2");
  702. MODULE_ALIAS("platform:tps65912-pmic");