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 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 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 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 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 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 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 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 437 void snd_wm8776_set_power(struct snd_wm8776 *wm, u16 power) 438 { 439 snd_wm8776_write(wm, WM8776_REG_PWRDOWN, power); 440 } 441 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 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 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 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 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 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 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