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