Commit | Line | Data |
---|---|---|
3fa5b8e0 AA |
1 | /* |
2 | * tps6507x-regulator.c | |
3 | * | |
4 | * Regulator driver for TPS65073 PMIC | |
5 | * | |
6 | * Copyright (C) 2009 Texas Instrument Incorporated - http://www.ti.com/ | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or | |
9 | * modify it under the terms of the GNU General Public License as | |
10 | * published by the Free Software Foundation version 2. | |
11 | * | |
12 | * This program is distributed "as is" WITHOUT ANY WARRANTY of any kind, | |
13 | * whether express or implied; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
15 | * General Public License for more details. | |
16 | */ | |
17 | ||
18 | #include <linux/kernel.h> | |
19 | #include <linux/module.h> | |
20 | #include <linux/init.h> | |
21 | #include <linux/err.h> | |
22 | #include <linux/platform_device.h> | |
23 | #include <linux/regulator/driver.h> | |
24 | #include <linux/regulator/machine.h> | |
7d14831e | 25 | #include <linux/regulator/tps6507x.h> |
3fa5b8e0 | 26 | #include <linux/delay.h> |
5a0e3ad6 | 27 | #include <linux/slab.h> |
d183fcc9 | 28 | #include <linux/mfd/tps6507x.h> |
3fa5b8e0 AA |
29 | |
30 | /* DCDC's */ | |
31 | #define TPS6507X_DCDC_1 0 | |
32 | #define TPS6507X_DCDC_2 1 | |
33 | #define TPS6507X_DCDC_3 2 | |
34 | /* LDOs */ | |
35 | #define TPS6507X_LDO_1 3 | |
36 | #define TPS6507X_LDO_2 4 | |
37 | ||
38 | #define TPS6507X_MAX_REG_ID TPS6507X_LDO_2 | |
39 | ||
40 | /* Number of step-down converters available */ | |
41 | #define TPS6507X_NUM_DCDC 3 | |
42 | /* Number of LDO voltage regulators available */ | |
43 | #define TPS6507X_NUM_LDO 2 | |
44 | /* Number of total regulators available */ | |
45 | #define TPS6507X_NUM_REGULATOR (TPS6507X_NUM_DCDC + TPS6507X_NUM_LDO) | |
46 | ||
47 | /* Supported voltage values for regulators (in milliVolts) */ | |
48 | static const u16 VDCDCx_VSEL_table[] = { | |
49 | 725, 750, 775, 800, | |
50 | 825, 850, 875, 900, | |
51 | 925, 950, 975, 1000, | |
52 | 1025, 1050, 1075, 1100, | |
53 | 1125, 1150, 1175, 1200, | |
54 | 1225, 1250, 1275, 1300, | |
55 | 1325, 1350, 1375, 1400, | |
56 | 1425, 1450, 1475, 1500, | |
57 | 1550, 1600, 1650, 1700, | |
58 | 1750, 1800, 1850, 1900, | |
59 | 1950, 2000, 2050, 2100, | |
60 | 2150, 2200, 2250, 2300, | |
61 | 2350, 2400, 2450, 2500, | |
62 | 2550, 2600, 2650, 2700, | |
63 | 2750, 2800, 2850, 2900, | |
64 | 3000, 3100, 3200, 3300, | |
65 | }; | |
66 | ||
67 | static const u16 LDO1_VSEL_table[] = { | |
68 | 1000, 1100, 1200, 1250, | |
69 | 1300, 1350, 1400, 1500, | |
70 | 1600, 1800, 2500, 2750, | |
71 | 2800, 3000, 3100, 3300, | |
72 | }; | |
73 | ||
74 | static const u16 LDO2_VSEL_table[] = { | |
75 | 725, 750, 775, 800, | |
76 | 825, 850, 875, 900, | |
77 | 925, 950, 975, 1000, | |
78 | 1025, 1050, 1075, 1100, | |
79 | 1125, 1150, 1175, 1200, | |
80 | 1225, 1250, 1275, 1300, | |
81 | 1325, 1350, 1375, 1400, | |
82 | 1425, 1450, 1475, 1500, | |
83 | 1550, 1600, 1650, 1700, | |
84 | 1750, 1800, 1850, 1900, | |
85 | 1950, 2000, 2050, 2100, | |
86 | 2150, 2200, 2250, 2300, | |
87 | 2350, 2400, 2450, 2500, | |
88 | 2550, 2600, 2650, 2700, | |
89 | 2750, 2800, 2850, 2900, | |
90 | 3000, 3100, 3200, 3300, | |
91 | }; | |
92 | ||
93 | static unsigned int num_voltages[] = {ARRAY_SIZE(VDCDCx_VSEL_table), | |
94 | ARRAY_SIZE(VDCDCx_VSEL_table), | |
95 | ARRAY_SIZE(VDCDCx_VSEL_table), | |
96 | ARRAY_SIZE(LDO1_VSEL_table), | |
97 | ARRAY_SIZE(LDO2_VSEL_table)}; | |
98 | ||
99 | struct tps_info { | |
100 | const char *name; | |
101 | unsigned min_uV; | |
102 | unsigned max_uV; | |
103 | u8 table_len; | |
104 | const u16 *table; | |
7d14831e AA |
105 | |
106 | /* Does DCDC high or the low register defines output voltage? */ | |
107 | bool defdcdc_default; | |
3fa5b8e0 AA |
108 | }; |
109 | ||
7d14831e | 110 | static struct tps_info tps6507x_pmic_regs[] = { |
31dd6a26 TF |
111 | { |
112 | .name = "VDCDC1", | |
113 | .min_uV = 725000, | |
114 | .max_uV = 3300000, | |
115 | .table_len = ARRAY_SIZE(VDCDCx_VSEL_table), | |
116 | .table = VDCDCx_VSEL_table, | |
117 | }, | |
118 | { | |
119 | .name = "VDCDC2", | |
120 | .min_uV = 725000, | |
121 | .max_uV = 3300000, | |
122 | .table_len = ARRAY_SIZE(VDCDCx_VSEL_table), | |
123 | .table = VDCDCx_VSEL_table, | |
124 | }, | |
125 | { | |
126 | .name = "VDCDC3", | |
127 | .min_uV = 725000, | |
128 | .max_uV = 3300000, | |
129 | .table_len = ARRAY_SIZE(VDCDCx_VSEL_table), | |
130 | .table = VDCDCx_VSEL_table, | |
131 | }, | |
132 | { | |
133 | .name = "LDO1", | |
134 | .min_uV = 1000000, | |
135 | .max_uV = 3300000, | |
136 | .table_len = ARRAY_SIZE(LDO1_VSEL_table), | |
137 | .table = LDO1_VSEL_table, | |
138 | }, | |
139 | { | |
140 | .name = "LDO2", | |
141 | .min_uV = 725000, | |
142 | .max_uV = 3300000, | |
143 | .table_len = ARRAY_SIZE(LDO2_VSEL_table), | |
144 | .table = LDO2_VSEL_table, | |
145 | }, | |
146 | }; | |
147 | ||
4ce5ba5b | 148 | struct tps6507x_pmic { |
3fa5b8e0 | 149 | struct regulator_desc desc[TPS6507X_NUM_REGULATOR]; |
31dd6a26 | 150 | struct tps6507x_dev *mfd; |
3fa5b8e0 | 151 | struct regulator_dev *rdev[TPS6507X_NUM_REGULATOR]; |
7d14831e | 152 | struct tps_info *info[TPS6507X_NUM_REGULATOR]; |
3fa5b8e0 AA |
153 | struct mutex io_lock; |
154 | }; | |
4ce5ba5b | 155 | static inline int tps6507x_pmic_read(struct tps6507x_pmic *tps, u8 reg) |
3fa5b8e0 | 156 | { |
31dd6a26 TF |
157 | u8 val; |
158 | int err; | |
159 | ||
160 | err = tps->mfd->read_dev(tps->mfd, reg, 1, &val); | |
161 | ||
162 | if (err) | |
163 | return err; | |
164 | ||
165 | return val; | |
3fa5b8e0 AA |
166 | } |
167 | ||
4ce5ba5b | 168 | static inline int tps6507x_pmic_write(struct tps6507x_pmic *tps, u8 reg, u8 val) |
3fa5b8e0 | 169 | { |
31dd6a26 | 170 | return tps->mfd->write_dev(tps->mfd, reg, 1, &val); |
3fa5b8e0 AA |
171 | } |
172 | ||
4ce5ba5b | 173 | static int tps6507x_pmic_set_bits(struct tps6507x_pmic *tps, u8 reg, u8 mask) |
3fa5b8e0 AA |
174 | { |
175 | int err, data; | |
176 | ||
177 | mutex_lock(&tps->io_lock); | |
178 | ||
4ce5ba5b | 179 | data = tps6507x_pmic_read(tps, reg); |
3fa5b8e0 | 180 | if (data < 0) { |
31dd6a26 | 181 | dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg); |
3fa5b8e0 AA |
182 | err = data; |
183 | goto out; | |
184 | } | |
185 | ||
186 | data |= mask; | |
4ce5ba5b | 187 | err = tps6507x_pmic_write(tps, reg, data); |
3fa5b8e0 | 188 | if (err) |
31dd6a26 | 189 | dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg); |
3fa5b8e0 AA |
190 | |
191 | out: | |
192 | mutex_unlock(&tps->io_lock); | |
193 | return err; | |
194 | } | |
195 | ||
4ce5ba5b | 196 | static int tps6507x_pmic_clear_bits(struct tps6507x_pmic *tps, u8 reg, u8 mask) |
3fa5b8e0 AA |
197 | { |
198 | int err, data; | |
199 | ||
200 | mutex_lock(&tps->io_lock); | |
201 | ||
4ce5ba5b | 202 | data = tps6507x_pmic_read(tps, reg); |
3fa5b8e0 | 203 | if (data < 0) { |
31dd6a26 | 204 | dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg); |
3fa5b8e0 AA |
205 | err = data; |
206 | goto out; | |
207 | } | |
208 | ||
209 | data &= ~mask; | |
4ce5ba5b | 210 | err = tps6507x_pmic_write(tps, reg, data); |
3fa5b8e0 | 211 | if (err) |
31dd6a26 | 212 | dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg); |
3fa5b8e0 AA |
213 | |
214 | out: | |
215 | mutex_unlock(&tps->io_lock); | |
216 | return err; | |
217 | } | |
218 | ||
4ce5ba5b | 219 | static int tps6507x_pmic_reg_read(struct tps6507x_pmic *tps, u8 reg) |
3fa5b8e0 AA |
220 | { |
221 | int data; | |
222 | ||
223 | mutex_lock(&tps->io_lock); | |
224 | ||
4ce5ba5b | 225 | data = tps6507x_pmic_read(tps, reg); |
3fa5b8e0 | 226 | if (data < 0) |
31dd6a26 | 227 | dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg); |
3fa5b8e0 AA |
228 | |
229 | mutex_unlock(&tps->io_lock); | |
230 | return data; | |
231 | } | |
232 | ||
4ce5ba5b | 233 | static int tps6507x_pmic_reg_write(struct tps6507x_pmic *tps, u8 reg, u8 val) |
3fa5b8e0 AA |
234 | { |
235 | int err; | |
236 | ||
237 | mutex_lock(&tps->io_lock); | |
238 | ||
4ce5ba5b | 239 | err = tps6507x_pmic_write(tps, reg, val); |
3fa5b8e0 | 240 | if (err < 0) |
31dd6a26 | 241 | dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg); |
3fa5b8e0 AA |
242 | |
243 | mutex_unlock(&tps->io_lock); | |
244 | return err; | |
245 | } | |
246 | ||
4ce5ba5b | 247 | static int tps6507x_pmic_dcdc_is_enabled(struct regulator_dev *dev) |
3fa5b8e0 | 248 | { |
4ce5ba5b | 249 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
3fa5b8e0 AA |
250 | int data, dcdc = rdev_get_id(dev); |
251 | u8 shift; | |
252 | ||
253 | if (dcdc < TPS6507X_DCDC_1 || dcdc > TPS6507X_DCDC_3) | |
254 | return -EINVAL; | |
255 | ||
256 | shift = TPS6507X_MAX_REG_ID - dcdc; | |
4ce5ba5b | 257 | data = tps6507x_pmic_reg_read(tps, TPS6507X_REG_CON_CTRL1); |
3fa5b8e0 AA |
258 | |
259 | if (data < 0) | |
260 | return data; | |
261 | else | |
262 | return (data & 1<<shift) ? 1 : 0; | |
263 | } | |
264 | ||
4ce5ba5b | 265 | static int tps6507x_pmic_ldo_is_enabled(struct regulator_dev *dev) |
3fa5b8e0 | 266 | { |
4ce5ba5b | 267 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
3fa5b8e0 AA |
268 | int data, ldo = rdev_get_id(dev); |
269 | u8 shift; | |
270 | ||
271 | if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2) | |
272 | return -EINVAL; | |
273 | ||
274 | shift = TPS6507X_MAX_REG_ID - ldo; | |
4ce5ba5b | 275 | data = tps6507x_pmic_reg_read(tps, TPS6507X_REG_CON_CTRL1); |
3fa5b8e0 AA |
276 | |
277 | if (data < 0) | |
278 | return data; | |
279 | else | |
280 | return (data & 1<<shift) ? 1 : 0; | |
281 | } | |
282 | ||
4ce5ba5b | 283 | static int tps6507x_pmic_dcdc_enable(struct regulator_dev *dev) |
3fa5b8e0 | 284 | { |
4ce5ba5b | 285 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
3fa5b8e0 AA |
286 | int dcdc = rdev_get_id(dev); |
287 | u8 shift; | |
288 | ||
289 | if (dcdc < TPS6507X_DCDC_1 || dcdc > TPS6507X_DCDC_3) | |
290 | return -EINVAL; | |
291 | ||
292 | shift = TPS6507X_MAX_REG_ID - dcdc; | |
4ce5ba5b | 293 | return tps6507x_pmic_set_bits(tps, TPS6507X_REG_CON_CTRL1, 1 << shift); |
3fa5b8e0 AA |
294 | } |
295 | ||
4ce5ba5b | 296 | static int tps6507x_pmic_dcdc_disable(struct regulator_dev *dev) |
3fa5b8e0 | 297 | { |
4ce5ba5b | 298 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
3fa5b8e0 AA |
299 | int dcdc = rdev_get_id(dev); |
300 | u8 shift; | |
301 | ||
302 | if (dcdc < TPS6507X_DCDC_1 || dcdc > TPS6507X_DCDC_3) | |
303 | return -EINVAL; | |
304 | ||
305 | shift = TPS6507X_MAX_REG_ID - dcdc; | |
4ce5ba5b TF |
306 | return tps6507x_pmic_clear_bits(tps, TPS6507X_REG_CON_CTRL1, |
307 | 1 << shift); | |
3fa5b8e0 AA |
308 | } |
309 | ||
4ce5ba5b | 310 | static int tps6507x_pmic_ldo_enable(struct regulator_dev *dev) |
3fa5b8e0 | 311 | { |
4ce5ba5b | 312 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
3fa5b8e0 AA |
313 | int ldo = rdev_get_id(dev); |
314 | u8 shift; | |
315 | ||
316 | if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2) | |
317 | return -EINVAL; | |
318 | ||
319 | shift = TPS6507X_MAX_REG_ID - ldo; | |
4ce5ba5b | 320 | return tps6507x_pmic_set_bits(tps, TPS6507X_REG_CON_CTRL1, 1 << shift); |
3fa5b8e0 AA |
321 | } |
322 | ||
4ce5ba5b | 323 | static int tps6507x_pmic_ldo_disable(struct regulator_dev *dev) |
3fa5b8e0 | 324 | { |
4ce5ba5b | 325 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
3fa5b8e0 AA |
326 | int ldo = rdev_get_id(dev); |
327 | u8 shift; | |
328 | ||
329 | if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2) | |
330 | return -EINVAL; | |
331 | ||
332 | shift = TPS6507X_MAX_REG_ID - ldo; | |
4ce5ba5b TF |
333 | return tps6507x_pmic_clear_bits(tps, TPS6507X_REG_CON_CTRL1, |
334 | 1 << shift); | |
3fa5b8e0 AA |
335 | } |
336 | ||
4ce5ba5b | 337 | static int tps6507x_pmic_dcdc_get_voltage(struct regulator_dev *dev) |
3fa5b8e0 | 338 | { |
4ce5ba5b | 339 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
3fa5b8e0 AA |
340 | int data, dcdc = rdev_get_id(dev); |
341 | u8 reg; | |
342 | ||
343 | switch (dcdc) { | |
344 | case TPS6507X_DCDC_1: | |
345 | reg = TPS6507X_REG_DEFDCDC1; | |
346 | break; | |
347 | case TPS6507X_DCDC_2: | |
7d14831e AA |
348 | if (tps->info[dcdc]->defdcdc_default) |
349 | reg = TPS6507X_REG_DEFDCDC2_HIGH; | |
350 | else | |
351 | reg = TPS6507X_REG_DEFDCDC2_LOW; | |
3fa5b8e0 AA |
352 | break; |
353 | case TPS6507X_DCDC_3: | |
7d14831e AA |
354 | if (tps->info[dcdc]->defdcdc_default) |
355 | reg = TPS6507X_REG_DEFDCDC3_HIGH; | |
356 | else | |
357 | reg = TPS6507X_REG_DEFDCDC3_LOW; | |
3fa5b8e0 AA |
358 | break; |
359 | default: | |
360 | return -EINVAL; | |
361 | } | |
362 | ||
4ce5ba5b | 363 | data = tps6507x_pmic_reg_read(tps, reg); |
3fa5b8e0 AA |
364 | if (data < 0) |
365 | return data; | |
366 | ||
367 | data &= TPS6507X_DEFDCDCX_DCDC_MASK; | |
368 | return tps->info[dcdc]->table[data] * 1000; | |
369 | } | |
370 | ||
4ce5ba5b | 371 | static int tps6507x_pmic_dcdc_set_voltage(struct regulator_dev *dev, |
3a93f2a9 MB |
372 | int min_uV, int max_uV, |
373 | unsigned *selector) | |
3fa5b8e0 | 374 | { |
4ce5ba5b | 375 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
3fa5b8e0 AA |
376 | int data, vsel, dcdc = rdev_get_id(dev); |
377 | u8 reg; | |
378 | ||
379 | switch (dcdc) { | |
380 | case TPS6507X_DCDC_1: | |
381 | reg = TPS6507X_REG_DEFDCDC1; | |
382 | break; | |
383 | case TPS6507X_DCDC_2: | |
7d14831e AA |
384 | if (tps->info[dcdc]->defdcdc_default) |
385 | reg = TPS6507X_REG_DEFDCDC2_HIGH; | |
386 | else | |
387 | reg = TPS6507X_REG_DEFDCDC2_LOW; | |
3fa5b8e0 AA |
388 | break; |
389 | case TPS6507X_DCDC_3: | |
7d14831e AA |
390 | if (tps->info[dcdc]->defdcdc_default) |
391 | reg = TPS6507X_REG_DEFDCDC3_HIGH; | |
392 | else | |
393 | reg = TPS6507X_REG_DEFDCDC3_LOW; | |
3fa5b8e0 AA |
394 | break; |
395 | default: | |
396 | return -EINVAL; | |
397 | } | |
398 | ||
399 | if (min_uV < tps->info[dcdc]->min_uV | |
400 | || min_uV > tps->info[dcdc]->max_uV) | |
401 | return -EINVAL; | |
402 | if (max_uV < tps->info[dcdc]->min_uV | |
403 | || max_uV > tps->info[dcdc]->max_uV) | |
404 | return -EINVAL; | |
405 | ||
406 | for (vsel = 0; vsel < tps->info[dcdc]->table_len; vsel++) { | |
407 | int mV = tps->info[dcdc]->table[vsel]; | |
408 | int uV = mV * 1000; | |
409 | ||
410 | /* Break at the first in-range value */ | |
411 | if (min_uV <= uV && uV <= max_uV) | |
412 | break; | |
413 | } | |
414 | ||
415 | /* write to the register in case we found a match */ | |
416 | if (vsel == tps->info[dcdc]->table_len) | |
417 | return -EINVAL; | |
418 | ||
3a93f2a9 MB |
419 | *selector = vsel; |
420 | ||
4ce5ba5b | 421 | data = tps6507x_pmic_reg_read(tps, reg); |
3fa5b8e0 AA |
422 | if (data < 0) |
423 | return data; | |
424 | ||
425 | data &= ~TPS6507X_DEFDCDCX_DCDC_MASK; | |
426 | data |= vsel; | |
427 | ||
4ce5ba5b | 428 | return tps6507x_pmic_reg_write(tps, reg, data); |
3fa5b8e0 AA |
429 | } |
430 | ||
4ce5ba5b | 431 | static int tps6507x_pmic_ldo_get_voltage(struct regulator_dev *dev) |
3fa5b8e0 | 432 | { |
4ce5ba5b | 433 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
3fa5b8e0 AA |
434 | int data, ldo = rdev_get_id(dev); |
435 | u8 reg, mask; | |
436 | ||
437 | if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2) | |
438 | return -EINVAL; | |
439 | else { | |
440 | reg = (ldo == TPS6507X_LDO_1 ? | |
441 | TPS6507X_REG_LDO_CTRL1 : TPS6507X_REG_DEFLDO2); | |
442 | mask = (ldo == TPS6507X_LDO_1 ? | |
443 | TPS6507X_REG_LDO_CTRL1_LDO1_MASK : | |
444 | TPS6507X_REG_DEFLDO2_LDO2_MASK); | |
445 | } | |
446 | ||
4ce5ba5b | 447 | data = tps6507x_pmic_reg_read(tps, reg); |
3fa5b8e0 AA |
448 | if (data < 0) |
449 | return data; | |
450 | ||
451 | data &= mask; | |
452 | return tps->info[ldo]->table[data] * 1000; | |
453 | } | |
454 | ||
4ce5ba5b | 455 | static int tps6507x_pmic_ldo_set_voltage(struct regulator_dev *dev, |
3a93f2a9 MB |
456 | int min_uV, int max_uV, |
457 | unsigned *selector) | |
3fa5b8e0 | 458 | { |
4ce5ba5b | 459 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
3fa5b8e0 AA |
460 | int data, vsel, ldo = rdev_get_id(dev); |
461 | u8 reg, mask; | |
462 | ||
463 | if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2) | |
464 | return -EINVAL; | |
465 | else { | |
466 | reg = (ldo == TPS6507X_LDO_1 ? | |
467 | TPS6507X_REG_LDO_CTRL1 : TPS6507X_REG_DEFLDO2); | |
468 | mask = (ldo == TPS6507X_LDO_1 ? | |
469 | TPS6507X_REG_LDO_CTRL1_LDO1_MASK : | |
470 | TPS6507X_REG_DEFLDO2_LDO2_MASK); | |
471 | } | |
472 | ||
473 | if (min_uV < tps->info[ldo]->min_uV || min_uV > tps->info[ldo]->max_uV) | |
474 | return -EINVAL; | |
475 | if (max_uV < tps->info[ldo]->min_uV || max_uV > tps->info[ldo]->max_uV) | |
476 | return -EINVAL; | |
477 | ||
478 | for (vsel = 0; vsel < tps->info[ldo]->table_len; vsel++) { | |
479 | int mV = tps->info[ldo]->table[vsel]; | |
480 | int uV = mV * 1000; | |
481 | ||
482 | /* Break at the first in-range value */ | |
483 | if (min_uV <= uV && uV <= max_uV) | |
484 | break; | |
485 | } | |
486 | ||
487 | if (vsel == tps->info[ldo]->table_len) | |
488 | return -EINVAL; | |
489 | ||
3a93f2a9 MB |
490 | *selector = vsel; |
491 | ||
4ce5ba5b | 492 | data = tps6507x_pmic_reg_read(tps, reg); |
3fa5b8e0 AA |
493 | if (data < 0) |
494 | return data; | |
495 | ||
496 | data &= ~mask; | |
497 | data |= vsel; | |
498 | ||
4ce5ba5b | 499 | return tps6507x_pmic_reg_write(tps, reg, data); |
3fa5b8e0 AA |
500 | } |
501 | ||
4ce5ba5b | 502 | static int tps6507x_pmic_dcdc_list_voltage(struct regulator_dev *dev, |
3fa5b8e0 AA |
503 | unsigned selector) |
504 | { | |
4ce5ba5b | 505 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
3fa5b8e0 AA |
506 | int dcdc = rdev_get_id(dev); |
507 | ||
508 | if (dcdc < TPS6507X_DCDC_1 || dcdc > TPS6507X_DCDC_3) | |
509 | return -EINVAL; | |
510 | ||
511 | if (selector >= tps->info[dcdc]->table_len) | |
512 | return -EINVAL; | |
513 | else | |
514 | return tps->info[dcdc]->table[selector] * 1000; | |
515 | } | |
516 | ||
4ce5ba5b | 517 | static int tps6507x_pmic_ldo_list_voltage(struct regulator_dev *dev, |
3fa5b8e0 AA |
518 | unsigned selector) |
519 | { | |
4ce5ba5b | 520 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
3fa5b8e0 AA |
521 | int ldo = rdev_get_id(dev); |
522 | ||
523 | if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2) | |
524 | return -EINVAL; | |
525 | ||
526 | if (selector >= tps->info[ldo]->table_len) | |
527 | return -EINVAL; | |
528 | else | |
529 | return tps->info[ldo]->table[selector] * 1000; | |
530 | } | |
531 | ||
532 | /* Operations permitted on VDCDCx */ | |
4ce5ba5b TF |
533 | static struct regulator_ops tps6507x_pmic_dcdc_ops = { |
534 | .is_enabled = tps6507x_pmic_dcdc_is_enabled, | |
535 | .enable = tps6507x_pmic_dcdc_enable, | |
536 | .disable = tps6507x_pmic_dcdc_disable, | |
537 | .get_voltage = tps6507x_pmic_dcdc_get_voltage, | |
538 | .set_voltage = tps6507x_pmic_dcdc_set_voltage, | |
539 | .list_voltage = tps6507x_pmic_dcdc_list_voltage, | |
3fa5b8e0 AA |
540 | }; |
541 | ||
542 | /* Operations permitted on LDOx */ | |
4ce5ba5b TF |
543 | static struct regulator_ops tps6507x_pmic_ldo_ops = { |
544 | .is_enabled = tps6507x_pmic_ldo_is_enabled, | |
545 | .enable = tps6507x_pmic_ldo_enable, | |
546 | .disable = tps6507x_pmic_ldo_disable, | |
547 | .get_voltage = tps6507x_pmic_ldo_get_voltage, | |
548 | .set_voltage = tps6507x_pmic_ldo_set_voltage, | |
549 | .list_voltage = tps6507x_pmic_ldo_list_voltage, | |
3fa5b8e0 AA |
550 | }; |
551 | ||
31dd6a26 TF |
552 | static __devinit |
553 | int tps6507x_pmic_probe(struct platform_device *pdev) | |
3fa5b8e0 | 554 | { |
31dd6a26 | 555 | struct tps6507x_dev *tps6507x_dev = dev_get_drvdata(pdev->dev.parent); |
7d14831e | 556 | struct tps_info *info = &tps6507x_pmic_regs[0]; |
3fa5b8e0 AA |
557 | struct regulator_init_data *init_data; |
558 | struct regulator_dev *rdev; | |
4ce5ba5b | 559 | struct tps6507x_pmic *tps; |
0bc20bba | 560 | struct tps6507x_board *tps_board; |
3fa5b8e0 | 561 | int i; |
56c23492 | 562 | int error; |
3fa5b8e0 | 563 | |
0bc20bba TF |
564 | /** |
565 | * tps_board points to pmic related constants | |
566 | * coming from the board-evm file. | |
567 | */ | |
568 | ||
31dd6a26 | 569 | tps_board = dev_get_platdata(tps6507x_dev->dev); |
0bc20bba TF |
570 | if (!tps_board) |
571 | return -EINVAL; | |
572 | ||
3fa5b8e0 AA |
573 | /** |
574 | * init_data points to array of regulator_init structures | |
575 | * coming from the board-evm file. | |
576 | */ | |
0bc20bba | 577 | init_data = tps_board->tps6507x_pmic_init_data; |
3fa5b8e0 | 578 | if (!init_data) |
0bc20bba | 579 | return -EINVAL; |
3fa5b8e0 AA |
580 | |
581 | tps = kzalloc(sizeof(*tps), GFP_KERNEL); | |
582 | if (!tps) | |
583 | return -ENOMEM; | |
584 | ||
585 | mutex_init(&tps->io_lock); | |
586 | ||
587 | /* common for all regulators */ | |
31dd6a26 | 588 | tps->mfd = tps6507x_dev; |
3fa5b8e0 AA |
589 | |
590 | for (i = 0; i < TPS6507X_NUM_REGULATOR; i++, info++, init_data++) { | |
591 | /* Register the regulators */ | |
592 | tps->info[i] = info; | |
7d14831e AA |
593 | if (init_data->driver_data) { |
594 | struct tps6507x_reg_platform_data *data = | |
595 | init_data->driver_data; | |
596 | tps->info[i]->defdcdc_default = data->defdcdc_default; | |
597 | } | |
598 | ||
3fa5b8e0 | 599 | tps->desc[i].name = info->name; |
77fa44d0 | 600 | tps->desc[i].id = i; |
3fa5b8e0 AA |
601 | tps->desc[i].n_voltages = num_voltages[i]; |
602 | tps->desc[i].ops = (i > TPS6507X_DCDC_3 ? | |
4ce5ba5b | 603 | &tps6507x_pmic_ldo_ops : &tps6507x_pmic_dcdc_ops); |
3fa5b8e0 AA |
604 | tps->desc[i].type = REGULATOR_VOLTAGE; |
605 | tps->desc[i].owner = THIS_MODULE; | |
606 | ||
607 | rdev = regulator_register(&tps->desc[i], | |
31dd6a26 | 608 | tps6507x_dev->dev, init_data, tps); |
3fa5b8e0 | 609 | if (IS_ERR(rdev)) { |
31dd6a26 TF |
610 | dev_err(tps6507x_dev->dev, |
611 | "failed to register %s regulator\n", | |
612 | pdev->name); | |
56c23492 DT |
613 | error = PTR_ERR(rdev); |
614 | goto fail; | |
3fa5b8e0 AA |
615 | } |
616 | ||
617 | /* Save regulator for cleanup */ | |
618 | tps->rdev[i] = rdev; | |
619 | } | |
620 | ||
31dd6a26 | 621 | tps6507x_dev->pmic = tps; |
d7399fa8 | 622 | platform_set_drvdata(pdev, tps6507x_dev); |
3fa5b8e0 AA |
623 | |
624 | return 0; | |
56c23492 DT |
625 | |
626 | fail: | |
627 | while (--i >= 0) | |
628 | regulator_unregister(tps->rdev[i]); | |
629 | ||
630 | kfree(tps); | |
631 | return error; | |
3fa5b8e0 AA |
632 | } |
633 | ||
31dd6a26 | 634 | static int __devexit tps6507x_pmic_remove(struct platform_device *pdev) |
3fa5b8e0 | 635 | { |
31dd6a26 TF |
636 | struct tps6507x_dev *tps6507x_dev = platform_get_drvdata(pdev); |
637 | struct tps6507x_pmic *tps = tps6507x_dev->pmic; | |
3fa5b8e0 AA |
638 | int i; |
639 | ||
640 | for (i = 0; i < TPS6507X_NUM_REGULATOR; i++) | |
641 | regulator_unregister(tps->rdev[i]); | |
642 | ||
3fa5b8e0 AA |
643 | kfree(tps); |
644 | ||
645 | return 0; | |
646 | } | |
647 | ||
31dd6a26 | 648 | static struct platform_driver tps6507x_pmic_driver = { |
3fa5b8e0 | 649 | .driver = { |
31dd6a26 | 650 | .name = "tps6507x-pmic", |
3fa5b8e0 AA |
651 | .owner = THIS_MODULE, |
652 | }, | |
4ce5ba5b TF |
653 | .probe = tps6507x_pmic_probe, |
654 | .remove = __devexit_p(tps6507x_pmic_remove), | |
3fa5b8e0 AA |
655 | }; |
656 | ||
657 | /** | |
4ce5ba5b | 658 | * tps6507x_pmic_init |
3fa5b8e0 AA |
659 | * |
660 | * Module init function | |
661 | */ | |
4ce5ba5b | 662 | static int __init tps6507x_pmic_init(void) |
3fa5b8e0 | 663 | { |
31dd6a26 | 664 | return platform_driver_register(&tps6507x_pmic_driver); |
3fa5b8e0 | 665 | } |
4ce5ba5b | 666 | subsys_initcall(tps6507x_pmic_init); |
3fa5b8e0 AA |
667 | |
668 | /** | |
4ce5ba5b | 669 | * tps6507x_pmic_cleanup |
3fa5b8e0 AA |
670 | * |
671 | * Module exit function | |
672 | */ | |
4ce5ba5b | 673 | static void __exit tps6507x_pmic_cleanup(void) |
3fa5b8e0 | 674 | { |
31dd6a26 | 675 | platform_driver_unregister(&tps6507x_pmic_driver); |
3fa5b8e0 | 676 | } |
4ce5ba5b | 677 | module_exit(tps6507x_pmic_cleanup); |
3fa5b8e0 AA |
678 | |
679 | MODULE_AUTHOR("Texas Instruments"); | |
680 | MODULE_DESCRIPTION("TPS6507x voltage regulator driver"); | |
9e108d33 | 681 | MODULE_LICENSE("GPL v2"); |
31dd6a26 | 682 | MODULE_ALIAS("platform:tps6507x-pmic"); |