1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/module.h>
15#include <linux/moduleparam.h>
16#include <linux/init.h>
17#include <linux/delay.h>
18#include <linux/pm.h>
19#include <linux/i2c.h>
20#include <linux/regulator/consumer.h>
21#include <linux/slab.h>
22#include <linux/of_device.h>
23#include <sound/core.h>
24#include <sound/pcm.h>
25#include <sound/pcm_params.h>
26#include <sound/soc.h>
27#include <sound/initval.h>
28#include <sound/tlv.h>
29
30#include "wm8523.h"
31
32#define WM8523_NUM_SUPPLIES 2
33static const char *wm8523_supply_names[WM8523_NUM_SUPPLIES] = {
34 "AVDD",
35 "LINEVDD",
36};
37
38#define WM8523_NUM_RATES 7
39
40
41struct wm8523_priv {
42 enum snd_soc_control_type control_type;
43 struct regulator_bulk_data supplies[WM8523_NUM_SUPPLIES];
44 unsigned int sysclk;
45 unsigned int rate_constraint_list[WM8523_NUM_RATES];
46 struct snd_pcm_hw_constraint_list rate_constraint;
47};
48
49static const u16 wm8523_reg[WM8523_REGISTER_COUNT] = {
50 0x8523,
51 0x0001,
52 0x0000,
53 0x1812,
54 0x0000,
55 0x0001,
56 0x0190,
57 0x0190,
58 0x0000,
59};
60
61static int wm8523_volatile_register(struct snd_soc_codec *codec, unsigned int reg)
62{
63 switch (reg) {
64 case WM8523_DEVICE_ID:
65 case WM8523_REVISION:
66 return 1;
67 default:
68 return 0;
69 }
70}
71
72static int wm8523_reset(struct snd_soc_codec *codec)
73{
74 return snd_soc_write(codec, WM8523_DEVICE_ID, 0);
75}
76
77static const DECLARE_TLV_DB_SCALE(dac_tlv, -10000, 25, 0);
78
79static const char *wm8523_zd_count_text[] = {
80 "1024",
81 "2048",
82};
83
84static const struct soc_enum wm8523_zc_count =
85 SOC_ENUM_SINGLE(WM8523_ZERO_DETECT, 0, 2, wm8523_zd_count_text);
86
87static const struct snd_kcontrol_new wm8523_controls[] = {
88SOC_DOUBLE_R_TLV("Playback Volume", WM8523_DAC_GAINL, WM8523_DAC_GAINR,
89 0, 448, 0, dac_tlv),
90SOC_SINGLE("ZC Switch", WM8523_DAC_CTRL3, 4, 1, 0),
91SOC_SINGLE("Playback Deemphasis Switch", WM8523_AIF_CTRL1, 8, 1, 0),
92SOC_DOUBLE("Playback Switch", WM8523_DAC_CTRL3, 2, 3, 1, 1),
93SOC_SINGLE("Volume Ramp Up Switch", WM8523_DAC_CTRL3, 1, 1, 0),
94SOC_SINGLE("Volume Ramp Down Switch", WM8523_DAC_CTRL3, 0, 1, 0),
95SOC_ENUM("Zero Detect Count", wm8523_zc_count),
96};
97
98static const struct snd_soc_dapm_widget wm8523_dapm_widgets[] = {
99SND_SOC_DAPM_DAC("DAC", "Playback", SND_SOC_NOPM, 0, 0),
100SND_SOC_DAPM_OUTPUT("LINEVOUTL"),
101SND_SOC_DAPM_OUTPUT("LINEVOUTR"),
102};
103
104static const struct snd_soc_dapm_route wm8523_dapm_routes[] = {
105 { "LINEVOUTL", NULL, "DAC" },
106 { "LINEVOUTR", NULL, "DAC" },
107};
108
109static struct {
110 int value;
111 int ratio;
112} lrclk_ratios[WM8523_NUM_RATES] = {
113 { 1, 128 },
114 { 2, 192 },
115 { 3, 256 },
116 { 4, 384 },
117 { 5, 512 },
118 { 6, 768 },
119 { 7, 1152 },
120};
121
122static int wm8523_startup(struct snd_pcm_substream *substream,
123 struct snd_soc_dai *dai)
124{
125 struct snd_soc_codec *codec = dai->codec;
126 struct wm8523_priv *wm8523 = snd_soc_codec_get_drvdata(codec);
127
128
129
130
131 if (!wm8523->sysclk) {
132 dev_err(codec->dev,
133 "No MCLK configured, call set_sysclk() on init\n");
134 return -EINVAL;
135 }
136
137 snd_pcm_hw_constraint_list(substream->runtime, 0,
138 SNDRV_PCM_HW_PARAM_RATE,
139 &wm8523->rate_constraint);
140
141 return 0;
142}
143
144static int wm8523_hw_params(struct snd_pcm_substream *substream,
145 struct snd_pcm_hw_params *params,
146 struct snd_soc_dai *dai)
147{
148 struct snd_soc_pcm_runtime *rtd = substream->private_data;
149 struct snd_soc_codec *codec = rtd->codec;
150 struct wm8523_priv *wm8523 = snd_soc_codec_get_drvdata(codec);
151 int i;
152 u16 aifctrl1 = snd_soc_read(codec, WM8523_AIF_CTRL1);
153 u16 aifctrl2 = snd_soc_read(codec, WM8523_AIF_CTRL2);
154
155
156 for (i = 0; i < ARRAY_SIZE(lrclk_ratios); i++) {
157 if (wm8523->sysclk / params_rate(params) ==
158 lrclk_ratios[i].ratio)
159 break;
160 }
161
162
163 if (i == ARRAY_SIZE(lrclk_ratios)) {
164 dev_err(codec->dev, "MCLK/fs ratio %d unsupported\n",
165 wm8523->sysclk / params_rate(params));
166 return -EINVAL;
167 }
168
169 aifctrl2 &= ~WM8523_SR_MASK;
170 aifctrl2 |= lrclk_ratios[i].value;
171
172 aifctrl1 &= ~WM8523_WL_MASK;
173 switch (params_format(params)) {
174 case SNDRV_PCM_FORMAT_S16_LE:
175 break;
176 case SNDRV_PCM_FORMAT_S20_3LE:
177 aifctrl1 |= 0x8;
178 break;
179 case SNDRV_PCM_FORMAT_S24_LE:
180 aifctrl1 |= 0x10;
181 break;
182 case SNDRV_PCM_FORMAT_S32_LE:
183 aifctrl1 |= 0x18;
184 break;
185 }
186
187 snd_soc_write(codec, WM8523_AIF_CTRL1, aifctrl1);
188 snd_soc_write(codec, WM8523_AIF_CTRL2, aifctrl2);
189
190 return 0;
191}
192
193static int wm8523_set_dai_sysclk(struct snd_soc_dai *codec_dai,
194 int clk_id, unsigned int freq, int dir)
195{
196 struct snd_soc_codec *codec = codec_dai->codec;
197 struct wm8523_priv *wm8523 = snd_soc_codec_get_drvdata(codec);
198 unsigned int val;
199 int i;
200
201 wm8523->sysclk = freq;
202
203 wm8523->rate_constraint.count = 0;
204 for (i = 0; i < ARRAY_SIZE(lrclk_ratios); i++) {
205 val = freq / lrclk_ratios[i].ratio;
206
207
208
209
210 switch (val) {
211 case 8000:
212 case 11025:
213 case 16000:
214 case 22050:
215 case 32000:
216 case 44100:
217 case 48000:
218 case 64000:
219 case 88200:
220 case 96000:
221 case 176400:
222 case 192000:
223 dev_dbg(codec->dev, "Supported sample rate: %dHz\n",
224 val);
225 wm8523->rate_constraint_list[i] = val;
226 wm8523->rate_constraint.count++;
227 break;
228 default:
229 dev_dbg(codec->dev, "Skipping sample rate: %dHz\n",
230 val);
231 }
232 }
233
234
235 if (wm8523->rate_constraint.count == 0)
236 return -EINVAL;
237
238 return 0;
239}
240
241
242static int wm8523_set_dai_fmt(struct snd_soc_dai *codec_dai,
243 unsigned int fmt)
244{
245 struct snd_soc_codec *codec = codec_dai->codec;
246 u16 aifctrl1 = snd_soc_read(codec, WM8523_AIF_CTRL1);
247
248 aifctrl1 &= ~(WM8523_BCLK_INV_MASK | WM8523_LRCLK_INV_MASK |
249 WM8523_FMT_MASK | WM8523_AIF_MSTR_MASK);
250
251 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
252 case SND_SOC_DAIFMT_CBM_CFM:
253 aifctrl1 |= WM8523_AIF_MSTR;
254 break;
255 case SND_SOC_DAIFMT_CBS_CFS:
256 break;
257 default:
258 return -EINVAL;
259 }
260
261 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
262 case SND_SOC_DAIFMT_I2S:
263 aifctrl1 |= 0x0002;
264 break;
265 case SND_SOC_DAIFMT_RIGHT_J:
266 break;
267 case SND_SOC_DAIFMT_LEFT_J:
268 aifctrl1 |= 0x0001;
269 break;
270 case SND_SOC_DAIFMT_DSP_A:
271 aifctrl1 |= 0x0003;
272 break;
273 case SND_SOC_DAIFMT_DSP_B:
274 aifctrl1 |= 0x0023;
275 break;
276 default:
277 return -EINVAL;
278 }
279
280 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
281 case SND_SOC_DAIFMT_NB_NF:
282 break;
283 case SND_SOC_DAIFMT_IB_IF:
284 aifctrl1 |= WM8523_BCLK_INV | WM8523_LRCLK_INV;
285 break;
286 case SND_SOC_DAIFMT_IB_NF:
287 aifctrl1 |= WM8523_BCLK_INV;
288 break;
289 case SND_SOC_DAIFMT_NB_IF:
290 aifctrl1 |= WM8523_LRCLK_INV;
291 break;
292 default:
293 return -EINVAL;
294 }
295
296 snd_soc_write(codec, WM8523_AIF_CTRL1, aifctrl1);
297
298 return 0;
299}
300
301static int wm8523_set_bias_level(struct snd_soc_codec *codec,
302 enum snd_soc_bias_level level)
303{
304 struct wm8523_priv *wm8523 = snd_soc_codec_get_drvdata(codec);
305 u16 *reg_cache = codec->reg_cache;
306 int ret, i;
307
308 switch (level) {
309 case SND_SOC_BIAS_ON:
310 break;
311
312 case SND_SOC_BIAS_PREPARE:
313
314 snd_soc_update_bits(codec, WM8523_PSCTRL1,
315 WM8523_SYS_ENA_MASK, 3);
316 break;
317
318 case SND_SOC_BIAS_STANDBY:
319 if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
320 ret = regulator_bulk_enable(ARRAY_SIZE(wm8523->supplies),
321 wm8523->supplies);
322 if (ret != 0) {
323 dev_err(codec->dev,
324 "Failed to enable supplies: %d\n",
325 ret);
326 return ret;
327 }
328
329
330 snd_soc_update_bits(codec, WM8523_PSCTRL1,
331 WM8523_SYS_ENA_MASK, 1);
332
333
334 for (i = WM8523_AIF_CTRL1;
335 i < WM8523_MAX_REGISTER; i++)
336 snd_soc_write(codec, i, reg_cache[i]);
337
338
339 msleep(100);
340 }
341
342
343 snd_soc_update_bits(codec, WM8523_PSCTRL1,
344 WM8523_SYS_ENA_MASK, 2);
345
346 break;
347
348 case SND_SOC_BIAS_OFF:
349
350 snd_soc_update_bits(codec, WM8523_PSCTRL1,
351 WM8523_SYS_ENA_MASK, 0);
352 msleep(100);
353
354 regulator_bulk_disable(ARRAY_SIZE(wm8523->supplies),
355 wm8523->supplies);
356 break;
357 }
358 codec->dapm.bias_level = level;
359 return 0;
360}
361
362#define WM8523_RATES SNDRV_PCM_RATE_8000_192000
363
364#define WM8523_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
365 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE)
366
367static const struct snd_soc_dai_ops wm8523_dai_ops = {
368 .startup = wm8523_startup,
369 .hw_params = wm8523_hw_params,
370 .set_sysclk = wm8523_set_dai_sysclk,
371 .set_fmt = wm8523_set_dai_fmt,
372};
373
374static struct snd_soc_dai_driver wm8523_dai = {
375 .name = "wm8523-hifi",
376 .playback = {
377 .stream_name = "Playback",
378 .channels_min = 2,
379 .channels_max = 2,
380 .rates = WM8523_RATES,
381 .formats = WM8523_FORMATS,
382 },
383 .ops = &wm8523_dai_ops,
384};
385
386#ifdef CONFIG_PM
387static int wm8523_suspend(struct snd_soc_codec *codec)
388{
389 wm8523_set_bias_level(codec, SND_SOC_BIAS_OFF);
390 return 0;
391}
392
393static int wm8523_resume(struct snd_soc_codec *codec)
394{
395 wm8523_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
396 return 0;
397}
398#else
399#define wm8523_suspend NULL
400#define wm8523_resume NULL
401#endif
402
403static int wm8523_probe(struct snd_soc_codec *codec)
404{
405 struct wm8523_priv *wm8523 = snd_soc_codec_get_drvdata(codec);
406 int ret, i;
407
408 wm8523->rate_constraint.list = &wm8523->rate_constraint_list[0];
409 wm8523->rate_constraint.count =
410 ARRAY_SIZE(wm8523->rate_constraint_list);
411
412 ret = snd_soc_codec_set_cache_io(codec, 8, 16, wm8523->control_type);
413 if (ret != 0) {
414 dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
415 return ret;
416 }
417
418 for (i = 0; i < ARRAY_SIZE(wm8523->supplies); i++)
419 wm8523->supplies[i].supply = wm8523_supply_names[i];
420
421 ret = regulator_bulk_get(codec->dev, ARRAY_SIZE(wm8523->supplies),
422 wm8523->supplies);
423 if (ret != 0) {
424 dev_err(codec->dev, "Failed to request supplies: %d\n", ret);
425 return ret;
426 }
427
428 ret = regulator_bulk_enable(ARRAY_SIZE(wm8523->supplies),
429 wm8523->supplies);
430 if (ret != 0) {
431 dev_err(codec->dev, "Failed to enable supplies: %d\n", ret);
432 goto err_get;
433 }
434
435 ret = snd_soc_read(codec, WM8523_DEVICE_ID);
436 if (ret < 0) {
437 dev_err(codec->dev, "Failed to read ID register\n");
438 goto err_enable;
439 }
440 if (ret != wm8523_reg[WM8523_DEVICE_ID]) {
441 dev_err(codec->dev, "Device is not a WM8523, ID is %x\n", ret);
442 ret = -EINVAL;
443 goto err_enable;
444 }
445
446 ret = snd_soc_read(codec, WM8523_REVISION);
447 if (ret < 0) {
448 dev_err(codec->dev, "Failed to read revision register\n");
449 goto err_enable;
450 }
451 dev_info(codec->dev, "revision %c\n",
452 (ret & WM8523_CHIP_REV_MASK) + 'A');
453
454 ret = wm8523_reset(codec);
455 if (ret < 0) {
456 dev_err(codec->dev, "Failed to issue reset\n");
457 goto err_enable;
458 }
459
460
461 snd_soc_update_bits(codec, WM8523_DAC_GAINR,
462 WM8523_DACR_VU, WM8523_DACR_VU);
463 snd_soc_update_bits(codec, WM8523_DAC_CTRL3, WM8523_ZC, WM8523_ZC);
464
465 wm8523_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
466
467
468 regulator_bulk_disable(ARRAY_SIZE(wm8523->supplies), wm8523->supplies);
469
470 return 0;
471
472err_enable:
473 regulator_bulk_disable(ARRAY_SIZE(wm8523->supplies), wm8523->supplies);
474err_get:
475 regulator_bulk_free(ARRAY_SIZE(wm8523->supplies), wm8523->supplies);
476
477 return ret;
478}
479
480static int wm8523_remove(struct snd_soc_codec *codec)
481{
482 struct wm8523_priv *wm8523 = snd_soc_codec_get_drvdata(codec);
483
484 wm8523_set_bias_level(codec, SND_SOC_BIAS_OFF);
485 regulator_bulk_free(ARRAY_SIZE(wm8523->supplies), wm8523->supplies);
486 return 0;
487}
488
489static struct snd_soc_codec_driver soc_codec_dev_wm8523 = {
490 .probe = wm8523_probe,
491 .remove = wm8523_remove,
492 .suspend = wm8523_suspend,
493 .resume = wm8523_resume,
494 .set_bias_level = wm8523_set_bias_level,
495 .reg_cache_size = WM8523_REGISTER_COUNT,
496 .reg_word_size = sizeof(u16),
497 .reg_cache_default = wm8523_reg,
498 .volatile_register = wm8523_volatile_register,
499
500 .controls = wm8523_controls,
501 .num_controls = ARRAY_SIZE(wm8523_controls),
502 .dapm_widgets = wm8523_dapm_widgets,
503 .num_dapm_widgets = ARRAY_SIZE(wm8523_dapm_widgets),
504 .dapm_routes = wm8523_dapm_routes,
505 .num_dapm_routes = ARRAY_SIZE(wm8523_dapm_routes),
506};
507
508static const struct of_device_id wm8523_of_match[] = {
509 { .compatible = "wlf,wm8523" },
510 { },
511};
512
513#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
514static __devinit int wm8523_i2c_probe(struct i2c_client *i2c,
515 const struct i2c_device_id *id)
516{
517 struct wm8523_priv *wm8523;
518 int ret;
519
520 wm8523 = kzalloc(sizeof(struct wm8523_priv), GFP_KERNEL);
521 if (wm8523 == NULL)
522 return -ENOMEM;
523
524 i2c_set_clientdata(i2c, wm8523);
525 wm8523->control_type = SND_SOC_I2C;
526
527 ret = snd_soc_register_codec(&i2c->dev,
528 &soc_codec_dev_wm8523, &wm8523_dai, 1);
529 if (ret < 0)
530 kfree(wm8523);
531 return ret;
532
533}
534
535static __devexit int wm8523_i2c_remove(struct i2c_client *client)
536{
537 snd_soc_unregister_codec(&client->dev);
538 kfree(i2c_get_clientdata(client));
539 return 0;
540}
541
542static const struct i2c_device_id wm8523_i2c_id[] = {
543 { "wm8523", 0 },
544 { }
545};
546MODULE_DEVICE_TABLE(i2c, wm8523_i2c_id);
547
548static struct i2c_driver wm8523_i2c_driver = {
549 .driver = {
550 .name = "wm8523",
551 .owner = THIS_MODULE,
552 .of_match_table = wm8523_of_match,
553 },
554 .probe = wm8523_i2c_probe,
555 .remove = __devexit_p(wm8523_i2c_remove),
556 .id_table = wm8523_i2c_id,
557};
558#endif
559
560static int __init wm8523_modinit(void)
561{
562 int ret;
563#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
564 ret = i2c_add_driver(&wm8523_i2c_driver);
565 if (ret != 0) {
566 printk(KERN_ERR "Failed to register WM8523 I2C driver: %d\n",
567 ret);
568 }
569#endif
570 return 0;
571}
572module_init(wm8523_modinit);
573
574static void __exit wm8523_exit(void)
575{
576#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
577 i2c_del_driver(&wm8523_i2c_driver);
578#endif
579}
580module_exit(wm8523_exit);
581
582MODULE_DESCRIPTION("ASoC WM8523 driver");
583MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
584MODULE_LICENSE("GPL");
585
