sound/soc/codecs/tlv320aic32x4.c

   1 /*
   2  * linux/sound/soc/codecs/tlv320aic32x4.c
   3  *
   4  * Copyright 2011 Vista Silicon S.L.
   5  *
   6  * Author: Javier Martin <javier.martin@vista-silicon.com>
   7  *
   8  * Based on sound/soc/codecs/wm8974 and TI driver for kernel 2.6.27.
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License as published by
  12  * the Free Software Foundation; either version 2 of the License, or
  13  * (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
  23  * MA 02110-1301, USA.
  24  */
  25
  26 #include <linux/module.h>
  27 #include <linux/moduleparam.h>
  28 #include <linux/init.h>
  29 #include <linux/delay.h>
  30 #include <linux/pm.h>
  31 #include <linux/i2c.h>
  32 #include <linux/platform_device.h>
  33 #include <linux/cdev.h>
  34 #include <linux/slab.h>
  35
  36 #include <sound/tlv320aic32x4.h>
  37 #include <sound/core.h>
  38 #include <sound/pcm.h>
  39 #include <sound/pcm_params.h>
  40 #include <sound/soc.h>
  41 #include <sound/soc-dapm.h>
  42 #include <sound/initval.h>
  43 #include <sound/tlv.h>
  44
  45 #include "tlv320aic32x4.h"
  46
  47 struct aic32x4_rate_divs {
  48         u32 mclk;
  49         u32 rate;
  50         u8 p_val;
  51         u8 pll_j;
  52         u16 pll_d;
  53         u16 dosr;
  54         u8 ndac;
  55         u8 mdac;
  56         u8 aosr;
  57         u8 nadc;
  58         u8 madc;
  59         u8 blck_N;
  60 };
  61
  62 struct aic32x4_priv {
  63         u32 sysclk;
  64         s32 master;
  65         u8 page_no;
  66         void *control_data;
  67         u32 power_cfg;
  68         u32 micpga_routing;
  69         bool swapdacs;
  70 };
  71
  72 /* 0dB min, 1dB steps */
  73 static DECLARE_TLV_DB_SCALE(tlv_step_1, 0, 100, 0);
  74 /* 0dB min, 0.5dB steps */
  75 static DECLARE_TLV_DB_SCALE(tlv_step_0_5, 0, 50, 0);
  76
  77 static const struct snd_kcontrol_new aic32x4_snd_controls[] = {
  78         SOC_DOUBLE_R_TLV("PCM Playback Volume", AIC32X4_LDACVOL,
  79                         AIC32X4_RDACVOL, 0, 0x30, 0, tlv_step_0_5),
  80         SOC_DOUBLE_R_TLV("HP Driver Gain Volume", AIC32X4_HPLGAIN,
  81                         AIC32X4_HPRGAIN, 0, 0x1D, 0, tlv_step_1),
  82         SOC_DOUBLE_R_TLV("LO Driver Gain Volume", AIC32X4_LOLGAIN,
  83                         AIC32X4_LORGAIN, 0, 0x1D, 0, tlv_step_1),
  84         SOC_DOUBLE_R("HP DAC Playback Switch", AIC32X4_HPLGAIN,
  85                         AIC32X4_HPRGAIN, 6, 0x01, 1),
  86         SOC_DOUBLE_R("LO DAC Playback Switch", AIC32X4_LOLGAIN,
  87                         AIC32X4_LORGAIN, 6, 0x01, 1),
  88         SOC_DOUBLE_R("Mic PGA Switch", AIC32X4_LMICPGAVOL,
  89                         AIC32X4_RMICPGAVOL, 7, 0x01, 1),
  90
  91         SOC_SINGLE("ADCFGA Left Mute Switch", AIC32X4_ADCFGA, 7, 1, 0),
  92         SOC_SINGLE("ADCFGA Right Mute Switch", AIC32X4_ADCFGA, 3, 1, 0),
  93
  94         SOC_DOUBLE_R_TLV("ADC Level Volume", AIC32X4_LADCVOL,
  95                         AIC32X4_RADCVOL, 0, 0x28, 0, tlv_step_0_5),
  96         SOC_DOUBLE_R_TLV("PGA Level Volume", AIC32X4_LMICPGAVOL,
  97                         AIC32X4_RMICPGAVOL, 0, 0x5f, 0, tlv_step_0_5),
  98
  99         SOC_SINGLE("Auto-mute Switch", AIC32X4_DACMUTE, 4, 7, 0),
 100
 101         SOC_SINGLE("AGC Left Switch", AIC32X4_LAGC1, 7, 1, 0),
 102         SOC_SINGLE("AGC Right Switch", AIC32X4_RAGC1, 7, 1, 0),
 103         SOC_DOUBLE_R("AGC Target Level", AIC32X4_LAGC1, AIC32X4_RAGC1,
 104                         4, 0x07, 0),
 105         SOC_DOUBLE_R("AGC Gain Hysteresis", AIC32X4_LAGC1, AIC32X4_RAGC1,
 106                         0, 0x03, 0),
 107         SOC_DOUBLE_R("AGC Hysteresis", AIC32X4_LAGC2, AIC32X4_RAGC2,
 108                         6, 0x03, 0),
 109         SOC_DOUBLE_R("AGC Noise Threshold", AIC32X4_LAGC2, AIC32X4_RAGC2,
 110                         1, 0x1F, 0),
 111         SOC_DOUBLE_R("AGC Max PGA", AIC32X4_LAGC3, AIC32X4_RAGC3,
 112                         0, 0x7F, 0),
 113         SOC_DOUBLE_R("AGC Attack Time", AIC32X4_LAGC4, AIC32X4_RAGC4,
 114                         3, 0x1F, 0),
 115         SOC_DOUBLE_R("AGC Decay Time", AIC32X4_LAGC5, AIC32X4_RAGC5,
 116                         3, 0x1F, 0),
 117         SOC_DOUBLE_R("AGC Noise Debounce", AIC32X4_LAGC6, AIC32X4_RAGC6,
 118                         0, 0x1F, 0),
 119         SOC_DOUBLE_R("AGC Signal Debounce", AIC32X4_LAGC7, AIC32X4_RAGC7,
 120                         0, 0x0F, 0),
 121 };
 122
 123 static const struct aic32x4_rate_divs aic32x4_divs[] = {
 124         /* 8k rate */
 125         {AIC32X4_FREQ_12000000, 8000, 1, 7, 6800, 768, 5, 3, 128, 5, 18, 24},
 126         {AIC32X4_FREQ_24000000, 8000, 2, 7, 6800, 768, 15, 1, 64, 45, 4, 24},
 127         {AIC32X4_FREQ_25000000, 8000, 2, 7, 3728, 768, 15, 1, 64, 45, 4, 24},
 128         /* 11.025k rate */
 129         {AIC32X4_FREQ_12000000, 11025, 1, 7, 5264, 512, 8, 2, 128, 8, 8, 16},
 130         {AIC32X4_FREQ_24000000, 11025, 2, 7, 5264, 512, 16, 1, 64, 32, 4, 16},
 131         /* 16k rate */
 132         {AIC32X4_FREQ_12000000, 16000, 1, 7, 6800, 384, 5, 3, 128, 5, 9, 12},
 133         {AIC32X4_FREQ_24000000, 16000, 2, 7, 6800, 384, 15, 1, 64, 18, 5, 12},
 134         {AIC32X4_FREQ_25000000, 16000, 2, 7, 3728, 384, 15, 1, 64, 18, 5, 12},
 135         /* 22.05k rate */
 136         {AIC32X4_FREQ_12000000, 22050, 1, 7, 5264, 256, 4, 4, 128, 4, 8, 8},
 137         {AIC32X4_FREQ_24000000, 22050, 2, 7, 5264, 256, 16, 1, 64, 16, 4, 8},
 138         {AIC32X4_FREQ_25000000, 22050, 2, 7, 2253, 256, 16, 1, 64, 16, 4, 8},
 139         /* 32k rate */
 140         {AIC32X4_FREQ_12000000, 32000, 1, 7, 1680, 192, 2, 7, 64, 2, 21, 6},
 141         {AIC32X4_FREQ_24000000, 32000, 2, 7, 1680, 192, 7, 2, 64, 7, 6, 6},
 142         /* 44.1k rate */
 143         {AIC32X4_FREQ_12000000, 44100, 1, 7, 5264, 128, 2, 8, 128, 2, 8, 4},
 144         {AIC32X4_FREQ_24000000, 44100, 2, 7, 5264, 128, 8, 2, 64, 8, 4, 4},
 145         {AIC32X4_FREQ_25000000, 44100, 2, 7, 2253, 128, 8, 2, 64, 8, 4, 4},
 146         /* 48k rate */
 147         {AIC32X4_FREQ_12000000, 48000, 1, 8, 1920, 128, 2, 8, 128, 2, 8, 4},
 148         {AIC32X4_FREQ_24000000, 48000, 2, 8, 1920, 128, 8, 2, 64, 8, 4, 4},
 149         {AIC32X4_FREQ_25000000, 48000, 2, 7, 8643, 128, 8, 2, 64, 8, 4, 4}
 150 };
 151
 152 static const struct snd_kcontrol_new hpl_output_mixer_controls[] = {
 153         SOC_DAPM_SINGLE("L_DAC Switch", AIC32X4_HPLROUTE, 3, 1, 0),
 154         SOC_DAPM_SINGLE("IN1_L Switch", AIC32X4_HPLROUTE, 2, 1, 0),
 155 };
 156
 157 static const struct snd_kcontrol_new hpr_output_mixer_controls[] = {
 158         SOC_DAPM_SINGLE("R_DAC Switch", AIC32X4_HPRROUTE, 3, 1, 0),
 159         SOC_DAPM_SINGLE("IN1_R Switch", AIC32X4_HPRROUTE, 2, 1, 0),
 160 };
 161
 162 static const struct snd_kcontrol_new lol_output_mixer_controls[] = {
 163         SOC_DAPM_SINGLE("L_DAC Switch", AIC32X4_LOLROUTE, 3, 1, 0),
 164 };
 165
 166 static const struct snd_kcontrol_new lor_output_mixer_controls[] = {
 167         SOC_DAPM_SINGLE("R_DAC Switch", AIC32X4_LORROUTE, 3, 1, 0),
 168 };
 169
 170 static const struct snd_kcontrol_new left_input_mixer_controls[] = {
 171         SOC_DAPM_SINGLE("IN1_L P Switch", AIC32X4_LMICPGAPIN, 6, 1, 0),
 172         SOC_DAPM_SINGLE("IN2_L P Switch", AIC32X4_LMICPGAPIN, 4, 1, 0),
 173         SOC_DAPM_SINGLE("IN3_L P Switch", AIC32X4_LMICPGAPIN, 2, 1, 0),
 174 };
 175
 176 static const struct snd_kcontrol_new right_input_mixer_controls[] = {
 177         SOC_DAPM_SINGLE("IN1_R P Switch", AIC32X4_RMICPGAPIN, 6, 1, 0),
 178         SOC_DAPM_SINGLE("IN2_R P Switch", AIC32X4_RMICPGAPIN, 4, 1, 0),
 179         SOC_DAPM_SINGLE("IN3_R P Switch", AIC32X4_RMICPGAPIN, 2, 1, 0),
 180 };
 181
 182 static const struct snd_soc_dapm_widget aic32x4_dapm_widgets[] = {
 183         SND_SOC_DAPM_DAC("Left DAC", "Left Playback", AIC32X4_DACSETUP, 7, 0),
 184         SND_SOC_DAPM_MIXER("HPL Output Mixer", SND_SOC_NOPM, 0, 0,
 185                            &hpl_output_mixer_controls[0],
 186                            ARRAY_SIZE(hpl_output_mixer_controls)),
 187         SND_SOC_DAPM_PGA("HPL Power", AIC32X4_OUTPWRCTL, 5, 0, NULL, 0),
 188
 189         SND_SOC_DAPM_MIXER("LOL Output Mixer", SND_SOC_NOPM, 0, 0,
 190                            &lol_output_mixer_controls[0],
 191                            ARRAY_SIZE(lol_output_mixer_controls)),
 192         SND_SOC_DAPM_PGA("LOL Power", AIC32X4_OUTPWRCTL, 3, 0, NULL, 0),
 193
 194         SND_SOC_DAPM_DAC("Right DAC", "Right Playback", AIC32X4_DACSETUP, 6, 0),
 195         SND_SOC_DAPM_MIXER("HPR Output Mixer", SND_SOC_NOPM, 0, 0,
 196                            &hpr_output_mixer_controls[0],
 197                            ARRAY_SIZE(hpr_output_mixer_controls)),
 198         SND_SOC_DAPM_PGA("HPR Power", AIC32X4_OUTPWRCTL, 4, 0, NULL, 0),
 199         SND_SOC_DAPM_MIXER("LOR Output Mixer", SND_SOC_NOPM, 0, 0,
 200                            &lor_output_mixer_controls[0],
 201                            ARRAY_SIZE(lor_output_mixer_controls)),
 202         SND_SOC_DAPM_PGA("LOR Power", AIC32X4_OUTPWRCTL, 2, 0, NULL, 0),
 203         SND_SOC_DAPM_MIXER("Left Input Mixer", SND_SOC_NOPM, 0, 0,
 204                            &left_input_mixer_controls[0],
 205                            ARRAY_SIZE(left_input_mixer_controls)),
 206         SND_SOC_DAPM_MIXER("Right Input Mixer", SND_SOC_NOPM, 0, 0,
 207                            &right_input_mixer_controls[0],
 208                            ARRAY_SIZE(right_input_mixer_controls)),
 209         SND_SOC_DAPM_ADC("Left ADC", "Left Capture", AIC32X4_ADCSETUP, 7, 0),
 210         SND_SOC_DAPM_ADC("Right ADC", "Right Capture", AIC32X4_ADCSETUP, 6, 0),
 211         SND_SOC_DAPM_MICBIAS("Mic Bias", AIC32X4_MICBIAS, 6, 0),
 212
 213         SND_SOC_DAPM_OUTPUT("HPL"),
 214         SND_SOC_DAPM_OUTPUT("HPR"),
 215         SND_SOC_DAPM_OUTPUT("LOL"),
 216         SND_SOC_DAPM_OUTPUT("LOR"),
 217         SND_SOC_DAPM_INPUT("IN1_L"),
 218         SND_SOC_DAPM_INPUT("IN1_R"),
 219         SND_SOC_DAPM_INPUT("IN2_L"),
 220         SND_SOC_DAPM_INPUT("IN2_R"),
 221         SND_SOC_DAPM_INPUT("IN3_L"),
 222         SND_SOC_DAPM_INPUT("IN3_R"),
 223 };
 224
 225 static const struct snd_soc_dapm_route aic32x4_dapm_routes[] = {
 226         /* Left Output */
 227         {"HPL Output Mixer", "L_DAC Switch", "Left DAC"},
 228         {"HPL Output Mixer", "IN1_L Switch", "IN1_L"},
 229
 230         {"HPL Power", NULL, "HPL Output Mixer"},
 231         {"HPL", NULL, "HPL Power"},
 232
 233         {"LOL Output Mixer", "L_DAC Switch", "Left DAC"},
 234
 235         {"LOL Power", NULL, "LOL Output Mixer"},
 236         {"LOL", NULL, "LOL Power"},
 237
 238         /* Right Output */
 239         {"HPR Output Mixer", "R_DAC Switch", "Right DAC"},
 240         {"HPR Output Mixer", "IN1_R Switch", "IN1_R"},
 241
 242         {"HPR Power", NULL, "HPR Output Mixer"},
 243         {"HPR", NULL, "HPR Power"},
 244
 245         {"LOR Output Mixer", "R_DAC Switch", "Right DAC"},
 246
 247         {"LOR Power", NULL, "LOR Output Mixer"},
 248         {"LOR", NULL, "LOR Power"},
 249
 250         /* Left input */
 251         {"Left Input Mixer", "IN1_L P Switch", "IN1_L"},
 252         {"Left Input Mixer", "IN2_L P Switch", "IN2_L"},
 253         {"Left Input Mixer", "IN3_L P Switch", "IN3_L"},
 254
 255         {"Left ADC", NULL, "Left Input Mixer"},
 256
 257         /* Right Input */
 258         {"Right Input Mixer", "IN1_R P Switch", "IN1_R"},
 259         {"Right Input Mixer", "IN2_R P Switch", "IN2_R"},
 260         {"Right Input Mixer", "IN3_R P Switch", "IN3_R"},
 261
 262         {"Right ADC", NULL, "Right Input Mixer"},
 263 };
 264
 265 static inline int aic32x4_change_page(struct snd_soc_codec *codec,
 266                                         unsigned int new_page)
 267 {
 268         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
 269         u8 data[2];
 270         int ret;
 271
 272         data[0] = 0x00;
 273         data[1] = new_page & 0xff;
 274
 275         ret = codec->hw_write(codec->control_data, data, 2);
 276         if (ret == 2) {
 277                 aic32x4->page_no = new_page;
 278                 return 0;
 279         } else {
 280                 return ret;
 281         }
 282 }
 283
 284 static int aic32x4_write(struct snd_soc_codec *codec, unsigned int reg,
 285                                 unsigned int val)
 286 {
 287         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
 288         unsigned int page = reg / 128;
 289         unsigned int fixed_reg = reg % 128;
 290         u8 data[2];
 291         int ret;
 292
 293         /* A write to AIC32X4_PSEL is really a non-explicit page change */
 294         if (reg == AIC32X4_PSEL)
 295                 return aic32x4_change_page(codec, val);
 296
 297         if (aic32x4->page_no != page) {
 298                 ret = aic32x4_change_page(codec, page);
 299                 if (ret != 0)
 300                         return ret;
 301         }
 302
 303         data[0] = fixed_reg & 0xff;
 304         data[1] = val & 0xff;
 305
 306         if (codec->hw_write(codec->control_data, data, 2) == 2)
 307                 return 0;
 308         else
 309                 return -EIO;
 310 }
 311
 312 static unsigned int aic32x4_read(struct snd_soc_codec *codec, unsigned int reg)
 313 {
 314         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
 315         unsigned int page = reg / 128;
 316         unsigned int fixed_reg = reg % 128;
 317         int ret;
 318
 319         if (aic32x4->page_no != page) {
 320                 ret = aic32x4_change_page(codec, page);
 321                 if (ret != 0)
 322                         return ret;
 323         }
 324         return i2c_smbus_read_byte_data(codec->control_data, fixed_reg & 0xff);
 325 }
 326
 327 static inline int aic32x4_get_divs(int mclk, int rate)
 328 {
 329         int i;
 330
 331         for (i = 0; i < ARRAY_SIZE(aic32x4_divs); i++) {
 332                 if ((aic32x4_divs[i].rate == rate)
 333                     && (aic32x4_divs[i].mclk == mclk)) {
 334                         return i;
 335                 }
 336         }
 337         printk(KERN_ERR "aic32x4: master clock and sample rate is not supported\n");
 338         return -EINVAL;
 339 }
 340
 341 static int aic32x4_add_widgets(struct snd_soc_codec *codec)
 342 {
 343         snd_soc_dapm_new_controls(&codec->dapm, aic32x4_dapm_widgets,
 344                                   ARRAY_SIZE(aic32x4_dapm_widgets));
 345
 346         snd_soc_dapm_add_routes(&codec->dapm, aic32x4_dapm_routes,
 347                                 ARRAY_SIZE(aic32x4_dapm_routes));
 348
 349         snd_soc_dapm_new_widgets(&codec->dapm);
 350         return 0;
 351 }
 352
 353 static int aic32x4_set_dai_sysclk(struct snd_soc_dai *codec_dai,
 354                                   int clk_id, unsigned int freq, int dir)
 355 {
 356         struct snd_soc_codec *codec = codec_dai->codec;
 357         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
 358
 359         switch (freq) {
 360         case AIC32X4_FREQ_12000000:
 361         case AIC32X4_FREQ_24000000:
 362         case AIC32X4_FREQ_25000000:
 363                 aic32x4->sysclk = freq;
 364                 return 0;
 365         }
 366         printk(KERN_ERR "aic32x4: invalid frequency to set DAI system clock\n");
 367         return -EINVAL;
 368 }
 369
 370 static int aic32x4_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
 371 {
 372         struct snd_soc_codec *codec = codec_dai->codec;
 373         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
 374         u8 iface_reg_1;
 375         u8 iface_reg_2;
 376         u8 iface_reg_3;
 377
 378         iface_reg_1 = snd_soc_read(codec, AIC32X4_IFACE1);
 379         iface_reg_1 = iface_reg_1 & ~(3 << 6 | 3 << 2);
 380         iface_reg_2 = snd_soc_read(codec, AIC32X4_IFACE2);
 381         iface_reg_2 = 0;
 382         iface_reg_3 = snd_soc_read(codec, AIC32X4_IFACE3);
 383         iface_reg_3 = iface_reg_3 & ~(1 << 3);
 384
 385         /* set master/slave audio interface */
 386         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
 387         case SND_SOC_DAIFMT_CBM_CFM:
 388                 aic32x4->master = 1;
 389                 iface_reg_1 |= AIC32X4_BCLKMASTER | AIC32X4_WCLKMASTER;
 390                 break;
 391         case SND_SOC_DAIFMT_CBS_CFS:
 392                 aic32x4->master = 0;
 393                 break;
 394         default:
 395                 printk(KERN_ERR "aic32x4: invalid DAI master/slave interface\n");
 396                 return -EINVAL;
 397         }
 398
 399         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
 400         case SND_SOC_DAIFMT_I2S:
 401                 break;
 402         case SND_SOC_DAIFMT_DSP_A:
 403                 iface_reg_1 |= (AIC32X4_DSP_MODE << AIC32X4_PLLJ_SHIFT);
 404                 iface_reg_3 |= (1 << 3); /* invert bit clock */
 405                 iface_reg_2 = 0x01; /* add offset 1 */
 406                 break;
 407         case SND_SOC_DAIFMT_DSP_B:
 408                 iface_reg_1 |= (AIC32X4_DSP_MODE << AIC32X4_PLLJ_SHIFT);
 409                 iface_reg_3 |= (1 << 3); /* invert bit clock */
 410                 break;
 411         case SND_SOC_DAIFMT_RIGHT_J:
 412                 iface_reg_1 |=
 413                         (AIC32X4_RIGHT_JUSTIFIED_MODE << AIC32X4_PLLJ_SHIFT);
 414                 break;
 415         case SND_SOC_DAIFMT_LEFT_J:
 416                 iface_reg_1 |=
 417                         (AIC32X4_LEFT_JUSTIFIED_MODE << AIC32X4_PLLJ_SHIFT);
 418                 break;
 419         default:
 420                 printk(KERN_ERR "aic32x4: invalid DAI interface format\n");
 421                 return -EINVAL;
 422         }
 423
 424         snd_soc_write(codec, AIC32X4_IFACE1, iface_reg_1);
 425         snd_soc_write(codec, AIC32X4_IFACE2, iface_reg_2);
 426         snd_soc_write(codec, AIC32X4_IFACE3, iface_reg_3);
 427         return 0;
 428 }
 429
 430 static int aic32x4_hw_params(struct snd_pcm_substream *substream,
 431                              struct snd_pcm_hw_params *params,
 432                              struct snd_soc_dai *dai)
 433 {
 434         struct snd_soc_codec *codec = dai->codec;
 435         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
 436         u8 data;
 437         int i;
 438
 439         i = aic32x4_get_divs(aic32x4->sysclk, params_rate(params));
 440         if (i < 0) {
 441                 printk(KERN_ERR "aic32x4: sampling rate not supported\n");
 442                 return i;
 443         }
 444
 445         /* Use PLL as CODEC_CLKIN and DAC_MOD_CLK as BDIV_CLKIN */
 446         snd_soc_write(codec, AIC32X4_CLKMUX, AIC32X4_PLLCLKIN);
 447         snd_soc_write(codec, AIC32X4_IFACE3, AIC32X4_DACMOD2BCLK);
 448
 449         /* We will fix R value to 1 and will make P & J=K.D as varialble */
 450         data = snd_soc_read(codec, AIC32X4_PLLPR);
 451         data &= ~(7 << 4);
 452         snd_soc_write(codec, AIC32X4_PLLPR,
 453                       (data | (aic32x4_divs[i].p_val << 4) | 0x01));
 454
 455         snd_soc_write(codec, AIC32X4_PLLJ, aic32x4_divs[i].pll_j);
 456
 457         snd_soc_write(codec, AIC32X4_PLLDMSB, (aic32x4_divs[i].pll_d >> 8));
 458         snd_soc_write(codec, AIC32X4_PLLDLSB,
 459                       (aic32x4_divs[i].pll_d & 0xff));
 460
 461         /* NDAC divider value */
 462         data = snd_soc_read(codec, AIC32X4_NDAC);
 463         data &= ~(0x7f);
 464         snd_soc_write(codec, AIC32X4_NDAC, data | aic32x4_divs[i].ndac);
 465
 466         /* MDAC divider value */
 467         data = snd_soc_read(codec, AIC32X4_MDAC);
 468         data &= ~(0x7f);
 469         snd_soc_write(codec, AIC32X4_MDAC, data | aic32x4_divs[i].mdac);
 470
 471         /* DOSR MSB & LSB values */
 472         snd_soc_write(codec, AIC32X4_DOSRMSB, aic32x4_divs[i].dosr >> 8);
 473         snd_soc_write(codec, AIC32X4_DOSRLSB,
 474                       (aic32x4_divs[i].dosr & 0xff));
 475
 476         /* NADC divider value */
 477         data = snd_soc_read(codec, AIC32X4_NADC);
 478         data &= ~(0x7f);
 479         snd_soc_write(codec, AIC32X4_NADC, data | aic32x4_divs[i].nadc);
 480
 481         /* MADC divider value */
 482         data = snd_soc_read(codec, AIC32X4_MADC);
 483         data &= ~(0x7f);
 484         snd_soc_write(codec, AIC32X4_MADC, data | aic32x4_divs[i].madc);
 485
 486         /* AOSR value */
 487         snd_soc_write(codec, AIC32X4_AOSR, aic32x4_divs[i].aosr);
 488
 489         /* BCLK N divider */
 490         data = snd_soc_read(codec, AIC32X4_BCLKN);
 491         data &= ~(0x7f);
 492         snd_soc_write(codec, AIC32X4_BCLKN, data | aic32x4_divs[i].blck_N);
 493
 494         data = snd_soc_read(codec, AIC32X4_IFACE1);
 495         data = data & ~(3 << 4);
 496         switch (params_format(params)) {
 497         case SNDRV_PCM_FORMAT_S16_LE:
 498                 break;
 499         case SNDRV_PCM_FORMAT_S20_3LE:
 500                 data |= (AIC32X4_WORD_LEN_20BITS << AIC32X4_DOSRMSB_SHIFT);
 501                 break;
 502         case SNDRV_PCM_FORMAT_S24_LE:
 503                 data |= (AIC32X4_WORD_LEN_24BITS << AIC32X4_DOSRMSB_SHIFT);
 504                 break;
 505         case SNDRV_PCM_FORMAT_S32_LE:
 506                 data |= (AIC32X4_WORD_LEN_32BITS << AIC32X4_DOSRMSB_SHIFT);
 507                 break;
 508         }
 509         snd_soc_write(codec, AIC32X4_IFACE1, data);
 510
 511         return 0;
 512 }
 513
 514 static int aic32x4_mute(struct snd_soc_dai *dai, int mute)
 515 {
 516         struct snd_soc_codec *codec = dai->codec;
 517         u8 dac_reg;
 518
 519         dac_reg = snd_soc_read(codec, AIC32X4_DACMUTE) & ~AIC32X4_MUTEON;
 520         if (mute)
 521                 snd_soc_write(codec, AIC32X4_DACMUTE, dac_reg | AIC32X4_MUTEON);
 522         else
 523                 snd_soc_write(codec, AIC32X4_DACMUTE, dac_reg);
 524         return 0;
 525 }
 526
 527 static int aic32x4_set_bias_level(struct snd_soc_codec *codec,
 528                                   enum snd_soc_bias_level level)
 529 {
 530         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
 531         u8 value;
 532
 533         switch (level) {
 534         case SND_SOC_BIAS_ON:
 535                 if (aic32x4->master) {
 536                         /* Switch on PLL */
 537                         value = snd_soc_read(codec, AIC32X4_PLLPR);
 538                         snd_soc_write(codec, AIC32X4_PLLPR,
 539                                       (value | AIC32X4_PLLEN));
 540
 541                         /* Switch on NDAC Divider */
 542                         value = snd_soc_read(codec, AIC32X4_NDAC);
 543                         snd_soc_write(codec, AIC32X4_NDAC,
 544                                       value | AIC32X4_NDACEN);
 545
 546                         /* Switch on MDAC Divider */
 547                         value = snd_soc_read(codec, AIC32X4_MDAC);
 548                         snd_soc_write(codec, AIC32X4_MDAC,
 549                                       value | AIC32X4_MDACEN);
 550
 551                         /* Switch on NADC Divider */
 552                         value = snd_soc_read(codec, AIC32X4_NADC);
 553                         snd_soc_write(codec, AIC32X4_NADC,
 554                                       value | AIC32X4_MDACEN);
 555
 556                         /* Switch on MADC Divider */
 557                         value = snd_soc_read(codec, AIC32X4_MADC);
 558                         snd_soc_write(codec, AIC32X4_MADC,
 559                                       value | AIC32X4_MDACEN);
 560
 561                         /* Switch on BCLK_N Divider */
 562                         value = snd_soc_read(codec, AIC32X4_BCLKN);
 563                         snd_soc_write(codec, AIC32X4_BCLKN,
 564                                       value | AIC32X4_BCLKEN);
 565                 }
 566                 break;
 567         case SND_SOC_BIAS_PREPARE:
 568                 break;
 569         case SND_SOC_BIAS_STANDBY:
 570                 if (aic32x4->master) {
 571                         /* Switch off PLL */
 572                         value = snd_soc_read(codec, AIC32X4_PLLPR);
 573                         snd_soc_write(codec, AIC32X4_PLLPR,
 574                                       (value & ~AIC32X4_PLLEN));
 575
 576                         /* Switch off NDAC Divider */
 577                         value = snd_soc_read(codec, AIC32X4_NDAC);
 578                         snd_soc_write(codec, AIC32X4_NDAC,
 579                                       value & ~AIC32X4_NDACEN);
 580
 581                         /* Switch off MDAC Divider */
 582                         value = snd_soc_read(codec, AIC32X4_MDAC);
 583                         snd_soc_write(codec, AIC32X4_MDAC,
 584                                       value & ~AIC32X4_MDACEN);
 585
 586                         /* Switch off NADC Divider */
 587                         value = snd_soc_read(codec, AIC32X4_NADC);
 588                         snd_soc_write(codec, AIC32X4_NADC,
 589                                       value & ~AIC32X4_NDACEN);
 590
 591                         /* Switch off MADC Divider */
 592                         value = snd_soc_read(codec, AIC32X4_MADC);
 593                         snd_soc_write(codec, AIC32X4_MADC,
 594                                       value & ~AIC32X4_MDACEN);
 595                         value = snd_soc_read(codec, AIC32X4_BCLKN);
 596
 597                         /* Switch off BCLK_N Divider */
 598                         snd_soc_write(codec, AIC32X4_BCLKN,
 599                                       value & ~AIC32X4_BCLKEN);
 600                 }
 601                 break;
 602         case SND_SOC_BIAS_OFF:
 603                 break;
 604         }
 605         codec->dapm.bias_level = level;
 606         return 0;
 607 }
 608
 609 #define AIC32X4_RATES   SNDRV_PCM_RATE_8000_48000
 610 #define AIC32X4_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE \
 611                          | SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE)
 612
 613 static struct snd_soc_dai_ops aic32x4_ops = {
 614         .hw_params = aic32x4_hw_params,
 615         .digital_mute = aic32x4_mute,
 616         .set_fmt = aic32x4_set_dai_fmt,
 617         .set_sysclk = aic32x4_set_dai_sysclk,
 618 };
 619
 620 static struct snd_soc_dai_driver aic32x4_dai = {
 621         .name = "tlv320aic32x4-hifi",
 622         .playback = {
 623                      .stream_name = "Playback",
 624                      .channels_min = 1,
 625                      .channels_max = 2,
 626                      .rates = AIC32X4_RATES,
 627                      .formats = AIC32X4_FORMATS,},
 628         .capture = {
 629                     .stream_name = "Capture",
 630                     .channels_min = 1,
 631                     .channels_max = 2,
 632                     .rates = AIC32X4_RATES,
 633                     .formats = AIC32X4_FORMATS,},
 634         .ops = &aic32x4_ops,
 635         .symmetric_rates = 1,
 636 };
 637
 638 static int aic32x4_suspend(struct snd_soc_codec *codec, pm_message_t state)
 639 {
 640         aic32x4_set_bias_level(codec, SND_SOC_BIAS_OFF);
 641         return 0;
 642 }
 643
 644 static int aic32x4_resume(struct snd_soc_codec *codec)
 645 {
 646         aic32x4_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
 647         return 0;
 648 }
 649
 650 static int aic32x4_probe(struct snd_soc_codec *codec)
 651 {
 652         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
 653         u32 tmp_reg;
 654
 655         codec->hw_write = (hw_write_t) i2c_master_send;
 656         codec->control_data = aic32x4->control_data;
 657
 658         snd_soc_write(codec, AIC32X4_RESET, 0x01);
 659
 660         /* Power platform configuration */
 661         if (aic32x4->power_cfg & AIC32X4_PWR_MICBIAS_2075_LDOIN) {
 662                 snd_soc_write(codec, AIC32X4_MICBIAS, AIC32X4_MICBIAS_LDOIN |
 663                                                       AIC32X4_MICBIAS_2075V);
 664         }
 665         if (aic32x4->power_cfg & AIC32X4_PWR_AVDD_DVDD_WEAK_DISABLE) {
 666                 snd_soc_write(codec, AIC32X4_PWRCFG, AIC32X4_AVDDWEAKDISABLE);
 667         }
 668         if (aic32x4->power_cfg & AIC32X4_PWR_AIC32X4_LDO_ENABLE) {
 669                 snd_soc_write(codec, AIC32X4_LDOCTL, AIC32X4_LDOCTLEN);
 670         }
 671         tmp_reg = snd_soc_read(codec, AIC32X4_CMMODE);
 672         if (aic32x4->power_cfg & AIC32X4_PWR_CMMODE_LDOIN_RANGE_18_36) {
 673                 tmp_reg |= AIC32X4_LDOIN_18_36;
 674         }
 675         if (aic32x4->power_cfg & AIC32X4_PWR_CMMODE_HP_LDOIN_POWERED) {
 676                 tmp_reg |= AIC32X4_LDOIN2HP;
 677         }
 678         snd_soc_write(codec, AIC32X4_CMMODE, tmp_reg);
 679
 680         /* Do DACs need to be swapped? */
 681         if (aic32x4->swapdacs) {
 682                 snd_soc_write(codec, AIC32X4_DACSETUP, AIC32X4_LDAC2RCHN | AIC32X4_RDAC2LCHN);
 683         } else {
 684                 snd_soc_write(codec, AIC32X4_DACSETUP, AIC32X4_LDAC2LCHN | AIC32X4_RDAC2RCHN);
 685         }
 686
 687         /* Mic PGA routing */
 688         if (aic32x4->micpga_routing | AIC32X4_MICPGA_ROUTE_LMIC_IN2R_10K) {
 689                 snd_soc_write(codec, AIC32X4_LMICPGANIN, AIC32X4_LMICPGANIN_IN2R_10K);
 690         }
 691         if (aic32x4->micpga_routing | AIC32X4_MICPGA_ROUTE_RMIC_IN1L_10K) {
 692                 snd_soc_write(codec, AIC32X4_RMICPGANIN, AIC32X4_RMICPGANIN_IN1L_10K);
 693         }
 694
 695         aic32x4_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
 696         snd_soc_add_controls(codec, aic32x4_snd_controls,
 697                              ARRAY_SIZE(aic32x4_snd_controls));
 698         aic32x4_add_widgets(codec);
 699
 700         return 0;
 701 }
 702
 703 static int aic32x4_remove(struct snd_soc_codec *codec)
 704 {
 705         aic32x4_set_bias_level(codec, SND_SOC_BIAS_OFF);
 706         return 0;
 707 }
 708
 709 static struct snd_soc_codec_driver soc_codec_dev_aic32x4 = {
 710         .read = aic32x4_read,
 711         .write = aic32x4_write,
 712         .probe = aic32x4_probe,
 713         .remove = aic32x4_remove,
 714         .suspend = aic32x4_suspend,
 715         .resume = aic32x4_resume,
 716         .set_bias_level = aic32x4_set_bias_level,
 717 };
 718
 719 static __devinit int aic32x4_i2c_probe(struct i2c_client *i2c,
 720                                       const struct i2c_device_id *id)
 721 {
 722         struct aic32x4_pdata *pdata = i2c->dev.platform_data;
 723         struct aic32x4_priv *aic32x4;
 724         int ret;
 725
 726         aic32x4 = kzalloc(sizeof(struct aic32x4_priv), GFP_KERNEL);
 727         if (aic32x4 == NULL)
 728                 return -ENOMEM;
 729
 730         aic32x4->control_data = i2c;
 731         i2c_set_clientdata(i2c, aic32x4);
 732
 733         if (pdata) {
 734                 aic32x4->power_cfg = pdata->power_cfg;
 735                 aic32x4->swapdacs = pdata->swapdacs;
 736                 aic32x4->micpga_routing = pdata->micpga_routing;
 737         } else {
 738                 aic32x4->power_cfg = 0;
 739                 aic32x4->swapdacs = false;
 740                 aic32x4->micpga_routing = 0;
 741         }
 742
 743         ret = snd_soc_register_codec(&i2c->dev,
 744                         &soc_codec_dev_aic32x4, &aic32x4_dai, 1);
 745         if (ret < 0)
 746                 kfree(aic32x4);
 747         return ret;
 748 }
 749
 750 static __devexit int aic32x4_i2c_remove(struct i2c_client *client)
 751 {
 752         snd_soc_unregister_codec(&client->dev);
 753         kfree(i2c_get_clientdata(client));
 754         return 0;
 755 }
 756
 757 static const struct i2c_device_id aic32x4_i2c_id[] = {
 758         { "tlv320aic32x4", 0 },
 759         { }
 760 };
 761 MODULE_DEVICE_TABLE(i2c, aic32x4_i2c_id);
 762
 763 static struct i2c_driver aic32x4_i2c_driver = {
 764         .driver = {
 765                 .name = "tlv320aic32x4",
 766                 .owner = THIS_MODULE,
 767         },
 768         .probe =    aic32x4_i2c_probe,
 769         .remove =   __devexit_p(aic32x4_i2c_remove),
 770         .id_table = aic32x4_i2c_id,
 771 };
 772
 773 static int __init aic32x4_modinit(void)
 774 {
 775         int ret = 0;
 776
 777         ret = i2c_add_driver(&aic32x4_i2c_driver);
 778         if (ret != 0) {
 779                 printk(KERN_ERR "Failed to register aic32x4 I2C driver: %d\n",
 780                        ret);
 781         }
 782         return ret;
 783 }
 784 module_init(aic32x4_modinit);
 785
 786 static void __exit aic32x4_exit(void)
 787 {
 788         i2c_del_driver(&aic32x4_i2c_driver);
 789 }
 790 module_exit(aic32x4_exit);
 791
 792 MODULE_DESCRIPTION("ASoC tlv320aic32x4 codec driver");
 793 MODULE_AUTHOR("Javier Martin <javier.martin@vista-silicon.com>");
 794 MODULE_LICENSE("GPL");