Blame view
drivers/regulator/pcf50633-regulator.c
9.11 KB
5ec271e74 regulator: PCF506... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 |
/* NXP PCF50633 PMIC Driver * * (C) 2006-2008 by Openmoko, Inc. * Author: Balaji Rao <balajirrao@openmoko.org> * All rights reserved. * * Broken down from monstrous PCF50633 driver mainly by * Harald Welte and Andy Green and Werner Almesberger * * This program is free software; you can redistribute it and/or modify it * under the terms of the GNU General Public License as published by the * Free Software Foundation; either version 2 of the License, or (at your * option) any later version. * */ #include <linux/kernel.h> #include <linux/module.h> #include <linux/init.h> #include <linux/device.h> #include <linux/err.h> #include <linux/platform_device.h> #include <linux/mfd/pcf50633/core.h> #include <linux/mfd/pcf50633/pmic.h> |
a6576cff1 Regulator: Implem... |
26 |
#define PCF50633_REGULATOR(_name, _id, _n) \ |
5ec271e74 regulator: PCF506... |
27 28 29 30 |
{ \ .name = _name, \ .id = _id, \ .ops = &pcf50633_regulator_ops, \ |
a6576cff1 Regulator: Implem... |
31 |
.n_voltages = _n, \ |
5ec271e74 regulator: PCF506... |
32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 |
.type = REGULATOR_VOLTAGE, \ .owner = THIS_MODULE, \ } static const u8 pcf50633_regulator_registers[PCF50633_NUM_REGULATORS] = { [PCF50633_REGULATOR_AUTO] = PCF50633_REG_AUTOOUT, [PCF50633_REGULATOR_DOWN1] = PCF50633_REG_DOWN1OUT, [PCF50633_REGULATOR_DOWN2] = PCF50633_REG_DOWN2OUT, [PCF50633_REGULATOR_MEMLDO] = PCF50633_REG_MEMLDOOUT, [PCF50633_REGULATOR_LDO1] = PCF50633_REG_LDO1OUT, [PCF50633_REGULATOR_LDO2] = PCF50633_REG_LDO2OUT, [PCF50633_REGULATOR_LDO3] = PCF50633_REG_LDO3OUT, [PCF50633_REGULATOR_LDO4] = PCF50633_REG_LDO4OUT, [PCF50633_REGULATOR_LDO5] = PCF50633_REG_LDO5OUT, [PCF50633_REGULATOR_LDO6] = PCF50633_REG_LDO6OUT, [PCF50633_REGULATOR_HCLDO] = PCF50633_REG_HCLDOOUT, }; /* Bits from voltage value */ static u8 auto_voltage_bits(unsigned int millivolts) { if (millivolts < 1800) return 0; if (millivolts > 3800) return 0xff; millivolts -= 625; return millivolts / 25; } static u8 down_voltage_bits(unsigned int millivolts) { if (millivolts < 625) return 0; else if (millivolts > 3000) return 0xff; millivolts -= 625; return millivolts / 25; } static u8 ldo_voltage_bits(unsigned int millivolts) { if (millivolts < 900) return 0; else if (millivolts > 3600) return 0x1f; millivolts -= 900; return millivolts / 100; } /* Obtain voltage value from bits */ static unsigned int auto_voltage_value(u8 bits) { if (bits < 0x2f) return 0; return 625 + (bits * 25); } static unsigned int down_voltage_value(u8 bits) { return 625 + (bits * 25); } static unsigned int ldo_voltage_value(u8 bits) { bits &= 0x1f; return 900 + (bits * 100); } static int pcf50633_regulator_set_voltage(struct regulator_dev *rdev, |
3a93f2a9f regulator: Report... |
110 111 |
int min_uV, int max_uV, unsigned *selector) |
5ec271e74 regulator: PCF506... |
112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 |
{ struct pcf50633 *pcf; int regulator_id, millivolts; u8 volt_bits, regnr; pcf = rdev_get_drvdata(rdev); regulator_id = rdev_get_id(rdev); if (regulator_id >= PCF50633_NUM_REGULATORS) return -EINVAL; millivolts = min_uV / 1000; regnr = pcf50633_regulator_registers[regulator_id]; switch (regulator_id) { case PCF50633_REGULATOR_AUTO: volt_bits = auto_voltage_bits(millivolts); break; case PCF50633_REGULATOR_DOWN1: volt_bits = down_voltage_bits(millivolts); break; case PCF50633_REGULATOR_DOWN2: volt_bits = down_voltage_bits(millivolts); break; case PCF50633_REGULATOR_LDO1: case PCF50633_REGULATOR_LDO2: case PCF50633_REGULATOR_LDO3: case PCF50633_REGULATOR_LDO4: case PCF50633_REGULATOR_LDO5: case PCF50633_REGULATOR_LDO6: case PCF50633_REGULATOR_HCLDO: volt_bits = ldo_voltage_bits(millivolts); break; default: return -EINVAL; } |
3a93f2a9f regulator: Report... |
149 |
*selector = volt_bits; |
5ec271e74 regulator: PCF506... |
150 151 |
return pcf50633_reg_write(pcf, regnr, volt_bits); } |
a6576cff1 Regulator: Implem... |
152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 |
static int pcf50633_regulator_voltage_value(enum pcf50633_regulator_id id, u8 bits) { int millivolts; switch (id) { case PCF50633_REGULATOR_AUTO: millivolts = auto_voltage_value(bits); break; case PCF50633_REGULATOR_DOWN1: millivolts = down_voltage_value(bits); break; case PCF50633_REGULATOR_DOWN2: millivolts = down_voltage_value(bits); break; case PCF50633_REGULATOR_LDO1: case PCF50633_REGULATOR_LDO2: case PCF50633_REGULATOR_LDO3: case PCF50633_REGULATOR_LDO4: case PCF50633_REGULATOR_LDO5: case PCF50633_REGULATOR_LDO6: case PCF50633_REGULATOR_HCLDO: millivolts = ldo_voltage_value(bits); break; default: return -EINVAL; } return millivolts * 1000; } |
5ec271e74 regulator: PCF506... |
182 183 184 |
static int pcf50633_regulator_get_voltage(struct regulator_dev *rdev) { struct pcf50633 *pcf; |
a6576cff1 Regulator: Implem... |
185 186 |
int regulator_id; u8 volt_bits, regnr; |
5ec271e74 regulator: PCF506... |
187 |
|
561864e8e drivers/regulator... |
188 |
pcf = rdev_get_drvdata(rdev); |
5ec271e74 regulator: PCF506... |
189 190 191 192 193 194 195 196 |
regulator_id = rdev_get_id(rdev); if (regulator_id >= PCF50633_NUM_REGULATORS) return -EINVAL; regnr = pcf50633_regulator_registers[regulator_id]; volt_bits = pcf50633_reg_read(pcf, regnr); |
a6576cff1 Regulator: Implem... |
197 198 199 200 201 202 203 204 205 206 207 208 209 |
return pcf50633_regulator_voltage_value(regulator_id, volt_bits); } static int pcf50633_regulator_list_voltage(struct regulator_dev *rdev, unsigned int index) { struct pcf50633 *pcf; int regulator_id; pcf = rdev_get_drvdata(rdev); regulator_id = rdev_get_id(rdev); |
5ec271e74 regulator: PCF506... |
210 211 212 |
switch (regulator_id) { case PCF50633_REGULATOR_AUTO: |
a6576cff1 Regulator: Implem... |
213 |
index += 0x2f; |
5ec271e74 regulator: PCF506... |
214 |
break; |
5ec271e74 regulator: PCF506... |
215 |
case PCF50633_REGULATOR_HCLDO: |
a6576cff1 Regulator: Implem... |
216 |
index += 0x01; |
5ec271e74 regulator: PCF506... |
217 218 |
break; default: |
a6576cff1 Regulator: Implem... |
219 |
break; |
5ec271e74 regulator: PCF506... |
220 |
} |
a6576cff1 Regulator: Implem... |
221 |
return pcf50633_regulator_voltage_value(regulator_id, index); |
5ec271e74 regulator: PCF506... |
222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 |
} static int pcf50633_regulator_enable(struct regulator_dev *rdev) { struct pcf50633 *pcf = rdev_get_drvdata(rdev); int regulator_id; u8 regnr; regulator_id = rdev_get_id(rdev); if (regulator_id >= PCF50633_NUM_REGULATORS) return -EINVAL; /* The *ENA register is always one after the *OUT register */ regnr = pcf50633_regulator_registers[regulator_id] + 1; return pcf50633_reg_set_bit_mask(pcf, regnr, PCF50633_REGULATOR_ON, PCF50633_REGULATOR_ON); } static int pcf50633_regulator_disable(struct regulator_dev *rdev) { struct pcf50633 *pcf = rdev_get_drvdata(rdev); int regulator_id; u8 regnr; regulator_id = rdev_get_id(rdev); if (regulator_id >= PCF50633_NUM_REGULATORS) return -EINVAL; /* the *ENA register is always one after the *OUT register */ regnr = pcf50633_regulator_registers[regulator_id] + 1; return pcf50633_reg_set_bit_mask(pcf, regnr, PCF50633_REGULATOR_ON, 0); } static int pcf50633_regulator_is_enabled(struct regulator_dev *rdev) { struct pcf50633 *pcf = rdev_get_drvdata(rdev); int regulator_id = rdev_get_id(rdev); u8 regnr; regulator_id = rdev_get_id(rdev); if (regulator_id >= PCF50633_NUM_REGULATORS) return -EINVAL; /* the *ENA register is always one after the *OUT register */ regnr = pcf50633_regulator_registers[regulator_id] + 1; return pcf50633_reg_read(pcf, regnr) & PCF50633_REGULATOR_ON; } static struct regulator_ops pcf50633_regulator_ops = { .set_voltage = pcf50633_regulator_set_voltage, .get_voltage = pcf50633_regulator_get_voltage, |
a6576cff1 Regulator: Implem... |
277 |
.list_voltage = pcf50633_regulator_list_voltage, |
5ec271e74 regulator: PCF506... |
278 279 280 281 282 283 284 |
.enable = pcf50633_regulator_enable, .disable = pcf50633_regulator_disable, .is_enabled = pcf50633_regulator_is_enabled, }; static struct regulator_desc regulators[] = { [PCF50633_REGULATOR_AUTO] = |
a6576cff1 Regulator: Implem... |
285 |
PCF50633_REGULATOR("auto", PCF50633_REGULATOR_AUTO, 80), |
5ec271e74 regulator: PCF506... |
286 |
[PCF50633_REGULATOR_DOWN1] = |
a6576cff1 Regulator: Implem... |
287 |
PCF50633_REGULATOR("down1", PCF50633_REGULATOR_DOWN1, 95), |
5ec271e74 regulator: PCF506... |
288 |
[PCF50633_REGULATOR_DOWN2] = |
a6576cff1 Regulator: Implem... |
289 |
PCF50633_REGULATOR("down2", PCF50633_REGULATOR_DOWN2, 95), |
5ec271e74 regulator: PCF506... |
290 |
[PCF50633_REGULATOR_LDO1] = |
a6576cff1 Regulator: Implem... |
291 |
PCF50633_REGULATOR("ldo1", PCF50633_REGULATOR_LDO1, 27), |
5ec271e74 regulator: PCF506... |
292 |
[PCF50633_REGULATOR_LDO2] = |
a6576cff1 Regulator: Implem... |
293 |
PCF50633_REGULATOR("ldo2", PCF50633_REGULATOR_LDO2, 27), |
5ec271e74 regulator: PCF506... |
294 |
[PCF50633_REGULATOR_LDO3] = |
a6576cff1 Regulator: Implem... |
295 |
PCF50633_REGULATOR("ldo3", PCF50633_REGULATOR_LDO3, 27), |
5ec271e74 regulator: PCF506... |
296 |
[PCF50633_REGULATOR_LDO4] = |
a6576cff1 Regulator: Implem... |
297 |
PCF50633_REGULATOR("ldo4", PCF50633_REGULATOR_LDO4, 27), |
5ec271e74 regulator: PCF506... |
298 |
[PCF50633_REGULATOR_LDO5] = |
a6576cff1 Regulator: Implem... |
299 |
PCF50633_REGULATOR("ldo5", PCF50633_REGULATOR_LDO5, 27), |
5ec271e74 regulator: PCF506... |
300 |
[PCF50633_REGULATOR_LDO6] = |
a6576cff1 Regulator: Implem... |
301 |
PCF50633_REGULATOR("ldo6", PCF50633_REGULATOR_LDO6, 27), |
5ec271e74 regulator: PCF506... |
302 |
[PCF50633_REGULATOR_HCLDO] = |
a6576cff1 Regulator: Implem... |
303 |
PCF50633_REGULATOR("hcldo", PCF50633_REGULATOR_HCLDO, 26), |
5ec271e74 regulator: PCF506... |
304 |
[PCF50633_REGULATOR_MEMLDO] = |
a6576cff1 Regulator: Implem... |
305 |
PCF50633_REGULATOR("memldo", PCF50633_REGULATOR_MEMLDO, 0), |
5ec271e74 regulator: PCF506... |
306 307 308 309 310 311 312 313 |
}; static int __devinit pcf50633_regulator_probe(struct platform_device *pdev) { struct regulator_dev *rdev; struct pcf50633 *pcf; /* Already set by core driver */ |
98c2e4903 mfd: Fix pcf50633... |
314 |
pcf = dev_to_pcf50633(pdev->dev.parent); |
5ec271e74 regulator: PCF506... |
315 |
|
0527100fd regulator: Pass r... |
316 |
rdev = regulator_register(®ulators[pdev->id], &pdev->dev, |
2c043bcbf regulator: pass a... |
317 |
pdev->dev.platform_data, pcf, NULL); |
5ec271e74 regulator: PCF506... |
318 319 |
if (IS_ERR(rdev)) return PTR_ERR(rdev); |
98c2e4903 mfd: Fix pcf50633... |
320 |
platform_set_drvdata(pdev, rdev); |
5ec271e74 regulator: PCF506... |
321 322 323 324 325 326 327 328 329 |
if (pcf->pdata->regulator_registered) pcf->pdata->regulator_registered(pcf, pdev->id); return 0; } static int __devexit pcf50633_regulator_remove(struct platform_device *pdev) { struct regulator_dev *rdev = platform_get_drvdata(pdev); |
98c2e4903 mfd: Fix pcf50633... |
330 |
platform_set_drvdata(pdev, NULL); |
5ec271e74 regulator: PCF506... |
331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 |
regulator_unregister(rdev); return 0; } static struct platform_driver pcf50633_regulator_driver = { .driver = { .name = "pcf50633-regltr", }, .probe = pcf50633_regulator_probe, .remove = __devexit_p(pcf50633_regulator_remove), }; static int __init pcf50633_regulator_init(void) { return platform_driver_register(&pcf50633_regulator_driver); } |
5a1b22bee regulator: Move r... |
348 |
subsys_initcall(pcf50633_regulator_init); |
5ec271e74 regulator: PCF506... |
349 350 351 352 353 354 355 356 357 358 359 |
static void __exit pcf50633_regulator_exit(void) { platform_driver_unregister(&pcf50633_regulator_driver); } module_exit(pcf50633_regulator_exit); MODULE_AUTHOR("Balaji Rao <balajirrao@openmoko.org>"); MODULE_DESCRIPTION("PCF50633 regulator driver"); MODULE_LICENSE("GPL"); MODULE_ALIAS("platform:pcf50633-regulator"); |