1// SPDX-License-Identifier: GPL-2.0-only 2/* 3 * Arizona core driver 4 * 5 * Copyright 2012 Wolfson Microelectronics plc 6 * 7 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com> 8 */ 9 10#include <linux/clk.h> 11#include <linux/delay.h> 12#include <linux/err.h> 13#include <linux/gpio/consumer.h> 14#include <linux/interrupt.h> 15#include <linux/mfd/core.h> 16#include <linux/module.h> 17#include <linux/of.h> 18#include <linux/of_device.h> 19#include <linux/pm_runtime.h> 20#include <linux/regmap.h> 21#include <linux/regulator/consumer.h> 22#include <linux/regulator/machine.h> 23#include <linux/slab.h> 24#include <linux/ktime.h> 25#include <linux/platform_device.h> 26 27#include <linux/mfd/arizona/core.h> 28#include <linux/mfd/arizona/registers.h> 29 30#include "arizona.h" 31 32static const char * const wm5102_core_supplies[] = { 33 "AVDD", 34 "DBVDD1", 35}; 36 37int arizona_clk32k_enable(struct arizona *arizona) 38{ 39 int ret = 0; 40 41 mutex_lock(&arizona->clk_lock); 42 43 arizona->clk32k_ref++; 44 45 if (arizona->clk32k_ref == 1) { 46 switch (arizona->pdata.clk32k_src) { 47 case ARIZONA_32KZ_MCLK1: 48 ret = pm_runtime_resume_and_get(arizona->dev); 49 if (ret != 0) 50 goto err_ref; 51 ret = clk_prepare_enable(arizona->mclk[ARIZONA_MCLK1]); 52 if (ret != 0) { 53 pm_runtime_put_sync(arizona->dev); 54 goto err_ref; 55 } 56 break; 57 case ARIZONA_32KZ_MCLK2: 58 ret = clk_prepare_enable(arizona->mclk[ARIZONA_MCLK2]); 59 if (ret != 0) 60 goto err_ref; 61 break; 62 } 63 64 ret = regmap_update_bits(arizona->regmap, ARIZONA_CLOCK_32K_1, 65 ARIZONA_CLK_32K_ENA, 66 ARIZONA_CLK_32K_ENA); 67 } 68 69err_ref: 70 if (ret != 0) 71 arizona->clk32k_ref--; 72 73 mutex_unlock(&arizona->clk_lock); 74 75 return ret; 76} 77EXPORT_SYMBOL_GPL(arizona_clk32k_enable); 78 79int arizona_clk32k_disable(struct arizona *arizona) 80{ 81 mutex_lock(&arizona->clk_lock); 82 83 WARN_ON(arizona->clk32k_ref <= 0); 84 85 arizona->clk32k_ref--; 86 87 if (arizona->clk32k_ref == 0) { 88 regmap_update_bits(arizona->regmap, ARIZONA_CLOCK_32K_1, 89 ARIZONA_CLK_32K_ENA, 0); 90 91 switch (arizona->pdata.clk32k_src) { 92 case ARIZONA_32KZ_MCLK1: 93 pm_runtime_put_sync(arizona->dev); 94 clk_disable_unprepare(arizona->mclk[ARIZONA_MCLK1]); 95 break; 96 case ARIZONA_32KZ_MCLK2: 97 clk_disable_unprepare(arizona->mclk[ARIZONA_MCLK2]); 98 break; 99 } 100 } 101 102 mutex_unlock(&arizona->clk_lock); 103 104 return 0; 105} 106EXPORT_SYMBOL_GPL(arizona_clk32k_disable); 107 108static irqreturn_t arizona_clkgen_err(int irq, void *data) 109{ 110 struct arizona *arizona = data; 111 112 dev_err(arizona->dev, "CLKGEN error\n"); 113 114 return IRQ_HANDLED; 115} 116 117static irqreturn_t arizona_underclocked(int irq, void *data) 118{ 119 struct arizona *arizona = data; 120 unsigned int val; 121 int ret; 122 123 ret = regmap_read(arizona->regmap, ARIZONA_INTERRUPT_RAW_STATUS_8, 124 &val); 125 if (ret != 0) { 126 dev_err(arizona->dev, "Failed to read underclock status: %d\n", 127 ret); 128 return IRQ_NONE; 129 } 130 131 if (val & ARIZONA_AIF3_UNDERCLOCKED_STS) 132 dev_err(arizona->dev, "AIF3 underclocked\n"); 133 if (val & ARIZONA_AIF2_UNDERCLOCKED_STS) 134 dev_err(arizona->dev, "AIF2 underclocked\n"); 135 if (val & ARIZONA_AIF1_UNDERCLOCKED_STS) 136 dev_err(arizona->dev, "AIF1 underclocked\n"); 137 if (val & ARIZONA_ISRC3_UNDERCLOCKED_STS) 138 dev_err(arizona->dev, "ISRC3 underclocked\n"); 139 if (val & ARIZONA_ISRC2_UNDERCLOCKED_STS) 140 dev_err(arizona->dev, "ISRC2 underclocked\n"); 141 if (val & ARIZONA_ISRC1_UNDERCLOCKED_STS) 142 dev_err(arizona->dev, "ISRC1 underclocked\n"); 143 if (val & ARIZONA_FX_UNDERCLOCKED_STS) 144 dev_err(arizona->dev, "FX underclocked\n"); 145 if (val & ARIZONA_ASRC_UNDERCLOCKED_STS) 146 dev_err(arizona->dev, "ASRC underclocked\n"); 147 if (val & ARIZONA_DAC_UNDERCLOCKED_STS) 148 dev_err(arizona->dev, "DAC underclocked\n"); 149 if (val & ARIZONA_ADC_UNDERCLOCKED_STS) 150 dev_err(arizona->dev, "ADC underclocked\n"); 151 if (val & ARIZONA_MIXER_UNDERCLOCKED_STS) 152 dev_err(arizona->dev, "Mixer dropped sample\n"); 153 154 return IRQ_HANDLED; 155} 156 157static irqreturn_t arizona_overclocked(int irq, void *data) 158{ 159 struct arizona *arizona = data; 160 unsigned int val[3]; 161 int ret; 162 163 ret = regmap_bulk_read(arizona->regmap, ARIZONA_INTERRUPT_RAW_STATUS_6, 164 &val[0], 3); 165 if (ret != 0) { 166 dev_err(arizona->dev, "Failed to read overclock status: %d\n", 167 ret); 168 return IRQ_NONE; 169 } 170 171 switch (arizona->type) { 172 case WM8998: 173 case WM1814: 174 /* Some bits are shifted on WM8998, 175 * rearrange to match the standard bit layout 176 */ 177 val[0] = ((val[0] & 0x60e0) >> 1) | 178 ((val[0] & 0x1e00) >> 2) | 179 (val[0] & 0x000f); 180 break; 181 default: 182 break; 183 } 184 185 if (val[0] & ARIZONA_PWM_OVERCLOCKED_STS) 186 dev_err(arizona->dev, "PWM overclocked\n"); 187 if (val[0] & ARIZONA_FX_CORE_OVERCLOCKED_STS) 188 dev_err(arizona->dev, "FX core overclocked\n"); 189 if (val[0] & ARIZONA_DAC_SYS_OVERCLOCKED_STS) 190 dev_err(arizona->dev, "DAC SYS overclocked\n"); 191 if (val[0] & ARIZONA_DAC_WARP_OVERCLOCKED_STS) 192 dev_err(arizona->dev, "DAC WARP overclocked\n"); 193 if (val[0] & ARIZONA_ADC_OVERCLOCKED_STS) 194 dev_err(arizona->dev, "ADC overclocked\n"); 195 if (val[0] & ARIZONA_MIXER_OVERCLOCKED_STS) 196 dev_err(arizona->dev, "Mixer overclocked\n"); 197 if (val[0] & ARIZONA_AIF3_SYNC_OVERCLOCKED_STS) 198 dev_err(arizona->dev, "AIF3 overclocked\n"); 199 if (val[0] & ARIZONA_AIF2_SYNC_OVERCLOCKED_STS) 200 dev_err(arizona->dev, "AIF2 overclocked\n"); 201 if (val[0] & ARIZONA_AIF1_SYNC_OVERCLOCKED_STS) 202 dev_err(arizona->dev, "AIF1 overclocked\n"); 203 if (val[0] & ARIZONA_PAD_CTRL_OVERCLOCKED_STS) 204 dev_err(arizona->dev, "Pad control overclocked\n"); 205 206 if (val[1] & ARIZONA_SLIMBUS_SUBSYS_OVERCLOCKED_STS) 207 dev_err(arizona->dev, "Slimbus subsystem overclocked\n"); 208 if (val[1] & ARIZONA_SLIMBUS_ASYNC_OVERCLOCKED_STS) 209 dev_err(arizona->dev, "Slimbus async overclocked\n"); 210 if (val[1] & ARIZONA_SLIMBUS_SYNC_OVERCLOCKED_STS) 211 dev_err(arizona->dev, "Slimbus sync overclocked\n"); 212 if (val[1] & ARIZONA_ASRC_ASYNC_SYS_OVERCLOCKED_STS) 213 dev_err(arizona->dev, "ASRC async system overclocked\n"); 214 if (val[1] & ARIZONA_ASRC_ASYNC_WARP_OVERCLOCKED_STS) 215 dev_err(arizona->dev, "ASRC async WARP overclocked\n"); 216 if (val[1] & ARIZONA_ASRC_SYNC_SYS_OVERCLOCKED_STS) 217 dev_err(arizona->dev, "ASRC sync system overclocked\n"); 218 if (val[1] & ARIZONA_ASRC_SYNC_WARP_OVERCLOCKED_STS) 219 dev_err(arizona->dev, "ASRC sync WARP overclocked\n"); 220 if (val[1] & ARIZONA_ADSP2_1_OVERCLOCKED_STS) 221 dev_err(arizona->dev, "DSP1 overclocked\n"); 222 if (val[1] & ARIZONA_ISRC3_OVERCLOCKED_STS) 223 dev_err(arizona->dev, "ISRC3 overclocked\n"); 224 if (val[1] & ARIZONA_ISRC2_OVERCLOCKED_STS) 225 dev_err(arizona->dev, "ISRC2 overclocked\n"); 226 if (val[1] & ARIZONA_ISRC1_OVERCLOCKED_STS) 227 dev_err(arizona->dev, "ISRC1 overclocked\n"); 228 229 if (val[2] & ARIZONA_SPDIF_OVERCLOCKED_STS) 230 dev_err(arizona->dev, "SPDIF overclocked\n"); 231 232 return IRQ_HANDLED; 233} 234 235#define ARIZONA_REG_POLL_DELAY_US 7500 236 237static inline bool arizona_poll_reg_delay(ktime_t timeout) 238{ 239 if (ktime_compare(ktime_get(), timeout) > 0) 240 return false; 241 242 usleep_range(ARIZONA_REG_POLL_DELAY_US / 2, ARIZONA_REG_POLL_DELAY_US); 243 244 return true; 245} 246 247static int arizona_poll_reg(struct arizona *arizona, 248 int timeout_ms, unsigned int reg, 249 unsigned int mask, unsigned int target) 250{ 251 ktime_t timeout = ktime_add_us(ktime_get(), timeout_ms * USEC_PER_MSEC); 252 unsigned int val = 0; 253 int ret; 254 255 do { 256 ret = regmap_read(arizona->regmap, reg, &val); 257 258 if ((val & mask) == target) 259 return 0; 260 } while (arizona_poll_reg_delay(timeout)); 261 262 if (ret) { 263 dev_err(arizona->dev, "Failed polling reg 0x%x: %d\n", 264 reg, ret); 265 return ret; 266 } 267 268 dev_err(arizona->dev, "Polling reg 0x%x timed out: %x\n", reg, val); 269 return -ETIMEDOUT; 270} 271 272static int arizona_wait_for_boot(struct arizona *arizona) 273{ 274 int ret; 275 276 /* 277 * We can't use an interrupt as we need to runtime resume to do so, 278 * we won't race with the interrupt handler as it'll be blocked on 279 * runtime resume. 280 */ 281 ret = arizona_poll_reg(arizona, 30, ARIZONA_INTERRUPT_RAW_STATUS_5, 282 ARIZONA_BOOT_DONE_STS, ARIZONA_BOOT_DONE_STS); 283 284 if (!ret) 285 regmap_write(arizona->regmap, ARIZONA_INTERRUPT_STATUS_5, 286 ARIZONA_BOOT_DONE_STS); 287 288 pm_runtime_mark_last_busy(arizona->dev); 289 290 return ret; 291} 292 293static inline void arizona_enable_reset(struct arizona *arizona) 294{ 295 if (arizona->pdata.reset) 296 gpiod_set_raw_value_cansleep(arizona->pdata.reset, 0); 297} 298 299static void arizona_disable_reset(struct arizona *arizona) 300{ 301 if (arizona->pdata.reset) { 302 switch (arizona->type) { 303 case WM5110: 304 case WM8280: 305 /* Meet requirements for minimum reset duration */ 306 usleep_range(5000, 10000); 307 break; 308 default: 309 break; 310 } 311 312 gpiod_set_raw_value_cansleep(arizona->pdata.reset, 1); 313 usleep_range(1000, 5000); 314 } 315} 316 317struct arizona_sysclk_state { 318 unsigned int fll; 319 unsigned int sysclk; 320}; 321 322static int arizona_enable_freerun_sysclk(struct arizona *arizona, 323 struct arizona_sysclk_state *state) 324{ 325 int ret, err; 326 327 /* Cache existing FLL and SYSCLK settings */ 328 ret = regmap_read(arizona->regmap, ARIZONA_FLL1_CONTROL_1, &state->fll); 329 if (ret) { 330 dev_err(arizona->dev, "Failed to cache FLL settings: %d\n", 331 ret); 332 return ret; 333 } 334 ret = regmap_read(arizona->regmap, ARIZONA_SYSTEM_CLOCK_1, 335 &state->sysclk); 336 if (ret) { 337 dev_err(arizona->dev, "Failed to cache SYSCLK settings: %d\n", 338 ret); 339 return ret; 340 } 341 342 /* Start up SYSCLK using the FLL in free running mode */ 343 ret = regmap_write(arizona->regmap, ARIZONA_FLL1_CONTROL_1, 344 ARIZONA_FLL1_ENA | ARIZONA_FLL1_FREERUN); 345 if (ret) { 346 dev_err(arizona->dev, 347 "Failed to start FLL in freerunning mode: %d\n", 348 ret); 349 return ret; 350 } 351 ret = arizona_poll_reg(arizona, 180, ARIZONA_INTERRUPT_RAW_STATUS_5, 352 ARIZONA_FLL1_CLOCK_OK_STS, 353 ARIZONA_FLL1_CLOCK_OK_STS); 354 if (ret) 355 goto err_fll; 356 357 ret = regmap_write(arizona->regmap, ARIZONA_SYSTEM_CLOCK_1, 0x0144); 358 if (ret) { 359 dev_err(arizona->dev, "Failed to start SYSCLK: %d\n", ret); 360 goto err_fll; 361 } 362 363 return 0; 364 365err_fll: 366 err = regmap_write(arizona->regmap, ARIZONA_FLL1_CONTROL_1, state->fll); 367 if (err) 368 dev_err(arizona->dev, 369 "Failed to re-apply old FLL settings: %d\n", err); 370 371 return ret; 372} 373 374static int arizona_disable_freerun_sysclk(struct arizona *arizona, 375 struct arizona_sysclk_state *state) 376{ 377 int ret; 378 379 ret = regmap_write(arizona->regmap, ARIZONA_SYSTEM_CLOCK_1, 380 state->sysclk); 381 if (ret) { 382 dev_err(arizona->dev, 383 "Failed to re-apply old SYSCLK settings: %d\n", ret); 384 return ret; 385 } 386 387 ret = regmap_write(arizona->regmap, ARIZONA_FLL1_CONTROL_1, state->fll); 388 if (ret) { 389 dev_err(arizona->dev, 390 "Failed to re-apply old FLL settings: %d\n", ret); 391 return ret; 392 } 393 394 return 0; 395} 396 397static int wm5102_apply_hardware_patch(struct arizona *arizona) 398{ 399 struct arizona_sysclk_state state; 400 int err, ret; 401 402 ret = arizona_enable_freerun_sysclk(arizona, &state); 403 if (ret) 404 return ret; 405 406 /* Start the write sequencer and wait for it to finish */ 407 ret = regmap_write(arizona->regmap, ARIZONA_WRITE_SEQUENCER_CTRL_0, 408 ARIZONA_WSEQ_ENA | ARIZONA_WSEQ_START | 160); 409 if (ret) { 410 dev_err(arizona->dev, "Failed to start write sequencer: %d\n", 411 ret); 412 goto err; 413 } 414 415 ret = arizona_poll_reg(arizona, 30, ARIZONA_WRITE_SEQUENCER_CTRL_1, 416 ARIZONA_WSEQ_BUSY, 0); 417 if (ret) 418 regmap_write(arizona->regmap, ARIZONA_WRITE_SEQUENCER_CTRL_0, 419 ARIZONA_WSEQ_ABORT); 420 421err: 422 err = arizona_disable_freerun_sysclk(arizona, &state); 423 424 return ret ?: err; 425} 426 427/* 428 * Register patch to some of the CODECs internal write sequences 429 * to ensure a clean exit from the low power sleep state. 430 */ 431static const struct reg_sequence wm5110_sleep_patch[] = { 432 { 0x337A, 0xC100 }, 433 { 0x337B, 0x0041 }, 434 { 0x3300, 0xA210 }, 435 { 0x3301, 0x050C }, 436}; 437 438static int wm5110_apply_sleep_patch(struct arizona *arizona) 439{ 440 struct arizona_sysclk_state state; 441 int err, ret; 442 443 ret = arizona_enable_freerun_sysclk(arizona, &state); 444 if (ret) 445 return ret; 446 447 ret = regmap_multi_reg_write_bypassed(arizona->regmap, 448 wm5110_sleep_patch, 449 ARRAY_SIZE(wm5110_sleep_patch)); 450 451 err = arizona_disable_freerun_sysclk(arizona, &state); 452 453 return ret ?: err; 454} 455 456static int wm5102_clear_write_sequencer(struct arizona *arizona) 457{ 458 int ret; 459 460 ret = regmap_write(arizona->regmap, ARIZONA_WRITE_SEQUENCER_CTRL_3, 461 0x0); 462 if (ret) { 463 dev_err(arizona->dev, 464 "Failed to clear write sequencer state: %d\n", ret); 465 return ret; 466 } 467 468 arizona_enable_reset(arizona); 469 regulator_disable(arizona->dcvdd); 470 471 msleep(20); 472 473 ret = regulator_enable(arizona->dcvdd); 474 if (ret) { 475 dev_err(arizona->dev, "Failed to re-enable DCVDD: %d\n", ret); 476 return ret; 477 } 478 arizona_disable_reset(arizona); 479 480 return 0; 481} 482 483#ifdef CONFIG_PM 484static int arizona_isolate_dcvdd(struct arizona *arizona) 485{ 486 int ret; 487 488 ret = regmap_update_bits(arizona->regmap, 489 ARIZONA_ISOLATION_CONTROL, 490 ARIZONA_ISOLATE_DCVDD1, 491 ARIZONA_ISOLATE_DCVDD1); 492 if (ret != 0) 493 dev_err(arizona->dev, "Failed to isolate DCVDD: %d\n", ret); 494 495 return ret; 496} 497 498static int arizona_connect_dcvdd(struct arizona *arizona) 499{ 500 int ret; 501 502 ret = regmap_update_bits(arizona->regmap, 503 ARIZONA_ISOLATION_CONTROL, 504 ARIZONA_ISOLATE_DCVDD1, 0); 505 if (ret != 0) 506 dev_err(arizona->dev, "Failed to connect DCVDD: %d\n", ret); 507 508 return ret; 509} 510 511static int arizona_is_jack_det_active(struct arizona *arizona) 512{ 513 unsigned int val; 514 int ret; 515 516 ret = regmap_read(arizona->regmap, ARIZONA_JACK_DETECT_ANALOGUE, &val); 517 if (ret) { 518 dev_err(arizona->dev, 519 "Failed to check jack det status: %d\n", ret); 520 return ret; 521 } else if (val & ARIZONA_JD1_ENA) { 522 return 1; 523 } else { 524 return 0; 525 } 526} 527 528static int arizona_runtime_resume(struct device *dev) 529{ 530 struct arizona *arizona = dev_get_drvdata(dev); 531 int ret; 532 533 dev_dbg(arizona->dev, "Leaving AoD mode\n"); 534 535 if (arizona->has_fully_powered_off) { 536 dev_dbg(arizona->dev, "Re-enabling core supplies\n"); 537 538 ret = regulator_bulk_enable(arizona->num_core_supplies, 539 arizona->core_supplies); 540 if (ret) { 541 dev_err(dev, "Failed to enable core supplies: %d\n", 542 ret); 543 return ret; 544 } 545 } 546 547 ret = regulator_enable(arizona->dcvdd); 548 if (ret != 0) { 549 dev_err(arizona->dev, "Failed to enable DCVDD: %d\n", ret); 550 if (arizona->has_fully_powered_off) 551 regulator_bulk_disable(arizona->num_core_supplies, 552 arizona->core_supplies); 553 return ret; 554 } 555 556 if (arizona->has_fully_powered_off) { 557 arizona_disable_reset(arizona); 558 enable_irq(arizona->irq); 559 arizona->has_fully_powered_off = false; 560 } 561 562 regcache_cache_only(arizona->regmap, false); 563 564 switch (arizona->type) { 565 case WM5102: 566 if (arizona->external_dcvdd) { 567 ret = arizona_connect_dcvdd(arizona); 568 if (ret != 0) 569 goto err; 570 } 571 572 ret = wm5102_patch(arizona); 573 if (ret != 0) { 574 dev_err(arizona->dev, "Failed to apply patch: %d\n", 575 ret); 576 goto err; 577 } 578 579 ret = wm5102_apply_hardware_patch(arizona); 580 if (ret) { 581 dev_err(arizona->dev, 582 "Failed to apply hardware patch: %d\n", 583 ret); 584 goto err; 585 } 586 break; 587 case WM5110: 588 case WM8280: 589 ret = arizona_wait_for_boot(arizona); 590 if (ret) 591 goto err; 592 593 if (arizona->external_dcvdd) { 594 ret = arizona_connect_dcvdd(arizona); 595 if (ret != 0) 596 goto err; 597 } else { 598 /* 599 * As this is only called for the internal regulator 600 * (where we know voltage ranges available) it is ok 601 * to request an exact range. 602 */ 603 ret = regulator_set_voltage(arizona->dcvdd, 604 1200000, 1200000); 605 if (ret < 0) { 606 dev_err(arizona->dev, 607 "Failed to set resume voltage: %d\n", 608 ret); 609 goto err; 610 } 611 } 612 613 ret = wm5110_apply_sleep_patch(arizona); 614 if (ret) { 615 dev_err(arizona->dev, 616 "Failed to re-apply sleep patch: %d\n", 617 ret); 618 goto err; 619 } 620 break; 621 case WM1831: 622 case CS47L24: 623 ret = arizona_wait_for_boot(arizona); 624 if (ret != 0) 625 goto err; 626 break; 627 default: 628 ret = arizona_wait_for_boot(arizona); 629 if (ret != 0) 630 goto err; 631 632 if (arizona->external_dcvdd) { 633 ret = arizona_connect_dcvdd(arizona); 634 if (ret != 0) 635 goto err; 636 } 637 break; 638 } 639 640 ret = regcache_sync(arizona->regmap); 641 if (ret != 0) { 642 dev_err(arizona->dev, "Failed to restore register cache\n"); 643 goto err; 644 } 645 646 return 0; 647 648err: 649 regcache_cache_only(arizona->regmap, true); 650 regulator_disable(arizona->dcvdd); 651 return ret; 652} 653 654static int arizona_runtime_suspend(struct device *dev) 655{ 656 struct arizona *arizona = dev_get_drvdata(dev); 657 int jd_active = 0; 658 int ret; 659 660 dev_dbg(arizona->dev, "Entering AoD mode\n"); 661 662 switch (arizona->type) { 663 case WM5110: 664 case WM8280: 665 jd_active = arizona_is_jack_det_active(arizona); 666 if (jd_active < 0) 667 return jd_active; 668 669 if (arizona->external_dcvdd) { 670 ret = arizona_isolate_dcvdd(arizona); 671 if (ret != 0) 672 return ret; 673 } else { 674 /* 675 * As this is only called for the internal regulator 676 * (where we know voltage ranges available) it is ok 677 * to request an exact range. 678 */ 679 ret = regulator_set_voltage(arizona->dcvdd, 680 1175000, 1175000); 681 if (ret < 0) { 682 dev_err(arizona->dev, 683 "Failed to set suspend voltage: %d\n", 684 ret); 685 return ret; 686 } 687 } 688 break; 689 case WM5102: 690 jd_active = arizona_is_jack_det_active(arizona); 691 if (jd_active < 0) 692 return jd_active; 693 694 if (arizona->external_dcvdd) { 695 ret = arizona_isolate_dcvdd(arizona); 696 if (ret != 0) 697 return ret; 698 } 699 700 if (!jd_active) { 701 ret = regmap_write(arizona->regmap, 702 ARIZONA_WRITE_SEQUENCER_CTRL_3, 0x0); 703 if (ret) { 704 dev_err(arizona->dev, 705 "Failed to clear write sequencer: %d\n", 706 ret); 707 return ret; 708 } 709 } 710 break; 711 case WM1831: 712 case CS47L24: 713 break; 714 default: 715 jd_active = arizona_is_jack_det_active(arizona); 716 if (jd_active < 0) 717 return jd_active; 718 719 if (arizona->external_dcvdd) { 720 ret = arizona_isolate_dcvdd(arizona); 721 if (ret != 0) 722 return ret; 723 } 724 break; 725 } 726 727 regcache_cache_only(arizona->regmap, true); 728 regcache_mark_dirty(arizona->regmap); 729 regulator_disable(arizona->dcvdd); 730 731 /* Allow us to completely power down if no jack detection */ 732 if (!jd_active) { 733 dev_dbg(arizona->dev, "Fully powering off\n"); 734 735 arizona->has_fully_powered_off = true; 736 737 disable_irq_nosync(arizona->irq); 738 arizona_enable_reset(arizona); 739 regulator_bulk_disable(arizona->num_core_supplies, 740 arizona->core_supplies); 741 } 742 743 return 0; 744} 745#endif 746 747#ifdef CONFIG_PM_SLEEP 748static int arizona_suspend(struct device *dev) 749{ 750 struct arizona *arizona = dev_get_drvdata(dev); 751 752 dev_dbg(arizona->dev, "Suspend, disabling IRQ\n"); 753 disable_irq(arizona->irq); 754 755 return 0; 756} 757 758static int arizona_suspend_noirq(struct device *dev) 759{ 760 struct arizona *arizona = dev_get_drvdata(dev); 761 762 dev_dbg(arizona->dev, "Late suspend, reenabling IRQ\n"); 763 enable_irq(arizona->irq); 764 765 return 0; 766} 767 768static int arizona_resume_noirq(struct device *dev) 769{ 770 struct arizona *arizona = dev_get_drvdata(dev); 771 772 dev_dbg(arizona->dev, "Early resume, disabling IRQ\n"); 773 disable_irq(arizona->irq); 774 775 return 0; 776} 777 778static int arizona_resume(struct device *dev) 779{ 780 struct arizona *arizona = dev_get_drvdata(dev); 781 782 dev_dbg(arizona->dev, "Resume, reenabling IRQ\n"); 783 enable_irq(arizona->irq); 784 785 return 0; 786} 787#endif 788 789const struct dev_pm_ops arizona_pm_ops = { 790 SET_RUNTIME_PM_OPS(arizona_runtime_suspend, 791 arizona_runtime_resume, 792 NULL) 793 SET_SYSTEM_SLEEP_PM_OPS(arizona_suspend, arizona_resume) 794 SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(arizona_suspend_noirq, 795 arizona_resume_noirq) 796}; 797EXPORT_SYMBOL_GPL(arizona_pm_ops); 798 799#ifdef CONFIG_OF 800unsigned long arizona_of_get_type(struct device *dev) 801{ 802 const struct of_device_id *id = of_match_device(arizona_of_match, dev); 803 804 if (id) 805 return (unsigned long)id->data; 806 else 807 return 0; 808} 809EXPORT_SYMBOL_GPL(arizona_of_get_type); 810 811static int arizona_of_get_core_pdata(struct arizona *arizona) 812{ 813 struct arizona_pdata *pdata = &arizona->pdata; 814 int ret, i; 815 816 /* Handle old non-standard DT binding */ 817 pdata->reset = devm_gpiod_get(arizona->dev, "wlf,reset", GPIOD_OUT_LOW); 818 if (IS_ERR(pdata->reset)) { 819 ret = PTR_ERR(pdata->reset); 820 821 /* 822 * Reset missing will be caught when other binding is read 823 * but all other errors imply this binding is in use but has 824 * encountered a problem so should be handled. 825 */ 826 if (ret == -EPROBE_DEFER) 827 return ret; 828 else if (ret != -ENOENT && ret != -ENOSYS) 829 dev_err(arizona->dev, "Reset GPIO malformed: %d\n", 830 ret); 831 832 pdata->reset = NULL; 833 } 834 835 ret = of_property_read_u32_array(arizona->dev->of_node, 836 "wlf,gpio-defaults", 837 pdata->gpio_defaults, 838 ARRAY_SIZE(pdata->gpio_defaults)); 839 if (ret >= 0) { 840 /* 841 * All values are literal except out of range values 842 * which are chip default, translate into platform 843 * data which uses 0 as chip default and out of range 844 * as zero. 845 */ 846 for (i = 0; i < ARRAY_SIZE(pdata->gpio_defaults); i++) { 847 if (pdata->gpio_defaults[i] > 0xffff) 848 pdata->gpio_defaults[i] = 0; 849 else if (pdata->gpio_defaults[i] == 0) 850 pdata->gpio_defaults[i] = 0x10000; 851 } 852 } else { 853 dev_err(arizona->dev, "Failed to parse GPIO defaults: %d\n", 854 ret); 855 } 856 857 return 0; 858} 859 860const struct of_device_id arizona_of_match[] = { 861 { .compatible = "wlf,wm5102", .data = (void *)WM5102 }, 862 { .compatible = "wlf,wm5110", .data = (void *)WM5110 }, 863 { .compatible = "wlf,wm8280", .data = (void *)WM8280 }, 864 { .compatible = "wlf,wm8997", .data = (void *)WM8997 }, 865 { .compatible = "wlf,wm8998", .data = (void *)WM8998 }, 866 { .compatible = "wlf,wm1814", .data = (void *)WM1814 }, 867 { .compatible = "wlf,wm1831", .data = (void *)WM1831 }, 868 { .compatible = "cirrus,cs47l24", .data = (void *)CS47L24 }, 869 {}, 870}; 871EXPORT_SYMBOL_GPL(arizona_of_match); 872#else 873static inline int arizona_of_get_core_pdata(struct arizona *arizona) 874{ 875 return 0; 876} 877#endif 878 879static const struct mfd_cell early_devs[] = { 880 { .name = "arizona-ldo1" }, 881}; 882 883static const char * const wm5102_supplies[] = { 884 "MICVDD", 885 "DBVDD2", 886 "DBVDD3", 887 "CPVDD", 888 "SPKVDDL", 889 "SPKVDDR", 890}; 891 892static const struct mfd_cell wm5102_devs[] = { 893 { .name = "arizona-micsupp" }, 894 { .name = "arizona-gpio" }, 895 { 896 .name = "arizona-extcon", 897 .parent_supplies = wm5102_supplies, 898 .num_parent_supplies = 1, /* We only need MICVDD */ 899 }, 900 { .name = "arizona-haptics" }, 901 { .name = "arizona-pwm" }, 902 { 903 .name = "wm5102-codec", 904 .parent_supplies = wm5102_supplies, 905 .num_parent_supplies = ARRAY_SIZE(wm5102_supplies), 906 }, 907}; 908 909static const struct mfd_cell wm5110_devs[] = { 910 { .name = "arizona-micsupp" }, 911 { .name = "arizona-gpio" }, 912 { 913 .name = "arizona-extcon", 914 .parent_supplies = wm5102_supplies, 915 .num_parent_supplies = 1, /* We only need MICVDD */ 916 }, 917 { .name = "arizona-haptics" }, 918 { .name = "arizona-pwm" }, 919 { 920 .name = "wm5110-codec", 921 .parent_supplies = wm5102_supplies, 922 .num_parent_supplies = ARRAY_SIZE(wm5102_supplies), 923 }, 924}; 925 926static const char * const cs47l24_supplies[] = { 927 "MICVDD", 928 "CPVDD", 929 "SPKVDD", 930}; 931 932static const struct mfd_cell cs47l24_devs[] = { 933 { .name = "arizona-gpio" }, 934 { .name = "arizona-haptics" }, 935 { .name = "arizona-pwm" }, 936 { 937 .name = "cs47l24-codec", 938 .parent_supplies = cs47l24_supplies, 939 .num_parent_supplies = ARRAY_SIZE(cs47l24_supplies), 940 }, 941}; 942 943static const char * const wm8997_supplies[] = { 944 "MICVDD", 945 "DBVDD2", 946 "CPVDD", 947 "SPKVDD", 948}; 949 950static const struct mfd_cell wm8997_devs[] = { 951 { .name = "arizona-micsupp" }, 952 { .name = "arizona-gpio" }, 953 { 954 .name = "arizona-extcon", 955 .parent_supplies = wm8997_supplies, 956 .num_parent_supplies = 1, /* We only need MICVDD */ 957 }, 958 { .name = "arizona-haptics" }, 959 { .name = "arizona-pwm" }, 960 { 961 .name = "wm8997-codec", 962 .parent_supplies = wm8997_supplies, 963 .num_parent_supplies = ARRAY_SIZE(wm8997_supplies), 964 }, 965}; 966 967static const struct mfd_cell wm8998_devs[] = { 968 { .name = "arizona-micsupp" }, 969 { .name = "arizona-gpio" }, 970 { 971 .name = "arizona-extcon", 972 .parent_supplies = wm5102_supplies, 973 .num_parent_supplies = 1, /* We only need MICVDD */ 974 }, 975 { .name = "arizona-haptics" }, 976 { .name = "arizona-pwm" }, 977 { 978 .name = "wm8998-codec", 979 .parent_supplies = wm5102_supplies, 980 .num_parent_supplies = ARRAY_SIZE(wm5102_supplies), 981 }, 982}; 983 984int arizona_dev_init(struct arizona *arizona) 985{ 986 static const char * const mclk_name[] = { "mclk1", "mclk2" }; 987 struct device *dev = arizona->dev; 988 const char *type_name = NULL; 989 unsigned int reg, val; 990 int (*apply_patch)(struct arizona *) = NULL; 991 const struct mfd_cell *subdevs = NULL; 992 int n_subdevs = 0, ret, i; 993 994 dev_set_drvdata(arizona->dev, arizona); 995 mutex_init(&arizona->clk_lock); 996 997 if (dev_get_platdata(arizona->dev)) { 998 memcpy(&arizona->pdata, dev_get_platdata(arizona->dev), 999 sizeof(arizona->pdata)); 1000 } else { 1001 ret = arizona_of_get_core_pdata(arizona); 1002 if (ret < 0) 1003 return ret; 1004 } 1005 1006 BUILD_BUG_ON(ARRAY_SIZE(arizona->mclk) != ARRAY_SIZE(mclk_name)); 1007 for (i = 0; i < ARRAY_SIZE(arizona->mclk); i++) { 1008 arizona->mclk[i] = devm_clk_get(arizona->dev, mclk_name[i]); 1009 if (IS_ERR(arizona->mclk[i])) { 1010 dev_info(arizona->dev, "Failed to get %s: %ld\n", 1011 mclk_name[i], PTR_ERR(arizona->mclk[i])); 1012 arizona->mclk[i] = NULL; 1013 } 1014 } 1015 1016 regcache_cache_only(arizona->regmap, true); 1017 1018 switch (arizona->type) { 1019 case WM5102: 1020 case WM5110: 1021 case WM8280: 1022 case WM8997: 1023 case WM8998: 1024 case WM1814: 1025 case WM1831: 1026 case CS47L24: 1027 for (i = 0; i < ARRAY_SIZE(wm5102_core_supplies); i++) 1028 arizona->core_supplies[i].supply 1029 = wm5102_core_supplies[i]; 1030 arizona->num_core_supplies = ARRAY_SIZE(wm5102_core_supplies); 1031 break; 1032 default: 1033 dev_err(arizona->dev, "Unknown device type %d\n", 1034 arizona->type); 1035 return -ENODEV; 1036 } 1037 1038 /* Mark DCVDD as external, LDO1 driver will clear if internal */ 1039 arizona->external_dcvdd = true; 1040 1041 switch (arizona->type) { 1042 case WM1831: 1043 case CS47L24: 1044 break; /* No LDO1 regulator */ 1045 default: 1046 ret = mfd_add_devices(arizona->dev, -1, early_devs, 1047 ARRAY_SIZE(early_devs), NULL, 0, NULL); 1048 if (ret != 0) { 1049 dev_err(dev, "Failed to add early children: %d\n", ret); 1050 return ret; 1051 } 1052 break; 1053 } 1054 1055 ret = devm_regulator_bulk_get(dev, arizona->num_core_supplies, 1056 arizona->core_supplies); 1057 if (ret != 0) { 1058 dev_err(dev, "Failed to request core supplies: %d\n", 1059 ret); 1060 goto err_early; 1061 } 1062 1063 /** 1064 * Don't use devres here because the only device we have to get 1065 * against is the MFD device and DCVDD will likely be supplied by 1066 * one of its children. Meaning that the regulator will be 1067 * destroyed by the time devres calls regulator put. 1068 */ 1069 arizona->dcvdd = regulator_get(arizona->dev, "DCVDD"); 1070 if (IS_ERR(arizona->dcvdd)) { 1071 ret = PTR_ERR(arizona->dcvdd); 1072 dev_err(dev, "Failed to request DCVDD: %d\n", ret); 1073 goto err_early; 1074 } 1075 1076 if (!arizona->pdata.reset) { 1077 /* Start out with /RESET low to put the chip into reset */ 1078 arizona->pdata.reset = devm_gpiod_get(arizona->dev, "reset", 1079 GPIOD_OUT_LOW); 1080 if (IS_ERR(arizona->pdata.reset)) { 1081 ret = PTR_ERR(arizona->pdata.reset); 1082 if (ret == -EPROBE_DEFER) 1083 goto err_dcvdd; 1084 1085 dev_err(arizona->dev, 1086 "Reset GPIO missing/malformed: %d\n", ret); 1087 1088 arizona->pdata.reset = NULL; 1089 } 1090 } 1091 1092 ret = regulator_bulk_enable(arizona->num_core_supplies, 1093 arizona->core_supplies); 1094 if (ret != 0) { 1095 dev_err(dev, "Failed to enable core supplies: %d\n", 1096 ret); 1097 goto err_dcvdd; 1098 } 1099 1100 ret = regulator_enable(arizona->dcvdd); 1101 if (ret != 0) { 1102 dev_err(dev, "Failed to enable DCVDD: %d\n", ret); 1103 goto err_enable; 1104 } 1105 1106 arizona_disable_reset(arizona); 1107 1108 regcache_cache_only(arizona->regmap, false); 1109 1110 /* Verify that this is a chip we know about */ 1111 ret = regmap_read(arizona->regmap, ARIZONA_SOFTWARE_RESET, ®); 1112 if (ret != 0) { 1113 dev_err(dev, "Failed to read ID register: %d\n", ret); 1114 goto err_reset; 1115 } 1116 1117 switch (reg) { 1118 case 0x5102: 1119 case 0x5110: 1120 case 0x6349: 1121 case 0x6363: 1122 case 0x8997: 1123 break; 1124 default: 1125 dev_err(arizona->dev, "Unknown device ID: %x\n", reg); 1126 ret = -ENODEV; 1127 goto err_reset; 1128 } 1129 1130 /* If we have a /RESET GPIO we'll already be reset */ 1131 if (!arizona->pdata.reset) { 1132 ret = regmap_write(arizona->regmap, ARIZONA_SOFTWARE_RESET, 0); 1133 if (ret != 0) { 1134 dev_err(dev, "Failed to reset device: %d\n", ret); 1135 goto err_reset; 1136 } 1137 1138 usleep_range(1000, 5000); 1139 } 1140 1141 /* Ensure device startup is complete */ 1142 switch (arizona->type) { 1143 case WM5102: 1144 ret = regmap_read(arizona->regmap, 1145 ARIZONA_WRITE_SEQUENCER_CTRL_3, &val); 1146 if (ret) { 1147 dev_err(dev, 1148 "Failed to check write sequencer state: %d\n", 1149 ret); 1150 } else if (val & 0x01) { 1151 ret = wm5102_clear_write_sequencer(arizona); 1152 if (ret) 1153 return ret; 1154 } 1155 break; 1156 default: 1157 break; 1158 } 1159 1160 ret = arizona_wait_for_boot(arizona); 1161 if (ret) { 1162 dev_err(arizona->dev, "Device failed initial boot: %d\n", ret); 1163 goto err_reset; 1164 } 1165 1166 /* Read the device ID information & do device specific stuff */ 1167 ret = regmap_read(arizona->regmap, ARIZONA_SOFTWARE_RESET, ®); 1168 if (ret != 0) { 1169 dev_err(dev, "Failed to read ID register: %d\n", ret); 1170 goto err_reset; 1171 } 1172 1173 ret = regmap_read(arizona->regmap, ARIZONA_DEVICE_REVISION, 1174 &arizona->rev); 1175 if (ret != 0) { 1176 dev_err(dev, "Failed to read revision register: %d\n", ret); 1177 goto err_reset; 1178 } 1179 arizona->rev &= ARIZONA_DEVICE_REVISION_MASK; 1180 1181 switch (reg) { 1182 case 0x5102: 1183 if (IS_ENABLED(CONFIG_MFD_WM5102)) { 1184 type_name = "WM5102"; 1185 if (arizona->type != WM5102) { 1186 dev_warn(arizona->dev, 1187 "WM5102 registered as %d\n", 1188 arizona->type); 1189 arizona->type = WM5102; 1190 } 1191 1192 apply_patch = wm5102_patch; 1193 arizona->rev &= 0x7; 1194 subdevs = wm5102_devs; 1195 n_subdevs = ARRAY_SIZE(wm5102_devs); 1196 } 1197 break; 1198 case 0x5110: 1199 if (IS_ENABLED(CONFIG_MFD_WM5110)) { 1200 switch (arizona->type) { 1201 case WM5110: 1202 type_name = "WM5110"; 1203 break; 1204 case WM8280: 1205 type_name = "WM8280"; 1206 break; 1207 default: 1208 type_name = "WM5110"; 1209 dev_warn(arizona->dev, 1210 "WM5110 registered as %d\n", 1211 arizona->type); 1212 arizona->type = WM5110; 1213 break; 1214 } 1215 1216 apply_patch = wm5110_patch; 1217 subdevs = wm5110_devs; 1218 n_subdevs = ARRAY_SIZE(wm5110_devs); 1219 } 1220 break; 1221 case 0x6363: 1222 if (IS_ENABLED(CONFIG_MFD_CS47L24)) { 1223 switch (arizona->type) { 1224 case CS47L24: 1225 type_name = "CS47L24"; 1226 break; 1227 1228 case WM1831: 1229 type_name = "WM1831"; 1230 break; 1231 1232 default: 1233 dev_warn(arizona->dev, 1234 "CS47L24 registered as %d\n", 1235 arizona->type); 1236 arizona->type = CS47L24; 1237 break; 1238 } 1239 1240 apply_patch = cs47l24_patch; 1241 subdevs = cs47l24_devs; 1242 n_subdevs = ARRAY_SIZE(cs47l24_devs); 1243 } 1244 break; 1245 case 0x8997: 1246 if (IS_ENABLED(CONFIG_MFD_WM8997)) { 1247 type_name = "WM8997"; 1248 if (arizona->type != WM8997) { 1249 dev_warn(arizona->dev, 1250 "WM8997 registered as %d\n", 1251 arizona->type); 1252 arizona->type = WM8997; 1253 } 1254 1255 apply_patch = wm8997_patch; 1256 subdevs = wm8997_devs; 1257 n_subdevs = ARRAY_SIZE(wm8997_devs); 1258 } 1259 break; 1260 case 0x6349: 1261 if (IS_ENABLED(CONFIG_MFD_WM8998)) { 1262 switch (arizona->type) { 1263 case WM8998: 1264 type_name = "WM8998"; 1265 break; 1266 1267 case WM1814: 1268 type_name = "WM1814"; 1269 break; 1270 1271 default: 1272 type_name = "WM8998"; 1273 dev_warn(arizona->dev, 1274 "WM8998 registered as %d\n", 1275 arizona->type); 1276 arizona->type = WM8998; 1277 } 1278 1279 apply_patch = wm8998_patch; 1280 subdevs = wm8998_devs; 1281 n_subdevs = ARRAY_SIZE(wm8998_devs); 1282 } 1283 break; 1284 default: 1285 dev_err(arizona->dev, "Unknown device ID %x\n", reg); 1286 ret = -ENODEV; 1287 goto err_reset; 1288 } 1289 1290 if (!subdevs) { 1291 dev_err(arizona->dev, 1292 "No kernel support for device ID %x\n", reg); 1293 ret = -ENODEV; 1294 goto err_reset; 1295 } 1296 1297 dev_info(dev, "%s revision %c\n", type_name, arizona->rev + 'A'); 1298 1299 if (apply_patch) { 1300 ret = apply_patch(arizona); 1301 if (ret != 0) { 1302 dev_err(arizona->dev, "Failed to apply patch: %d\n", 1303 ret); 1304 goto err_reset; 1305 } 1306 1307 switch (arizona->type) { 1308 case WM5102: 1309 ret = wm5102_apply_hardware_patch(arizona); 1310 if (ret) { 1311 dev_err(arizona->dev, 1312 "Failed to apply hardware patch: %d\n", 1313 ret); 1314 goto err_reset; 1315 } 1316 break; 1317 case WM5110: 1318 case WM8280: 1319 ret = wm5110_apply_sleep_patch(arizona); 1320 if (ret) { 1321 dev_err(arizona->dev, 1322 "Failed to apply sleep patch: %d\n", 1323 ret); 1324 goto err_reset; 1325 } 1326 break; 1327 default: 1328 break; 1329 } 1330 } 1331 1332 for (i = 0; i < ARRAY_SIZE(arizona->pdata.gpio_defaults); i++) { 1333 if (!arizona->pdata.gpio_defaults[i]) 1334 continue; 1335 1336 regmap_write(arizona->regmap, ARIZONA_GPIO1_CTRL + i, 1337 arizona->pdata.gpio_defaults[i]); 1338 } 1339 1340 /* Chip default */ 1341 if (!arizona->pdata.clk32k_src) 1342 arizona->pdata.clk32k_src = ARIZONA_32KZ_MCLK2; 1343 1344 switch (arizona->pdata.clk32k_src) { 1345 case ARIZONA_32KZ_MCLK1: 1346 case ARIZONA_32KZ_MCLK2: 1347 regmap_update_bits(arizona->regmap, ARIZONA_CLOCK_32K_1, 1348 ARIZONA_CLK_32K_SRC_MASK, 1349 arizona->pdata.clk32k_src - 1); 1350 arizona_clk32k_enable(arizona); 1351 break; 1352 case ARIZONA_32KZ_NONE: 1353 regmap_update_bits(arizona->regmap, ARIZONA_CLOCK_32K_1, 1354 ARIZONA_CLK_32K_SRC_MASK, 2); 1355 break; 1356 default: 1357 dev_err(arizona->dev, "Invalid 32kHz clock source: %d\n", 1358 arizona->pdata.clk32k_src); 1359 ret = -EINVAL; 1360 goto err_reset; 1361 } 1362 1363 for (i = 0; i < ARIZONA_MAX_MICBIAS; i++) { 1364 if (!arizona->pdata.micbias[i].mV && 1365 !arizona->pdata.micbias[i].bypass) 1366 continue; 1367 1368 /* Apply default for bypass mode */ 1369 if (!arizona->pdata.micbias[i].mV) 1370 arizona->pdata.micbias[i].mV = 2800; 1371 1372 val = (arizona->pdata.micbias[i].mV - 1500) / 100; 1373 1374 val <<= ARIZONA_MICB1_LVL_SHIFT; 1375 1376 if (arizona->pdata.micbias[i].ext_cap) 1377 val |= ARIZONA_MICB1_EXT_CAP; 1378 1379 if (arizona->pdata.micbias[i].discharge) 1380 val |= ARIZONA_MICB1_DISCH; 1381 1382 if (arizona->pdata.micbias[i].soft_start) 1383 val |= ARIZONA_MICB1_RATE; 1384 1385 if (arizona->pdata.micbias[i].bypass) 1386 val |= ARIZONA_MICB1_BYPASS; 1387 1388 regmap_update_bits(arizona->regmap, 1389 ARIZONA_MIC_BIAS_CTRL_1 + i, 1390 ARIZONA_MICB1_LVL_MASK | 1391 ARIZONA_MICB1_EXT_CAP | 1392 ARIZONA_MICB1_DISCH | 1393 ARIZONA_MICB1_BYPASS | 1394 ARIZONA_MICB1_RATE, val); 1395 } 1396 1397 pm_runtime_set_active(arizona->dev); 1398 pm_runtime_enable(arizona->dev); 1399 1400 /* Set up for interrupts */ 1401 ret = arizona_irq_init(arizona); 1402 if (ret != 0) 1403 goto err_pm; 1404 1405 pm_runtime_set_autosuspend_delay(arizona->dev, 100); 1406 pm_runtime_use_autosuspend(arizona->dev); 1407 1408 arizona_request_irq(arizona, ARIZONA_IRQ_CLKGEN_ERR, "CLKGEN error", 1409 arizona_clkgen_err, arizona); 1410 arizona_request_irq(arizona, ARIZONA_IRQ_OVERCLOCKED, "Overclocked", 1411 arizona_overclocked, arizona); 1412 arizona_request_irq(arizona, ARIZONA_IRQ_UNDERCLOCKED, "Underclocked", 1413 arizona_underclocked, arizona); 1414 1415 ret = mfd_add_devices(arizona->dev, PLATFORM_DEVID_NONE, 1416 subdevs, n_subdevs, NULL, 0, NULL); 1417 1418 if (ret) { 1419 dev_err(arizona->dev, "Failed to add subdevices: %d\n", ret); 1420 goto err_irq; 1421 } 1422 1423 return 0; 1424 1425err_irq: 1426 arizona_irq_exit(arizona); 1427err_pm: 1428 pm_runtime_disable(arizona->dev); 1429 1430 switch (arizona->pdata.clk32k_src) { 1431 case ARIZONA_32KZ_MCLK1: 1432 case ARIZONA_32KZ_MCLK2: 1433 arizona_clk32k_disable(arizona); 1434 break; 1435 default: 1436 break; 1437 } 1438err_reset: 1439 arizona_enable_reset(arizona); 1440 regulator_disable(arizona->dcvdd); 1441err_enable: 1442 regulator_bulk_disable(arizona->num_core_supplies, 1443 arizona->core_supplies); 1444err_dcvdd: 1445 regulator_put(arizona->dcvdd); 1446err_early: 1447 mfd_remove_devices(dev); 1448 return ret; 1449} 1450EXPORT_SYMBOL_GPL(arizona_dev_init); 1451 1452int arizona_dev_exit(struct arizona *arizona) 1453{ 1454 disable_irq(arizona->irq); 1455 pm_runtime_disable(arizona->dev); 1456 1457 regulator_disable(arizona->dcvdd); 1458 regulator_put(arizona->dcvdd); 1459 1460 switch (arizona->pdata.clk32k_src) { 1461 case ARIZONA_32KZ_MCLK1: 1462 case ARIZONA_32KZ_MCLK2: 1463 arizona_clk32k_disable(arizona); 1464 break; 1465 default: 1466 break; 1467 } 1468 1469 mfd_remove_devices(arizona->dev); 1470 arizona_free_irq(arizona, ARIZONA_IRQ_UNDERCLOCKED, arizona); 1471 arizona_free_irq(arizona, ARIZONA_IRQ_OVERCLOCKED, arizona); 1472 arizona_free_irq(arizona, ARIZONA_IRQ_CLKGEN_ERR, arizona); 1473 arizona_irq_exit(arizona); 1474 arizona_enable_reset(arizona); 1475 1476 regulator_bulk_disable(arizona->num_core_supplies, 1477 arizona->core_supplies); 1478 return 0; 1479} 1480EXPORT_SYMBOL_GPL(arizona_dev_exit); 1481