1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * ALSA driver for ICEnsemble VT17xx
4 *
5 * Lowlevel functions for WM8776 codec
6 *
7 * Copyright (c) 2012 Ondrej Zary <linux@rainbow-software.org>
8 */
9
10 #include <linux/delay.h>
11 #include <sound/core.h>
12 #include <sound/control.h>
13 #include <sound/tlv.h>
14 #include "wm8776.h"
15
16 /* low-level access */
17
snd_wm8776_write(struct snd_wm8776 * wm,u16 addr,u16 data)18 static void snd_wm8776_write(struct snd_wm8776 *wm, u16 addr, u16 data)
19 {
20 u8 bus_addr = addr << 1 | data >> 8; /* addr + 9th data bit */
21 u8 bus_data = data & 0xff; /* remaining 8 data bits */
22
23 if (addr < WM8776_REG_RESET)
24 wm->regs[addr] = data;
25 wm->ops.write(wm, bus_addr, bus_data);
26 }
27
28 /* register-level functions */
29
snd_wm8776_activate_ctl(struct snd_wm8776 * wm,const char * ctl_name,bool active)30 static void snd_wm8776_activate_ctl(struct snd_wm8776 *wm,
31 const char *ctl_name,
32 bool active)
33 {
34 struct snd_card *card = wm->card;
35 struct snd_kcontrol *kctl;
36 struct snd_kcontrol_volatile *vd;
37 unsigned int index_offset;
38
39 kctl = snd_ctl_find_id_mixer(card, ctl_name);
40 if (!kctl)
41 return;
42 index_offset = snd_ctl_get_ioff(kctl, &kctl->id);
43 vd = &kctl->vd[index_offset];
44 if (active)
45 vd->access &= ~SNDRV_CTL_ELEM_ACCESS_INACTIVE;
46 else
47 vd->access |= SNDRV_CTL_ELEM_ACCESS_INACTIVE;
48 snd_ctl_notify(card, SNDRV_CTL_EVENT_MASK_INFO, &kctl->id);
49 }
50
snd_wm8776_update_agc_ctl(struct snd_wm8776 * wm)51 static void snd_wm8776_update_agc_ctl(struct snd_wm8776 *wm)
52 {
53 int i, flags_on = 0, flags_off = 0;
54
55 switch (wm->agc_mode) {
56 case WM8776_AGC_OFF:
57 flags_off = WM8776_FLAG_LIM | WM8776_FLAG_ALC;
58 break;
59 case WM8776_AGC_LIM:
60 flags_off = WM8776_FLAG_ALC;
61 flags_on = WM8776_FLAG_LIM;
62 break;
63 case WM8776_AGC_ALC_R:
64 case WM8776_AGC_ALC_L:
65 case WM8776_AGC_ALC_STEREO:
66 flags_off = WM8776_FLAG_LIM;
67 flags_on = WM8776_FLAG_ALC;
68 break;
69 }
70
71 for (i = 0; i < WM8776_CTL_COUNT; i++)
72 if (wm->ctl[i].flags & flags_off)
73 snd_wm8776_activate_ctl(wm, wm->ctl[i].name, false);
74 else if (wm->ctl[i].flags & flags_on)
75 snd_wm8776_activate_ctl(wm, wm->ctl[i].name, true);
76 }
77
snd_wm8776_set_agc(struct snd_wm8776 * wm,u16 agc,u16 nothing)78 static void snd_wm8776_set_agc(struct snd_wm8776 *wm, u16 agc, u16 nothing)
79 {
80 u16 alc1 = wm->regs[WM8776_REG_ALCCTRL1] & ~WM8776_ALC1_LCT_MASK;
81 u16 alc2 = wm->regs[WM8776_REG_ALCCTRL2] & ~WM8776_ALC2_LCEN;
82
83 switch (agc) {
84 case 0: /* Off */
85 wm->agc_mode = WM8776_AGC_OFF;
86 break;
87 case 1: /* Limiter */
88 alc2 |= WM8776_ALC2_LCEN;
89 wm->agc_mode = WM8776_AGC_LIM;
90 break;
91 case 2: /* ALC Right */
92 alc1 |= WM8776_ALC1_LCSEL_ALCR;
93 alc2 |= WM8776_ALC2_LCEN;
94 wm->agc_mode = WM8776_AGC_ALC_R;
95 break;
96 case 3: /* ALC Left */
97 alc1 |= WM8776_ALC1_LCSEL_ALCL;
98 alc2 |= WM8776_ALC2_LCEN;
99 wm->agc_mode = WM8776_AGC_ALC_L;
100 break;
101 case 4: /* ALC Stereo */
102 alc1 |= WM8776_ALC1_LCSEL_ALCSTEREO;
103 alc2 |= WM8776_ALC2_LCEN;
104 wm->agc_mode = WM8776_AGC_ALC_STEREO;
105 break;
106 }
107 snd_wm8776_write(wm, WM8776_REG_ALCCTRL1, alc1);
108 snd_wm8776_write(wm, WM8776_REG_ALCCTRL2, alc2);
109 snd_wm8776_update_agc_ctl(wm);
110 }
111
snd_wm8776_get_agc(struct snd_wm8776 * wm,u16 * mode,u16 * nothing)112 static void snd_wm8776_get_agc(struct snd_wm8776 *wm, u16 *mode, u16 *nothing)
113 {
114 *mode = wm->agc_mode;
115 }
116
117 /* mixer controls */
118
119 static const DECLARE_TLV_DB_SCALE(wm8776_hp_tlv, -7400, 100, 1);
120 static const DECLARE_TLV_DB_SCALE(wm8776_dac_tlv, -12750, 50, 1);
121 static const DECLARE_TLV_DB_SCALE(wm8776_adc_tlv, -10350, 50, 1);
122 static const DECLARE_TLV_DB_SCALE(wm8776_lct_tlv, -1600, 100, 0);
123 static const DECLARE_TLV_DB_SCALE(wm8776_maxgain_tlv, 0, 400, 0);
124 static const DECLARE_TLV_DB_SCALE(wm8776_ngth_tlv, -7800, 600, 0);
125 static const DECLARE_TLV_DB_SCALE(wm8776_maxatten_lim_tlv, -1200, 100, 0);
126 static const DECLARE_TLV_DB_SCALE(wm8776_maxatten_alc_tlv, -2100, 400, 0);
127
128 static const struct snd_wm8776_ctl snd_wm8776_default_ctl[WM8776_CTL_COUNT] = {
129 [WM8776_CTL_DAC_VOL] = {
130 .name = "Master Playback Volume",
131 .type = SNDRV_CTL_ELEM_TYPE_INTEGER,
132 .tlv = wm8776_dac_tlv,
133 .reg1 = WM8776_REG_DACLVOL,
134 .reg2 = WM8776_REG_DACRVOL,
135 .mask1 = WM8776_DACVOL_MASK,
136 .mask2 = WM8776_DACVOL_MASK,
137 .max = 0xff,
138 .flags = WM8776_FLAG_STEREO | WM8776_FLAG_VOL_UPDATE,
139 },
140 [WM8776_CTL_DAC_SW] = {
141 .name = "Master Playback Switch",
142 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
143 .reg1 = WM8776_REG_DACCTRL1,
144 .reg2 = WM8776_REG_DACCTRL1,
145 .mask1 = WM8776_DAC_PL_LL,
146 .mask2 = WM8776_DAC_PL_RR,
147 .flags = WM8776_FLAG_STEREO,
148 },
149 [WM8776_CTL_DAC_ZC_SW] = {
150 .name = "Master Zero Cross Detect Playback Switch",
151 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
152 .reg1 = WM8776_REG_DACCTRL1,
153 .mask1 = WM8776_DAC_DZCEN,
154 },
155 [WM8776_CTL_HP_VOL] = {
156 .name = "Headphone Playback Volume",
157 .type = SNDRV_CTL_ELEM_TYPE_INTEGER,
158 .tlv = wm8776_hp_tlv,
159 .reg1 = WM8776_REG_HPLVOL,
160 .reg2 = WM8776_REG_HPRVOL,
161 .mask1 = WM8776_HPVOL_MASK,
162 .mask2 = WM8776_HPVOL_MASK,
163 .min = 0x2f,
164 .max = 0x7f,
165 .flags = WM8776_FLAG_STEREO | WM8776_FLAG_VOL_UPDATE,
166 },
167 [WM8776_CTL_HP_SW] = {
168 .name = "Headphone Playback Switch",
169 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
170 .reg1 = WM8776_REG_PWRDOWN,
171 .mask1 = WM8776_PWR_HPPD,
172 .flags = WM8776_FLAG_INVERT,
173 },
174 [WM8776_CTL_HP_ZC_SW] = {
175 .name = "Headphone Zero Cross Detect Playback Switch",
176 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
177 .reg1 = WM8776_REG_HPLVOL,
178 .reg2 = WM8776_REG_HPRVOL,
179 .mask1 = WM8776_VOL_HPZCEN,
180 .mask2 = WM8776_VOL_HPZCEN,
181 .flags = WM8776_FLAG_STEREO,
182 },
183 [WM8776_CTL_AUX_SW] = {
184 .name = "AUX Playback Switch",
185 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
186 .reg1 = WM8776_REG_OUTMUX,
187 .mask1 = WM8776_OUTMUX_AUX,
188 },
189 [WM8776_CTL_BYPASS_SW] = {
190 .name = "Bypass Playback Switch",
191 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
192 .reg1 = WM8776_REG_OUTMUX,
193 .mask1 = WM8776_OUTMUX_BYPASS,
194 },
195 [WM8776_CTL_DAC_IZD_SW] = {
196 .name = "Infinite Zero Detect Playback Switch",
197 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
198 .reg1 = WM8776_REG_DACCTRL1,
199 .mask1 = WM8776_DAC_IZD,
200 },
201 [WM8776_CTL_PHASE_SW] = {
202 .name = "Phase Invert Playback Switch",
203 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
204 .reg1 = WM8776_REG_PHASESWAP,
205 .reg2 = WM8776_REG_PHASESWAP,
206 .mask1 = WM8776_PHASE_INVERTL,
207 .mask2 = WM8776_PHASE_INVERTR,
208 .flags = WM8776_FLAG_STEREO,
209 },
210 [WM8776_CTL_DEEMPH_SW] = {
211 .name = "Deemphasis Playback Switch",
212 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
213 .reg1 = WM8776_REG_DACCTRL2,
214 .mask1 = WM8776_DAC2_DEEMPH,
215 },
216 [WM8776_CTL_ADC_VOL] = {
217 .name = "Input Capture Volume",
218 .type = SNDRV_CTL_ELEM_TYPE_INTEGER,
219 .tlv = wm8776_adc_tlv,
220 .reg1 = WM8776_REG_ADCLVOL,
221 .reg2 = WM8776_REG_ADCRVOL,
222 .mask1 = WM8776_ADC_GAIN_MASK,
223 .mask2 = WM8776_ADC_GAIN_MASK,
224 .max = 0xff,
225 .flags = WM8776_FLAG_STEREO | WM8776_FLAG_VOL_UPDATE,
226 },
227 [WM8776_CTL_ADC_SW] = {
228 .name = "Input Capture Switch",
229 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
230 .reg1 = WM8776_REG_ADCMUX,
231 .reg2 = WM8776_REG_ADCMUX,
232 .mask1 = WM8776_ADC_MUTEL,
233 .mask2 = WM8776_ADC_MUTER,
234 .flags = WM8776_FLAG_STEREO | WM8776_FLAG_INVERT,
235 },
236 [WM8776_CTL_INPUT1_SW] = {
237 .name = "AIN1 Capture Switch",
238 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
239 .reg1 = WM8776_REG_ADCMUX,
240 .mask1 = WM8776_ADC_MUX_AIN1,
241 },
242 [WM8776_CTL_INPUT2_SW] = {
243 .name = "AIN2 Capture Switch",
244 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
245 .reg1 = WM8776_REG_ADCMUX,
246 .mask1 = WM8776_ADC_MUX_AIN2,
247 },
248 [WM8776_CTL_INPUT3_SW] = {
249 .name = "AIN3 Capture Switch",
250 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
251 .reg1 = WM8776_REG_ADCMUX,
252 .mask1 = WM8776_ADC_MUX_AIN3,
253 },
254 [WM8776_CTL_INPUT4_SW] = {
255 .name = "AIN4 Capture Switch",
256 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
257 .reg1 = WM8776_REG_ADCMUX,
258 .mask1 = WM8776_ADC_MUX_AIN4,
259 },
260 [WM8776_CTL_INPUT5_SW] = {
261 .name = "AIN5 Capture Switch",
262 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
263 .reg1 = WM8776_REG_ADCMUX,
264 .mask1 = WM8776_ADC_MUX_AIN5,
265 },
266 [WM8776_CTL_AGC_SEL] = {
267 .name = "AGC Select Capture Enum",
268 .type = SNDRV_CTL_ELEM_TYPE_ENUMERATED,
269 .enum_names = { "Off", "Limiter", "ALC Right", "ALC Left",
270 "ALC Stereo" },
271 .max = 5, /* .enum_names item count */
272 .set = snd_wm8776_set_agc,
273 .get = snd_wm8776_get_agc,
274 },
275 [WM8776_CTL_LIM_THR] = {
276 .name = "Limiter Threshold Capture Volume",
277 .type = SNDRV_CTL_ELEM_TYPE_INTEGER,
278 .tlv = wm8776_lct_tlv,
279 .reg1 = WM8776_REG_ALCCTRL1,
280 .mask1 = WM8776_ALC1_LCT_MASK,
281 .max = 15,
282 .flags = WM8776_FLAG_LIM,
283 },
284 [WM8776_CTL_LIM_ATK] = {
285 .name = "Limiter Attack Time Capture Enum",
286 .type = SNDRV_CTL_ELEM_TYPE_ENUMERATED,
287 .enum_names = { "0.25 ms", "0.5 ms", "1 ms", "2 ms", "4 ms",
288 "8 ms", "16 ms", "32 ms", "64 ms", "128 ms", "256 ms" },
289 .max = 11, /* .enum_names item count */
290 .reg1 = WM8776_REG_ALCCTRL3,
291 .mask1 = WM8776_ALC3_ATK_MASK,
292 .flags = WM8776_FLAG_LIM,
293 },
294 [WM8776_CTL_LIM_DCY] = {
295 .name = "Limiter Decay Time Capture Enum",
296 .type = SNDRV_CTL_ELEM_TYPE_ENUMERATED,
297 .enum_names = { "1.2 ms", "2.4 ms", "4.8 ms", "9.6 ms",
298 "19.2 ms", "38.4 ms", "76.8 ms", "154 ms", "307 ms",
299 "614 ms", "1.23 s" },
300 .max = 11, /* .enum_names item count */
301 .reg1 = WM8776_REG_ALCCTRL3,
302 .mask1 = WM8776_ALC3_DCY_MASK,
303 .flags = WM8776_FLAG_LIM,
304 },
305 [WM8776_CTL_LIM_TRANWIN] = {
306 .name = "Limiter Transient Window Capture Enum",
307 .type = SNDRV_CTL_ELEM_TYPE_ENUMERATED,
308 .enum_names = { "0 us", "62.5 us", "125 us", "250 us", "500 us",
309 "1 ms", "2 ms", "4 ms" },
310 .max = 8, /* .enum_names item count */
311 .reg1 = WM8776_REG_LIMITER,
312 .mask1 = WM8776_LIM_TRANWIN_MASK,
313 .flags = WM8776_FLAG_LIM,
314 },
315 [WM8776_CTL_LIM_MAXATTN] = {
316 .name = "Limiter Maximum Attenuation Capture Volume",
317 .type = SNDRV_CTL_ELEM_TYPE_INTEGER,
318 .tlv = wm8776_maxatten_lim_tlv,
319 .reg1 = WM8776_REG_LIMITER,
320 .mask1 = WM8776_LIM_MAXATTEN_MASK,
321 .min = 3,
322 .max = 12,
323 .flags = WM8776_FLAG_LIM | WM8776_FLAG_INVERT,
324 },
325 [WM8776_CTL_ALC_TGT] = {
326 .name = "ALC Target Level Capture Volume",
327 .type = SNDRV_CTL_ELEM_TYPE_INTEGER,
328 .tlv = wm8776_lct_tlv,
329 .reg1 = WM8776_REG_ALCCTRL1,
330 .mask1 = WM8776_ALC1_LCT_MASK,
331 .max = 15,
332 .flags = WM8776_FLAG_ALC,
333 },
334 [WM8776_CTL_ALC_ATK] = {
335 .name = "ALC Attack Time Capture Enum",
336 .type = SNDRV_CTL_ELEM_TYPE_ENUMERATED,
337 .enum_names = { "8.40 ms", "16.8 ms", "33.6 ms", "67.2 ms",
338 "134 ms", "269 ms", "538 ms", "1.08 s", "2.15 s",
339 "4.3 s", "8.6 s" },
340 .max = 11, /* .enum_names item count */
341 .reg1 = WM8776_REG_ALCCTRL3,
342 .mask1 = WM8776_ALC3_ATK_MASK,
343 .flags = WM8776_FLAG_ALC,
344 },
345 [WM8776_CTL_ALC_DCY] = {
346 .name = "ALC Decay Time Capture Enum",
347 .type = SNDRV_CTL_ELEM_TYPE_ENUMERATED,
348 .enum_names = { "33.5 ms", "67.0 ms", "134 ms", "268 ms",
349 "536 ms", "1.07 s", "2.14 s", "4.29 s", "8.58 s",
350 "17.2 s", "34.3 s" },
351 .max = 11, /* .enum_names item count */
352 .reg1 = WM8776_REG_ALCCTRL3,
353 .mask1 = WM8776_ALC3_DCY_MASK,
354 .flags = WM8776_FLAG_ALC,
355 },
356 [WM8776_CTL_ALC_MAXGAIN] = {
357 .name = "ALC Maximum Gain Capture Volume",
358 .type = SNDRV_CTL_ELEM_TYPE_INTEGER,
359 .tlv = wm8776_maxgain_tlv,
360 .reg1 = WM8776_REG_ALCCTRL1,
361 .mask1 = WM8776_ALC1_MAXGAIN_MASK,
362 .min = 1,
363 .max = 7,
364 .flags = WM8776_FLAG_ALC,
365 },
366 [WM8776_CTL_ALC_MAXATTN] = {
367 .name = "ALC Maximum Attenuation Capture Volume",
368 .type = SNDRV_CTL_ELEM_TYPE_INTEGER,
369 .tlv = wm8776_maxatten_alc_tlv,
370 .reg1 = WM8776_REG_LIMITER,
371 .mask1 = WM8776_LIM_MAXATTEN_MASK,
372 .min = 10,
373 .max = 15,
374 .flags = WM8776_FLAG_ALC | WM8776_FLAG_INVERT,
375 },
376 [WM8776_CTL_ALC_HLD] = {
377 .name = "ALC Hold Time Capture Enum",
378 .type = SNDRV_CTL_ELEM_TYPE_ENUMERATED,
379 .enum_names = { "0 ms", "2.67 ms", "5.33 ms", "10.6 ms",
380 "21.3 ms", "42.7 ms", "85.3 ms", "171 ms", "341 ms",
381 "683 ms", "1.37 s", "2.73 s", "5.46 s", "10.9 s",
382 "21.8 s", "43.7 s" },
383 .max = 16, /* .enum_names item count */
384 .reg1 = WM8776_REG_ALCCTRL2,
385 .mask1 = WM8776_ALC2_HOLD_MASK,
386 .flags = WM8776_FLAG_ALC,
387 },
388 [WM8776_CTL_NGT_SW] = {
389 .name = "Noise Gate Capture Switch",
390 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,
391 .reg1 = WM8776_REG_NOISEGATE,
392 .mask1 = WM8776_NGAT_ENABLE,
393 .flags = WM8776_FLAG_ALC,
394 },
395 [WM8776_CTL_NGT_THR] = {
396 .name = "Noise Gate Threshold Capture Volume",
397 .type = SNDRV_CTL_ELEM_TYPE_INTEGER,
398 .tlv = wm8776_ngth_tlv,
399 .reg1 = WM8776_REG_NOISEGATE,
400 .mask1 = WM8776_NGAT_THR_MASK,
401 .max = 7,
402 .flags = WM8776_FLAG_ALC,
403 },
404 };
405
406 /* exported functions */
407
snd_wm8776_init(struct snd_wm8776 * wm)408 void snd_wm8776_init(struct snd_wm8776 *wm)
409 {
410 int i;
411 static const u16 default_values[] = {
412 0x000, 0x100, 0x000,
413 0x000, 0x100, 0x000,
414 0x000, 0x090, 0x000, 0x000,
415 0x022, 0x022, 0x022,
416 0x008, 0x0cf, 0x0cf, 0x07b, 0x000,
417 0x032, 0x000, 0x0a6, 0x001, 0x001
418 };
419
420 memcpy(wm->ctl, snd_wm8776_default_ctl, sizeof(wm->ctl));
421
422 snd_wm8776_write(wm, WM8776_REG_RESET, 0x00); /* reset */
423 udelay(10);
424 /* load defaults */
425 for (i = 0; i < ARRAY_SIZE(default_values); i++)
426 snd_wm8776_write(wm, i, default_values[i]);
427 }
428
snd_wm8776_resume(struct snd_wm8776 * wm)429 void snd_wm8776_resume(struct snd_wm8776 *wm)
430 {
431 int i;
432
433 for (i = 0; i < WM8776_REG_COUNT; i++)
434 snd_wm8776_write(wm, i, wm->regs[i]);
435 }
436
snd_wm8776_set_power(struct snd_wm8776 * wm,u16 power)437 void snd_wm8776_set_power(struct snd_wm8776 *wm, u16 power)
438 {
439 snd_wm8776_write(wm, WM8776_REG_PWRDOWN, power);
440 }
441
snd_wm8776_volume_restore(struct snd_wm8776 * wm)442 void snd_wm8776_volume_restore(struct snd_wm8776 *wm)
443 {
444 u16 val = wm->regs[WM8776_REG_DACRVOL];
445 /* restore volume after MCLK stopped */
446 snd_wm8776_write(wm, WM8776_REG_DACRVOL, val | WM8776_VOL_UPDATE);
447 }
448
449 /* mixer callbacks */
450
snd_wm8776_volume_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)451 static int snd_wm8776_volume_info(struct snd_kcontrol *kcontrol,
452 struct snd_ctl_elem_info *uinfo)
453 {
454 struct snd_wm8776 *wm = snd_kcontrol_chip(kcontrol);
455 int n = kcontrol->private_value;
456
457 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
458 uinfo->count = (wm->ctl[n].flags & WM8776_FLAG_STEREO) ? 2 : 1;
459 uinfo->value.integer.min = wm->ctl[n].min;
460 uinfo->value.integer.max = wm->ctl[n].max;
461
462 return 0;
463 }
464
snd_wm8776_enum_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)465 static int snd_wm8776_enum_info(struct snd_kcontrol *kcontrol,
466 struct snd_ctl_elem_info *uinfo)
467 {
468 struct snd_wm8776 *wm = snd_kcontrol_chip(kcontrol);
469 int n = kcontrol->private_value;
470
471 return snd_ctl_enum_info(uinfo, 1, wm->ctl[n].max,
472 wm->ctl[n].enum_names);
473 }
474
snd_wm8776_ctl_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)475 static int snd_wm8776_ctl_get(struct snd_kcontrol *kcontrol,
476 struct snd_ctl_elem_value *ucontrol)
477 {
478 struct snd_wm8776 *wm = snd_kcontrol_chip(kcontrol);
479 int n = kcontrol->private_value;
480 u16 val1, val2;
481
482 if (wm->ctl[n].get)
483 wm->ctl[n].get(wm, &val1, &val2);
484 else {
485 val1 = wm->regs[wm->ctl[n].reg1] & wm->ctl[n].mask1;
486 val1 >>= __ffs(wm->ctl[n].mask1);
487 if (wm->ctl[n].flags & WM8776_FLAG_STEREO) {
488 val2 = wm->regs[wm->ctl[n].reg2] & wm->ctl[n].mask2;
489 val2 >>= __ffs(wm->ctl[n].mask2);
490 if (wm->ctl[n].flags & WM8776_FLAG_VOL_UPDATE)
491 val2 &= ~WM8776_VOL_UPDATE;
492 }
493 }
494 if (wm->ctl[n].flags & WM8776_FLAG_INVERT) {
495 val1 = wm->ctl[n].max - (val1 - wm->ctl[n].min);
496 if (wm->ctl[n].flags & WM8776_FLAG_STEREO)
497 val2 = wm->ctl[n].max - (val2 - wm->ctl[n].min);
498 }
499 ucontrol->value.integer.value[0] = val1;
500 if (wm->ctl[n].flags & WM8776_FLAG_STEREO)
501 ucontrol->value.integer.value[1] = val2;
502
503 return 0;
504 }
505
snd_wm8776_ctl_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)506 static int snd_wm8776_ctl_put(struct snd_kcontrol *kcontrol,
507 struct snd_ctl_elem_value *ucontrol)
508 {
509 struct snd_wm8776 *wm = snd_kcontrol_chip(kcontrol);
510 int n = kcontrol->private_value;
511 u16 val, regval1, regval2;
512
513 /* this also works for enum because value is a union */
514 regval1 = ucontrol->value.integer.value[0];
515 regval2 = ucontrol->value.integer.value[1];
516 if (wm->ctl[n].flags & WM8776_FLAG_INVERT) {
517 regval1 = wm->ctl[n].max - (regval1 - wm->ctl[n].min);
518 regval2 = wm->ctl[n].max - (regval2 - wm->ctl[n].min);
519 }
520 if (wm->ctl[n].set)
521 wm->ctl[n].set(wm, regval1, regval2);
522 else {
523 val = wm->regs[wm->ctl[n].reg1] & ~wm->ctl[n].mask1;
524 val |= regval1 << __ffs(wm->ctl[n].mask1);
525 /* both stereo controls in one register */
526 if (wm->ctl[n].flags & WM8776_FLAG_STEREO &&
527 wm->ctl[n].reg1 == wm->ctl[n].reg2) {
528 val &= ~wm->ctl[n].mask2;
529 val |= regval2 << __ffs(wm->ctl[n].mask2);
530 }
531 snd_wm8776_write(wm, wm->ctl[n].reg1, val);
532 /* stereo controls in different registers */
533 if (wm->ctl[n].flags & WM8776_FLAG_STEREO &&
534 wm->ctl[n].reg1 != wm->ctl[n].reg2) {
535 val = wm->regs[wm->ctl[n].reg2] & ~wm->ctl[n].mask2;
536 val |= regval2 << __ffs(wm->ctl[n].mask2);
537 if (wm->ctl[n].flags & WM8776_FLAG_VOL_UPDATE)
538 val |= WM8776_VOL_UPDATE;
539 snd_wm8776_write(wm, wm->ctl[n].reg2, val);
540 }
541 }
542
543 return 0;
544 }
545
snd_wm8776_add_control(struct snd_wm8776 * wm,int num)546 static int snd_wm8776_add_control(struct snd_wm8776 *wm, int num)
547 {
548 struct snd_kcontrol_new cont;
549 struct snd_kcontrol *ctl;
550
551 memset(&cont, 0, sizeof(cont));
552 cont.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
553 cont.private_value = num;
554 cont.name = wm->ctl[num].name;
555 cont.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;
556 if (wm->ctl[num].flags & WM8776_FLAG_LIM ||
557 wm->ctl[num].flags & WM8776_FLAG_ALC)
558 cont.access |= SNDRV_CTL_ELEM_ACCESS_INACTIVE;
559 cont.tlv.p = NULL;
560 cont.get = snd_wm8776_ctl_get;
561 cont.put = snd_wm8776_ctl_put;
562
563 switch (wm->ctl[num].type) {
564 case SNDRV_CTL_ELEM_TYPE_INTEGER:
565 cont.info = snd_wm8776_volume_info;
566 cont.access |= SNDRV_CTL_ELEM_ACCESS_TLV_READ;
567 cont.tlv.p = wm->ctl[num].tlv;
568 break;
569 case SNDRV_CTL_ELEM_TYPE_BOOLEAN:
570 wm->ctl[num].max = 1;
571 if (wm->ctl[num].flags & WM8776_FLAG_STEREO)
572 cont.info = snd_ctl_boolean_stereo_info;
573 else
574 cont.info = snd_ctl_boolean_mono_info;
575 break;
576 case SNDRV_CTL_ELEM_TYPE_ENUMERATED:
577 cont.info = snd_wm8776_enum_info;
578 break;
579 default:
580 return -EINVAL;
581 }
582 ctl = snd_ctl_new1(&cont, wm);
583 if (!ctl)
584 return -ENOMEM;
585
586 return snd_ctl_add(wm->card, ctl);
587 }
588
snd_wm8776_build_controls(struct snd_wm8776 * wm)589 int snd_wm8776_build_controls(struct snd_wm8776 *wm)
590 {
591 int err, i;
592
593 for (i = 0; i < WM8776_CTL_COUNT; i++)
594 if (wm->ctl[i].name) {
595 err = snd_wm8776_add_control(wm, i);
596 if (err < 0)
597 return err;
598 }
599
600 return 0;
601 }
602