1 /* 2 * Regulator Driver for Freescale MC13783 PMIC 3 * 4 * Copyright (C) 2008 Sascha Hauer, Pengutronix <s.hauer@pengutronix.de> 5 * Copyright 2009 Alberto Panizzo <maramaopercheseimorto@gmail.com> 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License version 2 as 9 * published by the Free Software Foundation. 10 */ 11 12 #include <linux/mfd/mc13783.h> 13 #include <linux/regulator/machine.h> 14 #include <linux/regulator/driver.h> 15 #include <linux/platform_device.h> 16 #include <linux/kernel.h> 17 #include <linux/slab.h> 18 #include <linux/init.h> 19 #include <linux/err.h> 20 21 #define MC13783_REG_SWITCHERS5 29 22 #define MC13783_REG_SWITCHERS5_SW3EN (1 << 20) 23 #define MC13783_REG_SWITCHERS5_SW3VSEL 18 24 #define MC13783_REG_SWITCHERS5_SW3VSEL_M (3 << 18) 25 26 #define MC13783_REG_REGULATORSETTING0 30 27 #define MC13783_REG_REGULATORSETTING0_VIOLOVSEL 2 28 #define MC13783_REG_REGULATORSETTING0_VDIGVSEL 4 29 #define MC13783_REG_REGULATORSETTING0_VGENVSEL 6 30 #define MC13783_REG_REGULATORSETTING0_VRFDIGVSEL 9 31 #define MC13783_REG_REGULATORSETTING0_VRFREFVSEL 11 32 #define MC13783_REG_REGULATORSETTING0_VRFCPVSEL 13 33 #define MC13783_REG_REGULATORSETTING0_VSIMVSEL 14 34 #define MC13783_REG_REGULATORSETTING0_VESIMVSEL 15 35 #define MC13783_REG_REGULATORSETTING0_VCAMVSEL 16 36 37 #define MC13783_REG_REGULATORSETTING0_VIOLOVSEL_M (3 << 2) 38 #define MC13783_REG_REGULATORSETTING0_VDIGVSEL_M (3 << 4) 39 #define MC13783_REG_REGULATORSETTING0_VGENVSEL_M (7 << 6) 40 #define MC13783_REG_REGULATORSETTING0_VRFDIGVSEL_M (3 << 9) 41 #define MC13783_REG_REGULATORSETTING0_VRFREFVSEL_M (3 << 11) 42 #define MC13783_REG_REGULATORSETTING0_VRFCPVSEL_M (1 << 13) 43 #define MC13783_REG_REGULATORSETTING0_VSIMVSEL_M (1 << 14) 44 #define MC13783_REG_REGULATORSETTING0_VESIMVSEL_M (1 << 15) 45 #define MC13783_REG_REGULATORSETTING0_VCAMVSEL_M (7 << 16) 46 47 #define MC13783_REG_REGULATORSETTING1 31 48 #define MC13783_REG_REGULATORSETTING1_VVIBVSEL 0 49 #define MC13783_REG_REGULATORSETTING1_VRF1VSEL 2 50 #define MC13783_REG_REGULATORSETTING1_VRF2VSEL 4 51 #define MC13783_REG_REGULATORSETTING1_VMMC1VSEL 6 52 #define MC13783_REG_REGULATORSETTING1_VMMC2VSEL 9 53 54 #define MC13783_REG_REGULATORSETTING1_VVIBVSEL_M (3 << 0) 55 #define MC13783_REG_REGULATORSETTING1_VRF1VSEL_M (3 << 2) 56 #define MC13783_REG_REGULATORSETTING1_VRF2VSEL_M (3 << 4) 57 #define MC13783_REG_REGULATORSETTING1_VMMC1VSEL_M (7 << 6) 58 #define MC13783_REG_REGULATORSETTING1_VMMC2VSEL_M (7 << 9) 59 60 #define MC13783_REG_REGULATORMODE0 32 61 #define MC13783_REG_REGULATORMODE0_VAUDIOEN (1 << 0) 62 #define MC13783_REG_REGULATORMODE0_VIOHIEN (1 << 3) 63 #define MC13783_REG_REGULATORMODE0_VIOLOEN (1 << 6) 64 #define MC13783_REG_REGULATORMODE0_VDIGEN (1 << 9) 65 #define MC13783_REG_REGULATORMODE0_VGENEN (1 << 12) 66 #define MC13783_REG_REGULATORMODE0_VRFDIGEN (1 << 15) 67 #define MC13783_REG_REGULATORMODE0_VRFREFEN (1 << 18) 68 #define MC13783_REG_REGULATORMODE0_VRFCPEN (1 << 21) 69 70 #define MC13783_REG_REGULATORMODE1 33 71 #define MC13783_REG_REGULATORMODE1_VSIMEN (1 << 0) 72 #define MC13783_REG_REGULATORMODE1_VESIMEN (1 << 3) 73 #define MC13783_REG_REGULATORMODE1_VCAMEN (1 << 6) 74 #define MC13783_REG_REGULATORMODE1_VRFBGEN (1 << 9) 75 #define MC13783_REG_REGULATORMODE1_VVIBEN (1 << 11) 76 #define MC13783_REG_REGULATORMODE1_VRF1EN (1 << 12) 77 #define MC13783_REG_REGULATORMODE1_VRF2EN (1 << 15) 78 #define MC13783_REG_REGULATORMODE1_VMMC1EN (1 << 18) 79 #define MC13783_REG_REGULATORMODE1_VMMC2EN (1 << 21) 80 81 #define MC13783_REG_POWERMISC 34 82 #define MC13783_REG_POWERMISC_GPO1EN (1 << 6) 83 #define MC13783_REG_POWERMISC_GPO2EN (1 << 8) 84 #define MC13783_REG_POWERMISC_GPO3EN (1 << 10) 85 #define MC13783_REG_POWERMISC_GPO4EN (1 << 12) 86 #define MC13783_REG_POWERMISC_PWGT1SPIEN (1 << 15) 87 #define MC13783_REG_POWERMISC_PWGT2SPIEN (1 << 16) 88 89 #define MC13783_REG_POWERMISC_PWGTSPI_M (3 << 15) 90 91 92 struct mc13783_regulator { 93 struct regulator_desc desc; 94 int reg; 95 int enable_bit; 96 int vsel_reg; 97 int vsel_shift; 98 int vsel_mask; 99 int const *voltages; 100 }; 101 102 /* Voltage Values */ 103 static const int const mc13783_sw3_val[] = { 104 5000000, 5000000, 5000000, 5500000, 105 }; 106 107 static const int const mc13783_vaudio_val[] = { 108 2775000, 109 }; 110 111 static const int const mc13783_viohi_val[] = { 112 2775000, 113 }; 114 115 static const int const mc13783_violo_val[] = { 116 1200000, 1300000, 1500000, 1800000, 117 }; 118 119 static const int const mc13783_vdig_val[] = { 120 1200000, 1300000, 1500000, 1800000, 121 }; 122 123 static const int const mc13783_vgen_val[] = { 124 1200000, 1300000, 1500000, 1800000, 125 1100000, 2000000, 2775000, 2400000, 126 }; 127 128 static const int const mc13783_vrfdig_val[] = { 129 1200000, 1500000, 1800000, 1875000, 130 }; 131 132 static const int const mc13783_vrfref_val[] = { 133 2475000, 2600000, 2700000, 2775000, 134 }; 135 136 static const int const mc13783_vrfcp_val[] = { 137 2700000, 2775000, 138 }; 139 140 static const int const mc13783_vsim_val[] = { 141 1800000, 2900000, 3000000, 142 }; 143 144 static const int const mc13783_vesim_val[] = { 145 1800000, 2900000, 146 }; 147 148 static const int const mc13783_vcam_val[] = { 149 1500000, 1800000, 2500000, 2550000, 150 2600000, 2750000, 2800000, 3000000, 151 }; 152 153 static const int const mc13783_vrfbg_val[] = { 154 1250000, 155 }; 156 157 static const int const mc13783_vvib_val[] = { 158 1300000, 1800000, 2000000, 3000000, 159 }; 160 161 static const int const mc13783_vmmc_val[] = { 162 1600000, 1800000, 2000000, 2600000, 163 2700000, 2800000, 2900000, 3000000, 164 }; 165 166 static const int const mc13783_vrf_val[] = { 167 1500000, 1875000, 2700000, 2775000, 168 }; 169 170 static const int const mc13783_gpo_val[] = { 171 3100000, 172 }; 173 174 static const int const mc13783_pwgtdrv_val[] = { 175 5500000, 176 }; 177 178 static struct regulator_ops mc13783_regulator_ops; 179 static struct regulator_ops mc13783_fixed_regulator_ops; 180 static struct regulator_ops mc13783_gpo_regulator_ops; 181 182 #define MC13783_DEFINE(prefix, _name, _reg, _vsel_reg, _voltages) \ 183 [MC13783_ ## prefix ## _ ## _name] = { \ 184 .desc = { \ 185 .name = #prefix "_" #_name, \ 186 .n_voltages = ARRAY_SIZE(_voltages), \ 187 .ops = &mc13783_regulator_ops, \ 188 .type = REGULATOR_VOLTAGE, \ 189 .id = MC13783_ ## prefix ## _ ## _name, \ 190 .owner = THIS_MODULE, \ 191 }, \ 192 .reg = MC13783_REG_ ## _reg, \ 193 .enable_bit = MC13783_REG_ ## _reg ## _ ## _name ## EN, \ 194 .vsel_reg = MC13783_REG_ ## _vsel_reg, \ 195 .vsel_shift = MC13783_REG_ ## _vsel_reg ## _ ## _name ## VSEL,\ 196 .vsel_mask = MC13783_REG_ ## _vsel_reg ## _ ## _name ## VSEL_M,\ 197 .voltages = _voltages, \ 198 } 199 200 #define MC13783_FIXED_DEFINE(prefix, _name, _reg, _voltages) \ 201 [MC13783_ ## prefix ## _ ## _name] = { \ 202 .desc = { \ 203 .name = #prefix "_" #_name, \ 204 .n_voltages = ARRAY_SIZE(_voltages), \ 205 .ops = &mc13783_fixed_regulator_ops, \ 206 .type = REGULATOR_VOLTAGE, \ 207 .id = MC13783_ ## prefix ## _ ## _name, \ 208 .owner = THIS_MODULE, \ 209 }, \ 210 .reg = MC13783_REG_ ## _reg, \ 211 .enable_bit = MC13783_REG_ ## _reg ## _ ## _name ## EN, \ 212 .voltages = _voltages, \ 213 } 214 215 #define MC13783_GPO_DEFINE(prefix, _name, _reg, _voltages) \ 216 [MC13783_ ## prefix ## _ ## _name] = { \ 217 .desc = { \ 218 .name = #prefix "_" #_name, \ 219 .n_voltages = ARRAY_SIZE(_voltages), \ 220 .ops = &mc13783_gpo_regulator_ops, \ 221 .type = REGULATOR_VOLTAGE, \ 222 .id = MC13783_ ## prefix ## _ ## _name, \ 223 .owner = THIS_MODULE, \ 224 }, \ 225 .reg = MC13783_REG_ ## _reg, \ 226 .enable_bit = MC13783_REG_ ## _reg ## _ ## _name ## EN, \ 227 .voltages = _voltages, \ 228 } 229 230 #define MC13783_DEFINE_SW(_name, _reg, _vsel_reg, _voltages) \ 231 MC13783_DEFINE(SW, _name, _reg, _vsel_reg, _voltages) 232 #define MC13783_DEFINE_REGU(_name, _reg, _vsel_reg, _voltages) \ 233 MC13783_DEFINE(REGU, _name, _reg, _vsel_reg, _voltages) 234 235 static struct mc13783_regulator mc13783_regulators[] = { 236 MC13783_DEFINE_SW(SW3, SWITCHERS5, SWITCHERS5, mc13783_sw3_val), 237 238 MC13783_FIXED_DEFINE(REGU, VAUDIO, REGULATORMODE0, mc13783_vaudio_val), 239 MC13783_FIXED_DEFINE(REGU, VIOHI, REGULATORMODE0, mc13783_viohi_val), 240 MC13783_DEFINE_REGU(VIOLO, REGULATORMODE0, REGULATORSETTING0, \ 241 mc13783_violo_val), 242 MC13783_DEFINE_REGU(VDIG, REGULATORMODE0, REGULATORSETTING0, \ 243 mc13783_vdig_val), 244 MC13783_DEFINE_REGU(VGEN, REGULATORMODE0, REGULATORSETTING0, \ 245 mc13783_vgen_val), 246 MC13783_DEFINE_REGU(VRFDIG, REGULATORMODE0, REGULATORSETTING0, \ 247 mc13783_vrfdig_val), 248 MC13783_DEFINE_REGU(VRFREF, REGULATORMODE0, REGULATORSETTING0, \ 249 mc13783_vrfref_val), 250 MC13783_DEFINE_REGU(VRFCP, REGULATORMODE0, REGULATORSETTING0, \ 251 mc13783_vrfcp_val), 252 MC13783_DEFINE_REGU(VSIM, REGULATORMODE1, REGULATORSETTING0, \ 253 mc13783_vsim_val), 254 MC13783_DEFINE_REGU(VESIM, REGULATORMODE1, REGULATORSETTING0, \ 255 mc13783_vesim_val), 256 MC13783_DEFINE_REGU(VCAM, REGULATORMODE1, REGULATORSETTING0, \ 257 mc13783_vcam_val), 258 MC13783_FIXED_DEFINE(REGU, VRFBG, REGULATORMODE1, mc13783_vrfbg_val), 259 MC13783_DEFINE_REGU(VVIB, REGULATORMODE1, REGULATORSETTING1, \ 260 mc13783_vvib_val), 261 MC13783_DEFINE_REGU(VRF1, REGULATORMODE1, REGULATORSETTING1, \ 262 mc13783_vrf_val), 263 MC13783_DEFINE_REGU(VRF2, REGULATORMODE1, REGULATORSETTING1, \ 264 mc13783_vrf_val), 265 MC13783_DEFINE_REGU(VMMC1, REGULATORMODE1, REGULATORSETTING1, \ 266 mc13783_vmmc_val), 267 MC13783_DEFINE_REGU(VMMC2, REGULATORMODE1, REGULATORSETTING1, \ 268 mc13783_vmmc_val), 269 MC13783_GPO_DEFINE(REGU, GPO1, POWERMISC, mc13783_gpo_val), 270 MC13783_GPO_DEFINE(REGU, GPO2, POWERMISC, mc13783_gpo_val), 271 MC13783_GPO_DEFINE(REGU, GPO3, POWERMISC, mc13783_gpo_val), 272 MC13783_GPO_DEFINE(REGU, GPO4, POWERMISC, mc13783_gpo_val), 273 MC13783_GPO_DEFINE(REGU, PWGT1SPI, POWERMISC, mc13783_pwgtdrv_val), 274 MC13783_GPO_DEFINE(REGU, PWGT2SPI, POWERMISC, mc13783_pwgtdrv_val), 275 }; 276 277 struct mc13783_regulator_priv { 278 struct mc13783 *mc13783; 279 u32 powermisc_pwgt_state; 280 struct regulator_dev *regulators[]; 281 }; 282 283 static int mc13783_regulator_enable(struct regulator_dev *rdev) 284 { 285 struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev); 286 int id = rdev_get_id(rdev); 287 int ret; 288 289 dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id); 290 291 mc13783_lock(priv->mc13783); 292 ret = mc13783_reg_rmw(priv->mc13783, mc13783_regulators[id].reg, 293 mc13783_regulators[id].enable_bit, 294 mc13783_regulators[id].enable_bit); 295 mc13783_unlock(priv->mc13783); 296 297 return ret; 298 } 299 300 static int mc13783_regulator_disable(struct regulator_dev *rdev) 301 { 302 struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev); 303 int id = rdev_get_id(rdev); 304 int ret; 305 306 dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id); 307 308 mc13783_lock(priv->mc13783); 309 ret = mc13783_reg_rmw(priv->mc13783, mc13783_regulators[id].reg, 310 mc13783_regulators[id].enable_bit, 0); 311 mc13783_unlock(priv->mc13783); 312 313 return ret; 314 } 315 316 static int mc13783_regulator_is_enabled(struct regulator_dev *rdev) 317 { 318 struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev); 319 int ret, id = rdev_get_id(rdev); 320 unsigned int val; 321 322 mc13783_lock(priv->mc13783); 323 ret = mc13783_reg_read(priv->mc13783, mc13783_regulators[id].reg, &val); 324 mc13783_unlock(priv->mc13783); 325 326 if (ret) 327 return ret; 328 329 return (val & mc13783_regulators[id].enable_bit) != 0; 330 } 331 332 static int mc13783_regulator_list_voltage(struct regulator_dev *rdev, 333 unsigned selector) 334 { 335 int id = rdev_get_id(rdev); 336 337 if (selector >= mc13783_regulators[id].desc.n_voltages) 338 return -EINVAL; 339 340 return mc13783_regulators[id].voltages[selector]; 341 } 342 343 static int mc13783_get_best_voltage_index(struct regulator_dev *rdev, 344 int min_uV, int max_uV) 345 { 346 int reg_id = rdev_get_id(rdev); 347 int i; 348 int bestmatch; 349 int bestindex; 350 351 /* 352 * Locate the minimum voltage fitting the criteria on 353 * this regulator. The switchable voltages are not 354 * in strict falling order so we need to check them 355 * all for the best match. 356 */ 357 bestmatch = INT_MAX; 358 bestindex = -1; 359 for (i = 0; i < mc13783_regulators[reg_id].desc.n_voltages; i++) { 360 if (mc13783_regulators[reg_id].voltages[i] >= min_uV && 361 mc13783_regulators[reg_id].voltages[i] < bestmatch) { 362 bestmatch = mc13783_regulators[reg_id].voltages[i]; 363 bestindex = i; 364 } 365 } 366 367 if (bestindex < 0 || bestmatch > max_uV) { 368 dev_warn(&rdev->dev, "no possible value for %d<=x<=%d uV\n", 369 min_uV, max_uV); 370 return -EINVAL; 371 } 372 return bestindex; 373 } 374 375 static int mc13783_regulator_set_voltage(struct regulator_dev *rdev, 376 int min_uV, int max_uV) 377 { 378 struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev); 379 int value, id = rdev_get_id(rdev); 380 int ret; 381 382 dev_dbg(rdev_get_dev(rdev), "%s id: %d min_uV: %d max_uV: %d\n", 383 __func__, id, min_uV, max_uV); 384 385 /* Find the best index */ 386 value = mc13783_get_best_voltage_index(rdev, min_uV, max_uV); 387 dev_dbg(rdev_get_dev(rdev), "%s best value: %d \n", __func__, value); 388 if (value < 0) 389 return value; 390 391 mc13783_lock(priv->mc13783); 392 ret = mc13783_reg_rmw(priv->mc13783, mc13783_regulators[id].vsel_reg, 393 mc13783_regulators[id].vsel_mask, 394 value << mc13783_regulators[id].vsel_shift); 395 mc13783_unlock(priv->mc13783); 396 397 return ret; 398 } 399 400 static int mc13783_regulator_get_voltage(struct regulator_dev *rdev) 401 { 402 struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev); 403 int ret, id = rdev_get_id(rdev); 404 unsigned int val; 405 406 dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id); 407 408 mc13783_lock(priv->mc13783); 409 ret = mc13783_reg_read(priv->mc13783, 410 mc13783_regulators[id].vsel_reg, &val); 411 mc13783_unlock(priv->mc13783); 412 413 if (ret) 414 return ret; 415 416 val = (val & mc13783_regulators[id].vsel_mask) 417 >> mc13783_regulators[id].vsel_shift; 418 419 dev_dbg(rdev_get_dev(rdev), "%s id: %d val: %d\n", __func__, id, val); 420 421 BUG_ON(val < 0 || val > mc13783_regulators[id].desc.n_voltages); 422 423 return mc13783_regulators[id].voltages[val]; 424 } 425 426 static struct regulator_ops mc13783_regulator_ops = { 427 .enable = mc13783_regulator_enable, 428 .disable = mc13783_regulator_disable, 429 .is_enabled = mc13783_regulator_is_enabled, 430 .list_voltage = mc13783_regulator_list_voltage, 431 .set_voltage = mc13783_regulator_set_voltage, 432 .get_voltage = mc13783_regulator_get_voltage, 433 }; 434 435 static int mc13783_fixed_regulator_set_voltage(struct regulator_dev *rdev, 436 int min_uV, int max_uV) 437 { 438 int id = rdev_get_id(rdev); 439 440 dev_dbg(rdev_get_dev(rdev), "%s id: %d min_uV: %d max_uV: %d\n", 441 __func__, id, min_uV, max_uV); 442 443 if (min_uV >= mc13783_regulators[id].voltages[0] && 444 max_uV <= mc13783_regulators[id].voltages[0]) 445 return 0; 446 else 447 return -EINVAL; 448 } 449 450 static int mc13783_fixed_regulator_get_voltage(struct regulator_dev *rdev) 451 { 452 int id = rdev_get_id(rdev); 453 454 dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id); 455 456 return mc13783_regulators[id].voltages[0]; 457 } 458 459 static struct regulator_ops mc13783_fixed_regulator_ops = { 460 .enable = mc13783_regulator_enable, 461 .disable = mc13783_regulator_disable, 462 .is_enabled = mc13783_regulator_is_enabled, 463 .list_voltage = mc13783_regulator_list_voltage, 464 .set_voltage = mc13783_fixed_regulator_set_voltage, 465 .get_voltage = mc13783_fixed_regulator_get_voltage, 466 }; 467 468 static int mc13783_powermisc_rmw(struct mc13783_regulator_priv *priv, u32 mask, 469 u32 val) 470 { 471 struct mc13783 *mc13783 = priv->mc13783; 472 int ret; 473 u32 valread; 474 475 BUG_ON(val & ~mask); 476 477 ret = mc13783_reg_read(mc13783, MC13783_REG_POWERMISC, &valread); 478 if (ret) 479 return ret; 480 481 /* Update the stored state for Power Gates. */ 482 priv->powermisc_pwgt_state = 483 (priv->powermisc_pwgt_state & ~mask) | val; 484 priv->powermisc_pwgt_state &= MC13783_REG_POWERMISC_PWGTSPI_M; 485 486 /* Construct the new register value */ 487 valread = (valread & ~mask) | val; 488 /* Overwrite the PWGTxEN with the stored version */ 489 valread = (valread & ~MC13783_REG_POWERMISC_PWGTSPI_M) | 490 priv->powermisc_pwgt_state; 491 492 return mc13783_reg_write(mc13783, MC13783_REG_POWERMISC, valread); 493 } 494 495 static int mc13783_gpo_regulator_enable(struct regulator_dev *rdev) 496 { 497 struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev); 498 int id = rdev_get_id(rdev); 499 int ret; 500 u32 en_val = mc13783_regulators[id].enable_bit; 501 502 dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id); 503 504 /* Power Gate enable value is 0 */ 505 if (id == MC13783_REGU_PWGT1SPI || 506 id == MC13783_REGU_PWGT2SPI) 507 en_val = 0; 508 509 mc13783_lock(priv->mc13783); 510 ret = mc13783_powermisc_rmw(priv, mc13783_regulators[id].enable_bit, 511 en_val); 512 mc13783_unlock(priv->mc13783); 513 514 return ret; 515 } 516 517 static int mc13783_gpo_regulator_disable(struct regulator_dev *rdev) 518 { 519 struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev); 520 int id = rdev_get_id(rdev); 521 int ret; 522 u32 dis_val = 0; 523 524 dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id); 525 526 /* Power Gate disable value is 1 */ 527 if (id == MC13783_REGU_PWGT1SPI || 528 id == MC13783_REGU_PWGT2SPI) 529 dis_val = mc13783_regulators[id].enable_bit; 530 531 mc13783_lock(priv->mc13783); 532 ret = mc13783_powermisc_rmw(priv, mc13783_regulators[id].enable_bit, 533 dis_val); 534 mc13783_unlock(priv->mc13783); 535 536 return ret; 537 } 538 539 static int mc13783_gpo_regulator_is_enabled(struct regulator_dev *rdev) 540 { 541 struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev); 542 int ret, id = rdev_get_id(rdev); 543 unsigned int val; 544 545 mc13783_lock(priv->mc13783); 546 ret = mc13783_reg_read(priv->mc13783, mc13783_regulators[id].reg, &val); 547 mc13783_unlock(priv->mc13783); 548 549 if (ret) 550 return ret; 551 552 /* Power Gates state is stored in powermisc_pwgt_state 553 * where the meaning of bits is negated */ 554 val = (val & ~MC13783_REG_POWERMISC_PWGTSPI_M) | 555 (priv->powermisc_pwgt_state ^ MC13783_REG_POWERMISC_PWGTSPI_M); 556 557 return (val & mc13783_regulators[id].enable_bit) != 0; 558 } 559 560 static struct regulator_ops mc13783_gpo_regulator_ops = { 561 .enable = mc13783_gpo_regulator_enable, 562 .disable = mc13783_gpo_regulator_disable, 563 .is_enabled = mc13783_gpo_regulator_is_enabled, 564 .list_voltage = mc13783_regulator_list_voltage, 565 .set_voltage = mc13783_fixed_regulator_set_voltage, 566 .get_voltage = mc13783_fixed_regulator_get_voltage, 567 }; 568 569 static int __devinit mc13783_regulator_probe(struct platform_device *pdev) 570 { 571 struct mc13783_regulator_priv *priv; 572 struct mc13783 *mc13783 = dev_get_drvdata(pdev->dev.parent); 573 struct mc13783_regulator_platform_data *pdata = 574 dev_get_platdata(&pdev->dev); 575 struct mc13783_regulator_init_data *init_data; 576 int i, ret; 577 578 dev_dbg(&pdev->dev, "mc13783_regulator_probe id %d\n", pdev->id); 579 580 priv = kzalloc(sizeof(*priv) + 581 pdata->num_regulators * sizeof(priv->regulators[0]), 582 GFP_KERNEL); 583 if (!priv) 584 return -ENOMEM; 585 586 priv->mc13783 = mc13783; 587 588 for (i = 0; i < pdata->num_regulators; i++) { 589 init_data = &pdata->regulators[i]; 590 priv->regulators[i] = regulator_register( 591 &mc13783_regulators[init_data->id].desc, 592 &pdev->dev, init_data->init_data, priv); 593 594 if (IS_ERR(priv->regulators[i])) { 595 dev_err(&pdev->dev, "failed to register regulator %s\n", 596 mc13783_regulators[i].desc.name); 597 ret = PTR_ERR(priv->regulators[i]); 598 goto err; 599 } 600 } 601 602 platform_set_drvdata(pdev, priv); 603 604 return 0; 605 err: 606 while (--i >= 0) 607 regulator_unregister(priv->regulators[i]); 608 609 kfree(priv); 610 611 return ret; 612 } 613 614 static int __devexit mc13783_regulator_remove(struct platform_device *pdev) 615 { 616 struct mc13783_regulator_priv *priv = platform_get_drvdata(pdev); 617 struct mc13783_regulator_platform_data *pdata = 618 dev_get_platdata(&pdev->dev); 619 int i; 620 621 platform_set_drvdata(pdev, NULL); 622 623 for (i = 0; i < pdata->num_regulators; i++) 624 regulator_unregister(priv->regulators[i]); 625 626 kfree(priv); 627 return 0; 628 } 629 630 static struct platform_driver mc13783_regulator_driver = { 631 .driver = { 632 .name = "mc13783-regulator", 633 .owner = THIS_MODULE, 634 }, 635 .remove = __devexit_p(mc13783_regulator_remove), 636 .probe = mc13783_regulator_probe, 637 }; 638 639 static int __init mc13783_regulator_init(void) 640 { 641 return platform_driver_register(&mc13783_regulator_driver); 642 } 643 subsys_initcall(mc13783_regulator_init); 644 645 static void __exit mc13783_regulator_exit(void) 646 { 647 platform_driver_unregister(&mc13783_regulator_driver); 648 } 649 module_exit(mc13783_regulator_exit); 650 651 MODULE_LICENSE("GPL v2"); 652 MODULE_AUTHOR("Sascha Hauer <s.hauer@pengutronix.de>"); 653 MODULE_DESCRIPTION("Regulator Driver for Freescale MC13783 PMIC"); 654 MODULE_ALIAS("platform:mc13783-regulator"); 655