1 /* 2 * Motorola CPCAP PMIC regulator driver 3 * 4 * Based on cpcap-regulator.c from Motorola Linux kernel tree 5 * Copyright (C) 2009-2011 Motorola, Inc. 6 * 7 * Rewritten for mainline kernel to use device tree and regmap 8 * Copyright (C) 2017 Tony Lindgren <tony@atomide.com> 9 * 10 * This program is free software; you can redistribute it and/or 11 * modify it under the terms of the GNU General Public License as 12 * published by the Free Software Foundation version 2. 13 * 14 * This program is distributed "as is" WITHOUT ANY WARRANTY of any 15 * kind, whether express or implied; without even the implied warranty 16 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 17 * GNU General Public License for more details. 18 */ 19 20 #include <linux/err.h> 21 #include <linux/module.h> 22 #include <linux/of.h> 23 #include <linux/of_platform.h> 24 #include <linux/regmap.h> 25 #include <linux/regulator/driver.h> 26 #include <linux/regulator/machine.h> 27 #include <linux/regulator/of_regulator.h> 28 #include <linux/mfd/motorola-cpcap.h> 29 30 /* 31 * Resource assignment register bits. These seem to control the state 32 * idle modes adn are used at least for omap4. 33 */ 34 35 /* CPCAP_REG_ASSIGN2 bits - Resource Assignment 2 */ 36 #define CPCAP_BIT_VSDIO_SEL BIT(15) 37 #define CPCAP_BIT_VDIG_SEL BIT(14) 38 #define CPCAP_BIT_VCAM_SEL BIT(13) 39 #define CPCAP_BIT_SW6_SEL BIT(12) 40 #define CPCAP_BIT_SW5_SEL BIT(11) 41 #define CPCAP_BIT_SW4_SEL BIT(10) 42 #define CPCAP_BIT_SW3_SEL BIT(9) 43 #define CPCAP_BIT_SW2_SEL BIT(8) 44 #define CPCAP_BIT_SW1_SEL BIT(7) 45 46 /* CPCAP_REG_ASSIGN3 bits - Resource Assignment 3 */ 47 #define CPCAP_BIT_VUSBINT2_SEL BIT(15) 48 #define CPCAP_BIT_VUSBINT1_SEL BIT(14) 49 #define CPCAP_BIT_VVIB_SEL BIT(13) 50 #define CPCAP_BIT_VWLAN1_SEL BIT(12) 51 #define CPCAP_BIT_VRF1_SEL BIT(11) 52 #define CPCAP_BIT_VHVIO_SEL BIT(10) 53 #define CPCAP_BIT_VDAC_SEL BIT(9) 54 #define CPCAP_BIT_VUSB_SEL BIT(8) 55 #define CPCAP_BIT_VSIM_SEL BIT(7) 56 #define CPCAP_BIT_VRFREF_SEL BIT(6) 57 #define CPCAP_BIT_VPLL_SEL BIT(5) 58 #define CPCAP_BIT_VFUSE_SEL BIT(4) 59 #define CPCAP_BIT_VCSI_SEL BIT(3) 60 #define CPCAP_BIT_SPARE_14_2 BIT(2) 61 #define CPCAP_BIT_VWLAN2_SEL BIT(1) 62 #define CPCAP_BIT_VRF2_SEL BIT(0) 63 64 /* CPCAP_REG_ASSIGN4 bits - Resource Assignment 4 */ 65 #define CPCAP_BIT_VAUDIO_SEL BIT(0) 66 67 /* 68 * Enable register bits. At least CPCAP_BIT_AUDIO_LOW_PWR is generic, 69 * and not limited to audio regulator. Let's use the Motorola kernel 70 * naming for now until we have a better understanding of the other 71 * enable register bits. No idea why BIT(3) is not defined. 72 */ 73 #define CPCAP_BIT_AUDIO_LOW_PWR BIT(6) 74 #define CPCAP_BIT_AUD_LOWPWR_SPEED BIT(5) 75 #define CPCAP_BIT_VAUDIOPRISTBY BIT(4) 76 #define CPCAP_BIT_VAUDIO_MODE1 BIT(2) 77 #define CPCAP_BIT_VAUDIO_MODE0 BIT(1) 78 #define CPCAP_BIT_V_AUDIO_EN BIT(0) 79 80 #define CPCAP_BIT_AUDIO_NORMAL_MODE 0x00 81 82 /* 83 * Off mode configuration bit. Used currently only by SW5 on omap4. There's 84 * the following comment in Motorola Linux kernel tree for it: 85 * 86 * When set in the regulator mode, the regulator assignment will be changed 87 * to secondary when the regulator is disabled. The mode will be set back to 88 * primary when the regulator is turned on. 89 */ 90 #define CPCAP_REG_OFF_MODE_SEC BIT(15) 91 92 /** 93 * SoC specific configuraion for CPCAP regulator. There are at least three 94 * different SoCs each with their own parameters: omap3, omap4 and tegra2. 95 * 96 * The assign_reg and assign_mask seem to allow toggling between primary 97 * and secondary mode that at least omap4 uses for off mode. 98 */ 99 struct cpcap_regulator { 100 struct regulator_desc rdesc; 101 const u16 assign_reg; 102 const u16 assign_mask; 103 const u16 vsel_shift; 104 }; 105 106 #define CPCAP_REG(_ID, reg, assignment_reg, assignment_mask, val_tbl, \ 107 mode_mask, volt_mask, volt_shft, \ 108 mode_val, off_val, volt_trans_time) { \ 109 .rdesc = { \ 110 .name = #_ID, \ 111 .of_match = of_match_ptr(#_ID), \ 112 .ops = &cpcap_regulator_ops, \ 113 .regulators_node = of_match_ptr("regulators"), \ 114 .type = REGULATOR_VOLTAGE, \ 115 .id = CPCAP_##_ID, \ 116 .owner = THIS_MODULE, \ 117 .n_voltages = ARRAY_SIZE(val_tbl), \ 118 .volt_table = (val_tbl), \ 119 .vsel_reg = (reg), \ 120 .vsel_mask = (volt_mask), \ 121 .enable_reg = (reg), \ 122 .enable_mask = (mode_mask), \ 123 .enable_val = (mode_val), \ 124 .disable_val = (off_val), \ 125 .ramp_delay = (volt_trans_time), \ 126 .of_map_mode = cpcap_map_mode, \ 127 }, \ 128 .assign_reg = (assignment_reg), \ 129 .assign_mask = (assignment_mask), \ 130 .vsel_shift = (volt_shft), \ 131 } 132 133 struct cpcap_ddata { 134 struct regmap *reg; 135 struct device *dev; 136 const struct cpcap_regulator *soc; 137 }; 138 139 enum cpcap_regulator_id { 140 CPCAP_SW1, 141 CPCAP_SW2, 142 CPCAP_SW3, 143 CPCAP_SW4, 144 CPCAP_SW5, 145 CPCAP_SW6, 146 CPCAP_VCAM, 147 CPCAP_VCSI, 148 CPCAP_VDAC, 149 CPCAP_VDIG, 150 CPCAP_VFUSE, 151 CPCAP_VHVIO, 152 CPCAP_VSDIO, 153 CPCAP_VPLL, 154 CPCAP_VRF1, 155 CPCAP_VRF2, 156 CPCAP_VRFREF, 157 CPCAP_VWLAN1, 158 CPCAP_VWLAN2, 159 CPCAP_VSIM, 160 CPCAP_VSIMCARD, 161 CPCAP_VVIB, 162 CPCAP_VUSB, 163 CPCAP_VAUDIO, 164 CPCAP_NR_REGULATORS, 165 }; 166 167 /* 168 * We need to also configure regulator idle mode for SoC off mode if 169 * CPCAP_REG_OFF_MODE_SEC is set. 170 */ 171 static int cpcap_regulator_enable(struct regulator_dev *rdev) 172 { 173 struct cpcap_regulator *regulator = rdev_get_drvdata(rdev); 174 int error, ignore; 175 176 error = regulator_enable_regmap(rdev); 177 if (error) 178 return error; 179 180 if (rdev->desc->enable_val & CPCAP_REG_OFF_MODE_SEC) { 181 error = regmap_update_bits(rdev->regmap, regulator->assign_reg, 182 regulator->assign_mask, 183 regulator->assign_mask); 184 if (error) 185 ignore = regulator_disable_regmap(rdev); 186 } 187 188 return error; 189 } 190 191 /* 192 * We need to also configure regulator idle mode for SoC off mode if 193 * CPCAP_REG_OFF_MODE_SEC is set. 194 */ 195 static int cpcap_regulator_disable(struct regulator_dev *rdev) 196 { 197 struct cpcap_regulator *regulator = rdev_get_drvdata(rdev); 198 int error, ignore; 199 200 if (rdev->desc->enable_val & CPCAP_REG_OFF_MODE_SEC) { 201 error = regmap_update_bits(rdev->regmap, regulator->assign_reg, 202 regulator->assign_mask, 0); 203 if (error) 204 return error; 205 } 206 207 error = regulator_disable_regmap(rdev); 208 if (error && (rdev->desc->enable_val & CPCAP_REG_OFF_MODE_SEC)) { 209 ignore = regmap_update_bits(rdev->regmap, regulator->assign_reg, 210 regulator->assign_mask, 211 regulator->assign_mask); 212 } 213 214 return error; 215 } 216 217 static unsigned int cpcap_map_mode(unsigned int mode) 218 { 219 switch (mode) { 220 case CPCAP_BIT_AUDIO_NORMAL_MODE: 221 return REGULATOR_MODE_NORMAL; 222 case CPCAP_BIT_AUDIO_LOW_PWR: 223 return REGULATOR_MODE_STANDBY; 224 default: 225 return REGULATOR_MODE_INVALID; 226 } 227 } 228 229 static unsigned int cpcap_regulator_get_mode(struct regulator_dev *rdev) 230 { 231 int value; 232 233 regmap_read(rdev->regmap, rdev->desc->enable_reg, &value); 234 235 if (value & CPCAP_BIT_AUDIO_LOW_PWR) 236 return REGULATOR_MODE_STANDBY; 237 238 return REGULATOR_MODE_NORMAL; 239 } 240 241 static int cpcap_regulator_set_mode(struct regulator_dev *rdev, 242 unsigned int mode) 243 { 244 int value; 245 246 switch (mode) { 247 case REGULATOR_MODE_NORMAL: 248 value = CPCAP_BIT_AUDIO_NORMAL_MODE; 249 break; 250 case REGULATOR_MODE_STANDBY: 251 value = CPCAP_BIT_AUDIO_LOW_PWR; 252 break; 253 default: 254 return -EINVAL; 255 } 256 257 return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg, 258 CPCAP_BIT_AUDIO_LOW_PWR, value); 259 } 260 261 static struct regulator_ops cpcap_regulator_ops = { 262 .enable = cpcap_regulator_enable, 263 .disable = cpcap_regulator_disable, 264 .is_enabled = regulator_is_enabled_regmap, 265 .list_voltage = regulator_list_voltage_table, 266 .map_voltage = regulator_map_voltage_iterate, 267 .get_voltage_sel = regulator_get_voltage_sel_regmap, 268 .set_voltage_sel = regulator_set_voltage_sel_regmap, 269 .get_mode = cpcap_regulator_get_mode, 270 .set_mode = cpcap_regulator_set_mode, 271 }; 272 273 static const unsigned int unknown_val_tbl[] = { 0, }; 274 static const unsigned int sw2_sw4_val_tbl[] = { 612500, 625000, 637500, 275 650000, 662500, 675000, 276 687500, 700000, 712500, 277 725000, 737500, 750000, 278 762500, 775000, 787500, 279 800000, 812500, 825000, 280 837500, 850000, 862500, 281 875000, 887500, 900000, 282 912500, 925000, 937500, 283 950000, 962500, 975000, 284 987500, 1000000, 1012500, 285 1025000, 1037500, 1050000, 286 1062500, 1075000, 1087500, 287 1100000, 1112500, 1125000, 288 1137500, 1150000, 1162500, 289 1175000, 1187500, 1200000, 290 1212500, 1225000, 1237500, 291 1250000, 1262500, 1275000, 292 1287500, 1300000, 1312500, 293 1325000, 1337500, 1350000, 294 1362500, 1375000, 1387500, 295 1400000, 1412500, 1425000, 296 1437500, 1450000, 1462500, }; 297 static const unsigned int sw5_val_tbl[] = { 0, 5050000, }; 298 static const unsigned int vcam_val_tbl[] = { 2600000, 2700000, 2800000, 299 2900000, }; 300 static const unsigned int vcsi_val_tbl[] = { 1200000, 1800000, }; 301 static const unsigned int vdac_val_tbl[] = { 1200000, 1500000, 1800000, 302 2500000,}; 303 static const unsigned int vdig_val_tbl[] = { 1200000, 1350000, 1500000, 304 1875000, }; 305 static const unsigned int vfuse_val_tbl[] = { 1500000, 1600000, 1700000, 306 1800000, 1900000, 2000000, 307 2100000, 2200000, 2300000, 308 2400000, 2500000, 2600000, 309 2700000, 3150000, }; 310 static const unsigned int vhvio_val_tbl[] = { 2775000, }; 311 static const unsigned int vsdio_val_tbl[] = { 1500000, 1600000, 1800000, 312 2600000, 2700000, 2800000, 313 2900000, 3000000, }; 314 static const unsigned int vpll_val_tbl[] = { 1200000, 1300000, 1400000, 315 1800000, }; 316 /* Quirk: 2775000 is before 2500000 for vrf1 regulator */ 317 static const unsigned int vrf1_val_tbl[] = { 2775000, 2500000, }; 318 static const unsigned int vrf2_val_tbl[] = { 0, 2775000, }; 319 static const unsigned int vrfref_val_tbl[] = { 2500000, 2775000, }; 320 static const unsigned int vwlan1_val_tbl[] = { 1800000, 1900000, }; 321 static const unsigned int vwlan2_val_tbl[] = { 2775000, 3000000, 3300000, 322 3300000, }; 323 static const unsigned int vsim_val_tbl[] = { 1800000, 2900000, }; 324 static const unsigned int vsimcard_val_tbl[] = { 1800000, 2900000, }; 325 static const unsigned int vvib_val_tbl[] = { 1300000, 1800000, 2000000, 326 3000000, }; 327 static const unsigned int vusb_val_tbl[] = { 0, 3300000, }; 328 static const unsigned int vaudio_val_tbl[] = { 0, 2775000, }; 329 330 /** 331 * SoC specific configuration for omap4. The data below is comes from Motorola 332 * Linux kernel tree. It's basically the values of cpcap_regltr_data, 333 * cpcap_regulator_mode_values and cpcap_regulator_off_mode_values, see 334 * CPCAP_REG macro above. 335 * 336 * SW1 to SW4 and SW6 seems to be unused for mapphone. Note that VSIM and 337 * VSIMCARD have a shared resource assignment bit. 338 */ 339 static struct cpcap_regulator omap4_regulators[] = { 340 CPCAP_REG(SW1, CPCAP_REG_S1C1, CPCAP_REG_ASSIGN2, 341 CPCAP_BIT_SW1_SEL, unknown_val_tbl, 342 0, 0, 0, 0, 0, 0), 343 CPCAP_REG(SW2, CPCAP_REG_S2C1, CPCAP_REG_ASSIGN2, 344 CPCAP_BIT_SW2_SEL, unknown_val_tbl, 345 0, 0, 0, 0, 0, 0), 346 CPCAP_REG(SW3, CPCAP_REG_S3C, CPCAP_REG_ASSIGN2, 347 CPCAP_BIT_SW3_SEL, unknown_val_tbl, 348 0, 0, 0, 0, 0, 0), 349 CPCAP_REG(SW4, CPCAP_REG_S4C1, CPCAP_REG_ASSIGN2, 350 CPCAP_BIT_SW4_SEL, unknown_val_tbl, 351 0, 0, 0, 0, 0, 0), 352 CPCAP_REG(SW5, CPCAP_REG_S5C, CPCAP_REG_ASSIGN2, 353 CPCAP_BIT_SW5_SEL, sw5_val_tbl, 354 0x28, 0, 0, 0x20 | CPCAP_REG_OFF_MODE_SEC, 0, 0), 355 CPCAP_REG(SW6, CPCAP_REG_S6C, CPCAP_REG_ASSIGN2, 356 CPCAP_BIT_SW6_SEL, unknown_val_tbl, 357 0, 0, 0, 0, 0, 0), 358 CPCAP_REG(VCAM, CPCAP_REG_VCAMC, CPCAP_REG_ASSIGN2, 359 CPCAP_BIT_VCAM_SEL, vcam_val_tbl, 360 0x87, 0x30, 4, 0x3, 0, 420), 361 CPCAP_REG(VCSI, CPCAP_REG_VCSIC, CPCAP_REG_ASSIGN3, 362 CPCAP_BIT_VCSI_SEL, vcsi_val_tbl, 363 0x47, 0x10, 4, 0x43, 0x41, 350), 364 CPCAP_REG(VDAC, CPCAP_REG_VDACC, CPCAP_REG_ASSIGN3, 365 CPCAP_BIT_VDAC_SEL, vdac_val_tbl, 366 0x87, 0x30, 4, 0x3, 0, 420), 367 CPCAP_REG(VDIG, CPCAP_REG_VDIGC, CPCAP_REG_ASSIGN2, 368 CPCAP_BIT_VDIG_SEL, vdig_val_tbl, 369 0x87, 0x30, 4, 0x82, 0, 420), 370 CPCAP_REG(VFUSE, CPCAP_REG_VFUSEC, CPCAP_REG_ASSIGN3, 371 CPCAP_BIT_VFUSE_SEL, vfuse_val_tbl, 372 0x80, 0xf, 0, 0x80, 0, 420), 373 CPCAP_REG(VHVIO, CPCAP_REG_VHVIOC, CPCAP_REG_ASSIGN3, 374 CPCAP_BIT_VHVIO_SEL, vhvio_val_tbl, 375 0x17, 0, 0, 0, 0x12, 0), 376 CPCAP_REG(VSDIO, CPCAP_REG_VSDIOC, CPCAP_REG_ASSIGN2, 377 CPCAP_BIT_VSDIO_SEL, vsdio_val_tbl, 378 0x87, 0x38, 3, 0x82, 0, 420), 379 CPCAP_REG(VPLL, CPCAP_REG_VPLLC, CPCAP_REG_ASSIGN3, 380 CPCAP_BIT_VPLL_SEL, vpll_val_tbl, 381 0x43, 0x18, 3, 0x2, 0, 420), 382 CPCAP_REG(VRF1, CPCAP_REG_VRF1C, CPCAP_REG_ASSIGN3, 383 CPCAP_BIT_VRF1_SEL, vrf1_val_tbl, 384 0xac, 0x2, 1, 0x4, 0, 10), 385 CPCAP_REG(VRF2, CPCAP_REG_VRF2C, CPCAP_REG_ASSIGN3, 386 CPCAP_BIT_VRF2_SEL, vrf2_val_tbl, 387 0x23, 0x8, 3, 0, 0, 10), 388 CPCAP_REG(VRFREF, CPCAP_REG_VRFREFC, CPCAP_REG_ASSIGN3, 389 CPCAP_BIT_VRFREF_SEL, vrfref_val_tbl, 390 0x23, 0x8, 3, 0, 0, 420), 391 CPCAP_REG(VWLAN1, CPCAP_REG_VWLAN1C, CPCAP_REG_ASSIGN3, 392 CPCAP_BIT_VWLAN1_SEL, vwlan1_val_tbl, 393 0x47, 0x10, 4, 0, 0, 420), 394 CPCAP_REG(VWLAN2, CPCAP_REG_VWLAN2C, CPCAP_REG_ASSIGN3, 395 CPCAP_BIT_VWLAN2_SEL, vwlan2_val_tbl, 396 0x20c, 0xc0, 6, 0x20c, 0, 420), 397 CPCAP_REG(VSIM, CPCAP_REG_VSIMC, CPCAP_REG_ASSIGN3, 398 0xffff, vsim_val_tbl, 399 0x23, 0x8, 3, 0x3, 0, 420), 400 CPCAP_REG(VSIMCARD, CPCAP_REG_VSIMC, CPCAP_REG_ASSIGN3, 401 0xffff, vsimcard_val_tbl, 402 0x1e80, 0x8, 3, 0x1e00, 0, 420), 403 CPCAP_REG(VVIB, CPCAP_REG_VVIBC, CPCAP_REG_ASSIGN3, 404 CPCAP_BIT_VVIB_SEL, vvib_val_tbl, 405 0x1, 0xc, 2, 0x1, 0, 500), 406 CPCAP_REG(VUSB, CPCAP_REG_VUSBC, CPCAP_REG_ASSIGN3, 407 CPCAP_BIT_VUSB_SEL, vusb_val_tbl, 408 0x11c, 0x40, 6, 0xc, 0, 0), 409 CPCAP_REG(VAUDIO, CPCAP_REG_VAUDIOC, CPCAP_REG_ASSIGN4, 410 CPCAP_BIT_VAUDIO_SEL, vaudio_val_tbl, 411 0x16, 0x1, 0, 0x4, 0, 0), 412 { /* sentinel */ }, 413 }; 414 415 static struct cpcap_regulator xoom_regulators[] = { 416 CPCAP_REG(SW1, CPCAP_REG_S1C1, CPCAP_REG_ASSIGN2, 417 CPCAP_BIT_SW1_SEL, unknown_val_tbl, 418 0, 0, 0, 0, 0, 0), 419 CPCAP_REG(SW2, CPCAP_REG_S2C1, CPCAP_REG_ASSIGN2, 420 CPCAP_BIT_SW2_SEL, sw2_sw4_val_tbl, 421 0xf00, 0x7f, 0, 0x800, 0, 120), 422 CPCAP_REG(SW3, CPCAP_REG_S3C, CPCAP_REG_ASSIGN2, 423 CPCAP_BIT_SW3_SEL, unknown_val_tbl, 424 0, 0, 0, 0, 0, 0), 425 CPCAP_REG(SW4, CPCAP_REG_S4C1, CPCAP_REG_ASSIGN2, 426 CPCAP_BIT_SW4_SEL, sw2_sw4_val_tbl, 427 0xf00, 0x7f, 0, 0x900, 0, 100), 428 CPCAP_REG(SW5, CPCAP_REG_S5C, CPCAP_REG_ASSIGN2, 429 CPCAP_BIT_SW5_SEL, sw5_val_tbl, 430 0x2a, 0, 0, 0x22, 0, 0), 431 CPCAP_REG(SW6, CPCAP_REG_S6C, CPCAP_REG_ASSIGN2, 432 CPCAP_BIT_SW6_SEL, unknown_val_tbl, 433 0, 0, 0, 0, 0, 0), 434 CPCAP_REG(VCAM, CPCAP_REG_VCAMC, CPCAP_REG_ASSIGN2, 435 CPCAP_BIT_VCAM_SEL, vcam_val_tbl, 436 0x87, 0x30, 4, 0x7, 0, 420), 437 CPCAP_REG(VCSI, CPCAP_REG_VCSIC, CPCAP_REG_ASSIGN3, 438 CPCAP_BIT_VCSI_SEL, vcsi_val_tbl, 439 0x47, 0x10, 4, 0x7, 0, 350), 440 CPCAP_REG(VDAC, CPCAP_REG_VDACC, CPCAP_REG_ASSIGN3, 441 CPCAP_BIT_VDAC_SEL, vdac_val_tbl, 442 0x87, 0x30, 4, 0x3, 0, 420), 443 CPCAP_REG(VDIG, CPCAP_REG_VDIGC, CPCAP_REG_ASSIGN2, 444 CPCAP_BIT_VDIG_SEL, vdig_val_tbl, 445 0x87, 0x30, 4, 0x5, 0, 420), 446 CPCAP_REG(VFUSE, CPCAP_REG_VFUSEC, CPCAP_REG_ASSIGN3, 447 CPCAP_BIT_VFUSE_SEL, vfuse_val_tbl, 448 0x80, 0xf, 0, 0x80, 0, 420), 449 CPCAP_REG(VHVIO, CPCAP_REG_VHVIOC, CPCAP_REG_ASSIGN3, 450 CPCAP_BIT_VHVIO_SEL, vhvio_val_tbl, 451 0x17, 0, 0, 0x2, 0, 0), 452 CPCAP_REG(VSDIO, CPCAP_REG_VSDIOC, CPCAP_REG_ASSIGN2, 453 CPCAP_BIT_VSDIO_SEL, vsdio_val_tbl, 454 0x87, 0x38, 3, 0x2, 0, 420), 455 CPCAP_REG(VPLL, CPCAP_REG_VPLLC, CPCAP_REG_ASSIGN3, 456 CPCAP_BIT_VPLL_SEL, vpll_val_tbl, 457 0x43, 0x18, 3, 0x1, 0, 420), 458 CPCAP_REG(VRF1, CPCAP_REG_VRF1C, CPCAP_REG_ASSIGN3, 459 CPCAP_BIT_VRF1_SEL, vrf1_val_tbl, 460 0xac, 0x2, 1, 0xc, 0, 10), 461 CPCAP_REG(VRF2, CPCAP_REG_VRF2C, CPCAP_REG_ASSIGN3, 462 CPCAP_BIT_VRF2_SEL, vrf2_val_tbl, 463 0x23, 0x8, 3, 0x3, 0, 10), 464 CPCAP_REG(VRFREF, CPCAP_REG_VRFREFC, CPCAP_REG_ASSIGN3, 465 CPCAP_BIT_VRFREF_SEL, vrfref_val_tbl, 466 0x23, 0x8, 3, 0x3, 0, 420), 467 CPCAP_REG(VWLAN1, CPCAP_REG_VWLAN1C, CPCAP_REG_ASSIGN3, 468 CPCAP_BIT_VWLAN1_SEL, vwlan1_val_tbl, 469 0x47, 0x10, 4, 0x5, 0, 420), 470 CPCAP_REG(VWLAN2, CPCAP_REG_VWLAN2C, CPCAP_REG_ASSIGN3, 471 CPCAP_BIT_VWLAN2_SEL, vwlan2_val_tbl, 472 0x20c, 0xc0, 6, 0x8, 0, 420), 473 CPCAP_REG(VSIM, CPCAP_REG_VSIMC, CPCAP_REG_ASSIGN3, 474 0xffff, vsim_val_tbl, 475 0x23, 0x8, 3, 0x3, 0, 420), 476 CPCAP_REG(VSIMCARD, CPCAP_REG_VSIMC, CPCAP_REG_ASSIGN3, 477 0xffff, vsimcard_val_tbl, 478 0x1e80, 0x8, 3, 0x1e00, 0, 420), 479 CPCAP_REG(VVIB, CPCAP_REG_VVIBC, CPCAP_REG_ASSIGN3, 480 CPCAP_BIT_VVIB_SEL, vvib_val_tbl, 481 0x1, 0xc, 2, 0, 0x1, 500), 482 CPCAP_REG(VUSB, CPCAP_REG_VUSBC, CPCAP_REG_ASSIGN3, 483 CPCAP_BIT_VUSB_SEL, vusb_val_tbl, 484 0x11c, 0x40, 6, 0xc, 0, 0), 485 CPCAP_REG(VAUDIO, CPCAP_REG_VAUDIOC, CPCAP_REG_ASSIGN4, 486 CPCAP_BIT_VAUDIO_SEL, vaudio_val_tbl, 487 0x16, 0x1, 0, 0x4, 0, 0), 488 { /* sentinel */ }, 489 }; 490 491 static const struct of_device_id cpcap_regulator_id_table[] = { 492 { 493 .compatible = "motorola,cpcap-regulator", 494 }, 495 { 496 .compatible = "motorola,mapphone-cpcap-regulator", 497 .data = omap4_regulators, 498 }, 499 { 500 .compatible = "motorola,xoom-cpcap-regulator", 501 .data = xoom_regulators, 502 }, 503 {}, 504 }; 505 MODULE_DEVICE_TABLE(of, cpcap_regulator_id_table); 506 507 static int cpcap_regulator_probe(struct platform_device *pdev) 508 { 509 struct cpcap_ddata *ddata; 510 const struct of_device_id *match; 511 struct regulator_config config; 512 struct regulator_init_data init_data; 513 int i; 514 515 match = of_match_device(of_match_ptr(cpcap_regulator_id_table), 516 &pdev->dev); 517 if (!match) 518 return -EINVAL; 519 520 if (!match->data) { 521 dev_err(&pdev->dev, "no configuration data found\n"); 522 523 return -ENODEV; 524 } 525 526 ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL); 527 if (!ddata) 528 return -ENOMEM; 529 530 ddata->reg = dev_get_regmap(pdev->dev.parent, NULL); 531 if (!ddata->reg) 532 return -ENODEV; 533 534 ddata->dev = &pdev->dev; 535 ddata->soc = match->data; 536 platform_set_drvdata(pdev, ddata); 537 538 memset(&config, 0, sizeof(config)); 539 memset(&init_data, 0, sizeof(init_data)); 540 config.dev = &pdev->dev; 541 config.regmap = ddata->reg; 542 config.init_data = &init_data; 543 544 for (i = 0; i < CPCAP_NR_REGULATORS; i++) { 545 const struct cpcap_regulator *regulator = &ddata->soc[i]; 546 struct regulator_dev *rdev; 547 548 if (!regulator->rdesc.name) 549 break; 550 551 if (regulator->rdesc.volt_table == unknown_val_tbl) 552 continue; 553 554 config.driver_data = (void *)regulator; 555 rdev = devm_regulator_register(&pdev->dev, 556 ®ulator->rdesc, 557 &config); 558 if (IS_ERR(rdev)) { 559 dev_err(&pdev->dev, "failed to register regulator %s\n", 560 regulator->rdesc.name); 561 562 return PTR_ERR(rdev); 563 } 564 } 565 566 return 0; 567 } 568 569 static struct platform_driver cpcap_regulator_driver = { 570 .probe = cpcap_regulator_probe, 571 .driver = { 572 .name = "cpcap-regulator", 573 .of_match_table = of_match_ptr(cpcap_regulator_id_table), 574 }, 575 }; 576 577 module_platform_driver(cpcap_regulator_driver); 578 579 MODULE_ALIAS("platform:cpcap-regulator"); 580 MODULE_AUTHOR("Tony Lindgren <tony@atomide.com>"); 581 MODULE_DESCRIPTION("CPCAP regulator driver"); 582 MODULE_LICENSE("GPL v2"); 583