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 92struct 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 */ 103static const int const mc13783_sw3_val[] = { 104 5000000, 5000000, 5000000, 5500000, 105}; 106 107static const int const mc13783_vaudio_val[] = { 108 2775000, 109}; 110 111static const int const mc13783_viohi_val[] = { 112 2775000, 113}; 114 115static const int const mc13783_violo_val[] = { 116 1200000, 1300000, 1500000, 1800000, 117}; 118 119static const int const mc13783_vdig_val[] = { 120 1200000, 1300000, 1500000, 1800000, 121}; 122 123static const int const mc13783_vgen_val[] = { 124 1200000, 1300000, 1500000, 1800000, 125 1100000, 2000000, 2775000, 2400000, 126}; 127 128static const int const mc13783_vrfdig_val[] = { 129 1200000, 1500000, 1800000, 1875000, 130}; 131 132static const int const mc13783_vrfref_val[] = { 133 2475000, 2600000, 2700000, 2775000, 134}; 135 136static const int const mc13783_vrfcp_val[] = { 137 2700000, 2775000, 138}; 139 140static const int const mc13783_vsim_val[] = { 141 1800000, 2900000, 3000000, 142}; 143 144static const int const mc13783_vesim_val[] = { 145 1800000, 2900000, 146}; 147 148static const int const mc13783_vcam_val[] = { 149 1500000, 1800000, 2500000, 2550000, 150 2600000, 2750000, 2800000, 3000000, 151}; 152 153static const int const mc13783_vrfbg_val[] = { 154 1250000, 155}; 156 157static const int const mc13783_vvib_val[] = { 158 1300000, 1800000, 2000000, 3000000, 159}; 160 161static const int const mc13783_vmmc_val[] = { 162 1600000, 1800000, 2000000, 2600000, 163 2700000, 2800000, 2900000, 3000000, 164}; 165 166static const int const mc13783_vrf_val[] = { 167 1500000, 1875000, 2700000, 2775000, 168}; 169 170static const int const mc13783_gpo_val[] = { 171 3100000, 172}; 173 174static const int const mc13783_pwgtdrv_val[] = { 175 5500000, 176}; 177 178static struct regulator_ops mc13783_regulator_ops; 179static struct regulator_ops mc13783_fixed_regulator_ops; 180static 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 235static 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 277struct mc13783_regulator_priv { 278 struct mc13783 *mc13783; 279 u32 powermisc_pwgt_state; 280 struct regulator_dev *regulators[]; 281}; 282 283static 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 300static 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 316static 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 332static 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 343static 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 375static 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 400static 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 426static 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 435static 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 450static 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 459static 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 468int 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 495static 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 517static 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 539static 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 560static 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 569static 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; 605err: 606 while (--i >= 0) 607 regulator_unregister(priv->regulators[i]); 608 609 kfree(priv); 610 611 return ret; 612} 613 614static 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 630static 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 639static int __init mc13783_regulator_init(void) 640{ 641 return platform_driver_register(&mc13783_regulator_driver); 642} 643subsys_initcall(mc13783_regulator_init); 644 645static void __exit mc13783_regulator_exit(void) 646{ 647 platform_driver_unregister(&mc13783_regulator_driver); 648} 649module_exit(mc13783_regulator_exit); 650 651MODULE_LICENSE("GPL v2"); 652MODULE_AUTHOR("Sascha Hauer <s.hauer@pengutronix.de>"); 653MODULE_DESCRIPTION("Regulator Driver for Freescale MC13783 PMIC"); 654MODULE_ALIAS("platform:mc13783-regulator"); 655