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, 288 pdev->dev.platform_data, pcf); 289 if (IS_ERR(rdev)) 290 return PTR_ERR(rdev); 291 292 if (pcf->pdata->regulator_registered) 293 pcf->pdata->regulator_registered(pcf, pdev->id); 294 295 return 0; 296 } 297 298 static int __devexit pcf50633_regulator_remove(struct platform_device *pdev) 299 { 300 struct regulator_dev *rdev = platform_get_drvdata(pdev); 301 302 regulator_unregister(rdev); 303 304 return 0; 305 } 306 307 static struct platform_driver pcf50633_regulator_driver = { 308 .driver = { 309 .name = "pcf50633-regltr", 310 }, 311 .probe = pcf50633_regulator_probe, 312 .remove = __devexit_p(pcf50633_regulator_remove), 313 }; 314 315 static int __init pcf50633_regulator_init(void) 316 { 317 return platform_driver_register(&pcf50633_regulator_driver); 318 } 319 module_init(pcf50633_regulator_init); 320 321 static void __exit pcf50633_regulator_exit(void) 322 { 323 platform_driver_unregister(&pcf50633_regulator_driver); 324 } 325 module_exit(pcf50633_regulator_exit); 326 327 MODULE_AUTHOR("Balaji Rao <balajirrao@openmoko.org>"); 328 MODULE_DESCRIPTION("PCF50633 regulator driver"); 329 MODULE_LICENSE("GPL"); 330 MODULE_ALIAS("platform:pcf50633-regulator"); 331