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/gpio.h>
  32 #include <linux/of_gpio.h>
  33 #include <linux/i2c.h>
  34 #include <linux/cdev.h>
  35 #include <linux/slab.h>
  36 #include <linux/clk.h>
  37 #include <linux/regulator/consumer.h>
  38
  39 #include <sound/tlv320aic32x4.h>
  40 #include <sound/core.h>
  41 #include <sound/pcm.h>
  42 #include <sound/pcm_params.h>
  43 #include <sound/soc.h>
  44 #include <sound/soc-dapm.h>
  45 #include <sound/initval.h>
  46 #include <sound/tlv.h>
  47
  48 #include "tlv320aic32x4.h"
  49
  50 struct aic32x4_rate_divs {
  51         u32 mclk;
  52         u32 rate;
  53         u8 p_val;
  54         u8 pll_j;
  55         u16 pll_d;
  56         u16 dosr;
  57         u8 ndac;
  58         u8 mdac;
  59         u8 aosr;
  60         u8 nadc;
  61         u8 madc;
  62         u8 blck_N;
  63 };
  64
  65 struct aic32x4_priv {
  66         struct regmap *regmap;
  67         u32 sysclk;
  68         u32 power_cfg;
  69         u32 micpga_routing;
  70         bool swapdacs;
  71         int rstn_gpio;
  72         struct clk *mclk;
  73
  74         struct regulator *supply_ldo;
  75         struct regulator *supply_iov;
  76         struct regulator *supply_dv;
  77         struct regulator *supply_av;
  78 };
  79
  80 /* 0dB min, 0.5dB steps */
  81 static DECLARE_TLV_DB_SCALE(tlv_step_0_5, 0, 50, 0);
  82 /* -63.5dB min, 0.5dB steps */
  83 static DECLARE_TLV_DB_SCALE(tlv_pcm, -6350, 50, 0);
  84 /* -6dB min, 1dB steps */
  85 static DECLARE_TLV_DB_SCALE(tlv_driver_gain, -600, 100, 0);
  86 /* -12dB min, 0.5dB steps */
  87 static DECLARE_TLV_DB_SCALE(tlv_adc_vol, -1200, 50, 0);
  88
  89 static const struct snd_kcontrol_new aic32x4_snd_controls[] = {
  90         SOC_DOUBLE_R_S_TLV("PCM Playback Volume", AIC32X4_LDACVOL,
  91                         AIC32X4_RDACVOL, 0, -0x7f, 0x30, 7, 0, tlv_pcm),
  92         SOC_DOUBLE_R_S_TLV("HP Driver Gain Volume", AIC32X4_HPLGAIN,
  93                         AIC32X4_HPRGAIN, 0, -0x6, 0x1d, 5, 0,
  94                         tlv_driver_gain),
  95         SOC_DOUBLE_R_S_TLV("LO Driver Gain Volume", AIC32X4_LOLGAIN,
  96                         AIC32X4_LORGAIN, 0, -0x6, 0x1d, 5, 0,
  97                         tlv_driver_gain),
  98         SOC_DOUBLE_R("HP DAC Playback Switch", AIC32X4_HPLGAIN,
  99                         AIC32X4_HPRGAIN, 6, 0x01, 1),
 100         SOC_DOUBLE_R("LO DAC Playback Switch", AIC32X4_LOLGAIN,
 101                         AIC32X4_LORGAIN, 6, 0x01, 1),
 102         SOC_DOUBLE_R("Mic PGA Switch", AIC32X4_LMICPGAVOL,
 103                         AIC32X4_RMICPGAVOL, 7, 0x01, 1),
 104
 105         SOC_SINGLE("ADCFGA Left Mute Switch", AIC32X4_ADCFGA, 7, 1, 0),
 106         SOC_SINGLE("ADCFGA Right Mute Switch", AIC32X4_ADCFGA, 3, 1, 0),
 107
 108         SOC_DOUBLE_R_S_TLV("ADC Level Volume", AIC32X4_LADCVOL,
 109                         AIC32X4_RADCVOL, 0, -0x18, 0x28, 6, 0, tlv_adc_vol),
 110         SOC_DOUBLE_R_TLV("PGA Level Volume", AIC32X4_LMICPGAVOL,
 111                         AIC32X4_RMICPGAVOL, 0, 0x5f, 0, tlv_step_0_5),
 112
 113         SOC_SINGLE("Auto-mute Switch", AIC32X4_DACMUTE, 4, 7, 0),
 114
 115         SOC_SINGLE("AGC Left Switch", AIC32X4_LAGC1, 7, 1, 0),
 116         SOC_SINGLE("AGC Right Switch", AIC32X4_RAGC1, 7, 1, 0),
 117         SOC_DOUBLE_R("AGC Target Level", AIC32X4_LAGC1, AIC32X4_RAGC1,
 118                         4, 0x07, 0),
 119         SOC_DOUBLE_R("AGC Gain Hysteresis", AIC32X4_LAGC1, AIC32X4_RAGC1,
 120                         0, 0x03, 0),
 121         SOC_DOUBLE_R("AGC Hysteresis", AIC32X4_LAGC2, AIC32X4_RAGC2,
 122                         6, 0x03, 0),
 123         SOC_DOUBLE_R("AGC Noise Threshold", AIC32X4_LAGC2, AIC32X4_RAGC2,
 124                         1, 0x1F, 0),
 125         SOC_DOUBLE_R("AGC Max PGA", AIC32X4_LAGC3, AIC32X4_RAGC3,
 126                         0, 0x7F, 0),
 127         SOC_DOUBLE_R("AGC Attack Time", AIC32X4_LAGC4, AIC32X4_RAGC4,
 128                         3, 0x1F, 0),
 129         SOC_DOUBLE_R("AGC Decay Time", AIC32X4_LAGC5, AIC32X4_RAGC5,
 130                         3, 0x1F, 0),
 131         SOC_DOUBLE_R("AGC Noise Debounce", AIC32X4_LAGC6, AIC32X4_RAGC6,
 132                         0, 0x1F, 0),
 133         SOC_DOUBLE_R("AGC Signal Debounce", AIC32X4_LAGC7, AIC32X4_RAGC7,
 134                         0, 0x0F, 0),
 135 };
 136
 137 static const struct aic32x4_rate_divs aic32x4_divs[] = {
 138         /* 8k rate */
 139         {AIC32X4_FREQ_12000000, 8000, 1, 7, 6800, 768, 5, 3, 128, 5, 18, 24},
 140         {AIC32X4_FREQ_24000000, 8000, 2, 7, 6800, 768, 15, 1, 64, 45, 4, 24},
 141         {AIC32X4_FREQ_25000000, 8000, 2, 7, 3728, 768, 15, 1, 64, 45, 4, 24},
 142         /* 11.025k rate */
 143         {AIC32X4_FREQ_12000000, 11025, 1, 7, 5264, 512, 8, 2, 128, 8, 8, 16},
 144         {AIC32X4_FREQ_24000000, 11025, 2, 7, 5264, 512, 16, 1, 64, 32, 4, 16},
 145         /* 16k rate */
 146         {AIC32X4_FREQ_12000000, 16000, 1, 7, 6800, 384, 5, 3, 128, 5, 9, 12},
 147         {AIC32X4_FREQ_24000000, 16000, 2, 7, 6800, 384, 15, 1, 64, 18, 5, 12},
 148         {AIC32X4_FREQ_25000000, 16000, 2, 7, 3728, 384, 15, 1, 64, 18, 5, 12},
 149         /* 22.05k rate */
 150         {AIC32X4_FREQ_12000000, 22050, 1, 7, 5264, 256, 4, 4, 128, 4, 8, 8},
 151         {AIC32X4_FREQ_24000000, 22050, 2, 7, 5264, 256, 16, 1, 64, 16, 4, 8},
 152         {AIC32X4_FREQ_25000000, 22050, 2, 7, 2253, 256, 16, 1, 64, 16, 4, 8},
 153         /* 32k rate */
 154         {AIC32X4_FREQ_12000000, 32000, 1, 7, 1680, 192, 2, 7, 64, 2, 21, 6},
 155         {AIC32X4_FREQ_24000000, 32000, 2, 7, 1680, 192, 7, 2, 64, 7, 6, 6},
 156         /* 44.1k rate */
 157         {AIC32X4_FREQ_12000000, 44100, 1, 7, 5264, 128, 2, 8, 128, 2, 8, 4},
 158         {AIC32X4_FREQ_24000000, 44100, 2, 7, 5264, 128, 8, 2, 64, 8, 4, 4},
 159         {AIC32X4_FREQ_25000000, 44100, 2, 7, 2253, 128, 8, 2, 64, 8, 4, 4},
 160         /* 48k rate */
 161         {AIC32X4_FREQ_12000000, 48000, 1, 8, 1920, 128, 2, 8, 128, 2, 8, 4},
 162         {AIC32X4_FREQ_24000000, 48000, 2, 8, 1920, 128, 8, 2, 64, 8, 4, 4},
 163         {AIC32X4_FREQ_25000000, 48000, 2, 7, 8643, 128, 8, 2, 64, 8, 4, 4}
 164 };
 165
 166 static const struct snd_kcontrol_new hpl_output_mixer_controls[] = {
 167         SOC_DAPM_SINGLE("L_DAC Switch", AIC32X4_HPLROUTE, 3, 1, 0),
 168         SOC_DAPM_SINGLE("IN1_L Switch", AIC32X4_HPLROUTE, 2, 1, 0),
 169 };
 170
 171 static const struct snd_kcontrol_new hpr_output_mixer_controls[] = {
 172         SOC_DAPM_SINGLE("R_DAC Switch", AIC32X4_HPRROUTE, 3, 1, 0),
 173         SOC_DAPM_SINGLE("IN1_R Switch", AIC32X4_HPRROUTE, 2, 1, 0),
 174 };
 175
 176 static const struct snd_kcontrol_new lol_output_mixer_controls[] = {
 177         SOC_DAPM_SINGLE("L_DAC Switch", AIC32X4_LOLROUTE, 3, 1, 0),
 178 };
 179
 180 static const struct snd_kcontrol_new lor_output_mixer_controls[] = {
 181         SOC_DAPM_SINGLE("R_DAC Switch", AIC32X4_LORROUTE, 3, 1, 0),
 182 };
 183
 184 static const struct snd_kcontrol_new left_input_mixer_controls[] = {
 185         SOC_DAPM_SINGLE("IN1_L P Switch", AIC32X4_LMICPGAPIN, 6, 1, 0),
 186         SOC_DAPM_SINGLE("IN2_L P Switch", AIC32X4_LMICPGAPIN, 4, 1, 0),
 187         SOC_DAPM_SINGLE("IN3_L P Switch", AIC32X4_LMICPGAPIN, 2, 1, 0),
 188 };
 189
 190 static const struct snd_kcontrol_new right_input_mixer_controls[] = {
 191         SOC_DAPM_SINGLE("IN1_R P Switch", AIC32X4_RMICPGAPIN, 6, 1, 0),
 192         SOC_DAPM_SINGLE("IN2_R P Switch", AIC32X4_RMICPGAPIN, 4, 1, 0),
 193         SOC_DAPM_SINGLE("IN3_R P Switch", AIC32X4_RMICPGAPIN, 2, 1, 0),
 194 };
 195
 196 static const struct snd_soc_dapm_widget aic32x4_dapm_widgets[] = {
 197         SND_SOC_DAPM_DAC("Left DAC", "Left Playback", AIC32X4_DACSETUP, 7, 0),
 198         SND_SOC_DAPM_MIXER("HPL Output Mixer", SND_SOC_NOPM, 0, 0,
 199                            &hpl_output_mixer_controls[0],
 200                            ARRAY_SIZE(hpl_output_mixer_controls)),
 201         SND_SOC_DAPM_PGA("HPL Power", AIC32X4_OUTPWRCTL, 5, 0, NULL, 0),
 202
 203         SND_SOC_DAPM_MIXER("LOL Output Mixer", SND_SOC_NOPM, 0, 0,
 204                            &lol_output_mixer_controls[0],
 205                            ARRAY_SIZE(lol_output_mixer_controls)),
 206         SND_SOC_DAPM_PGA("LOL Power", AIC32X4_OUTPWRCTL, 3, 0, NULL, 0),
 207
 208         SND_SOC_DAPM_DAC("Right DAC", "Right Playback", AIC32X4_DACSETUP, 6, 0),
 209         SND_SOC_DAPM_MIXER("HPR Output Mixer", SND_SOC_NOPM, 0, 0,
 210                            &hpr_output_mixer_controls[0],
 211                            ARRAY_SIZE(hpr_output_mixer_controls)),
 212         SND_SOC_DAPM_PGA("HPR Power", AIC32X4_OUTPWRCTL, 4, 0, NULL, 0),
 213         SND_SOC_DAPM_MIXER("LOR Output Mixer", SND_SOC_NOPM, 0, 0,
 214                            &lor_output_mixer_controls[0],
 215                            ARRAY_SIZE(lor_output_mixer_controls)),
 216         SND_SOC_DAPM_PGA("LOR Power", AIC32X4_OUTPWRCTL, 2, 0, NULL, 0),
 217         SND_SOC_DAPM_MIXER("Left Input Mixer", SND_SOC_NOPM, 0, 0,
 218                            &left_input_mixer_controls[0],
 219                            ARRAY_SIZE(left_input_mixer_controls)),
 220         SND_SOC_DAPM_MIXER("Right Input Mixer", SND_SOC_NOPM, 0, 0,
 221                            &right_input_mixer_controls[0],
 222                            ARRAY_SIZE(right_input_mixer_controls)),
 223         SND_SOC_DAPM_ADC("Left ADC", "Left Capture", AIC32X4_ADCSETUP, 7, 0),
 224         SND_SOC_DAPM_ADC("Right ADC", "Right Capture", AIC32X4_ADCSETUP, 6, 0),
 225         SND_SOC_DAPM_MICBIAS("Mic Bias", AIC32X4_MICBIAS, 6, 0),
 226
 227         SND_SOC_DAPM_OUTPUT("HPL"),
 228         SND_SOC_DAPM_OUTPUT("HPR"),
 229         SND_SOC_DAPM_OUTPUT("LOL"),
 230         SND_SOC_DAPM_OUTPUT("LOR"),
 231         SND_SOC_DAPM_INPUT("IN1_L"),
 232         SND_SOC_DAPM_INPUT("IN1_R"),
 233         SND_SOC_DAPM_INPUT("IN2_L"),
 234         SND_SOC_DAPM_INPUT("IN2_R"),
 235         SND_SOC_DAPM_INPUT("IN3_L"),
 236         SND_SOC_DAPM_INPUT("IN3_R"),
 237 };
 238
 239 static const struct snd_soc_dapm_route aic32x4_dapm_routes[] = {
 240         /* Left Output */
 241         {"HPL Output Mixer", "L_DAC Switch", "Left DAC"},
 242         {"HPL Output Mixer", "IN1_L Switch", "IN1_L"},
 243
 244         {"HPL Power", NULL, "HPL Output Mixer"},
 245         {"HPL", NULL, "HPL Power"},
 246
 247         {"LOL Output Mixer", "L_DAC Switch", "Left DAC"},
 248
 249         {"LOL Power", NULL, "LOL Output Mixer"},
 250         {"LOL", NULL, "LOL Power"},
 251
 252         /* Right Output */
 253         {"HPR Output Mixer", "R_DAC Switch", "Right DAC"},
 254         {"HPR Output Mixer", "IN1_R Switch", "IN1_R"},
 255
 256         {"HPR Power", NULL, "HPR Output Mixer"},
 257         {"HPR", NULL, "HPR Power"},
 258
 259         {"LOR Output Mixer", "R_DAC Switch", "Right DAC"},
 260
 261         {"LOR Power", NULL, "LOR Output Mixer"},
 262         {"LOR", NULL, "LOR Power"},
 263
 264         /* Left input */
 265         {"Left Input Mixer", "IN1_L P Switch", "IN1_L"},
 266         {"Left Input Mixer", "IN2_L P Switch", "IN2_L"},
 267         {"Left Input Mixer", "IN3_L P Switch", "IN3_L"},
 268
 269         {"Left ADC", NULL, "Left Input Mixer"},
 270
 271         /* Right Input */
 272         {"Right Input Mixer", "IN1_R P Switch", "IN1_R"},
 273         {"Right Input Mixer", "IN2_R P Switch", "IN2_R"},
 274         {"Right Input Mixer", "IN3_R P Switch", "IN3_R"},
 275
 276         {"Right ADC", NULL, "Right Input Mixer"},
 277 };
 278
 279 static const struct regmap_range_cfg aic32x4_regmap_pages[] = {
 280         {
 281                 .selector_reg = 0,
 282                 .selector_mask  = 0xff,
 283                 .window_start = 0,
 284                 .window_len = 128,
 285                 .range_min = 0,
 286                 .range_max = AIC32X4_RMICPGAVOL,
 287         },
 288 };
 289
 290 static const struct regmap_config aic32x4_regmap = {
 291         .reg_bits = 8,
 292         .val_bits = 8,
 293
 294         .max_register = AIC32X4_RMICPGAVOL,
 295         .ranges = aic32x4_regmap_pages,
 296         .num_ranges = ARRAY_SIZE(aic32x4_regmap_pages),
 297 };
 298
 299 static inline int aic32x4_get_divs(int mclk, int rate)
 300 {
 301         int i;
 302
 303         for (i = 0; i < ARRAY_SIZE(aic32x4_divs); i++) {
 304                 if ((aic32x4_divs[i].rate == rate)
 305                     && (aic32x4_divs[i].mclk == mclk)) {
 306                         return i;
 307                 }
 308         }
 309         printk(KERN_ERR "aic32x4: master clock and sample rate is not supported\n");
 310         return -EINVAL;
 311 }
 312
 313 static int aic32x4_set_dai_sysclk(struct snd_soc_dai *codec_dai,
 314                                   int clk_id, unsigned int freq, int dir)
 315 {
 316         struct snd_soc_codec *codec = codec_dai->codec;
 317         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
 318
 319         switch (freq) {
 320         case AIC32X4_FREQ_12000000:
 321         case AIC32X4_FREQ_24000000:
 322         case AIC32X4_FREQ_25000000:
 323                 aic32x4->sysclk = freq;
 324                 return 0;
 325         }
 326         printk(KERN_ERR "aic32x4: invalid frequency to set DAI system clock\n");
 327         return -EINVAL;
 328 }
 329
 330 static int aic32x4_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
 331 {
 332         struct snd_soc_codec *codec = codec_dai->codec;
 333         u8 iface_reg_1;
 334         u8 iface_reg_2;
 335         u8 iface_reg_3;
 336
 337         iface_reg_1 = snd_soc_read(codec, AIC32X4_IFACE1);
 338         iface_reg_1 = iface_reg_1 & ~(3 << 6 | 3 << 2);
 339         iface_reg_2 = snd_soc_read(codec, AIC32X4_IFACE2);
 340         iface_reg_2 = 0;
 341         iface_reg_3 = snd_soc_read(codec, AIC32X4_IFACE3);
 342         iface_reg_3 = iface_reg_3 & ~(1 << 3);
 343
 344         /* set master/slave audio interface */
 345         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
 346         case SND_SOC_DAIFMT_CBM_CFM:
 347                 iface_reg_1 |= AIC32X4_BCLKMASTER | AIC32X4_WCLKMASTER;
 348                 break;
 349         case SND_SOC_DAIFMT_CBS_CFS:
 350                 break;
 351         default:
 352                 printk(KERN_ERR "aic32x4: invalid DAI master/slave interface\n");
 353                 return -EINVAL;
 354         }
 355
 356         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
 357         case SND_SOC_DAIFMT_I2S:
 358                 break;
 359         case SND_SOC_DAIFMT_DSP_A:
 360                 iface_reg_1 |= (AIC32X4_DSP_MODE << AIC32X4_PLLJ_SHIFT);
 361                 iface_reg_3 |= (1 << 3); /* invert bit clock */
 362                 iface_reg_2 = 0x01; /* add offset 1 */
 363                 break;
 364         case SND_SOC_DAIFMT_DSP_B:
 365                 iface_reg_1 |= (AIC32X4_DSP_MODE << AIC32X4_PLLJ_SHIFT);
 366                 iface_reg_3 |= (1 << 3); /* invert bit clock */
 367                 break;
 368         case SND_SOC_DAIFMT_RIGHT_J:
 369                 iface_reg_1 |=
 370                         (AIC32X4_RIGHT_JUSTIFIED_MODE << AIC32X4_PLLJ_SHIFT);
 371                 break;
 372         case SND_SOC_DAIFMT_LEFT_J:
 373                 iface_reg_1 |=
 374                         (AIC32X4_LEFT_JUSTIFIED_MODE << AIC32X4_PLLJ_SHIFT);
 375                 break;
 376         default:
 377                 printk(KERN_ERR "aic32x4: invalid DAI interface format\n");
 378                 return -EINVAL;
 379         }
 380
 381         snd_soc_write(codec, AIC32X4_IFACE1, iface_reg_1);
 382         snd_soc_write(codec, AIC32X4_IFACE2, iface_reg_2);
 383         snd_soc_write(codec, AIC32X4_IFACE3, iface_reg_3);
 384         return 0;
 385 }
 386
 387 static int aic32x4_hw_params(struct snd_pcm_substream *substream,
 388                              struct snd_pcm_hw_params *params,
 389                              struct snd_soc_dai *dai)
 390 {
 391         struct snd_soc_codec *codec = dai->codec;
 392         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
 393         u8 data;
 394         int i;
 395
 396         i = aic32x4_get_divs(aic32x4->sysclk, params_rate(params));
 397         if (i < 0) {
 398                 printk(KERN_ERR "aic32x4: sampling rate not supported\n");
 399                 return i;
 400         }
 401
 402         /* Use PLL as CODEC_CLKIN and DAC_MOD_CLK as BDIV_CLKIN */
 403         snd_soc_write(codec, AIC32X4_CLKMUX, AIC32X4_PLLCLKIN);
 404         snd_soc_write(codec, AIC32X4_IFACE3, AIC32X4_DACMOD2BCLK);
 405
 406         /* We will fix R value to 1 and will make P & J=K.D as varialble */
 407         data = snd_soc_read(codec, AIC32X4_PLLPR);
 408         data &= ~(7 << 4);
 409         snd_soc_write(codec, AIC32X4_PLLPR,
 410                       (data | (aic32x4_divs[i].p_val << 4) | 0x01));
 411
 412         snd_soc_write(codec, AIC32X4_PLLJ, aic32x4_divs[i].pll_j);
 413
 414         snd_soc_write(codec, AIC32X4_PLLDMSB, (aic32x4_divs[i].pll_d >> 8));
 415         snd_soc_write(codec, AIC32X4_PLLDLSB,
 416                       (aic32x4_divs[i].pll_d & 0xff));
 417
 418         /* NDAC divider value */
 419         data = snd_soc_read(codec, AIC32X4_NDAC);
 420         data &= ~(0x7f);
 421         snd_soc_write(codec, AIC32X4_NDAC, data | aic32x4_divs[i].ndac);
 422
 423         /* MDAC divider value */
 424         data = snd_soc_read(codec, AIC32X4_MDAC);
 425         data &= ~(0x7f);
 426         snd_soc_write(codec, AIC32X4_MDAC, data | aic32x4_divs[i].mdac);
 427
 428         /* DOSR MSB & LSB values */
 429         snd_soc_write(codec, AIC32X4_DOSRMSB, aic32x4_divs[i].dosr >> 8);
 430         snd_soc_write(codec, AIC32X4_DOSRLSB,
 431                       (aic32x4_divs[i].dosr & 0xff));
 432
 433         /* NADC divider value */
 434         data = snd_soc_read(codec, AIC32X4_NADC);
 435         data &= ~(0x7f);
 436         snd_soc_write(codec, AIC32X4_NADC, data | aic32x4_divs[i].nadc);
 437
 438         /* MADC divider value */
 439         data = snd_soc_read(codec, AIC32X4_MADC);
 440         data &= ~(0x7f);
 441         snd_soc_write(codec, AIC32X4_MADC, data | aic32x4_divs[i].madc);
 442
 443         /* AOSR value */
 444         snd_soc_write(codec, AIC32X4_AOSR, aic32x4_divs[i].aosr);
 445
 446         /* BCLK N divider */
 447         data = snd_soc_read(codec, AIC32X4_BCLKN);
 448         data &= ~(0x7f);
 449         snd_soc_write(codec, AIC32X4_BCLKN, data | aic32x4_divs[i].blck_N);
 450
 451         data = snd_soc_read(codec, AIC32X4_IFACE1);
 452         data = data & ~(3 << 4);
 453         switch (params_width(params)) {
 454         case 16:
 455                 break;
 456         case 20:
 457                 data |= (AIC32X4_WORD_LEN_20BITS << AIC32X4_DOSRMSB_SHIFT);
 458                 break;
 459         case 24:
 460                 data |= (AIC32X4_WORD_LEN_24BITS << AIC32X4_DOSRMSB_SHIFT);
 461                 break;
 462         case 32:
 463                 data |= (AIC32X4_WORD_LEN_32BITS << AIC32X4_DOSRMSB_SHIFT);
 464                 break;
 465         }
 466         snd_soc_write(codec, AIC32X4_IFACE1, data);
 467
 468         if (params_channels(params) == 1) {
 469                 data = AIC32X4_RDAC2LCHN | AIC32X4_LDAC2LCHN;
 470         } else {
 471                 if (aic32x4->swapdacs)
 472                         data = AIC32X4_RDAC2LCHN | AIC32X4_LDAC2RCHN;
 473                 else
 474                         data = AIC32X4_LDAC2LCHN | AIC32X4_RDAC2RCHN;
 475         }
 476         snd_soc_update_bits(codec, AIC32X4_DACSETUP, AIC32X4_DAC_CHAN_MASK,
 477                         data);
 478
 479         return 0;
 480 }
 481
 482 static int aic32x4_mute(struct snd_soc_dai *dai, int mute)
 483 {
 484         struct snd_soc_codec *codec = dai->codec;
 485         u8 dac_reg;
 486
 487         dac_reg = snd_soc_read(codec, AIC32X4_DACMUTE) & ~AIC32X4_MUTEON;
 488         if (mute)
 489                 snd_soc_write(codec, AIC32X4_DACMUTE, dac_reg | AIC32X4_MUTEON);
 490         else
 491                 snd_soc_write(codec, AIC32X4_DACMUTE, dac_reg);
 492         return 0;
 493 }
 494
 495 static int aic32x4_set_bias_level(struct snd_soc_codec *codec,
 496                                   enum snd_soc_bias_level level)
 497 {
 498         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
 499         int ret;
 500
 501         switch (level) {
 502         case SND_SOC_BIAS_ON:
 503                 /* Switch on master clock */
 504                 ret = clk_prepare_enable(aic32x4->mclk);
 505                 if (ret) {
 506                         dev_err(codec->dev, "Failed to enable master clock\n");
 507                         return ret;
 508                 }
 509
 510                 /* Switch on PLL */
 511                 snd_soc_update_bits(codec, AIC32X4_PLLPR,
 512                                     AIC32X4_PLLEN, AIC32X4_PLLEN);
 513
 514                 /* Switch on NDAC Divider */
 515                 snd_soc_update_bits(codec, AIC32X4_NDAC,
 516                                     AIC32X4_NDACEN, AIC32X4_NDACEN);
 517
 518                 /* Switch on MDAC Divider */
 519                 snd_soc_update_bits(codec, AIC32X4_MDAC,
 520                                     AIC32X4_MDACEN, AIC32X4_MDACEN);
 521
 522                 /* Switch on NADC Divider */
 523                 snd_soc_update_bits(codec, AIC32X4_NADC,
 524                                     AIC32X4_NADCEN, AIC32X4_NADCEN);
 525
 526                 /* Switch on MADC Divider */
 527                 snd_soc_update_bits(codec, AIC32X4_MADC,
 528                                     AIC32X4_MADCEN, AIC32X4_MADCEN);
 529
 530                 /* Switch on BCLK_N Divider */
 531                 snd_soc_update_bits(codec, AIC32X4_BCLKN,
 532                                     AIC32X4_BCLKEN, AIC32X4_BCLKEN);
 533                 break;
 534         case SND_SOC_BIAS_PREPARE:
 535                 break;
 536         case SND_SOC_BIAS_STANDBY:
 537                 /* Switch off BCLK_N Divider */
 538                 snd_soc_update_bits(codec, AIC32X4_BCLKN,
 539                                     AIC32X4_BCLKEN, 0);
 540
 541                 /* Switch off MADC Divider */
 542                 snd_soc_update_bits(codec, AIC32X4_MADC,
 543                                     AIC32X4_MADCEN, 0);
 544
 545                 /* Switch off NADC Divider */
 546                 snd_soc_update_bits(codec, AIC32X4_NADC,
 547                                     AIC32X4_NADCEN, 0);
 548
 549                 /* Switch off MDAC Divider */
 550                 snd_soc_update_bits(codec, AIC32X4_MDAC,
 551                                     AIC32X4_MDACEN, 0);
 552
 553                 /* Switch off NDAC Divider */
 554                 snd_soc_update_bits(codec, AIC32X4_NDAC,
 555                                     AIC32X4_NDACEN, 0);
 556
 557                 /* Switch off PLL */
 558                 snd_soc_update_bits(codec, AIC32X4_PLLPR,
 559                                     AIC32X4_PLLEN, 0);
 560
 561                 /* Switch off master clock */
 562                 clk_disable_unprepare(aic32x4->mclk);
 563                 break;
 564         case SND_SOC_BIAS_OFF:
 565                 break;
 566         }
 567         codec->dapm.bias_level = level;
 568         return 0;
 569 }
 570
 571 #define AIC32X4_RATES   SNDRV_PCM_RATE_8000_48000
 572 #define AIC32X4_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE \
 573                          | SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE)
 574
 575 static const struct snd_soc_dai_ops aic32x4_ops = {
 576         .hw_params = aic32x4_hw_params,
 577         .digital_mute = aic32x4_mute,
 578         .set_fmt = aic32x4_set_dai_fmt,
 579         .set_sysclk = aic32x4_set_dai_sysclk,
 580 };
 581
 582 static struct snd_soc_dai_driver aic32x4_dai = {
 583         .name = "tlv320aic32x4-hifi",
 584         .playback = {
 585                      .stream_name = "Playback",
 586                      .channels_min = 1,
 587                      .channels_max = 2,
 588                      .rates = AIC32X4_RATES,
 589                      .formats = AIC32X4_FORMATS,},
 590         .capture = {
 591                     .stream_name = "Capture",
 592                     .channels_min = 1,
 593                     .channels_max = 2,
 594                     .rates = AIC32X4_RATES,
 595                     .formats = AIC32X4_FORMATS,},
 596         .ops = &aic32x4_ops,
 597         .symmetric_rates = 1,
 598 };
 599
 600 static int aic32x4_suspend(struct snd_soc_codec *codec)
 601 {
 602         aic32x4_set_bias_level(codec, SND_SOC_BIAS_OFF);
 603         return 0;
 604 }
 605
 606 static int aic32x4_resume(struct snd_soc_codec *codec)
 607 {
 608         aic32x4_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
 609         return 0;
 610 }
 611
 612 static int aic32x4_probe(struct snd_soc_codec *codec)
 613 {
 614         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
 615         u32 tmp_reg;
 616
 617         if (gpio_is_valid(aic32x4->rstn_gpio)) {
 618                 ndelay(10);
 619                 gpio_set_value(aic32x4->rstn_gpio, 1);
 620         }
 621
 622         snd_soc_write(codec, AIC32X4_RESET, 0x01);
 623
 624         /* Power platform configuration */
 625         if (aic32x4->power_cfg & AIC32X4_PWR_MICBIAS_2075_LDOIN) {
 626                 snd_soc_write(codec, AIC32X4_MICBIAS, AIC32X4_MICBIAS_LDOIN |
 627                                                       AIC32X4_MICBIAS_2075V);
 628         }
 629         if (aic32x4->power_cfg & AIC32X4_PWR_AVDD_DVDD_WEAK_DISABLE)
 630                 snd_soc_write(codec, AIC32X4_PWRCFG, AIC32X4_AVDDWEAKDISABLE);
 631
 632         tmp_reg = (aic32x4->power_cfg & AIC32X4_PWR_AIC32X4_LDO_ENABLE) ?
 633                         AIC32X4_LDOCTLEN : 0;
 634         snd_soc_write(codec, AIC32X4_LDOCTL, tmp_reg);
 635
 636         tmp_reg = snd_soc_read(codec, AIC32X4_CMMODE);
 637         if (aic32x4->power_cfg & AIC32X4_PWR_CMMODE_LDOIN_RANGE_18_36)
 638                 tmp_reg |= AIC32X4_LDOIN_18_36;
 639         if (aic32x4->power_cfg & AIC32X4_PWR_CMMODE_HP_LDOIN_POWERED)
 640                 tmp_reg |= AIC32X4_LDOIN2HP;
 641         snd_soc_write(codec, AIC32X4_CMMODE, tmp_reg);
 642
 643         /* Mic PGA routing */
 644         if (aic32x4->micpga_routing & AIC32X4_MICPGA_ROUTE_LMIC_IN2R_10K)
 645                 snd_soc_write(codec, AIC32X4_LMICPGANIN,
 646                                 AIC32X4_LMICPGANIN_IN2R_10K);
 647         else
 648                 snd_soc_write(codec, AIC32X4_LMICPGANIN,
 649                                 AIC32X4_LMICPGANIN_CM1L_10K);
 650         if (aic32x4->micpga_routing & AIC32X4_MICPGA_ROUTE_RMIC_IN1L_10K)
 651                 snd_soc_write(codec, AIC32X4_RMICPGANIN,
 652                                 AIC32X4_RMICPGANIN_IN1L_10K);
 653         else
 654                 snd_soc_write(codec, AIC32X4_RMICPGANIN,
 655                                 AIC32X4_RMICPGANIN_CM1R_10K);
 656
 657         aic32x4_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
 658
 659         /*
 660          * Workaround: for an unknown reason, the ADC needs to be powered up
 661          * and down for the first capture to work properly. It seems related to
 662          * a HW BUG or some kind of behavior not documented in the datasheet.
 663          */
 664         tmp_reg = snd_soc_read(codec, AIC32X4_ADCSETUP);
 665         snd_soc_write(codec, AIC32X4_ADCSETUP, tmp_reg |
 666                                 AIC32X4_LADC_EN | AIC32X4_RADC_EN);
 667         snd_soc_write(codec, AIC32X4_ADCSETUP, tmp_reg);
 668
 669         return 0;
 670 }
 671
 672 static int aic32x4_remove(struct snd_soc_codec *codec)
 673 {
 674         aic32x4_set_bias_level(codec, SND_SOC_BIAS_OFF);
 675         return 0;
 676 }
 677
 678 static struct snd_soc_codec_driver soc_codec_dev_aic32x4 = {
 679         .probe = aic32x4_probe,
 680         .remove = aic32x4_remove,
 681         .suspend = aic32x4_suspend,
 682         .resume = aic32x4_resume,
 683         .set_bias_level = aic32x4_set_bias_level,
 684
 685         .controls = aic32x4_snd_controls,
 686         .num_controls = ARRAY_SIZE(aic32x4_snd_controls),
 687         .dapm_widgets = aic32x4_dapm_widgets,
 688         .num_dapm_widgets = ARRAY_SIZE(aic32x4_dapm_widgets),
 689         .dapm_routes = aic32x4_dapm_routes,
 690         .num_dapm_routes = ARRAY_SIZE(aic32x4_dapm_routes),
 691 };
 692
 693 static int aic32x4_parse_dt(struct aic32x4_priv *aic32x4,
 694                 struct device_node *np)
 695 {
 696         aic32x4->swapdacs = false;
 697         aic32x4->micpga_routing = 0;
 698         aic32x4->rstn_gpio = of_get_named_gpio(np, "reset-gpios", 0);
 699
 700         return 0;
 701 }
 702
 703 static void aic32x4_disable_regulators(struct aic32x4_priv *aic32x4)
 704 {
 705         regulator_disable(aic32x4->supply_iov);
 706
 707         if (!IS_ERR(aic32x4->supply_ldo))
 708                 regulator_disable(aic32x4->supply_ldo);
 709
 710         if (!IS_ERR(aic32x4->supply_dv))
 711                 regulator_disable(aic32x4->supply_dv);
 712
 713         if (!IS_ERR(aic32x4->supply_av))
 714                 regulator_disable(aic32x4->supply_av);
 715 }
 716
 717 static int aic32x4_setup_regulators(struct device *dev,
 718                 struct aic32x4_priv *aic32x4)
 719 {
 720         int ret = 0;
 721
 722         aic32x4->supply_ldo = devm_regulator_get_optional(dev, "ldoin");
 723         aic32x4->supply_iov = devm_regulator_get(dev, "iov");
 724         aic32x4->supply_dv = devm_regulator_get_optional(dev, "dv");
 725         aic32x4->supply_av = devm_regulator_get_optional(dev, "av");
 726
 727         /* Check if the regulator requirements are fulfilled */
 728
 729         if (IS_ERR(aic32x4->supply_iov)) {
 730                 dev_err(dev, "Missing supply 'iov'\n");
 731                 return PTR_ERR(aic32x4->supply_iov);
 732         }
 733
 734         if (IS_ERR(aic32x4->supply_ldo)) {
 735                 if (PTR_ERR(aic32x4->supply_ldo) == -EPROBE_DEFER)
 736                         return -EPROBE_DEFER;
 737
 738                 if (IS_ERR(aic32x4->supply_dv)) {
 739                         dev_err(dev, "Missing supply 'dv' or 'ldoin'\n");
 740                         return PTR_ERR(aic32x4->supply_dv);
 741                 }
 742                 if (IS_ERR(aic32x4->supply_av)) {
 743                         dev_err(dev, "Missing supply 'av' or 'ldoin'\n");
 744                         return PTR_ERR(aic32x4->supply_av);
 745                 }
 746         } else {
 747                 if (IS_ERR(aic32x4->supply_dv) &&
 748                                 PTR_ERR(aic32x4->supply_dv) == -EPROBE_DEFER)
 749                         return -EPROBE_DEFER;
 750                 if (IS_ERR(aic32x4->supply_av) &&
 751                                 PTR_ERR(aic32x4->supply_av) == -EPROBE_DEFER)
 752                         return -EPROBE_DEFER;
 753         }
 754
 755         ret = regulator_enable(aic32x4->supply_iov);
 756         if (ret) {
 757                 dev_err(dev, "Failed to enable regulator iov\n");
 758                 return ret;
 759         }
 760
 761         if (!IS_ERR(aic32x4->supply_ldo)) {
 762                 ret = regulator_enable(aic32x4->supply_ldo);
 763                 if (ret) {
 764                         dev_err(dev, "Failed to enable regulator ldo\n");
 765                         goto error_ldo;
 766                 }
 767         }
 768
 769         if (!IS_ERR(aic32x4->supply_dv)) {
 770                 ret = regulator_enable(aic32x4->supply_dv);
 771                 if (ret) {
 772                         dev_err(dev, "Failed to enable regulator dv\n");
 773                         goto error_dv;
 774                 }
 775         }
 776
 777         if (!IS_ERR(aic32x4->supply_av)) {
 778                 ret = regulator_enable(aic32x4->supply_av);
 779                 if (ret) {
 780                         dev_err(dev, "Failed to enable regulator av\n");
 781                         goto error_av;
 782                 }
 783         }
 784
 785         if (!IS_ERR(aic32x4->supply_ldo) && IS_ERR(aic32x4->supply_av))
 786                 aic32x4->power_cfg |= AIC32X4_PWR_AIC32X4_LDO_ENABLE;
 787
 788         return 0;
 789
 790 error_av:
 791         if (!IS_ERR(aic32x4->supply_dv))
 792                 regulator_disable(aic32x4->supply_dv);
 793
 794 error_dv:
 795         if (!IS_ERR(aic32x4->supply_ldo))
 796                 regulator_disable(aic32x4->supply_ldo);
 797
 798 error_ldo:
 799         regulator_disable(aic32x4->supply_iov);
 800         return ret;
 801 }
 802
 803 static int aic32x4_i2c_probe(struct i2c_client *i2c,
 804                              const struct i2c_device_id *id)
 805 {
 806         struct aic32x4_pdata *pdata = i2c->dev.platform_data;
 807         struct aic32x4_priv *aic32x4;
 808         struct device_node *np = i2c->dev.of_node;
 809         int ret;
 810
 811         aic32x4 = devm_kzalloc(&i2c->dev, sizeof(struct aic32x4_priv),
 812                                GFP_KERNEL);
 813         if (aic32x4 == NULL)
 814                 return -ENOMEM;
 815
 816         aic32x4->regmap = devm_regmap_init_i2c(i2c, &aic32x4_regmap);
 817         if (IS_ERR(aic32x4->regmap))
 818                 return PTR_ERR(aic32x4->regmap);
 819
 820         i2c_set_clientdata(i2c, aic32x4);
 821
 822         if (pdata) {
 823                 aic32x4->power_cfg = pdata->power_cfg;
 824                 aic32x4->swapdacs = pdata->swapdacs;
 825                 aic32x4->micpga_routing = pdata->micpga_routing;
 826                 aic32x4->rstn_gpio = pdata->rstn_gpio;
 827         } else if (np) {
 828                 ret = aic32x4_parse_dt(aic32x4, np);
 829                 if (ret) {
 830                         dev_err(&i2c->dev, "Failed to parse DT node\n");
 831                         return ret;
 832                 }
 833         } else {
 834                 aic32x4->power_cfg = 0;
 835                 aic32x4->swapdacs = false;
 836                 aic32x4->micpga_routing = 0;
 837                 aic32x4->rstn_gpio = -1;
 838         }
 839
 840         aic32x4->mclk = devm_clk_get(&i2c->dev, "mclk");
 841         if (IS_ERR(aic32x4->mclk)) {
 842                 dev_err(&i2c->dev, "Failed getting the mclk. The current implementation does not support the usage of this codec without mclk\n");
 843                 return PTR_ERR(aic32x4->mclk);
 844         }
 845
 846         if (gpio_is_valid(aic32x4->rstn_gpio)) {
 847                 ret = devm_gpio_request_one(&i2c->dev, aic32x4->rstn_gpio,
 848                                 GPIOF_OUT_INIT_LOW, "tlv320aic32x4 rstn");
 849                 if (ret != 0)
 850                         return ret;
 851         }
 852
 853         ret = aic32x4_setup_regulators(&i2c->dev, aic32x4);
 854         if (ret) {
 855                 dev_err(&i2c->dev, "Failed to setup regulators\n");
 856                 return ret;
 857         }
 858
 859         ret = snd_soc_register_codec(&i2c->dev,
 860                         &soc_codec_dev_aic32x4, &aic32x4_dai, 1);
 861         if (ret) {
 862                 dev_err(&i2c->dev, "Failed to register codec\n");
 863                 aic32x4_disable_regulators(aic32x4);
 864                 return ret;
 865         }
 866
 867         i2c_set_clientdata(i2c, aic32x4);
 868
 869         return 0;
 870 }
 871
 872 static int aic32x4_i2c_remove(struct i2c_client *client)
 873 {
 874         struct aic32x4_priv *aic32x4 = i2c_get_clientdata(client);
 875
 876         aic32x4_disable_regulators(aic32x4);
 877
 878         snd_soc_unregister_codec(&client->dev);
 879         return 0;
 880 }
 881
 882 static const struct i2c_device_id aic32x4_i2c_id[] = {
 883         { "tlv320aic32x4", 0 },
 884         { }
 885 };
 886 MODULE_DEVICE_TABLE(i2c, aic32x4_i2c_id);
 887
 888 static const struct of_device_id aic32x4_of_id[] = {
 889         { .compatible = "ti,tlv320aic32x4", },
 890         { /* senitel */ }
 891 };
 892 MODULE_DEVICE_TABLE(of, aic32x4_of_id);
 893
 894 static struct i2c_driver aic32x4_i2c_driver = {
 895         .driver = {
 896                 .name = "tlv320aic32x4",
 897                 .owner = THIS_MODULE,
 898                 .of_match_table = aic32x4_of_id,
 899         },
 900         .probe =    aic32x4_i2c_probe,
 901         .remove =   aic32x4_i2c_remove,
 902         .id_table = aic32x4_i2c_id,
 903 };
 904
 905 module_i2c_driver(aic32x4_i2c_driver);
 906
 907 MODULE_DESCRIPTION("ASoC tlv320aic32x4 codec driver");
 908 MODULE_AUTHOR("Javier Martin <javier.martin@vista-silicon.com>");
 909 MODULE_LICENSE("GPL");