kernel/sound/pci/ice1712/wm8776.c

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