sound/soc/codecs/tlv320aic3x.c

   1 /*
   2  * ALSA SoC TLV320AIC3X codec driver
   3  *
   4  * Author:      Vladimir Barinov, <vbarinov@ru.mvista.com>
   5  * Copyright:   (C) 2007 MontaVista Software, Inc., <source@mvista.com>
   6  *
   7  * Based on sound/soc/codecs/wm8753.c by Liam Girdwood
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License version 2 as
  11  * published by the Free Software Foundation.
  12  *
  13  * Notes:
  14  *  The AIC3X is a driver for a low power stereo audio
  15  *  codecs aic31, aic32, aic33.
  16  *
  17  *  It supports full aic33 codec functionality.
  18  *  The compatibility with aic32, aic31 is as follows:
  19  *        aic32        |        aic31
  20  *  ---------------------------------------
  21  *   MONO_LOUT -> N/A  |  MONO_LOUT -> N/A
  22  *                     |  IN1L -> LINE1L
  23  *                     |  IN1R -> LINE1R
  24  *                     |  IN2L -> LINE2L
  25  *                     |  IN2R -> LINE2R
  26  *                     |  MIC3L/R -> N/A
  27  *   truncated internal functionality in
  28  *   accordance with documentation
  29  *  ---------------------------------------
  30  *
  31  *  Hence the machine layer should disable unsupported inputs/outputs by
  32  *  snd_soc_dapm_set_endpoint(codec, "MONO_LOUT", 0), etc.
  33  */
  34
  35 #include <linux/module.h>
  36 #include <linux/moduleparam.h>
  37 #include <linux/init.h>
  38 #include <linux/delay.h>
  39 #include <linux/pm.h>
  40 #include <linux/i2c.h>
  41 #include <linux/platform_device.h>
  42 #include <sound/core.h>
  43 #include <sound/pcm.h>
  44 #include <sound/pcm_params.h>
  45 #include <sound/soc.h>
  46 #include <sound/soc-dapm.h>
  47 #include <sound/initval.h>
  48
  49 #include "tlv320aic3x.h"
  50
  51 #define AUDIO_NAME "aic3x"
  52 #define AIC3X_VERSION "0.2"
  53
  54 /* codec private data */
  55 struct aic3x_priv {
  56         unsigned int sysclk;
  57         int master;
  58 };
  59
  60 /*
  61  * AIC3X register cache
  62  * We can't read the AIC3X register space when we are
  63  * using 2 wire for device control, so we cache them instead.
  64  * There is no point in caching the reset register
  65  */
  66 static const u8 aic3x_reg[AIC3X_CACHEREGNUM] = {
  67         0x00, 0x00, 0x00, 0x10, /* 0 */
  68         0x04, 0x00, 0x00, 0x00, /* 4 */
  69         0x00, 0x00, 0x00, 0x01, /* 8 */
  70         0x00, 0x00, 0x00, 0x80, /* 12 */
  71         0x80, 0xff, 0xff, 0x78, /* 16 */
  72         0x78, 0x78, 0x78, 0x78, /* 20 */
  73         0x78, 0x00, 0x00, 0xfe, /* 24 */
  74         0x00, 0x00, 0xfe, 0x00, /* 28 */
  75         0x18, 0x18, 0x00, 0x00, /* 32 */
  76         0x00, 0x00, 0x00, 0x00, /* 36 */
  77         0x00, 0x00, 0x00, 0x80, /* 40 */
  78         0x80, 0x00, 0x00, 0x00, /* 44 */
  79         0x00, 0x00, 0x00, 0x04, /* 48 */
  80         0x00, 0x00, 0x00, 0x00, /* 52 */
  81         0x00, 0x00, 0x04, 0x00, /* 56 */
  82         0x00, 0x00, 0x00, 0x00, /* 60 */
  83         0x00, 0x04, 0x00, 0x00, /* 64 */
  84         0x00, 0x00, 0x00, 0x00, /* 68 */
  85         0x04, 0x00, 0x00, 0x00, /* 72 */
  86         0x00, 0x00, 0x00, 0x00, /* 76 */
  87         0x00, 0x00, 0x00, 0x00, /* 80 */
  88         0x00, 0x00, 0x00, 0x00, /* 84 */
  89         0x00, 0x00, 0x00, 0x00, /* 88 */
  90         0x00, 0x00, 0x00, 0x00, /* 92 */
  91         0x00, 0x00, 0x00, 0x00, /* 96 */
  92         0x00, 0x00, 0x02,       /* 100 */
  93 };
  94
  95 /*
  96  * read aic3x register cache
  97  */
  98 static inline unsigned int aic3x_read_reg_cache(struct snd_soc_codec *codec,
  99                                                 unsigned int reg)
 100 {
 101         u8 *cache = codec->reg_cache;
 102         if (reg >= AIC3X_CACHEREGNUM)
 103                 return -1;
 104         return cache[reg];
 105 }
 106
 107 /*
 108  * write aic3x register cache
 109  */
 110 static inline void aic3x_write_reg_cache(struct snd_soc_codec *codec,
 111                                          u8 reg, u8 value)
 112 {
 113         u8 *cache = codec->reg_cache;
 114         if (reg >= AIC3X_CACHEREGNUM)
 115                 return;
 116         cache[reg] = value;
 117 }
 118
 119 /*
 120  * write to the aic3x register space
 121  */
 122 static int aic3x_write(struct snd_soc_codec *codec, unsigned int reg,
 123                        unsigned int value)
 124 {
 125         u8 data[2];
 126
 127         /* data is
 128          *   D15..D8 aic3x register offset
 129          *   D7...D0 register data
 130          */
 131         data[0] = reg & 0xff;
 132         data[1] = value & 0xff;
 133
 134         aic3x_write_reg_cache(codec, data[0], data[1]);
 135         if (codec->hw_write(codec->control_data, data, 2) == 2)
 136                 return 0;
 137         else
 138                 return -EIO;
 139 }
 140
 141 /*
 142  * read from the aic3x register space
 143  */
 144 static int aic3x_read(struct snd_soc_codec *codec, unsigned int reg,
 145                       u8 *value)
 146 {
 147         *value = reg & 0xff;
 148         if (codec->hw_read(codec->control_data, value, 1) != 1)
 149                 return -EIO;
 150
 151         aic3x_write_reg_cache(codec, reg, *value);
 152         return 0;
 153 }
 154
 155 #define SOC_DAPM_SINGLE_AIC3X(xname, reg, shift, mask, invert) \
 156 {       .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
 157         .info = snd_soc_info_volsw, \
 158         .get = snd_soc_dapm_get_volsw, .put = snd_soc_dapm_put_volsw_aic3x, \
 159         .private_value =  SOC_SINGLE_VALUE(reg, shift, mask, invert) }
 160
 161 /*
 162  * All input lines are connected when !0xf and disconnected with 0xf bit field,
 163  * so we have to use specific dapm_put call for input mixer
 164  */
 165 static int snd_soc_dapm_put_volsw_aic3x(struct snd_kcontrol *kcontrol,
 166                                         struct snd_ctl_elem_value *ucontrol)
 167 {
 168         struct snd_soc_dapm_widget *widget = snd_kcontrol_chip(kcontrol);
 169         int reg = kcontrol->private_value & 0xff;
 170         int shift = (kcontrol->private_value >> 8) & 0x0f;
 171         int mask = (kcontrol->private_value >> 16) & 0xff;
 172         int invert = (kcontrol->private_value >> 24) & 0x01;
 173         unsigned short val, val_mask;
 174         int ret;
 175         struct snd_soc_dapm_path *path;
 176         int found = 0;
 177
 178         val = (ucontrol->value.integer.value[0] & mask);
 179
 180         mask = 0xf;
 181         if (val)
 182                 val = mask;
 183
 184         if (invert)
 185                 val = mask - val;
 186         val_mask = mask << shift;
 187         val = val << shift;
 188
 189         mutex_lock(&widget->codec->mutex);
 190
 191         if (snd_soc_test_bits(widget->codec, reg, val_mask, val)) {
 192                 /* find dapm widget path assoc with kcontrol */
 193                 list_for_each_entry(path, &widget->codec->dapm_paths, list) {
 194                         if (path->kcontrol != kcontrol)
 195                                 continue;
 196
 197                         /* found, now check type */
 198                         found = 1;
 199                         if (val)
 200                                 /* new connection */
 201                                 path->connect = invert ? 0 : 1;
 202                         else
 203                                 /* old connection must be powered down */
 204                                 path->connect = invert ? 1 : 0;
 205                         break;
 206                 }
 207
 208                 if (found)
 209                         snd_soc_dapm_sync_endpoints(widget->codec);
 210         }
 211
 212         ret = snd_soc_update_bits(widget->codec, reg, val_mask, val);
 213
 214         mutex_unlock(&widget->codec->mutex);
 215         return ret;
 216 }
 217
 218 static const char *aic3x_left_dac_mux[] = { "DAC_L1", "DAC_L3", "DAC_L2" };
 219 static const char *aic3x_right_dac_mux[] = { "DAC_R1", "DAC_R3", "DAC_R2" };
 220 static const char *aic3x_left_hpcom_mux[] =
 221     { "differential of HPLOUT", "constant VCM", "single-ended" };
 222 static const char *aic3x_right_hpcom_mux[] =
 223     { "differential of HPROUT", "constant VCM", "single-ended",
 224       "differential of HPLCOM", "external feedback" };
 225 static const char *aic3x_linein_mode_mux[] = { "single-ended", "differential" };
 226
 227 #define LDAC_ENUM       0
 228 #define RDAC_ENUM       1
 229 #define LHPCOM_ENUM     2
 230 #define RHPCOM_ENUM     3
 231 #define LINE1L_ENUM     4
 232 #define LINE1R_ENUM     5
 233 #define LINE2L_ENUM     6
 234 #define LINE2R_ENUM     7
 235
 236 static const struct soc_enum aic3x_enum[] = {
 237         SOC_ENUM_SINGLE(DAC_LINE_MUX, 6, 3, aic3x_left_dac_mux),
 238         SOC_ENUM_SINGLE(DAC_LINE_MUX, 4, 3, aic3x_right_dac_mux),
 239         SOC_ENUM_SINGLE(HPLCOM_CFG, 4, 3, aic3x_left_hpcom_mux),
 240         SOC_ENUM_SINGLE(HPRCOM_CFG, 3, 5, aic3x_right_hpcom_mux),
 241         SOC_ENUM_SINGLE(LINE1L_2_LADC_CTRL, 7, 2, aic3x_linein_mode_mux),
 242         SOC_ENUM_SINGLE(LINE1R_2_RADC_CTRL, 7, 2, aic3x_linein_mode_mux),
 243         SOC_ENUM_SINGLE(LINE2L_2_LADC_CTRL, 7, 2, aic3x_linein_mode_mux),
 244         SOC_ENUM_SINGLE(LINE2R_2_RADC_CTRL, 7, 2, aic3x_linein_mode_mux),
 245 };
 246
 247 static const struct snd_kcontrol_new aic3x_snd_controls[] = {
 248         /* Output */
 249         SOC_DOUBLE_R("PCM Playback Volume", LDAC_VOL, RDAC_VOL, 0, 0x7f, 1),
 250
 251         SOC_DOUBLE_R("Line DAC Playback Volume", DACL1_2_LLOPM_VOL,
 252                      DACR1_2_RLOPM_VOL, 0, 0x7f, 1),
 253         SOC_DOUBLE_R("Line DAC Playback Switch", LLOPM_CTRL, RLOPM_CTRL, 3,
 254                      0x01, 0),
 255         SOC_DOUBLE_R("Line PGA Bypass Playback Volume", PGAL_2_LLOPM_VOL,
 256                      PGAR_2_RLOPM_VOL, 0, 0x7f, 1),
 257         SOC_DOUBLE_R("Line Line2 Bypass Playback Volume", LINE2L_2_LLOPM_VOL,
 258                      LINE2R_2_RLOPM_VOL, 0, 0x7f, 1),
 259
 260         SOC_DOUBLE_R("Mono DAC Playback Volume", DACL1_2_MONOLOPM_VOL,
 261                      DACR1_2_MONOLOPM_VOL, 0, 0x7f, 1),
 262         SOC_SINGLE("Mono DAC Playback Switch", MONOLOPM_CTRL, 3, 0x01, 0),
 263         SOC_DOUBLE_R("Mono PGA Bypass Playback Volume", PGAL_2_MONOLOPM_VOL,
 264                      PGAR_2_MONOLOPM_VOL, 0, 0x7f, 1),
 265         SOC_DOUBLE_R("Mono Line2 Bypass Playback Volume", LINE2L_2_MONOLOPM_VOL,
 266                      LINE2R_2_MONOLOPM_VOL, 0, 0x7f, 1),
 267
 268         SOC_DOUBLE_R("HP DAC Playback Volume", DACL1_2_HPLOUT_VOL,
 269                      DACR1_2_HPROUT_VOL, 0, 0x7f, 1),
 270         SOC_DOUBLE_R("HP DAC Playback Switch", HPLOUT_CTRL, HPROUT_CTRL, 3,
 271                      0x01, 0),
 272         SOC_DOUBLE_R("HP PGA Bypass Playback Volume", PGAL_2_HPLOUT_VOL,
 273                      PGAR_2_HPROUT_VOL, 0, 0x7f, 1),
 274         SOC_DOUBLE_R("HP Line2 Bypass Playback Volume", LINE2L_2_HPLOUT_VOL,
 275                      LINE2R_2_HPROUT_VOL, 0, 0x7f, 1),
 276
 277         SOC_DOUBLE_R("HPCOM DAC Playback Volume", DACL1_2_HPLCOM_VOL,
 278                      DACR1_2_HPRCOM_VOL, 0, 0x7f, 1),
 279         SOC_DOUBLE_R("HPCOM DAC Playback Switch", HPLCOM_CTRL, HPRCOM_CTRL, 3,
 280                      0x01, 0),
 281         SOC_DOUBLE_R("HPCOM PGA Bypass Playback Volume", PGAL_2_HPLCOM_VOL,
 282                      PGAR_2_HPRCOM_VOL, 0, 0x7f, 1),
 283         SOC_DOUBLE_R("HPCOM Line2 Bypass Playback Volume", LINE2L_2_HPLCOM_VOL,
 284                      LINE2R_2_HPRCOM_VOL, 0, 0x7f, 1),
 285
 286         /*
 287          * Note: enable Automatic input Gain Controller with care. It can
 288          * adjust PGA to max value when ADC is on and will never go back.
 289         */
 290         SOC_DOUBLE_R("AGC Switch", LAGC_CTRL_A, RAGC_CTRL_A, 7, 0x01, 0),
 291
 292         /* Input */
 293         SOC_DOUBLE_R("PGA Capture Volume", LADC_VOL, RADC_VOL, 0, 0x7f, 0),
 294         SOC_DOUBLE_R("PGA Capture Switch", LADC_VOL, RADC_VOL, 7, 0x01, 1),
 295 };
 296
 297 /* add non dapm controls */
 298 static int aic3x_add_controls(struct snd_soc_codec *codec)
 299 {
 300         int err, i;
 301
 302         for (i = 0; i < ARRAY_SIZE(aic3x_snd_controls); i++) {
 303                 err = snd_ctl_add(codec->card,
 304                                   snd_soc_cnew(&aic3x_snd_controls[i],
 305                                                codec, NULL));
 306                 if (err < 0)
 307                         return err;
 308         }
 309
 310         return 0;
 311 }
 312
 313 /* Left DAC Mux */
 314 static const struct snd_kcontrol_new aic3x_left_dac_mux_controls =
 315 SOC_DAPM_ENUM("Route", aic3x_enum[LDAC_ENUM]);
 316
 317 /* Right DAC Mux */
 318 static const struct snd_kcontrol_new aic3x_right_dac_mux_controls =
 319 SOC_DAPM_ENUM("Route", aic3x_enum[RDAC_ENUM]);
 320
 321 /* Left HPCOM Mux */
 322 static const struct snd_kcontrol_new aic3x_left_hpcom_mux_controls =
 323 SOC_DAPM_ENUM("Route", aic3x_enum[LHPCOM_ENUM]);
 324
 325 /* Right HPCOM Mux */
 326 static const struct snd_kcontrol_new aic3x_right_hpcom_mux_controls =
 327 SOC_DAPM_ENUM("Route", aic3x_enum[RHPCOM_ENUM]);
 328
 329 /* Left DAC_L1 Mixer */
 330 static const struct snd_kcontrol_new aic3x_left_dac_mixer_controls[] = {
 331         SOC_DAPM_SINGLE("Line Switch", DACL1_2_LLOPM_VOL, 7, 1, 0),
 332         SOC_DAPM_SINGLE("Mono Switch", DACL1_2_MONOLOPM_VOL, 7, 1, 0),
 333         SOC_DAPM_SINGLE("HP Switch", DACL1_2_HPLOUT_VOL, 7, 1, 0),
 334         SOC_DAPM_SINGLE("HPCOM Switch", DACL1_2_HPLCOM_VOL, 7, 1, 0),
 335 };
 336
 337 /* Right DAC_R1 Mixer */
 338 static const struct snd_kcontrol_new aic3x_right_dac_mixer_controls[] = {
 339         SOC_DAPM_SINGLE("Line Switch", DACR1_2_RLOPM_VOL, 7, 1, 0),
 340         SOC_DAPM_SINGLE("Mono Switch", DACR1_2_MONOLOPM_VOL, 7, 1, 0),
 341         SOC_DAPM_SINGLE("HP Switch", DACR1_2_HPROUT_VOL, 7, 1, 0),
 342         SOC_DAPM_SINGLE("HPCOM Switch", DACR1_2_HPRCOM_VOL, 7, 1, 0),
 343 };
 344
 345 /* Left PGA Mixer */
 346 static const struct snd_kcontrol_new aic3x_left_pga_mixer_controls[] = {
 347         SOC_DAPM_SINGLE_AIC3X("Line1L Switch", LINE1L_2_LADC_CTRL, 3, 1, 1),
 348         SOC_DAPM_SINGLE_AIC3X("Line2L Switch", LINE2L_2_LADC_CTRL, 3, 1, 1),
 349         SOC_DAPM_SINGLE_AIC3X("Mic3L Switch", MIC3LR_2_LADC_CTRL, 4, 1, 1),
 350 };
 351
 352 /* Right PGA Mixer */
 353 static const struct snd_kcontrol_new aic3x_right_pga_mixer_controls[] = {
 354         SOC_DAPM_SINGLE_AIC3X("Line1R Switch", LINE1R_2_RADC_CTRL, 3, 1, 1),
 355         SOC_DAPM_SINGLE_AIC3X("Line2R Switch", LINE2R_2_RADC_CTRL, 3, 1, 1),
 356         SOC_DAPM_SINGLE_AIC3X("Mic3R Switch", MIC3LR_2_RADC_CTRL, 0, 1, 1),
 357 };
 358
 359 /* Left Line1 Mux */
 360 static const struct snd_kcontrol_new aic3x_left_line1_mux_controls =
 361 SOC_DAPM_ENUM("Route", aic3x_enum[LINE1L_ENUM]);
 362
 363 /* Right Line1 Mux */
 364 static const struct snd_kcontrol_new aic3x_right_line1_mux_controls =
 365 SOC_DAPM_ENUM("Route", aic3x_enum[LINE1R_ENUM]);
 366
 367 /* Left Line2 Mux */
 368 static const struct snd_kcontrol_new aic3x_left_line2_mux_controls =
 369 SOC_DAPM_ENUM("Route", aic3x_enum[LINE2L_ENUM]);
 370
 371 /* Right Line2 Mux */
 372 static const struct snd_kcontrol_new aic3x_right_line2_mux_controls =
 373 SOC_DAPM_ENUM("Route", aic3x_enum[LINE2R_ENUM]);
 374
 375 /* Left PGA Bypass Mixer */
 376 static const struct snd_kcontrol_new aic3x_left_pga_bp_mixer_controls[] = {
 377         SOC_DAPM_SINGLE("Line Switch", PGAL_2_LLOPM_VOL, 7, 1, 0),
 378         SOC_DAPM_SINGLE("Mono Switch", PGAL_2_MONOLOPM_VOL, 7, 1, 0),
 379         SOC_DAPM_SINGLE("HP Switch", PGAL_2_HPLOUT_VOL, 7, 1, 0),
 380         SOC_DAPM_SINGLE("HPCOM Switch", PGAL_2_HPLCOM_VOL, 7, 1, 0),
 381 };
 382
 383 /* Right PGA Bypass Mixer */
 384 static const struct snd_kcontrol_new aic3x_right_pga_bp_mixer_controls[] = {
 385         SOC_DAPM_SINGLE("Line Switch", PGAR_2_RLOPM_VOL, 7, 1, 0),
 386         SOC_DAPM_SINGLE("Mono Switch", PGAR_2_MONOLOPM_VOL, 7, 1, 0),
 387         SOC_DAPM_SINGLE("HP Switch", PGAR_2_HPROUT_VOL, 7, 1, 0),
 388         SOC_DAPM_SINGLE("HPCOM Switch", PGAR_2_HPRCOM_VOL, 7, 1, 0),
 389 };
 390
 391 /* Left Line2 Bypass Mixer */
 392 static const struct snd_kcontrol_new aic3x_left_line2_bp_mixer_controls[] = {
 393         SOC_DAPM_SINGLE("Line Switch", LINE2L_2_LLOPM_VOL, 7, 1, 0),
 394         SOC_DAPM_SINGLE("Mono Switch", LINE2L_2_MONOLOPM_VOL, 7, 1, 0),
 395         SOC_DAPM_SINGLE("HP Switch", LINE2L_2_HPLOUT_VOL, 7, 1, 0),
 396         SOC_DAPM_SINGLE("HPCOM Switch", LINE2L_2_HPLCOM_VOL, 7, 1, 0),
 397 };
 398
 399 /* Right Line2 Bypass Mixer */
 400 static const struct snd_kcontrol_new aic3x_right_line2_bp_mixer_controls[] = {
 401         SOC_DAPM_SINGLE("Line Switch", LINE2R_2_RLOPM_VOL, 7, 1, 0),
 402         SOC_DAPM_SINGLE("Mono Switch", LINE2R_2_MONOLOPM_VOL, 7, 1, 0),
 403         SOC_DAPM_SINGLE("HP Switch", LINE2R_2_HPROUT_VOL, 7, 1, 0),
 404         SOC_DAPM_SINGLE("HPCOM Switch", LINE2R_2_HPRCOM_VOL, 7, 1, 0),
 405 };
 406
 407 static const struct snd_soc_dapm_widget aic3x_dapm_widgets[] = {
 408         /* Left DAC to Left Outputs */
 409         SND_SOC_DAPM_DAC("Left DAC", "Left Playback", DAC_PWR, 7, 0),
 410         SND_SOC_DAPM_MUX("Left DAC Mux", SND_SOC_NOPM, 0, 0,
 411                          &aic3x_left_dac_mux_controls),
 412         SND_SOC_DAPM_MIXER("Left DAC_L1 Mixer", SND_SOC_NOPM, 0, 0,
 413                            &aic3x_left_dac_mixer_controls[0],
 414                            ARRAY_SIZE(aic3x_left_dac_mixer_controls)),
 415         SND_SOC_DAPM_MUX("Left HPCOM Mux", SND_SOC_NOPM, 0, 0,
 416                          &aic3x_left_hpcom_mux_controls),
 417         SND_SOC_DAPM_PGA("Left Line Out", LLOPM_CTRL, 0, 0, NULL, 0),
 418         SND_SOC_DAPM_PGA("Left HP Out", HPLOUT_CTRL, 0, 0, NULL, 0),
 419         SND_SOC_DAPM_PGA("Left HP Com", HPLCOM_CTRL, 0, 0, NULL, 0),
 420
 421         /* Right DAC to Right Outputs */
 422         SND_SOC_DAPM_DAC("Right DAC", "Right Playback", DAC_PWR, 6, 0),
 423         SND_SOC_DAPM_MUX("Right DAC Mux", SND_SOC_NOPM, 0, 0,
 424                          &aic3x_right_dac_mux_controls),
 425         SND_SOC_DAPM_MIXER("Right DAC_R1 Mixer", SND_SOC_NOPM, 0, 0,
 426                            &aic3x_right_dac_mixer_controls[0],
 427                            ARRAY_SIZE(aic3x_right_dac_mixer_controls)),
 428         SND_SOC_DAPM_MUX("Right HPCOM Mux", SND_SOC_NOPM, 0, 0,
 429                          &aic3x_right_hpcom_mux_controls),
 430         SND_SOC_DAPM_PGA("Right Line Out", RLOPM_CTRL, 0, 0, NULL, 0),
 431         SND_SOC_DAPM_PGA("Right HP Out", HPROUT_CTRL, 0, 0, NULL, 0),
 432         SND_SOC_DAPM_PGA("Right HP Com", HPRCOM_CTRL, 0, 0, NULL, 0),
 433
 434         /* Mono Output */
 435         SND_SOC_DAPM_PGA("Mono Out", MONOLOPM_CTRL, 0, 0, NULL, 0),
 436
 437         /* Left Inputs to Left ADC */
 438         SND_SOC_DAPM_ADC("Left ADC", "Left Capture", LINE1L_2_LADC_CTRL, 2, 0),
 439         SND_SOC_DAPM_MIXER("Left PGA Mixer", SND_SOC_NOPM, 0, 0,
 440                            &aic3x_left_pga_mixer_controls[0],
 441                            ARRAY_SIZE(aic3x_left_pga_mixer_controls)),
 442         SND_SOC_DAPM_MUX("Left Line1L Mux", SND_SOC_NOPM, 0, 0,
 443                          &aic3x_left_line1_mux_controls),
 444         SND_SOC_DAPM_MUX("Left Line2L Mux", SND_SOC_NOPM, 0, 0,
 445                          &aic3x_left_line2_mux_controls),
 446
 447         /* Right Inputs to Right ADC */
 448         SND_SOC_DAPM_ADC("Right ADC", "Right Capture",
 449                          LINE1R_2_RADC_CTRL, 2, 0),
 450         SND_SOC_DAPM_MIXER("Right PGA Mixer", SND_SOC_NOPM, 0, 0,
 451                            &aic3x_right_pga_mixer_controls[0],
 452                            ARRAY_SIZE(aic3x_right_pga_mixer_controls)),
 453         SND_SOC_DAPM_MUX("Right Line1R Mux", SND_SOC_NOPM, 0, 0,
 454                          &aic3x_right_line1_mux_controls),
 455         SND_SOC_DAPM_MUX("Right Line2R Mux", SND_SOC_NOPM, 0, 0,
 456                          &aic3x_right_line2_mux_controls),
 457
 458         /* Mic Bias */
 459         SND_SOC_DAPM_REG(snd_soc_dapm_micbias, "Mic Bias 2V",
 460                          MICBIAS_CTRL, 6, 3, 1, 0),
 461         SND_SOC_DAPM_REG(snd_soc_dapm_micbias, "Mic Bias 2.5V",
 462                          MICBIAS_CTRL, 6, 3, 2, 0),
 463         SND_SOC_DAPM_REG(snd_soc_dapm_micbias, "Mic Bias AVDD",
 464                          MICBIAS_CTRL, 6, 3, 3, 0),
 465
 466         /* Left PGA to Left Output bypass */
 467         SND_SOC_DAPM_MIXER("Left PGA Bypass Mixer", SND_SOC_NOPM, 0, 0,
 468                            &aic3x_left_pga_bp_mixer_controls[0],
 469                            ARRAY_SIZE(aic3x_left_pga_bp_mixer_controls)),
 470
 471         /* Right PGA to Right Output bypass */
 472         SND_SOC_DAPM_MIXER("Right PGA Bypass Mixer", SND_SOC_NOPM, 0, 0,
 473                            &aic3x_right_pga_bp_mixer_controls[0],
 474                            ARRAY_SIZE(aic3x_right_pga_bp_mixer_controls)),
 475
 476         /* Left Line2 to Left Output bypass */
 477         SND_SOC_DAPM_MIXER("Left Line2 Bypass Mixer", SND_SOC_NOPM, 0, 0,
 478                            &aic3x_left_line2_bp_mixer_controls[0],
 479                            ARRAY_SIZE(aic3x_left_line2_bp_mixer_controls)),
 480
 481         /* Right Line2 to Right Output bypass */
 482         SND_SOC_DAPM_MIXER("Right Line2 Bypass Mixer", SND_SOC_NOPM, 0, 0,
 483                            &aic3x_right_line2_bp_mixer_controls[0],
 484                            ARRAY_SIZE(aic3x_right_line2_bp_mixer_controls)),
 485
 486         SND_SOC_DAPM_OUTPUT("LLOUT"),
 487         SND_SOC_DAPM_OUTPUT("RLOUT"),
 488         SND_SOC_DAPM_OUTPUT("MONO_LOUT"),
 489         SND_SOC_DAPM_OUTPUT("HPLOUT"),
 490         SND_SOC_DAPM_OUTPUT("HPROUT"),
 491         SND_SOC_DAPM_OUTPUT("HPLCOM"),
 492         SND_SOC_DAPM_OUTPUT("HPRCOM"),
 493
 494         SND_SOC_DAPM_INPUT("MIC3L"),
 495         SND_SOC_DAPM_INPUT("MIC3R"),
 496         SND_SOC_DAPM_INPUT("LINE1L"),
 497         SND_SOC_DAPM_INPUT("LINE1R"),
 498         SND_SOC_DAPM_INPUT("LINE2L"),
 499         SND_SOC_DAPM_INPUT("LINE2R"),
 500 };
 501
 502 static const struct snd_soc_dapm_route intercon[] = {
 503         /* Left Output */
 504         {"Left DAC Mux", "DAC_L1", "Left DAC"},
 505         {"Left DAC Mux", "DAC_L2", "Left DAC"},
 506         {"Left DAC Mux", "DAC_L3", "Left DAC"},
 507
 508         {"Left DAC_L1 Mixer", "Line Switch", "Left DAC Mux"},
 509         {"Left DAC_L1 Mixer", "Mono Switch", "Left DAC Mux"},
 510         {"Left DAC_L1 Mixer", "HP Switch", "Left DAC Mux"},
 511         {"Left DAC_L1 Mixer", "HPCOM Switch", "Left DAC Mux"},
 512         {"Left Line Out", NULL, "Left DAC Mux"},
 513         {"Left HP Out", NULL, "Left DAC Mux"},
 514
 515         {"Left HPCOM Mux", "differential of HPLOUT", "Left DAC_L1 Mixer"},
 516         {"Left HPCOM Mux", "constant VCM", "Left DAC_L1 Mixer"},
 517         {"Left HPCOM Mux", "single-ended", "Left DAC_L1 Mixer"},
 518
 519         {"Left Line Out", NULL, "Left DAC_L1 Mixer"},
 520         {"Mono Out", NULL, "Left DAC_L1 Mixer"},
 521         {"Left HP Out", NULL, "Left DAC_L1 Mixer"},
 522         {"Left HP Com", NULL, "Left HPCOM Mux"},
 523
 524         {"LLOUT", NULL, "Left Line Out"},
 525         {"LLOUT", NULL, "Left Line Out"},
 526         {"HPLOUT", NULL, "Left HP Out"},
 527         {"HPLCOM", NULL, "Left HP Com"},
 528
 529         /* Right Output */
 530         {"Right DAC Mux", "DAC_R1", "Right DAC"},
 531         {"Right DAC Mux", "DAC_R2", "Right DAC"},
 532         {"Right DAC Mux", "DAC_R3", "Right DAC"},
 533
 534         {"Right DAC_R1 Mixer", "Line Switch", "Right DAC Mux"},
 535         {"Right DAC_R1 Mixer", "Mono Switch", "Right DAC Mux"},
 536         {"Right DAC_R1 Mixer", "HP Switch", "Right DAC Mux"},
 537         {"Right DAC_R1 Mixer", "HPCOM Switch", "Right DAC Mux"},
 538         {"Right Line Out", NULL, "Right DAC Mux"},
 539         {"Right HP Out", NULL, "Right DAC Mux"},
 540
 541         {"Right HPCOM Mux", "differential of HPROUT", "Right DAC_R1 Mixer"},
 542         {"Right HPCOM Mux", "constant VCM", "Right DAC_R1 Mixer"},
 543         {"Right HPCOM Mux", "single-ended", "Right DAC_R1 Mixer"},
 544         {"Right HPCOM Mux", "differential of HPLCOM", "Right DAC_R1 Mixer"},
 545         {"Right HPCOM Mux", "external feedback", "Right DAC_R1 Mixer"},
 546
 547         {"Right Line Out", NULL, "Right DAC_R1 Mixer"},
 548         {"Mono Out", NULL, "Right DAC_R1 Mixer"},
 549         {"Right HP Out", NULL, "Right DAC_R1 Mixer"},
 550         {"Right HP Com", NULL, "Right HPCOM Mux"},
 551
 552         {"RLOUT", NULL, "Right Line Out"},
 553         {"RLOUT", NULL, "Right Line Out"},
 554         {"HPROUT", NULL, "Right HP Out"},
 555         {"HPRCOM", NULL, "Right HP Com"},
 556
 557         /* Mono Output */
 558         {"MONO_LOUT", NULL, "Mono Out"},
 559         {"MONO_LOUT", NULL, "Mono Out"},
 560
 561         /* Left Input */
 562         {"Left Line1L Mux", "single-ended", "LINE1L"},
 563         {"Left Line1L Mux", "differential", "LINE1L"},
 564
 565         {"Left Line2L Mux", "single-ended", "LINE2L"},
 566         {"Left Line2L Mux", "differential", "LINE2L"},
 567
 568         {"Left PGA Mixer", "Line1L Switch", "Left Line1L Mux"},
 569         {"Left PGA Mixer", "Line2L Switch", "Left Line2L Mux"},
 570         {"Left PGA Mixer", "Mic3L Switch", "MIC3L"},
 571
 572         {"Left ADC", NULL, "Left PGA Mixer"},
 573
 574         /* Right Input */
 575         {"Right Line1R Mux", "single-ended", "LINE1R"},
 576         {"Right Line1R Mux", "differential", "LINE1R"},
 577
 578         {"Right Line2R Mux", "single-ended", "LINE2R"},
 579         {"Right Line2R Mux", "differential", "LINE2R"},
 580
 581         {"Right PGA Mixer", "Line1R Switch", "Right Line1R Mux"},
 582         {"Right PGA Mixer", "Line2R Switch", "Right Line2R Mux"},
 583         {"Right PGA Mixer", "Mic3R Switch", "MIC3R"},
 584
 585         {"Right ADC", NULL, "Right PGA Mixer"},
 586
 587         /* Left PGA Bypass */
 588         {"Left PGA Bypass Mixer", "Line Switch", "Left PGA Mixer"},
 589         {"Left PGA Bypass Mixer", "Mono Switch", "Left PGA Mixer"},
 590         {"Left PGA Bypass Mixer", "HP Switch", "Left PGA Mixer"},
 591         {"Left PGA Bypass Mixer", "HPCOM Switch", "Left PGA Mixer"},
 592
 593         {"Left HPCOM Mux", "differential of HPLOUT", "Left PGA Bypass Mixer"},
 594         {"Left HPCOM Mux", "constant VCM", "Left PGA Bypass Mixer"},
 595         {"Left HPCOM Mux", "single-ended", "Left PGA Bypass Mixer"},
 596
 597         {"Left Line Out", NULL, "Left PGA Bypass Mixer"},
 598         {"Mono Out", NULL, "Left PGA Bypass Mixer"},
 599         {"Left HP Out", NULL, "Left PGA Bypass Mixer"},
 600
 601         /* Right PGA Bypass */
 602         {"Right PGA Bypass Mixer", "Line Switch", "Right PGA Mixer"},
 603         {"Right PGA Bypass Mixer", "Mono Switch", "Right PGA Mixer"},
 604         {"Right PGA Bypass Mixer", "HP Switch", "Right PGA Mixer"},
 605         {"Right PGA Bypass Mixer", "HPCOM Switch", "Right PGA Mixer"},
 606
 607         {"Right HPCOM Mux", "differential of HPROUT", "Right PGA Bypass Mixer"},
 608         {"Right HPCOM Mux", "constant VCM", "Right PGA Bypass Mixer"},
 609         {"Right HPCOM Mux", "single-ended", "Right PGA Bypass Mixer"},
 610         {"Right HPCOM Mux", "differential of HPLCOM", "Right PGA Bypass Mixer"},
 611         {"Right HPCOM Mux", "external feedback", "Right PGA Bypass Mixer"},
 612
 613         {"Right Line Out", NULL, "Right PGA Bypass Mixer"},
 614         {"Mono Out", NULL, "Right PGA Bypass Mixer"},
 615         {"Right HP Out", NULL, "Right PGA Bypass Mixer"},
 616
 617         /* Left Line2 Bypass */
 618         {"Left Line2 Bypass Mixer", "Line Switch", "Left Line2L Mux"},
 619         {"Left Line2 Bypass Mixer", "Mono Switch", "Left Line2L Mux"},
 620         {"Left Line2 Bypass Mixer", "HP Switch", "Left Line2L Mux"},
 621         {"Left Line2 Bypass Mixer", "HPCOM Switch", "Left Line2L Mux"},
 622
 623         {"Left HPCOM Mux", "differential of HPLOUT", "Left Line2 Bypass Mixer"},
 624         {"Left HPCOM Mux", "constant VCM", "Left Line2 Bypass Mixer"},
 625         {"Left HPCOM Mux", "single-ended", "Left Line2 Bypass Mixer"},
 626
 627         {"Left Line Out", NULL, "Left Line2 Bypass Mixer"},
 628         {"Mono Out", NULL, "Left Line2 Bypass Mixer"},
 629         {"Left HP Out", NULL, "Left Line2 Bypass Mixer"},
 630
 631         /* Right Line2 Bypass */
 632         {"Right Line2 Bypass Mixer", "Line Switch", "Right Line2R Mux"},
 633         {"Right Line2 Bypass Mixer", "Mono Switch", "Right Line2R Mux"},
 634         {"Right Line2 Bypass Mixer", "HP Switch", "Right Line2R Mux"},
 635         {"Right Line2 Bypass Mixer", "HPCOM Switch", "Right Line2R Mux"},
 636
 637         {"Right HPCOM Mux", "differential of HPROUT", "Right Line2 Bypass Mixer"},
 638         {"Right HPCOM Mux", "constant VCM", "Right Line2 Bypass Mixer"},
 639         {"Right HPCOM Mux", "single-ended", "Right Line2 Bypass Mixer"},
 640         {"Right HPCOM Mux", "differential of HPLCOM", "Right Line2 Bypass Mixer"},
 641         {"Right HPCOM Mux", "external feedback", "Right Line2 Bypass Mixer"},
 642
 643         {"Right Line Out", NULL, "Right Line2 Bypass Mixer"},
 644         {"Mono Out", NULL, "Right Line2 Bypass Mixer"},
 645         {"Right HP Out", NULL, "Right Line2 Bypass Mixer"},
 646 };
 647
 648 static int aic3x_add_widgets(struct snd_soc_codec *codec)
 649 {
 650         snd_soc_dapm_new_controls(codec, aic3x_dapm_widgets,
 651                                   ARRAY_SIZE(aic3x_dapm_widgets));
 652
 653         /* set up audio path interconnects */
 654         snd_soc_dapm_add_routes(codec, intercon, ARRAY_SIZE(intercon));
 655
 656         snd_soc_dapm_new_widgets(codec);
 657         return 0;
 658 }
 659
 660 static int aic3x_hw_params(struct snd_pcm_substream *substream,
 661                            struct snd_pcm_hw_params *params)
 662 {
 663         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 664         struct snd_soc_device *socdev = rtd->socdev;
 665         struct snd_soc_codec *codec = socdev->codec;
 666         struct aic3x_priv *aic3x = codec->private_data;
 667         int codec_clk = 0, bypass_pll = 0, fsref, last_clk = 0;
 668         u8 data, r, p, pll_q, pll_p = 1, pll_r = 1, pll_j = 1;
 669         u16 pll_d = 1;
 670
 671         /* select data word length */
 672         data =
 673             aic3x_read_reg_cache(codec, AIC3X_ASD_INTF_CTRLB) & (~(0x3 << 4));
 674         switch (params_format(params)) {
 675         case SNDRV_PCM_FORMAT_S16_LE:
 676                 break;
 677         case SNDRV_PCM_FORMAT_S20_3LE:
 678                 data |= (0x01 << 4);
 679                 break;
 680         case SNDRV_PCM_FORMAT_S24_LE:
 681                 data |= (0x02 << 4);
 682                 break;
 683         case SNDRV_PCM_FORMAT_S32_LE:
 684                 data |= (0x03 << 4);
 685                 break;
 686         }
 687         aic3x_write(codec, AIC3X_ASD_INTF_CTRLB, data);
 688
 689         /* Fsref can be 44100 or 48000 */
 690         fsref = (params_rate(params) % 11025 == 0) ? 44100 : 48000;
 691
 692         /* Try to find a value for Q which allows us to bypass the PLL and
 693          * generate CODEC_CLK directly. */
 694         for (pll_q = 2; pll_q < 18; pll_q++)
 695                 if (aic3x->sysclk / (128 * pll_q) == fsref) {
 696                         bypass_pll = 1;
 697                         break;
 698                 }
 699
 700         if (bypass_pll) {
 701                 pll_q &= 0xf;
 702                 aic3x_write(codec, AIC3X_PLL_PROGA_REG, pll_q << PLLQ_SHIFT);
 703                 aic3x_write(codec, AIC3X_GPIOB_REG, CODEC_CLKIN_CLKDIV);
 704         } else
 705                 aic3x_write(codec, AIC3X_GPIOB_REG, CODEC_CLKIN_PLLDIV);
 706
 707         /* Route Left DAC to left channel input and
 708          * right DAC to right channel input */
 709         data = (LDAC2LCH | RDAC2RCH);
 710         data |= (fsref == 44100) ? FSREF_44100 : FSREF_48000;
 711         if (params_rate(params) >= 64000)
 712                 data |= DUAL_RATE_MODE;
 713         aic3x_write(codec, AIC3X_CODEC_DATAPATH_REG, data);
 714
 715         /* codec sample rate select */
 716         data = (fsref * 20) / params_rate(params);
 717         if (params_rate(params) < 64000)
 718                 data /= 2;
 719         data /= 5;
 720         data -= 2;
 721         data |= (data << 4);
 722         aic3x_write(codec, AIC3X_SAMPLE_RATE_SEL_REG, data);
 723
 724         if (bypass_pll)
 725                 return 0;
 726
 727         /* Use PLL
 728          * find an apropriate setup for j, d, r and p by iterating over
 729          * p and r - j and d are calculated for each fraction.
 730          * Up to 128 values are probed, the closest one wins the game.
 731          * The sysclk is divided by 1000 to prevent integer overflows.
 732          */
 733         codec_clk = (2048 * fsref) / (aic3x->sysclk / 1000);
 734
 735         for (r = 1; r <= 16; r++)
 736                 for (p = 1; p <= 8; p++) {
 737                         int clk, tmp = (codec_clk * pll_r * 10) / pll_p;
 738                         u8 j = tmp / 10000;
 739                         u16 d = tmp % 10000;
 740
 741                         if (j > 63)
 742                                 continue;
 743
 744                         if (d != 0 && aic3x->sysclk < 10000000)
 745                                 continue;
 746
 747                         /* This is actually 1000 * ((j + (d/10000)) * r) / p
 748                          * The term had to be converted to get rid of the
 749                          * division by 10000 */
 750                         clk = ((10000 * j * r) + (d * r)) / (10 * p);
 751
 752                         /* check whether this values get closer than the best
 753                          * ones we had before */
 754                         if (abs(codec_clk - clk) < abs(codec_clk - last_clk)) {
 755                                 pll_j = j; pll_d = d; pll_r = r; pll_p = p;
 756                                 last_clk = clk;
 757                         }
 758
 759                         /* Early exit for exact matches */
 760                         if (clk == codec_clk)
 761                                 break;
 762                 }
 763
 764         if (last_clk == 0) {
 765                 printk(KERN_ERR "%s(): unable to setup PLL\n", __func__);
 766                 return -EINVAL;
 767         }
 768
 769         data = aic3x_read_reg_cache(codec, AIC3X_PLL_PROGA_REG);
 770         aic3x_write(codec, AIC3X_PLL_PROGA_REG, data | (pll_p << PLLP_SHIFT));
 771         aic3x_write(codec, AIC3X_OVRF_STATUS_AND_PLLR_REG, pll_r << PLLR_SHIFT);
 772         aic3x_write(codec, AIC3X_PLL_PROGB_REG, pll_j << PLLJ_SHIFT);
 773         aic3x_write(codec, AIC3X_PLL_PROGC_REG, (pll_d >> 6) << PLLD_MSB_SHIFT);
 774         aic3x_write(codec, AIC3X_PLL_PROGD_REG,
 775                     (pll_d & 0x3F) << PLLD_LSB_SHIFT);
 776
 777         return 0;
 778 }
 779
 780 static int aic3x_mute(struct snd_soc_codec_dai *dai, int mute)
 781 {
 782         struct snd_soc_codec *codec = dai->codec;
 783         u8 ldac_reg = aic3x_read_reg_cache(codec, LDAC_VOL) & ~MUTE_ON;
 784         u8 rdac_reg = aic3x_read_reg_cache(codec, RDAC_VOL) & ~MUTE_ON;
 785
 786         if (mute) {
 787                 aic3x_write(codec, LDAC_VOL, ldac_reg | MUTE_ON);
 788                 aic3x_write(codec, RDAC_VOL, rdac_reg | MUTE_ON);
 789         } else {
 790                 aic3x_write(codec, LDAC_VOL, ldac_reg);
 791                 aic3x_write(codec, RDAC_VOL, rdac_reg);
 792         }
 793
 794         return 0;
 795 }
 796
 797 static int aic3x_set_dai_sysclk(struct snd_soc_codec_dai *codec_dai,
 798                                 int clk_id, unsigned int freq, int dir)
 799 {
 800         struct snd_soc_codec *codec = codec_dai->codec;
 801         struct aic3x_priv *aic3x = codec->private_data;
 802
 803         aic3x->sysclk = freq;
 804         return 0;
 805 }
 806
 807 static int aic3x_set_dai_fmt(struct snd_soc_codec_dai *codec_dai,
 808                              unsigned int fmt)
 809 {
 810         struct snd_soc_codec *codec = codec_dai->codec;
 811         struct aic3x_priv *aic3x = codec->private_data;
 812         u8 iface_areg, iface_breg;
 813
 814         iface_areg = aic3x_read_reg_cache(codec, AIC3X_ASD_INTF_CTRLA) & 0x3f;
 815         iface_breg = aic3x_read_reg_cache(codec, AIC3X_ASD_INTF_CTRLB) & 0x3f;
 816
 817         /* set master/slave audio interface */
 818         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
 819         case SND_SOC_DAIFMT_CBM_CFM:
 820                 aic3x->master = 1;
 821                 iface_areg |= BIT_CLK_MASTER | WORD_CLK_MASTER;
 822                 break;
 823         case SND_SOC_DAIFMT_CBS_CFS:
 824                 aic3x->master = 0;
 825                 break;
 826         default:
 827                 return -EINVAL;
 828         }
 829
 830         /* interface format */
 831         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
 832         case SND_SOC_DAIFMT_I2S:
 833                 break;
 834         case SND_SOC_DAIFMT_DSP_A:
 835                 iface_breg |= (0x01 << 6);
 836                 break;
 837         case SND_SOC_DAIFMT_RIGHT_J:
 838                 iface_breg |= (0x02 << 6);
 839                 break;
 840         case SND_SOC_DAIFMT_LEFT_J:
 841                 iface_breg |= (0x03 << 6);
 842                 break;
 843         default:
 844                 return -EINVAL;
 845         }
 846
 847         /* set iface */
 848         aic3x_write(codec, AIC3X_ASD_INTF_CTRLA, iface_areg);
 849         aic3x_write(codec, AIC3X_ASD_INTF_CTRLB, iface_breg);
 850
 851         return 0;
 852 }
 853
 854 static int aic3x_set_bias_level(struct snd_soc_codec *codec,
 855                                 enum snd_soc_bias_level level)
 856 {
 857         struct aic3x_priv *aic3x = codec->private_data;
 858         u8 reg;
 859
 860         switch (level) {
 861         case SND_SOC_BIAS_ON:
 862                 /* all power is driven by DAPM system */
 863                 if (aic3x->master) {
 864                         /* enable pll */
 865                         reg = aic3x_read_reg_cache(codec, AIC3X_PLL_PROGA_REG);
 866                         aic3x_write(codec, AIC3X_PLL_PROGA_REG,
 867                                     reg | PLL_ENABLE);
 868                 }
 869                 break;
 870         case SND_SOC_BIAS_PREPARE:
 871                 break;
 872         case SND_SOC_BIAS_STANDBY:
 873                 /*
 874                  * all power is driven by DAPM system,
 875                  * so output power is safe if bypass was set
 876                  */
 877                 if (aic3x->master) {
 878                         /* disable pll */
 879                         reg = aic3x_read_reg_cache(codec, AIC3X_PLL_PROGA_REG);
 880                         aic3x_write(codec, AIC3X_PLL_PROGA_REG,
 881                                     reg & ~PLL_ENABLE);
 882                 }
 883                 break;
 884         case SND_SOC_BIAS_OFF:
 885                 /* force all power off */
 886                 reg = aic3x_read_reg_cache(codec, LINE1L_2_LADC_CTRL);
 887                 aic3x_write(codec, LINE1L_2_LADC_CTRL, reg & ~LADC_PWR_ON);
 888                 reg = aic3x_read_reg_cache(codec, LINE1R_2_RADC_CTRL);
 889                 aic3x_write(codec, LINE1R_2_RADC_CTRL, reg & ~RADC_PWR_ON);
 890
 891                 reg = aic3x_read_reg_cache(codec, DAC_PWR);
 892                 aic3x_write(codec, DAC_PWR, reg & ~(LDAC_PWR_ON | RDAC_PWR_ON));
 893
 894                 reg = aic3x_read_reg_cache(codec, HPLOUT_CTRL);
 895                 aic3x_write(codec, HPLOUT_CTRL, reg & ~HPLOUT_PWR_ON);
 896                 reg = aic3x_read_reg_cache(codec, HPROUT_CTRL);
 897                 aic3x_write(codec, HPROUT_CTRL, reg & ~HPROUT_PWR_ON);
 898
 899                 reg = aic3x_read_reg_cache(codec, HPLCOM_CTRL);
 900                 aic3x_write(codec, HPLCOM_CTRL, reg & ~HPLCOM_PWR_ON);
 901                 reg = aic3x_read_reg_cache(codec, HPRCOM_CTRL);
 902                 aic3x_write(codec, HPRCOM_CTRL, reg & ~HPRCOM_PWR_ON);
 903
 904                 reg = aic3x_read_reg_cache(codec, MONOLOPM_CTRL);
 905                 aic3x_write(codec, MONOLOPM_CTRL, reg & ~MONOLOPM_PWR_ON);
 906
 907                 reg = aic3x_read_reg_cache(codec, LLOPM_CTRL);
 908                 aic3x_write(codec, LLOPM_CTRL, reg & ~LLOPM_PWR_ON);
 909                 reg = aic3x_read_reg_cache(codec, RLOPM_CTRL);
 910                 aic3x_write(codec, RLOPM_CTRL, reg & ~RLOPM_PWR_ON);
 911
 912                 if (aic3x->master) {
 913                         /* disable pll */
 914                         reg = aic3x_read_reg_cache(codec, AIC3X_PLL_PROGA_REG);
 915                         aic3x_write(codec, AIC3X_PLL_PROGA_REG,
 916                                     reg & ~PLL_ENABLE);
 917                 }
 918                 break;
 919         }
 920         codec->bias_level = level;
 921
 922         return 0;
 923 }
 924
 925 void aic3x_set_gpio(struct snd_soc_codec *codec, int gpio, int state)
 926 {
 927         u8 reg = gpio ? AIC3X_GPIO2_REG : AIC3X_GPIO1_REG;
 928         u8 bit = gpio ? 3: 0;
 929         u8 val = aic3x_read_reg_cache(codec, reg) & ~(1 << bit);
 930         aic3x_write(codec, reg, val | (!!state << bit));
 931 }
 932 EXPORT_SYMBOL_GPL(aic3x_set_gpio);
 933
 934 int aic3x_get_gpio(struct snd_soc_codec *codec, int gpio)
 935 {
 936         u8 reg = gpio ? AIC3X_GPIO2_REG : AIC3X_GPIO1_REG;
 937         u8 val, bit = gpio ? 2: 1;
 938
 939         aic3x_read(codec, reg, &val);
 940         return (val >> bit) & 1;
 941 }
 942 EXPORT_SYMBOL_GPL(aic3x_get_gpio);
 943
 944 int aic3x_headset_detected(struct snd_soc_codec *codec)
 945 {
 946         u8 val;
 947         aic3x_read(codec, AIC3X_RT_IRQ_FLAGS_REG, &val);
 948         return (val >> 2) & 1;
 949 }
 950 EXPORT_SYMBOL_GPL(aic3x_headset_detected);
 951
 952 #define AIC3X_RATES     SNDRV_PCM_RATE_8000_96000
 953 #define AIC3X_FORMATS   (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
 954                          SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE)
 955
 956 struct snd_soc_codec_dai aic3x_dai = {
 957         .name = "aic3x",
 958         .playback = {
 959                 .stream_name = "Playback",
 960                 .channels_min = 1,
 961                 .channels_max = 2,
 962                 .rates = AIC3X_RATES,
 963                 .formats = AIC3X_FORMATS,},
 964         .capture = {
 965                 .stream_name = "Capture",
 966                 .channels_min = 1,
 967                 .channels_max = 2,
 968                 .rates = AIC3X_RATES,
 969                 .formats = AIC3X_FORMATS,},
 970         .ops = {
 971                 .hw_params = aic3x_hw_params,
 972         },
 973         .dai_ops = {
 974                 .digital_mute = aic3x_mute,
 975                 .set_sysclk = aic3x_set_dai_sysclk,
 976                 .set_fmt = aic3x_set_dai_fmt,
 977         }
 978 };
 979 EXPORT_SYMBOL_GPL(aic3x_dai);
 980
 981 static int aic3x_suspend(struct platform_device *pdev, pm_message_t state)
 982 {
 983         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
 984         struct snd_soc_codec *codec = socdev->codec;
 985
 986         aic3x_set_bias_level(codec, SND_SOC_BIAS_OFF);
 987
 988         return 0;
 989 }
 990
 991 static int aic3x_resume(struct platform_device *pdev)
 992 {
 993         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
 994         struct snd_soc_codec *codec = socdev->codec;
 995         int i;
 996         u8 data[2];
 997         u8 *cache = codec->reg_cache;
 998
 999         /* Sync reg_cache with the hardware */
1000         for (i = 0; i < ARRAY_SIZE(aic3x_reg); i++) {
1001                 data[0] = i;
1002                 data[1] = cache[i];
1003                 codec->hw_write(codec->control_data, data, 2);
1004         }
1005
1006         aic3x_set_bias_level(codec, codec->suspend_bias_level);
1007
1008         return 0;
1009 }
1010
1011 /*
1012  * initialise the AIC3X driver
1013  * register the mixer and dsp interfaces with the kernel
1014  */
1015 static int aic3x_init(struct snd_soc_device *socdev)
1016 {
1017         struct snd_soc_codec *codec = socdev->codec;
1018         struct aic3x_setup_data *setup = socdev->codec_data;
1019         int reg, ret = 0;
1020
1021         codec->name = "aic3x";
1022         codec->owner = THIS_MODULE;
1023         codec->read = aic3x_read_reg_cache;
1024         codec->write = aic3x_write;
1025         codec->set_bias_level = aic3x_set_bias_level;
1026         codec->dai = &aic3x_dai;
1027         codec->num_dai = 1;
1028         codec->reg_cache_size = ARRAY_SIZE(aic3x_reg);
1029         codec->reg_cache = kmemdup(aic3x_reg, sizeof(aic3x_reg), GFP_KERNEL);
1030         if (codec->reg_cache == NULL)
1031                 return -ENOMEM;
1032
1033         aic3x_write(codec, AIC3X_PAGE_SELECT, PAGE0_SELECT);
1034         aic3x_write(codec, AIC3X_RESET, SOFT_RESET);
1035
1036         /* register pcms */
1037         ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
1038         if (ret < 0) {
1039                 printk(KERN_ERR "aic3x: failed to create pcms\n");
1040                 goto pcm_err;
1041         }
1042
1043         /* DAC default volume and mute */
1044         aic3x_write(codec, LDAC_VOL, DEFAULT_VOL | MUTE_ON);
1045         aic3x_write(codec, RDAC_VOL, DEFAULT_VOL | MUTE_ON);
1046
1047         /* DAC to HP default volume and route to Output mixer */
1048         aic3x_write(codec, DACL1_2_HPLOUT_VOL, DEFAULT_VOL | ROUTE_ON);
1049         aic3x_write(codec, DACR1_2_HPROUT_VOL, DEFAULT_VOL | ROUTE_ON);
1050         aic3x_write(codec, DACL1_2_HPLCOM_VOL, DEFAULT_VOL | ROUTE_ON);
1051         aic3x_write(codec, DACR1_2_HPRCOM_VOL, DEFAULT_VOL | ROUTE_ON);
1052         /* DAC to Line Out default volume and route to Output mixer */
1053         aic3x_write(codec, DACL1_2_LLOPM_VOL, DEFAULT_VOL | ROUTE_ON);
1054         aic3x_write(codec, DACR1_2_RLOPM_VOL, DEFAULT_VOL | ROUTE_ON);
1055         /* DAC to Mono Line Out default volume and route to Output mixer */
1056         aic3x_write(codec, DACL1_2_MONOLOPM_VOL, DEFAULT_VOL | ROUTE_ON);
1057         aic3x_write(codec, DACR1_2_MONOLOPM_VOL, DEFAULT_VOL | ROUTE_ON);
1058
1059         /* unmute all outputs */
1060         reg = aic3x_read_reg_cache(codec, LLOPM_CTRL);
1061         aic3x_write(codec, LLOPM_CTRL, reg | UNMUTE);
1062         reg = aic3x_read_reg_cache(codec, RLOPM_CTRL);
1063         aic3x_write(codec, RLOPM_CTRL, reg | UNMUTE);
1064         reg = aic3x_read_reg_cache(codec, MONOLOPM_CTRL);
1065         aic3x_write(codec, MONOLOPM_CTRL, reg | UNMUTE);
1066         reg = aic3x_read_reg_cache(codec, HPLOUT_CTRL);
1067         aic3x_write(codec, HPLOUT_CTRL, reg | UNMUTE);
1068         reg = aic3x_read_reg_cache(codec, HPROUT_CTRL);
1069         aic3x_write(codec, HPROUT_CTRL, reg | UNMUTE);
1070         reg = aic3x_read_reg_cache(codec, HPLCOM_CTRL);
1071         aic3x_write(codec, HPLCOM_CTRL, reg | UNMUTE);
1072         reg = aic3x_read_reg_cache(codec, HPRCOM_CTRL);
1073         aic3x_write(codec, HPRCOM_CTRL, reg | UNMUTE);
1074
1075         /* ADC default volume and unmute */
1076         aic3x_write(codec, LADC_VOL, DEFAULT_GAIN);
1077         aic3x_write(codec, RADC_VOL, DEFAULT_GAIN);
1078         /* By default route Line1 to ADC PGA mixer */
1079         aic3x_write(codec, LINE1L_2_LADC_CTRL, 0x0);
1080         aic3x_write(codec, LINE1R_2_RADC_CTRL, 0x0);
1081
1082         /* PGA to HP Bypass default volume, disconnect from Output Mixer */
1083         aic3x_write(codec, PGAL_2_HPLOUT_VOL, DEFAULT_VOL);
1084         aic3x_write(codec, PGAR_2_HPROUT_VOL, DEFAULT_VOL);
1085         aic3x_write(codec, PGAL_2_HPLCOM_VOL, DEFAULT_VOL);
1086         aic3x_write(codec, PGAR_2_HPRCOM_VOL, DEFAULT_VOL);
1087         /* PGA to Line Out default volume, disconnect from Output Mixer */
1088         aic3x_write(codec, PGAL_2_LLOPM_VOL, DEFAULT_VOL);
1089         aic3x_write(codec, PGAR_2_RLOPM_VOL, DEFAULT_VOL);
1090         /* PGA to Mono Line Out default volume, disconnect from Output Mixer */
1091         aic3x_write(codec, PGAL_2_MONOLOPM_VOL, DEFAULT_VOL);
1092         aic3x_write(codec, PGAR_2_MONOLOPM_VOL, DEFAULT_VOL);
1093
1094         /* Line2 to HP Bypass default volume, disconnect from Output Mixer */
1095         aic3x_write(codec, LINE2L_2_HPLOUT_VOL, DEFAULT_VOL);
1096         aic3x_write(codec, LINE2R_2_HPROUT_VOL, DEFAULT_VOL);
1097         aic3x_write(codec, LINE2L_2_HPLCOM_VOL, DEFAULT_VOL);
1098         aic3x_write(codec, LINE2R_2_HPRCOM_VOL, DEFAULT_VOL);
1099         /* Line2 Line Out default volume, disconnect from Output Mixer */
1100         aic3x_write(codec, LINE2L_2_LLOPM_VOL, DEFAULT_VOL);
1101         aic3x_write(codec, LINE2R_2_RLOPM_VOL, DEFAULT_VOL);
1102         /* Line2 to Mono Out default volume, disconnect from Output Mixer */
1103         aic3x_write(codec, LINE2L_2_MONOLOPM_VOL, DEFAULT_VOL);
1104         aic3x_write(codec, LINE2R_2_MONOLOPM_VOL, DEFAULT_VOL);
1105
1106         /* off, with power on */
1107         aic3x_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
1108
1109         /* setup GPIO functions */
1110         aic3x_write(codec, AIC3X_GPIO1_REG, (setup->gpio_func[0] & 0xf) << 4);
1111         aic3x_write(codec, AIC3X_GPIO2_REG, (setup->gpio_func[1] & 0xf) << 4);
1112
1113         aic3x_add_controls(codec);
1114         aic3x_add_widgets(codec);
1115         ret = snd_soc_register_card(socdev);
1116         if (ret < 0) {
1117                 printk(KERN_ERR "aic3x: failed to register card\n");
1118                 goto card_err;
1119         }
1120
1121         return ret;
1122
1123 card_err:
1124         snd_soc_free_pcms(socdev);
1125         snd_soc_dapm_free(socdev);
1126 pcm_err:
1127         kfree(codec->reg_cache);
1128         return ret;
1129 }
1130
1131 static struct snd_soc_device *aic3x_socdev;
1132
1133 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
1134 /*
1135  * AIC3X 2 wire address can be up to 4 devices with device addresses
1136  * 0x18, 0x19, 0x1A, 0x1B
1137  */
1138 static unsigned short normal_i2c[] = { 0, I2C_CLIENT_END };
1139
1140 /* Magic definition of all other variables and things */
1141 I2C_CLIENT_INSMOD;
1142
1143 static struct i2c_driver aic3x_i2c_driver;
1144 static struct i2c_client client_template;
1145
1146 /*
1147  * If the i2c layer weren't so broken, we could pass this kind of data
1148  * around
1149  */
1150 static int aic3x_codec_probe(struct i2c_adapter *adap, int addr, int kind)
1151 {
1152         struct snd_soc_device *socdev = aic3x_socdev;
1153         struct aic3x_setup_data *setup = socdev->codec_data;
1154         struct snd_soc_codec *codec = socdev->codec;
1155         struct i2c_client *i2c;
1156         int ret;
1157
1158         if (addr != setup->i2c_address)
1159                 return -ENODEV;
1160
1161         client_template.adapter = adap;
1162         client_template.addr = addr;
1163
1164         i2c = kmemdup(&client_template, sizeof(client_template), GFP_KERNEL);
1165         if (i2c == NULL) {
1166                 kfree(codec);
1167                 return -ENOMEM;
1168         }
1169         i2c_set_clientdata(i2c, codec);
1170         codec->control_data = i2c;
1171
1172         ret = i2c_attach_client(i2c);
1173         if (ret < 0) {
1174                 printk(KERN_ERR "aic3x: failed to attach codec at addr %x\n",
1175                        addr);
1176                 goto err;
1177         }
1178
1179         ret = aic3x_init(socdev);
1180         if (ret < 0) {
1181                 printk(KERN_ERR "aic3x: failed to initialise AIC3X\n");
1182                 goto err;
1183         }
1184         return ret;
1185
1186 err:
1187         kfree(codec);
1188         kfree(i2c);
1189         return ret;
1190 }
1191
1192 static int aic3x_i2c_detach(struct i2c_client *client)
1193 {
1194         struct snd_soc_codec *codec = i2c_get_clientdata(client);
1195         i2c_detach_client(client);
1196         kfree(codec->reg_cache);
1197         kfree(client);
1198         return 0;
1199 }
1200
1201 static int aic3x_i2c_attach(struct i2c_adapter *adap)
1202 {
1203         return i2c_probe(adap, &addr_data, aic3x_codec_probe);
1204 }
1205
1206 /* machine i2c codec control layer */
1207 static struct i2c_driver aic3x_i2c_driver = {
1208         .driver = {
1209                 .name = "aic3x I2C Codec",
1210                 .owner = THIS_MODULE,
1211         },
1212         .attach_adapter = aic3x_i2c_attach,
1213         .detach_client = aic3x_i2c_detach,
1214 };
1215
1216 static struct i2c_client client_template = {
1217         .name = "AIC3X",
1218         .driver = &aic3x_i2c_driver,
1219 };
1220
1221 static int aic3x_i2c_read(struct i2c_client *client, u8 *value, int len)
1222 {
1223         value[0] = i2c_smbus_read_byte_data(client, value[0]);
1224         return (len == 1);
1225 }
1226 #endif
1227
1228 static int aic3x_probe(struct platform_device *pdev)
1229 {
1230         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1231         struct aic3x_setup_data *setup;
1232         struct snd_soc_codec *codec;
1233         struct aic3x_priv *aic3x;
1234         int ret = 0;
1235
1236         printk(KERN_INFO "AIC3X Audio Codec %s\n", AIC3X_VERSION);
1237
1238         setup = socdev->codec_data;
1239         codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
1240         if (codec == NULL)
1241                 return -ENOMEM;
1242
1243         aic3x = kzalloc(sizeof(struct aic3x_priv), GFP_KERNEL);
1244         if (aic3x == NULL) {
1245                 kfree(codec);
1246                 return -ENOMEM;
1247         }
1248
1249         codec->private_data = aic3x;
1250         socdev->codec = codec;
1251         mutex_init(&codec->mutex);
1252         INIT_LIST_HEAD(&codec->dapm_widgets);
1253         INIT_LIST_HEAD(&codec->dapm_paths);
1254
1255         aic3x_socdev = socdev;
1256 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
1257         if (setup->i2c_address) {
1258                 normal_i2c[0] = setup->i2c_address;
1259                 codec->hw_write = (hw_write_t) i2c_master_send;
1260                 codec->hw_read = (hw_read_t) aic3x_i2c_read;
1261                 ret = i2c_add_driver(&aic3x_i2c_driver);
1262                 if (ret != 0)
1263                         printk(KERN_ERR "can't add i2c driver");
1264         }
1265 #else
1266         /* Add other interfaces here */
1267 #endif
1268         return ret;
1269 }
1270
1271 static int aic3x_remove(struct platform_device *pdev)
1272 {
1273         struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1274         struct snd_soc_codec *codec = socdev->codec;
1275
1276         /* power down chip */
1277         if (codec->control_data)
1278                 aic3x_set_bias_level(codec, SND_SOC_BIAS_OFF);
1279
1280         snd_soc_free_pcms(socdev);
1281         snd_soc_dapm_free(socdev);
1282 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
1283         i2c_del_driver(&aic3x_i2c_driver);
1284 #endif
1285         kfree(codec->private_data);
1286         kfree(codec);
1287
1288         return 0;
1289 }
1290
1291 struct snd_soc_codec_device soc_codec_dev_aic3x = {
1292         .probe = aic3x_probe,
1293         .remove = aic3x_remove,
1294         .suspend = aic3x_suspend,
1295         .resume = aic3x_resume,
1296 };
1297 EXPORT_SYMBOL_GPL(soc_codec_dev_aic3x);
1298
1299 MODULE_DESCRIPTION("ASoC TLV320AIC3X codec driver");
1300 MODULE_AUTHOR("Vladimir Barinov");
1301 MODULE_LICENSE("GPL");