drivers/mfd/arizona-core.c

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