tps65912-regulator.c 18 KB

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