1 /* 2 * wm8994-core.c -- Device access for Wolfson WM8994 3 * 4 * Copyright 2009 Wolfson Microelectronics PLC. 5 * 6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com> 7 * 8 * This program is free software; you can redistribute it and/or modify it 9 * under the terms of the GNU General Public License as published by the 10 * Free Software Foundation; either version 2 of the License, or (at your 11 * option) any later version. 12 * 13 */ 14 15 #include <linux/kernel.h> 16 #include <linux/module.h> 17 #include <linux/slab.h> 18 #include <linux/i2c.h> 19 #include <linux/err.h> 20 #include <linux/delay.h> 21 #include <linux/mfd/core.h> 22 #include <linux/of.h> 23 #include <linux/of_device.h> 24 #include <linux/of_gpio.h> 25 #include <linux/pm_runtime.h> 26 #include <linux/regmap.h> 27 #include <linux/regulator/consumer.h> 28 #include <linux/regulator/machine.h> 29 30 #include <linux/mfd/wm8994/core.h> 31 #include <linux/mfd/wm8994/pdata.h> 32 #include <linux/mfd/wm8994/registers.h> 33 34 #include "wm8994.h" 35 36 /** 37 * wm8994_reg_read: Read a single WM8994 register. 38 * 39 * @wm8994: Device to read from. 40 * @reg: Register to read. 41 */ 42 int wm8994_reg_read(struct wm8994 *wm8994, unsigned short reg) 43 { 44 unsigned int val; 45 int ret; 46 47 ret = regmap_read(wm8994->regmap, reg, &val); 48 49 if (ret < 0) 50 return ret; 51 else 52 return val; 53 } 54 EXPORT_SYMBOL_GPL(wm8994_reg_read); 55 56 /** 57 * wm8994_bulk_read: Read multiple WM8994 registers 58 * 59 * @wm8994: Device to read from 60 * @reg: First register 61 * @count: Number of registers 62 * @buf: Buffer to fill. The data will be returned big endian. 63 */ 64 int wm8994_bulk_read(struct wm8994 *wm8994, unsigned short reg, 65 int count, u16 *buf) 66 { 67 return regmap_bulk_read(wm8994->regmap, reg, buf, count); 68 } 69 70 /** 71 * wm8994_reg_write: Write a single WM8994 register. 72 * 73 * @wm8994: Device to write to. 74 * @reg: Register to write to. 75 * @val: Value to write. 76 */ 77 int wm8994_reg_write(struct wm8994 *wm8994, unsigned short reg, 78 unsigned short val) 79 { 80 return regmap_write(wm8994->regmap, reg, val); 81 } 82 EXPORT_SYMBOL_GPL(wm8994_reg_write); 83 84 /** 85 * wm8994_bulk_write: Write multiple WM8994 registers 86 * 87 * @wm8994: Device to write to 88 * @reg: First register 89 * @count: Number of registers 90 * @buf: Buffer to write from. Data must be big-endian formatted. 91 */ 92 int wm8994_bulk_write(struct wm8994 *wm8994, unsigned short reg, 93 int count, const u16 *buf) 94 { 95 return regmap_raw_write(wm8994->regmap, reg, buf, count * sizeof(u16)); 96 } 97 EXPORT_SYMBOL_GPL(wm8994_bulk_write); 98 99 /** 100 * wm8994_set_bits: Set the value of a bitfield in a WM8994 register 101 * 102 * @wm8994: Device to write to. 103 * @reg: Register to write to. 104 * @mask: Mask of bits to set. 105 * @val: Value to set (unshifted) 106 */ 107 int wm8994_set_bits(struct wm8994 *wm8994, unsigned short reg, 108 unsigned short mask, unsigned short val) 109 { 110 return regmap_update_bits(wm8994->regmap, reg, mask, val); 111 } 112 EXPORT_SYMBOL_GPL(wm8994_set_bits); 113 114 static struct mfd_cell wm8994_regulator_devs[] = { 115 { 116 .name = "wm8994-ldo", 117 .id = 1, 118 .pm_runtime_no_callbacks = true, 119 }, 120 { 121 .name = "wm8994-ldo", 122 .id = 2, 123 .pm_runtime_no_callbacks = true, 124 }, 125 }; 126 127 static struct resource wm8994_codec_resources[] = { 128 { 129 .start = WM8994_IRQ_TEMP_SHUT, 130 .end = WM8994_IRQ_TEMP_WARN, 131 .flags = IORESOURCE_IRQ, 132 }, 133 }; 134 135 static struct resource wm8994_gpio_resources[] = { 136 { 137 .start = WM8994_IRQ_GPIO(1), 138 .end = WM8994_IRQ_GPIO(11), 139 .flags = IORESOURCE_IRQ, 140 }, 141 }; 142 143 static struct mfd_cell wm8994_devs[] = { 144 { 145 .name = "wm8994-codec", 146 .num_resources = ARRAY_SIZE(wm8994_codec_resources), 147 .resources = wm8994_codec_resources, 148 }, 149 150 { 151 .name = "wm8994-gpio", 152 .num_resources = ARRAY_SIZE(wm8994_gpio_resources), 153 .resources = wm8994_gpio_resources, 154 .pm_runtime_no_callbacks = true, 155 }, 156 }; 157 158 /* 159 * Supplies for the main bulk of CODEC; the LDO supplies are ignored 160 * and should be handled via the standard regulator API supply 161 * management. 162 */ 163 static const char *wm1811_main_supplies[] = { 164 "DBVDD1", 165 "DBVDD2", 166 "DBVDD3", 167 "DCVDD", 168 "AVDD1", 169 "AVDD2", 170 "CPVDD", 171 "SPKVDD1", 172 "SPKVDD2", 173 }; 174 175 static const char *wm8994_main_supplies[] = { 176 "DBVDD", 177 "DCVDD", 178 "AVDD1", 179 "AVDD2", 180 "CPVDD", 181 "SPKVDD1", 182 "SPKVDD2", 183 }; 184 185 static const char *wm8958_main_supplies[] = { 186 "DBVDD1", 187 "DBVDD2", 188 "DBVDD3", 189 "DCVDD", 190 "AVDD1", 191 "AVDD2", 192 "CPVDD", 193 "SPKVDD1", 194 "SPKVDD2", 195 }; 196 197 #ifdef CONFIG_PM_RUNTIME 198 static int wm8994_suspend(struct device *dev) 199 { 200 struct wm8994 *wm8994 = dev_get_drvdata(dev); 201 int ret; 202 203 /* Don't actually go through with the suspend if the CODEC is 204 * still active (eg, for audio passthrough from CP. */ 205 ret = wm8994_reg_read(wm8994, WM8994_POWER_MANAGEMENT_1); 206 if (ret < 0) { 207 dev_err(dev, "Failed to read power status: %d\n", ret); 208 } else if (ret & WM8994_VMID_SEL_MASK) { 209 dev_dbg(dev, "CODEC still active, ignoring suspend\n"); 210 return 0; 211 } 212 213 ret = wm8994_reg_read(wm8994, WM8994_POWER_MANAGEMENT_4); 214 if (ret < 0) { 215 dev_err(dev, "Failed to read power status: %d\n", ret); 216 } else if (ret & (WM8994_AIF2ADCL_ENA | WM8994_AIF2ADCR_ENA | 217 WM8994_AIF1ADC2L_ENA | WM8994_AIF1ADC2R_ENA | 218 WM8994_AIF1ADC1L_ENA | WM8994_AIF1ADC1R_ENA)) { 219 dev_dbg(dev, "CODEC still active, ignoring suspend\n"); 220 return 0; 221 } 222 223 ret = wm8994_reg_read(wm8994, WM8994_POWER_MANAGEMENT_5); 224 if (ret < 0) { 225 dev_err(dev, "Failed to read power status: %d\n", ret); 226 } else if (ret & (WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA | 227 WM8994_AIF1DAC2L_ENA | WM8994_AIF1DAC2R_ENA | 228 WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA)) { 229 dev_dbg(dev, "CODEC still active, ignoring suspend\n"); 230 return 0; 231 } 232 233 switch (wm8994->type) { 234 case WM8958: 235 case WM1811: 236 ret = wm8994_reg_read(wm8994, WM8958_MIC_DETECT_1); 237 if (ret < 0) { 238 dev_err(dev, "Failed to read power status: %d\n", ret); 239 } else if (ret & WM8958_MICD_ENA) { 240 dev_dbg(dev, "CODEC still active, ignoring suspend\n"); 241 return 0; 242 } 243 break; 244 default: 245 break; 246 } 247 248 switch (wm8994->type) { 249 case WM1811: 250 ret = wm8994_reg_read(wm8994, WM8994_ANTIPOP_2); 251 if (ret < 0) { 252 dev_err(dev, "Failed to read jackdet: %d\n", ret); 253 } else if (ret & WM1811_JACKDET_MODE_MASK) { 254 dev_dbg(dev, "CODEC still active, ignoring suspend\n"); 255 return 0; 256 } 257 break; 258 default: 259 break; 260 } 261 262 switch (wm8994->type) { 263 case WM1811: 264 ret = wm8994_reg_read(wm8994, WM8994_ANTIPOP_2); 265 if (ret < 0) { 266 dev_err(dev, "Failed to read jackdet: %d\n", ret); 267 } else if (ret & WM1811_JACKDET_MODE_MASK) { 268 dev_dbg(dev, "CODEC still active, ignoring suspend\n"); 269 return 0; 270 } 271 break; 272 default: 273 break; 274 } 275 276 /* Disable LDO pulldowns while the device is suspended if we 277 * don't know that something will be driving them. */ 278 if (!wm8994->ldo_ena_always_driven) 279 wm8994_set_bits(wm8994, WM8994_PULL_CONTROL_2, 280 WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD, 281 WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD); 282 283 /* Explicitly put the device into reset in case regulators 284 * don't get disabled in order to ensure consistent restart. 285 */ 286 wm8994_reg_write(wm8994, WM8994_SOFTWARE_RESET, 287 wm8994_reg_read(wm8994, WM8994_SOFTWARE_RESET)); 288 289 regcache_mark_dirty(wm8994->regmap); 290 291 /* Restore GPIO registers to prevent problems with mismatched 292 * pin configurations. 293 */ 294 ret = regcache_sync_region(wm8994->regmap, WM8994_GPIO_1, 295 WM8994_GPIO_11); 296 if (ret != 0) 297 dev_err(dev, "Failed to restore GPIO registers: %d\n", ret); 298 299 /* In case one of the GPIOs is used as a wake input. */ 300 ret = regcache_sync_region(wm8994->regmap, 301 WM8994_INTERRUPT_STATUS_1_MASK, 302 WM8994_INTERRUPT_STATUS_1_MASK); 303 if (ret != 0) 304 dev_err(dev, "Failed to restore interrupt mask: %d\n", ret); 305 306 regcache_cache_only(wm8994->regmap, true); 307 wm8994->suspended = true; 308 309 ret = regulator_bulk_disable(wm8994->num_supplies, 310 wm8994->supplies); 311 if (ret != 0) { 312 dev_err(dev, "Failed to disable supplies: %d\n", ret); 313 return ret; 314 } 315 316 return 0; 317 } 318 319 static int wm8994_resume(struct device *dev) 320 { 321 struct wm8994 *wm8994 = dev_get_drvdata(dev); 322 int ret; 323 324 /* We may have lied to the PM core about suspending */ 325 if (!wm8994->suspended) 326 return 0; 327 328 ret = regulator_bulk_enable(wm8994->num_supplies, 329 wm8994->supplies); 330 if (ret != 0) { 331 dev_err(dev, "Failed to enable supplies: %d\n", ret); 332 return ret; 333 } 334 335 regcache_cache_only(wm8994->regmap, false); 336 ret = regcache_sync(wm8994->regmap); 337 if (ret != 0) { 338 dev_err(dev, "Failed to restore register map: %d\n", ret); 339 goto err_enable; 340 } 341 342 /* Disable LDO pulldowns while the device is active */ 343 wm8994_set_bits(wm8994, WM8994_PULL_CONTROL_2, 344 WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD, 345 0); 346 347 wm8994->suspended = false; 348 349 return 0; 350 351 err_enable: 352 regulator_bulk_disable(wm8994->num_supplies, wm8994->supplies); 353 354 return ret; 355 } 356 #endif 357 358 #ifdef CONFIG_REGULATOR 359 static int wm8994_ldo_in_use(struct wm8994_pdata *pdata, int ldo) 360 { 361 struct wm8994_ldo_pdata *ldo_pdata; 362 363 if (!pdata) 364 return 0; 365 366 ldo_pdata = &pdata->ldo[ldo]; 367 368 if (!ldo_pdata->init_data) 369 return 0; 370 371 return ldo_pdata->init_data->num_consumer_supplies != 0; 372 } 373 #else 374 static int wm8994_ldo_in_use(struct wm8994_pdata *pdata, int ldo) 375 { 376 return 0; 377 } 378 #endif 379 380 static const struct reg_default wm8994_revc_patch[] = { 381 { 0x102, 0x3 }, 382 { 0x56, 0x3 }, 383 { 0x817, 0x0 }, 384 { 0x102, 0x0 }, 385 }; 386 387 static const struct reg_default wm8958_reva_patch[] = { 388 { 0x102, 0x3 }, 389 { 0xcb, 0x81 }, 390 { 0x817, 0x0 }, 391 { 0x102, 0x0 }, 392 }; 393 394 static const struct reg_default wm1811_reva_patch[] = { 395 { 0x102, 0x3 }, 396 { 0x56, 0xc07 }, 397 { 0x5d, 0x7e }, 398 { 0x5e, 0x0 }, 399 { 0x102, 0x0 }, 400 }; 401 402 #ifdef CONFIG_OF 403 static int wm8994_set_pdata_from_of(struct wm8994 *wm8994) 404 { 405 struct device_node *np = wm8994->dev->of_node; 406 struct wm8994_pdata *pdata = &wm8994->pdata; 407 int i; 408 409 if (!np) 410 return 0; 411 412 if (of_property_read_u32_array(np, "wlf,gpio-cfg", pdata->gpio_defaults, 413 ARRAY_SIZE(pdata->gpio_defaults)) >= 0) { 414 for (i = 0; i < ARRAY_SIZE(pdata->gpio_defaults); i++) { 415 if (wm8994->pdata.gpio_defaults[i] == 0) 416 pdata->gpio_defaults[i] 417 = WM8994_CONFIGURE_GPIO; 418 } 419 } 420 421 of_property_read_u32_array(np, "wlf,micbias-cfg", pdata->micbias, 422 ARRAY_SIZE(pdata->micbias)); 423 424 pdata->lineout1_diff = true; 425 pdata->lineout2_diff = true; 426 if (of_find_property(np, "wlf,lineout1-se", NULL)) 427 pdata->lineout1_diff = false; 428 if (of_find_property(np, "wlf,lineout2-se", NULL)) 429 pdata->lineout2_diff = false; 430 431 if (of_find_property(np, "wlf,lineout1-feedback", NULL)) 432 pdata->lineout1fb = true; 433 if (of_find_property(np, "wlf,lineout2-feedback", NULL)) 434 pdata->lineout2fb = true; 435 436 if (of_find_property(np, "wlf,ldoena-always-driven", NULL)) 437 pdata->lineout2fb = true; 438 439 pdata->ldo[0].enable = of_get_named_gpio(np, "wlf,ldo1ena", 0); 440 if (pdata->ldo[0].enable < 0) 441 pdata->ldo[0].enable = 0; 442 443 pdata->ldo[1].enable = of_get_named_gpio(np, "wlf,ldo2ena", 0); 444 if (pdata->ldo[1].enable < 0) 445 pdata->ldo[1].enable = 0; 446 447 return 0; 448 } 449 #else 450 static int wm8994_set_pdata_from_of(struct wm8994 *wm8994) 451 { 452 return 0; 453 } 454 #endif 455 456 /* 457 * Instantiate the generic non-control parts of the device. 458 */ 459 static int wm8994_device_init(struct wm8994 *wm8994, int irq) 460 { 461 struct wm8994_pdata *pdata; 462 struct regmap_config *regmap_config; 463 const struct reg_default *regmap_patch = NULL; 464 const char *devname; 465 int ret, i, patch_regs = 0; 466 int pulls = 0; 467 468 if (dev_get_platdata(wm8994->dev)) { 469 pdata = dev_get_platdata(wm8994->dev); 470 wm8994->pdata = *pdata; 471 } 472 pdata = &wm8994->pdata; 473 474 ret = wm8994_set_pdata_from_of(wm8994); 475 if (ret != 0) 476 return ret; 477 478 dev_set_drvdata(wm8994->dev, wm8994); 479 480 /* Add the on-chip regulators first for bootstrapping */ 481 ret = mfd_add_devices(wm8994->dev, -1, 482 wm8994_regulator_devs, 483 ARRAY_SIZE(wm8994_regulator_devs), 484 NULL, 0, NULL); 485 if (ret != 0) { 486 dev_err(wm8994->dev, "Failed to add children: %d\n", ret); 487 goto err; 488 } 489 490 switch (wm8994->type) { 491 case WM1811: 492 wm8994->num_supplies = ARRAY_SIZE(wm1811_main_supplies); 493 break; 494 case WM8994: 495 wm8994->num_supplies = ARRAY_SIZE(wm8994_main_supplies); 496 break; 497 case WM8958: 498 wm8994->num_supplies = ARRAY_SIZE(wm8958_main_supplies); 499 break; 500 default: 501 BUG(); 502 goto err; 503 } 504 505 wm8994->supplies = devm_kzalloc(wm8994->dev, 506 sizeof(struct regulator_bulk_data) * 507 wm8994->num_supplies, GFP_KERNEL); 508 if (!wm8994->supplies) { 509 ret = -ENOMEM; 510 goto err; 511 } 512 513 switch (wm8994->type) { 514 case WM1811: 515 for (i = 0; i < ARRAY_SIZE(wm1811_main_supplies); i++) 516 wm8994->supplies[i].supply = wm1811_main_supplies[i]; 517 break; 518 case WM8994: 519 for (i = 0; i < ARRAY_SIZE(wm8994_main_supplies); i++) 520 wm8994->supplies[i].supply = wm8994_main_supplies[i]; 521 break; 522 case WM8958: 523 for (i = 0; i < ARRAY_SIZE(wm8958_main_supplies); i++) 524 wm8994->supplies[i].supply = wm8958_main_supplies[i]; 525 break; 526 default: 527 BUG(); 528 goto err; 529 } 530 531 ret = devm_regulator_bulk_get(wm8994->dev, wm8994->num_supplies, 532 wm8994->supplies); 533 if (ret != 0) { 534 dev_err(wm8994->dev, "Failed to get supplies: %d\n", ret); 535 goto err; 536 } 537 538 ret = regulator_bulk_enable(wm8994->num_supplies, 539 wm8994->supplies); 540 if (ret != 0) { 541 dev_err(wm8994->dev, "Failed to enable supplies: %d\n", ret); 542 goto err; 543 } 544 545 ret = wm8994_reg_read(wm8994, WM8994_SOFTWARE_RESET); 546 if (ret < 0) { 547 dev_err(wm8994->dev, "Failed to read ID register\n"); 548 goto err_enable; 549 } 550 switch (ret) { 551 case 0x1811: 552 devname = "WM1811"; 553 if (wm8994->type != WM1811) 554 dev_warn(wm8994->dev, "Device registered as type %d\n", 555 wm8994->type); 556 wm8994->type = WM1811; 557 break; 558 case 0x8994: 559 devname = "WM8994"; 560 if (wm8994->type != WM8994) 561 dev_warn(wm8994->dev, "Device registered as type %d\n", 562 wm8994->type); 563 wm8994->type = WM8994; 564 break; 565 case 0x8958: 566 devname = "WM8958"; 567 if (wm8994->type != WM8958) 568 dev_warn(wm8994->dev, "Device registered as type %d\n", 569 wm8994->type); 570 wm8994->type = WM8958; 571 break; 572 default: 573 dev_err(wm8994->dev, "Device is not a WM8994, ID is %x\n", 574 ret); 575 ret = -EINVAL; 576 goto err_enable; 577 } 578 579 ret = wm8994_reg_read(wm8994, WM8994_CHIP_REVISION); 580 if (ret < 0) { 581 dev_err(wm8994->dev, "Failed to read revision register: %d\n", 582 ret); 583 goto err_enable; 584 } 585 wm8994->revision = ret & WM8994_CHIP_REV_MASK; 586 wm8994->cust_id = (ret & WM8994_CUST_ID_MASK) >> WM8994_CUST_ID_SHIFT; 587 588 switch (wm8994->type) { 589 case WM8994: 590 switch (wm8994->revision) { 591 case 0: 592 case 1: 593 dev_warn(wm8994->dev, 594 "revision %c not fully supported\n", 595 'A' + wm8994->revision); 596 break; 597 case 2: 598 case 3: 599 default: 600 regmap_patch = wm8994_revc_patch; 601 patch_regs = ARRAY_SIZE(wm8994_revc_patch); 602 break; 603 } 604 break; 605 606 case WM8958: 607 switch (wm8994->revision) { 608 case 0: 609 regmap_patch = wm8958_reva_patch; 610 patch_regs = ARRAY_SIZE(wm8958_reva_patch); 611 break; 612 default: 613 break; 614 } 615 break; 616 617 case WM1811: 618 /* Revision C did not change the relevant layer */ 619 if (wm8994->revision > 1) 620 wm8994->revision++; 621 622 regmap_patch = wm1811_reva_patch; 623 patch_regs = ARRAY_SIZE(wm1811_reva_patch); 624 break; 625 626 default: 627 break; 628 } 629 630 dev_info(wm8994->dev, "%s revision %c CUST_ID %02x\n", devname, 631 'A' + wm8994->revision, wm8994->cust_id); 632 633 switch (wm8994->type) { 634 case WM1811: 635 regmap_config = &wm1811_regmap_config; 636 break; 637 case WM8994: 638 regmap_config = &wm8994_regmap_config; 639 break; 640 case WM8958: 641 regmap_config = &wm8958_regmap_config; 642 break; 643 default: 644 dev_err(wm8994->dev, "Unknown device type %d\n", wm8994->type); 645 return -EINVAL; 646 } 647 648 ret = regmap_reinit_cache(wm8994->regmap, regmap_config); 649 if (ret != 0) { 650 dev_err(wm8994->dev, "Failed to reinit register cache: %d\n", 651 ret); 652 return ret; 653 } 654 655 if (regmap_patch) { 656 ret = regmap_register_patch(wm8994->regmap, regmap_patch, 657 patch_regs); 658 if (ret != 0) { 659 dev_err(wm8994->dev, "Failed to register patch: %d\n", 660 ret); 661 goto err; 662 } 663 } 664 665 wm8994->irq_base = pdata->irq_base; 666 wm8994->gpio_base = pdata->gpio_base; 667 668 /* GPIO configuration is only applied if it's non-zero */ 669 for (i = 0; i < ARRAY_SIZE(pdata->gpio_defaults); i++) { 670 if (pdata->gpio_defaults[i]) { 671 wm8994_set_bits(wm8994, WM8994_GPIO_1 + i, 672 0xffff, pdata->gpio_defaults[i]); 673 } 674 } 675 676 wm8994->ldo_ena_always_driven = pdata->ldo_ena_always_driven; 677 678 if (pdata->spkmode_pu) 679 pulls |= WM8994_SPKMODE_PU; 680 681 /* Disable unneeded pulls */ 682 wm8994_set_bits(wm8994, WM8994_PULL_CONTROL_2, 683 WM8994_LDO1ENA_PD | WM8994_LDO2ENA_PD | 684 WM8994_SPKMODE_PU | WM8994_CSNADDR_PD, 685 pulls); 686 687 /* In some system designs where the regulators are not in use, 688 * we can achieve a small reduction in leakage currents by 689 * floating LDO outputs. This bit makes no difference if the 690 * LDOs are enabled, it only affects cases where the LDOs were 691 * in operation and are then disabled. 692 */ 693 for (i = 0; i < WM8994_NUM_LDO_REGS; i++) { 694 if (wm8994_ldo_in_use(pdata, i)) 695 wm8994_set_bits(wm8994, WM8994_LDO_1 + i, 696 WM8994_LDO1_DISCH, WM8994_LDO1_DISCH); 697 else 698 wm8994_set_bits(wm8994, WM8994_LDO_1 + i, 699 WM8994_LDO1_DISCH, 0); 700 } 701 702 wm8994_irq_init(wm8994); 703 704 ret = mfd_add_devices(wm8994->dev, -1, 705 wm8994_devs, ARRAY_SIZE(wm8994_devs), 706 NULL, 0, NULL); 707 if (ret != 0) { 708 dev_err(wm8994->dev, "Failed to add children: %d\n", ret); 709 goto err_irq; 710 } 711 712 pm_runtime_enable(wm8994->dev); 713 pm_runtime_idle(wm8994->dev); 714 715 return 0; 716 717 err_irq: 718 wm8994_irq_exit(wm8994); 719 err_enable: 720 regulator_bulk_disable(wm8994->num_supplies, 721 wm8994->supplies); 722 err: 723 mfd_remove_devices(wm8994->dev); 724 return ret; 725 } 726 727 static void wm8994_device_exit(struct wm8994 *wm8994) 728 { 729 pm_runtime_disable(wm8994->dev); 730 mfd_remove_devices(wm8994->dev); 731 wm8994_irq_exit(wm8994); 732 regulator_bulk_disable(wm8994->num_supplies, 733 wm8994->supplies); 734 } 735 736 static const struct of_device_id wm8994_of_match[] = { 737 { .compatible = "wlf,wm1811", .data = (void *)WM1811 }, 738 { .compatible = "wlf,wm8994", .data = (void *)WM8994 }, 739 { .compatible = "wlf,wm8958", .data = (void *)WM8958 }, 740 { } 741 }; 742 MODULE_DEVICE_TABLE(of, wm8994_of_match); 743 744 static int wm8994_i2c_probe(struct i2c_client *i2c, 745 const struct i2c_device_id *id) 746 { 747 const struct of_device_id *of_id; 748 struct wm8994 *wm8994; 749 int ret; 750 751 wm8994 = devm_kzalloc(&i2c->dev, sizeof(struct wm8994), GFP_KERNEL); 752 if (wm8994 == NULL) 753 return -ENOMEM; 754 755 i2c_set_clientdata(i2c, wm8994); 756 wm8994->dev = &i2c->dev; 757 wm8994->irq = i2c->irq; 758 759 if (i2c->dev.of_node) { 760 of_id = of_match_device(wm8994_of_match, &i2c->dev); 761 if (of_id) 762 wm8994->type = (int)of_id->data; 763 } else { 764 wm8994->type = id->driver_data; 765 } 766 767 wm8994->regmap = devm_regmap_init_i2c(i2c, &wm8994_base_regmap_config); 768 if (IS_ERR(wm8994->regmap)) { 769 ret = PTR_ERR(wm8994->regmap); 770 dev_err(wm8994->dev, "Failed to allocate register map: %d\n", 771 ret); 772 return ret; 773 } 774 775 return wm8994_device_init(wm8994, i2c->irq); 776 } 777 778 static int wm8994_i2c_remove(struct i2c_client *i2c) 779 { 780 struct wm8994 *wm8994 = i2c_get_clientdata(i2c); 781 782 wm8994_device_exit(wm8994); 783 784 return 0; 785 } 786 787 static const struct i2c_device_id wm8994_i2c_id[] = { 788 { "wm1811", WM1811 }, 789 { "wm1811a", WM1811 }, 790 { "wm8994", WM8994 }, 791 { "wm8958", WM8958 }, 792 { } 793 }; 794 MODULE_DEVICE_TABLE(i2c, wm8994_i2c_id); 795 796 static const struct dev_pm_ops wm8994_pm_ops = { 797 SET_RUNTIME_PM_OPS(wm8994_suspend, wm8994_resume, NULL) 798 }; 799 800 static struct i2c_driver wm8994_i2c_driver = { 801 .driver = { 802 .name = "wm8994", 803 .owner = THIS_MODULE, 804 .pm = &wm8994_pm_ops, 805 .of_match_table = of_match_ptr(wm8994_of_match), 806 }, 807 .probe = wm8994_i2c_probe, 808 .remove = wm8994_i2c_remove, 809 .id_table = wm8994_i2c_id, 810 }; 811 812 module_i2c_driver(wm8994_i2c_driver); 813 814 MODULE_DESCRIPTION("Core support for the WM8994 audio CODEC"); 815 MODULE_LICENSE("GPL"); 816 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>"); 817