sound/soc/codecs/wm9090.c

   1 /*
   2  * ALSA SoC WM9090 driver
   3  *
   4  * Copyright 2009, 2010 Wolfson Microelectronics
   5  *
   6  * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License
  10  * version 2 as published by the Free Software Foundation.
  11  *
  12  * This program is distributed in the hope that it will be useful, but
  13  * WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  15  * General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with this program; if not, write to the Free Software
  19  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  20  * 02110-1301 USA
  21  */
  22
  23 #include <linux/module.h>
  24 #include <linux/errno.h>
  25 #include <linux/device.h>
  26 #include <linux/i2c.h>
  27 #include <linux/delay.h>
  28 #include <linux/slab.h>
  29 #include <sound/initval.h>
  30 #include <sound/soc.h>
  31 #include <sound/soc-dapm.h>
  32 #include <sound/tlv.h>
  33 #include <sound/wm9090.h>
  34
  35 #include "wm9090.h"
  36
  37 static struct snd_soc_codec *wm9090_codec;
  38
  39 static const u16 wm9090_reg_defaults[] = {
  40         0x9093,     /* R0   - Software Reset */
  41         0x0006,     /* R1   - Power Management (1) */
  42         0x6000,     /* R2   - Power Management (2) */
  43         0x0000,     /* R3   - Power Management (3) */
  44         0x0000,     /* R4 */
  45         0x0000,     /* R5 */
  46         0x01C0,     /* R6   - Clocking 1 */
  47         0x0000,     /* R7 */
  48         0x0000,     /* R8 */
  49         0x0000,     /* R9 */
  50         0x0000,     /* R10 */
  51         0x0000,     /* R11 */
  52         0x0000,     /* R12 */
  53         0x0000,     /* R13 */
  54         0x0000,     /* R14 */
  55         0x0000,     /* R15 */
  56         0x0000,     /* R16 */
  57         0x0000,     /* R17 */
  58         0x0000,     /* R18 */
  59         0x0000,     /* R19 */
  60         0x0000,     /* R20 */
  61         0x0000,     /* R21 */
  62         0x0003,     /* R22  - IN1 Line Control */
  63         0x0003,     /* R23  - IN2 Line Control */
  64         0x0083,     /* R24  - IN1 Line Input A Volume */
  65         0x0083,     /* R25  - IN1  Line Input B Volume */
  66         0x0083,     /* R26  - IN2 Line Input A Volume */
  67         0x0083,     /* R27  - IN2 Line Input B Volume */
  68         0x002D,     /* R28  - Left Output Volume */
  69         0x002D,     /* R29  - Right Output Volume */
  70         0x0000,     /* R30 */
  71         0x0000,     /* R31 */
  72         0x0000,     /* R32 */
  73         0x0000,     /* R33 */
  74         0x0100,     /* R34  - SPKMIXL Attenuation */
  75         0x0000,     /* R35 */
  76         0x0010,     /* R36  - SPKOUT Mixers */
  77         0x0140,     /* R37  - ClassD3 */
  78         0x0039,     /* R38  - Speaker Volume Left */
  79         0x0000,     /* R39 */
  80         0x0000,     /* R40 */
  81         0x0000,     /* R41 */
  82         0x0000,     /* R42 */
  83         0x0000,     /* R43 */
  84         0x0000,     /* R44 */
  85         0x0000,     /* R45  - Output Mixer1 */
  86         0x0000,     /* R46  - Output Mixer2 */
  87         0x0100,     /* R47  - Output Mixer3 */
  88         0x0100,     /* R48  - Output Mixer4 */
  89         0x0000,     /* R49 */
  90         0x0000,     /* R50 */
  91         0x0000,     /* R51 */
  92         0x0000,     /* R52 */
  93         0x0000,     /* R53 */
  94         0x0000,     /* R54  - Speaker Mixer */
  95         0x0000,     /* R55 */
  96         0x0000,     /* R56 */
  97         0x000D,     /* R57  - AntiPOP2 */
  98         0x0000,     /* R58 */
  99         0x0000,     /* R59 */
 100         0x0000,     /* R60 */
 101         0x0000,     /* R61 */
 102         0x0000,     /* R62 */
 103         0x0000,     /* R63 */
 104         0x0000,     /* R64 */
 105         0x0000,     /* R65 */
 106         0x0000,     /* R66 */
 107         0x0000,     /* R67 */
 108         0x0000,     /* R68 */
 109         0x0000,     /* R69 */
 110         0x0000,     /* R70  - Write Sequencer 0 */
 111         0x0000,     /* R71  - Write Sequencer 1 */
 112         0x0000,     /* R72  - Write Sequencer 2 */
 113         0x0000,     /* R73  - Write Sequencer 3 */
 114         0x0000,     /* R74  - Write Sequencer 4 */
 115         0x0000,     /* R75  - Write Sequencer 5 */
 116         0x1F25,     /* R76  - Charge Pump 1 */
 117         0x0000,     /* R77 */
 118         0x0000,     /* R78 */
 119         0x0000,     /* R79 */
 120         0x0000,     /* R80 */
 121         0x0000,     /* R81 */
 122         0x0000,     /* R82 */
 123         0x0000,     /* R83 */
 124         0x0000,     /* R84  - DC Servo 0 */
 125         0x054A,     /* R85  - DC Servo 1 */
 126         0x0000,     /* R86 */
 127         0x0000,     /* R87  - DC Servo 3 */
 128         0x0000,     /* R88  - DC Servo Readback 0 */
 129         0x0000,     /* R89  - DC Servo Readback 1 */
 130         0x0000,     /* R90  - DC Servo Readback 2 */
 131         0x0000,     /* R91 */
 132         0x0000,     /* R92 */
 133         0x0000,     /* R93 */
 134         0x0000,     /* R94 */
 135         0x0000,     /* R95 */
 136         0x0100,     /* R96  - Analogue HP 0 */
 137         0x0000,     /* R97 */
 138         0x8640,     /* R98  - AGC Control 0 */
 139         0xC000,     /* R99  - AGC Control 1 */
 140         0x0200,     /* R100 - AGC Control 2 */
 141 };
 142
 143 /* This struct is used to save the context */
 144 struct wm9090_priv {
 145         /* We're not really registering as a CODEC since ASoC core
 146          * does not yet support multiple CODECs but having the CODEC
 147          * structure means we can reuse some of the ASoC core
 148          * features.
 149          */
 150         struct snd_soc_codec codec;
 151         struct mutex mutex;
 152         u16 reg_cache[WM9090_MAX_REGISTER + 1];
 153         struct wm9090_platform_data pdata;
 154 };
 155
 156 static int wm9090_volatile(unsigned int reg)
 157 {
 158         switch (reg) {
 159         case WM9090_SOFTWARE_RESET:
 160         case WM9090_DC_SERVO_0:
 161         case WM9090_DC_SERVO_READBACK_0:
 162         case WM9090_DC_SERVO_READBACK_1:
 163         case WM9090_DC_SERVO_READBACK_2:
 164                 return 1;
 165
 166         default:
 167                 return 0;
 168         }
 169 }
 170
 171 static void wait_for_dc_servo(struct snd_soc_codec *codec)
 172 {
 173         unsigned int reg;
 174         int count = 0;
 175
 176         dev_dbg(codec->dev, "Waiting for DC servo...\n");
 177         do {
 178                 count++;
 179                 msleep(1);
 180                 reg = snd_soc_read(codec, WM9090_DC_SERVO_READBACK_0);
 181                 dev_dbg(codec->dev, "DC servo status: %x\n", reg);
 182         } while ((reg & WM9090_DCS_CAL_COMPLETE_MASK)
 183                  != WM9090_DCS_CAL_COMPLETE_MASK && count < 1000);
 184
 185         if ((reg & WM9090_DCS_CAL_COMPLETE_MASK)
 186             != WM9090_DCS_CAL_COMPLETE_MASK)
 187                 dev_err(codec->dev, "Timed out waiting for DC Servo\n");
 188 }
 189
 190 static const unsigned int in_tlv[] = {
 191         TLV_DB_RANGE_HEAD(6),
 192         0, 0, TLV_DB_SCALE_ITEM(-600, 0, 0),
 193         1, 3, TLV_DB_SCALE_ITEM(-350, 350, 0),
 194         4, 6, TLV_DB_SCALE_ITEM(600, 600, 0),
 195 };
 196 static const unsigned int mix_tlv[] = {
 197         TLV_DB_RANGE_HEAD(4),
 198         0, 2, TLV_DB_SCALE_ITEM(-1200, 300, 0),
 199         3, 3, TLV_DB_SCALE_ITEM(0, 0, 0),
 200 };
 201 static const DECLARE_TLV_DB_SCALE(out_tlv, -5700, 100, 0);
 202 static const unsigned int spkboost_tlv[] = {
 203         TLV_DB_RANGE_HEAD(7),
 204         0, 6, TLV_DB_SCALE_ITEM(0, 150, 0),
 205         7, 7, TLV_DB_SCALE_ITEM(1200, 0, 0),
 206 };
 207
 208 static const struct snd_kcontrol_new wm9090_controls[] = {
 209 SOC_SINGLE_TLV("IN1A Volume", WM9090_IN1_LINE_INPUT_A_VOLUME, 0, 6, 0,
 210                in_tlv),
 211 SOC_SINGLE("IN1A Switch", WM9090_IN1_LINE_INPUT_A_VOLUME, 7, 1, 1),
 212 SOC_SINGLE("IN1A ZC Switch", WM9090_IN1_LINE_INPUT_A_VOLUME, 6, 1, 0),
 213
 214 SOC_SINGLE_TLV("IN2A Volume", WM9090_IN2_LINE_INPUT_A_VOLUME, 0, 6, 0,
 215                in_tlv),
 216 SOC_SINGLE("IN2A Switch", WM9090_IN2_LINE_INPUT_A_VOLUME, 7, 1, 1),
 217 SOC_SINGLE("IN2A ZC Switch", WM9090_IN2_LINE_INPUT_A_VOLUME, 6, 1, 0),
 218
 219 SOC_SINGLE("MIXOUTL Switch", WM9090_OUTPUT_MIXER3, 8, 1, 1),
 220 SOC_SINGLE_TLV("MIXOUTL IN1A Volume", WM9090_OUTPUT_MIXER3, 6, 3, 1,
 221                mix_tlv),
 222 SOC_SINGLE_TLV("MIXOUTL IN2A Volume", WM9090_OUTPUT_MIXER3, 2, 3, 1,
 223                mix_tlv),
 224
 225 SOC_SINGLE("MIXOUTR Switch", WM9090_OUTPUT_MIXER4, 8, 1, 1),
 226 SOC_SINGLE_TLV("MIXOUTR IN1A Volume", WM9090_OUTPUT_MIXER4, 6, 3, 1,
 227                mix_tlv),
 228 SOC_SINGLE_TLV("MIXOUTR IN2A Volume", WM9090_OUTPUT_MIXER4, 2, 3, 1,
 229                mix_tlv),
 230
 231 SOC_SINGLE("SPKMIX Switch", WM9090_SPKMIXL_ATTENUATION, 8, 1, 1),
 232 SOC_SINGLE_TLV("SPKMIX IN1A Volume", WM9090_SPKMIXL_ATTENUATION, 6, 3, 1,
 233                mix_tlv),
 234 SOC_SINGLE_TLV("SPKMIX IN2A Volume", WM9090_SPKMIXL_ATTENUATION, 2, 3, 1,
 235                mix_tlv),
 236
 237 SOC_DOUBLE_R_TLV("Headphone Volume", WM9090_LEFT_OUTPUT_VOLUME,
 238                  WM9090_RIGHT_OUTPUT_VOLUME, 0, 63, 0, out_tlv),
 239 SOC_DOUBLE_R("Headphone Switch", WM9090_LEFT_OUTPUT_VOLUME,
 240              WM9090_RIGHT_OUTPUT_VOLUME, 6, 1, 1),
 241 SOC_DOUBLE_R("Headphone ZC Switch", WM9090_LEFT_OUTPUT_VOLUME,
 242              WM9090_RIGHT_OUTPUT_VOLUME, 7, 1, 0),
 243
 244 SOC_SINGLE_TLV("Speaker Volume", WM9090_SPEAKER_VOLUME_LEFT, 0, 63, 0,
 245                out_tlv),
 246 SOC_SINGLE("Speaker Switch", WM9090_SPEAKER_VOLUME_LEFT, 6, 1, 1),
 247 SOC_SINGLE("Speaker ZC Switch", WM9090_SPEAKER_VOLUME_LEFT, 7, 1, 0),
 248 SOC_SINGLE_TLV("Speaker Boost Volume", WM9090_CLASSD3, 3, 7, 0, spkboost_tlv),
 249 };
 250
 251 static const struct snd_kcontrol_new wm9090_in1_se_controls[] = {
 252 SOC_SINGLE_TLV("IN1B Volume", WM9090_IN1_LINE_INPUT_B_VOLUME, 0, 6, 0,
 253                in_tlv),
 254 SOC_SINGLE("IN1B Switch", WM9090_IN1_LINE_INPUT_B_VOLUME, 7, 1, 1),
 255 SOC_SINGLE("IN1B ZC Switch", WM9090_IN1_LINE_INPUT_B_VOLUME, 6, 1, 0),
 256
 257 SOC_SINGLE_TLV("SPKMIX IN1B Volume", WM9090_SPKMIXL_ATTENUATION, 4, 3, 1,
 258                mix_tlv),
 259 SOC_SINGLE_TLV("MIXOUTL IN1B Volume", WM9090_OUTPUT_MIXER3, 4, 3, 1,
 260                mix_tlv),
 261 SOC_SINGLE_TLV("MIXOUTR IN1B Volume", WM9090_OUTPUT_MIXER4, 4, 3, 1,
 262                mix_tlv),
 263 };
 264
 265 static const struct snd_kcontrol_new wm9090_in2_se_controls[] = {
 266 SOC_SINGLE_TLV("IN2B Volume", WM9090_IN2_LINE_INPUT_B_VOLUME, 0, 6, 0,
 267                in_tlv),
 268 SOC_SINGLE("IN2B Switch", WM9090_IN2_LINE_INPUT_B_VOLUME, 7, 1, 1),
 269 SOC_SINGLE("IN2B ZC Switch", WM9090_IN2_LINE_INPUT_B_VOLUME, 6, 1, 0),
 270
 271 SOC_SINGLE_TLV("SPKMIX IN2B Volume", WM9090_SPKMIXL_ATTENUATION, 0, 3, 1,
 272                mix_tlv),
 273 SOC_SINGLE_TLV("MIXOUTL IN2B Volume", WM9090_OUTPUT_MIXER3, 0, 3, 1,
 274                mix_tlv),
 275 SOC_SINGLE_TLV("MIXOUTR IN2B Volume", WM9090_OUTPUT_MIXER4, 0, 3, 1,
 276                mix_tlv),
 277 };
 278
 279 static int hp_ev(struct snd_soc_dapm_widget *w,
 280                  struct snd_kcontrol *kcontrol, int event)
 281 {
 282         struct snd_soc_codec *codec = w->codec;
 283         unsigned int reg = snd_soc_read(codec, WM9090_ANALOGUE_HP_0);
 284
 285         switch (event) {
 286         case SND_SOC_DAPM_POST_PMU:
 287                 snd_soc_update_bits(codec, WM9090_CHARGE_PUMP_1,
 288                                     WM9090_CP_ENA, WM9090_CP_ENA);
 289
 290                 msleep(5);
 291
 292                 snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
 293                                     WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA,
 294                                     WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA);
 295
 296                 reg |= WM9090_HPOUT1L_DLY | WM9090_HPOUT1R_DLY;
 297                 snd_soc_write(codec, WM9090_ANALOGUE_HP_0, reg);
 298
 299                 /* Start the DC servo.  We don't currently use the
 300                  * ability to save the state since we don't have full
 301                  * control of the analogue paths and they can change
 302                  * DC offsets; see the WM8904 driver for an example of
 303                  * doing so.
 304                  */
 305                 snd_soc_write(codec, WM9090_DC_SERVO_0,
 306                               WM9090_DCS_ENA_CHAN_0 |
 307                               WM9090_DCS_ENA_CHAN_1 |
 308                               WM9090_DCS_TRIG_STARTUP_1 |
 309                               WM9090_DCS_TRIG_STARTUP_0);
 310                 wait_for_dc_servo(codec);
 311
 312                 reg |= WM9090_HPOUT1R_OUTP | WM9090_HPOUT1R_RMV_SHORT |
 313                         WM9090_HPOUT1L_OUTP | WM9090_HPOUT1L_RMV_SHORT;
 314                 snd_soc_write(codec, WM9090_ANALOGUE_HP_0, reg);
 315                 break;
 316
 317         case SND_SOC_DAPM_PRE_PMD:
 318                 reg &= ~(WM9090_HPOUT1L_RMV_SHORT |
 319                          WM9090_HPOUT1L_DLY |
 320                          WM9090_HPOUT1L_OUTP |
 321                          WM9090_HPOUT1R_RMV_SHORT |
 322                          WM9090_HPOUT1R_DLY |
 323                          WM9090_HPOUT1R_OUTP);
 324
 325                 snd_soc_write(codec, WM9090_ANALOGUE_HP_0, reg);
 326
 327                 snd_soc_write(codec, WM9090_DC_SERVO_0, 0);
 328
 329                 snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
 330                                     WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA,
 331                                     0);
 332
 333                 snd_soc_update_bits(codec, WM9090_CHARGE_PUMP_1,
 334                                     WM9090_CP_ENA, 0);
 335                 break;
 336         }
 337
 338         return 0;
 339 }
 340
 341 static const struct snd_kcontrol_new spkmix[] = {
 342 SOC_DAPM_SINGLE("IN1A Switch", WM9090_SPEAKER_MIXER, 6, 1, 0),
 343 SOC_DAPM_SINGLE("IN1B Switch", WM9090_SPEAKER_MIXER, 4, 1, 0),
 344 SOC_DAPM_SINGLE("IN2A Switch", WM9090_SPEAKER_MIXER, 2, 1, 0),
 345 SOC_DAPM_SINGLE("IN2B Switch", WM9090_SPEAKER_MIXER, 0, 1, 0),
 346 };
 347
 348 static const struct snd_kcontrol_new spkout[] = {
 349 SOC_DAPM_SINGLE("Mixer Switch", WM9090_SPKOUT_MIXERS, 4, 1, 0),
 350 };
 351
 352 static const struct snd_kcontrol_new mixoutl[] = {
 353 SOC_DAPM_SINGLE("IN1A Switch", WM9090_OUTPUT_MIXER1, 6, 1, 0),
 354 SOC_DAPM_SINGLE("IN1B Switch", WM9090_OUTPUT_MIXER1, 4, 1, 0),
 355 SOC_DAPM_SINGLE("IN2A Switch", WM9090_OUTPUT_MIXER1, 2, 1, 0),
 356 SOC_DAPM_SINGLE("IN2B Switch", WM9090_OUTPUT_MIXER1, 0, 1, 0),
 357 };
 358
 359 static const struct snd_kcontrol_new mixoutr[] = {
 360 SOC_DAPM_SINGLE("IN1A Switch", WM9090_OUTPUT_MIXER2, 6, 1, 0),
 361 SOC_DAPM_SINGLE("IN1B Switch", WM9090_OUTPUT_MIXER2, 4, 1, 0),
 362 SOC_DAPM_SINGLE("IN2A Switch", WM9090_OUTPUT_MIXER2, 2, 1, 0),
 363 SOC_DAPM_SINGLE("IN2B Switch", WM9090_OUTPUT_MIXER2, 0, 1, 0),
 364 };
 365
 366 static const struct snd_soc_dapm_widget wm9090_dapm_widgets[] = {
 367 SND_SOC_DAPM_INPUT("IN1+"),
 368 SND_SOC_DAPM_INPUT("IN1-"),
 369 SND_SOC_DAPM_INPUT("IN2+"),
 370 SND_SOC_DAPM_INPUT("IN2-"),
 371
 372 SND_SOC_DAPM_SUPPLY("OSC", WM9090_POWER_MANAGEMENT_1, 3, 0, NULL, 0),
 373
 374 SND_SOC_DAPM_PGA("IN1A PGA", WM9090_POWER_MANAGEMENT_2, 7, 0, NULL, 0),
 375 SND_SOC_DAPM_PGA("IN1B PGA", WM9090_POWER_MANAGEMENT_2, 6, 0, NULL, 0),
 376 SND_SOC_DAPM_PGA("IN2A PGA", WM9090_POWER_MANAGEMENT_2, 5, 0, NULL, 0),
 377 SND_SOC_DAPM_PGA("IN2B PGA", WM9090_POWER_MANAGEMENT_2, 4, 0, NULL, 0),
 378
 379 SND_SOC_DAPM_MIXER("SPKMIX", WM9090_POWER_MANAGEMENT_3, 3, 0,
 380                    spkmix, ARRAY_SIZE(spkmix)),
 381 SND_SOC_DAPM_MIXER("MIXOUTL", WM9090_POWER_MANAGEMENT_3, 5, 0,
 382                    mixoutl, ARRAY_SIZE(mixoutl)),
 383 SND_SOC_DAPM_MIXER("MIXOUTR", WM9090_POWER_MANAGEMENT_3, 4, 0,
 384                    mixoutr, ARRAY_SIZE(mixoutr)),
 385
 386 SND_SOC_DAPM_PGA_E("HP PGA", SND_SOC_NOPM, 0, 0, NULL, 0,
 387                    hp_ev, SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
 388
 389 SND_SOC_DAPM_PGA("SPKPGA", WM9090_POWER_MANAGEMENT_3, 8, 0, NULL, 0),
 390 SND_SOC_DAPM_MIXER("SPKOUT", WM9090_POWER_MANAGEMENT_1, 12, 0,
 391                    spkout, ARRAY_SIZE(spkout)),
 392
 393 SND_SOC_DAPM_OUTPUT("HPR"),
 394 SND_SOC_DAPM_OUTPUT("HPL"),
 395 SND_SOC_DAPM_OUTPUT("Speaker"),
 396 };
 397
 398 static const struct snd_soc_dapm_route audio_map[] = {
 399         { "IN1A PGA", NULL, "IN1+" },
 400         { "IN2A PGA", NULL, "IN2+" },
 401
 402         { "SPKMIX", "IN1A Switch", "IN1A PGA" },
 403         { "SPKMIX", "IN2A Switch", "IN2A PGA" },
 404
 405         { "MIXOUTL", "IN1A Switch", "IN1A PGA" },
 406         { "MIXOUTL", "IN2A Switch", "IN2A PGA" },
 407
 408         { "MIXOUTR", "IN1A Switch", "IN1A PGA" },
 409         { "MIXOUTR", "IN2A Switch", "IN2A PGA" },
 410
 411         { "HP PGA", NULL, "OSC" },
 412         { "HP PGA", NULL, "MIXOUTL" },
 413         { "HP PGA", NULL, "MIXOUTR" },
 414
 415         { "HPL", NULL, "HP PGA" },
 416         { "HPR", NULL, "HP PGA" },
 417
 418         { "SPKPGA", NULL, "OSC" },
 419         { "SPKPGA", NULL, "SPKMIX" },
 420
 421         { "SPKOUT", "Mixer Switch", "SPKPGA" },
 422
 423         { "Speaker", NULL, "SPKOUT" },
 424 };
 425
 426 static const struct snd_soc_dapm_route audio_map_in1_se[] = {
 427         { "IN1B PGA", NULL, "IN1-" },
 428
 429         { "SPKMIX", "IN1B Switch", "IN1B PGA" },
 430         { "MIXOUTL", "IN1B Switch", "IN1B PGA" },
 431         { "MIXOUTR", "IN1B Switch", "IN1B PGA" },
 432 };
 433
 434 static const struct snd_soc_dapm_route audio_map_in1_diff[] = {
 435         { "IN1A PGA", NULL, "IN1-" },
 436 };
 437
 438 static const struct snd_soc_dapm_route audio_map_in2_se[] = {
 439         { "IN2B PGA", NULL, "IN2-" },
 440
 441         { "SPKMIX", "IN2B Switch", "IN2B PGA" },
 442         { "MIXOUTL", "IN2B Switch", "IN2B PGA" },
 443         { "MIXOUTR", "IN2B Switch", "IN2B PGA" },
 444 };
 445
 446 static const struct snd_soc_dapm_route audio_map_in2_diff[] = {
 447         { "IN2A PGA", NULL, "IN2-" },
 448 };
 449
 450 static int wm9090_add_controls(struct snd_soc_codec *codec)
 451 {
 452         struct wm9090_priv *wm9090 = snd_soc_codec_get_drvdata(codec);
 453         int i;
 454
 455         snd_soc_dapm_new_controls(codec, wm9090_dapm_widgets,
 456                                   ARRAY_SIZE(wm9090_dapm_widgets));
 457
 458         snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
 459
 460         snd_soc_add_controls(codec, wm9090_controls,
 461                              ARRAY_SIZE(wm9090_controls));
 462
 463         if (wm9090->pdata.lin1_diff) {
 464                 snd_soc_dapm_add_routes(codec, audio_map_in1_diff,
 465                                         ARRAY_SIZE(audio_map_in1_diff));
 466         } else {
 467                 snd_soc_dapm_add_routes(codec, audio_map_in1_se,
 468                                         ARRAY_SIZE(audio_map_in1_se));
 469                 snd_soc_add_controls(codec, wm9090_in1_se_controls,
 470                                      ARRAY_SIZE(wm9090_in1_se_controls));
 471         }
 472
 473         if (wm9090->pdata.lin2_diff) {
 474                 snd_soc_dapm_add_routes(codec, audio_map_in2_diff,
 475                                         ARRAY_SIZE(audio_map_in2_diff));
 476         } else {
 477                 snd_soc_dapm_add_routes(codec, audio_map_in2_se,
 478                                         ARRAY_SIZE(audio_map_in2_se));
 479                 snd_soc_add_controls(codec, wm9090_in2_se_controls,
 480                                      ARRAY_SIZE(wm9090_in2_se_controls));
 481         }
 482
 483         if (wm9090->pdata.agc_ena) {
 484                 for (i = 0; i < ARRAY_SIZE(wm9090->pdata.agc); i++)
 485                         snd_soc_write(codec, WM9090_AGC_CONTROL_0 + i,
 486                                       wm9090->pdata.agc[i]);
 487                 snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_3,
 488                                     WM9090_AGC_ENA, WM9090_AGC_ENA);
 489         } else {
 490                 snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_3,
 491                                     WM9090_AGC_ENA, 0);
 492         }
 493
 494         return 0;
 495
 496 }
 497
 498 /*
 499  * The machine driver should call this from their set_bias_level; if there
 500  * isn't one then this can just be set as the set_bias_level function.
 501  */
 502 static int wm9090_set_bias_level(struct snd_soc_codec *codec,
 503                                  enum snd_soc_bias_level level)
 504 {
 505         u16 *reg_cache = codec->reg_cache;
 506         int i, ret;
 507
 508         switch (level) {
 509         case SND_SOC_BIAS_ON:
 510                 break;
 511
 512         case SND_SOC_BIAS_PREPARE:
 513                 snd_soc_update_bits(codec, WM9090_ANTIPOP2, WM9090_VMID_ENA,
 514                                     WM9090_VMID_ENA);
 515                 snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
 516                                     WM9090_BIAS_ENA |
 517                                     WM9090_VMID_RES_MASK,
 518                                     WM9090_BIAS_ENA |
 519                                     1 << WM9090_VMID_RES_SHIFT);
 520                 msleep(1);  /* Probably an overestimate */
 521                 break;
 522
 523         case SND_SOC_BIAS_STANDBY:
 524                 if (codec->bias_level == SND_SOC_BIAS_OFF) {
 525                         /* Restore the register cache */
 526                         for (i = 1; i < codec->reg_cache_size; i++) {
 527                                 if (reg_cache[i] == wm9090_reg_defaults[i])
 528                                         continue;
 529                                 if (wm9090_volatile(i))
 530                                         continue;
 531
 532                                 ret = snd_soc_write(codec, i, reg_cache[i]);
 533                                 if (ret != 0)
 534                                         dev_warn(codec->dev,
 535                                                  "Failed to restore register %d: %d\n",
 536                                                  i, ret);
 537                         }
 538                 }
 539
 540                 /* We keep VMID off during standby since the combination of
 541                  * ground referenced outputs and class D speaker mean that
 542                  * latency is not an issue.
 543                  */
 544                 snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
 545                                     WM9090_BIAS_ENA | WM9090_VMID_RES_MASK, 0);
 546                 snd_soc_update_bits(codec, WM9090_ANTIPOP2,
 547                                     WM9090_VMID_ENA, 0);
 548                 break;
 549
 550         case SND_SOC_BIAS_OFF:
 551                 break;
 552         }
 553
 554         codec->bias_level = level;
 555
 556         return 0;
 557 }
 558
 559 static int wm9090_probe(struct platform_device *pdev)
 560 {
 561         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
 562         struct snd_soc_codec *codec;
 563         int ret = 0;
 564
 565         if (wm9090_codec == NULL) {
 566                 dev_err(&pdev->dev, "Codec device not registered\n");
 567                 return -ENODEV;
 568         }
 569
 570         socdev->card->codec = wm9090_codec;
 571         codec = wm9090_codec;
 572
 573         /* register pcms */
 574         ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
 575         if (ret < 0) {
 576                 dev_err(codec->dev, "failed to create pcms: %d\n", ret);
 577                 goto pcm_err;
 578         }
 579
 580         wm9090_add_controls(codec);
 581
 582         return 0;
 583
 584 pcm_err:
 585         return ret;
 586 }
 587
 588 #ifdef CONFIG_PM
 589 static int wm9090_suspend(struct platform_device *pdev, pm_message_t state)
 590 {
 591         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
 592         struct snd_soc_codec *codec = socdev->card->codec;
 593
 594         wm9090_set_bias_level(codec, SND_SOC_BIAS_OFF);
 595
 596         return 0;
 597 }
 598
 599 static int wm9090_resume(struct platform_device *pdev)
 600 {
 601         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
 602         struct snd_soc_codec *codec = socdev->card->codec;
 603
 604         wm9090_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
 605
 606         return 0;
 607 }
 608 #else
 609 #define wm9090_suspend NULL
 610 #define wm9090_resume NULL
 611 #endif
 612
 613 static int wm9090_remove(struct platform_device *pdev)
 614 {
 615         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
 616
 617         snd_soc_free_pcms(socdev);
 618         snd_soc_dapm_free(socdev);
 619
 620         return 0;
 621 }
 622
 623 struct snd_soc_codec_device soc_codec_dev_wm9090 = {
 624         .probe =        wm9090_probe,
 625         .remove =       wm9090_remove,
 626         .suspend =      wm9090_suspend,
 627         .resume =       wm9090_resume,
 628 };
 629 EXPORT_SYMBOL_GPL(soc_codec_dev_wm9090);
 630
 631 static int wm9090_i2c_probe(struct i2c_client *i2c,
 632                             const struct i2c_device_id *id)
 633 {
 634         struct wm9090_priv *wm9090;
 635         struct snd_soc_codec *codec;
 636         int ret;
 637
 638         wm9090 = kzalloc(sizeof(*wm9090), GFP_KERNEL);
 639         if (wm9090 == NULL) {
 640                 dev_err(&i2c->dev, "Can not allocate memory\n");
 641                 return -ENOMEM;
 642         }
 643         codec = &wm9090->codec;
 644
 645         if (i2c->dev.platform_data)
 646                 memcpy(&wm9090->pdata, i2c->dev.platform_data,
 647                        sizeof(wm9090->pdata));
 648
 649         wm9090_codec = codec;
 650
 651         i2c_set_clientdata(i2c, wm9090);
 652
 653         mutex_init(&codec->mutex);
 654         INIT_LIST_HEAD(&codec->dapm_widgets);
 655         INIT_LIST_HEAD(&codec->dapm_paths);
 656
 657         codec->control_data = i2c;
 658         snd_soc_codec_set_drvdata(codec, wm9090);
 659         codec->dev = &i2c->dev;
 660         codec->name = "WM9090";
 661         codec->owner = THIS_MODULE;
 662         codec->bias_level = SND_SOC_BIAS_OFF;
 663         codec->set_bias_level = wm9090_set_bias_level,
 664         codec->reg_cache_size = WM9090_MAX_REGISTER + 1;
 665         codec->reg_cache = &wm9090->reg_cache;
 666         codec->volatile_register = wm9090_volatile;
 667
 668         ret = snd_soc_codec_set_cache_io(codec, 8, 16, SND_SOC_I2C);
 669         if (ret != 0) {
 670                 dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
 671                 goto err;
 672         }
 673
 674         memcpy(&wm9090->reg_cache, wm9090_reg_defaults,
 675                sizeof(wm9090->reg_cache));
 676
 677         ret = snd_soc_read(codec, WM9090_SOFTWARE_RESET);
 678         if (ret < 0)
 679                 goto err;
 680         if (ret != wm9090_reg_defaults[WM9090_SOFTWARE_RESET]) {
 681                 dev_err(&i2c->dev, "Device is not a WM9090, ID=%x\n", ret);
 682                 ret = -EINVAL;
 683                 goto err;
 684         }
 685
 686         ret = snd_soc_write(codec, WM9090_SOFTWARE_RESET, 0);
 687         if (ret < 0)
 688                 goto err;
 689
 690         /* Configure some defaults; they will be written out when we
 691          * bring the bias up.
 692          */
 693         wm9090->reg_cache[WM9090_IN1_LINE_INPUT_A_VOLUME] |= WM9090_IN1_VU
 694                 | WM9090_IN1A_ZC;
 695         wm9090->reg_cache[WM9090_IN1_LINE_INPUT_B_VOLUME] |= WM9090_IN1_VU
 696                 | WM9090_IN1B_ZC;
 697         wm9090->reg_cache[WM9090_IN2_LINE_INPUT_A_VOLUME] |= WM9090_IN2_VU
 698                 | WM9090_IN2A_ZC;
 699         wm9090->reg_cache[WM9090_IN2_LINE_INPUT_B_VOLUME] |= WM9090_IN2_VU
 700                 | WM9090_IN2B_ZC;
 701         wm9090->reg_cache[WM9090_SPEAKER_VOLUME_LEFT] |=
 702                 WM9090_SPKOUT_VU | WM9090_SPKOUTL_ZC;
 703         wm9090->reg_cache[WM9090_LEFT_OUTPUT_VOLUME] |=
 704                 WM9090_HPOUT1_VU | WM9090_HPOUT1L_ZC;
 705         wm9090->reg_cache[WM9090_RIGHT_OUTPUT_VOLUME] |=
 706                 WM9090_HPOUT1_VU | WM9090_HPOUT1R_ZC;
 707
 708         wm9090->reg_cache[WM9090_CLOCKING_1] |= WM9090_TOCLK_ENA;
 709
 710         wm9090_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
 711
 712         ret = snd_soc_register_codec(codec);
 713         if (ret != 0) {
 714                 dev_err(&i2c->dev, "Failed to register CODEC: %d\n", ret);
 715                 goto err_bias;
 716         }
 717
 718         return 0;
 719
 720 err_bias:
 721         wm9090_set_bias_level(codec, SND_SOC_BIAS_OFF);
 722 err:
 723         kfree(wm9090);
 724         i2c_set_clientdata(i2c, NULL);
 725         wm9090_codec = NULL;
 726
 727         return ret;
 728 }
 729
 730 static int wm9090_i2c_remove(struct i2c_client *i2c)
 731 {
 732         struct wm9090_priv *wm9090 = i2c_get_clientdata(i2c);
 733         struct snd_soc_codec *codec = &wm9090->codec;
 734
 735         snd_soc_unregister_codec(codec);
 736         wm9090_set_bias_level(codec, SND_SOC_BIAS_OFF);
 737         kfree(wm9090);
 738         wm9090_codec = NULL;
 739
 740         return 0;
 741 }
 742
 743 static const struct i2c_device_id wm9090_id[] = {
 744         { "wm9090", 0 },
 745         { }
 746 };
 747 MODULE_DEVICE_TABLE(i2c, wm9090_id);
 748
 749 static struct i2c_driver wm9090_i2c_driver = {
 750         .driver = {
 751                 .name = "wm9090",
 752                 .owner = THIS_MODULE,
 753         },
 754         .probe = wm9090_i2c_probe,
 755         .remove = __devexit_p(wm9090_i2c_remove),
 756         .id_table = wm9090_id,
 757 };
 758
 759 static int __init wm9090_init(void)
 760 {
 761         return i2c_add_driver(&wm9090_i2c_driver);
 762 }
 763 module_init(wm9090_init);
 764
 765 static void __exit wm9090_exit(void)
 766 {
 767         i2c_del_driver(&wm9090_i2c_driver);
 768 }
 769 module_exit(wm9090_exit);
 770
 771 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
 772 MODULE_DESCRIPTION("WM9090 ASoC driver");
 773 MODULE_LICENSE("GPL");