sound/soc/codecs/tlv320aic23.c

   1 /*
   2  * ALSA SoC TLV320AIC23 codec driver
   3  *
   4  * Author:      Arun KS, <arunks@mistralsolutions.com>
   5  * Copyright:   (C) 2008 Mistral Solutions Pvt Ltd.,
   6  *
   7  * Based on sound/soc/codecs/wm8731.c by Richard Purdie
   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 AIC23 is a driver for a low power stereo audio
  15  *  codec tlv320aic23
  16  *
  17  *  The machine layer should disable unsupported inputs/outputs by
  18  *  snd_soc_dapm_disable_pin(codec, "LHPOUT"), etc.
  19  */
  20
  21 #include <linux/module.h>
  22 #include <linux/moduleparam.h>
  23 #include <linux/init.h>
  24 #include <linux/delay.h>
  25 #include <linux/pm.h>
  26 #include <linux/i2c.h>
  27 #include <linux/platform_device.h>
  28 #include <linux/slab.h>
  29 #include <sound/core.h>
  30 #include <sound/pcm.h>
  31 #include <sound/pcm_params.h>
  32 #include <sound/soc.h>
  33 #include <sound/soc-dapm.h>
  34 #include <sound/tlv.h>
  35 #include <sound/initval.h>
  36
  37 #include "tlv320aic23.h"
  38
  39 #define AIC23_VERSION "0.1"
  40
  41 /*
  42  * AIC23 register cache
  43  */
  44 static const u16 tlv320aic23_reg[] = {
  45         0x0097, 0x0097, 0x00F9, 0x00F9, /* 0 */
  46         0x001A, 0x0004, 0x0007, 0x0001, /* 4 */
  47         0x0020, 0x0000, 0x0000, 0x0000, /* 8 */
  48         0x0000, 0x0000, 0x0000, 0x0000, /* 12 */
  49 };
  50
  51 /*
  52  * read tlv320aic23 register cache
  53  */
  54 static inline unsigned int tlv320aic23_read_reg_cache(struct snd_soc_codec
  55                                                       *codec, unsigned int reg)
  56 {
  57         u16 *cache = codec->reg_cache;
  58         if (reg >= ARRAY_SIZE(tlv320aic23_reg))
  59                 return -1;
  60         return cache[reg];
  61 }
  62
  63 /*
  64  * write tlv320aic23 register cache
  65  */
  66 static inline void tlv320aic23_write_reg_cache(struct snd_soc_codec *codec,
  67                                                u8 reg, u16 value)
  68 {
  69         u16 *cache = codec->reg_cache;
  70         if (reg >= ARRAY_SIZE(tlv320aic23_reg))
  71                 return;
  72         cache[reg] = value;
  73 }
  74
  75 /*
  76  * write to the tlv320aic23 register space
  77  */
  78 static int tlv320aic23_write(struct snd_soc_codec *codec, unsigned int reg,
  79                              unsigned int value)
  80 {
  81
  82         u8 data[2];
  83
  84         /* TLV320AIC23 has 7 bit address and 9 bits of data
  85          * so we need to switch one data bit into reg and rest
  86          * of data into val
  87          */
  88
  89         if (reg > 9 && reg != 15) {
  90                 printk(KERN_WARNING "%s Invalid register R%u\n", __func__, reg);
  91                 return -1;
  92         }
  93
  94         data[0] = (reg << 1) | (value >> 8 & 0x01);
  95         data[1] = value & 0xff;
  96
  97         tlv320aic23_write_reg_cache(codec, reg, value);
  98
  99         if (codec->hw_write(codec->control_data, data, 2) == 2)
 100                 return 0;
 101
 102         printk(KERN_ERR "%s cannot write %03x to register R%u\n", __func__,
 103                value, reg);
 104
 105         return -EIO;
 106 }
 107
 108 static const char *rec_src_text[] = { "Line", "Mic" };
 109 static const char *deemph_text[] = {"None", "32Khz", "44.1Khz", "48Khz"};
 110
 111 static const struct soc_enum rec_src_enum =
 112         SOC_ENUM_SINGLE(TLV320AIC23_ANLG, 2, 2, rec_src_text);
 113
 114 static const struct snd_kcontrol_new tlv320aic23_rec_src_mux_controls =
 115 SOC_DAPM_ENUM("Input Select", rec_src_enum);
 116
 117 static const struct soc_enum tlv320aic23_rec_src =
 118         SOC_ENUM_SINGLE(TLV320AIC23_ANLG, 2, 2, rec_src_text);
 119 static const struct soc_enum tlv320aic23_deemph =
 120         SOC_ENUM_SINGLE(TLV320AIC23_DIGT, 1, 4, deemph_text);
 121
 122 static const DECLARE_TLV_DB_SCALE(out_gain_tlv, -12100, 100, 0);
 123 static const DECLARE_TLV_DB_SCALE(input_gain_tlv, -1725, 75, 0);
 124 static const DECLARE_TLV_DB_SCALE(sidetone_vol_tlv, -1800, 300, 0);
 125
 126 static int snd_soc_tlv320aic23_put_volsw(struct snd_kcontrol *kcontrol,
 127         struct snd_ctl_elem_value *ucontrol)
 128 {
 129         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 130         u16 val, reg;
 131
 132         val = (ucontrol->value.integer.value[0] & 0x07);
 133
 134         /* linear conversion to userspace
 135         * 000   =       -6db
 136         * 001   =       -9db
 137         * 010   =       -12db
 138         * 011   =       -18db (Min)
 139         * 100   =       0db (Max)
 140         */
 141         val = (val >= 4) ? 4  : (3 - val);
 142
 143         reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_ANLG) & (~0x1C0);
 144         tlv320aic23_write(codec, TLV320AIC23_ANLG, reg | (val << 6));
 145
 146         return 0;
 147 }
 148
 149 static int snd_soc_tlv320aic23_get_volsw(struct snd_kcontrol *kcontrol,
 150         struct snd_ctl_elem_value *ucontrol)
 151 {
 152         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 153         u16 val;
 154
 155         val = tlv320aic23_read_reg_cache(codec, TLV320AIC23_ANLG) & (0x1C0);
 156         val = val >> 6;
 157         val = (val >= 4) ? 4  : (3 -  val);
 158         ucontrol->value.integer.value[0] = val;
 159         return 0;
 160
 161 }
 162
 163 #define SOC_TLV320AIC23_SINGLE_TLV(xname, reg, shift, max, invert, tlv_array) \
 164 {       .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
 165         .access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\
 166                  SNDRV_CTL_ELEM_ACCESS_READWRITE,\
 167         .tlv.p = (tlv_array), \
 168         .info = snd_soc_info_volsw, .get = snd_soc_tlv320aic23_get_volsw,\
 169         .put = snd_soc_tlv320aic23_put_volsw, \
 170         .private_value =  SOC_SINGLE_VALUE(reg, shift, max, invert) }
 171
 172 static const struct snd_kcontrol_new tlv320aic23_snd_controls[] = {
 173         SOC_DOUBLE_R_TLV("Digital Playback Volume", TLV320AIC23_LCHNVOL,
 174                          TLV320AIC23_RCHNVOL, 0, 127, 0, out_gain_tlv),
 175         SOC_SINGLE("Digital Playback Switch", TLV320AIC23_DIGT, 3, 1, 1),
 176         SOC_DOUBLE_R("Line Input Switch", TLV320AIC23_LINVOL,
 177                      TLV320AIC23_RINVOL, 7, 1, 0),
 178         SOC_DOUBLE_R_TLV("Line Input Volume", TLV320AIC23_LINVOL,
 179                          TLV320AIC23_RINVOL, 0, 31, 0, input_gain_tlv),
 180         SOC_SINGLE("Mic Input Switch", TLV320AIC23_ANLG, 1, 1, 1),
 181         SOC_SINGLE("Mic Booster Switch", TLV320AIC23_ANLG, 0, 1, 0),
 182         SOC_TLV320AIC23_SINGLE_TLV("Sidetone Volume", TLV320AIC23_ANLG,
 183                                   6, 4, 0, sidetone_vol_tlv),
 184         SOC_ENUM("Playback De-emphasis", tlv320aic23_deemph),
 185 };
 186
 187 /* PGA Mixer controls for Line and Mic switch */
 188 static const struct snd_kcontrol_new tlv320aic23_output_mixer_controls[] = {
 189         SOC_DAPM_SINGLE("Line Bypass Switch", TLV320AIC23_ANLG, 3, 1, 0),
 190         SOC_DAPM_SINGLE("Mic Sidetone Switch", TLV320AIC23_ANLG, 5, 1, 0),
 191         SOC_DAPM_SINGLE("Playback Switch", TLV320AIC23_ANLG, 4, 1, 0),
 192 };
 193
 194 static const struct snd_soc_dapm_widget tlv320aic23_dapm_widgets[] = {
 195         SND_SOC_DAPM_DAC("DAC", "Playback", TLV320AIC23_PWR, 3, 1),
 196         SND_SOC_DAPM_ADC("ADC", "Capture", TLV320AIC23_PWR, 2, 1),
 197         SND_SOC_DAPM_MUX("Capture Source", SND_SOC_NOPM, 0, 0,
 198                          &tlv320aic23_rec_src_mux_controls),
 199         SND_SOC_DAPM_MIXER("Output Mixer", TLV320AIC23_PWR, 4, 1,
 200                            &tlv320aic23_output_mixer_controls[0],
 201                            ARRAY_SIZE(tlv320aic23_output_mixer_controls)),
 202         SND_SOC_DAPM_PGA("Line Input", TLV320AIC23_PWR, 0, 1, NULL, 0),
 203         SND_SOC_DAPM_PGA("Mic Input", TLV320AIC23_PWR, 1, 1, NULL, 0),
 204
 205         SND_SOC_DAPM_OUTPUT("LHPOUT"),
 206         SND_SOC_DAPM_OUTPUT("RHPOUT"),
 207         SND_SOC_DAPM_OUTPUT("LOUT"),
 208         SND_SOC_DAPM_OUTPUT("ROUT"),
 209
 210         SND_SOC_DAPM_INPUT("LLINEIN"),
 211         SND_SOC_DAPM_INPUT("RLINEIN"),
 212
 213         SND_SOC_DAPM_INPUT("MICIN"),
 214 };
 215
 216 static const struct snd_soc_dapm_route intercon[] = {
 217         /* Output Mixer */
 218         {"Output Mixer", "Line Bypass Switch", "Line Input"},
 219         {"Output Mixer", "Playback Switch", "DAC"},
 220         {"Output Mixer", "Mic Sidetone Switch", "Mic Input"},
 221
 222         /* Outputs */
 223         {"RHPOUT", NULL, "Output Mixer"},
 224         {"LHPOUT", NULL, "Output Mixer"},
 225         {"LOUT", NULL, "Output Mixer"},
 226         {"ROUT", NULL, "Output Mixer"},
 227
 228         /* Inputs */
 229         {"Line Input", "NULL", "LLINEIN"},
 230         {"Line Input", "NULL", "RLINEIN"},
 231
 232         {"Mic Input", "NULL", "MICIN"},
 233
 234         /* input mux */
 235         {"Capture Source", "Line", "Line Input"},
 236         {"Capture Source", "Mic", "Mic Input"},
 237         {"ADC", NULL, "Capture Source"},
 238
 239 };
 240
 241 /* AIC23 driver data */
 242 struct aic23 {
 243         enum snd_soc_control_type control_type;
 244         void *control_data;
 245         int mclk;
 246         int requested_adc;
 247         int requested_dac;
 248 };
 249
 250 /*
 251  * Common Crystals used
 252  * 11.2896 Mhz /128 = *88.2k  /192 = 58.8k
 253  * 12.0000 Mhz /125 = *96k    /136 = 88.235K
 254  * 12.2880 Mhz /128 = *96k    /192 = 64k
 255  * 16.9344 Mhz /128 = 132.3k /192 = *88.2k
 256  * 18.4320 Mhz /128 = 144k   /192 = *96k
 257  */
 258
 259 /*
 260  * Normal BOSR 0-256/2 = 128, 1-384/2 = 192
 261  * USB BOSR 0-250/2 = 125, 1-272/2 = 136
 262  */
 263 static const int bosr_usb_divisor_table[] = {
 264         128, 125, 192, 136
 265 };
 266 #define LOWER_GROUP ((1<<0) | (1<<1) | (1<<2) | (1<<3) | (1<<6) | (1<<7))
 267 #define UPPER_GROUP ((1<<8) | (1<<9) | (1<<10) | (1<<11)        | (1<<15))
 268 static const unsigned short sr_valid_mask[] = {
 269         LOWER_GROUP|UPPER_GROUP,        /* Normal, bosr - 0*/
 270         LOWER_GROUP,                    /* Usb, bosr - 0*/
 271         LOWER_GROUP|UPPER_GROUP,        /* Normal, bosr - 1*/
 272         UPPER_GROUP,                    /* Usb, bosr - 1*/
 273 };
 274 /*
 275  * Every divisor is a factor of 11*12
 276  */
 277 #define SR_MULT (11*12)
 278 #define A(x) (SR_MULT/x)
 279 static const unsigned char sr_adc_mult_table[] = {
 280         A(2), A(2), A(12), A(12),  0, 0, A(3), A(1),
 281         A(2), A(2), A(11), A(11),  0, 0, 0, A(1)
 282 };
 283 static const unsigned char sr_dac_mult_table[] = {
 284         A(2), A(12), A(2), A(12),  0, 0, A(3), A(1),
 285         A(2), A(11), A(2), A(11),  0, 0, 0, A(1)
 286 };
 287
 288 static unsigned get_score(int adc, int adc_l, int adc_h, int need_adc,
 289                 int dac, int dac_l, int dac_h, int need_dac)
 290 {
 291         if ((adc >= adc_l) && (adc <= adc_h) &&
 292                         (dac >= dac_l) && (dac <= dac_h)) {
 293                 int diff_adc = need_adc - adc;
 294                 int diff_dac = need_dac - dac;
 295                 return abs(diff_adc) + abs(diff_dac);
 296         }
 297         return UINT_MAX;
 298 }
 299
 300 static int find_rate(int mclk, u32 need_adc, u32 need_dac)
 301 {
 302         int i, j;
 303         int best_i = -1;
 304         int best_j = -1;
 305         int best_div = 0;
 306         unsigned best_score = UINT_MAX;
 307         int adc_l, adc_h, dac_l, dac_h;
 308
 309         need_adc *= SR_MULT;
 310         need_dac *= SR_MULT;
 311         /*
 312          * rates given are +/- 1/32
 313          */
 314         adc_l = need_adc - (need_adc >> 5);
 315         adc_h = need_adc + (need_adc >> 5);
 316         dac_l = need_dac - (need_dac >> 5);
 317         dac_h = need_dac + (need_dac >> 5);
 318         for (i = 0; i < ARRAY_SIZE(bosr_usb_divisor_table); i++) {
 319                 int base = mclk / bosr_usb_divisor_table[i];
 320                 int mask = sr_valid_mask[i];
 321                 for (j = 0; j < ARRAY_SIZE(sr_adc_mult_table);
 322                                 j++, mask >>= 1) {
 323                         int adc;
 324                         int dac;
 325                         int score;
 326                         if ((mask & 1) == 0)
 327                                 continue;
 328                         adc = base * sr_adc_mult_table[j];
 329                         dac = base * sr_dac_mult_table[j];
 330                         score = get_score(adc, adc_l, adc_h, need_adc,
 331                                         dac, dac_l, dac_h, need_dac);
 332                         if (best_score > score) {
 333                                 best_score = score;
 334                                 best_i = i;
 335                                 best_j = j;
 336                                 best_div = 0;
 337                         }
 338                         score = get_score((adc >> 1), adc_l, adc_h, need_adc,
 339                                         (dac >> 1), dac_l, dac_h, need_dac);
 340                         /* prefer to have a /2 */
 341                         if ((score != UINT_MAX) && (best_score >= score)) {
 342                                 best_score = score;
 343                                 best_i = i;
 344                                 best_j = j;
 345                                 best_div = 1;
 346                         }
 347                 }
 348         }
 349         return (best_j << 2) | best_i | (best_div << TLV320AIC23_CLKIN_SHIFT);
 350 }
 351
 352 #ifdef DEBUG
 353 static void get_current_sample_rates(struct snd_soc_codec *codec, int mclk,
 354                 u32 *sample_rate_adc, u32 *sample_rate_dac)
 355 {
 356         int src = tlv320aic23_read_reg_cache(codec, TLV320AIC23_SRATE);
 357         int sr = (src >> 2) & 0x0f;
 358         int val = (mclk / bosr_usb_divisor_table[src & 3]);
 359         int adc = (val * sr_adc_mult_table[sr]) / SR_MULT;
 360         int dac = (val * sr_dac_mult_table[sr]) / SR_MULT;
 361         if (src & TLV320AIC23_CLKIN_HALF) {
 362                 adc >>= 1;
 363                 dac >>= 1;
 364         }
 365         *sample_rate_adc = adc;
 366         *sample_rate_dac = dac;
 367 }
 368 #endif
 369
 370 static int set_sample_rate_control(struct snd_soc_codec *codec, int mclk,
 371                 u32 sample_rate_adc, u32 sample_rate_dac)
 372 {
 373         /* Search for the right sample rate */
 374         int data = find_rate(mclk, sample_rate_adc, sample_rate_dac);
 375         if (data < 0) {
 376                 printk(KERN_ERR "%s:Invalid rate %u,%u requested\n",
 377                                 __func__, sample_rate_adc, sample_rate_dac);
 378                 return -EINVAL;
 379         }
 380         tlv320aic23_write(codec, TLV320AIC23_SRATE, data);
 381 #ifdef DEBUG
 382         {
 383                 u32 adc, dac;
 384                 get_current_sample_rates(codec, mclk, &adc, &dac);
 385                 printk(KERN_DEBUG "actual samplerate = %u,%u reg=%x\n",
 386                         adc, dac, data);
 387         }
 388 #endif
 389         return 0;
 390 }
 391
 392 static int tlv320aic23_add_widgets(struct snd_soc_codec *codec)
 393 {
 394         snd_soc_dapm_new_controls(codec, tlv320aic23_dapm_widgets,
 395                                   ARRAY_SIZE(tlv320aic23_dapm_widgets));
 396
 397         /* set up audio path interconnects */
 398         snd_soc_dapm_add_routes(codec, intercon, ARRAY_SIZE(intercon));
 399
 400         return 0;
 401 }
 402
 403 static int tlv320aic23_hw_params(struct snd_pcm_substream *substream,
 404                                  struct snd_pcm_hw_params *params,
 405                                  struct snd_soc_dai *dai)
 406 {
 407         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 408         struct snd_soc_codec *codec = rtd->codec;
 409         u16 iface_reg;
 410         int ret;
 411         struct aic23 *aic23 = snd_soc_codec_get_drvdata(codec);
 412         u32 sample_rate_adc = aic23->requested_adc;
 413         u32 sample_rate_dac = aic23->requested_dac;
 414         u32 sample_rate = params_rate(params);
 415
 416         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 417                 aic23->requested_dac = sample_rate_dac = sample_rate;
 418                 if (!sample_rate_adc)
 419                         sample_rate_adc = sample_rate;
 420         } else {
 421                 aic23->requested_adc = sample_rate_adc = sample_rate;
 422                 if (!sample_rate_dac)
 423                         sample_rate_dac = sample_rate;
 424         }
 425         ret = set_sample_rate_control(codec, aic23->mclk, sample_rate_adc,
 426                         sample_rate_dac);
 427         if (ret < 0)
 428                 return ret;
 429
 430         iface_reg =
 431             tlv320aic23_read_reg_cache(codec,
 432                                        TLV320AIC23_DIGT_FMT) & ~(0x03 << 2);
 433         switch (params_format(params)) {
 434         case SNDRV_PCM_FORMAT_S16_LE:
 435                 break;
 436         case SNDRV_PCM_FORMAT_S20_3LE:
 437                 iface_reg |= (0x01 << 2);
 438                 break;
 439         case SNDRV_PCM_FORMAT_S24_LE:
 440                 iface_reg |= (0x02 << 2);
 441                 break;
 442         case SNDRV_PCM_FORMAT_S32_LE:
 443                 iface_reg |= (0x03 << 2);
 444                 break;
 445         }
 446         tlv320aic23_write(codec, TLV320AIC23_DIGT_FMT, iface_reg);
 447
 448         return 0;
 449 }
 450
 451 static int tlv320aic23_pcm_prepare(struct snd_pcm_substream *substream,
 452                                    struct snd_soc_dai *dai)
 453 {
 454         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 455         struct snd_soc_codec *codec = rtd->codec;
 456
 457         /* set active */
 458         tlv320aic23_write(codec, TLV320AIC23_ACTIVE, 0x0001);
 459
 460         return 0;
 461 }
 462
 463 static void tlv320aic23_shutdown(struct snd_pcm_substream *substream,
 464                                  struct snd_soc_dai *dai)
 465 {
 466         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 467         struct snd_soc_codec *codec = rtd->codec;
 468         struct aic23 *aic23 = snd_soc_codec_get_drvdata(codec);
 469
 470         /* deactivate */
 471         if (!codec->active) {
 472                 udelay(50);
 473                 tlv320aic23_write(codec, TLV320AIC23_ACTIVE, 0x0);
 474         }
 475         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
 476                 aic23->requested_dac = 0;
 477         else
 478                 aic23->requested_adc = 0;
 479 }
 480
 481 static int tlv320aic23_mute(struct snd_soc_dai *dai, int mute)
 482 {
 483         struct snd_soc_codec *codec = dai->codec;
 484         u16 reg;
 485
 486         reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_DIGT);
 487         if (mute)
 488                 reg |= TLV320AIC23_DACM_MUTE;
 489
 490         else
 491                 reg &= ~TLV320AIC23_DACM_MUTE;
 492
 493         tlv320aic23_write(codec, TLV320AIC23_DIGT, reg);
 494
 495         return 0;
 496 }
 497
 498 static int tlv320aic23_set_dai_fmt(struct snd_soc_dai *codec_dai,
 499                                    unsigned int fmt)
 500 {
 501         struct snd_soc_codec *codec = codec_dai->codec;
 502         u16 iface_reg;
 503
 504         iface_reg =
 505             tlv320aic23_read_reg_cache(codec, TLV320AIC23_DIGT_FMT) & (~0x03);
 506
 507         /* set master/slave audio interface */
 508         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
 509         case SND_SOC_DAIFMT_CBM_CFM:
 510                 iface_reg |= TLV320AIC23_MS_MASTER;
 511                 break;
 512         case SND_SOC_DAIFMT_CBS_CFS:
 513                 break;
 514         default:
 515                 return -EINVAL;
 516
 517         }
 518
 519         /* interface format */
 520         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
 521         case SND_SOC_DAIFMT_I2S:
 522                 iface_reg |= TLV320AIC23_FOR_I2S;
 523                 break;
 524         case SND_SOC_DAIFMT_DSP_A:
 525                 iface_reg |= TLV320AIC23_LRP_ON;
 526         case SND_SOC_DAIFMT_DSP_B:
 527                 iface_reg |= TLV320AIC23_FOR_DSP;
 528                 break;
 529         case SND_SOC_DAIFMT_RIGHT_J:
 530                 break;
 531         case SND_SOC_DAIFMT_LEFT_J:
 532                 iface_reg |= TLV320AIC23_FOR_LJUST;
 533                 break;
 534         default:
 535                 return -EINVAL;
 536
 537         }
 538
 539         tlv320aic23_write(codec, TLV320AIC23_DIGT_FMT, iface_reg);
 540
 541         return 0;
 542 }
 543
 544 static int tlv320aic23_set_dai_sysclk(struct snd_soc_dai *codec_dai,
 545                                       int clk_id, unsigned int freq, int dir)
 546 {
 547         struct aic23 *aic23 = snd_soc_dai_get_drvdata(codec_dai);
 548         aic23->mclk = freq;
 549         return 0;
 550 }
 551
 552 static int tlv320aic23_set_bias_level(struct snd_soc_codec *codec,
 553                                       enum snd_soc_bias_level level)
 554 {
 555         u16 reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_PWR) & 0xff7f;
 556
 557         switch (level) {
 558         case SND_SOC_BIAS_ON:
 559                 /* vref/mid, osc on, dac unmute */
 560                 reg &= ~(TLV320AIC23_DEVICE_PWR_OFF | TLV320AIC23_OSC_OFF | \
 561                         TLV320AIC23_DAC_OFF);
 562                 tlv320aic23_write(codec, TLV320AIC23_PWR, reg);
 563                 break;
 564         case SND_SOC_BIAS_PREPARE:
 565                 break;
 566         case SND_SOC_BIAS_STANDBY:
 567                 /* everything off except vref/vmid, */
 568                 tlv320aic23_write(codec, TLV320AIC23_PWR, reg | \
 569                         TLV320AIC23_CLK_OFF);
 570                 break;
 571         case SND_SOC_BIAS_OFF:
 572                 /* everything off, dac mute, inactive */
 573                 tlv320aic23_write(codec, TLV320AIC23_ACTIVE, 0x0);
 574                 tlv320aic23_write(codec, TLV320AIC23_PWR, 0xffff);
 575                 break;
 576         }
 577         codec->bias_level = level;
 578         return 0;
 579 }
 580
 581 #define AIC23_RATES     SNDRV_PCM_RATE_8000_96000
 582 #define AIC23_FORMATS   (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
 583                          SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE)
 584
 585 static struct snd_soc_dai_ops tlv320aic23_dai_ops = {
 586         .prepare        = tlv320aic23_pcm_prepare,
 587         .hw_params      = tlv320aic23_hw_params,
 588         .shutdown       = tlv320aic23_shutdown,
 589         .digital_mute   = tlv320aic23_mute,
 590         .set_fmt        = tlv320aic23_set_dai_fmt,
 591         .set_sysclk     = tlv320aic23_set_dai_sysclk,
 592 };
 593
 594 static struct snd_soc_dai_driver tlv320aic23_dai = {
 595         .name = "tlv320aic23-hifi",
 596         .playback = {
 597                      .stream_name = "Playback",
 598                      .channels_min = 2,
 599                      .channels_max = 2,
 600                      .rates = AIC23_RATES,
 601                      .formats = AIC23_FORMATS,},
 602         .capture = {
 603                     .stream_name = "Capture",
 604                     .channels_min = 2,
 605                     .channels_max = 2,
 606                     .rates = AIC23_RATES,
 607                     .formats = AIC23_FORMATS,},
 608         .ops = &tlv320aic23_dai_ops,
 609 };
 610
 611 static int tlv320aic23_suspend(struct snd_soc_codec *codec,
 612                                pm_message_t state)
 613 {
 614         tlv320aic23_set_bias_level(codec, SND_SOC_BIAS_OFF);
 615
 616         return 0;
 617 }
 618
 619 static int tlv320aic23_resume(struct snd_soc_codec *codec)
 620 {
 621         u16 reg;
 622
 623         /* Sync reg_cache with the hardware */
 624         for (reg = 0; reg <= TLV320AIC23_ACTIVE; reg++) {
 625                 u16 val = tlv320aic23_read_reg_cache(codec, reg);
 626                 tlv320aic23_write(codec, reg, val);
 627         }
 628         tlv320aic23_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
 629
 630         return 0;
 631 }
 632
 633 static int tlv320aic23_probe(struct snd_soc_codec *codec)
 634 {
 635         struct aic23 *aic23 = snd_soc_codec_get_drvdata(codec);
 636         int reg;
 637
 638         printk(KERN_INFO "AIC23 Audio Codec %s\n", AIC23_VERSION);
 639         codec->control_data = aic23->control_data;
 640         codec->hw_write = (hw_write_t)i2c_master_send;
 641         codec->hw_read = NULL;
 642
 643         /* Reset codec */
 644         tlv320aic23_write(codec, TLV320AIC23_RESET, 0);
 645
 646         /* power on device */
 647         tlv320aic23_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
 648
 649         tlv320aic23_write(codec, TLV320AIC23_DIGT, TLV320AIC23_DEEMP_44K);
 650
 651         /* Unmute input */
 652         reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_LINVOL);
 653         tlv320aic23_write(codec, TLV320AIC23_LINVOL,
 654                           (reg & (~TLV320AIC23_LIM_MUTED)) |
 655                           (TLV320AIC23_LRS_ENABLED));
 656
 657         reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_RINVOL);
 658         tlv320aic23_write(codec, TLV320AIC23_RINVOL,
 659                           (reg & (~TLV320AIC23_LIM_MUTED)) |
 660                           TLV320AIC23_LRS_ENABLED);
 661
 662         reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_ANLG);
 663         tlv320aic23_write(codec, TLV320AIC23_ANLG,
 664                          (reg) & (~TLV320AIC23_BYPASS_ON) &
 665                          (~TLV320AIC23_MICM_MUTED));
 666
 667         /* Default output volume */
 668         tlv320aic23_write(codec, TLV320AIC23_LCHNVOL,
 669                           TLV320AIC23_DEFAULT_OUT_VOL &
 670                           TLV320AIC23_OUT_VOL_MASK);
 671         tlv320aic23_write(codec, TLV320AIC23_RCHNVOL,
 672                           TLV320AIC23_DEFAULT_OUT_VOL &
 673                           TLV320AIC23_OUT_VOL_MASK);
 674
 675         tlv320aic23_write(codec, TLV320AIC23_ACTIVE, 0x1);
 676
 677         snd_soc_add_controls(codec, tlv320aic23_snd_controls,
 678                                 ARRAY_SIZE(tlv320aic23_snd_controls));
 679         tlv320aic23_add_widgets(codec);
 680
 681         return 0;
 682 }
 683
 684 static int tlv320aic23_remove(struct snd_soc_codec *codec)
 685 {
 686         tlv320aic23_set_bias_level(codec, SND_SOC_BIAS_OFF);
 687         return 0;
 688 }
 689
 690 static struct snd_soc_codec_driver soc_codec_dev_tlv320aic23 = {
 691         .reg_cache_size = ARRAY_SIZE(tlv320aic23_reg),
 692         .reg_word_size = sizeof(u16),
 693         .reg_cache_default = tlv320aic23_reg,
 694         .probe = tlv320aic23_probe,
 695         .remove = tlv320aic23_remove,
 696         .suspend = tlv320aic23_suspend,
 697         .resume = tlv320aic23_resume,
 698         .read = tlv320aic23_read_reg_cache,
 699         .write = tlv320aic23_write,
 700         .set_bias_level = tlv320aic23_set_bias_level,
 701 };
 702
 703 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
 704 /*
 705  * If the i2c layer weren't so broken, we could pass this kind of data
 706  * around
 707  */
 708 static int tlv320aic23_codec_probe(struct i2c_client *i2c,
 709                                    const struct i2c_device_id *i2c_id)
 710 {
 711         struct aic23 *aic23;
 712         int ret;
 713
 714         if (!i2c_check_functionality(i2c->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
 715                 return -EINVAL;
 716
 717         aic23 = kzalloc(sizeof(struct aic23), GFP_KERNEL);
 718         if (aic23 == NULL)
 719                 return -ENOMEM;
 720
 721         i2c_set_clientdata(i2c, aic23);
 722         aic23->control_data = i2c;
 723         aic23->control_type = SND_SOC_I2C;
 724
 725         ret =  snd_soc_register_codec(&i2c->dev,
 726                         &soc_codec_dev_tlv320aic23, &tlv320aic23_dai, 1);
 727         if (ret < 0)
 728                 kfree(aic23);
 729         return ret;
 730 }
 731 static int __exit tlv320aic23_i2c_remove(struct i2c_client *i2c)
 732 {
 733         snd_soc_unregister_codec(&i2c->dev);
 734         kfree(i2c_get_clientdata(i2c));
 735         return 0;
 736 }
 737
 738 static const struct i2c_device_id tlv320aic23_id[] = {
 739         {"tlv320aic23", 0},
 740         {}
 741 };
 742
 743 MODULE_DEVICE_TABLE(i2c, tlv320aic23_id);
 744
 745 static struct i2c_driver tlv320aic23_i2c_driver = {
 746         .driver = {
 747                    .name = "tlv320aic23-codec",
 748                    },
 749         .probe = tlv320aic23_codec_probe,
 750         .remove = __exit_p(tlv320aic23_i2c_remove),
 751         .id_table = tlv320aic23_id,
 752 };
 753
 754 #endif
 755
 756 static int __init tlv320aic23_modinit(void)
 757 {
 758         int ret;
 759 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
 760         ret = i2c_add_driver(&tlv320aic23_i2c_driver);
 761         if (ret != 0) {
 762                 printk(KERN_ERR "Failed to register TLV320AIC23 I2C driver: %d\n",
 763                        ret);
 764         }
 765 #endif
 766         return ret;
 767 }
 768 module_init(tlv320aic23_modinit);
 769
 770 static void __exit tlv320aic23_exit(void)
 771 {
 772 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
 773         i2c_del_driver(&tlv320aic23_i2c_driver);
 774 #endif
 775 }
 776 module_exit(tlv320aic23_exit);
 777
 778 MODULE_DESCRIPTION("ASoC TLV320AIC23 codec driver");
 779 MODULE_AUTHOR("Arun KS <arunks@mistralsolutions.com>");
 780 MODULE_LICENSE("GPL");