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