diff options
Diffstat (limited to 'sound/soc/codecs/stac9766.c')
| -rw-r--r-- | sound/soc/codecs/stac9766.c | 463 |
1 files changed, 463 insertions, 0 deletions
diff --git a/sound/soc/codecs/stac9766.c b/sound/soc/codecs/stac9766.c new file mode 100644 index 000000000000..8ad4b7b3e3ba --- /dev/null +++ b/sound/soc/codecs/stac9766.c | |||
| @@ -0,0 +1,463 @@ | |||
| 1 | /* | ||
| 2 | * stac9766.c -- ALSA SoC STAC9766 codec support | ||
| 3 | * | ||
| 4 | * Copyright 2009 Jon Smirl, Digispeaker | ||
| 5 | * Author: Jon Smirl <jonsmirl@gmail.com> | ||
| 6 | * | ||
| 7 | * This program is free software; you can redistribute it and/or modify it | ||
| 8 | * under the terms of the GNU General Public License as published by the | ||
| 9 | * Free Software Foundation; either version 2 of the License, or (at your | ||
| 10 | * option) any later version. | ||
| 11 | * | ||
| 12 | * Features:- | ||
| 13 | * | ||
| 14 | * o Support for AC97 Codec, S/PDIF | ||
| 15 | */ | ||
| 16 | |||
| 17 | #include <linux/init.h> | ||
| 18 | #include <linux/module.h> | ||
| 19 | #include <linux/device.h> | ||
| 20 | #include <sound/core.h> | ||
| 21 | #include <sound/pcm.h> | ||
| 22 | #include <sound/ac97_codec.h> | ||
| 23 | #include <sound/initval.h> | ||
| 24 | #include <sound/pcm_params.h> | ||
| 25 | #include <sound/soc.h> | ||
| 26 | #include <sound/tlv.h> | ||
| 27 | #include <sound/soc-of-simple.h> | ||
| 28 | |||
| 29 | #include "stac9766.h" | ||
| 30 | |||
| 31 | #define STAC9766_VERSION "0.10" | ||
| 32 | |||
| 33 | /* | ||
| 34 | * STAC9766 register cache | ||
| 35 | */ | ||
| 36 | static const u16 stac9766_reg[] = { | ||
| 37 | 0x6A90, 0x8000, 0x8000, 0x8000, /* 6 */ | ||
| 38 | 0x0000, 0x0000, 0x8008, 0x8008, /* e */ | ||
| 39 | 0x8808, 0x8808, 0x8808, 0x8808, /* 16 */ | ||
| 40 | 0x8808, 0x0000, 0x8000, 0x0000, /* 1e */ | ||
| 41 | 0x0000, 0x0000, 0x0000, 0x000f, /* 26 */ | ||
| 42 | 0x0a05, 0x0400, 0xbb80, 0x0000, /* 2e */ | ||
| 43 | 0x0000, 0xbb80, 0x0000, 0x0000, /* 36 */ | ||
| 44 | 0x0000, 0x2000, 0x0000, 0x0100, /* 3e */ | ||
| 45 | 0x0000, 0x0000, 0x0080, 0x0000, /* 46 */ | ||
| 46 | 0x0000, 0x0000, 0x0003, 0xffff, /* 4e */ | ||
| 47 | 0x0000, 0x0000, 0x0000, 0x0000, /* 56 */ | ||
| 48 | 0x4000, 0x0000, 0x0000, 0x0000, /* 5e */ | ||
| 49 | 0x1201, 0xFFFF, 0xFFFF, 0x0000, /* 66 */ | ||
| 50 | 0x0000, 0x0000, 0x0000, 0x0000, /* 6e */ | ||
| 51 | 0x0000, 0x0000, 0x0000, 0x0006, /* 76 */ | ||
| 52 | 0x0000, 0x0000, 0x0000, 0x0000, /* 7e */ | ||
| 53 | }; | ||
| 54 | |||
| 55 | static const char *stac9766_record_mux[] = {"Mic", "CD", "Video", "AUX", | ||
| 56 | "Line", "Stereo Mix", "Mono Mix", "Phone"}; | ||
| 57 | static const char *stac9766_mono_mux[] = {"Mix", "Mic"}; | ||
| 58 | static const char *stac9766_mic_mux[] = {"Mic1", "Mic2"}; | ||
| 59 | static const char *stac9766_SPDIF_mux[] = {"PCM", "ADC Record"}; | ||
| 60 | static const char *stac9766_popbypass_mux[] = {"Normal", "Bypass Mixer"}; | ||
| 61 | static const char *stac9766_record_all_mux[] = {"All analog", | ||
| 62 | "Analog plus DAC"}; | ||
| 63 | static const char *stac9766_boost1[] = {"0dB", "10dB"}; | ||
| 64 | static const char *stac9766_boost2[] = {"0dB", "20dB"}; | ||
| 65 | static const char *stac9766_stereo_mic[] = {"Off", "On"}; | ||
| 66 | |||
| 67 | static const struct soc_enum stac9766_record_enum = | ||
| 68 | SOC_ENUM_DOUBLE(AC97_REC_SEL, 8, 0, 8, stac9766_record_mux); | ||
| 69 | static const struct soc_enum stac9766_mono_enum = | ||
| 70 | SOC_ENUM_SINGLE(AC97_GENERAL_PURPOSE, 9, 2, stac9766_mono_mux); | ||
| 71 | static const struct soc_enum stac9766_mic_enum = | ||
| 72 | SOC_ENUM_SINGLE(AC97_GENERAL_PURPOSE, 8, 2, stac9766_mic_mux); | ||
| 73 | static const struct soc_enum stac9766_SPDIF_enum = | ||
| 74 | SOC_ENUM_SINGLE(AC97_STAC_DA_CONTROL, 1, 2, stac9766_SPDIF_mux); | ||
| 75 | static const struct soc_enum stac9766_popbypass_enum = | ||
| 76 | SOC_ENUM_SINGLE(AC97_GENERAL_PURPOSE, 15, 2, stac9766_popbypass_mux); | ||
| 77 | static const struct soc_enum stac9766_record_all_enum = | ||
| 78 | SOC_ENUM_SINGLE(AC97_STAC_ANALOG_SPECIAL, 12, 2, | ||
| 79 | stac9766_record_all_mux); | ||
| 80 | static const struct soc_enum stac9766_boost1_enum = | ||
| 81 | SOC_ENUM_SINGLE(AC97_MIC, 6, 2, stac9766_boost1); /* 0/10dB */ | ||
| 82 | static const struct soc_enum stac9766_boost2_enum = | ||
| 83 | SOC_ENUM_SINGLE(AC97_STAC_ANALOG_SPECIAL, 2, 2, stac9766_boost2); /* 0/20dB */ | ||
| 84 | static const struct soc_enum stac9766_stereo_mic_enum = | ||
| 85 | SOC_ENUM_SINGLE(AC97_STAC_STEREO_MIC, 2, 1, stac9766_stereo_mic); | ||
| 86 | |||
| 87 | static const DECLARE_TLV_DB_LINEAR(master_tlv, -4600, 0); | ||
| 88 | static const DECLARE_TLV_DB_LINEAR(record_tlv, 0, 2250); | ||
| 89 | static const DECLARE_TLV_DB_LINEAR(beep_tlv, -4500, 0); | ||
| 90 | static const DECLARE_TLV_DB_LINEAR(mix_tlv, -3450, 1200); | ||
| 91 | |||
| 92 | static const struct snd_kcontrol_new stac9766_snd_ac97_controls[] = { | ||
| 93 | SOC_DOUBLE_TLV("Speaker Volume", AC97_MASTER, 8, 0, 31, 1, master_tlv), | ||
| 94 | SOC_SINGLE("Speaker Switch", AC97_MASTER, 15, 1, 1), | ||
| 95 | SOC_DOUBLE_TLV("Headphone Volume", AC97_HEADPHONE, 8, 0, 31, 1, | ||
| 96 | master_tlv), | ||
| 97 | SOC_SINGLE("Headphone Switch", AC97_HEADPHONE, 15, 1, 1), | ||
| 98 | SOC_SINGLE_TLV("Mono Out Volume", AC97_MASTER_MONO, 0, 31, 1, | ||
| 99 | master_tlv), | ||
| 100 | SOC_SINGLE("Mono Out Switch", AC97_MASTER_MONO, 15, 1, 1), | ||
| 101 | |||
| 102 | SOC_DOUBLE_TLV("Record Volume", AC97_REC_GAIN, 8, 0, 15, 0, record_tlv), | ||
| 103 | SOC_SINGLE("Record Switch", AC97_REC_GAIN, 15, 1, 1), | ||
| 104 | |||
| 105 | |||
| 106 | SOC_SINGLE_TLV("Beep Volume", AC97_PC_BEEP, 1, 15, 1, beep_tlv), | ||
| 107 | SOC_SINGLE("Beep Switch", AC97_PC_BEEP, 15, 1, 1), | ||
| 108 | SOC_SINGLE("Beep Frequency", AC97_PC_BEEP, 5, 127, 1), | ||
| 109 | SOC_SINGLE_TLV("Phone Volume", AC97_PHONE, 0, 31, 1, mix_tlv), | ||
| 110 | SOC_SINGLE("Phone Switch", AC97_PHONE, 15, 1, 1), | ||
| 111 | |||
| 112 | SOC_ENUM("Mic Boost1", stac9766_boost1_enum), | ||
| 113 | SOC_ENUM("Mic Boost2", stac9766_boost2_enum), | ||
| 114 | SOC_SINGLE_TLV("Mic Volume", AC97_MIC, 0, 31, 1, mix_tlv), | ||
| 115 | SOC_SINGLE("Mic Switch", AC97_MIC, 15, 1, 1), | ||
| 116 | SOC_ENUM("Stereo Mic", stac9766_stereo_mic_enum), | ||
| 117 | |||
| 118 | SOC_DOUBLE_TLV("Line Volume", AC97_LINE, 8, 0, 31, 1, mix_tlv), | ||
| 119 | SOC_SINGLE("Line Switch", AC97_LINE, 15, 1, 1), | ||
| 120 | SOC_DOUBLE_TLV("CD Volume", AC97_CD, 8, 0, 31, 1, mix_tlv), | ||
| 121 | SOC_SINGLE("CD Switch", AC97_CD, 15, 1, 1), | ||
| 122 | SOC_DOUBLE_TLV("AUX Volume", AC97_AUX, 8, 0, 31, 1, mix_tlv), | ||
| 123 | SOC_SINGLE("AUX Switch", AC97_AUX, 15, 1, 1), | ||
| 124 | SOC_DOUBLE_TLV("Video Volume", AC97_VIDEO, 8, 0, 31, 1, mix_tlv), | ||
| 125 | SOC_SINGLE("Video Switch", AC97_VIDEO, 15, 1, 1), | ||
| 126 | |||
| 127 | SOC_DOUBLE_TLV("DAC Volume", AC97_PCM, 8, 0, 31, 1, mix_tlv), | ||
| 128 | SOC_SINGLE("DAC Switch", AC97_PCM, 15, 1, 1), | ||
| 129 | SOC_SINGLE("Loopback Test Switch", AC97_GENERAL_PURPOSE, 7, 1, 0), | ||
| 130 | SOC_SINGLE("3D Volume", AC97_3D_CONTROL, 3, 2, 1), | ||
| 131 | SOC_SINGLE("3D Switch", AC97_GENERAL_PURPOSE, 13, 1, 0), | ||
| 132 | |||
| 133 | SOC_ENUM("SPDIF Mux", stac9766_SPDIF_enum), | ||
| 134 | SOC_ENUM("Mic1/2 Mux", stac9766_mic_enum), | ||
| 135 | SOC_ENUM("Record All Mux", stac9766_record_all_enum), | ||
| 136 | SOC_ENUM("Record Mux", stac9766_record_enum), | ||
| 137 | SOC_ENUM("Mono Mux", stac9766_mono_enum), | ||
| 138 | SOC_ENUM("Pop Bypass Mux", stac9766_popbypass_enum), | ||
| 139 | }; | ||
| 140 | |||
| 141 | static int stac9766_ac97_write(struct snd_soc_codec *codec, unsigned int reg, | ||
| 142 | unsigned int val) | ||
| 143 | { | ||
| 144 | u16 *cache = codec->reg_cache; | ||
| 145 | |||
| 146 | if (reg > AC97_STAC_PAGE0) { | ||
| 147 | stac9766_ac97_write(codec, AC97_INT_PAGING, 0); | ||
| 148 | soc_ac97_ops.write(codec->ac97, reg, val); | ||
| 149 | stac9766_ac97_write(codec, AC97_INT_PAGING, 1); | ||
| 150 | return 0; | ||
| 151 | } | ||
| 152 | if (reg / 2 > ARRAY_SIZE(stac9766_reg)) | ||
| 153 | return -EIO; | ||
| 154 | |||
| 155 | soc_ac97_ops.write(codec->ac97, reg, val); | ||
| 156 | cache[reg / 2] = val; | ||
| 157 | return 0; | ||
| 158 | } | ||
| 159 | |||
| 160 | static unsigned int stac9766_ac97_read(struct snd_soc_codec *codec, | ||
| 161 | unsigned int reg) | ||
| 162 | { | ||
| 163 | u16 val = 0, *cache = codec->reg_cache; | ||
| 164 | |||
| 165 | if (reg > AC97_STAC_PAGE0) { | ||
| 166 | stac9766_ac97_write(codec, AC97_INT_PAGING, 0); | ||
| 167 | val = soc_ac97_ops.read(codec->ac97, reg - AC97_STAC_PAGE0); | ||
| 168 | stac9766_ac97_write(codec, AC97_INT_PAGING, 1); | ||
| 169 | return val; | ||
| 170 | } | ||
| 171 | if (reg / 2 > ARRAY_SIZE(stac9766_reg)) | ||
| 172 | return -EIO; | ||
| 173 | |||
| 174 | if (reg == AC97_RESET || reg == AC97_GPIO_STATUS || | ||
| 175 | reg == AC97_INT_PAGING || reg == AC97_VENDOR_ID1 || | ||
| 176 | reg == AC97_VENDOR_ID2) { | ||
| 177 | |||
| 178 | val = soc_ac97_ops.read(codec->ac97, reg); | ||
| 179 | return val; | ||
| 180 | } | ||
| 181 | return cache[reg / 2]; | ||
| 182 | } | ||
| 183 | |||
| 184 | static int ac97_analog_prepare(struct snd_pcm_substream *substream, | ||
| 185 | struct snd_soc_dai *dai) | ||
| 186 | { | ||
| 187 | struct snd_soc_codec *codec = dai->codec; | ||
| 188 | struct snd_pcm_runtime *runtime = substream->runtime; | ||
| 189 | unsigned short reg, vra; | ||
| 190 | |||
| 191 | vra = stac9766_ac97_read(codec, AC97_EXTENDED_STATUS); | ||
| 192 | |||
| 193 | vra |= 0x1; /* enable variable rate audio */ | ||
| 194 | |||
| 195 | stac9766_ac97_write(codec, AC97_EXTENDED_STATUS, vra); | ||
| 196 | |||
| 197 | if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) | ||
| 198 | reg = AC97_PCM_FRONT_DAC_RATE; | ||
| 199 | else | ||
| 200 | reg = AC97_PCM_LR_ADC_RATE; | ||
| 201 | |||
| 202 | return stac9766_ac97_write(codec, reg, runtime->rate); | ||
| 203 | } | ||
| 204 | |||
| 205 | static int ac97_digital_prepare(struct snd_pcm_substream *substream, | ||
| 206 | struct snd_soc_dai *dai) | ||
| 207 | { | ||
| 208 | struct snd_soc_codec *codec = dai->codec; | ||
| 209 | struct snd_pcm_runtime *runtime = substream->runtime; | ||
| 210 | unsigned short reg, vra; | ||
| 211 | |||
| 212 | stac9766_ac97_write(codec, AC97_SPDIF, 0x2002); | ||
| 213 | |||
| 214 | vra = stac9766_ac97_read(codec, AC97_EXTENDED_STATUS); | ||
| 215 | vra |= 0x5; /* Enable VRA and SPDIF out */ | ||
| 216 | |||
| 217 | stac9766_ac97_write(codec, AC97_EXTENDED_STATUS, vra); | ||
| 218 | |||
| 219 | reg = AC97_PCM_FRONT_DAC_RATE; | ||
| 220 | |||
| 221 | return stac9766_ac97_write(codec, reg, runtime->rate); | ||
| 222 | } | ||
| 223 | |||
| 224 | static int ac97_digital_trigger(struct snd_pcm_substream *substream, | ||
| 225 | int cmd, struct snd_soc_dai *dai) | ||
| 226 | { | ||
| 227 | struct snd_soc_codec *codec = dai->codec; | ||
| 228 | unsigned short vra; | ||
| 229 | |||
| 230 | switch (cmd) { | ||
| 231 | case SNDRV_PCM_TRIGGER_STOP: | ||
| 232 | vra = stac9766_ac97_read(codec, AC97_EXTENDED_STATUS); | ||
| 233 | vra &= !0x04; | ||
| 234 | stac9766_ac97_write(codec, AC97_EXTENDED_STATUS, vra); | ||
| 235 | break; | ||
| 236 | } | ||
| 237 | return 0; | ||
| 238 | } | ||
| 239 | |||
| 240 | static int stac9766_set_bias_level(struct snd_soc_codec *codec, | ||
| 241 | enum snd_soc_bias_level level) | ||
| 242 | { | ||
| 243 | switch (level) { | ||
| 244 | case SND_SOC_BIAS_ON: /* full On */ | ||
| 245 | case SND_SOC_BIAS_PREPARE: /* partial On */ | ||
| 246 | case SND_SOC_BIAS_STANDBY: /* Off, with power */ | ||
| 247 | stac9766_ac97_write(codec, AC97_POWERDOWN, 0x0000); | ||
| 248 | break; | ||
| 249 | case SND_SOC_BIAS_OFF: /* Off, without power */ | ||
| 250 | /* disable everything including AC link */ | ||
| 251 | stac9766_ac97_write(codec, AC97_POWERDOWN, 0xffff); | ||
| 252 | break; | ||
| 253 | } | ||
| 254 | codec->bias_level = level; | ||
| 255 | return 0; | ||
| 256 | } | ||
| 257 | |||
| 258 | static int stac9766_reset(struct snd_soc_codec *codec, int try_warm) | ||
| 259 | { | ||
| 260 | if (try_warm && soc_ac97_ops.warm_reset) { | ||
| 261 | soc_ac97_ops.warm_reset(codec->ac97); | ||
| 262 | if (stac9766_ac97_read(codec, 0) == stac9766_reg[0]) | ||
| 263 | return 1; | ||
| 264 | } | ||
| 265 | |||
| 266 | soc_ac97_ops.reset(codec->ac97); | ||
| 267 | if (soc_ac97_ops.warm_reset) | ||
| 268 | soc_ac97_ops.warm_reset(codec->ac97); | ||
| 269 | if (stac9766_ac97_read(codec, 0) != stac9766_reg[0]) | ||
| 270 | return -EIO; | ||
| 271 | return 0; | ||
| 272 | } | ||
| 273 | |||
| 274 | static int stac9766_codec_suspend(struct platform_device *pdev, | ||
| 275 | pm_message_t state) | ||
| 276 | { | ||
| 277 | struct snd_soc_device *socdev = platform_get_drvdata(pdev); | ||
| 278 | struct snd_soc_codec *codec = socdev->card->codec; | ||
| 279 | |||
| 280 | stac9766_set_bias_level(codec, SND_SOC_BIAS_OFF); | ||
| 281 | return 0; | ||
| 282 | } | ||
| 283 | |||
| 284 | static int stac9766_codec_resume(struct platform_device *pdev) | ||
| 285 | { | ||
| 286 | struct snd_soc_device *socdev = platform_get_drvdata(pdev); | ||
| 287 | struct snd_soc_codec *codec = socdev->card->codec; | ||
| 288 | u16 id, reset; | ||
| 289 | |||
| 290 | reset = 0; | ||
| 291 | /* give the codec an AC97 warm reset to start the link */ | ||
| 292 | reset: | ||
| 293 | if (reset > 5) { | ||
| 294 | printk(KERN_ERR "stac9766 failed to resume"); | ||
| 295 | return -EIO; | ||
| 296 | } | ||
| 297 | codec->ac97->bus->ops->warm_reset(codec->ac97); | ||
| 298 | id = soc_ac97_ops.read(codec->ac97, AC97_VENDOR_ID2); | ||
| 299 | if (id != 0x4c13) { | ||
| 300 | stac9766_reset(codec, 0); | ||
| 301 | reset++; | ||
| 302 | goto reset; | ||
| 303 | } | ||
| 304 | stac9766_set_bias_level(codec, SND_SOC_BIAS_STANDBY); | ||
| 305 | |||
| 306 | if (codec->suspend_bias_level == SND_SOC_BIAS_ON) | ||
| 307 | stac9766_set_bias_level(codec, SND_SOC_BIAS_ON); | ||
| 308 | |||
| 309 | return 0; | ||
| 310 | } | ||
| 311 | |||
| 312 | static struct snd_soc_dai_ops stac9766_dai_ops_analog = { | ||
| 313 | .prepare = ac97_analog_prepare, | ||
| 314 | }; | ||
| 315 | |||
| 316 | static struct snd_soc_dai_ops stac9766_dai_ops_digital = { | ||
| 317 | .prepare = ac97_digital_prepare, | ||
| 318 | .trigger = ac97_digital_trigger, | ||
| 319 | }; | ||
| 320 | |||
| 321 | struct snd_soc_dai stac9766_dai[] = { | ||
| 322 | { | ||
| 323 | .name = "stac9766 analog", | ||
| 324 | .id = 0, | ||
| 325 | .ac97_control = 1, | ||
| 326 | |||
| 327 | /* stream cababilities */ | ||
| 328 | .playback = { | ||
| 329 | .stream_name = "stac9766 analog", | ||
| 330 | .channels_min = 1, | ||
| 331 | .channels_max = 2, | ||
| 332 | .rates = SNDRV_PCM_RATE_8000_48000, | ||
| 333 | .formats = SND_SOC_STD_AC97_FMTS, | ||
| 334 | }, | ||
| 335 | .capture = { | ||
| 336 | .stream_name = "stac9766 analog", | ||
| 337 | .channels_min = 1, | ||
| 338 | .channels_max = 2, | ||
| 339 | .rates = SNDRV_PCM_RATE_8000_48000, | ||
| 340 | .formats = SND_SOC_STD_AC97_FMTS, | ||
| 341 | }, | ||
| 342 | /* alsa ops */ | ||
| 343 | .ops = &stac9766_dai_ops_analog, | ||
| 344 | }, | ||
| 345 | { | ||
| 346 | .name = "stac9766 IEC958", | ||
| 347 | .id = 1, | ||
| 348 | .ac97_control = 1, | ||
| 349 | |||
| 350 | /* stream cababilities */ | ||
| 351 | .playback = { | ||
| 352 | .stream_name = "stac9766 IEC958", | ||
| 353 | .channels_min = 1, | ||
| 354 | .channels_max = 2, | ||
| 355 | .rates = SNDRV_PCM_RATE_32000 | \ | ||
| 356 | SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000, | ||
| 357 | .formats = SNDRV_PCM_FORMAT_IEC958_SUBFRAME_BE, | ||
| 358 | }, | ||
| 359 | /* alsa ops */ | ||
| 360 | .ops = &stac9766_dai_ops_digital, | ||
| 361 | } | ||
| 362 | }; | ||
| 363 | EXPORT_SYMBOL_GPL(stac9766_dai); | ||
| 364 | |||
| 365 | static int stac9766_codec_probe(struct platform_device *pdev) | ||
| 366 | { | ||
| 367 | struct snd_soc_device *socdev = platform_get_drvdata(pdev); | ||
| 368 | struct snd_soc_codec *codec; | ||
| 369 | int ret = 0; | ||
| 370 | |||
| 371 | printk(KERN_INFO "STAC9766 SoC Audio Codec %s\n", STAC9766_VERSION); | ||
| 372 | |||
| 373 | socdev->card->codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL); | ||
| 374 | if (socdev->card->codec == NULL) | ||
| 375 | return -ENOMEM; | ||
| 376 | codec = socdev->card->codec; | ||
| 377 | mutex_init(&codec->mutex); | ||
| 378 | |||
| 379 | codec->reg_cache = kmemdup(stac9766_reg, sizeof(stac9766_reg), | ||
| 380 | GFP_KERNEL); | ||
| 381 | if (codec->reg_cache == NULL) { | ||
| 382 | ret = -ENOMEM; | ||
| 383 | goto cache_err; | ||
| 384 | } | ||
| 385 | codec->reg_cache_size = sizeof(stac9766_reg); | ||
| 386 | codec->reg_cache_step = 2; | ||
| 387 | |||
| 388 | codec->name = "STAC9766"; | ||
| 389 | codec->owner = THIS_MODULE; | ||
| 390 | codec->dai = stac9766_dai; | ||
| 391 | codec->num_dai = ARRAY_SIZE(stac9766_dai); | ||
| 392 | codec->write = stac9766_ac97_write; | ||
| 393 | codec->read = stac9766_ac97_read; | ||
| 394 | codec->set_bias_level = stac9766_set_bias_level; | ||
| 395 | INIT_LIST_HEAD(&codec->dapm_widgets); | ||
| 396 | INIT_LIST_HEAD(&codec->dapm_paths); | ||
| 397 | |||
| 398 | ret = snd_soc_new_ac97_codec(codec, &soc_ac97_ops, 0); | ||
| 399 | if (ret < 0) | ||
| 400 | goto codec_err; | ||
| 401 | |||
| 402 | /* register pcms */ | ||
| 403 | ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1); | ||
| 404 | if (ret < 0) | ||
| 405 | goto pcm_err; | ||
| 406 | |||
| 407 | /* do a cold reset for the controller and then try | ||
| 408 | * a warm reset followed by an optional cold reset for codec */ | ||
| 409 | stac9766_reset(codec, 0); | ||
| 410 | ret = stac9766_reset(codec, 1); | ||
| 411 | if (ret < 0) { | ||
| 412 | printk(KERN_ERR "Failed to reset STAC9766: AC97 link error\n"); | ||
| 413 | goto reset_err; | ||
| 414 | } | ||
| 415 | |||
| 416 | stac9766_set_bias_level(codec, SND_SOC_BIAS_STANDBY); | ||
| 417 | |||
| 418 | snd_soc_add_controls(codec, stac9766_snd_ac97_controls, | ||
| 419 | ARRAY_SIZE(stac9766_snd_ac97_controls)); | ||
| 420 | |||
| 421 | ret = snd_soc_init_card(socdev); | ||
| 422 | if (ret < 0) | ||
| 423 | goto reset_err; | ||
| 424 | return 0; | ||
| 425 | |||
| 426 | reset_err: | ||
| 427 | snd_soc_free_pcms(socdev); | ||
| 428 | pcm_err: | ||
| 429 | snd_soc_free_ac97_codec(codec); | ||
| 430 | codec_err: | ||
| 431 | kfree(codec->private_data); | ||
| 432 | cache_err: | ||
| 433 | kfree(socdev->card->codec); | ||
| 434 | socdev->card->codec = NULL; | ||
| 435 | return ret; | ||
| 436 | } | ||
| 437 | |||
| 438 | static int stac9766_codec_remove(struct platform_device *pdev) | ||
| 439 | { | ||
| 440 | struct snd_soc_device *socdev = platform_get_drvdata(pdev); | ||
| 441 | struct snd_soc_codec *codec = socdev->card->codec; | ||
| 442 | |||
| 443 | if (codec == NULL) | ||
| 444 | return 0; | ||
| 445 | |||
| 446 | snd_soc_free_pcms(socdev); | ||
| 447 | snd_soc_free_ac97_codec(codec); | ||
| 448 | kfree(codec->reg_cache); | ||
| 449 | kfree(codec); | ||
| 450 | return 0; | ||
| 451 | } | ||
| 452 | |||
| 453 | struct snd_soc_codec_device soc_codec_dev_stac9766 = { | ||
| 454 | .probe = stac9766_codec_probe, | ||
| 455 | .remove = stac9766_codec_remove, | ||
| 456 | .suspend = stac9766_codec_suspend, | ||
| 457 | .resume = stac9766_codec_resume, | ||
| 458 | }; | ||
| 459 | EXPORT_SYMBOL_GPL(soc_codec_dev_stac9766); | ||
| 460 | |||
| 461 | MODULE_DESCRIPTION("ASoC stac9766 driver"); | ||
| 462 | MODULE_AUTHOR("Jon Smirl <jonsmirl@gmail.com>"); | ||
| 463 | MODULE_LICENSE("GPL"); | ||
