Commit | Line | Data |
---|---|---|
c789ca20 SI |
1 | /* |
2 | * Copyright (C) ST-Ericsson SA 2010 | |
3 | * | |
4 | * License Terms: GNU General Public License v2 | |
5 | * | |
e1159e6d BJ |
6 | * Authors: Sundar Iyer <sundar.iyer@stericsson.com> for ST-Ericsson |
7 | * Bengt Jonsson <bengt.g.jonsson@stericsson.com> for ST-Ericsson | |
c789ca20 SI |
8 | * |
9 | * AB8500 peripheral regulators | |
10 | * | |
e1159e6d | 11 | * AB8500 supports the following regulators: |
ea05ef31 | 12 | * VAUX1/2/3, VINTCORE, VTVOUT, VUSB, VAUDIO, VAMIC1/2, VDMIC, VANA |
c789ca20 SI |
13 | */ |
14 | #include <linux/init.h> | |
15 | #include <linux/kernel.h> | |
65602c32 | 16 | #include <linux/module.h> |
c789ca20 SI |
17 | #include <linux/err.h> |
18 | #include <linux/platform_device.h> | |
47c16975 | 19 | #include <linux/mfd/abx500.h> |
ee66e653 | 20 | #include <linux/mfd/abx500/ab8500.h> |
3a8334b9 LJ |
21 | #include <linux/of.h> |
22 | #include <linux/regulator/of_regulator.h> | |
c789ca20 SI |
23 | #include <linux/regulator/driver.h> |
24 | #include <linux/regulator/machine.h> | |
25 | #include <linux/regulator/ab8500.h> | |
3a8334b9 | 26 | #include <linux/slab.h> |
c789ca20 SI |
27 | |
28 | /** | |
29 | * struct ab8500_regulator_info - ab8500 regulator information | |
e1159e6d | 30 | * @dev: device pointer |
c789ca20 | 31 | * @desc: regulator description |
c789ca20 | 32 | * @regulator_dev: regulator device |
bd28a157 | 33 | * @is_enabled: status of regulator (on/off) |
7ce4669c | 34 | * @load_lp_uA: maximum load in idle (low power) mode |
47c16975 | 35 | * @update_bank: bank to control on/off |
c789ca20 | 36 | * @update_reg: register to control on/off |
bd28a157 EV |
37 | * @update_mask: mask to enable/disable and set mode of regulator |
38 | * @update_val: bits holding the regulator current mode | |
39 | * @update_val_idle: bits to enable the regulator in idle (low power) mode | |
40 | * @update_val_normal: bits to enable the regulator in normal (high power) mode | |
47c16975 | 41 | * @voltage_bank: bank to control regulator voltage |
c789ca20 SI |
42 | * @voltage_reg: register to control regulator voltage |
43 | * @voltage_mask: mask to control regulator voltage | |
a0a7014c | 44 | * @voltage_shift: shift to control regulator voltage |
42ab616a | 45 | * @delay: startup/set voltage delay in us |
c789ca20 SI |
46 | */ |
47 | struct ab8500_regulator_info { | |
48 | struct device *dev; | |
49 | struct regulator_desc desc; | |
c789ca20 | 50 | struct regulator_dev *regulator; |
bd28a157 | 51 | bool is_enabled; |
7ce4669c | 52 | int load_lp_uA; |
47c16975 MW |
53 | u8 update_bank; |
54 | u8 update_reg; | |
e1159e6d | 55 | u8 update_mask; |
bd28a157 EV |
56 | u8 update_val; |
57 | u8 update_val_idle; | |
58 | u8 update_val_normal; | |
47c16975 MW |
59 | u8 voltage_bank; |
60 | u8 voltage_reg; | |
61 | u8 voltage_mask; | |
a0a7014c | 62 | u8 voltage_shift; |
42ab616a | 63 | unsigned int delay; |
c789ca20 SI |
64 | }; |
65 | ||
66 | /* voltage tables for the vauxn/vintcore supplies */ | |
ec1cc4d9 | 67 | static const unsigned int ldo_vauxn_voltages[] = { |
c789ca20 SI |
68 | 1100000, |
69 | 1200000, | |
70 | 1300000, | |
71 | 1400000, | |
72 | 1500000, | |
73 | 1800000, | |
74 | 1850000, | |
75 | 1900000, | |
76 | 2500000, | |
77 | 2650000, | |
78 | 2700000, | |
79 | 2750000, | |
80 | 2800000, | |
81 | 2900000, | |
82 | 3000000, | |
83 | 3300000, | |
84 | }; | |
85 | ||
ec1cc4d9 | 86 | static const unsigned int ldo_vaux3_voltages[] = { |
2b75151a BJ |
87 | 1200000, |
88 | 1500000, | |
89 | 1800000, | |
90 | 2100000, | |
91 | 2500000, | |
92 | 2750000, | |
93 | 2790000, | |
94 | 2910000, | |
95 | }; | |
96 | ||
ec1cc4d9 | 97 | static const unsigned int ldo_vintcore_voltages[] = { |
c789ca20 SI |
98 | 1200000, |
99 | 1225000, | |
100 | 1250000, | |
101 | 1275000, | |
102 | 1300000, | |
103 | 1325000, | |
104 | 1350000, | |
105 | }; | |
106 | ||
107 | static int ab8500_regulator_enable(struct regulator_dev *rdev) | |
108 | { | |
fc24b426 | 109 | int ret; |
c789ca20 SI |
110 | struct ab8500_regulator_info *info = rdev_get_drvdata(rdev); |
111 | ||
fc24b426 BJ |
112 | if (info == NULL) { |
113 | dev_err(rdev_get_dev(rdev), "regulator info null pointer\n"); | |
c789ca20 | 114 | return -EINVAL; |
fc24b426 | 115 | } |
c789ca20 | 116 | |
47c16975 | 117 | ret = abx500_mask_and_set_register_interruptible(info->dev, |
e1159e6d | 118 | info->update_bank, info->update_reg, |
bd28a157 | 119 | info->update_mask, info->update_val); |
c789ca20 SI |
120 | if (ret < 0) |
121 | dev_err(rdev_get_dev(rdev), | |
122 | "couldn't set enable bits for regulator\n"); | |
09aefa12 | 123 | |
bd28a157 EV |
124 | info->is_enabled = true; |
125 | ||
09aefa12 BJ |
126 | dev_vdbg(rdev_get_dev(rdev), |
127 | "%s-enable (bank, reg, mask, value): 0x%x, 0x%x, 0x%x, 0x%x\n", | |
128 | info->desc.name, info->update_bank, info->update_reg, | |
bd28a157 | 129 | info->update_mask, info->update_val); |
09aefa12 | 130 | |
c789ca20 SI |
131 | return ret; |
132 | } | |
133 | ||
134 | static int ab8500_regulator_disable(struct regulator_dev *rdev) | |
135 | { | |
fc24b426 | 136 | int ret; |
c789ca20 SI |
137 | struct ab8500_regulator_info *info = rdev_get_drvdata(rdev); |
138 | ||
fc24b426 BJ |
139 | if (info == NULL) { |
140 | dev_err(rdev_get_dev(rdev), "regulator info null pointer\n"); | |
c789ca20 | 141 | return -EINVAL; |
fc24b426 | 142 | } |
c789ca20 | 143 | |
47c16975 | 144 | ret = abx500_mask_and_set_register_interruptible(info->dev, |
e1159e6d BJ |
145 | info->update_bank, info->update_reg, |
146 | info->update_mask, 0x0); | |
c789ca20 SI |
147 | if (ret < 0) |
148 | dev_err(rdev_get_dev(rdev), | |
149 | "couldn't set disable bits for regulator\n"); | |
09aefa12 | 150 | |
bd28a157 EV |
151 | info->is_enabled = false; |
152 | ||
09aefa12 BJ |
153 | dev_vdbg(rdev_get_dev(rdev), |
154 | "%s-disable (bank, reg, mask, value): 0x%x, 0x%x, 0x%x, 0x%x\n", | |
155 | info->desc.name, info->update_bank, info->update_reg, | |
156 | info->update_mask, 0x0); | |
157 | ||
c789ca20 SI |
158 | return ret; |
159 | } | |
160 | ||
7ce4669c BJ |
161 | static unsigned int ab8500_regulator_get_optimum_mode( |
162 | struct regulator_dev *rdev, int input_uV, | |
163 | int output_uV, int load_uA) | |
164 | { | |
165 | unsigned int mode; | |
166 | ||
167 | struct ab8500_regulator_info *info = rdev_get_drvdata(rdev); | |
168 | ||
169 | if (info == NULL) { | |
170 | dev_err(rdev_get_dev(rdev), "regulator info null pointer\n"); | |
171 | return -EINVAL; | |
172 | } | |
173 | ||
174 | if (load_uA <= info->load_lp_uA) | |
175 | mode = REGULATOR_MODE_IDLE; | |
176 | else | |
177 | mode = REGULATOR_MODE_NORMAL; | |
178 | ||
179 | return mode; | |
180 | } | |
181 | ||
bd28a157 EV |
182 | static int ab8500_regulator_set_mode(struct regulator_dev *rdev, |
183 | unsigned int mode) | |
184 | { | |
185 | int ret = 0; | |
186 | ||
187 | struct ab8500_regulator_info *info = rdev_get_drvdata(rdev); | |
188 | ||
189 | if (info == NULL) { | |
190 | dev_err(rdev_get_dev(rdev), "regulator info null pointer\n"); | |
191 | return -EINVAL; | |
192 | } | |
193 | ||
194 | switch (mode) { | |
195 | case REGULATOR_MODE_NORMAL: | |
196 | info->update_val = info->update_val_normal; | |
197 | break; | |
198 | case REGULATOR_MODE_IDLE: | |
199 | info->update_val = info->update_val_idle; | |
200 | break; | |
201 | default: | |
202 | return -EINVAL; | |
203 | } | |
204 | ||
205 | if (info->is_enabled) { | |
206 | ret = abx500_mask_and_set_register_interruptible(info->dev, | |
207 | info->update_bank, info->update_reg, | |
208 | info->update_mask, info->update_val); | |
209 | if (ret < 0) | |
210 | dev_err(rdev_get_dev(rdev), | |
211 | "couldn't set regulator mode\n"); | |
7ce4669c BJ |
212 | |
213 | dev_vdbg(rdev_get_dev(rdev), | |
214 | "%s-set_mode (bank, reg, mask, value): " | |
215 | "0x%x, 0x%x, 0x%x, 0x%x\n", | |
216 | info->desc.name, info->update_bank, info->update_reg, | |
217 | info->update_mask, info->update_val); | |
bd28a157 EV |
218 | } |
219 | ||
220 | return ret; | |
221 | } | |
222 | ||
223 | static unsigned int ab8500_regulator_get_mode(struct regulator_dev *rdev) | |
224 | { | |
225 | struct ab8500_regulator_info *info = rdev_get_drvdata(rdev); | |
226 | int ret; | |
227 | ||
228 | if (info == NULL) { | |
229 | dev_err(rdev_get_dev(rdev), "regulator info null pointer\n"); | |
230 | return -EINVAL; | |
231 | } | |
232 | ||
233 | if (info->update_val == info->update_val_normal) | |
234 | ret = REGULATOR_MODE_NORMAL; | |
235 | else if (info->update_val == info->update_val_idle) | |
236 | ret = REGULATOR_MODE_IDLE; | |
237 | else | |
238 | ret = -EINVAL; | |
239 | ||
240 | return ret; | |
241 | } | |
242 | ||
c789ca20 SI |
243 | static int ab8500_regulator_is_enabled(struct regulator_dev *rdev) |
244 | { | |
fc24b426 | 245 | int ret; |
c789ca20 | 246 | struct ab8500_regulator_info *info = rdev_get_drvdata(rdev); |
09aefa12 | 247 | u8 regval; |
c789ca20 | 248 | |
fc24b426 BJ |
249 | if (info == NULL) { |
250 | dev_err(rdev_get_dev(rdev), "regulator info null pointer\n"); | |
c789ca20 | 251 | return -EINVAL; |
fc24b426 | 252 | } |
c789ca20 | 253 | |
47c16975 | 254 | ret = abx500_get_register_interruptible(info->dev, |
09aefa12 | 255 | info->update_bank, info->update_reg, ®val); |
c789ca20 SI |
256 | if (ret < 0) { |
257 | dev_err(rdev_get_dev(rdev), | |
258 | "couldn't read 0x%x register\n", info->update_reg); | |
259 | return ret; | |
260 | } | |
261 | ||
09aefa12 BJ |
262 | dev_vdbg(rdev_get_dev(rdev), |
263 | "%s-is_enabled (bank, reg, mask, value): 0x%x, 0x%x, 0x%x," | |
264 | " 0x%x\n", | |
265 | info->desc.name, info->update_bank, info->update_reg, | |
266 | info->update_mask, regval); | |
267 | ||
268 | if (regval & info->update_mask) | |
bd28a157 | 269 | info->is_enabled = true; |
c789ca20 | 270 | else |
bd28a157 EV |
271 | info->is_enabled = false; |
272 | ||
273 | return info->is_enabled; | |
c789ca20 SI |
274 | } |
275 | ||
3bf6e90e | 276 | static int ab8500_regulator_get_voltage_sel(struct regulator_dev *rdev) |
c789ca20 | 277 | { |
09aefa12 | 278 | int ret, val; |
c789ca20 | 279 | struct ab8500_regulator_info *info = rdev_get_drvdata(rdev); |
09aefa12 | 280 | u8 regval; |
c789ca20 | 281 | |
fc24b426 BJ |
282 | if (info == NULL) { |
283 | dev_err(rdev_get_dev(rdev), "regulator info null pointer\n"); | |
c789ca20 | 284 | return -EINVAL; |
fc24b426 | 285 | } |
c789ca20 | 286 | |
09aefa12 BJ |
287 | ret = abx500_get_register_interruptible(info->dev, |
288 | info->voltage_bank, info->voltage_reg, ®val); | |
c789ca20 SI |
289 | if (ret < 0) { |
290 | dev_err(rdev_get_dev(rdev), | |
291 | "couldn't read voltage reg for regulator\n"); | |
292 | return ret; | |
293 | } | |
294 | ||
09aefa12 | 295 | dev_vdbg(rdev_get_dev(rdev), |
a0a7014c LW |
296 | "%s-get_voltage (bank, reg, mask, shift, value): " |
297 | "0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n", | |
298 | info->desc.name, info->voltage_bank, | |
299 | info->voltage_reg, info->voltage_mask, | |
300 | info->voltage_shift, regval); | |
09aefa12 | 301 | |
09aefa12 | 302 | val = regval & info->voltage_mask; |
a0a7014c | 303 | return val >> info->voltage_shift; |
c789ca20 SI |
304 | } |
305 | ||
ae713d39 AL |
306 | static int ab8500_regulator_set_voltage_sel(struct regulator_dev *rdev, |
307 | unsigned selector) | |
c789ca20 | 308 | { |
fc24b426 | 309 | int ret; |
c789ca20 | 310 | struct ab8500_regulator_info *info = rdev_get_drvdata(rdev); |
09aefa12 | 311 | u8 regval; |
c789ca20 | 312 | |
fc24b426 BJ |
313 | if (info == NULL) { |
314 | dev_err(rdev_get_dev(rdev), "regulator info null pointer\n"); | |
c789ca20 | 315 | return -EINVAL; |
fc24b426 | 316 | } |
c789ca20 | 317 | |
c789ca20 | 318 | /* set the registers for the request */ |
a0a7014c | 319 | regval = (u8)selector << info->voltage_shift; |
47c16975 | 320 | ret = abx500_mask_and_set_register_interruptible(info->dev, |
09aefa12 BJ |
321 | info->voltage_bank, info->voltage_reg, |
322 | info->voltage_mask, regval); | |
c789ca20 SI |
323 | if (ret < 0) |
324 | dev_err(rdev_get_dev(rdev), | |
325 | "couldn't set voltage reg for regulator\n"); | |
326 | ||
09aefa12 BJ |
327 | dev_vdbg(rdev_get_dev(rdev), |
328 | "%s-set_voltage (bank, reg, mask, value): 0x%x, 0x%x, 0x%x," | |
329 | " 0x%x\n", | |
330 | info->desc.name, info->voltage_bank, info->voltage_reg, | |
331 | info->voltage_mask, regval); | |
332 | ||
c789ca20 SI |
333 | return ret; |
334 | } | |
335 | ||
42ab616a LW |
336 | static int ab8500_regulator_set_voltage_time_sel(struct regulator_dev *rdev, |
337 | unsigned int old_sel, | |
338 | unsigned int new_sel) | |
339 | { | |
340 | struct ab8500_regulator_info *info = rdev_get_drvdata(rdev); | |
42ab616a | 341 | |
42ab616a LW |
342 | return info->delay; |
343 | } | |
344 | ||
7ce4669c BJ |
345 | static struct regulator_ops ab8500_regulator_volt_mode_ops = { |
346 | .enable = ab8500_regulator_enable, | |
347 | .disable = ab8500_regulator_disable, | |
348 | .is_enabled = ab8500_regulator_is_enabled, | |
349 | .get_optimum_mode = ab8500_regulator_get_optimum_mode, | |
350 | .set_mode = ab8500_regulator_set_mode, | |
351 | .get_mode = ab8500_regulator_get_mode, | |
352 | .get_voltage_sel = ab8500_regulator_get_voltage_sel, | |
353 | .set_voltage_sel = ab8500_regulator_set_voltage_sel, | |
354 | .list_voltage = regulator_list_voltage_table, | |
355 | .set_voltage_time_sel = ab8500_regulator_set_voltage_time_sel, | |
c789ca20 SI |
356 | }; |
357 | ||
7ce4669c BJ |
358 | static struct regulator_ops ab8500_regulator_mode_ops = { |
359 | .enable = ab8500_regulator_enable, | |
360 | .disable = ab8500_regulator_disable, | |
361 | .is_enabled = ab8500_regulator_is_enabled, | |
362 | .get_optimum_mode = ab8500_regulator_get_optimum_mode, | |
363 | .set_mode = ab8500_regulator_set_mode, | |
364 | .get_mode = ab8500_regulator_get_mode, | |
365 | .get_voltage_sel = ab8500_regulator_get_voltage_sel, | |
366 | .list_voltage = regulator_list_voltage_table, | |
367 | .set_voltage_time_sel = ab8500_regulator_set_voltage_time_sel, | |
368 | }; | |
369 | ||
370 | static struct regulator_ops ab8500_regulator_ops = { | |
371 | .enable = ab8500_regulator_enable, | |
372 | .disable = ab8500_regulator_disable, | |
373 | .is_enabled = ab8500_regulator_is_enabled, | |
374 | .get_voltage_sel = ab8500_regulator_get_voltage_sel, | |
375 | .list_voltage = regulator_list_voltage_table, | |
c789ca20 SI |
376 | }; |
377 | ||
6909b452 BJ |
378 | static struct ab8500_regulator_info |
379 | ab8500_regulator_info[AB8500_NUM_REGULATORS] = { | |
c789ca20 | 380 | /* |
e1159e6d BJ |
381 | * Variable Voltage Regulators |
382 | * name, min mV, max mV, | |
383 | * update bank, reg, mask, enable val | |
ec1cc4d9 | 384 | * volt bank, reg, mask |
c789ca20 | 385 | */ |
6909b452 BJ |
386 | [AB8500_LDO_AUX1] = { |
387 | .desc = { | |
388 | .name = "LDO-AUX1", | |
7ce4669c | 389 | .ops = &ab8500_regulator_volt_mode_ops, |
6909b452 BJ |
390 | .type = REGULATOR_VOLTAGE, |
391 | .id = AB8500_LDO_AUX1, | |
392 | .owner = THIS_MODULE, | |
393 | .n_voltages = ARRAY_SIZE(ldo_vauxn_voltages), | |
ec1cc4d9 | 394 | .volt_table = ldo_vauxn_voltages, |
6909b452 | 395 | }, |
7ce4669c | 396 | .load_lp_uA = 5000, |
6909b452 BJ |
397 | .update_bank = 0x04, |
398 | .update_reg = 0x09, | |
399 | .update_mask = 0x03, | |
bd28a157 EV |
400 | .update_val = 0x01, |
401 | .update_val_idle = 0x03, | |
402 | .update_val_normal = 0x01, | |
6909b452 BJ |
403 | .voltage_bank = 0x04, |
404 | .voltage_reg = 0x1f, | |
405 | .voltage_mask = 0x0f, | |
6909b452 BJ |
406 | }, |
407 | [AB8500_LDO_AUX2] = { | |
408 | .desc = { | |
409 | .name = "LDO-AUX2", | |
7ce4669c | 410 | .ops = &ab8500_regulator_volt_mode_ops, |
6909b452 BJ |
411 | .type = REGULATOR_VOLTAGE, |
412 | .id = AB8500_LDO_AUX2, | |
413 | .owner = THIS_MODULE, | |
414 | .n_voltages = ARRAY_SIZE(ldo_vauxn_voltages), | |
ec1cc4d9 | 415 | .volt_table = ldo_vauxn_voltages, |
6909b452 | 416 | }, |
7ce4669c | 417 | .load_lp_uA = 5000, |
6909b452 BJ |
418 | .update_bank = 0x04, |
419 | .update_reg = 0x09, | |
420 | .update_mask = 0x0c, | |
bd28a157 EV |
421 | .update_val = 0x04, |
422 | .update_val_idle = 0x0c, | |
423 | .update_val_normal = 0x04, | |
6909b452 BJ |
424 | .voltage_bank = 0x04, |
425 | .voltage_reg = 0x20, | |
426 | .voltage_mask = 0x0f, | |
6909b452 BJ |
427 | }, |
428 | [AB8500_LDO_AUX3] = { | |
429 | .desc = { | |
430 | .name = "LDO-AUX3", | |
7ce4669c | 431 | .ops = &ab8500_regulator_volt_mode_ops, |
6909b452 BJ |
432 | .type = REGULATOR_VOLTAGE, |
433 | .id = AB8500_LDO_AUX3, | |
434 | .owner = THIS_MODULE, | |
435 | .n_voltages = ARRAY_SIZE(ldo_vaux3_voltages), | |
ec1cc4d9 | 436 | .volt_table = ldo_vaux3_voltages, |
6909b452 | 437 | }, |
7ce4669c | 438 | .load_lp_uA = 5000, |
6909b452 BJ |
439 | .update_bank = 0x04, |
440 | .update_reg = 0x0a, | |
441 | .update_mask = 0x03, | |
bd28a157 EV |
442 | .update_val = 0x01, |
443 | .update_val_idle = 0x03, | |
444 | .update_val_normal = 0x01, | |
6909b452 BJ |
445 | .voltage_bank = 0x04, |
446 | .voltage_reg = 0x21, | |
447 | .voltage_mask = 0x07, | |
6909b452 BJ |
448 | }, |
449 | [AB8500_LDO_INTCORE] = { | |
450 | .desc = { | |
451 | .name = "LDO-INTCORE", | |
7ce4669c | 452 | .ops = &ab8500_regulator_volt_mode_ops, |
6909b452 BJ |
453 | .type = REGULATOR_VOLTAGE, |
454 | .id = AB8500_LDO_INTCORE, | |
455 | .owner = THIS_MODULE, | |
456 | .n_voltages = ARRAY_SIZE(ldo_vintcore_voltages), | |
ec1cc4d9 | 457 | .volt_table = ldo_vintcore_voltages, |
6909b452 | 458 | }, |
7ce4669c | 459 | .load_lp_uA = 5000, |
6909b452 BJ |
460 | .update_bank = 0x03, |
461 | .update_reg = 0x80, | |
462 | .update_mask = 0x44, | |
bd28a157 EV |
463 | .update_val = 0x04, |
464 | .update_val_idle = 0x44, | |
465 | .update_val_normal = 0x04, | |
6909b452 BJ |
466 | .voltage_bank = 0x03, |
467 | .voltage_reg = 0x80, | |
468 | .voltage_mask = 0x38, | |
a0a7014c | 469 | .voltage_shift = 3, |
6909b452 | 470 | }, |
c789ca20 SI |
471 | |
472 | /* | |
e1159e6d BJ |
473 | * Fixed Voltage Regulators |
474 | * name, fixed mV, | |
475 | * update bank, reg, mask, enable val | |
c789ca20 | 476 | */ |
6909b452 BJ |
477 | [AB8500_LDO_TVOUT] = { |
478 | .desc = { | |
479 | .name = "LDO-TVOUT", | |
7ce4669c | 480 | .ops = &ab8500_regulator_mode_ops, |
6909b452 BJ |
481 | .type = REGULATOR_VOLTAGE, |
482 | .id = AB8500_LDO_TVOUT, | |
483 | .owner = THIS_MODULE, | |
484 | .n_voltages = 1, | |
7142e213 | 485 | .min_uV = 2000000, |
7fee2afb | 486 | .enable_time = 10000, |
6909b452 | 487 | }, |
42ab616a | 488 | .delay = 10000, |
7ce4669c | 489 | .load_lp_uA = 1000, |
6909b452 BJ |
490 | .update_bank = 0x03, |
491 | .update_reg = 0x80, | |
492 | .update_mask = 0x82, | |
bd28a157 | 493 | .update_val = 0x02, |
7ce4669c BJ |
494 | .update_val_idle = 0x82, |
495 | .update_val_normal = 0x02, | |
6909b452 | 496 | }, |
328a5369 AL |
497 | |
498 | /* | |
499 | * Regulators with fixed voltage and normal mode | |
500 | */ | |
ea05ef31 BJ |
501 | [AB8500_LDO_USB] = { |
502 | .desc = { | |
503 | .name = "LDO-USB", | |
328a5369 | 504 | .ops = &ab8500_regulator_ops, |
ea05ef31 BJ |
505 | .type = REGULATOR_VOLTAGE, |
506 | .id = AB8500_LDO_USB, | |
507 | .owner = THIS_MODULE, | |
508 | .n_voltages = 1, | |
7142e213 | 509 | .min_uV = 3300000, |
ea05ef31 | 510 | }, |
ea05ef31 BJ |
511 | .update_bank = 0x03, |
512 | .update_reg = 0x82, | |
513 | .update_mask = 0x03, | |
ea05ef31 | 514 | }, |
6909b452 BJ |
515 | [AB8500_LDO_AUDIO] = { |
516 | .desc = { | |
517 | .name = "LDO-AUDIO", | |
7ce4669c | 518 | .ops = &ab8500_regulator_ops, |
6909b452 BJ |
519 | .type = REGULATOR_VOLTAGE, |
520 | .id = AB8500_LDO_AUDIO, | |
521 | .owner = THIS_MODULE, | |
522 | .n_voltages = 1, | |
7142e213 | 523 | .min_uV = 2000000, |
6909b452 | 524 | }, |
6909b452 BJ |
525 | .update_bank = 0x03, |
526 | .update_reg = 0x83, | |
527 | .update_mask = 0x02, | |
bd28a157 | 528 | .update_val = 0x02, |
6909b452 BJ |
529 | }, |
530 | [AB8500_LDO_ANAMIC1] = { | |
531 | .desc = { | |
532 | .name = "LDO-ANAMIC1", | |
7ce4669c | 533 | .ops = &ab8500_regulator_ops, |
6909b452 BJ |
534 | .type = REGULATOR_VOLTAGE, |
535 | .id = AB8500_LDO_ANAMIC1, | |
536 | .owner = THIS_MODULE, | |
537 | .n_voltages = 1, | |
7142e213 | 538 | .min_uV = 2050000, |
6909b452 | 539 | }, |
6909b452 BJ |
540 | .update_bank = 0x03, |
541 | .update_reg = 0x83, | |
542 | .update_mask = 0x08, | |
bd28a157 | 543 | .update_val = 0x08, |
6909b452 BJ |
544 | }, |
545 | [AB8500_LDO_ANAMIC2] = { | |
546 | .desc = { | |
547 | .name = "LDO-ANAMIC2", | |
7ce4669c | 548 | .ops = &ab8500_regulator_ops, |
6909b452 BJ |
549 | .type = REGULATOR_VOLTAGE, |
550 | .id = AB8500_LDO_ANAMIC2, | |
551 | .owner = THIS_MODULE, | |
552 | .n_voltages = 1, | |
7142e213 | 553 | .min_uV = 2050000, |
6909b452 | 554 | }, |
6909b452 BJ |
555 | .update_bank = 0x03, |
556 | .update_reg = 0x83, | |
557 | .update_mask = 0x10, | |
bd28a157 | 558 | .update_val = 0x10, |
6909b452 BJ |
559 | }, |
560 | [AB8500_LDO_DMIC] = { | |
561 | .desc = { | |
562 | .name = "LDO-DMIC", | |
7ce4669c | 563 | .ops = &ab8500_regulator_ops, |
6909b452 BJ |
564 | .type = REGULATOR_VOLTAGE, |
565 | .id = AB8500_LDO_DMIC, | |
566 | .owner = THIS_MODULE, | |
567 | .n_voltages = 1, | |
7142e213 | 568 | .min_uV = 1800000, |
6909b452 | 569 | }, |
6909b452 BJ |
570 | .update_bank = 0x03, |
571 | .update_reg = 0x83, | |
572 | .update_mask = 0x04, | |
bd28a157 | 573 | .update_val = 0x04, |
6909b452 | 574 | }, |
7ce4669c BJ |
575 | |
576 | /* | |
577 | * Regulators with fixed voltage and normal/idle modes | |
578 | */ | |
6909b452 BJ |
579 | [AB8500_LDO_ANA] = { |
580 | .desc = { | |
581 | .name = "LDO-ANA", | |
7ce4669c | 582 | .ops = &ab8500_regulator_mode_ops, |
6909b452 BJ |
583 | .type = REGULATOR_VOLTAGE, |
584 | .id = AB8500_LDO_ANA, | |
585 | .owner = THIS_MODULE, | |
586 | .n_voltages = 1, | |
7142e213 | 587 | .min_uV = 1200000, |
6909b452 | 588 | }, |
7ce4669c | 589 | .load_lp_uA = 1000, |
6909b452 BJ |
590 | .update_bank = 0x04, |
591 | .update_reg = 0x06, | |
592 | .update_mask = 0x0c, | |
bd28a157 | 593 | .update_val = 0x04, |
7ce4669c BJ |
594 | .update_val_idle = 0x0c, |
595 | .update_val_normal = 0x04, | |
6909b452 BJ |
596 | }, |
597 | ||
598 | ||
c789ca20 SI |
599 | }; |
600 | ||
79568b94 BJ |
601 | struct ab8500_reg_init { |
602 | u8 bank; | |
603 | u8 addr; | |
604 | u8 mask; | |
605 | }; | |
606 | ||
607 | #define REG_INIT(_id, _bank, _addr, _mask) \ | |
608 | [_id] = { \ | |
609 | .bank = _bank, \ | |
610 | .addr = _addr, \ | |
611 | .mask = _mask, \ | |
612 | } | |
613 | ||
614 | static struct ab8500_reg_init ab8500_reg_init[] = { | |
615 | /* | |
33bc8f46 LJ |
616 | * 0x03, VarmRequestCtrl |
617 | * 0x0c, VapeRequestCtrl | |
618 | * 0x30, Vsmps1RequestCtrl | |
619 | * 0xc0, Vsmps2RequestCtrl | |
620 | */ | |
621 | REG_INIT(AB8500_REGUREQUESTCTRL1, 0x03, 0x03, 0xff), | |
622 | /* | |
623 | * 0x03, Vsmps3RequestCtrl | |
d79df329 | 624 | * 0x0c, VpllRequestCtrl |
33bc8f46 | 625 | * 0x30, VanaRequestCtrl |
79568b94 BJ |
626 | * 0xc0, VextSupply1RequestCtrl |
627 | */ | |
33bc8f46 | 628 | REG_INIT(AB8500_REGUREQUESTCTRL2, 0x03, 0x04, 0xff), |
79568b94 BJ |
629 | /* |
630 | * 0x03, VextSupply2RequestCtrl | |
631 | * 0x0c, VextSupply3RequestCtrl | |
632 | * 0x30, Vaux1RequestCtrl | |
633 | * 0xc0, Vaux2RequestCtrl | |
634 | */ | |
635 | REG_INIT(AB8500_REGUREQUESTCTRL3, 0x03, 0x05, 0xff), | |
636 | /* | |
637 | * 0x03, Vaux3RequestCtrl | |
638 | * 0x04, SwHPReq | |
639 | */ | |
640 | REG_INIT(AB8500_REGUREQUESTCTRL4, 0x03, 0x06, 0x07), | |
641 | /* | |
d79df329 LJ |
642 | * 0x01, Vsmps1SysClkReq1HPValid |
643 | * 0x02, Vsmps2SysClkReq1HPValid | |
644 | * 0x04, Vsmps3SysClkReq1HPValid | |
79568b94 | 645 | * 0x08, VanaSysClkReq1HPValid |
d79df329 | 646 | * 0x10, VpllSysClkReq1HPValid |
79568b94 BJ |
647 | * 0x20, Vaux1SysClkReq1HPValid |
648 | * 0x40, Vaux2SysClkReq1HPValid | |
649 | * 0x80, Vaux3SysClkReq1HPValid | |
650 | */ | |
d79df329 | 651 | REG_INIT(AB8500_REGUSYSCLKREQ1HPVALID1, 0x03, 0x07, 0xff), |
79568b94 | 652 | /* |
33bc8f46 LJ |
653 | * 0x01, VapeSysClkReq1HPValid |
654 | * 0x02, VarmSysClkReq1HPValid | |
655 | * 0x04, VbbSysClkReq1HPValid | |
656 | * 0x08, VmodSysClkReq1HPValid | |
79568b94 BJ |
657 | * 0x10, VextSupply1SysClkReq1HPValid |
658 | * 0x20, VextSupply2SysClkReq1HPValid | |
659 | * 0x40, VextSupply3SysClkReq1HPValid | |
660 | */ | |
33bc8f46 | 661 | REG_INIT(AB8500_REGUSYSCLKREQ1HPVALID2, 0x03, 0x08, 0x7f), |
79568b94 | 662 | /* |
33bc8f46 LJ |
663 | * 0x01, Vsmps1HwHPReq1Valid |
664 | * 0x02, Vsmps2HwHPReq1Valid | |
665 | * 0x04, Vsmps3HwHPReq1Valid | |
79568b94 | 666 | * 0x08, VanaHwHPReq1Valid |
33bc8f46 | 667 | * 0x10, VpllHwHPReq1Valid |
79568b94 BJ |
668 | * 0x20, Vaux1HwHPReq1Valid |
669 | * 0x40, Vaux2HwHPReq1Valid | |
670 | * 0x80, Vaux3HwHPReq1Valid | |
671 | */ | |
33bc8f46 | 672 | REG_INIT(AB8500_REGUHWHPREQ1VALID1, 0x03, 0x09, 0xff), |
79568b94 BJ |
673 | /* |
674 | * 0x01, VextSupply1HwHPReq1Valid | |
675 | * 0x02, VextSupply2HwHPReq1Valid | |
676 | * 0x04, VextSupply3HwHPReq1Valid | |
33bc8f46 | 677 | * 0x08, VmodHwHPReq1Valid |
79568b94 | 678 | */ |
33bc8f46 | 679 | REG_INIT(AB8500_REGUHWHPREQ1VALID2, 0x03, 0x0a, 0x0f), |
79568b94 | 680 | /* |
33bc8f46 LJ |
681 | * 0x01, Vsmps1HwHPReq2Valid |
682 | * 0x02, Vsmps2HwHPReq2Valid | |
683 | * 0x03, Vsmps3HwHPReq2Valid | |
79568b94 | 684 | * 0x08, VanaHwHPReq2Valid |
33bc8f46 | 685 | * 0x10, VpllHwHPReq2Valid |
79568b94 BJ |
686 | * 0x20, Vaux1HwHPReq2Valid |
687 | * 0x40, Vaux2HwHPReq2Valid | |
688 | * 0x80, Vaux3HwHPReq2Valid | |
689 | */ | |
33bc8f46 | 690 | REG_INIT(AB8500_REGUHWHPREQ2VALID1, 0x03, 0x0b, 0xff), |
79568b94 BJ |
691 | /* |
692 | * 0x01, VextSupply1HwHPReq2Valid | |
693 | * 0x02, VextSupply2HwHPReq2Valid | |
694 | * 0x04, VextSupply3HwHPReq2Valid | |
33bc8f46 | 695 | * 0x08, VmodHwHPReq2Valid |
79568b94 | 696 | */ |
33bc8f46 | 697 | REG_INIT(AB8500_REGUHWHPREQ2VALID2, 0x03, 0x0c, 0x0f), |
79568b94 | 698 | /* |
33bc8f46 LJ |
699 | * 0x01, VapeSwHPReqValid |
700 | * 0x02, VarmSwHPReqValid | |
701 | * 0x04, Vsmps1SwHPReqValid | |
702 | * 0x08, Vsmps2SwHPReqValid | |
703 | * 0x10, Vsmps3SwHPReqValid | |
79568b94 | 704 | * 0x20, VanaSwHPReqValid |
33bc8f46 | 705 | * 0x40, VpllSwHPReqValid |
79568b94 BJ |
706 | * 0x80, Vaux1SwHPReqValid |
707 | */ | |
33bc8f46 | 708 | REG_INIT(AB8500_REGUSWHPREQVALID1, 0x03, 0x0d, 0xff), |
79568b94 BJ |
709 | /* |
710 | * 0x01, Vaux2SwHPReqValid | |
711 | * 0x02, Vaux3SwHPReqValid | |
712 | * 0x04, VextSupply1SwHPReqValid | |
713 | * 0x08, VextSupply2SwHPReqValid | |
714 | * 0x10, VextSupply3SwHPReqValid | |
33bc8f46 | 715 | * 0x20, VmodSwHPReqValid |
79568b94 | 716 | */ |
33bc8f46 | 717 | REG_INIT(AB8500_REGUSWHPREQVALID2, 0x03, 0x0e, 0x3f), |
79568b94 BJ |
718 | /* |
719 | * 0x02, SysClkReq2Valid1 | |
720 | * ... | |
721 | * 0x80, SysClkReq8Valid1 | |
722 | */ | |
723 | REG_INIT(AB8500_REGUSYSCLKREQVALID1, 0x03, 0x0f, 0xfe), | |
724 | /* | |
725 | * 0x02, SysClkReq2Valid2 | |
726 | * ... | |
727 | * 0x80, SysClkReq8Valid2 | |
728 | */ | |
729 | REG_INIT(AB8500_REGUSYSCLKREQVALID2, 0x03, 0x10, 0xfe), | |
730 | /* | |
731 | * 0x02, VTVoutEna | |
732 | * 0x04, Vintcore12Ena | |
733 | * 0x38, Vintcore12Sel | |
734 | * 0x40, Vintcore12LP | |
735 | * 0x80, VTVoutLP | |
736 | */ | |
737 | REG_INIT(AB8500_REGUMISC1, 0x03, 0x80, 0xfe), | |
738 | /* | |
739 | * 0x02, VaudioEna | |
740 | * 0x04, VdmicEna | |
741 | * 0x08, Vamic1Ena | |
742 | * 0x10, Vamic2Ena | |
743 | */ | |
744 | REG_INIT(AB8500_VAUDIOSUPPLY, 0x03, 0x83, 0x1e), | |
745 | /* | |
746 | * 0x01, Vamic1_dzout | |
747 | * 0x02, Vamic2_dzout | |
748 | */ | |
749 | REG_INIT(AB8500_REGUCTRL1VAMIC, 0x03, 0x84, 0x03), | |
d79df329 LJ |
750 | /* |
751 | * 0x03, Vsmps1Regu | |
752 | * 0x0c, Vsmps1SelCtrl | |
33bc8f46 LJ |
753 | * 0x10, Vsmps1AutoMode |
754 | * 0x20, Vsmps1PWMMode | |
d79df329 | 755 | */ |
33bc8f46 | 756 | REG_INIT(AB8500_VSMPS1REGU, 0x04, 0x03, 0x3f), |
d79df329 LJ |
757 | /* |
758 | * 0x03, Vsmps2Regu | |
759 | * 0x0c, Vsmps2SelCtrl | |
33bc8f46 LJ |
760 | * 0x10, Vsmps2AutoMode |
761 | * 0x20, Vsmps2PWMMode | |
d79df329 | 762 | */ |
33bc8f46 | 763 | REG_INIT(AB8500_VSMPS2REGU, 0x04, 0x04, 0x3f), |
79568b94 | 764 | /* |
79568b94 | 765 | * 0x03, VpllRegu |
33bc8f46 | 766 | * 0x0c, VanaRegu |
79568b94 BJ |
767 | */ |
768 | REG_INIT(AB8500_VPLLVANAREGU, 0x04, 0x06, 0x0f), | |
769 | /* | |
770 | * 0x01, VrefDDREna | |
771 | * 0x02, VrefDDRSleepMode | |
772 | */ | |
773 | REG_INIT(AB8500_VREFDDR, 0x04, 0x07, 0x03), | |
774 | /* | |
775 | * 0x03, VextSupply1Regu | |
776 | * 0x0c, VextSupply2Regu | |
777 | * 0x30, VextSupply3Regu | |
778 | * 0x40, ExtSupply2Bypass | |
779 | * 0x80, ExtSupply3Bypass | |
780 | */ | |
781 | REG_INIT(AB8500_EXTSUPPLYREGU, 0x04, 0x08, 0xff), | |
782 | /* | |
783 | * 0x03, Vaux1Regu | |
784 | * 0x0c, Vaux2Regu | |
785 | */ | |
786 | REG_INIT(AB8500_VAUX12REGU, 0x04, 0x09, 0x0f), | |
787 | /* | |
d79df329 | 788 | * 0x0c, Vrf1Regu |
79568b94 BJ |
789 | * 0x03, Vaux3Regu |
790 | */ | |
d79df329 | 791 | REG_INIT(AB8500_VRF1VAUX3REGU, 0x04, 0x0a, 0x0f), |
79568b94 BJ |
792 | /* |
793 | * 0x3f, Vsmps1Sel1 | |
794 | */ | |
795 | REG_INIT(AB8500_VSMPS1SEL1, 0x04, 0x13, 0x3f), | |
796 | /* | |
797 | * 0x0f, Vaux1Sel | |
798 | */ | |
799 | REG_INIT(AB8500_VAUX1SEL, 0x04, 0x1f, 0x0f), | |
800 | /* | |
801 | * 0x0f, Vaux2Sel | |
802 | */ | |
803 | REG_INIT(AB8500_VAUX2SEL, 0x04, 0x20, 0x0f), | |
804 | /* | |
805 | * 0x07, Vaux3Sel | |
33bc8f46 | 806 | * 0x30, Vrf1Sel |
79568b94 | 807 | */ |
33bc8f46 | 808 | REG_INIT(AB8500_VRF1VAUX3SEL, 0x04, 0x21, 0x37), |
79568b94 BJ |
809 | /* |
810 | * 0x01, VextSupply12LP | |
811 | */ | |
812 | REG_INIT(AB8500_REGUCTRL2SPARE, 0x04, 0x22, 0x01), | |
813 | /* | |
33bc8f46 LJ |
814 | * 0x01, VpllDisch |
815 | * 0x02, Vrf1Disch | |
79568b94 BJ |
816 | * 0x04, Vaux1Disch |
817 | * 0x08, Vaux2Disch | |
818 | * 0x10, Vaux3Disch | |
819 | * 0x20, Vintcore12Disch | |
820 | * 0x40, VTVoutDisch | |
821 | * 0x80, VaudioDisch | |
822 | */ | |
33bc8f46 | 823 | REG_INIT(AB8500_REGUCTRLDISCH, 0x04, 0x43, 0xff), |
79568b94 | 824 | /* |
33bc8f46 | 825 | * 0x01, VsimDisch |
79568b94 BJ |
826 | * 0x02, VanaDisch |
827 | * 0x04, VdmicPullDownEna | |
33bc8f46 | 828 | * 0x08, VpllPullDownEna |
79568b94 BJ |
829 | * 0x10, VdmicDisch |
830 | */ | |
33bc8f46 | 831 | REG_INIT(AB8500_REGUCTRLDISCH2, 0x04, 0x44, 0x1f), |
79568b94 BJ |
832 | }; |
833 | ||
3c1b8438 LJ |
834 | static int ab8500_regulator_init_registers(struct platform_device *pdev, |
835 | int id, int mask, int value) | |
a7ac1d9e LJ |
836 | { |
837 | int err; | |
838 | ||
3c1b8438 LJ |
839 | BUG_ON(value & ~mask); |
840 | BUG_ON(mask & ~ab8500_reg_init[id].mask); | |
a7ac1d9e | 841 | |
3c1b8438 | 842 | /* initialize register */ |
a7ac1d9e LJ |
843 | err = abx500_mask_and_set_register_interruptible( |
844 | &pdev->dev, | |
845 | ab8500_reg_init[id].bank, | |
846 | ab8500_reg_init[id].addr, | |
3c1b8438 | 847 | mask, value); |
a7ac1d9e LJ |
848 | if (err < 0) { |
849 | dev_err(&pdev->dev, | |
850 | "Failed to initialize 0x%02x, 0x%02x.\n", | |
851 | ab8500_reg_init[id].bank, | |
852 | ab8500_reg_init[id].addr); | |
853 | return err; | |
854 | } | |
a7ac1d9e | 855 | dev_vdbg(&pdev->dev, |
3c1b8438 LJ |
856 | " init: 0x%02x, 0x%02x, 0x%02x, 0x%02x\n", |
857 | ab8500_reg_init[id].bank, | |
858 | ab8500_reg_init[id].addr, | |
859 | mask, value); | |
a7ac1d9e LJ |
860 | |
861 | return 0; | |
862 | } | |
863 | ||
a5023574 | 864 | static int ab8500_regulator_register(struct platform_device *pdev, |
a7ac1d9e LJ |
865 | struct regulator_init_data *init_data, |
866 | int id, | |
867 | struct device_node *np) | |
868 | { | |
869 | struct ab8500_regulator_info *info = NULL; | |
870 | struct regulator_config config = { }; | |
871 | int err; | |
872 | ||
873 | /* assign per-regulator data */ | |
874 | info = &ab8500_regulator_info[id]; | |
875 | info->dev = &pdev->dev; | |
876 | ||
877 | config.dev = &pdev->dev; | |
878 | config.init_data = init_data; | |
879 | config.driver_data = info; | |
880 | config.of_node = np; | |
881 | ||
882 | /* fix for hardware before ab8500v2.0 */ | |
883 | if (abx500_get_chip_id(info->dev) < 0x20) { | |
884 | if (info->desc.id == AB8500_LDO_AUX3) { | |
885 | info->desc.n_voltages = | |
886 | ARRAY_SIZE(ldo_vauxn_voltages); | |
ec1cc4d9 | 887 | info->desc.volt_table = ldo_vauxn_voltages; |
a7ac1d9e LJ |
888 | info->voltage_mask = 0xf; |
889 | } | |
890 | } | |
891 | ||
892 | /* register regulator with framework */ | |
893 | info->regulator = regulator_register(&info->desc, &config); | |
894 | if (IS_ERR(info->regulator)) { | |
895 | err = PTR_ERR(info->regulator); | |
896 | dev_err(&pdev->dev, "failed to register regulator %s\n", | |
897 | info->desc.name); | |
898 | /* when we fail, un-register all earlier regulators */ | |
899 | while (--id >= 0) { | |
900 | info = &ab8500_regulator_info[id]; | |
901 | regulator_unregister(info->regulator); | |
902 | } | |
903 | return err; | |
904 | } | |
905 | ||
906 | return 0; | |
907 | } | |
908 | ||
3a8334b9 | 909 | static struct of_regulator_match ab8500_regulator_matches[] = { |
7e715b95 LJ |
910 | { .name = "ab8500_ldo_aux1", .driver_data = (void *) AB8500_LDO_AUX1, }, |
911 | { .name = "ab8500_ldo_aux2", .driver_data = (void *) AB8500_LDO_AUX2, }, | |
912 | { .name = "ab8500_ldo_aux3", .driver_data = (void *) AB8500_LDO_AUX3, }, | |
913 | { .name = "ab8500_ldo_intcore", .driver_data = (void *) AB8500_LDO_INTCORE, }, | |
914 | { .name = "ab8500_ldo_tvout", .driver_data = (void *) AB8500_LDO_TVOUT, }, | |
915 | { .name = "ab8500_ldo_usb", .driver_data = (void *) AB8500_LDO_USB, }, | |
916 | { .name = "ab8500_ldo_audio", .driver_data = (void *) AB8500_LDO_AUDIO, }, | |
917 | { .name = "ab8500_ldo_anamic1", .driver_data = (void *) AB8500_LDO_ANAMIC1, }, | |
918 | { .name = "ab8500_ldo_amamic2", .driver_data = (void *) AB8500_LDO_ANAMIC2, }, | |
919 | { .name = "ab8500_ldo_dmic", .driver_data = (void *) AB8500_LDO_DMIC, }, | |
920 | { .name = "ab8500_ldo_ana", .driver_data = (void *) AB8500_LDO_ANA, }, | |
3a8334b9 LJ |
921 | }; |
922 | ||
a5023574 | 923 | static int |
3a8334b9 LJ |
924 | ab8500_regulator_of_probe(struct platform_device *pdev, struct device_node *np) |
925 | { | |
926 | int err, i; | |
927 | ||
928 | for (i = 0; i < ARRAY_SIZE(ab8500_regulator_info); i++) { | |
929 | err = ab8500_regulator_register( | |
930 | pdev, ab8500_regulator_matches[i].init_data, | |
931 | i, ab8500_regulator_matches[i].of_node); | |
932 | if (err) | |
933 | return err; | |
934 | } | |
935 | ||
936 | return 0; | |
937 | } | |
938 | ||
a5023574 | 939 | static int ab8500_regulator_probe(struct platform_device *pdev) |
c789ca20 SI |
940 | { |
941 | struct ab8500 *ab8500 = dev_get_drvdata(pdev->dev.parent); | |
3a8334b9 | 942 | struct device_node *np = pdev->dev.of_node; |
732805a5 BJ |
943 | struct ab8500_platform_data *ppdata; |
944 | struct ab8500_regulator_platform_data *pdata; | |
c789ca20 SI |
945 | int i, err; |
946 | ||
3a8334b9 LJ |
947 | if (np) { |
948 | err = of_regulator_match(&pdev->dev, np, | |
949 | ab8500_regulator_matches, | |
950 | ARRAY_SIZE(ab8500_regulator_matches)); | |
951 | if (err < 0) { | |
952 | dev_err(&pdev->dev, | |
953 | "Error parsing regulator init data: %d\n", err); | |
954 | return err; | |
955 | } | |
956 | ||
957 | err = ab8500_regulator_of_probe(pdev, np); | |
958 | return err; | |
959 | } | |
960 | ||
c789ca20 SI |
961 | if (!ab8500) { |
962 | dev_err(&pdev->dev, "null mfd parent\n"); | |
963 | return -EINVAL; | |
964 | } | |
732805a5 BJ |
965 | |
966 | ppdata = dev_get_platdata(ab8500->dev); | |
967 | if (!ppdata) { | |
968 | dev_err(&pdev->dev, "null parent pdata\n"); | |
969 | return -EINVAL; | |
970 | } | |
971 | ||
972 | pdata = ppdata->regulator; | |
fc24b426 BJ |
973 | if (!pdata) { |
974 | dev_err(&pdev->dev, "null pdata\n"); | |
975 | return -EINVAL; | |
976 | } | |
c789ca20 | 977 | |
cb189b07 BJ |
978 | /* make sure the platform data has the correct size */ |
979 | if (pdata->num_regulator != ARRAY_SIZE(ab8500_regulator_info)) { | |
79568b94 | 980 | dev_err(&pdev->dev, "Configuration error: size mismatch.\n"); |
cb189b07 BJ |
981 | return -EINVAL; |
982 | } | |
983 | ||
79568b94 | 984 | /* initialize registers */ |
732805a5 | 985 | for (i = 0; i < pdata->num_reg_init; i++) { |
3c1b8438 | 986 | int id, mask, value; |
79568b94 | 987 | |
732805a5 BJ |
988 | id = pdata->reg_init[i].id; |
989 | mask = pdata->reg_init[i].mask; | |
990 | value = pdata->reg_init[i].value; | |
79568b94 BJ |
991 | |
992 | /* check for configuration errors */ | |
3c1b8438 | 993 | BUG_ON(id >= AB8500_NUM_REGULATOR_REGISTERS); |
79568b94 | 994 | |
3c1b8438 | 995 | err = ab8500_regulator_init_registers(pdev, id, mask, value); |
a7ac1d9e | 996 | if (err < 0) |
79568b94 | 997 | return err; |
79568b94 BJ |
998 | } |
999 | ||
c789ca20 SI |
1000 | /* register all regulators */ |
1001 | for (i = 0; i < ARRAY_SIZE(ab8500_regulator_info); i++) { | |
a7ac1d9e LJ |
1002 | err = ab8500_regulator_register(pdev, &pdata->regulator[i], i, NULL); |
1003 | if (err < 0) | |
c789ca20 | 1004 | return err; |
c789ca20 SI |
1005 | } |
1006 | ||
1007 | return 0; | |
1008 | } | |
1009 | ||
8dc995f5 | 1010 | static int ab8500_regulator_remove(struct platform_device *pdev) |
c789ca20 SI |
1011 | { |
1012 | int i; | |
1013 | ||
1014 | for (i = 0; i < ARRAY_SIZE(ab8500_regulator_info); i++) { | |
1015 | struct ab8500_regulator_info *info = NULL; | |
1016 | info = &ab8500_regulator_info[i]; | |
09aefa12 BJ |
1017 | |
1018 | dev_vdbg(rdev_get_dev(info->regulator), | |
1019 | "%s-remove\n", info->desc.name); | |
1020 | ||
c789ca20 SI |
1021 | regulator_unregister(info->regulator); |
1022 | } | |
1023 | ||
1024 | return 0; | |
1025 | } | |
1026 | ||
1027 | static struct platform_driver ab8500_regulator_driver = { | |
1028 | .probe = ab8500_regulator_probe, | |
5eb9f2b9 | 1029 | .remove = ab8500_regulator_remove, |
c789ca20 SI |
1030 | .driver = { |
1031 | .name = "ab8500-regulator", | |
1032 | .owner = THIS_MODULE, | |
1033 | }, | |
1034 | }; | |
1035 | ||
1036 | static int __init ab8500_regulator_init(void) | |
1037 | { | |
1038 | int ret; | |
1039 | ||
1040 | ret = platform_driver_register(&ab8500_regulator_driver); | |
1041 | if (ret != 0) | |
1042 | pr_err("Failed to register ab8500 regulator: %d\n", ret); | |
1043 | ||
1044 | return ret; | |
1045 | } | |
1046 | subsys_initcall(ab8500_regulator_init); | |
1047 | ||
1048 | static void __exit ab8500_regulator_exit(void) | |
1049 | { | |
1050 | platform_driver_unregister(&ab8500_regulator_driver); | |
1051 | } | |
1052 | module_exit(ab8500_regulator_exit); | |
1053 | ||
1054 | MODULE_LICENSE("GPL v2"); | |
1055 | MODULE_AUTHOR("Sundar Iyer <sundar.iyer@stericsson.com>"); | |
732805a5 | 1056 | MODULE_AUTHOR("Bengt Jonsson <bengt.g.jonsson@stericsson.com>"); |
c789ca20 SI |
1057 | MODULE_DESCRIPTION("Regulator Driver for ST-Ericsson AB8500 Mixed-Sig PMIC"); |
1058 | MODULE_ALIAS("platform:ab8500-regulator"); |