projects / linux-2.6-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
ASoC: wm*: use simple i2c probe function
[linux-2.6-block.git] / sound / soc / codecs / wm5100.c
CommitLineData
d2912cb1 1// SPDX-License-Identifier: GPL-2.0-only
6d4baf08
MB		 2/*
3 * wm5100.c -- WM5100 ALSA SoC Audio driver
4 *
656baaeb 5 * Copyright 2011-2 Wolfson Microelectronics plc
6d4baf08
MB		 6 *
7 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
6d4baf08
MB		 8 */
9
10#include <linux/module.h>
11#include <linux/moduleparam.h>
12#include <linux/init.h>
13#include <linux/delay.h>
0cf0f174 14#include <linux/export.h>
6d4baf08
MB		 15#include <linux/pm.h>
16#include <linux/gcd.h>
db1d1270 17#include <linux/gpio/driver.h>
6d4baf08
MB		 18#include <linux/gpio.h>
19#include <linux/i2c.h>
62c1c401 20#include <linux/pm_runtime.h>
6d4baf08
MB		 21#include <linux/regulator/consumer.h>
22#include <linux/regulator/fixed.h>
23#include <linux/slab.h>
24#include <sound/core.h>
25#include <sound/pcm.h>
26#include <sound/pcm_params.h>
27#include <sound/soc.h>
ba896ede 28#include <sound/jack.h>
6d4baf08
MB		 29#include <sound/initval.h>
30#include <sound/tlv.h>
31#include <sound/wm5100.h>
32
33#include "wm5100.h"
34
35#define WM5100_NUM_CORE_SUPPLIES 2
36static const char *wm5100_core_supply_names[WM5100_NUM_CORE_SUPPLIES] = {
37 "DBVDD1",
38 "LDOVDD", /* If DCVDD is supplied externally specify as LDOVDD */
39};
40
41#define WM5100_AIFS 3
42#define WM5100_SYNC_SRS 3
43
44struct wm5100_fll {
45 int fref;
46 int fout;
47 int src;
48 struct completion lock;
49};
50
51/* codec private data */
52struct wm5100_priv {
46c1a877 53 struct device *dev;
bd132ec5 54 struct regmap *regmap;
61195838 55 struct snd_soc_component *component;
6d4baf08
MB		 56
57 struct regulator_bulk_data core_supplies[WM5100_NUM_CORE_SUPPLIES];
6d4baf08
MB		 58
59 int rev;
60
61 int sysclk;
62 int asyncclk;
63
64 bool aif_async[WM5100_AIFS];
65 bool aif_symmetric[WM5100_AIFS];
66 int sr_ref[WM5100_SYNC_SRS];
67
68 bool out_ena[2];
69
ba896ede
MB		 70 struct snd_soc_jack *jack;
71 bool jack_detecting;
72 bool jack_mic;
73 int jack_mode;
2633f736 74 int jack_flips;
ba896ede 75
6d4baf08
MB		 76 struct wm5100_fll fll[2];
77
78 struct wm5100_pdata pdata;
79
80#ifdef CONFIG_GPIOLIB
81 struct gpio_chip gpio_chip;
82#endif
83};
84
85static int wm5100_sr_code[] = {
86 0,
87 12000,
88 24000,
89 48000,
90 96000,
91 192000,
92 384000,
93 768000,
94 0,
95 11025,
96 22050,
97 44100,
98 88200,
99 176400,
100 352800,
101 705600,
102 4000,
103 8000,
104 16000,
105 32000,
106 64000,
107 128000,
108 256000,
109 512000,
110};
111
112static int wm5100_sr_regs[WM5100_SYNC_SRS] = {
113 WM5100_CLOCKING_4,
114 WM5100_CLOCKING_5,
115 WM5100_CLOCKING_6,
116};
117
61195838 118static int wm5100_alloc_sr(struct snd_soc_component *component, int rate)
6d4baf08 119{
61195838 120 struct wm5100_priv *wm5100 = snd_soc_component_get_drvdata(component);
6d4baf08
MB		 121 int sr_code, sr_free, i;
122
123 for (i = 0; i < ARRAY_SIZE(wm5100_sr_code); i++)
124 if (wm5100_sr_code[i] == rate)
125 break;
126 if (i == ARRAY_SIZE(wm5100_sr_code)) {
61195838 127 dev_err(component->dev, "Unsupported sample rate: %dHz\n", rate);
6d4baf08
MB		 128 return -EINVAL;
129 }
130 sr_code = i;
131
132 if ((wm5100->sysclk % rate) == 0) {
133 /* Is this rate already in use? */
134 sr_free = -1;
135 for (i = 0; i < ARRAY_SIZE(wm5100_sr_regs); i++) {
136 if (!wm5100->sr_ref[i] && sr_free == -1) {
137 sr_free = i;
138 continue;
139 }
6d75dfc3 140 if ((snd_soc_component_read(component, wm5100_sr_regs[i]) &
6d4baf08
MB		 141 WM5100_SAMPLE_RATE_1_MASK) == sr_code)
142 break;
143 }
144
145 if (i < ARRAY_SIZE(wm5100_sr_regs)) {
146 wm5100->sr_ref[i]++;
61195838 147 dev_dbg(component->dev, "SR %dHz, slot %d, ref %d\n",
6d4baf08
MB		 148 rate, i, wm5100->sr_ref[i]);
149 return i;
150 }
151
152 if (sr_free == -1) {
61195838 153 dev_err(component->dev, "All SR slots already in use\n");
6d4baf08
MB		 154 return -EBUSY;
155 }
156
61195838 157 dev_dbg(component->dev, "Allocating SR slot %d for %dHz\n",
6d4baf08
MB		 158 sr_free, rate);
159 wm5100->sr_ref[sr_free]++;
61195838 160 snd_soc_component_update_bits(component, wm5100_sr_regs[sr_free],
6d4baf08
MB		 161 WM5100_SAMPLE_RATE_1_MASK,
162 sr_code);
163
164 return sr_free;
165
166 } else {
61195838 167 dev_err(component->dev,
6d4baf08
MB		 168 "SR %dHz incompatible with %dHz SYSCLK and %dHz ASYNCCLK\n",
169 rate, wm5100->sysclk, wm5100->asyncclk);
170 return -EINVAL;
171 }
172}
173
61195838 174static void wm5100_free_sr(struct snd_soc_component *component, int rate)
6d4baf08 175{
61195838 176 struct wm5100_priv *wm5100 = snd_soc_component_get_drvdata(component);
6d4baf08
MB		 177 int i, sr_code;
178
179 for (i = 0; i < ARRAY_SIZE(wm5100_sr_code); i++)
180 if (wm5100_sr_code[i] == rate)
181 break;
182 if (i == ARRAY_SIZE(wm5100_sr_code)) {
61195838 183 dev_err(component->dev, "Unsupported sample rate: %dHz\n", rate);
6d4baf08
MB		 184 return;
185 }
186 sr_code = wm5100_sr_code[i];
187
188 for (i = 0; i < ARRAY_SIZE(wm5100_sr_regs); i++) {
189 if (!wm5100->sr_ref[i])
190 continue;
191
6d75dfc3 192 if ((snd_soc_component_read(component, wm5100_sr_regs[i]) &
6d4baf08
MB		 193 WM5100_SAMPLE_RATE_1_MASK) == sr_code)
194 break;
195 }
196 if (i < ARRAY_SIZE(wm5100_sr_regs)) {
197 wm5100->sr_ref[i]--;
61195838 198 dev_dbg(component->dev, "Dereference SR %dHz, count now %d\n",
6d4baf08
MB		 199 rate, wm5100->sr_ref[i]);
200 } else {
61195838 201 dev_warn(component->dev, "Freeing unreferenced sample rate %dHz\n",
6d4baf08
MB		 202 rate);
203 }
204}
205
588ac5e0 206static int wm5100_reset(struct wm5100_priv *wm5100)
6d4baf08 207{
6d4baf08
MB		 208 if (wm5100->pdata.reset) {
209 gpio_set_value_cansleep(wm5100->pdata.reset, 0);
210 gpio_set_value_cansleep(wm5100->pdata.reset, 1);
211
212 return 0;
213 } else {
588ac5e0 214 return regmap_write(wm5100->regmap, WM5100_SOFTWARE_RESET, 0);
6d4baf08
MB		 215 }
216}
217
218static DECLARE_TLV_DB_SCALE(in_tlv, -6300, 100, 0);
219static DECLARE_TLV_DB_SCALE(eq_tlv, -1200, 100, 0);
220static DECLARE_TLV_DB_SCALE(mixer_tlv, -3200, 100, 0);
221static DECLARE_TLV_DB_SCALE(out_tlv, -6400, 100, 0);
222static DECLARE_TLV_DB_SCALE(digital_tlv, -6400, 50, 0);
223
224static const char *wm5100_mixer_texts[] = {
225 "None",
226 "Tone Generator 1",
227 "Tone Generator 2",
228 "AEC loopback",
229 "IN1L",
230 "IN1R",
231 "IN2L",
232 "IN2R",
233 "IN3L",
234 "IN3R",
235 "IN4L",
236 "IN4R",
237 "AIF1RX1",
238 "AIF1RX2",
239 "AIF1RX3",
240 "AIF1RX4",
241 "AIF1RX5",
242 "AIF1RX6",
243 "AIF1RX7",
244 "AIF1RX8",
245 "AIF2RX1",
246 "AIF2RX2",
247 "AIF3RX1",
248 "AIF3RX2",
249 "EQ1",
250 "EQ2",
251 "EQ3",
252 "EQ4",
253 "DRC1L",
254 "DRC1R",
255 "LHPF1",
256 "LHPF2",
257 "LHPF3",
258 "LHPF4",
259 "DSP1.1",
260 "DSP1.2",
261 "DSP1.3",
262 "DSP1.4",
263 "DSP1.5",
264 "DSP1.6",
265 "DSP2.1",
266 "DSP2.2",
267 "DSP2.3",
268 "DSP2.4",
269 "DSP2.5",
270 "DSP2.6",
271 "DSP3.1",
272 "DSP3.2",
273 "DSP3.3",
274 "DSP3.4",
275 "DSP3.5",
276 "DSP3.6",
277 "ASRC1L",
278 "ASRC1R",
279 "ASRC2L",
280 "ASRC2R",
281 "ISRC1INT1",
282 "ISRC1INT2",
283 "ISRC1INT3",
284 "ISRC1INT4",
285 "ISRC2INT1",
286 "ISRC2INT2",
287 "ISRC2INT3",
288 "ISRC2INT4",
289 "ISRC1DEC1",
290 "ISRC1DEC2",
291 "ISRC1DEC3",
292 "ISRC1DEC4",
293 "ISRC2DEC1",
294 "ISRC2DEC2",
295 "ISRC2DEC3",
296 "ISRC2DEC4",
297};
298
299static int wm5100_mixer_values[] = {
300 0x00,
301 0x04, /* Tone */
302 0x05,
303 0x08, /* AEC */
304 0x10, /* Input */
305 0x11,
306 0x12,
307 0x13,
308 0x14,
309 0x15,
310 0x16,
311 0x17,
312 0x20, /* AIF */
313 0x21,
314 0x22,
315 0x23,
316 0x24,
317 0x25,
318 0x26,
319 0x27,
320 0x28,
321 0x29,
322 0x30, /* AIF3 - check */
323 0x31,
324 0x50, /* EQ */
325 0x51,
326 0x52,
327 0x53,
328 0x54,
329 0x58, /* DRC */
330 0x59,
331 0x60, /* LHPF1 */
332 0x61, /* LHPF2 */
333 0x62, /* LHPF3 */
334 0x63, /* LHPF4 */
335 0x68, /* DSP1 */
336 0x69,
337 0x6a,
338 0x6b,
339 0x6c,
340 0x6d,
341 0x70, /* DSP2 */
342 0x71,
343 0x72,
344 0x73,
345 0x74,
346 0x75,
347 0x78, /* DSP3 */
348 0x79,
349 0x7a,
350 0x7b,
351 0x7c,
352 0x7d,
353 0x90, /* ASRC1 */
354 0x91,
355 0x92, /* ASRC2 */
356 0x93,
357 0xa0, /* ISRC1DEC1 */
358 0xa1,
359 0xa2,
360 0xa3,
361 0xa4, /* ISRC1INT1 */
362 0xa5,
363 0xa6,
364 0xa7,
365 0xa8, /* ISRC2DEC1 */
366 0xa9,
367 0xaa,
368 0xab,
369 0xac, /* ISRC2INT1 */
370 0xad,
371 0xae,
372 0xaf,
373};
374
375#define WM5100_MIXER_CONTROLS(name, base) \
376 SOC_SINGLE_TLV(name " Input 1 Volume", base + 1 , \
377 WM5100_MIXER_VOL_SHIFT, 80, 0, mixer_tlv), \
378 SOC_SINGLE_TLV(name " Input 2 Volume", base + 3 , \
379 WM5100_MIXER_VOL_SHIFT, 80, 0, mixer_tlv), \
380 SOC_SINGLE_TLV(name " Input 3 Volume", base + 5 , \
381 WM5100_MIXER_VOL_SHIFT, 80, 0, mixer_tlv), \
382 SOC_SINGLE_TLV(name " Input 4 Volume", base + 7 , \
383 WM5100_MIXER_VOL_SHIFT, 80, 0, mixer_tlv)
384
385#define WM5100_MUX_ENUM_DECL(name, reg) \
386 SOC_VALUE_ENUM_SINGLE_DECL(name, reg, 0, 0xff, \
387 wm5100_mixer_texts, wm5100_mixer_values)
388
389#define WM5100_MUX_CTL_DECL(name) \
390 const struct snd_kcontrol_new name##_mux = \
cda88669 391 SOC_DAPM_ENUM("Route", name##_enum)
6d4baf08
MB		 392
393#define WM5100_MIXER_ENUMS(name, base_reg) \
394 static WM5100_MUX_ENUM_DECL(name##_in1_enum, base_reg); \
395 static WM5100_MUX_ENUM_DECL(name##_in2_enum, base_reg + 2); \
396 static WM5100_MUX_ENUM_DECL(name##_in3_enum, base_reg + 4); \
397 static WM5100_MUX_ENUM_DECL(name##_in4_enum, base_reg + 6); \
398 static WM5100_MUX_CTL_DECL(name##_in1); \
399 static WM5100_MUX_CTL_DECL(name##_in2); \
400 static WM5100_MUX_CTL_DECL(name##_in3); \
401 static WM5100_MUX_CTL_DECL(name##_in4)
402
403WM5100_MIXER_ENUMS(HPOUT1L, WM5100_OUT1LMIX_INPUT_1_SOURCE);
404WM5100_MIXER_ENUMS(HPOUT1R, WM5100_OUT1RMIX_INPUT_1_SOURCE);
405WM5100_MIXER_ENUMS(HPOUT2L, WM5100_OUT2LMIX_INPUT_1_SOURCE);
406WM5100_MIXER_ENUMS(HPOUT2R, WM5100_OUT2RMIX_INPUT_1_SOURCE);
407WM5100_MIXER_ENUMS(HPOUT3L, WM5100_OUT3LMIX_INPUT_1_SOURCE);
408WM5100_MIXER_ENUMS(HPOUT3R, WM5100_OUT3RMIX_INPUT_1_SOURCE);
409
410WM5100_MIXER_ENUMS(SPKOUTL, WM5100_OUT4LMIX_INPUT_1_SOURCE);
411WM5100_MIXER_ENUMS(SPKOUTR, WM5100_OUT4RMIX_INPUT_1_SOURCE);
412WM5100_MIXER_ENUMS(SPKDAT1L, WM5100_OUT5LMIX_INPUT_1_SOURCE);
413WM5100_MIXER_ENUMS(SPKDAT1R, WM5100_OUT5RMIX_INPUT_1_SOURCE);
414WM5100_MIXER_ENUMS(SPKDAT2L, WM5100_OUT6LMIX_INPUT_1_SOURCE);
415WM5100_MIXER_ENUMS(SPKDAT2R, WM5100_OUT6RMIX_INPUT_1_SOURCE);
416
417WM5100_MIXER_ENUMS(PWM1, WM5100_PWM1MIX_INPUT_1_SOURCE);
418WM5100_MIXER_ENUMS(PWM2, WM5100_PWM1MIX_INPUT_1_SOURCE);
419
420WM5100_MIXER_ENUMS(AIF1TX1, WM5100_AIF1TX1MIX_INPUT_1_SOURCE);
421WM5100_MIXER_ENUMS(AIF1TX2, WM5100_AIF1TX2MIX_INPUT_1_SOURCE);
422WM5100_MIXER_ENUMS(AIF1TX3, WM5100_AIF1TX3MIX_INPUT_1_SOURCE);
423WM5100_MIXER_ENUMS(AIF1TX4, WM5100_AIF1TX4MIX_INPUT_1_SOURCE);
424WM5100_MIXER_ENUMS(AIF1TX5, WM5100_AIF1TX5MIX_INPUT_1_SOURCE);
425WM5100_MIXER_ENUMS(AIF1TX6, WM5100_AIF1TX6MIX_INPUT_1_SOURCE);
426WM5100_MIXER_ENUMS(AIF1TX7, WM5100_AIF1TX7MIX_INPUT_1_SOURCE);
427WM5100_MIXER_ENUMS(AIF1TX8, WM5100_AIF1TX8MIX_INPUT_1_SOURCE);
428
429WM5100_MIXER_ENUMS(AIF2TX1, WM5100_AIF2TX1MIX_INPUT_1_SOURCE);
430WM5100_MIXER_ENUMS(AIF2TX2, WM5100_AIF2TX2MIX_INPUT_1_SOURCE);
431
432WM5100_MIXER_ENUMS(AIF3TX1, WM5100_AIF1TX1MIX_INPUT_1_SOURCE);
433WM5100_MIXER_ENUMS(AIF3TX2, WM5100_AIF1TX2MIX_INPUT_1_SOURCE);
434
435WM5100_MIXER_ENUMS(EQ1, WM5100_EQ1MIX_INPUT_1_SOURCE);
436WM5100_MIXER_ENUMS(EQ2, WM5100_EQ2MIX_INPUT_1_SOURCE);
437WM5100_MIXER_ENUMS(EQ3, WM5100_EQ3MIX_INPUT_1_SOURCE);
438WM5100_MIXER_ENUMS(EQ4, WM5100_EQ4MIX_INPUT_1_SOURCE);
439
440WM5100_MIXER_ENUMS(DRC1L, WM5100_DRC1LMIX_INPUT_1_SOURCE);
441WM5100_MIXER_ENUMS(DRC1R, WM5100_DRC1RMIX_INPUT_1_SOURCE);
442
443WM5100_MIXER_ENUMS(LHPF1, WM5100_HPLP1MIX_INPUT_1_SOURCE);
444WM5100_MIXER_ENUMS(LHPF2, WM5100_HPLP2MIX_INPUT_1_SOURCE);
445WM5100_MIXER_ENUMS(LHPF3, WM5100_HPLP3MIX_INPUT_1_SOURCE);
446WM5100_MIXER_ENUMS(LHPF4, WM5100_HPLP4MIX_INPUT_1_SOURCE);
447
448#define WM5100_MUX(name, ctrl) \
cda88669 449 SND_SOC_DAPM_MUX(name, SND_SOC_NOPM, 0, 0, ctrl)
6d4baf08
MB		 450
451#define WM5100_MIXER_WIDGETS(name, name_str) \
452 WM5100_MUX(name_str " Input 1", &name##_in1_mux), \
453 WM5100_MUX(name_str " Input 2", &name##_in2_mux), \
454 WM5100_MUX(name_str " Input 3", &name##_in3_mux), \
455 WM5100_MUX(name_str " Input 4", &name##_in4_mux), \
456 SND_SOC_DAPM_MIXER(name_str " Mixer", SND_SOC_NOPM, 0, 0, NULL, 0)
457
458#define WM5100_MIXER_INPUT_ROUTES(name) \
459 { name, "Tone Generator 1", "Tone Generator 1" }, \
460 { name, "Tone Generator 2", "Tone Generator 2" }, \
461 { name, "IN1L", "IN1L PGA" }, \
462 { name, "IN1R", "IN1R PGA" }, \
463 { name, "IN2L", "IN2L PGA" }, \
464 { name, "IN2R", "IN2R PGA" }, \
465 { name, "IN3L", "IN3L PGA" }, \
466 { name, "IN3R", "IN3R PGA" }, \
467 { name, "IN4L", "IN4L PGA" }, \
468 { name, "IN4R", "IN4R PGA" }, \
469 { name, "AIF1RX1", "AIF1RX1" }, \
470 { name, "AIF1RX2", "AIF1RX2" }, \
471 { name, "AIF1RX3", "AIF1RX3" }, \
472 { name, "AIF1RX4", "AIF1RX4" }, \
473 { name, "AIF1RX5", "AIF1RX5" }, \
474 { name, "AIF1RX6", "AIF1RX6" }, \
475 { name, "AIF1RX7", "AIF1RX7" }, \
476 { name, "AIF1RX8", "AIF1RX8" }, \
477 { name, "AIF2RX1", "AIF2RX1" }, \
478 { name, "AIF2RX2", "AIF2RX2" }, \
479 { name, "AIF3RX1", "AIF3RX1" }, \
480 { name, "AIF3RX2", "AIF3RX2" }, \
481 { name, "EQ1", "EQ1" }, \
482 { name, "EQ2", "EQ2" }, \
483 { name, "EQ3", "EQ3" }, \
484 { name, "EQ4", "EQ4" }, \
485 { name, "DRC1L", "DRC1L" }, \
486 { name, "DRC1R", "DRC1R" }, \
487 { name, "LHPF1", "LHPF1" }, \
488 { name, "LHPF2", "LHPF2" }, \
489 { name, "LHPF3", "LHPF3" }, \
490 { name, "LHPF4", "LHPF4" }
491
492#define WM5100_MIXER_ROUTES(widget, name) \
493 { widget, NULL, name " Mixer" }, \
494 { name " Mixer", NULL, name " Input 1" }, \
495 { name " Mixer", NULL, name " Input 2" }, \
496 { name " Mixer", NULL, name " Input 3" }, \
497 { name " Mixer", NULL, name " Input 4" }, \
498 WM5100_MIXER_INPUT_ROUTES(name " Input 1"), \
499 WM5100_MIXER_INPUT_ROUTES(name " Input 2"), \
500 WM5100_MIXER_INPUT_ROUTES(name " Input 3"), \
501 WM5100_MIXER_INPUT_ROUTES(name " Input 4")
502
503static const char *wm5100_lhpf_mode_text[] = {
504 "Low-pass", "High-pass"
505};
506
0224ba6a
TI		 507static SOC_ENUM_SINGLE_DECL(wm5100_lhpf1_mode,
508 WM5100_HPLPF1_1, WM5100_LHPF1_MODE_SHIFT,
509 wm5100_lhpf_mode_text);
6d4baf08 510
0224ba6a
TI		 511static SOC_ENUM_SINGLE_DECL(wm5100_lhpf2_mode,
512 WM5100_HPLPF2_1, WM5100_LHPF2_MODE_SHIFT,
513 wm5100_lhpf_mode_text);
6d4baf08 514
0224ba6a
TI		 515static SOC_ENUM_SINGLE_DECL(wm5100_lhpf3_mode,
516 WM5100_HPLPF3_1, WM5100_LHPF3_MODE_SHIFT,
517 wm5100_lhpf_mode_text);
6d4baf08 518
0224ba6a
TI		 519static SOC_ENUM_SINGLE_DECL(wm5100_lhpf4_mode,
520 WM5100_HPLPF4_1, WM5100_LHPF4_MODE_SHIFT,
521 wm5100_lhpf_mode_text);
6d4baf08
MB		 522
523static const struct snd_kcontrol_new wm5100_snd_controls[] = {
524SOC_SINGLE("IN1 High Performance Switch", WM5100_IN1L_CONTROL,
525 WM5100_IN1_OSR_SHIFT, 1, 0),
526SOC_SINGLE("IN2 High Performance Switch", WM5100_IN2L_CONTROL,
527 WM5100_IN2_OSR_SHIFT, 1, 0),
528SOC_SINGLE("IN3 High Performance Switch", WM5100_IN3L_CONTROL,
529 WM5100_IN3_OSR_SHIFT, 1, 0),
530SOC_SINGLE("IN4 High Performance Switch", WM5100_IN4L_CONTROL,
531 WM5100_IN4_OSR_SHIFT, 1, 0),
532
533/* Only applicable for analogue inputs */
534SOC_DOUBLE_R_TLV("IN1 Volume", WM5100_IN1L_CONTROL, WM5100_IN1R_CONTROL,
535 WM5100_IN1L_PGA_VOL_SHIFT, 94, 0, in_tlv),
536SOC_DOUBLE_R_TLV("IN2 Volume", WM5100_IN2L_CONTROL, WM5100_IN2R_CONTROL,
537 WM5100_IN2L_PGA_VOL_SHIFT, 94, 0, in_tlv),
538SOC_DOUBLE_R_TLV("IN3 Volume", WM5100_IN3L_CONTROL, WM5100_IN3R_CONTROL,
539 WM5100_IN3L_PGA_VOL_SHIFT, 94, 0, in_tlv),
540SOC_DOUBLE_R_TLV("IN4 Volume", WM5100_IN4L_CONTROL, WM5100_IN4R_CONTROL,
541 WM5100_IN4L_PGA_VOL_SHIFT, 94, 0, in_tlv),
542
543SOC_DOUBLE_R_TLV("IN1 Digital Volume", WM5100_ADC_DIGITAL_VOLUME_1L,
544 WM5100_ADC_DIGITAL_VOLUME_1R, WM5100_IN1L_VOL_SHIFT, 191,
545 0, digital_tlv),
546SOC_DOUBLE_R_TLV("IN2 Digital Volume", WM5100_ADC_DIGITAL_VOLUME_2L,
547 WM5100_ADC_DIGITAL_VOLUME_2R, WM5100_IN2L_VOL_SHIFT, 191,
548 0, digital_tlv),
549SOC_DOUBLE_R_TLV("IN3 Digital Volume", WM5100_ADC_DIGITAL_VOLUME_3L,
550 WM5100_ADC_DIGITAL_VOLUME_3R, WM5100_IN3L_VOL_SHIFT, 191,
551 0, digital_tlv),
552SOC_DOUBLE_R_TLV("IN4 Digital Volume", WM5100_ADC_DIGITAL_VOLUME_4L,
553 WM5100_ADC_DIGITAL_VOLUME_4R, WM5100_IN4L_VOL_SHIFT, 191,
554 0, digital_tlv),
555
556SOC_DOUBLE_R("IN1 Switch", WM5100_ADC_DIGITAL_VOLUME_1L,
557 WM5100_ADC_DIGITAL_VOLUME_1R, WM5100_IN1L_MUTE_SHIFT, 1, 1),
558SOC_DOUBLE_R("IN2 Switch", WM5100_ADC_DIGITAL_VOLUME_2L,
559 WM5100_ADC_DIGITAL_VOLUME_2R, WM5100_IN2L_MUTE_SHIFT, 1, 1),
560SOC_DOUBLE_R("IN3 Switch", WM5100_ADC_DIGITAL_VOLUME_3L,
561 WM5100_ADC_DIGITAL_VOLUME_3R, WM5100_IN3L_MUTE_SHIFT, 1, 1),
562SOC_DOUBLE_R("IN4 Switch", WM5100_ADC_DIGITAL_VOLUME_4L,
563 WM5100_ADC_DIGITAL_VOLUME_4R, WM5100_IN4L_MUTE_SHIFT, 1, 1),
564
20fc4863
MB		 565SND_SOC_BYTES_MASK("EQ1 Coefficients", WM5100_EQ1_1, 20, WM5100_EQ1_ENA),
566SND_SOC_BYTES_MASK("EQ2 Coefficients", WM5100_EQ2_1, 20, WM5100_EQ2_ENA),
567SND_SOC_BYTES_MASK("EQ3 Coefficients", WM5100_EQ3_1, 20, WM5100_EQ3_ENA),
568SND_SOC_BYTES_MASK("EQ4 Coefficients", WM5100_EQ4_1, 20, WM5100_EQ4_ENA),
569
570SND_SOC_BYTES_MASK("DRC Coefficients", WM5100_DRC1_CTRL1, 5,
571 WM5100_DRCL_ENA | WM5100_DRCR_ENA),
572
57b70db2
CIK		 573SND_SOC_BYTES("LHPF1 Coefficients", WM5100_HPLPF1_2, 1),
574SND_SOC_BYTES("LHPF2 Coefficients", WM5100_HPLPF2_2, 1),
575SND_SOC_BYTES("LHPF3 Coefficients", WM5100_HPLPF3_2, 1),
576SND_SOC_BYTES("LHPF4 Coefficients", WM5100_HPLPF4_2, 1),
20fc4863 577
6d4baf08
MB		 578SOC_SINGLE("HPOUT1 High Performance Switch", WM5100_OUT_VOLUME_1L,
579 WM5100_OUT1_OSR_SHIFT, 1, 0),
580SOC_SINGLE("HPOUT2 High Performance Switch", WM5100_OUT_VOLUME_2L,
581 WM5100_OUT2_OSR_SHIFT, 1, 0),
582SOC_SINGLE("HPOUT3 High Performance Switch", WM5100_OUT_VOLUME_3L,
583 WM5100_OUT3_OSR_SHIFT, 1, 0),
584SOC_SINGLE("SPKOUT High Performance Switch", WM5100_OUT_VOLUME_4L,
585 WM5100_OUT4_OSR_SHIFT, 1, 0),
586SOC_SINGLE("SPKDAT1 High Performance Switch", WM5100_DAC_VOLUME_LIMIT_5L,
587 WM5100_OUT5_OSR_SHIFT, 1, 0),
588SOC_SINGLE("SPKDAT2 High Performance Switch", WM5100_DAC_VOLUME_LIMIT_6L,
589 WM5100_OUT6_OSR_SHIFT, 1, 0),
590
591SOC_DOUBLE_R_TLV("HPOUT1 Digital Volume", WM5100_DAC_DIGITAL_VOLUME_1L,
592 WM5100_DAC_DIGITAL_VOLUME_1R, WM5100_OUT1L_VOL_SHIFT, 159, 0,
593 digital_tlv),
594SOC_DOUBLE_R_TLV("HPOUT2 Digital Volume", WM5100_DAC_DIGITAL_VOLUME_2L,
595 WM5100_DAC_DIGITAL_VOLUME_2R, WM5100_OUT2L_VOL_SHIFT, 159, 0,
596 digital_tlv),
597SOC_DOUBLE_R_TLV("HPOUT3 Digital Volume", WM5100_DAC_DIGITAL_VOLUME_3L,
598 WM5100_DAC_DIGITAL_VOLUME_3R, WM5100_OUT3L_VOL_SHIFT, 159, 0,
599 digital_tlv),
600SOC_DOUBLE_R_TLV("SPKOUT Digital Volume", WM5100_DAC_DIGITAL_VOLUME_4L,
601 WM5100_DAC_DIGITAL_VOLUME_4R, WM5100_OUT4L_VOL_SHIFT, 159, 0,
602 digital_tlv),
603SOC_DOUBLE_R_TLV("SPKDAT1 Digital Volume", WM5100_DAC_DIGITAL_VOLUME_5L,
604 WM5100_DAC_DIGITAL_VOLUME_5R, WM5100_OUT5L_VOL_SHIFT, 159, 0,
605 digital_tlv),
606SOC_DOUBLE_R_TLV("SPKDAT2 Digital Volume", WM5100_DAC_DIGITAL_VOLUME_6L,
607 WM5100_DAC_DIGITAL_VOLUME_6R, WM5100_OUT6L_VOL_SHIFT, 159, 0,
608 digital_tlv),
609
610SOC_DOUBLE_R("HPOUT1 Digital Switch", WM5100_DAC_DIGITAL_VOLUME_1L,
611 WM5100_DAC_DIGITAL_VOLUME_1R, WM5100_OUT1L_MUTE_SHIFT, 1, 1),
612SOC_DOUBLE_R("HPOUT2 Digital Switch", WM5100_DAC_DIGITAL_VOLUME_2L,
613 WM5100_DAC_DIGITAL_VOLUME_2R, WM5100_OUT2L_MUTE_SHIFT, 1, 1),
614SOC_DOUBLE_R("HPOUT3 Digital Switch", WM5100_DAC_DIGITAL_VOLUME_3L,
615 WM5100_DAC_DIGITAL_VOLUME_3R, WM5100_OUT3L_MUTE_SHIFT, 1, 1),
616SOC_DOUBLE_R("SPKOUT Digital Switch", WM5100_DAC_DIGITAL_VOLUME_4L,
617 WM5100_DAC_DIGITAL_VOLUME_4R, WM5100_OUT4L_MUTE_SHIFT, 1, 1),
618SOC_DOUBLE_R("SPKDAT1 Digital Switch", WM5100_DAC_DIGITAL_VOLUME_5L,
619 WM5100_DAC_DIGITAL_VOLUME_5R, WM5100_OUT5L_MUTE_SHIFT, 1, 1),
620SOC_DOUBLE_R("SPKDAT2 Digital Switch", WM5100_DAC_DIGITAL_VOLUME_6L,
621 WM5100_DAC_DIGITAL_VOLUME_6R, WM5100_OUT6L_MUTE_SHIFT, 1, 1),
622
623/* FIXME: Only valid from -12dB to 0dB (52-64) */
624SOC_DOUBLE_R_TLV("HPOUT1 Volume", WM5100_OUT_VOLUME_1L, WM5100_OUT_VOLUME_1R,
625 WM5100_OUT1L_PGA_VOL_SHIFT, 64, 0, out_tlv),
626SOC_DOUBLE_R_TLV("HPOUT2 Volume", WM5100_OUT_VOLUME_2L, WM5100_OUT_VOLUME_2R,
627 WM5100_OUT2L_PGA_VOL_SHIFT, 64, 0, out_tlv),
628SOC_DOUBLE_R_TLV("HPOUT3 Volume", WM5100_OUT_VOLUME_3L, WM5100_OUT_VOLUME_3R,
629 WM5100_OUT2L_PGA_VOL_SHIFT, 64, 0, out_tlv),
630
631SOC_DOUBLE("SPKDAT1 Switch", WM5100_PDM_SPK1_CTRL_1, WM5100_SPK1L_MUTE_SHIFT,
632 WM5100_SPK1R_MUTE_SHIFT, 1, 1),
633SOC_DOUBLE("SPKDAT2 Switch", WM5100_PDM_SPK2_CTRL_1, WM5100_SPK2L_MUTE_SHIFT,
634 WM5100_SPK2R_MUTE_SHIFT, 1, 1),
635
636SOC_SINGLE_TLV("EQ1 Band 1 Volume", WM5100_EQ1_1, WM5100_EQ1_B1_GAIN_SHIFT,
637 24, 0, eq_tlv),
638SOC_SINGLE_TLV("EQ1 Band 2 Volume", WM5100_EQ1_1, WM5100_EQ1_B2_GAIN_SHIFT,
639 24, 0, eq_tlv),
640SOC_SINGLE_TLV("EQ1 Band 3 Volume", WM5100_EQ1_1, WM5100_EQ1_B3_GAIN_SHIFT,
641 24, 0, eq_tlv),
642SOC_SINGLE_TLV("EQ1 Band 4 Volume", WM5100_EQ1_2, WM5100_EQ1_B4_GAIN_SHIFT,
643 24, 0, eq_tlv),
644SOC_SINGLE_TLV("EQ1 Band 5 Volume", WM5100_EQ1_2, WM5100_EQ1_B5_GAIN_SHIFT,
645 24, 0, eq_tlv),
646
647SOC_SINGLE_TLV("EQ2 Band 1 Volume", WM5100_EQ2_1, WM5100_EQ2_B1_GAIN_SHIFT,
648 24, 0, eq_tlv),
649SOC_SINGLE_TLV("EQ2 Band 2 Volume", WM5100_EQ2_1, WM5100_EQ2_B2_GAIN_SHIFT,
650 24, 0, eq_tlv),
651SOC_SINGLE_TLV("EQ2 Band 3 Volume", WM5100_EQ2_1, WM5100_EQ2_B3_GAIN_SHIFT,
652 24, 0, eq_tlv),
653SOC_SINGLE_TLV("EQ2 Band 4 Volume", WM5100_EQ2_2, WM5100_EQ2_B4_GAIN_SHIFT,
654 24, 0, eq_tlv),
655SOC_SINGLE_TLV("EQ2 Band 5 Volume", WM5100_EQ2_2, WM5100_EQ2_B5_GAIN_SHIFT,
656 24, 0, eq_tlv),
657
658SOC_SINGLE_TLV("EQ3 Band 1 Volume", WM5100_EQ1_1, WM5100_EQ3_B1_GAIN_SHIFT,
659 24, 0, eq_tlv),
660SOC_SINGLE_TLV("EQ3 Band 2 Volume", WM5100_EQ3_1, WM5100_EQ3_B2_GAIN_SHIFT,
661 24, 0, eq_tlv),
662SOC_SINGLE_TLV("EQ3 Band 3 Volume", WM5100_EQ3_1, WM5100_EQ3_B3_GAIN_SHIFT,
663 24, 0, eq_tlv),
664SOC_SINGLE_TLV("EQ3 Band 4 Volume", WM5100_EQ3_2, WM5100_EQ3_B4_GAIN_SHIFT,
665 24, 0, eq_tlv),
666SOC_SINGLE_TLV("EQ3 Band 5 Volume", WM5100_EQ3_2, WM5100_EQ3_B5_GAIN_SHIFT,
667 24, 0, eq_tlv),
668
669SOC_SINGLE_TLV("EQ4 Band 1 Volume", WM5100_EQ4_1, WM5100_EQ4_B1_GAIN_SHIFT,
670 24, 0, eq_tlv),
671SOC_SINGLE_TLV("EQ4 Band 2 Volume", WM5100_EQ4_1, WM5100_EQ4_B2_GAIN_SHIFT,
672 24, 0, eq_tlv),
673SOC_SINGLE_TLV("EQ4 Band 3 Volume", WM5100_EQ4_1, WM5100_EQ4_B3_GAIN_SHIFT,
674 24, 0, eq_tlv),
675SOC_SINGLE_TLV("EQ4 Band 4 Volume", WM5100_EQ4_2, WM5100_EQ4_B4_GAIN_SHIFT,
676 24, 0, eq_tlv),
677SOC_SINGLE_TLV("EQ4 Band 5 Volume", WM5100_EQ4_2, WM5100_EQ4_B5_GAIN_SHIFT,
678 24, 0, eq_tlv),
679
680SOC_ENUM("LHPF1 Mode", wm5100_lhpf1_mode),
681SOC_ENUM("LHPF2 Mode", wm5100_lhpf2_mode),
682SOC_ENUM("LHPF3 Mode", wm5100_lhpf3_mode),
683SOC_ENUM("LHPF4 Mode", wm5100_lhpf4_mode),
684
685WM5100_MIXER_CONTROLS("HPOUT1L", WM5100_OUT1LMIX_INPUT_1_SOURCE),
686WM5100_MIXER_CONTROLS("HPOUT1R", WM5100_OUT1RMIX_INPUT_1_SOURCE),
687WM5100_MIXER_CONTROLS("HPOUT2L", WM5100_OUT2LMIX_INPUT_1_SOURCE),
688WM5100_MIXER_CONTROLS("HPOUT2R", WM5100_OUT2RMIX_INPUT_1_SOURCE),
689WM5100_MIXER_CONTROLS("HPOUT3L", WM5100_OUT3LMIX_INPUT_1_SOURCE),
690WM5100_MIXER_CONTROLS("HPOUT3R", WM5100_OUT3RMIX_INPUT_1_SOURCE),
691
692WM5100_MIXER_CONTROLS("SPKOUTL", WM5100_OUT4LMIX_INPUT_1_SOURCE),
693WM5100_MIXER_CONTROLS("SPKOUTR", WM5100_OUT4RMIX_INPUT_1_SOURCE),
694WM5100_MIXER_CONTROLS("SPKDAT1L", WM5100_OUT5LMIX_INPUT_1_SOURCE),
695WM5100_MIXER_CONTROLS("SPKDAT1R", WM5100_OUT5RMIX_INPUT_1_SOURCE),
696WM5100_MIXER_CONTROLS("SPKDAT2L", WM5100_OUT6LMIX_INPUT_1_SOURCE),
697WM5100_MIXER_CONTROLS("SPKDAT2R", WM5100_OUT6RMIX_INPUT_1_SOURCE),
698
699WM5100_MIXER_CONTROLS("PWM1", WM5100_PWM1MIX_INPUT_1_SOURCE),
700WM5100_MIXER_CONTROLS("PWM2", WM5100_PWM2MIX_INPUT_1_SOURCE),
701
702WM5100_MIXER_CONTROLS("AIF1TX1", WM5100_AIF1TX1MIX_INPUT_1_SOURCE),
703WM5100_MIXER_CONTROLS("AIF1TX2", WM5100_AIF1TX2MIX_INPUT_1_SOURCE),
704WM5100_MIXER_CONTROLS("AIF1TX3", WM5100_AIF1TX3MIX_INPUT_1_SOURCE),
705WM5100_MIXER_CONTROLS("AIF1TX4", WM5100_AIF1TX4MIX_INPUT_1_SOURCE),
706WM5100_MIXER_CONTROLS("AIF1TX5", WM5100_AIF1TX5MIX_INPUT_1_SOURCE),
707WM5100_MIXER_CONTROLS("AIF1TX6", WM5100_AIF1TX6MIX_INPUT_1_SOURCE),
708WM5100_MIXER_CONTROLS("AIF1TX7", WM5100_AIF1TX7MIX_INPUT_1_SOURCE),
709WM5100_MIXER_CONTROLS("AIF1TX8", WM5100_AIF1TX8MIX_INPUT_1_SOURCE),
710
711WM5100_MIXER_CONTROLS("AIF2TX1", WM5100_AIF2TX1MIX_INPUT_1_SOURCE),
712WM5100_MIXER_CONTROLS("AIF2TX2", WM5100_AIF2TX2MIX_INPUT_1_SOURCE),
713
714WM5100_MIXER_CONTROLS("AIF3TX1", WM5100_AIF3TX1MIX_INPUT_1_SOURCE),
715WM5100_MIXER_CONTROLS("AIF3TX2", WM5100_AIF3TX2MIX_INPUT_1_SOURCE),
716
717WM5100_MIXER_CONTROLS("EQ1", WM5100_EQ1MIX_INPUT_1_SOURCE),
718WM5100_MIXER_CONTROLS("EQ2", WM5100_EQ2MIX_INPUT_1_SOURCE),
719WM5100_MIXER_CONTROLS("EQ3", WM5100_EQ3MIX_INPUT_1_SOURCE),
720WM5100_MIXER_CONTROLS("EQ4", WM5100_EQ4MIX_INPUT_1_SOURCE),
721
722WM5100_MIXER_CONTROLS("DRC1L", WM5100_DRC1LMIX_INPUT_1_SOURCE),
723WM5100_MIXER_CONTROLS("DRC1R", WM5100_DRC1RMIX_INPUT_1_SOURCE),
cdaaf301
MB		 724SND_SOC_BYTES_MASK("DRC", WM5100_DRC1_CTRL1, 5,
725 WM5100_DRCL_ENA | WM5100_DRCR_ENA),
6d4baf08
MB		 726
727WM5100_MIXER_CONTROLS("LHPF1", WM5100_HPLP1MIX_INPUT_1_SOURCE),
728WM5100_MIXER_CONTROLS("LHPF2", WM5100_HPLP2MIX_INPUT_1_SOURCE),
729WM5100_MIXER_CONTROLS("LHPF3", WM5100_HPLP3MIX_INPUT_1_SOURCE),
730WM5100_MIXER_CONTROLS("LHPF4", WM5100_HPLP4MIX_INPUT_1_SOURCE),
731};
732
61195838 733static void wm5100_seq_notifier(struct snd_soc_component *component,
6d4baf08
MB		 734 enum snd_soc_dapm_type event, int subseq)
735{
61195838 736 struct wm5100_priv *wm5100 = snd_soc_component_get_drvdata(component);
6d4baf08
MB		 737 u16 val, expect, i;
738
739 /* Wait for the outputs to flag themselves as enabled */
740 if (wm5100->out_ena[0]) {
6d75dfc3 741 expect = snd_soc_component_read(component, WM5100_CHANNEL_ENABLES_1);
6d4baf08 742 for (i = 0; i < 200; i++) {
6d75dfc3 743 val = snd_soc_component_read(component, WM5100_OUTPUT_STATUS_1);
6d4baf08
MB		 744 if (val == expect) {
745 wm5100->out_ena[0] = false;
746 break;
747 }
748 }
749 if (i == 200) {
61195838 750 dev_err(component->dev, "Timeout waiting for OUTPUT1 %x\n",
6d4baf08
MB		 751 expect);
752 }
753 }
754
755 if (wm5100->out_ena[1]) {
6d75dfc3 756 expect = snd_soc_component_read(component, WM5100_OUTPUT_ENABLES_2);
6d4baf08 757 for (i = 0; i < 200; i++) {
6d75dfc3 758 val = snd_soc_component_read(component, WM5100_OUTPUT_STATUS_2);
6d4baf08
MB		 759 if (val == expect) {
760 wm5100->out_ena[1] = false;
761 break;
762 }
763 }
764 if (i == 200) {
61195838 765 dev_err(component->dev, "Timeout waiting for OUTPUT2 %x\n",
6d4baf08
MB		 766 expect);
767 }
768 }
769}
770
771static int wm5100_out_ev(struct snd_soc_dapm_widget *w,
772 struct snd_kcontrol *kcontrol,
773 int event)
774{
61195838
KM		 775 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
776 struct wm5100_priv *wm5100 = snd_soc_component_get_drvdata(component);
6d4baf08
MB		 777
778 switch (w->reg) {
779 case WM5100_CHANNEL_ENABLES_1:
780 wm5100->out_ena[0] = true;
781 break;
782 case WM5100_OUTPUT_ENABLES_2:
783 wm5100->out_ena[0] = true;
784 break;
785 default:
786 break;
787 }
788
789 return 0;
790}
791
46c1a877 792static void wm5100_log_status3(struct wm5100_priv *wm5100, int val)
6d4baf08
MB		 793{
794 if (val & WM5100_SPK_SHUTDOWN_WARN_EINT)
46c1a877 795 dev_crit(wm5100->dev, "Speaker shutdown warning\n");
6d4baf08 796 if (val & WM5100_SPK_SHUTDOWN_EINT)
46c1a877 797 dev_crit(wm5100->dev, "Speaker shutdown\n");
6d4baf08 798 if (val & WM5100_CLKGEN_ERR_EINT)
46c1a877 799 dev_crit(wm5100->dev, "SYSCLK underclocked\n");
6d4baf08 800 if (val & WM5100_CLKGEN_ERR_ASYNC_EINT)
46c1a877 801 dev_crit(wm5100->dev, "ASYNCCLK underclocked\n");
6d4baf08
MB		 802}
803
46c1a877 804static void wm5100_log_status4(struct wm5100_priv *wm5100, int val)
6d4baf08
MB		 805{
806 if (val & WM5100_AIF3_ERR_EINT)
46c1a877 807 dev_err(wm5100->dev, "AIF3 configuration error\n");
6d4baf08 808 if (val & WM5100_AIF2_ERR_EINT)
46c1a877 809 dev_err(wm5100->dev, "AIF2 configuration error\n");
6d4baf08 810 if (val & WM5100_AIF1_ERR_EINT)
46c1a877 811 dev_err(wm5100->dev, "AIF1 configuration error\n");
6d4baf08 812 if (val & WM5100_CTRLIF_ERR_EINT)
46c1a877 813 dev_err(wm5100->dev, "Control interface error\n");
6d4baf08 814 if (val & WM5100_ISRC2_UNDERCLOCKED_EINT)
46c1a877 815 dev_err(wm5100->dev, "ISRC2 underclocked\n");
6d4baf08 816 if (val & WM5100_ISRC1_UNDERCLOCKED_EINT)
46c1a877 817 dev_err(wm5100->dev, "ISRC1 underclocked\n");
6d4baf08 818 if (val & WM5100_FX_UNDERCLOCKED_EINT)
46c1a877 819 dev_err(wm5100->dev, "FX underclocked\n");
6d4baf08 820 if (val & WM5100_AIF3_UNDERCLOCKED_EINT)
46c1a877 821 dev_err(wm5100->dev, "AIF3 underclocked\n");
6d4baf08 822 if (val & WM5100_AIF2_UNDERCLOCKED_EINT)
46c1a877 823 dev_err(wm5100->dev, "AIF2 underclocked\n");
6d4baf08 824 if (val & WM5100_AIF1_UNDERCLOCKED_EINT)
46c1a877 825 dev_err(wm5100->dev, "AIF1 underclocked\n");
6d4baf08 826 if (val & WM5100_ASRC_UNDERCLOCKED_EINT)
46c1a877 827 dev_err(wm5100->dev, "ASRC underclocked\n");
6d4baf08 828 if (val & WM5100_DAC_UNDERCLOCKED_EINT)
46c1a877 829 dev_err(wm5100->dev, "DAC underclocked\n");
6d4baf08 830 if (val & WM5100_ADC_UNDERCLOCKED_EINT)
46c1a877 831 dev_err(wm5100->dev, "ADC underclocked\n");
6d4baf08 832 if (val & WM5100_MIXER_UNDERCLOCKED_EINT)
46c1a877 833 dev_err(wm5100->dev, "Mixer underclocked\n");
6d4baf08
MB		 834}
835
836static int wm5100_post_ev(struct snd_soc_dapm_widget *w,
837 struct snd_kcontrol *kcontrol,
838 int event)
839{
61195838
KM		 840 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
841 struct wm5100_priv *wm5100 = snd_soc_component_get_drvdata(component);
6d4baf08
MB		 842 int ret;
843
6d75dfc3 844 ret = snd_soc_component_read(component, WM5100_INTERRUPT_RAW_STATUS_3);
6d4baf08
MB		 845 ret &= WM5100_SPK_SHUTDOWN_WARN_STS |
846 WM5100_SPK_SHUTDOWN_STS | WM5100_CLKGEN_ERR_STS |
847 WM5100_CLKGEN_ERR_ASYNC_STS;
46c1a877 848 wm5100_log_status3(wm5100, ret);
6d4baf08 849
6d75dfc3 850 ret = snd_soc_component_read(component, WM5100_INTERRUPT_RAW_STATUS_4);
46c1a877 851 wm5100_log_status4(wm5100, ret);
6d4baf08
MB		 852
853 return 0;
854}
855
856static const struct snd_soc_dapm_widget wm5100_dapm_widgets[] = {
857SND_SOC_DAPM_SUPPLY("SYSCLK", WM5100_CLOCKING_3, WM5100_SYSCLK_ENA_SHIFT, 0,
858 NULL, 0),
859SND_SOC_DAPM_SUPPLY("ASYNCCLK", WM5100_CLOCKING_6, WM5100_ASYNC_CLK_ENA_SHIFT,
860 0, NULL, 0),
861
822b4b8d
MB		 862SND_SOC_DAPM_REGULATOR_SUPPLY("CPVDD", 20, 0),
863SND_SOC_DAPM_REGULATOR_SUPPLY("DBVDD2", 0, 0),
864SND_SOC_DAPM_REGULATOR_SUPPLY("DBVDD3", 0, 0),
1cf73356 865
6d4baf08 866SND_SOC_DAPM_SUPPLY("CP1", WM5100_HP_CHARGE_PUMP_1, WM5100_CP1_ENA_SHIFT, 0,
1cf73356 867 NULL, 0),
6d4baf08
MB		 868SND_SOC_DAPM_SUPPLY("CP2", WM5100_MIC_CHARGE_PUMP_1, WM5100_CP2_ENA_SHIFT, 0,
869 NULL, 0),
870SND_SOC_DAPM_SUPPLY("CP2 Active", WM5100_MIC_CHARGE_PUMP_1,
1cf73356 871 WM5100_CP2_BYPASS_SHIFT, 1, NULL, 0),
6d4baf08
MB		 872
873SND_SOC_DAPM_SUPPLY("MICBIAS1", WM5100_MIC_BIAS_CTRL_1, WM5100_MICB1_ENA_SHIFT,
874 0, NULL, 0),
875SND_SOC_DAPM_SUPPLY("MICBIAS2", WM5100_MIC_BIAS_CTRL_2, WM5100_MICB2_ENA_SHIFT,
876 0, NULL, 0),
877SND_SOC_DAPM_SUPPLY("MICBIAS3", WM5100_MIC_BIAS_CTRL_3, WM5100_MICB3_ENA_SHIFT,
878 0, NULL, 0),
879
880SND_SOC_DAPM_INPUT("IN1L"),
881SND_SOC_DAPM_INPUT("IN1R"),
882SND_SOC_DAPM_INPUT("IN2L"),
883SND_SOC_DAPM_INPUT("IN2R"),
884SND_SOC_DAPM_INPUT("IN3L"),
885SND_SOC_DAPM_INPUT("IN3R"),
886SND_SOC_DAPM_INPUT("IN4L"),
887SND_SOC_DAPM_INPUT("IN4R"),
dea8e237 888SND_SOC_DAPM_SIGGEN("TONE"),
6d4baf08
MB		 889
890SND_SOC_DAPM_PGA_E("IN1L PGA", WM5100_INPUT_ENABLES, WM5100_IN1L_ENA_SHIFT, 0,
891 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
892SND_SOC_DAPM_PGA_E("IN1R PGA", WM5100_INPUT_ENABLES, WM5100_IN1R_ENA_SHIFT, 0,
893 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
894SND_SOC_DAPM_PGA_E("IN2L PGA", WM5100_INPUT_ENABLES, WM5100_IN2L_ENA_SHIFT, 0,
895 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
896SND_SOC_DAPM_PGA_E("IN2R PGA", WM5100_INPUT_ENABLES, WM5100_IN2R_ENA_SHIFT, 0,
897 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
898SND_SOC_DAPM_PGA_E("IN3L PGA", WM5100_INPUT_ENABLES, WM5100_IN3L_ENA_SHIFT, 0,
899 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
900SND_SOC_DAPM_PGA_E("IN3R PGA", WM5100_INPUT_ENABLES, WM5100_IN3R_ENA_SHIFT, 0,
901 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
902SND_SOC_DAPM_PGA_E("IN4L PGA", WM5100_INPUT_ENABLES, WM5100_IN4L_ENA_SHIFT, 0,
903 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
904SND_SOC_DAPM_PGA_E("IN4R PGA", WM5100_INPUT_ENABLES, WM5100_IN4R_ENA_SHIFT, 0,
905 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
906
907SND_SOC_DAPM_PGA("Tone Generator 1", WM5100_TONE_GENERATOR_1,
908 WM5100_TONE1_ENA_SHIFT, 0, NULL, 0),
909SND_SOC_DAPM_PGA("Tone Generator 2", WM5100_TONE_GENERATOR_1,
910 WM5100_TONE2_ENA_SHIFT, 0, NULL, 0),
911
912SND_SOC_DAPM_AIF_IN("AIF1RX1", "AIF1 Playback", 0,
913 WM5100_AUDIO_IF_1_27, WM5100_AIF1RX1_ENA_SHIFT, 0),
914SND_SOC_DAPM_AIF_IN("AIF1RX2", "AIF1 Playback", 1,
915 WM5100_AUDIO_IF_1_27, WM5100_AIF1RX2_ENA_SHIFT, 0),
916SND_SOC_DAPM_AIF_IN("AIF1RX3", "AIF1 Playback", 2,
917 WM5100_AUDIO_IF_1_27, WM5100_AIF1RX3_ENA_SHIFT, 0),
918SND_SOC_DAPM_AIF_IN("AIF1RX4", "AIF1 Playback", 3,
919 WM5100_AUDIO_IF_1_27, WM5100_AIF1RX4_ENA_SHIFT, 0),
920SND_SOC_DAPM_AIF_IN("AIF1RX5", "AIF1 Playback", 4,
921 WM5100_AUDIO_IF_1_27, WM5100_AIF1RX5_ENA_SHIFT, 0),
922SND_SOC_DAPM_AIF_IN("AIF1RX6", "AIF1 Playback", 5,
923 WM5100_AUDIO_IF_1_27, WM5100_AIF1RX6_ENA_SHIFT, 0),
924SND_SOC_DAPM_AIF_IN("AIF1RX7", "AIF1 Playback", 6,
925 WM5100_AUDIO_IF_1_27, WM5100_AIF1RX7_ENA_SHIFT, 0),
926SND_SOC_DAPM_AIF_IN("AIF1RX8", "AIF1 Playback", 7,
927 WM5100_AUDIO_IF_1_27, WM5100_AIF1RX8_ENA_SHIFT, 0),
928
929SND_SOC_DAPM_AIF_IN("AIF2RX1", "AIF2 Playback", 0,
930 WM5100_AUDIO_IF_2_27, WM5100_AIF2RX1_ENA_SHIFT, 0),
931SND_SOC_DAPM_AIF_IN("AIF2RX2", "AIF2 Playback", 1,
932 WM5100_AUDIO_IF_2_27, WM5100_AIF2RX2_ENA_SHIFT, 0),
933
934SND_SOC_DAPM_AIF_IN("AIF3RX1", "AIF3 Playback", 0,
935 WM5100_AUDIO_IF_3_27, WM5100_AIF3RX1_ENA_SHIFT, 0),
936SND_SOC_DAPM_AIF_IN("AIF3RX2", "AIF3 Playback", 1,
937 WM5100_AUDIO_IF_3_27, WM5100_AIF3RX2_ENA_SHIFT, 0),
938
939SND_SOC_DAPM_AIF_OUT("AIF1TX1", "AIF1 Capture", 0,
940 WM5100_AUDIO_IF_1_26, WM5100_AIF1TX1_ENA_SHIFT, 0),
941SND_SOC_DAPM_AIF_OUT("AIF1TX2", "AIF1 Capture", 1,
942 WM5100_AUDIO_IF_1_26, WM5100_AIF1TX2_ENA_SHIFT, 0),
943SND_SOC_DAPM_AIF_OUT("AIF1TX3", "AIF1 Capture", 2,
944 WM5100_AUDIO_IF_1_26, WM5100_AIF1TX3_ENA_SHIFT, 0),
945SND_SOC_DAPM_AIF_OUT("AIF1TX4", "AIF1 Capture", 3,
946 WM5100_AUDIO_IF_1_26, WM5100_AIF1TX4_ENA_SHIFT, 0),
947SND_SOC_DAPM_AIF_OUT("AIF1TX5", "AIF1 Capture", 4,
948 WM5100_AUDIO_IF_1_26, WM5100_AIF1TX5_ENA_SHIFT, 0),
949SND_SOC_DAPM_AIF_OUT("AIF1TX6", "AIF1 Capture", 5,
950 WM5100_AUDIO_IF_1_26, WM5100_AIF1TX6_ENA_SHIFT, 0),
951SND_SOC_DAPM_AIF_OUT("AIF1TX7", "AIF1 Capture", 6,
952 WM5100_AUDIO_IF_1_26, WM5100_AIF1TX7_ENA_SHIFT, 0),
953SND_SOC_DAPM_AIF_OUT("AIF1TX8", "AIF1 Capture", 7,
954 WM5100_AUDIO_IF_1_26, WM5100_AIF1TX8_ENA_SHIFT, 0),
955
956SND_SOC_DAPM_AIF_OUT("AIF2TX1", "AIF2 Capture", 0,
957 WM5100_AUDIO_IF_2_26, WM5100_AIF2TX1_ENA_SHIFT, 0),
958SND_SOC_DAPM_AIF_OUT("AIF2TX2", "AIF2 Capture", 1,
959 WM5100_AUDIO_IF_2_26, WM5100_AIF2TX2_ENA_SHIFT, 0),
960
961SND_SOC_DAPM_AIF_OUT("AIF3TX1", "AIF3 Capture", 0,
962 WM5100_AUDIO_IF_3_26, WM5100_AIF3TX1_ENA_SHIFT, 0),
963SND_SOC_DAPM_AIF_OUT("AIF3TX2", "AIF3 Capture", 1,
964 WM5100_AUDIO_IF_3_26, WM5100_AIF3TX2_ENA_SHIFT, 0),
965
966SND_SOC_DAPM_PGA_E("OUT6L", WM5100_OUTPUT_ENABLES_2, WM5100_OUT6L_ENA_SHIFT, 0,
967 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
968SND_SOC_DAPM_PGA_E("OUT6R", WM5100_OUTPUT_ENABLES_2, WM5100_OUT6R_ENA_SHIFT, 0,
969 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
970SND_SOC_DAPM_PGA_E("OUT5L", WM5100_OUTPUT_ENABLES_2, WM5100_OUT5L_ENA_SHIFT, 0,
971 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
972SND_SOC_DAPM_PGA_E("OUT5R", WM5100_OUTPUT_ENABLES_2, WM5100_OUT5R_ENA_SHIFT, 0,
973 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
974SND_SOC_DAPM_PGA_E("OUT4L", WM5100_OUTPUT_ENABLES_2, WM5100_OUT4L_ENA_SHIFT, 0,
975 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
976SND_SOC_DAPM_PGA_E("OUT4R", WM5100_OUTPUT_ENABLES_2, WM5100_OUT4R_ENA_SHIFT, 0,
977 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
978SND_SOC_DAPM_PGA_E("OUT3L", WM5100_CHANNEL_ENABLES_1, WM5100_HP3L_ENA_SHIFT, 0,
979 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
980SND_SOC_DAPM_PGA_E("OUT3R", WM5100_CHANNEL_ENABLES_1, WM5100_HP3R_ENA_SHIFT, 0,
981 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
982SND_SOC_DAPM_PGA_E("OUT2L", WM5100_CHANNEL_ENABLES_1, WM5100_HP2L_ENA_SHIFT, 0,
983 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
984SND_SOC_DAPM_PGA_E("OUT2R", WM5100_CHANNEL_ENABLES_1, WM5100_HP2R_ENA_SHIFT, 0,
985 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
986SND_SOC_DAPM_PGA_E("OUT1L", WM5100_CHANNEL_ENABLES_1, WM5100_HP1L_ENA_SHIFT, 0,
987 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
988SND_SOC_DAPM_PGA_E("OUT1R", WM5100_CHANNEL_ENABLES_1, WM5100_HP1R_ENA_SHIFT, 0,
989 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
990SND_SOC_DAPM_PGA_E("PWM1 Driver", WM5100_PWM_DRIVE_1, WM5100_PWM1_ENA_SHIFT, 0,
991 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
992SND_SOC_DAPM_PGA_E("PWM2 Driver", WM5100_PWM_DRIVE_1, WM5100_PWM2_ENA_SHIFT, 0,
993 NULL, 0, wm5100_out_ev, SND_SOC_DAPM_POST_PMU),
994
995SND_SOC_DAPM_PGA("EQ1", WM5100_EQ1_1, WM5100_EQ1_ENA_SHIFT, 0, NULL, 0),
996SND_SOC_DAPM_PGA("EQ2", WM5100_EQ2_1, WM5100_EQ2_ENA_SHIFT, 0, NULL, 0),
997SND_SOC_DAPM_PGA("EQ3", WM5100_EQ3_1, WM5100_EQ3_ENA_SHIFT, 0, NULL, 0),
998SND_SOC_DAPM_PGA("EQ4", WM5100_EQ4_1, WM5100_EQ4_ENA_SHIFT, 0, NULL, 0),
999
1000SND_SOC_DAPM_PGA("DRC1L", WM5100_DRC1_CTRL1, WM5100_DRCL_ENA_SHIFT, 0,
1001 NULL, 0),
1002SND_SOC_DAPM_PGA("DRC1R", WM5100_DRC1_CTRL1, WM5100_DRCR_ENA_SHIFT, 0,
1003 NULL, 0),
1004
1005SND_SOC_DAPM_PGA("LHPF1", WM5100_HPLPF1_1, WM5100_LHPF1_ENA_SHIFT, 0,
1006 NULL, 0),
1007SND_SOC_DAPM_PGA("LHPF2", WM5100_HPLPF2_1, WM5100_LHPF2_ENA_SHIFT, 0,
1008 NULL, 0),
1009SND_SOC_DAPM_PGA("LHPF3", WM5100_HPLPF3_1, WM5100_LHPF3_ENA_SHIFT, 0,
1010 NULL, 0),
1011SND_SOC_DAPM_PGA("LHPF4", WM5100_HPLPF4_1, WM5100_LHPF4_ENA_SHIFT, 0,
1012 NULL, 0),
1013
1014WM5100_MIXER_WIDGETS(EQ1, "EQ1"),
1015WM5100_MIXER_WIDGETS(EQ2, "EQ2"),
1016WM5100_MIXER_WIDGETS(EQ3, "EQ3"),
1017WM5100_MIXER_WIDGETS(EQ4, "EQ4"),
1018
1019WM5100_MIXER_WIDGETS(DRC1L, "DRC1L"),
1020WM5100_MIXER_WIDGETS(DRC1R, "DRC1R"),
1021
1022WM5100_MIXER_WIDGETS(LHPF1, "LHPF1"),
1023WM5100_MIXER_WIDGETS(LHPF2, "LHPF2"),
1024WM5100_MIXER_WIDGETS(LHPF3, "LHPF3"),
1025WM5100_MIXER_WIDGETS(LHPF4, "LHPF4"),
1026
1027WM5100_MIXER_WIDGETS(AIF1TX1, "AIF1TX1"),
1028WM5100_MIXER_WIDGETS(AIF1TX2, "AIF1TX2"),
1029WM5100_MIXER_WIDGETS(AIF1TX3, "AIF1TX3"),
1030WM5100_MIXER_WIDGETS(AIF1TX4, "AIF1TX4"),
1031WM5100_MIXER_WIDGETS(AIF1TX5, "AIF1TX5"),
1032WM5100_MIXER_WIDGETS(AIF1TX6, "AIF1TX6"),
1033WM5100_MIXER_WIDGETS(AIF1TX7, "AIF1TX7"),
1034WM5100_MIXER_WIDGETS(AIF1TX8, "AIF1TX8"),
1035
1036WM5100_MIXER_WIDGETS(AIF2TX1, "AIF2TX1"),
1037WM5100_MIXER_WIDGETS(AIF2TX2, "AIF2TX2"),
1038
1039WM5100_MIXER_WIDGETS(AIF3TX1, "AIF3TX1"),
1040WM5100_MIXER_WIDGETS(AIF3TX2, "AIF3TX2"),
1041
1042WM5100_MIXER_WIDGETS(HPOUT1L, "HPOUT1L"),
1043WM5100_MIXER_WIDGETS(HPOUT1R, "HPOUT1R"),
1044WM5100_MIXER_WIDGETS(HPOUT2L, "HPOUT2L"),
1045WM5100_MIXER_WIDGETS(HPOUT2R, "HPOUT2R"),
1046WM5100_MIXER_WIDGETS(HPOUT3L, "HPOUT3L"),
1047WM5100_MIXER_WIDGETS(HPOUT3R, "HPOUT3R"),
1048
1049WM5100_MIXER_WIDGETS(SPKOUTL, "SPKOUTL"),
1050WM5100_MIXER_WIDGETS(SPKOUTR, "SPKOUTR"),
1051WM5100_MIXER_WIDGETS(SPKDAT1L, "SPKDAT1L"),
1052WM5100_MIXER_WIDGETS(SPKDAT1R, "SPKDAT1R"),
1053WM5100_MIXER_WIDGETS(SPKDAT2L, "SPKDAT2L"),
1054WM5100_MIXER_WIDGETS(SPKDAT2R, "SPKDAT2R"),
1055
1056WM5100_MIXER_WIDGETS(PWM1, "PWM1"),
1057WM5100_MIXER_WIDGETS(PWM2, "PWM2"),
1058
1059SND_SOC_DAPM_OUTPUT("HPOUT1L"),
1060SND_SOC_DAPM_OUTPUT("HPOUT1R"),
1061SND_SOC_DAPM_OUTPUT("HPOUT2L"),
1062SND_SOC_DAPM_OUTPUT("HPOUT2R"),
1063SND_SOC_DAPM_OUTPUT("HPOUT3L"),
1064SND_SOC_DAPM_OUTPUT("HPOUT3R"),
1065SND_SOC_DAPM_OUTPUT("SPKOUTL"),
1066SND_SOC_DAPM_OUTPUT("SPKOUTR"),
1067SND_SOC_DAPM_OUTPUT("SPKDAT1"),
1068SND_SOC_DAPM_OUTPUT("SPKDAT2"),
1069SND_SOC_DAPM_OUTPUT("PWM1"),
1070SND_SOC_DAPM_OUTPUT("PWM2"),
1071};
1072
1073/* We register a _POST event if we don't have IRQ support so we can
1074 * look at the error status from the CODEC - if we've got the IRQ
1075 * hooked up then we will get prompted to look by an interrupt.
1076 */
1077static const struct snd_soc_dapm_widget wm5100_dapm_widgets_noirq[] = {
1078SND_SOC_DAPM_POST("Post", wm5100_post_ev),
1079};
1080
1081static const struct snd_soc_dapm_route wm5100_dapm_routes[] = {
1cf73356
MB		 1082 { "CP1", NULL, "CPVDD" },
1083 { "CP2 Active", NULL, "CPVDD" },
1084
6d4baf08
MB		 1085 { "IN1L", NULL, "SYSCLK" },
1086 { "IN1R", NULL, "SYSCLK" },
1087 { "IN2L", NULL, "SYSCLK" },
1088 { "IN2R", NULL, "SYSCLK" },
1089 { "IN3L", NULL, "SYSCLK" },
1090 { "IN3R", NULL, "SYSCLK" },
1091 { "IN4L", NULL, "SYSCLK" },
1092 { "IN4R", NULL, "SYSCLK" },
1093
1094 { "OUT1L", NULL, "SYSCLK" },
1095 { "OUT1R", NULL, "SYSCLK" },
1096 { "OUT2L", NULL, "SYSCLK" },
1097 { "OUT2R", NULL, "SYSCLK" },
1098 { "OUT3L", NULL, "SYSCLK" },
1099 { "OUT3R", NULL, "SYSCLK" },
1100 { "OUT4L", NULL, "SYSCLK" },
1101 { "OUT4R", NULL, "SYSCLK" },
1102 { "OUT5L", NULL, "SYSCLK" },
1103 { "OUT5R", NULL, "SYSCLK" },
1104 { "OUT6L", NULL, "SYSCLK" },
1105 { "OUT6R", NULL, "SYSCLK" },
1106
1107 { "AIF1RX1", NULL, "SYSCLK" },
1108 { "AIF1RX2", NULL, "SYSCLK" },
1109 { "AIF1RX3", NULL, "SYSCLK" },
1110 { "AIF1RX4", NULL, "SYSCLK" },
1111 { "AIF1RX5", NULL, "SYSCLK" },
1112 { "AIF1RX6", NULL, "SYSCLK" },
1113 { "AIF1RX7", NULL, "SYSCLK" },
1114 { "AIF1RX8", NULL, "SYSCLK" },
1115
1116 { "AIF2RX1", NULL, "SYSCLK" },
7aefb086 1117 { "AIF2RX1", NULL, "DBVDD2" },
6d4baf08 1118 { "AIF2RX2", NULL, "SYSCLK" },
7aefb086 1119 { "AIF2RX2", NULL, "DBVDD2" },
6d4baf08
MB		 1120
1121 { "AIF3RX1", NULL, "SYSCLK" },
7aefb086 1122 { "AIF3RX1", NULL, "DBVDD3" },
6d4baf08 1123 { "AIF3RX2", NULL, "SYSCLK" },
7aefb086 1124 { "AIF3RX2", NULL, "DBVDD3" },
6d4baf08
MB		 1125
1126 { "AIF1TX1", NULL, "SYSCLK" },
1127 { "AIF1TX2", NULL, "SYSCLK" },
1128 { "AIF1TX3", NULL, "SYSCLK" },
1129 { "AIF1TX4", NULL, "SYSCLK" },
1130 { "AIF1TX5", NULL, "SYSCLK" },
1131 { "AIF1TX6", NULL, "SYSCLK" },
1132 { "AIF1TX7", NULL, "SYSCLK" },
1133 { "AIF1TX8", NULL, "SYSCLK" },
1134
1135 { "AIF2TX1", NULL, "SYSCLK" },
7aefb086 1136 { "AIF2TX1", NULL, "DBVDD2" },
6d4baf08 1137 { "AIF2TX2", NULL, "SYSCLK" },
7aefb086 1138 { "AIF2TX2", NULL, "DBVDD2" },
6d4baf08
MB		 1139
1140 { "AIF3TX1", NULL, "SYSCLK" },
7aefb086 1141 { "AIF3TX1", NULL, "DBVDD3" },
6d4baf08 1142 { "AIF3TX2", NULL, "SYSCLK" },
7aefb086 1143 { "AIF3TX2", NULL, "DBVDD3" },
6d4baf08
MB		 1144
1145 { "MICBIAS1", NULL, "CP2" },
1146 { "MICBIAS2", NULL, "CP2" },
1147 { "MICBIAS3", NULL, "CP2" },
1148
1149 { "IN1L PGA", NULL, "CP2" },
1150 { "IN1R PGA", NULL, "CP2" },
1151 { "IN2L PGA", NULL, "CP2" },
1152 { "IN2R PGA", NULL, "CP2" },
1153 { "IN3L PGA", NULL, "CP2" },
1154 { "IN3R PGA", NULL, "CP2" },
1155 { "IN4L PGA", NULL, "CP2" },
1156 { "IN4R PGA", NULL, "CP2" },
1157
1158 { "IN1L PGA", NULL, "CP2 Active" },
1159 { "IN1R PGA", NULL, "CP2 Active" },
1160 { "IN2L PGA", NULL, "CP2 Active" },
1161 { "IN2R PGA", NULL, "CP2 Active" },
1162 { "IN3L PGA", NULL, "CP2 Active" },
1163 { "IN3R PGA", NULL, "CP2 Active" },
1164 { "IN4L PGA", NULL, "CP2 Active" },
1165 { "IN4R PGA", NULL, "CP2 Active" },
1166
1167 { "OUT1L", NULL, "CP1" },
1168 { "OUT1R", NULL, "CP1" },
1169 { "OUT2L", NULL, "CP1" },
1170 { "OUT2R", NULL, "CP1" },
1171 { "OUT3L", NULL, "CP1" },
1172 { "OUT3R", NULL, "CP1" },
1173
1174 { "Tone Generator 1", NULL, "TONE" },
1175 { "Tone Generator 2", NULL, "TONE" },
1176
1177 { "IN1L PGA", NULL, "IN1L" },
1178 { "IN1R PGA", NULL, "IN1R" },
1179 { "IN2L PGA", NULL, "IN2L" },
1180 { "IN2R PGA", NULL, "IN2R" },
1181 { "IN3L PGA", NULL, "IN3L" },
1182 { "IN3R PGA", NULL, "IN3R" },
1183 { "IN4L PGA", NULL, "IN4L" },
1184 { "IN4R PGA", NULL, "IN4R" },
1185
1186 WM5100_MIXER_ROUTES("OUT1L", "HPOUT1L"),
1187 WM5100_MIXER_ROUTES("OUT1R", "HPOUT1R"),
1188 WM5100_MIXER_ROUTES("OUT2L", "HPOUT2L"),
1189 WM5100_MIXER_ROUTES("OUT2R", "HPOUT2R"),
1190 WM5100_MIXER_ROUTES("OUT3L", "HPOUT3L"),
1191 WM5100_MIXER_ROUTES("OUT3R", "HPOUT3R"),
1192
1193 WM5100_MIXER_ROUTES("OUT4L", "SPKOUTL"),
1194 WM5100_MIXER_ROUTES("OUT4R", "SPKOUTR"),
1195 WM5100_MIXER_ROUTES("OUT5L", "SPKDAT1L"),
1196 WM5100_MIXER_ROUTES("OUT5R", "SPKDAT1R"),
1197 WM5100_MIXER_ROUTES("OUT6L", "SPKDAT2L"),
1198 WM5100_MIXER_ROUTES("OUT6R", "SPKDAT2R"),
1199
1200 WM5100_MIXER_ROUTES("PWM1 Driver", "PWM1"),
1201 WM5100_MIXER_ROUTES("PWM2 Driver", "PWM2"),
1202
1203 WM5100_MIXER_ROUTES("AIF1TX1", "AIF1TX1"),
1204 WM5100_MIXER_ROUTES("AIF1TX2", "AIF1TX2"),
1205 WM5100_MIXER_ROUTES("AIF1TX3", "AIF1TX3"),
1206 WM5100_MIXER_ROUTES("AIF1TX4", "AIF1TX4"),
1207 WM5100_MIXER_ROUTES("AIF1TX5", "AIF1TX5"),
1208 WM5100_MIXER_ROUTES("AIF1TX6", "AIF1TX6"),
1209 WM5100_MIXER_ROUTES("AIF1TX7", "AIF1TX7"),
1210 WM5100_MIXER_ROUTES("AIF1TX8", "AIF1TX8"),
1211
1212 WM5100_MIXER_ROUTES("AIF2TX1", "AIF2TX1"),
1213 WM5100_MIXER_ROUTES("AIF2TX2", "AIF2TX2"),
1214
1215 WM5100_MIXER_ROUTES("AIF3TX1", "AIF3TX1"),
1216 WM5100_MIXER_ROUTES("AIF3TX2", "AIF3TX2"),
1217
1218 WM5100_MIXER_ROUTES("EQ1", "EQ1"),
1219 WM5100_MIXER_ROUTES("EQ2", "EQ2"),
1220 WM5100_MIXER_ROUTES("EQ3", "EQ3"),
1221 WM5100_MIXER_ROUTES("EQ4", "EQ4"),
1222
1223 WM5100_MIXER_ROUTES("DRC1L", "DRC1L"),
1224 WM5100_MIXER_ROUTES("DRC1R", "DRC1R"),
1225
1226 WM5100_MIXER_ROUTES("LHPF1", "LHPF1"),
1227 WM5100_MIXER_ROUTES("LHPF2", "LHPF2"),
1228 WM5100_MIXER_ROUTES("LHPF3", "LHPF3"),
1229 WM5100_MIXER_ROUTES("LHPF4", "LHPF4"),
1230
1231 { "HPOUT1L", NULL, "OUT1L" },
1232 { "HPOUT1R", NULL, "OUT1R" },
1233 { "HPOUT2L", NULL, "OUT2L" },
1234 { "HPOUT2R", NULL, "OUT2R" },
1235 { "HPOUT3L", NULL, "OUT3L" },
1236 { "HPOUT3R", NULL, "OUT3R" },
1237 { "SPKOUTL", NULL, "OUT4L" },
1238 { "SPKOUTR", NULL, "OUT4R" },
1239 { "SPKDAT1", NULL, "OUT5L" },
1240 { "SPKDAT1", NULL, "OUT5R" },
1241 { "SPKDAT2", NULL, "OUT6L" },
1242 { "SPKDAT2", NULL, "OUT6R" },
1243 { "PWM1", NULL, "PWM1 Driver" },
1244 { "PWM2", NULL, "PWM2 Driver" },
1245};
1246
8019ff6c 1247static const struct reg_sequence wm5100_reva_patches[] = {
6d4baf08
MB		 1248 { WM5100_AUDIO_IF_1_10, 0 },
1249 { WM5100_AUDIO_IF_1_11, 1 },
1250 { WM5100_AUDIO_IF_1_12, 2 },
1251 { WM5100_AUDIO_IF_1_13, 3 },
1252 { WM5100_AUDIO_IF_1_14, 4 },
1253 { WM5100_AUDIO_IF_1_15, 5 },
1254 { WM5100_AUDIO_IF_1_16, 6 },
1255 { WM5100_AUDIO_IF_1_17, 7 },
1256
1257 { WM5100_AUDIO_IF_1_18, 0 },
1258 { WM5100_AUDIO_IF_1_19, 1 },
1259 { WM5100_AUDIO_IF_1_20, 2 },
1260 { WM5100_AUDIO_IF_1_21, 3 },
1261 { WM5100_AUDIO_IF_1_22, 4 },
1262 { WM5100_AUDIO_IF_1_23, 5 },
1263 { WM5100_AUDIO_IF_1_24, 6 },
1264 { WM5100_AUDIO_IF_1_25, 7 },
1265
1266 { WM5100_AUDIO_IF_2_10, 0 },
1267 { WM5100_AUDIO_IF_2_11, 1 },
1268
1269 { WM5100_AUDIO_IF_2_18, 0 },
1270 { WM5100_AUDIO_IF_2_19, 1 },
1271
1272 { WM5100_AUDIO_IF_3_10, 0 },
1273 { WM5100_AUDIO_IF_3_11, 1 },
1274
1275 { WM5100_AUDIO_IF_3_18, 0 },
1276 { WM5100_AUDIO_IF_3_19, 1 },
1277};
1278
6d4baf08
MB		 1279static int wm5100_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
1280{
61195838 1281 struct snd_soc_component *component = dai->component;
6d4baf08
MB		 1282 int lrclk, bclk, mask, base;
1283
9b523124 1284 base = dai->driver->base;
6d4baf08
MB		 1285
1286 lrclk = 0;
1287 bclk = 0;
1288
1289 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1290 case SND_SOC_DAIFMT_DSP_A:
1291 mask = 0;
1292 break;
6d4baf08
MB		 1293 case SND_SOC_DAIFMT_I2S:
1294 mask = 2;
1295 break;
6d4baf08 1296 default:
61195838 1297 dev_err(component->dev, "Unsupported DAI format %d\n",
6d4baf08
MB		 1298 fmt & SND_SOC_DAIFMT_FORMAT_MASK);
1299 return -EINVAL;
1300 }
1301
1302 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1303 case SND_SOC_DAIFMT_CBS_CFS:
1304 break;
1305 case SND_SOC_DAIFMT_CBS_CFM:
1306 lrclk |= WM5100_AIF1TX_LRCLK_MSTR;
1307 break;
1308 case SND_SOC_DAIFMT_CBM_CFS:
1309 bclk |= WM5100_AIF1_BCLK_MSTR;
1310 break;
1311 case SND_SOC_DAIFMT_CBM_CFM:
1312 lrclk |= WM5100_AIF1TX_LRCLK_MSTR;
1313 bclk |= WM5100_AIF1_BCLK_MSTR;
1314 break;
1315 default:
61195838 1316 dev_err(component->dev, "Unsupported master mode %d\n",
6d4baf08
MB		 1317 fmt & SND_SOC_DAIFMT_MASTER_MASK);
1318 return -EINVAL;
1319 }
1320
1321 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1322 case SND_SOC_DAIFMT_NB_NF:
1323 break;
1324 case SND_SOC_DAIFMT_IB_IF:
1325 bclk |= WM5100_AIF1_BCLK_INV;
1326 lrclk |= WM5100_AIF1TX_LRCLK_INV;
1327 break;
1328 case SND_SOC_DAIFMT_IB_NF:
1329 bclk |= WM5100_AIF1_BCLK_INV;
1330 break;
1331 case SND_SOC_DAIFMT_NB_IF:
1332 lrclk |= WM5100_AIF1TX_LRCLK_INV;
1333 break;
1334 default:
1335 return -EINVAL;
1336 }
1337
61195838 1338 snd_soc_component_update_bits(component, base + 1, WM5100_AIF1_BCLK_MSTR |
6d4baf08 1339 WM5100_AIF1_BCLK_INV, bclk);
61195838 1340 snd_soc_component_update_bits(component, base + 2, WM5100_AIF1TX_LRCLK_MSTR |
6d4baf08 1341 WM5100_AIF1TX_LRCLK_INV, lrclk);
61195838 1342 snd_soc_component_update_bits(component, base + 3, WM5100_AIF1TX_LRCLK_MSTR |
6d4baf08 1343 WM5100_AIF1TX_LRCLK_INV, lrclk);
61195838 1344 snd_soc_component_update_bits(component, base + 5, WM5100_AIF1_FMT_MASK, mask);
6d4baf08
MB		 1345
1346 return 0;
1347}
1348
1349#define WM5100_NUM_BCLK_RATES 19
1350
1351static int wm5100_bclk_rates_dat[WM5100_NUM_BCLK_RATES] = {
1352 32000,
1353 48000,
1354 64000,
1355 96000,
1356 128000,
1357 192000,
d73ec75c 1358 256000,
6d4baf08
MB		 1359 384000,
1360 512000,
1361 768000,
1362 1024000,
1363 1536000,
1364 2048000,
1365 3072000,
1366 4096000,
1367 6144000,
1368 8192000,
1369 12288000,
1370 24576000,
1371};
1372
1373static int wm5100_bclk_rates_cd[WM5100_NUM_BCLK_RATES] = {
1374 29400,
1375 44100,
1376 58800,
1377 88200,
1378 117600,
1379 176400,
1380 235200,
1381 352800,
1382 470400,
1383 705600,
1384 940800,
1385 1411200,
1386 1881600,
1387 2882400,
1388 3763200,
1389 5644800,
1390 7526400,
1391 11289600,
1392 22579600,
1393};
1394
1395static int wm5100_hw_params(struct snd_pcm_substream *substream,
1396 struct snd_pcm_hw_params *params,
1397 struct snd_soc_dai *dai)
1398{
61195838
KM		 1399 struct snd_soc_component *component = dai->component;
1400 struct wm5100_priv *wm5100 = snd_soc_component_get_drvdata(component);
6d4baf08
MB		 1401 bool async = wm5100->aif_async[dai->id];
1402 int i, base, bclk, aif_rate, lrclk, wl, fl, sr;
1403 int *bclk_rates;
1404
9b523124 1405 base = dai->driver->base;
6d4baf08
MB		 1406
1407 /* Data sizes if not using TDM */
0a3dcb50 1408 wl = params_width(params);
6d4baf08
MB		 1409 if (wl < 0)
1410 return wl;
1411 fl = snd_soc_params_to_frame_size(params);
1412 if (fl < 0)
1413 return fl;
1414
61195838 1415 dev_dbg(component->dev, "Word length %d bits, frame length %d bits\n",
6d4baf08
MB		 1416 wl, fl);
1417
1418 /* Target BCLK rate */
1419 bclk = snd_soc_params_to_bclk(params);
1420 if (bclk < 0)
1421 return bclk;
1422
1423 /* Root for BCLK depends on SYS/ASYNCCLK */
1424 if (!async) {
1425 aif_rate = wm5100->sysclk;
61195838 1426 sr = wm5100_alloc_sr(component, params_rate(params));
6d4baf08
MB		 1427 if (sr < 0)
1428 return sr;
1429 } else {
1430 /* If we're in ASYNCCLK set the ASYNC sample rate */
1431 aif_rate = wm5100->asyncclk;
1432 sr = 3;
1433
1434 for (i = 0; i < ARRAY_SIZE(wm5100_sr_code); i++)
1435 if (params_rate(params) == wm5100_sr_code[i])
1436 break;
1437 if (i == ARRAY_SIZE(wm5100_sr_code)) {
61195838 1438 dev_err(component->dev, "Invalid rate %dHzn",
6d4baf08
MB		 1439 params_rate(params));
1440 return -EINVAL;
1441 }
1442
1443 /* TODO: We should really check for symmetry */
61195838 1444 snd_soc_component_update_bits(component, WM5100_CLOCKING_8,
6d4baf08
MB		 1445 WM5100_ASYNC_SAMPLE_RATE_MASK, i);
1446 }
1447
1448 if (!aif_rate) {
61195838 1449 dev_err(component->dev, "%s has no rate set\n",
6d4baf08
MB		 1450 async ? "ASYNCCLK" : "SYSCLK");
1451 return -EINVAL;
1452 }
1453
61195838 1454 dev_dbg(component->dev, "Target BCLK is %dHz, using %dHz %s\n",
6d4baf08
MB		 1455 bclk, aif_rate, async ? "ASYNCCLK" : "SYSCLK");
1456
1457 if (aif_rate % 4000)
1458 bclk_rates = wm5100_bclk_rates_cd;
1459 else
1460 bclk_rates = wm5100_bclk_rates_dat;
1461
1462 for (i = 0; i < WM5100_NUM_BCLK_RATES; i++)
1463 if (bclk_rates[i] >= bclk && (bclk_rates[i] % bclk == 0))
1464 break;
1465 if (i == WM5100_NUM_BCLK_RATES) {
61195838 1466 dev_err(component->dev,
6d4baf08
MB		 1467 "No valid BCLK for %dHz found from %dHz %s\n",
1468 bclk, aif_rate, async ? "ASYNCCLK" : "SYSCLK");
1469 return -EINVAL;
1470 }
1471
1472 bclk = i;
61195838
KM		 1473 dev_dbg(component->dev, "Setting %dHz BCLK\n", bclk_rates[bclk]);
1474 snd_soc_component_update_bits(component, base + 1, WM5100_AIF1_BCLK_FREQ_MASK, bclk);
6d4baf08
MB		 1475
1476 lrclk = bclk_rates[bclk] / params_rate(params);
61195838 1477 dev_dbg(component->dev, "Setting %dHz LRCLK\n", bclk_rates[bclk] / lrclk);
6d4baf08
MB		 1478 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ||
1479 wm5100->aif_symmetric[dai->id])
61195838 1480 snd_soc_component_update_bits(component, base + 7,
6d4baf08
MB		 1481 WM5100_AIF1RX_BCPF_MASK, lrclk);
1482 else
61195838 1483 snd_soc_component_update_bits(component, base + 6,
6d4baf08
MB		 1484 WM5100_AIF1TX_BCPF_MASK, lrclk);
1485
1486 i = (wl << WM5100_AIF1TX_WL_SHIFT) | fl;
1487 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
61195838 1488 snd_soc_component_update_bits(component, base + 9,
6d4baf08
MB		 1489 WM5100_AIF1RX_WL_MASK |
1490 WM5100_AIF1RX_SLOT_LEN_MASK, i);
1491 else
61195838 1492 snd_soc_component_update_bits(component, base + 8,
6d4baf08
MB		 1493 WM5100_AIF1TX_WL_MASK |
1494 WM5100_AIF1TX_SLOT_LEN_MASK, i);
1495
61195838 1496 snd_soc_component_update_bits(component, base + 4, WM5100_AIF1_RATE_MASK, sr);
6d4baf08
MB		 1497
1498 return 0;
1499}
1500
85e7652d 1501static const struct snd_soc_dai_ops wm5100_dai_ops = {
6d4baf08
MB		 1502 .set_fmt = wm5100_set_fmt,
1503 .hw_params = wm5100_hw_params,
1504};
1505
61195838 1506static int wm5100_set_sysclk(struct snd_soc_component *component, int clk_id,
6d4baf08
MB		 1507 int source, unsigned int freq, int dir)
1508{
61195838 1509 struct wm5100_priv *wm5100 = snd_soc_component_get_drvdata(component);
6d4baf08
MB		 1510 int *rate_store;
1511 int fval, audio_rate, ret, reg;
1512
1513 switch (clk_id) {
1514 case WM5100_CLK_SYSCLK:
1515 reg = WM5100_CLOCKING_3;
1516 rate_store = &wm5100->sysclk;
1517 break;
1518 case WM5100_CLK_ASYNCCLK:
1519 reg = WM5100_CLOCKING_7;
1520 rate_store = &wm5100->asyncclk;
1521 break;
1522 case WM5100_CLK_32KHZ:
1523 /* The 32kHz clock is slightly different to the others */
1524 switch (source) {
1525 case WM5100_CLKSRC_MCLK1:
1526 case WM5100_CLKSRC_MCLK2:
1527 case WM5100_CLKSRC_SYSCLK:
61195838 1528 snd_soc_component_update_bits(component, WM5100_CLOCKING_1,
6d4baf08
MB		 1529 WM5100_CLK_32K_SRC_MASK,
1530 source);
1531 break;
1532 default:
1533 return -EINVAL;
1534 }
1535 return 0;
1536
1537 case WM5100_CLK_AIF1:
1538 case WM5100_CLK_AIF2:
1539 case WM5100_CLK_AIF3:
1540 /* Not real clocks, record which clock domain they're in */
1541 switch (source) {
1542 case WM5100_CLKSRC_SYSCLK:
1543 wm5100->aif_async[clk_id - 1] = false;
1544 break;
1545 case WM5100_CLKSRC_ASYNCCLK:
1546 wm5100->aif_async[clk_id - 1] = true;
1547 break;
1548 default:
61195838 1549 dev_err(component->dev, "Invalid source %d\n", source);
6d4baf08
MB		 1550 return -EINVAL;
1551 }
1552 return 0;
1553
1554 case WM5100_CLK_OPCLK:
1555 switch (freq) {
1556 case 5644800:
1557 case 6144000:
61195838 1558 snd_soc_component_update_bits(component, WM5100_MISC_GPIO_1,
6d4baf08
MB		 1559 WM5100_OPCLK_SEL_MASK, 0);
1560 break;
1561 case 11289600:
1562 case 12288000:
61195838 1563 snd_soc_component_update_bits(component, WM5100_MISC_GPIO_1,
6d4baf08
MB		 1564 WM5100_OPCLK_SEL_MASK, 0);
1565 break;
1566 case 22579200:
1567 case 24576000:
61195838 1568 snd_soc_component_update_bits(component, WM5100_MISC_GPIO_1,
6d4baf08
MB		 1569 WM5100_OPCLK_SEL_MASK, 0);
1570 break;
1571 default:
61195838 1572 dev_err(component->dev, "Unsupported OPCLK %dHz\n",
6d4baf08
MB		 1573 freq);
1574 return -EINVAL;
1575 }
1576 return 0;
1577
1578 default:
61195838 1579 dev_err(component->dev, "Unknown clock %d\n", clk_id);
6d4baf08
MB		 1580 return -EINVAL;
1581 }
1582
1583 switch (source) {
1584 case WM5100_CLKSRC_SYSCLK:
1585 case WM5100_CLKSRC_ASYNCCLK:
61195838 1586 dev_err(component->dev, "Invalid source %d\n", source);
6d4baf08
MB		 1587 return -EINVAL;
1588 }
1589
1590 switch (freq) {
1591 case 5644800:
1592 case 6144000:
1593 fval = 0;
1594 break;
1595 case 11289600:
1596 case 12288000:
1597 fval = 1;
1598 break;
1599 case 22579200:
11c2b5f2 1600 case 24576000:
6d4baf08
MB		 1601 fval = 2;
1602 break;
1603 default:
61195838 1604 dev_err(component->dev, "Invalid clock rate: %d\n", freq);
6d4baf08
MB		 1605 return -EINVAL;
1606 }
1607
1608 switch (freq) {
1609 case 5644800:
1610 case 11289600:
1611 case 22579200:
1612 audio_rate = 44100;
1613 break;
1614
1615 case 6144000:
1616 case 12288000:
11c2b5f2 1617 case 24576000:
6d4baf08
MB		 1618 audio_rate = 48000;
1619 break;
1620
1621 default:
1622 BUG();
1623 audio_rate = 0;
1624 break;
1625 }
1626
1627 /* TODO: Check if MCLKs are in use and enable/disable pulls to
1628 * match.
1629 */
1630
61195838 1631 snd_soc_component_update_bits(component, reg, WM5100_SYSCLK_FREQ_MASK |
6d4baf08
MB		 1632 WM5100_SYSCLK_SRC_MASK,
1633 fval << WM5100_SYSCLK_FREQ_SHIFT | source);
1634
1635 /* If this is SYSCLK then configure the clock rate for the
1636 * internal audio functions to the natural sample rate for
1637 * this clock rate.
1638 */
1639 if (clk_id == WM5100_CLK_SYSCLK) {
61195838 1640 dev_dbg(component->dev, "Setting primary audio rate to %dHz",
6d4baf08
MB		 1641 audio_rate);
1642 if (0 && *rate_store)
61195838
KM		 1643 wm5100_free_sr(component, audio_rate);
1644 ret = wm5100_alloc_sr(component, audio_rate);
6d4baf08 1645 if (ret != 0)
61195838 1646 dev_warn(component->dev, "Primary audio slot is %d\n",
6d4baf08
MB		 1647 ret);
1648 }
1649
1650 *rate_store = freq;
1651
1652 return 0;
1653}
1654
1655struct _fll_div {
1656 u16 fll_fratio;
1657 u16 fll_outdiv;
1658 u16 fll_refclk_div;
1659 u16 n;
1660 u16 theta;
1661 u16 lambda;
1662};
1663
1664static struct {
1665 unsigned int min;
1666 unsigned int max;
1667 u16 fll_fratio;
1668 int ratio;
1669} fll_fratios[] = {
1670 { 0, 64000, 4, 16 },
1671 { 64000, 128000, 3, 8 },
1672 { 128000, 256000, 2, 4 },
1673 { 256000, 1000000, 1, 2 },
1674 { 1000000, 13500000, 0, 1 },
1675};
1676
1677static int fll_factors(struct _fll_div *fll_div, unsigned int Fref,
1678 unsigned int Fout)
1679{
1680 unsigned int target;
1681 unsigned int div;
1682 unsigned int fratio, gcd_fll;
1683 int i;
1684
1685 /* Fref must be <=13.5MHz */
1686 div = 1;
1687 fll_div->fll_refclk_div = 0;
1688 while ((Fref / div) > 13500000) {
1689 div *= 2;
1690 fll_div->fll_refclk_div++;
1691
1692 if (div > 8) {
1693 pr_err("Can't scale %dMHz input down to <=13.5MHz\n",
1694 Fref);
1695 return -EINVAL;
1696 }
1697 }
1698
1699 pr_debug("FLL Fref=%u Fout=%u\n", Fref, Fout);
1700
1701 /* Apply the division for our remaining calculations */
1702 Fref /= div;
1703
1704 /* Fvco should be 90-100MHz; don't check the upper bound */
1705 div = 2;
1706 while (Fout * div < 90000000) {
1707 div++;
1708 if (div > 64) {
1709 pr_err("Unable to find FLL_OUTDIV for Fout=%uHz\n",
1710 Fout);
1711 return -EINVAL;
1712 }
1713 }
1714 target = Fout * div;
1715 fll_div->fll_outdiv = div - 1;
1716
1717 pr_debug("FLL Fvco=%dHz\n", target);
1718
1719 /* Find an appropraite FLL_FRATIO and factor it out of the target */
1720 for (i = 0; i < ARRAY_SIZE(fll_fratios); i++) {
1721 if (fll_fratios[i].min <= Fref && Fref <= fll_fratios[i].max) {
1722 fll_div->fll_fratio = fll_fratios[i].fll_fratio;
1723 fratio = fll_fratios[i].ratio;
1724 break;
1725 }
1726 }
1727 if (i == ARRAY_SIZE(fll_fratios)) {
1728 pr_err("Unable to find FLL_FRATIO for Fref=%uHz\n", Fref);
1729 return -EINVAL;
1730 }
1731
1732 fll_div->n = target / (fratio * Fref);
1733
1734 if (target % Fref == 0) {
1735 fll_div->theta = 0;
1736 fll_div->lambda = 0;
1737 } else {
1738 gcd_fll = gcd(target, fratio * Fref);
1739
1740 fll_div->theta = (target - (fll_div->n * fratio * Fref))
1741 / gcd_fll;
1742 fll_div->lambda = (fratio * Fref) / gcd_fll;
1743 }
1744
1745 pr_debug("FLL N=%x THETA=%x LAMBDA=%x\n",
1746 fll_div->n, fll_div->theta, fll_div->lambda);
1747 pr_debug("FLL_FRATIO=%x(%d) FLL_OUTDIV=%x FLL_REFCLK_DIV=%x\n",
1748 fll_div->fll_fratio, fratio, fll_div->fll_outdiv,
1749 fll_div->fll_refclk_div);
1750
1751 return 0;
1752}
1753
61195838 1754static int wm5100_set_fll(struct snd_soc_component *component, int fll_id, int source,
6d4baf08
MB		 1755 unsigned int Fref, unsigned int Fout)
1756{
61195838
KM		 1757 struct i2c_client *i2c = to_i2c_client(component->dev);
1758 struct wm5100_priv *wm5100 = snd_soc_component_get_drvdata(component);
6d4baf08
MB		 1759 struct _fll_div factors;
1760 struct wm5100_fll *fll;
1761 int ret, base, lock, i, timeout;
905a8086 1762 unsigned long time_left;
6d4baf08
MB		 1763
1764 switch (fll_id) {
1765 case WM5100_FLL1:
1766 fll = &wm5100->fll[0];
1767 base = WM5100_FLL1_CONTROL_1 - 1;
1768 lock = WM5100_FLL1_LOCK_STS;
1769 break;
1770 case WM5100_FLL2:
1771 fll = &wm5100->fll[1];
1772 base = WM5100_FLL2_CONTROL_2 - 1;
1773 lock = WM5100_FLL2_LOCK_STS;
1774 break;
1775 default:
61195838 1776 dev_err(component->dev, "Unknown FLL %d\n",fll_id);
6d4baf08
MB		 1777 return -EINVAL;
1778 }
1779
1780 if (!Fout) {
61195838 1781 dev_dbg(component->dev, "FLL%d disabled", fll_id);
62c1c401 1782 if (fll->fout)
61195838 1783 pm_runtime_put(component->dev);
6d4baf08 1784 fll->fout = 0;
61195838 1785 snd_soc_component_update_bits(component, base + 1, WM5100_FLL1_ENA, 0);
6d4baf08
MB		 1786 return 0;
1787 }
1788
1789 switch (source) {
1790 case WM5100_FLL_SRC_MCLK1:
1791 case WM5100_FLL_SRC_MCLK2:
1792 case WM5100_FLL_SRC_FLL1:
1793 case WM5100_FLL_SRC_FLL2:
1794 case WM5100_FLL_SRC_AIF1BCLK:
1795 case WM5100_FLL_SRC_AIF2BCLK:
1796 case WM5100_FLL_SRC_AIF3BCLK:
1797 break;
1798 default:
61195838 1799 dev_err(component->dev, "Invalid FLL source %d\n", source);
6d4baf08
MB		 1800 return -EINVAL;
1801 }
1802
1803 ret = fll_factors(&factors, Fref, Fout);
1804 if (ret < 0)
1805 return ret;
1806
1807 /* Disable the FLL while we reconfigure */
61195838 1808 snd_soc_component_update_bits(component, base + 1, WM5100_FLL1_ENA, 0);
6d4baf08 1809
61195838 1810 snd_soc_component_update_bits(component, base + 2,
6d4baf08
MB		 1811 WM5100_FLL1_OUTDIV_MASK | WM5100_FLL1_FRATIO_MASK,
1812 (factors.fll_outdiv << WM5100_FLL1_OUTDIV_SHIFT) |
1813 factors.fll_fratio);
61195838 1814 snd_soc_component_update_bits(component, base + 3, WM5100_FLL1_THETA_MASK,
6d4baf08 1815 factors.theta);
61195838
KM		 1816 snd_soc_component_update_bits(component, base + 5, WM5100_FLL1_N_MASK, factors.n);
1817 snd_soc_component_update_bits(component, base + 6,
6d4baf08
MB		 1818 WM5100_FLL1_REFCLK_DIV_MASK |
1819 WM5100_FLL1_REFCLK_SRC_MASK,
1820 (factors.fll_refclk_div
1821 << WM5100_FLL1_REFCLK_DIV_SHIFT) | source);
61195838 1822 snd_soc_component_update_bits(component, base + 7, WM5100_FLL1_LAMBDA_MASK,
6d4baf08
MB		 1823 factors.lambda);
1824
1825 /* Clear any pending completions */
1826 try_wait_for_completion(&fll->lock);
1827
61195838 1828 pm_runtime_get_sync(component->dev);
62c1c401 1829
61195838 1830 snd_soc_component_update_bits(component, base + 1, WM5100_FLL1_ENA, WM5100_FLL1_ENA);
6d4baf08
MB		 1831
1832 if (i2c->irq)
1833 timeout = 2;
1834 else
1835 timeout = 50;
1836
61195838 1837 snd_soc_component_update_bits(component, WM5100_CLOCKING_3, WM5100_SYSCLK_ENA,
bd132ec5
MB		 1838 WM5100_SYSCLK_ENA);
1839
6d4baf08
MB		 1840 /* Poll for the lock; will use interrupt when we can test */
1841 for (i = 0; i < timeout; i++) {
1842 if (i2c->irq) {
905a8086
NMG		 1843 time_left = wait_for_completion_timeout(&fll->lock,
1844 msecs_to_jiffies(25));
1845 if (time_left > 0)
6d4baf08
MB		 1846 break;
1847 } else {
1848 msleep(1);
1849 }
1850
6d75dfc3 1851 ret = snd_soc_component_read(component,
6d4baf08
MB		 1852 WM5100_INTERRUPT_RAW_STATUS_3);
1853 if (ret < 0) {
61195838 1854 dev_err(component->dev,
6d4baf08
MB		 1855 "Failed to read FLL status: %d\n",
1856 ret);
1857 continue;
1858 }
1859 if (ret & lock)
1860 break;
1861 }
1862 if (i == timeout) {
61195838
KM		 1863 dev_err(component->dev, "FLL%d lock timed out\n", fll_id);
1864 pm_runtime_put(component->dev);
6d4baf08
MB		 1865 return -ETIMEDOUT;
1866 }
1867
1868 fll->src = source;
1869 fll->fref = Fref;
1870 fll->fout = Fout;
1871
61195838 1872 dev_dbg(component->dev, "FLL%d running %dHz->%dHz\n", fll_id,
6d4baf08
MB		 1873 Fref, Fout);
1874
1875 return 0;
1876}
1877
1878/* Actually go much higher */
1879#define WM5100_RATES SNDRV_PCM_RATE_8000_192000
1880
1881#define WM5100_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
1882 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE)
1883
1884static struct snd_soc_dai_driver wm5100_dai[] = {
1885 {
1886 .name = "wm5100-aif1",
9b523124 1887 .base = WM5100_AUDIO_IF_1_1 - 1,
6d4baf08
MB		 1888 .playback = {
1889 .stream_name = "AIF1 Playback",
1890 .channels_min = 2,
1891 .channels_max = 2,
1892 .rates = WM5100_RATES,
1893 .formats = WM5100_FORMATS,
1894 },
1895 .capture = {
1896 .stream_name = "AIF1 Capture",
1897 .channels_min = 2,
1898 .channels_max = 2,
1899 .rates = WM5100_RATES,
1900 .formats = WM5100_FORMATS,
1901 },
1902 .ops = &wm5100_dai_ops,
1903 },
1904 {
1905 .name = "wm5100-aif2",
1906 .id = 1,
9b523124 1907 .base = WM5100_AUDIO_IF_2_1 - 1,
6d4baf08
MB		 1908 .playback = {
1909 .stream_name = "AIF2 Playback",
1910 .channels_min = 2,
1911 .channels_max = 2,
1912 .rates = WM5100_RATES,
1913 .formats = WM5100_FORMATS,
1914 },
1915 .capture = {
1916 .stream_name = "AIF2 Capture",
1917 .channels_min = 2,
1918 .channels_max = 2,
1919 .rates = WM5100_RATES,
1920 .formats = WM5100_FORMATS,
1921 },
1922 .ops = &wm5100_dai_ops,
1923 },
1924 {
1925 .name = "wm5100-aif3",
1926 .id = 2,
9b523124 1927 .base = WM5100_AUDIO_IF_3_1 - 1,
6d4baf08
MB		 1928 .playback = {
1929 .stream_name = "AIF3 Playback",
1930 .channels_min = 2,
1931 .channels_max = 2,
1932 .rates = WM5100_RATES,
1933 .formats = WM5100_FORMATS,
1934 },
1935 .capture = {
1936 .stream_name = "AIF3 Capture",
1937 .channels_min = 2,
1938 .channels_max = 2,
1939 .rates = WM5100_RATES,
1940 .formats = WM5100_FORMATS,
1941 },
1942 .ops = &wm5100_dai_ops,
1943 },
1944};
1945
1946static int wm5100_dig_vu[] = {
1947 WM5100_ADC_DIGITAL_VOLUME_1L,
1948 WM5100_ADC_DIGITAL_VOLUME_1R,
1949 WM5100_ADC_DIGITAL_VOLUME_2L,
1950 WM5100_ADC_DIGITAL_VOLUME_2R,
1951 WM5100_ADC_DIGITAL_VOLUME_3L,
1952 WM5100_ADC_DIGITAL_VOLUME_3R,
1953 WM5100_ADC_DIGITAL_VOLUME_4L,
1954 WM5100_ADC_DIGITAL_VOLUME_4R,
1955
1956 WM5100_DAC_DIGITAL_VOLUME_1L,
1957 WM5100_DAC_DIGITAL_VOLUME_1R,
1958 WM5100_DAC_DIGITAL_VOLUME_2L,
1959 WM5100_DAC_DIGITAL_VOLUME_2R,
1960 WM5100_DAC_DIGITAL_VOLUME_3L,
1961 WM5100_DAC_DIGITAL_VOLUME_3R,
1962 WM5100_DAC_DIGITAL_VOLUME_4L,
1963 WM5100_DAC_DIGITAL_VOLUME_4R,
1964 WM5100_DAC_DIGITAL_VOLUME_5L,
1965 WM5100_DAC_DIGITAL_VOLUME_5R,
1966 WM5100_DAC_DIGITAL_VOLUME_6L,
1967 WM5100_DAC_DIGITAL_VOLUME_6R,
1968};
1969
46c1a877 1970static void wm5100_set_detect_mode(struct wm5100_priv *wm5100, int the_mode)
ba896ede 1971{
ba896ede
MB		 1972 struct wm5100_jack_mode *mode = &wm5100->pdata.jack_modes[the_mode];
1973
95ff71e9
TI		 1974 if (WARN_ON(the_mode >= ARRAY_SIZE(wm5100->pdata.jack_modes)))
1975 return;
ba896ede
MB		 1976
1977 gpio_set_value_cansleep(wm5100->pdata.hp_pol, mode->hp_pol);
46c1a877
MB		 1978 regmap_update_bits(wm5100->regmap, WM5100_ACCESSORY_DETECT_MODE_1,
1979 WM5100_ACCDET_BIAS_SRC_MASK |
1980 WM5100_ACCDET_SRC,
1981 (mode->bias << WM5100_ACCDET_BIAS_SRC_SHIFT) |
1982 mode->micd_src << WM5100_ACCDET_SRC_SHIFT);
1983 regmap_update_bits(wm5100->regmap, WM5100_MISC_CONTROL,
1984 WM5100_HPCOM_SRC,
1985 mode->micd_src << WM5100_HPCOM_SRC_SHIFT);
ba896ede
MB		 1986
1987 wm5100->jack_mode = the_mode;
1988
46c1a877 1989 dev_dbg(wm5100->dev, "Set microphone polarity to %d\n",
ba896ede
MB		 1990 wm5100->jack_mode);
1991}
1992
2633f736
MB		 1993static void wm5100_report_headphone(struct wm5100_priv *wm5100)
1994{
1995 dev_dbg(wm5100->dev, "Headphone detected\n");
1996 wm5100->jack_detecting = false;
1997 snd_soc_jack_report(wm5100->jack, SND_JACK_HEADPHONE,
1998 SND_JACK_HEADPHONE);
1999
2000 /* Increase the detection rate a bit for responsiveness. */
2001 regmap_update_bits(wm5100->regmap, WM5100_MIC_DETECT_1,
2002 WM5100_ACCDET_RATE_MASK,
2003 7 << WM5100_ACCDET_RATE_SHIFT);
2004}
2005
46c1a877 2006static void wm5100_micd_irq(struct wm5100_priv *wm5100)
ba896ede 2007{
46c1a877
MB		 2008 unsigned int val;
2009 int ret;
ba896ede 2010
46c1a877
MB		 2011 ret = regmap_read(wm5100->regmap, WM5100_MIC_DETECT_3, &val);
2012 if (ret != 0) {
fd9f069d 2013 dev_err(wm5100->dev, "Failed to read microphone status: %d\n",
46c1a877
MB		 2014 ret);
2015 return;
2016 }
ba896ede 2017
46c1a877 2018 dev_dbg(wm5100->dev, "Microphone event: %x\n", val);
ba896ede
MB		 2019
2020 if (!(val & WM5100_ACCDET_VALID)) {
46c1a877 2021 dev_warn(wm5100->dev, "Microphone detection state invalid\n");
ba896ede
MB		 2022 return;
2023 }
2024
2025 /* No accessory, reset everything and report removal */
2026 if (!(val & WM5100_ACCDET_STS)) {
46c1a877 2027 dev_dbg(wm5100->dev, "Jack removal detected\n");
ba896ede
MB		 2028 wm5100->jack_mic = false;
2029 wm5100->jack_detecting = true;
2633f736 2030 wm5100->jack_flips = 0;
ba896ede
MB		 2031 snd_soc_jack_report(wm5100->jack, 0,
2032 SND_JACK_LINEOUT | SND_JACK_HEADSET |
2033 SND_JACK_BTN_0);
2034
46c1a877
MB		 2035 regmap_update_bits(wm5100->regmap, WM5100_MIC_DETECT_1,
2036 WM5100_ACCDET_RATE_MASK,
2037 WM5100_ACCDET_RATE_MASK);
ba896ede
MB		 2038 return;
2039 }
2040
2041 /* If the measurement is very high we've got a microphone,
2042 * either we just detected one or if we already reported then
2043 * we've got a button release event.
2044 */
2045 if (val & 0x400) {
2046 if (wm5100->jack_detecting) {
46c1a877 2047 dev_dbg(wm5100->dev, "Microphone detected\n");
ba896ede 2048 wm5100->jack_mic = true;
9fb83526 2049 wm5100->jack_detecting = false;
ba896ede
MB		 2050 snd_soc_jack_report(wm5100->jack,
2051 SND_JACK_HEADSET,
2052 SND_JACK_HEADSET | SND_JACK_BTN_0);
2053
2054 /* Increase poll rate to give better responsiveness
2055 * for buttons */
46c1a877
MB		 2056 regmap_update_bits(wm5100->regmap, WM5100_MIC_DETECT_1,
2057 WM5100_ACCDET_RATE_MASK,
2058 5 << WM5100_ACCDET_RATE_SHIFT);
ba896ede 2059 } else {
46c1a877 2060 dev_dbg(wm5100->dev, "Mic button up\n");
ba896ede
MB		 2061 snd_soc_jack_report(wm5100->jack, 0, SND_JACK_BTN_0);
2062 }
2063
2064 return;
2065 }
2066
2067 /* If we detected a lower impedence during initial startup
2068 * then we probably have the wrong polarity, flip it. Don't
2069 * do this for the lowest impedences to speed up detection of
2633f736
MB		 2070 * plain headphones and give up if neither polarity looks
2071 * sensible.
ba896ede
MB		 2072 */
2073 if (wm5100->jack_detecting && (val & 0x3f8)) {
2633f736
MB		 2074 wm5100->jack_flips++;
2075
2076 if (wm5100->jack_flips > 1)
2077 wm5100_report_headphone(wm5100);
2078 else
2079 wm5100_set_detect_mode(wm5100, !wm5100->jack_mode);
ba896ede
MB		 2080
2081 return;
2082 }
2083
2084 /* Don't distinguish between buttons, just report any low
2085 * impedence as BTN_0.
2086 */
2087 if (val & 0x3fc) {
2088 if (wm5100->jack_mic) {
46c1a877 2089 dev_dbg(wm5100->dev, "Mic button detected\n");
ba896ede
MB		 2090 snd_soc_jack_report(wm5100->jack, SND_JACK_BTN_0,
2091 SND_JACK_BTN_0);
2092 } else if (wm5100->jack_detecting) {
2633f736 2093 wm5100_report_headphone(wm5100);
ba896ede
MB		 2094 }
2095 }
2096}
2097
61195838 2098int wm5100_detect(struct snd_soc_component *component, struct snd_soc_jack *jack)
ba896ede 2099{
61195838
KM		 2100 struct wm5100_priv *wm5100 = snd_soc_component_get_drvdata(component);
2101 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
ba896ede
MB		 2102
2103 if (jack) {
2104 wm5100->jack = jack;
2105 wm5100->jack_detecting = true;
2633f736 2106 wm5100->jack_flips = 0;
ba896ede 2107
46c1a877 2108 wm5100_set_detect_mode(wm5100, 0);
ba896ede
MB		 2109
2110 /* Slowest detection rate, gives debounce for initial
2111 * detection */
61195838 2112 snd_soc_component_update_bits(component, WM5100_MIC_DETECT_1,
ba896ede
MB		 2113 WM5100_ACCDET_BIAS_STARTTIME_MASK |
2114 WM5100_ACCDET_RATE_MASK,
2115 (7 << WM5100_ACCDET_BIAS_STARTTIME_SHIFT) |
2116 WM5100_ACCDET_RATE_MASK);
2117
2118 /* We need the charge pump to power MICBIAS */
e951f267
CK		 2119 snd_soc_dapm_mutex_lock(dapm);
2120
2121 snd_soc_dapm_force_enable_pin_unlocked(dapm, "CP2");
2122 snd_soc_dapm_force_enable_pin_unlocked(dapm, "SYSCLK");
2123
2124 snd_soc_dapm_sync_unlocked(dapm);
2125
2126 snd_soc_dapm_mutex_unlock(dapm);
ba896ede
MB		 2127
2128 /* We start off just enabling microphone detection - even a
2129 * plain headphone will trigger detection.
2130 */
61195838 2131 snd_soc_component_update_bits(component, WM5100_MIC_DETECT_1,
ba896ede
MB		 2132 WM5100_ACCDET_ENA, WM5100_ACCDET_ENA);
2133
61195838 2134 snd_soc_component_update_bits(component, WM5100_INTERRUPT_STATUS_3_MASK,
ba896ede
MB		 2135 WM5100_IM_ACCDET_EINT, 0);
2136 } else {
61195838 2137 snd_soc_component_update_bits(component, WM5100_INTERRUPT_STATUS_3_MASK,
ba896ede
MB		 2138 WM5100_IM_HPDET_EINT |
2139 WM5100_IM_ACCDET_EINT,
2140 WM5100_IM_HPDET_EINT |
2141 WM5100_IM_ACCDET_EINT);
61195838 2142 snd_soc_component_update_bits(component, WM5100_MIC_DETECT_1,
ba896ede
MB		 2143 WM5100_ACCDET_ENA, 0);
2144 wm5100->jack = NULL;
2145 }
2146
2147 return 0;
2148}
0cf0f174 2149EXPORT_SYMBOL_GPL(wm5100_detect);
ba896ede 2150
6d4baf08
MB		 2151static irqreturn_t wm5100_irq(int irq, void *data)
2152{
46c1a877 2153 struct wm5100_priv *wm5100 = data;
6d4baf08 2154 irqreturn_t status = IRQ_NONE;
46c1a877
MB		 2155 unsigned int irq_val, mask_val;
2156 int ret;
6d4baf08 2157
46c1a877
MB		 2158 ret = regmap_read(wm5100->regmap, WM5100_INTERRUPT_STATUS_3, &irq_val);
2159 if (ret < 0) {
2160 dev_err(wm5100->dev, "Failed to read IRQ status 3: %d\n",
2161 ret);
6d4baf08
MB		 2162 irq_val = 0;
2163 }
6d4baf08 2164
46c1a877
MB		 2165 ret = regmap_read(wm5100->regmap, WM5100_INTERRUPT_STATUS_3_MASK,
2166 &mask_val);
2167 if (ret < 0) {
2168 dev_err(wm5100->dev, "Failed to read IRQ mask 3: %d\n",
2169 ret);
2170 mask_val = 0xffff;
2171 }
2172
2173 irq_val &= ~mask_val;
2174
2175 regmap_write(wm5100->regmap, WM5100_INTERRUPT_STATUS_3, irq_val);
6d4baf08
MB		 2176
2177 if (irq_val)
2178 status = IRQ_HANDLED;
2179
46c1a877 2180 wm5100_log_status3(wm5100, irq_val);
6d4baf08
MB		 2181
2182 if (irq_val & WM5100_FLL1_LOCK_EINT) {
46c1a877 2183 dev_dbg(wm5100->dev, "FLL1 locked\n");
6d4baf08
MB		 2184 complete(&wm5100->fll[0].lock);
2185 }
2186 if (irq_val & WM5100_FLL2_LOCK_EINT) {
46c1a877 2187 dev_dbg(wm5100->dev, "FLL2 locked\n");
6d4baf08
MB		 2188 complete(&wm5100->fll[1].lock);
2189 }
2190
ba896ede 2191 if (irq_val & WM5100_ACCDET_EINT)
46c1a877 2192 wm5100_micd_irq(wm5100);
ba896ede 2193
46c1a877
MB		 2194 ret = regmap_read(wm5100->regmap, WM5100_INTERRUPT_STATUS_4, &irq_val);
2195 if (ret < 0) {
2196 dev_err(wm5100->dev, "Failed to read IRQ status 4: %d\n",
2197 ret);
6d4baf08
MB		 2198 irq_val = 0;
2199 }
46c1a877
MB		 2200
2201 ret = regmap_read(wm5100->regmap, WM5100_INTERRUPT_STATUS_4_MASK,
2202 &mask_val);
2203 if (ret < 0) {
2204 dev_err(wm5100->dev, "Failed to read IRQ mask 4: %d\n",
2205 ret);
2206 mask_val = 0xffff;
2207 }
2208
2209 irq_val &= ~mask_val;
6d4baf08
MB		 2210
2211 if (irq_val)
2212 status = IRQ_HANDLED;
2213
46c1a877 2214 regmap_write(wm5100->regmap, WM5100_INTERRUPT_STATUS_4, irq_val);
6d4baf08 2215
46c1a877 2216 wm5100_log_status4(wm5100, irq_val);
6d4baf08
MB		 2217
2218 return status;
2219}
2220
2221static irqreturn_t wm5100_edge_irq(int irq, void *data)
2222{
2223 irqreturn_t ret = IRQ_NONE;
2224 irqreturn_t val;
2225
2226 do {
2227 val = wm5100_irq(irq, data);
2228 if (val != IRQ_NONE)
2229 ret = val;
2230 } while (val != IRQ_NONE);
2231
2232 return ret;
2233}
2234
2235#ifdef CONFIG_GPIOLIB
6d4baf08
MB		 2236static void wm5100_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
2237{
db1d1270 2238 struct wm5100_priv *wm5100 = gpiochip_get_data(chip);
6d4baf08 2239
9db16e4c
MB		 2240 regmap_update_bits(wm5100->regmap, WM5100_GPIO_CTRL_1 + offset,
2241 WM5100_GP1_LVL, !!value << WM5100_GP1_LVL_SHIFT);
6d4baf08
MB		 2242}
2243
2244static int wm5100_gpio_direction_out(struct gpio_chip *chip,
2245 unsigned offset, int value)
2246{
db1d1270 2247 struct wm5100_priv *wm5100 = gpiochip_get_data(chip);
64964e82 2248 int val, ret;
6d4baf08
MB		 2249
2250 val = (1 << WM5100_GP1_FN_SHIFT) | (!!value << WM5100_GP1_LVL_SHIFT);
2251
9db16e4c
MB		 2252 ret = regmap_update_bits(wm5100->regmap, WM5100_GPIO_CTRL_1 + offset,
2253 WM5100_GP1_FN_MASK | WM5100_GP1_DIR |
2254 WM5100_GP1_LVL, val);
64964e82
MB		 2255 if (ret < 0)
2256 return ret;
2257 else
2258 return 0;
6d4baf08
MB		 2259}
2260
2261static int wm5100_gpio_get(struct gpio_chip *chip, unsigned offset)
2262{
db1d1270 2263 struct wm5100_priv *wm5100 = gpiochip_get_data(chip);
9db16e4c 2264 unsigned int reg;
6d4baf08
MB		 2265 int ret;
2266
9db16e4c 2267 ret = regmap_read(wm5100->regmap, WM5100_GPIO_CTRL_1 + offset, &reg);
6d4baf08
MB		 2268 if (ret < 0)
2269 return ret;
2270
9db16e4c 2271 return (reg & WM5100_GP1_LVL) != 0;
6d4baf08
MB		 2272}
2273
2274static int wm5100_gpio_direction_in(struct gpio_chip *chip, unsigned offset)
2275{
db1d1270 2276 struct wm5100_priv *wm5100 = gpiochip_get_data(chip);
6d4baf08 2277
9db16e4c
MB		 2278 return regmap_update_bits(wm5100->regmap, WM5100_GPIO_CTRL_1 + offset,
2279 WM5100_GP1_FN_MASK | WM5100_GP1_DIR,
2280 (1 << WM5100_GP1_FN_SHIFT) |
2281 (1 << WM5100_GP1_DIR_SHIFT));
6d4baf08
MB		 2282}
2283
c59b24f8 2284static const struct gpio_chip wm5100_template_chip = {
6d4baf08
MB		 2285 .label = "wm5100",
2286 .owner = THIS_MODULE,
2287 .direction_output = wm5100_gpio_direction_out,
2288 .set = wm5100_gpio_set,
2289 .direction_input = wm5100_gpio_direction_in,
2290 .get = wm5100_gpio_get,
2291 .can_sleep = 1,
2292};
2293
9db16e4c 2294static void wm5100_init_gpio(struct i2c_client *i2c)
6d4baf08 2295{
9db16e4c 2296 struct wm5100_priv *wm5100 = i2c_get_clientdata(i2c);
6d4baf08
MB		 2297 int ret;
2298
2299 wm5100->gpio_chip = wm5100_template_chip;
2300 wm5100->gpio_chip.ngpio = 6;
58383c78 2301 wm5100->gpio_chip.parent = &i2c->dev;
6d4baf08
MB		 2302
2303 if (wm5100->pdata.gpio_base)
2304 wm5100->gpio_chip.base = wm5100->pdata.gpio_base;
2305 else
2306 wm5100->gpio_chip.base = -1;
2307
db1d1270 2308 ret = gpiochip_add_data(&wm5100->gpio_chip, wm5100);
6d4baf08 2309 if (ret != 0)
9db16e4c 2310 dev_err(&i2c->dev, "Failed to add GPIOs: %d\n", ret);
6d4baf08
MB		 2311}
2312
9db16e4c 2313static void wm5100_free_gpio(struct i2c_client *i2c)
6d4baf08 2314{
9db16e4c 2315 struct wm5100_priv *wm5100 = i2c_get_clientdata(i2c);
6d4baf08 2316
88d5e520 2317 gpiochip_remove(&wm5100->gpio_chip);
6d4baf08
MB		 2318}
2319#else
9db16e4c 2320static void wm5100_init_gpio(struct i2c_client *i2c)
6d4baf08
MB		 2321{
2322}
2323
9db16e4c 2324static void wm5100_free_gpio(struct i2c_client *i2c)
6d4baf08
MB		 2325{
2326}
2327#endif
2328
61195838 2329static int wm5100_probe(struct snd_soc_component *component)
6d4baf08 2330{
61195838
KM		 2331 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
2332 struct i2c_client *i2c = to_i2c_client(component->dev);
2333 struct wm5100_priv *wm5100 = snd_soc_component_get_drvdata(component);
09452f23 2334 int ret, i;
6d4baf08 2335
61195838 2336 wm5100->component = component;
6d4baf08 2337
6d4baf08 2338 for (i = 0; i < ARRAY_SIZE(wm5100_dig_vu); i++)
61195838 2339 snd_soc_component_update_bits(component, wm5100_dig_vu[i], WM5100_OUT_VU,
6d4baf08
MB		 2340 WM5100_OUT_VU);
2341
6d4baf08 2342 /* Don't debounce interrupts to support use of SYSCLK only */
61195838
KM		 2343 snd_soc_component_write(component, WM5100_IRQ_DEBOUNCE_1, 0);
2344 snd_soc_component_write(component, WM5100_IRQ_DEBOUNCE_2, 0);
6d4baf08
MB		 2345
2346 /* TODO: check if we're symmetric */
2347
09452f23 2348 if (i2c->irq)
002d1c4e 2349 snd_soc_dapm_new_controls(dapm, wm5100_dapm_widgets_noirq,
6d4baf08 2350 ARRAY_SIZE(wm5100_dapm_widgets_noirq));
6d4baf08
MB		 2351
2352 if (wm5100->pdata.hp_pol) {
2353 ret = gpio_request_one(wm5100->pdata.hp_pol,
2354 GPIOF_OUT_INIT_HIGH, "WM5100 HP_POL");
2355 if (ret < 0) {
2356 dev_err(&i2c->dev, "Failed to request HP_POL %d: %d\n",
2357 wm5100->pdata.hp_pol, ret);
2358 goto err_gpio;
2359 }
2360 }
2361
6d4baf08
MB		 2362 return 0;
2363
2364err_gpio:
6d4baf08
MB		 2365
2366 return ret;
2367}
2368
61195838 2369static void wm5100_remove(struct snd_soc_component *component)
6d4baf08 2370{
61195838 2371 struct wm5100_priv *wm5100 = snd_soc_component_get_drvdata(component);
6d4baf08 2372
6d4baf08
MB		 2373 if (wm5100->pdata.hp_pol) {
2374 gpio_free(wm5100->pdata.hp_pol);
2375 }
6d4baf08
MB		 2376}
2377
61195838
KM		 2378static const struct snd_soc_component_driver soc_component_dev_wm5100 = {
2379 .probe = wm5100_probe,
2380 .remove = wm5100_remove,
2381 .set_sysclk = wm5100_set_sysclk,
2382 .set_pll = wm5100_set_fll,
2383 .seq_notifier = wm5100_seq_notifier,
2384 .controls = wm5100_snd_controls,
2385 .num_controls = ARRAY_SIZE(wm5100_snd_controls),
2386 .dapm_widgets = wm5100_dapm_widgets,
2387 .num_dapm_widgets = ARRAY_SIZE(wm5100_dapm_widgets),
2388 .dapm_routes = wm5100_dapm_routes,
2389 .num_dapm_routes = ARRAY_SIZE(wm5100_dapm_routes),
2390 .use_pmdown_time = 1,
2391 .endianness = 1,
2392 .non_legacy_dai_naming = 1,
bd132ec5 2393};
6d4baf08 2394
bd132ec5
MB		 2395static const struct regmap_config wm5100_regmap = {
2396 .reg_bits = 16,
2397 .val_bits = 16,
6d4baf08 2398
bd132ec5
MB		 2399 .max_register = WM5100_MAX_REGISTER,
2400 .reg_defaults = wm5100_reg_defaults,
2401 .num_reg_defaults = ARRAY_SIZE(wm5100_reg_defaults),
2402 .volatile_reg = wm5100_volatile_register,
2403 .readable_reg = wm5100_readable_register,
2404 .cache_type = REGCACHE_RBTREE,
6d4baf08
MB		 2405};
2406
a188fcba
MB		 2407static const unsigned int wm5100_mic_ctrl_reg[] = {
2408 WM5100_IN1L_CONTROL,
2409 WM5100_IN2L_CONTROL,
2410 WM5100_IN3L_CONTROL,
2411 WM5100_IN4L_CONTROL,
2412};
2413
97b0b6e3 2414static int wm5100_i2c_probe(struct i2c_client *i2c)
6d4baf08
MB		 2415{
2416 struct wm5100_pdata *pdata = dev_get_platdata(&i2c->dev);
2417 struct wm5100_priv *wm5100;
588ac5e0 2418 unsigned int reg;
09452f23 2419 int ret, i, irq_flags;
6d4baf08 2420
a81b82c0
MB		 2421 wm5100 = devm_kzalloc(&i2c->dev, sizeof(struct wm5100_priv),
2422 GFP_KERNEL);
6d4baf08
MB		 2423 if (wm5100 == NULL)
2424 return -ENOMEM;
2425
46c1a877
MB		 2426 wm5100->dev = &i2c->dev;
2427
77caabaa 2428 wm5100->regmap = devm_regmap_init_i2c(i2c, &wm5100_regmap);
bd132ec5
MB		 2429 if (IS_ERR(wm5100->regmap)) {
2430 ret = PTR_ERR(wm5100->regmap);
2431 dev_err(&i2c->dev, "Failed to allocate register map: %d\n",
2432 ret);
a81b82c0 2433 goto err;
bd132ec5
MB		 2434 }
2435
6d4baf08
MB		 2436 for (i = 0; i < ARRAY_SIZE(wm5100->fll); i++)
2437 init_completion(&wm5100->fll[i].lock);
2438
2439 if (pdata)
2440 wm5100->pdata = *pdata;
2441
2442 i2c_set_clientdata(i2c, wm5100);
2443
588ac5e0
MB		 2444 for (i = 0; i < ARRAY_SIZE(wm5100->core_supplies); i++)
2445 wm5100->core_supplies[i].supply = wm5100_core_supply_names[i];
2446
17e3e57b
MB		 2447 ret = devm_regulator_bulk_get(&i2c->dev,
2448 ARRAY_SIZE(wm5100->core_supplies),
2449 wm5100->core_supplies);
588ac5e0
MB		 2450 if (ret != 0) {
2451 dev_err(&i2c->dev, "Failed to request core supplies: %d\n",
2452 ret);
77caabaa 2453 goto err;
588ac5e0
MB		 2454 }
2455
588ac5e0
MB		 2456 ret = regulator_bulk_enable(ARRAY_SIZE(wm5100->core_supplies),
2457 wm5100->core_supplies);
2458 if (ret != 0) {
2459 dev_err(&i2c->dev, "Failed to enable core supplies: %d\n",
2460 ret);
77caabaa 2461 goto err;
588ac5e0
MB		 2462 }
2463
2464 if (wm5100->pdata.ldo_ena) {
2465 ret = gpio_request_one(wm5100->pdata.ldo_ena,
2466 GPIOF_OUT_INIT_HIGH, "WM5100 LDOENA");
2467 if (ret < 0) {
2468 dev_err(&i2c->dev, "Failed to request LDOENA %d: %d\n",
2469 wm5100->pdata.ldo_ena, ret);
2470 goto err_enable;
2471 }
2472 msleep(2);
2473 }
2474
2475 if (wm5100->pdata.reset) {
2476 ret = gpio_request_one(wm5100->pdata.reset,
2477 GPIOF_OUT_INIT_HIGH, "WM5100 /RESET");
2478 if (ret < 0) {
2479 dev_err(&i2c->dev, "Failed to request /RESET %d: %d\n",
2480 wm5100->pdata.reset, ret);
2481 goto err_ldo;
2482 }
2483 }
2484
2485 ret = regmap_read(wm5100->regmap, WM5100_SOFTWARE_RESET, &reg);
2486 if (ret < 0) {
0132615d 2487 dev_err(&i2c->dev, "Failed to read ID register: %d\n", ret);
588ac5e0
MB		 2488 goto err_reset;
2489 }
2490 switch (reg) {
2491 case 0x8997:
2492 case 0x5100:
2493 break;
2494
2495 default:
2496 dev_err(&i2c->dev, "Device is not a WM5100, ID is %x\n", reg);
2497 ret = -EINVAL;
2498 goto err_reset;
2499 }
2500
2501 ret = regmap_read(wm5100->regmap, WM5100_DEVICE_REVISION, &reg);
2502 if (ret < 0) {
2503 dev_err(&i2c->dev, "Failed to read revision register\n");
2504 goto err_reset;
2505 }
2506 wm5100->rev = reg & WM5100_DEVICE_REVISION_MASK;
2507
2508 dev_info(&i2c->dev, "revision %c\n", wm5100->rev + 'A');
2509
2510 ret = wm5100_reset(wm5100);
2511 if (ret < 0) {
2512 dev_err(&i2c->dev, "Failed to issue reset\n");
2513 goto err_reset;
2514 }
2515
15b52f10
MB		 2516 switch (wm5100->rev) {
2517 case 0:
2518 ret = regmap_register_patch(wm5100->regmap,
2519 wm5100_reva_patches,
2520 ARRAY_SIZE(wm5100_reva_patches));
2521 if (ret != 0) {
2522 dev_err(&i2c->dev, "Failed to register patches: %d\n",
2523 ret);
2524 goto err_reset;
2525 }
2526 break;
2527 default:
2528 break;
2529 }
2530
2531
9db16e4c
MB		 2532 wm5100_init_gpio(i2c);
2533
d9b5e9c6
MB		 2534 for (i = 0; i < ARRAY_SIZE(wm5100->pdata.gpio_defaults); i++) {
2535 if (!wm5100->pdata.gpio_defaults[i])
2536 continue;
2537
2538 regmap_write(wm5100->regmap, WM5100_GPIO_CTRL_1 + i,
2539 wm5100->pdata.gpio_defaults[i]);
2540 }
2541
2542 for (i = 0; i < ARRAY_SIZE(wm5100->pdata.in_mode); i++) {
a188fcba 2543 regmap_update_bits(wm5100->regmap, wm5100_mic_ctrl_reg[i],
d9b5e9c6
MB		 2544 WM5100_IN1_MODE_MASK |
2545 WM5100_IN1_DMIC_SUP_MASK,
2546 (wm5100->pdata.in_mode[i] <<
2547 WM5100_IN1_MODE_SHIFT) |
2548 (wm5100->pdata.dmic_sup[i] <<
2549 WM5100_IN1_DMIC_SUP_SHIFT));
2550 }
2551
09452f23
MB		 2552 if (i2c->irq) {
2553 if (wm5100->pdata.irq_flags)
2554 irq_flags = wm5100->pdata.irq_flags;
2555 else
2556 irq_flags = IRQF_TRIGGER_LOW;
2557
2558 irq_flags |= IRQF_ONESHOT;
2559
2560 if (irq_flags & (IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING))
2561 ret = request_threaded_irq(i2c->irq, NULL,
efc04ca2 2562 wm5100_edge_irq, irq_flags,
09452f23
MB		 2563 "wm5100", wm5100);
2564 else
2565 ret = request_threaded_irq(i2c->irq, NULL, wm5100_irq,
efc04ca2 2566 irq_flags, "wm5100",
09452f23
MB		 2567 wm5100);
2568
2569 if (ret != 0) {
2570 dev_err(&i2c->dev, "Failed to request IRQ %d: %d\n",
2571 i2c->irq, ret);
2572 } else {
2573 /* Enable default interrupts */
2574 regmap_update_bits(wm5100->regmap,
2575 WM5100_INTERRUPT_STATUS_3_MASK,
2576 WM5100_IM_SPK_SHUTDOWN_WARN_EINT |
2577 WM5100_IM_SPK_SHUTDOWN_EINT |
2578 WM5100_IM_ASRC2_LOCK_EINT |
2579 WM5100_IM_ASRC1_LOCK_EINT |
2580 WM5100_IM_FLL2_LOCK_EINT |
2581 WM5100_IM_FLL1_LOCK_EINT |
2582 WM5100_CLKGEN_ERR_EINT |
2583 WM5100_CLKGEN_ERR_ASYNC_EINT, 0);
2584
2585 regmap_update_bits(wm5100->regmap,
2586 WM5100_INTERRUPT_STATUS_4_MASK,
2587 WM5100_AIF3_ERR_EINT |
2588 WM5100_AIF2_ERR_EINT |
2589 WM5100_AIF1_ERR_EINT |
2590 WM5100_CTRLIF_ERR_EINT |
2591 WM5100_ISRC2_UNDERCLOCKED_EINT |
2592 WM5100_ISRC1_UNDERCLOCKED_EINT |
2593 WM5100_FX_UNDERCLOCKED_EINT |
2594 WM5100_AIF3_UNDERCLOCKED_EINT |
2595 WM5100_AIF2_UNDERCLOCKED_EINT |
2596 WM5100_AIF1_UNDERCLOCKED_EINT |
2597 WM5100_ASRC_UNDERCLOCKED_EINT |
2598 WM5100_DAC_UNDERCLOCKED_EINT |
2599 WM5100_ADC_UNDERCLOCKED_EINT |
2600 WM5100_MIXER_UNDERCLOCKED_EINT, 0);
2601 }
2602 }
2603
62c1c401
MB		 2604 pm_runtime_set_active(&i2c->dev);
2605 pm_runtime_enable(&i2c->dev);
2606 pm_request_idle(&i2c->dev);
2607
61195838
KM		 2608 ret = devm_snd_soc_register_component(&i2c->dev,
2609 &soc_component_dev_wm5100, wm5100_dai,
6d4baf08
MB		 2610 ARRAY_SIZE(wm5100_dai));
2611 if (ret < 0) {
2612 dev_err(&i2c->dev, "Failed to register WM5100: %d\n", ret);
588ac5e0 2613 goto err_reset;
6d4baf08
MB		 2614 }
2615
2616 return ret;
bd132ec5 2617
588ac5e0 2618err_reset:
b1176bbb 2619 pm_runtime_disable(&i2c->dev);
09452f23
MB		 2620 if (i2c->irq)
2621 free_irq(i2c->irq, wm5100);
9db16e4c 2622 wm5100_free_gpio(i2c);
588ac5e0 2623 if (wm5100->pdata.reset) {
2688738e 2624 gpio_set_value_cansleep(wm5100->pdata.reset, 0);
588ac5e0
MB		 2625 gpio_free(wm5100->pdata.reset);
2626 }
2627err_ldo:
2628 if (wm5100->pdata.ldo_ena) {
2629 gpio_set_value_cansleep(wm5100->pdata.ldo_ena, 0);
2630 gpio_free(wm5100->pdata.ldo_ena);
2631 }
2632err_enable:
2633 regulator_bulk_disable(ARRAY_SIZE(wm5100->core_supplies),
2634 wm5100->core_supplies);
a81b82c0 2635err:
bd132ec5 2636 return ret;
6d4baf08
MB		 2637}
2638
7a79e94e 2639static int wm5100_i2c_remove(struct i2c_client *i2c)
6d4baf08 2640{
09452f23 2641 struct wm5100_priv *wm5100 = i2c_get_clientdata(i2c);
bd132ec5 2642
b1176bbb 2643 pm_runtime_disable(&i2c->dev);
09452f23
MB		 2644 if (i2c->irq)
2645 free_irq(i2c->irq, wm5100);
2646 wm5100_free_gpio(i2c);
588ac5e0 2647 if (wm5100->pdata.reset) {
2688738e 2648 gpio_set_value_cansleep(wm5100->pdata.reset, 0);
588ac5e0
MB		 2649 gpio_free(wm5100->pdata.reset);
2650 }
2651 if (wm5100->pdata.ldo_ena) {
2652 gpio_set_value_cansleep(wm5100->pdata.ldo_ena, 0);
2653 gpio_free(wm5100->pdata.ldo_ena);
2654 }
bd132ec5 2655
6d4baf08
MB		 2656 return 0;
2657}
2658
641d334b 2659#ifdef CONFIG_PM
62c1c401
MB		 2660static int wm5100_runtime_suspend(struct device *dev)
2661{
2662 struct wm5100_priv *wm5100 = dev_get_drvdata(dev);
2663
2664 regcache_cache_only(wm5100->regmap, true);
2665 regcache_mark_dirty(wm5100->regmap);
2666 if (wm5100->pdata.ldo_ena)
2667 gpio_set_value_cansleep(wm5100->pdata.ldo_ena, 0);
2668 regulator_bulk_disable(ARRAY_SIZE(wm5100->core_supplies),
2669 wm5100->core_supplies);
2670
2671 return 0;
2672}
2673
2674static int wm5100_runtime_resume(struct device *dev)
2675{
2676 struct wm5100_priv *wm5100 = dev_get_drvdata(dev);
2677 int ret;
2678
2679 ret = regulator_bulk_enable(ARRAY_SIZE(wm5100->core_supplies),
2680 wm5100->core_supplies);
2681 if (ret != 0) {
2682 dev_err(dev, "Failed to enable supplies: %d\n",
2683 ret);
2684 return ret;
2685 }
2686
2687 if (wm5100->pdata.ldo_ena) {
2688 gpio_set_value_cansleep(wm5100->pdata.ldo_ena, 1);
2689 msleep(2);
2690 }
2691
2692 regcache_cache_only(wm5100->regmap, false);
2693 regcache_sync(wm5100->regmap);
2694
2695 return 0;
2696}
2697#endif
2698
42d1b8ce 2699static const struct dev_pm_ops wm5100_pm = {
62c1c401
MB		 2700 SET_RUNTIME_PM_OPS(wm5100_runtime_suspend, wm5100_runtime_resume,
2701 NULL)
2702};
2703
6d4baf08
MB		 2704static const struct i2c_device_id wm5100_i2c_id[] = {
2705 { "wm5100", 0 },
2706 { }
2707};
2708MODULE_DEVICE_TABLE(i2c, wm5100_i2c_id);
2709
2710static struct i2c_driver wm5100_i2c_driver = {
2711 .driver = {
2712 .name = "wm5100",
62c1c401 2713 .pm = &wm5100_pm,
6d4baf08 2714 },
97b0b6e3 2715 .probe_new = wm5100_i2c_probe,
7a79e94e 2716 .remove = wm5100_i2c_remove,
6d4baf08
MB		 2717 .id_table = wm5100_i2c_id,
2718};
2719
d5644076 2720module_i2c_driver(wm5100_i2c_driver);
6d4baf08
MB		 2721
2722MODULE_DESCRIPTION("ASoC WM5100 driver");
2723MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
2724MODULE_LICENSE("GPL");
Linux 6.x block layer and io_uring tree(s)