1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * MFD driver for TWL6040 audio device 4 * 5 * Authors: Misael Lopez Cruz <misael.lopez@ti.com> 6 * Jorge Eduardo Candelaria <jorge.candelaria@ti.com> 7 * Peter Ujfalusi <peter.ujfalusi@ti.com> 8 * 9 * Copyright: (C) 2011 Texas Instruments, Inc. 10 */ 11 12 #include <linux/module.h> 13 #include <linux/types.h> 14 #include <linux/slab.h> 15 #include <linux/kernel.h> 16 #include <linux/err.h> 17 #include <linux/platform_device.h> 18 #include <linux/of.h> 19 #include <linux/gpio/consumer.h> 20 #include <linux/delay.h> 21 #include <linux/i2c.h> 22 #include <linux/regmap.h> 23 #include <linux/mfd/core.h> 24 #include <linux/mfd/twl6040.h> 25 #include <linux/regulator/consumer.h> 26 27 #define VIBRACTRL_MEMBER(reg) ((reg == TWL6040_REG_VIBCTLL) ? 0 : 1) 28 #define TWL6040_NUM_SUPPLIES (2) 29 30 static const struct reg_default twl6040_defaults[] = { 31 { 0x01, 0x4B }, /* REG_ASICID (ro) */ 32 { 0x02, 0x00 }, /* REG_ASICREV (ro) */ 33 { 0x03, 0x00 }, /* REG_INTID */ 34 { 0x04, 0x00 }, /* REG_INTMR */ 35 { 0x05, 0x00 }, /* REG_NCPCTRL */ 36 { 0x06, 0x00 }, /* REG_LDOCTL */ 37 { 0x07, 0x60 }, /* REG_HPPLLCTL */ 38 { 0x08, 0x00 }, /* REG_LPPLLCTL */ 39 { 0x09, 0x4A }, /* REG_LPPLLDIV */ 40 { 0x0A, 0x00 }, /* REG_AMICBCTL */ 41 { 0x0B, 0x00 }, /* REG_DMICBCTL */ 42 { 0x0C, 0x00 }, /* REG_MICLCTL */ 43 { 0x0D, 0x00 }, /* REG_MICRCTL */ 44 { 0x0E, 0x00 }, /* REG_MICGAIN */ 45 { 0x0F, 0x1B }, /* REG_LINEGAIN */ 46 { 0x10, 0x00 }, /* REG_HSLCTL */ 47 { 0x11, 0x00 }, /* REG_HSRCTL */ 48 { 0x12, 0x00 }, /* REG_HSGAIN */ 49 { 0x13, 0x00 }, /* REG_EARCTL */ 50 { 0x14, 0x00 }, /* REG_HFLCTL */ 51 { 0x15, 0x00 }, /* REG_HFLGAIN */ 52 { 0x16, 0x00 }, /* REG_HFRCTL */ 53 { 0x17, 0x00 }, /* REG_HFRGAIN */ 54 { 0x18, 0x00 }, /* REG_VIBCTLL */ 55 { 0x19, 0x00 }, /* REG_VIBDATL */ 56 { 0x1A, 0x00 }, /* REG_VIBCTLR */ 57 { 0x1B, 0x00 }, /* REG_VIBDATR */ 58 { 0x1C, 0x00 }, /* REG_HKCTL1 */ 59 { 0x1D, 0x00 }, /* REG_HKCTL2 */ 60 { 0x1E, 0x00 }, /* REG_GPOCTL */ 61 { 0x1F, 0x00 }, /* REG_ALB */ 62 { 0x20, 0x00 }, /* REG_DLB */ 63 /* 0x28, REG_TRIM1 */ 64 /* 0x29, REG_TRIM2 */ 65 /* 0x2A, REG_TRIM3 */ 66 /* 0x2B, REG_HSOTRIM */ 67 /* 0x2C, REG_HFOTRIM */ 68 { 0x2D, 0x08 }, /* REG_ACCCTL */ 69 { 0x2E, 0x00 }, /* REG_STATUS (ro) */ 70 }; 71 72 static struct reg_sequence twl6040_patch[] = { 73 /* 74 * Select I2C bus access to dual access registers 75 * Interrupt register is cleared on read 76 * Select fast mode for i2c (400KHz) 77 */ 78 { TWL6040_REG_ACCCTL, 79 TWL6040_I2CSEL | TWL6040_INTCLRMODE | TWL6040_I2CMODE(1) }, 80 }; 81 82 83 static bool twl6040_has_vibra(struct device_node *parent) 84 { 85 struct device_node *node; 86 87 node = of_get_child_by_name(parent, "vibra"); 88 if (node) { 89 of_node_put(node); 90 return true; 91 } 92 93 return false; 94 } 95 96 int twl6040_reg_read(struct twl6040 *twl6040, unsigned int reg) 97 { 98 int ret; 99 unsigned int val; 100 101 ret = regmap_read(twl6040->regmap, reg, &val); 102 if (ret < 0) 103 return ret; 104 105 return val; 106 } 107 EXPORT_SYMBOL(twl6040_reg_read); 108 109 int twl6040_reg_write(struct twl6040 *twl6040, unsigned int reg, u8 val) 110 { 111 int ret; 112 113 ret = regmap_write(twl6040->regmap, reg, val); 114 115 return ret; 116 } 117 EXPORT_SYMBOL(twl6040_reg_write); 118 119 int twl6040_set_bits(struct twl6040 *twl6040, unsigned int reg, u8 mask) 120 { 121 return regmap_update_bits(twl6040->regmap, reg, mask, mask); 122 } 123 EXPORT_SYMBOL(twl6040_set_bits); 124 125 int twl6040_clear_bits(struct twl6040 *twl6040, unsigned int reg, u8 mask) 126 { 127 return regmap_update_bits(twl6040->regmap, reg, mask, 0); 128 } 129 EXPORT_SYMBOL(twl6040_clear_bits); 130 131 /* twl6040 codec manual power-up sequence */ 132 static int twl6040_power_up_manual(struct twl6040 *twl6040) 133 { 134 u8 ldoctl, ncpctl, lppllctl; 135 int ret; 136 137 /* enable high-side LDO, reference system and internal oscillator */ 138 ldoctl = TWL6040_HSLDOENA | TWL6040_REFENA | TWL6040_OSCENA; 139 ret = twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl); 140 if (ret) 141 return ret; 142 usleep_range(10000, 10500); 143 144 /* enable negative charge pump */ 145 ncpctl = TWL6040_NCPENA; 146 ret = twl6040_reg_write(twl6040, TWL6040_REG_NCPCTL, ncpctl); 147 if (ret) 148 goto ncp_err; 149 usleep_range(1000, 1500); 150 151 /* enable low-side LDO */ 152 ldoctl |= TWL6040_LSLDOENA; 153 ret = twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl); 154 if (ret) 155 goto lsldo_err; 156 usleep_range(1000, 1500); 157 158 /* enable low-power PLL */ 159 lppllctl = TWL6040_LPLLENA; 160 ret = twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL, lppllctl); 161 if (ret) 162 goto lppll_err; 163 usleep_range(5000, 5500); 164 165 /* disable internal oscillator */ 166 ldoctl &= ~TWL6040_OSCENA; 167 ret = twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl); 168 if (ret) 169 goto osc_err; 170 171 return 0; 172 173 osc_err: 174 lppllctl &= ~TWL6040_LPLLENA; 175 twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL, lppllctl); 176 lppll_err: 177 ldoctl &= ~TWL6040_LSLDOENA; 178 twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl); 179 lsldo_err: 180 ncpctl &= ~TWL6040_NCPENA; 181 twl6040_reg_write(twl6040, TWL6040_REG_NCPCTL, ncpctl); 182 ncp_err: 183 ldoctl &= ~(TWL6040_HSLDOENA | TWL6040_REFENA | TWL6040_OSCENA); 184 twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl); 185 186 dev_err(twl6040->dev, "manual power-up failed\n"); 187 return ret; 188 } 189 190 /* twl6040 manual power-down sequence */ 191 static void twl6040_power_down_manual(struct twl6040 *twl6040) 192 { 193 u8 ncpctl, ldoctl, lppllctl; 194 195 ncpctl = twl6040_reg_read(twl6040, TWL6040_REG_NCPCTL); 196 ldoctl = twl6040_reg_read(twl6040, TWL6040_REG_LDOCTL); 197 lppllctl = twl6040_reg_read(twl6040, TWL6040_REG_LPPLLCTL); 198 199 /* enable internal oscillator */ 200 ldoctl |= TWL6040_OSCENA; 201 twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl); 202 usleep_range(1000, 1500); 203 204 /* disable low-power PLL */ 205 lppllctl &= ~TWL6040_LPLLENA; 206 twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL, lppllctl); 207 208 /* disable low-side LDO */ 209 ldoctl &= ~TWL6040_LSLDOENA; 210 twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl); 211 212 /* disable negative charge pump */ 213 ncpctl &= ~TWL6040_NCPENA; 214 twl6040_reg_write(twl6040, TWL6040_REG_NCPCTL, ncpctl); 215 216 /* disable high-side LDO, reference system and internal oscillator */ 217 ldoctl &= ~(TWL6040_HSLDOENA | TWL6040_REFENA | TWL6040_OSCENA); 218 twl6040_reg_write(twl6040, TWL6040_REG_LDOCTL, ldoctl); 219 } 220 221 static irqreturn_t twl6040_readyint_handler(int irq, void *data) 222 { 223 struct twl6040 *twl6040 = data; 224 225 complete(&twl6040->ready); 226 227 return IRQ_HANDLED; 228 } 229 230 static irqreturn_t twl6040_thint_handler(int irq, void *data) 231 { 232 struct twl6040 *twl6040 = data; 233 u8 status; 234 235 status = twl6040_reg_read(twl6040, TWL6040_REG_STATUS); 236 if (status & TWL6040_TSHUTDET) { 237 dev_warn(twl6040->dev, "Thermal shutdown, powering-off"); 238 twl6040_power(twl6040, 0); 239 } else { 240 dev_warn(twl6040->dev, "Leaving thermal shutdown, powering-on"); 241 twl6040_power(twl6040, 1); 242 } 243 244 return IRQ_HANDLED; 245 } 246 247 static int twl6040_power_up_automatic(struct twl6040 *twl6040) 248 { 249 int time_left; 250 251 gpiod_set_value_cansleep(twl6040->audpwron, 1); 252 253 time_left = wait_for_completion_timeout(&twl6040->ready, 254 msecs_to_jiffies(144)); 255 if (!time_left) { 256 u8 intid; 257 258 dev_warn(twl6040->dev, "timeout waiting for READYINT\n"); 259 intid = twl6040_reg_read(twl6040, TWL6040_REG_INTID); 260 if (!(intid & TWL6040_READYINT)) { 261 dev_err(twl6040->dev, "automatic power-up failed\n"); 262 gpiod_set_value_cansleep(twl6040->audpwron, 0); 263 return -ETIMEDOUT; 264 } 265 } 266 267 return 0; 268 } 269 270 int twl6040_power(struct twl6040 *twl6040, int on) 271 { 272 int ret = 0; 273 274 mutex_lock(&twl6040->mutex); 275 276 if (on) { 277 /* already powered-up */ 278 if (twl6040->power_count++) 279 goto out; 280 281 ret = clk_prepare_enable(twl6040->clk32k); 282 if (ret) { 283 twl6040->power_count = 0; 284 goto out; 285 } 286 287 /* Allow writes to the chip */ 288 regcache_cache_only(twl6040->regmap, false); 289 290 if (twl6040->audpwron) { 291 /* use automatic power-up sequence */ 292 ret = twl6040_power_up_automatic(twl6040); 293 if (ret) { 294 clk_disable_unprepare(twl6040->clk32k); 295 twl6040->power_count = 0; 296 goto out; 297 } 298 } else { 299 /* use manual power-up sequence */ 300 ret = twl6040_power_up_manual(twl6040); 301 if (ret) { 302 clk_disable_unprepare(twl6040->clk32k); 303 twl6040->power_count = 0; 304 goto out; 305 } 306 } 307 308 /* 309 * Register access can produce errors after power-up unless we 310 * wait at least 8ms based on measurements on duovero. 311 */ 312 usleep_range(10000, 12000); 313 314 /* Sync with the HW */ 315 ret = regcache_sync(twl6040->regmap); 316 if (ret) { 317 dev_err(twl6040->dev, "Failed to sync with the HW: %i\n", 318 ret); 319 goto out; 320 } 321 322 /* Default PLL configuration after power up */ 323 twl6040->pll = TWL6040_SYSCLK_SEL_LPPLL; 324 twl6040->sysclk_rate = 19200000; 325 } else { 326 /* already powered-down */ 327 if (!twl6040->power_count) { 328 dev_err(twl6040->dev, 329 "device is already powered-off\n"); 330 ret = -EPERM; 331 goto out; 332 } 333 334 if (--twl6040->power_count) 335 goto out; 336 337 if (twl6040->audpwron) { 338 /* use AUDPWRON line */ 339 gpiod_set_value_cansleep(twl6040->audpwron, 0); 340 341 /* power-down sequence latency */ 342 usleep_range(500, 700); 343 } else { 344 /* use manual power-down sequence */ 345 twl6040_power_down_manual(twl6040); 346 } 347 348 /* Set regmap to cache only and mark it as dirty */ 349 regcache_cache_only(twl6040->regmap, true); 350 regcache_mark_dirty(twl6040->regmap); 351 352 twl6040->sysclk_rate = 0; 353 354 if (twl6040->pll == TWL6040_SYSCLK_SEL_HPPLL) { 355 clk_disable_unprepare(twl6040->mclk); 356 twl6040->mclk_rate = 0; 357 } 358 359 clk_disable_unprepare(twl6040->clk32k); 360 } 361 362 out: 363 mutex_unlock(&twl6040->mutex); 364 return ret; 365 } 366 EXPORT_SYMBOL(twl6040_power); 367 368 int twl6040_set_pll(struct twl6040 *twl6040, int pll_id, 369 unsigned int freq_in, unsigned int freq_out) 370 { 371 u8 hppllctl, lppllctl; 372 int ret = 0; 373 374 mutex_lock(&twl6040->mutex); 375 376 hppllctl = twl6040_reg_read(twl6040, TWL6040_REG_HPPLLCTL); 377 lppllctl = twl6040_reg_read(twl6040, TWL6040_REG_LPPLLCTL); 378 379 /* Force full reconfiguration when switching between PLL */ 380 if (pll_id != twl6040->pll) { 381 twl6040->sysclk_rate = 0; 382 twl6040->mclk_rate = 0; 383 } 384 385 switch (pll_id) { 386 case TWL6040_SYSCLK_SEL_LPPLL: 387 /* low-power PLL divider */ 388 /* Change the sysclk configuration only if it has been canged */ 389 if (twl6040->sysclk_rate != freq_out) { 390 switch (freq_out) { 391 case 17640000: 392 lppllctl |= TWL6040_LPLLFIN; 393 break; 394 case 19200000: 395 lppllctl &= ~TWL6040_LPLLFIN; 396 break; 397 default: 398 dev_err(twl6040->dev, 399 "freq_out %d not supported\n", 400 freq_out); 401 ret = -EINVAL; 402 goto pll_out; 403 } 404 twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL, 405 lppllctl); 406 } 407 408 /* The PLL in use has not been change, we can exit */ 409 if (twl6040->pll == pll_id) 410 break; 411 412 switch (freq_in) { 413 case 32768: 414 lppllctl |= TWL6040_LPLLENA; 415 twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL, 416 lppllctl); 417 mdelay(5); 418 lppllctl &= ~TWL6040_HPLLSEL; 419 twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL, 420 lppllctl); 421 hppllctl &= ~TWL6040_HPLLENA; 422 twl6040_reg_write(twl6040, TWL6040_REG_HPPLLCTL, 423 hppllctl); 424 break; 425 default: 426 dev_err(twl6040->dev, 427 "freq_in %d not supported\n", freq_in); 428 ret = -EINVAL; 429 goto pll_out; 430 } 431 432 clk_disable_unprepare(twl6040->mclk); 433 break; 434 case TWL6040_SYSCLK_SEL_HPPLL: 435 /* high-performance PLL can provide only 19.2 MHz */ 436 if (freq_out != 19200000) { 437 dev_err(twl6040->dev, 438 "freq_out %d not supported\n", freq_out); 439 ret = -EINVAL; 440 goto pll_out; 441 } 442 443 if (twl6040->mclk_rate != freq_in) { 444 hppllctl &= ~TWL6040_MCLK_MSK; 445 446 switch (freq_in) { 447 case 12000000: 448 /* PLL enabled, active mode */ 449 hppllctl |= TWL6040_MCLK_12000KHZ | 450 TWL6040_HPLLENA; 451 break; 452 case 19200000: 453 /* PLL enabled, bypass mode */ 454 hppllctl |= TWL6040_MCLK_19200KHZ | 455 TWL6040_HPLLBP | TWL6040_HPLLENA; 456 break; 457 case 26000000: 458 /* PLL enabled, active mode */ 459 hppllctl |= TWL6040_MCLK_26000KHZ | 460 TWL6040_HPLLENA; 461 break; 462 case 38400000: 463 /* PLL enabled, bypass mode */ 464 hppllctl |= TWL6040_MCLK_38400KHZ | 465 TWL6040_HPLLBP | TWL6040_HPLLENA; 466 break; 467 default: 468 dev_err(twl6040->dev, 469 "freq_in %d not supported\n", freq_in); 470 ret = -EINVAL; 471 goto pll_out; 472 } 473 474 /* When switching to HPPLL, enable the mclk first */ 475 if (pll_id != twl6040->pll) 476 clk_prepare_enable(twl6040->mclk); 477 /* 478 * enable clock slicer to ensure input waveform is 479 * square 480 */ 481 hppllctl |= TWL6040_HPLLSQRENA; 482 483 twl6040_reg_write(twl6040, TWL6040_REG_HPPLLCTL, 484 hppllctl); 485 usleep_range(500, 700); 486 lppllctl |= TWL6040_HPLLSEL; 487 twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL, 488 lppllctl); 489 lppllctl &= ~TWL6040_LPLLENA; 490 twl6040_reg_write(twl6040, TWL6040_REG_LPPLLCTL, 491 lppllctl); 492 493 twl6040->mclk_rate = freq_in; 494 } 495 break; 496 default: 497 dev_err(twl6040->dev, "unknown pll id %d\n", pll_id); 498 ret = -EINVAL; 499 goto pll_out; 500 } 501 502 twl6040->sysclk_rate = freq_out; 503 twl6040->pll = pll_id; 504 505 pll_out: 506 mutex_unlock(&twl6040->mutex); 507 return ret; 508 } 509 EXPORT_SYMBOL(twl6040_set_pll); 510 511 int twl6040_get_pll(struct twl6040 *twl6040) 512 { 513 if (twl6040->power_count) 514 return twl6040->pll; 515 else 516 return -ENODEV; 517 } 518 EXPORT_SYMBOL(twl6040_get_pll); 519 520 unsigned int twl6040_get_sysclk(struct twl6040 *twl6040) 521 { 522 return twl6040->sysclk_rate; 523 } 524 EXPORT_SYMBOL(twl6040_get_sysclk); 525 526 /* Get the combined status of the vibra control register */ 527 int twl6040_get_vibralr_status(struct twl6040 *twl6040) 528 { 529 unsigned int reg; 530 int ret; 531 u8 status; 532 533 ret = regmap_read(twl6040->regmap, TWL6040_REG_VIBCTLL, ®); 534 if (ret != 0) 535 return ret; 536 status = reg; 537 538 ret = regmap_read(twl6040->regmap, TWL6040_REG_VIBCTLR, ®); 539 if (ret != 0) 540 return ret; 541 status |= reg; 542 543 status &= (TWL6040_VIBENA | TWL6040_VIBSEL); 544 545 return status; 546 } 547 EXPORT_SYMBOL(twl6040_get_vibralr_status); 548 549 static struct resource twl6040_vibra_rsrc[] = { 550 { 551 .flags = IORESOURCE_IRQ, 552 }, 553 }; 554 555 static struct resource twl6040_codec_rsrc[] = { 556 { 557 .flags = IORESOURCE_IRQ, 558 }, 559 }; 560 561 static bool twl6040_readable_reg(struct device *dev, unsigned int reg) 562 { 563 /* Register 0 is not readable */ 564 if (!reg) 565 return false; 566 return true; 567 } 568 569 static bool twl6040_volatile_reg(struct device *dev, unsigned int reg) 570 { 571 switch (reg) { 572 case TWL6040_REG_ASICID: 573 case TWL6040_REG_ASICREV: 574 case TWL6040_REG_INTID: 575 case TWL6040_REG_LPPLLCTL: 576 case TWL6040_REG_HPPLLCTL: 577 case TWL6040_REG_STATUS: 578 return true; 579 default: 580 return false; 581 } 582 } 583 584 static bool twl6040_writeable_reg(struct device *dev, unsigned int reg) 585 { 586 switch (reg) { 587 case TWL6040_REG_ASICID: 588 case TWL6040_REG_ASICREV: 589 case TWL6040_REG_STATUS: 590 return false; 591 default: 592 return true; 593 } 594 } 595 596 static const struct regmap_config twl6040_regmap_config = { 597 .reg_bits = 8, 598 .val_bits = 8, 599 600 .reg_defaults = twl6040_defaults, 601 .num_reg_defaults = ARRAY_SIZE(twl6040_defaults), 602 603 .max_register = TWL6040_REG_STATUS, /* 0x2e */ 604 605 .readable_reg = twl6040_readable_reg, 606 .volatile_reg = twl6040_volatile_reg, 607 .writeable_reg = twl6040_writeable_reg, 608 609 .cache_type = REGCACHE_MAPLE, 610 .use_single_read = true, 611 .use_single_write = true, 612 }; 613 614 static const struct regmap_irq twl6040_irqs[] = { 615 { .reg_offset = 0, .mask = TWL6040_THINT, }, 616 { .reg_offset = 0, .mask = TWL6040_PLUGINT | TWL6040_UNPLUGINT, }, 617 { .reg_offset = 0, .mask = TWL6040_HOOKINT, }, 618 { .reg_offset = 0, .mask = TWL6040_HFINT, }, 619 { .reg_offset = 0, .mask = TWL6040_VIBINT, }, 620 { .reg_offset = 0, .mask = TWL6040_READYINT, }, 621 }; 622 623 static struct regmap_irq_chip twl6040_irq_chip = { 624 .name = "twl6040", 625 .irqs = twl6040_irqs, 626 .num_irqs = ARRAY_SIZE(twl6040_irqs), 627 628 .num_regs = 1, 629 .status_base = TWL6040_REG_INTID, 630 .mask_base = TWL6040_REG_INTMR, 631 }; 632 633 static int twl6040_probe(struct i2c_client *client) 634 { 635 struct device_node *node = client->dev.of_node; 636 struct twl6040 *twl6040; 637 struct mfd_cell *cell = NULL; 638 int irq, ret, children = 0; 639 640 if (!node) { 641 dev_err(&client->dev, "of node is missing\n"); 642 return -EINVAL; 643 } 644 645 /* In order to operate correctly we need valid interrupt config */ 646 if (!client->irq) { 647 dev_err(&client->dev, "Invalid IRQ configuration\n"); 648 return -EINVAL; 649 } 650 651 twl6040 = devm_kzalloc(&client->dev, sizeof(struct twl6040), 652 GFP_KERNEL); 653 if (!twl6040) 654 return -ENOMEM; 655 656 twl6040->regmap = devm_regmap_init_i2c(client, &twl6040_regmap_config); 657 if (IS_ERR(twl6040->regmap)) 658 return PTR_ERR(twl6040->regmap); 659 660 i2c_set_clientdata(client, twl6040); 661 662 twl6040->clk32k = devm_clk_get(&client->dev, "clk32k"); 663 if (IS_ERR(twl6040->clk32k)) { 664 if (PTR_ERR(twl6040->clk32k) == -EPROBE_DEFER) 665 return -EPROBE_DEFER; 666 dev_dbg(&client->dev, "clk32k is not handled\n"); 667 twl6040->clk32k = NULL; 668 } 669 670 twl6040->mclk = devm_clk_get(&client->dev, "mclk"); 671 if (IS_ERR(twl6040->mclk)) { 672 if (PTR_ERR(twl6040->mclk) == -EPROBE_DEFER) 673 return -EPROBE_DEFER; 674 dev_dbg(&client->dev, "mclk is not handled\n"); 675 twl6040->mclk = NULL; 676 } 677 678 twl6040->supplies[0].supply = "vio"; 679 twl6040->supplies[1].supply = "v2v1"; 680 ret = devm_regulator_bulk_get(&client->dev, TWL6040_NUM_SUPPLIES, 681 twl6040->supplies); 682 if (ret != 0) { 683 dev_err(&client->dev, "Failed to get supplies: %d\n", ret); 684 return ret; 685 } 686 687 ret = regulator_bulk_enable(TWL6040_NUM_SUPPLIES, twl6040->supplies); 688 if (ret != 0) { 689 dev_err(&client->dev, "Failed to enable supplies: %d\n", ret); 690 return ret; 691 } 692 693 twl6040->dev = &client->dev; 694 twl6040->irq = client->irq; 695 696 mutex_init(&twl6040->mutex); 697 init_completion(&twl6040->ready); 698 699 regmap_register_patch(twl6040->regmap, twl6040_patch, 700 ARRAY_SIZE(twl6040_patch)); 701 702 twl6040->rev = twl6040_reg_read(twl6040, TWL6040_REG_ASICREV); 703 if (twl6040->rev < 0) { 704 dev_err(&client->dev, "Failed to read revision register: %d\n", 705 twl6040->rev); 706 ret = twl6040->rev; 707 goto gpio_err; 708 } 709 710 /* ERRATA: Automatic power-up is not possible in ES1.0 */ 711 if (twl6040_get_revid(twl6040) > TWL6040_REV_ES1_0) { 712 twl6040->audpwron = devm_gpiod_get_optional(&client->dev, 713 "ti,audpwron", 714 GPIOD_OUT_LOW); 715 ret = PTR_ERR_OR_ZERO(twl6040->audpwron); 716 if (ret) 717 goto gpio_err; 718 719 gpiod_set_consumer_name(twl6040->audpwron, "audpwron"); 720 721 /* Clear any pending interrupt */ 722 twl6040_reg_read(twl6040, TWL6040_REG_INTID); 723 } 724 725 ret = regmap_add_irq_chip(twl6040->regmap, twl6040->irq, IRQF_ONESHOT, 726 0, &twl6040_irq_chip, &twl6040->irq_data); 727 if (ret < 0) 728 goto gpio_err; 729 730 twl6040->irq_ready = regmap_irq_get_virq(twl6040->irq_data, 731 TWL6040_IRQ_READY); 732 twl6040->irq_th = regmap_irq_get_virq(twl6040->irq_data, 733 TWL6040_IRQ_TH); 734 735 ret = devm_request_threaded_irq(twl6040->dev, twl6040->irq_ready, NULL, 736 twl6040_readyint_handler, IRQF_ONESHOT, 737 "twl6040_irq_ready", twl6040); 738 if (ret) { 739 dev_err(twl6040->dev, "READY IRQ request failed: %d\n", ret); 740 goto readyirq_err; 741 } 742 743 ret = devm_request_threaded_irq(twl6040->dev, twl6040->irq_th, NULL, 744 twl6040_thint_handler, IRQF_ONESHOT, 745 "twl6040_irq_th", twl6040); 746 if (ret) { 747 dev_err(twl6040->dev, "Thermal IRQ request failed: %d\n", ret); 748 goto readyirq_err; 749 } 750 751 /* 752 * The main functionality of twl6040 to provide audio on OMAP4+ systems. 753 * We can add the ASoC codec child whenever this driver has been loaded. 754 */ 755 irq = regmap_irq_get_virq(twl6040->irq_data, TWL6040_IRQ_PLUG); 756 cell = &twl6040->cells[children]; 757 cell->name = "twl6040-codec"; 758 twl6040_codec_rsrc[0].start = irq; 759 twl6040_codec_rsrc[0].end = irq; 760 cell->resources = twl6040_codec_rsrc; 761 cell->num_resources = ARRAY_SIZE(twl6040_codec_rsrc); 762 children++; 763 764 /* Vibra input driver support */ 765 if (twl6040_has_vibra(node)) { 766 irq = regmap_irq_get_virq(twl6040->irq_data, TWL6040_IRQ_VIB); 767 768 cell = &twl6040->cells[children]; 769 cell->name = "twl6040-vibra"; 770 twl6040_vibra_rsrc[0].start = irq; 771 twl6040_vibra_rsrc[0].end = irq; 772 cell->resources = twl6040_vibra_rsrc; 773 cell->num_resources = ARRAY_SIZE(twl6040_vibra_rsrc); 774 children++; 775 } 776 777 /* GPO support */ 778 cell = &twl6040->cells[children]; 779 cell->name = "twl6040-gpo"; 780 children++; 781 782 /* PDM clock support */ 783 cell = &twl6040->cells[children]; 784 cell->name = "twl6040-pdmclk"; 785 children++; 786 787 /* The chip is powered down so mark regmap to cache only and dirty */ 788 regcache_cache_only(twl6040->regmap, true); 789 regcache_mark_dirty(twl6040->regmap); 790 791 ret = mfd_add_devices(&client->dev, -1, twl6040->cells, children, 792 NULL, 0, NULL); 793 if (ret) 794 goto readyirq_err; 795 796 return 0; 797 798 readyirq_err: 799 regmap_del_irq_chip(twl6040->irq, twl6040->irq_data); 800 gpio_err: 801 regulator_bulk_disable(TWL6040_NUM_SUPPLIES, twl6040->supplies); 802 return ret; 803 } 804 805 static void twl6040_remove(struct i2c_client *client) 806 { 807 struct twl6040 *twl6040 = i2c_get_clientdata(client); 808 809 if (twl6040->power_count) 810 twl6040_power(twl6040, 0); 811 812 regmap_del_irq_chip(twl6040->irq, twl6040->irq_data); 813 814 mfd_remove_devices(&client->dev); 815 816 regulator_bulk_disable(TWL6040_NUM_SUPPLIES, twl6040->supplies); 817 } 818 819 static const struct i2c_device_id twl6040_i2c_id[] = { 820 { "twl6040", 0, }, 821 { "twl6041", 0, }, 822 { }, 823 }; 824 MODULE_DEVICE_TABLE(i2c, twl6040_i2c_id); 825 826 static struct i2c_driver twl6040_driver = { 827 .driver = { 828 .name = "twl6040", 829 }, 830 .probe = twl6040_probe, 831 .remove = twl6040_remove, 832 .id_table = twl6040_i2c_id, 833 }; 834 835 module_i2c_driver(twl6040_driver); 836 837 MODULE_DESCRIPTION("TWL6040 MFD"); 838 MODULE_AUTHOR("Misael Lopez Cruz <misael.lopez@ti.com>"); 839 MODULE_AUTHOR("Jorge Eduardo Candelaria <jorge.candelaria@ti.com>"); 840