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 | ||
3fa5b8e0 AA |
93 | struct tps_info { |
94 | const char *name; | |
95 | unsigned min_uV; | |
96 | unsigned max_uV; | |
97 | u8 table_len; | |
98 | const u16 *table; | |
7d14831e AA |
99 | |
100 | /* Does DCDC high or the low register defines output voltage? */ | |
101 | bool defdcdc_default; | |
3fa5b8e0 AA |
102 | }; |
103 | ||
7d14831e | 104 | static struct tps_info tps6507x_pmic_regs[] = { |
31dd6a26 TF |
105 | { |
106 | .name = "VDCDC1", | |
107 | .min_uV = 725000, | |
108 | .max_uV = 3300000, | |
109 | .table_len = ARRAY_SIZE(VDCDCx_VSEL_table), | |
110 | .table = VDCDCx_VSEL_table, | |
111 | }, | |
112 | { | |
113 | .name = "VDCDC2", | |
114 | .min_uV = 725000, | |
115 | .max_uV = 3300000, | |
116 | .table_len = ARRAY_SIZE(VDCDCx_VSEL_table), | |
117 | .table = VDCDCx_VSEL_table, | |
118 | }, | |
119 | { | |
120 | .name = "VDCDC3", | |
121 | .min_uV = 725000, | |
122 | .max_uV = 3300000, | |
123 | .table_len = ARRAY_SIZE(VDCDCx_VSEL_table), | |
124 | .table = VDCDCx_VSEL_table, | |
125 | }, | |
126 | { | |
127 | .name = "LDO1", | |
128 | .min_uV = 1000000, | |
129 | .max_uV = 3300000, | |
130 | .table_len = ARRAY_SIZE(LDO1_VSEL_table), | |
131 | .table = LDO1_VSEL_table, | |
132 | }, | |
133 | { | |
134 | .name = "LDO2", | |
135 | .min_uV = 725000, | |
136 | .max_uV = 3300000, | |
137 | .table_len = ARRAY_SIZE(LDO2_VSEL_table), | |
138 | .table = LDO2_VSEL_table, | |
139 | }, | |
140 | }; | |
141 | ||
4ce5ba5b | 142 | struct tps6507x_pmic { |
3fa5b8e0 | 143 | struct regulator_desc desc[TPS6507X_NUM_REGULATOR]; |
31dd6a26 | 144 | struct tps6507x_dev *mfd; |
3fa5b8e0 | 145 | struct regulator_dev *rdev[TPS6507X_NUM_REGULATOR]; |
7d14831e | 146 | struct tps_info *info[TPS6507X_NUM_REGULATOR]; |
3fa5b8e0 AA |
147 | struct mutex io_lock; |
148 | }; | |
4ce5ba5b | 149 | static inline int tps6507x_pmic_read(struct tps6507x_pmic *tps, u8 reg) |
3fa5b8e0 | 150 | { |
31dd6a26 TF |
151 | u8 val; |
152 | int err; | |
153 | ||
154 | err = tps->mfd->read_dev(tps->mfd, reg, 1, &val); | |
155 | ||
156 | if (err) | |
157 | return err; | |
158 | ||
159 | return val; | |
3fa5b8e0 AA |
160 | } |
161 | ||
4ce5ba5b | 162 | static inline int tps6507x_pmic_write(struct tps6507x_pmic *tps, u8 reg, u8 val) |
3fa5b8e0 | 163 | { |
31dd6a26 | 164 | return tps->mfd->write_dev(tps->mfd, reg, 1, &val); |
3fa5b8e0 AA |
165 | } |
166 | ||
4ce5ba5b | 167 | static int tps6507x_pmic_set_bits(struct tps6507x_pmic *tps, u8 reg, u8 mask) |
3fa5b8e0 AA |
168 | { |
169 | int err, data; | |
170 | ||
171 | mutex_lock(&tps->io_lock); | |
172 | ||
4ce5ba5b | 173 | data = tps6507x_pmic_read(tps, reg); |
3fa5b8e0 | 174 | if (data < 0) { |
31dd6a26 | 175 | dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg); |
3fa5b8e0 AA |
176 | err = data; |
177 | goto out; | |
178 | } | |
179 | ||
180 | data |= mask; | |
4ce5ba5b | 181 | err = tps6507x_pmic_write(tps, reg, data); |
3fa5b8e0 | 182 | if (err) |
31dd6a26 | 183 | dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg); |
3fa5b8e0 AA |
184 | |
185 | out: | |
186 | mutex_unlock(&tps->io_lock); | |
187 | return err; | |
188 | } | |
189 | ||
4ce5ba5b | 190 | static int tps6507x_pmic_clear_bits(struct tps6507x_pmic *tps, u8 reg, u8 mask) |
3fa5b8e0 AA |
191 | { |
192 | int err, data; | |
193 | ||
194 | mutex_lock(&tps->io_lock); | |
195 | ||
4ce5ba5b | 196 | data = tps6507x_pmic_read(tps, reg); |
3fa5b8e0 | 197 | if (data < 0) { |
31dd6a26 | 198 | dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg); |
3fa5b8e0 AA |
199 | err = data; |
200 | goto out; | |
201 | } | |
202 | ||
203 | data &= ~mask; | |
4ce5ba5b | 204 | err = tps6507x_pmic_write(tps, reg, data); |
3fa5b8e0 | 205 | if (err) |
31dd6a26 | 206 | dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg); |
3fa5b8e0 AA |
207 | |
208 | out: | |
209 | mutex_unlock(&tps->io_lock); | |
210 | return err; | |
211 | } | |
212 | ||
4ce5ba5b | 213 | static int tps6507x_pmic_reg_read(struct tps6507x_pmic *tps, u8 reg) |
3fa5b8e0 AA |
214 | { |
215 | int data; | |
216 | ||
217 | mutex_lock(&tps->io_lock); | |
218 | ||
4ce5ba5b | 219 | data = tps6507x_pmic_read(tps, reg); |
3fa5b8e0 | 220 | if (data < 0) |
31dd6a26 | 221 | dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg); |
3fa5b8e0 AA |
222 | |
223 | mutex_unlock(&tps->io_lock); | |
224 | return data; | |
225 | } | |
226 | ||
4ce5ba5b | 227 | static int tps6507x_pmic_reg_write(struct tps6507x_pmic *tps, u8 reg, u8 val) |
3fa5b8e0 AA |
228 | { |
229 | int err; | |
230 | ||
231 | mutex_lock(&tps->io_lock); | |
232 | ||
4ce5ba5b | 233 | err = tps6507x_pmic_write(tps, reg, val); |
3fa5b8e0 | 234 | if (err < 0) |
31dd6a26 | 235 | dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg); |
3fa5b8e0 AA |
236 | |
237 | mutex_unlock(&tps->io_lock); | |
238 | return err; | |
239 | } | |
240 | ||
f2933d33 | 241 | static int tps6507x_pmic_is_enabled(struct regulator_dev *dev) |
3fa5b8e0 | 242 | { |
4ce5ba5b | 243 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
f2933d33 | 244 | int data, rid = rdev_get_id(dev); |
3fa5b8e0 AA |
245 | u8 shift; |
246 | ||
f2933d33 | 247 | if (rid < TPS6507X_DCDC_1 || rid > TPS6507X_LDO_2) |
3fa5b8e0 AA |
248 | return -EINVAL; |
249 | ||
f2933d33 | 250 | shift = TPS6507X_MAX_REG_ID - rid; |
4ce5ba5b | 251 | data = tps6507x_pmic_reg_read(tps, TPS6507X_REG_CON_CTRL1); |
3fa5b8e0 AA |
252 | |
253 | if (data < 0) | |
254 | return data; | |
255 | else | |
256 | return (data & 1<<shift) ? 1 : 0; | |
257 | } | |
258 | ||
f2933d33 | 259 | static int tps6507x_pmic_enable(struct regulator_dev *dev) |
3fa5b8e0 | 260 | { |
4ce5ba5b | 261 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
f2933d33 | 262 | int rid = rdev_get_id(dev); |
3fa5b8e0 AA |
263 | u8 shift; |
264 | ||
f2933d33 | 265 | if (rid < TPS6507X_DCDC_1 || rid > TPS6507X_LDO_2) |
3fa5b8e0 AA |
266 | return -EINVAL; |
267 | ||
f2933d33 | 268 | shift = TPS6507X_MAX_REG_ID - rid; |
4ce5ba5b | 269 | return tps6507x_pmic_set_bits(tps, TPS6507X_REG_CON_CTRL1, 1 << shift); |
3fa5b8e0 AA |
270 | } |
271 | ||
f2933d33 | 272 | static int tps6507x_pmic_disable(struct regulator_dev *dev) |
3fa5b8e0 | 273 | { |
4ce5ba5b | 274 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
f2933d33 | 275 | int rid = rdev_get_id(dev); |
3fa5b8e0 AA |
276 | u8 shift; |
277 | ||
f2933d33 | 278 | if (rid < TPS6507X_DCDC_1 || rid > TPS6507X_LDO_2) |
3fa5b8e0 AA |
279 | return -EINVAL; |
280 | ||
f2933d33 | 281 | shift = TPS6507X_MAX_REG_ID - rid; |
4ce5ba5b TF |
282 | return tps6507x_pmic_clear_bits(tps, TPS6507X_REG_CON_CTRL1, |
283 | 1 << shift); | |
3fa5b8e0 AA |
284 | } |
285 | ||
f2933d33 | 286 | static int tps6507x_pmic_get_voltage(struct regulator_dev *dev) |
3fa5b8e0 | 287 | { |
4ce5ba5b | 288 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
f2933d33 AL |
289 | int data, rid = rdev_get_id(dev); |
290 | u8 reg, mask; | |
3fa5b8e0 | 291 | |
f2933d33 | 292 | switch (rid) { |
3fa5b8e0 AA |
293 | case TPS6507X_DCDC_1: |
294 | reg = TPS6507X_REG_DEFDCDC1; | |
f2933d33 | 295 | mask = TPS6507X_DEFDCDCX_DCDC_MASK; |
3fa5b8e0 AA |
296 | break; |
297 | case TPS6507X_DCDC_2: | |
f2933d33 | 298 | if (tps->info[rid]->defdcdc_default) |
7d14831e AA |
299 | reg = TPS6507X_REG_DEFDCDC2_HIGH; |
300 | else | |
301 | reg = TPS6507X_REG_DEFDCDC2_LOW; | |
f2933d33 | 302 | mask = TPS6507X_DEFDCDCX_DCDC_MASK; |
3fa5b8e0 AA |
303 | break; |
304 | case TPS6507X_DCDC_3: | |
f2933d33 | 305 | if (tps->info[rid]->defdcdc_default) |
7d14831e AA |
306 | reg = TPS6507X_REG_DEFDCDC3_HIGH; |
307 | else | |
308 | reg = TPS6507X_REG_DEFDCDC3_LOW; | |
f2933d33 AL |
309 | mask = TPS6507X_DEFDCDCX_DCDC_MASK; |
310 | break; | |
311 | case TPS6507X_LDO_1: | |
312 | reg = TPS6507X_REG_LDO_CTRL1; | |
313 | mask = TPS6507X_REG_LDO_CTRL1_LDO1_MASK; | |
314 | break; | |
315 | case TPS6507X_LDO_2: | |
316 | reg = TPS6507X_REG_DEFLDO2; | |
317 | mask = TPS6507X_REG_DEFLDO2_LDO2_MASK; | |
3fa5b8e0 AA |
318 | break; |
319 | default: | |
320 | return -EINVAL; | |
321 | } | |
322 | ||
4ce5ba5b | 323 | data = tps6507x_pmic_reg_read(tps, reg); |
3fa5b8e0 AA |
324 | if (data < 0) |
325 | return data; | |
326 | ||
f2933d33 AL |
327 | data &= mask; |
328 | return tps->info[rid]->table[data] * 1000; | |
3fa5b8e0 AA |
329 | } |
330 | ||
ca61a7bf AL |
331 | static int tps6507x_pmic_set_voltage_sel(struct regulator_dev *dev, |
332 | unsigned selector) | |
3fa5b8e0 | 333 | { |
4ce5ba5b | 334 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
ca61a7bf | 335 | int data, rid = rdev_get_id(dev); |
f2933d33 | 336 | u8 reg, mask; |
3fa5b8e0 | 337 | |
f2933d33 | 338 | switch (rid) { |
3fa5b8e0 AA |
339 | case TPS6507X_DCDC_1: |
340 | reg = TPS6507X_REG_DEFDCDC1; | |
f2933d33 | 341 | mask = TPS6507X_DEFDCDCX_DCDC_MASK; |
3fa5b8e0 AA |
342 | break; |
343 | case TPS6507X_DCDC_2: | |
f2933d33 | 344 | if (tps->info[rid]->defdcdc_default) |
7d14831e AA |
345 | reg = TPS6507X_REG_DEFDCDC2_HIGH; |
346 | else | |
347 | reg = TPS6507X_REG_DEFDCDC2_LOW; | |
f2933d33 | 348 | mask = TPS6507X_DEFDCDCX_DCDC_MASK; |
3fa5b8e0 AA |
349 | break; |
350 | case TPS6507X_DCDC_3: | |
f2933d33 | 351 | if (tps->info[rid]->defdcdc_default) |
7d14831e AA |
352 | reg = TPS6507X_REG_DEFDCDC3_HIGH; |
353 | else | |
354 | reg = TPS6507X_REG_DEFDCDC3_LOW; | |
f2933d33 AL |
355 | mask = TPS6507X_DEFDCDCX_DCDC_MASK; |
356 | break; | |
357 | case TPS6507X_LDO_1: | |
358 | reg = TPS6507X_REG_LDO_CTRL1; | |
359 | mask = TPS6507X_REG_LDO_CTRL1_LDO1_MASK; | |
360 | break; | |
361 | case TPS6507X_LDO_2: | |
362 | reg = TPS6507X_REG_DEFLDO2; | |
363 | mask = TPS6507X_REG_DEFLDO2_LDO2_MASK; | |
3fa5b8e0 AA |
364 | break; |
365 | default: | |
366 | return -EINVAL; | |
367 | } | |
368 | ||
4ce5ba5b | 369 | data = tps6507x_pmic_reg_read(tps, reg); |
3fa5b8e0 AA |
370 | if (data < 0) |
371 | return data; | |
372 | ||
373 | data &= ~mask; | |
ca61a7bf | 374 | data |= selector; |
3fa5b8e0 | 375 | |
4ce5ba5b | 376 | return tps6507x_pmic_reg_write(tps, reg, data); |
3fa5b8e0 AA |
377 | } |
378 | ||
f2933d33 | 379 | static int tps6507x_pmic_list_voltage(struct regulator_dev *dev, |
3fa5b8e0 AA |
380 | unsigned selector) |
381 | { | |
4ce5ba5b | 382 | struct tps6507x_pmic *tps = rdev_get_drvdata(dev); |
f2933d33 | 383 | int rid = rdev_get_id(dev); |
3fa5b8e0 | 384 | |
f2933d33 | 385 | if (rid < TPS6507X_DCDC_1 || rid > TPS6507X_LDO_2) |
3fa5b8e0 AA |
386 | return -EINVAL; |
387 | ||
f2933d33 | 388 | if (selector >= tps->info[rid]->table_len) |
3fa5b8e0 AA |
389 | return -EINVAL; |
390 | else | |
f2933d33 | 391 | return tps->info[rid]->table[selector] * 1000; |
3fa5b8e0 AA |
392 | } |
393 | ||
f2933d33 AL |
394 | static struct regulator_ops tps6507x_pmic_ops = { |
395 | .is_enabled = tps6507x_pmic_is_enabled, | |
396 | .enable = tps6507x_pmic_enable, | |
397 | .disable = tps6507x_pmic_disable, | |
398 | .get_voltage = tps6507x_pmic_get_voltage, | |
ca61a7bf | 399 | .set_voltage_sel = tps6507x_pmic_set_voltage_sel, |
f2933d33 | 400 | .list_voltage = tps6507x_pmic_list_voltage, |
3fa5b8e0 AA |
401 | }; |
402 | ||
f2933d33 | 403 | static __devinit int tps6507x_pmic_probe(struct platform_device *pdev) |
3fa5b8e0 | 404 | { |
31dd6a26 | 405 | struct tps6507x_dev *tps6507x_dev = dev_get_drvdata(pdev->dev.parent); |
7d14831e | 406 | struct tps_info *info = &tps6507x_pmic_regs[0]; |
c172708d | 407 | struct regulator_config config = { }; |
3fa5b8e0 AA |
408 | struct regulator_init_data *init_data; |
409 | struct regulator_dev *rdev; | |
4ce5ba5b | 410 | struct tps6507x_pmic *tps; |
0bc20bba | 411 | struct tps6507x_board *tps_board; |
3fa5b8e0 | 412 | int i; |
56c23492 | 413 | int error; |
3fa5b8e0 | 414 | |
0bc20bba TF |
415 | /** |
416 | * tps_board points to pmic related constants | |
417 | * coming from the board-evm file. | |
418 | */ | |
419 | ||
31dd6a26 | 420 | tps_board = dev_get_platdata(tps6507x_dev->dev); |
0bc20bba TF |
421 | if (!tps_board) |
422 | return -EINVAL; | |
423 | ||
3fa5b8e0 AA |
424 | /** |
425 | * init_data points to array of regulator_init structures | |
426 | * coming from the board-evm file. | |
427 | */ | |
0bc20bba | 428 | init_data = tps_board->tps6507x_pmic_init_data; |
3fa5b8e0 | 429 | if (!init_data) |
0bc20bba | 430 | return -EINVAL; |
3fa5b8e0 AA |
431 | |
432 | tps = kzalloc(sizeof(*tps), GFP_KERNEL); | |
433 | if (!tps) | |
434 | return -ENOMEM; | |
435 | ||
436 | mutex_init(&tps->io_lock); | |
437 | ||
438 | /* common for all regulators */ | |
31dd6a26 | 439 | tps->mfd = tps6507x_dev; |
3fa5b8e0 AA |
440 | |
441 | for (i = 0; i < TPS6507X_NUM_REGULATOR; i++, info++, init_data++) { | |
442 | /* Register the regulators */ | |
443 | tps->info[i] = info; | |
7d14831e AA |
444 | if (init_data->driver_data) { |
445 | struct tps6507x_reg_platform_data *data = | |
446 | init_data->driver_data; | |
447 | tps->info[i]->defdcdc_default = data->defdcdc_default; | |
448 | } | |
449 | ||
3fa5b8e0 | 450 | tps->desc[i].name = info->name; |
77fa44d0 | 451 | tps->desc[i].id = i; |
0fcdb109 | 452 | tps->desc[i].n_voltages = info->table_len; |
f2933d33 | 453 | tps->desc[i].ops = &tps6507x_pmic_ops; |
3fa5b8e0 AA |
454 | tps->desc[i].type = REGULATOR_VOLTAGE; |
455 | tps->desc[i].owner = THIS_MODULE; | |
456 | ||
c172708d MB |
457 | config.dev = tps6507x_dev->dev; |
458 | config.init_data = init_data; | |
459 | config.driver_data = tps; | |
460 | ||
461 | rdev = regulator_register(&tps->desc[i], &config); | |
3fa5b8e0 | 462 | if (IS_ERR(rdev)) { |
31dd6a26 TF |
463 | dev_err(tps6507x_dev->dev, |
464 | "failed to register %s regulator\n", | |
465 | pdev->name); | |
56c23492 DT |
466 | error = PTR_ERR(rdev); |
467 | goto fail; | |
3fa5b8e0 AA |
468 | } |
469 | ||
470 | /* Save regulator for cleanup */ | |
471 | tps->rdev[i] = rdev; | |
472 | } | |
473 | ||
31dd6a26 | 474 | tps6507x_dev->pmic = tps; |
d7399fa8 | 475 | platform_set_drvdata(pdev, tps6507x_dev); |
3fa5b8e0 AA |
476 | |
477 | return 0; | |
56c23492 DT |
478 | |
479 | fail: | |
480 | while (--i >= 0) | |
481 | regulator_unregister(tps->rdev[i]); | |
482 | ||
483 | kfree(tps); | |
484 | return error; | |
3fa5b8e0 AA |
485 | } |
486 | ||
31dd6a26 | 487 | static int __devexit tps6507x_pmic_remove(struct platform_device *pdev) |
3fa5b8e0 | 488 | { |
31dd6a26 TF |
489 | struct tps6507x_dev *tps6507x_dev = platform_get_drvdata(pdev); |
490 | struct tps6507x_pmic *tps = tps6507x_dev->pmic; | |
3fa5b8e0 AA |
491 | int i; |
492 | ||
493 | for (i = 0; i < TPS6507X_NUM_REGULATOR; i++) | |
494 | regulator_unregister(tps->rdev[i]); | |
495 | ||
3fa5b8e0 AA |
496 | kfree(tps); |
497 | ||
498 | return 0; | |
499 | } | |
500 | ||
31dd6a26 | 501 | static struct platform_driver tps6507x_pmic_driver = { |
3fa5b8e0 | 502 | .driver = { |
31dd6a26 | 503 | .name = "tps6507x-pmic", |
3fa5b8e0 AA |
504 | .owner = THIS_MODULE, |
505 | }, | |
4ce5ba5b TF |
506 | .probe = tps6507x_pmic_probe, |
507 | .remove = __devexit_p(tps6507x_pmic_remove), | |
3fa5b8e0 AA |
508 | }; |
509 | ||
4ce5ba5b | 510 | static int __init tps6507x_pmic_init(void) |
3fa5b8e0 | 511 | { |
31dd6a26 | 512 | return platform_driver_register(&tps6507x_pmic_driver); |
3fa5b8e0 | 513 | } |
4ce5ba5b | 514 | subsys_initcall(tps6507x_pmic_init); |
3fa5b8e0 | 515 | |
4ce5ba5b | 516 | static void __exit tps6507x_pmic_cleanup(void) |
3fa5b8e0 | 517 | { |
31dd6a26 | 518 | platform_driver_unregister(&tps6507x_pmic_driver); |
3fa5b8e0 | 519 | } |
4ce5ba5b | 520 | module_exit(tps6507x_pmic_cleanup); |
3fa5b8e0 AA |
521 | |
522 | MODULE_AUTHOR("Texas Instruments"); | |
523 | MODULE_DESCRIPTION("TPS6507x voltage regulator driver"); | |
9e108d33 | 524 | MODULE_LICENSE("GPL v2"); |
31dd6a26 | 525 | MODULE_ALIAS("platform:tps6507x-pmic"); |