333 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * ALSA driver for ICEnsemble VT17xx4 *5 * Lowlevel functions for WM8766 codec6 *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 "wm8766.h"15 16/* low-level access */17 18static void snd_wm8766_write(struct snd_wm8766 *wm, u16 addr, u16 data)19{20 if (addr < WM8766_REG_COUNT)21 wm->regs[addr] = data;22 wm->ops.write(wm, addr, data);23}24 25/* mixer controls */26 27static const DECLARE_TLV_DB_SCALE(wm8766_tlv, -12750, 50, 1);28 29static const struct snd_wm8766_ctl snd_wm8766_default_ctl[WM8766_CTL_COUNT] = {30 [WM8766_CTL_CH1_VOL] = {31 .name = "Channel 1 Playback Volume",32 .type = SNDRV_CTL_ELEM_TYPE_INTEGER,33 .tlv = wm8766_tlv,34 .reg1 = WM8766_REG_DACL1,35 .reg2 = WM8766_REG_DACR1,36 .mask1 = WM8766_VOL_MASK,37 .mask2 = WM8766_VOL_MASK,38 .max = 0xff,39 .flags = WM8766_FLAG_STEREO | WM8766_FLAG_VOL_UPDATE,40 },41 [WM8766_CTL_CH2_VOL] = {42 .name = "Channel 2 Playback Volume",43 .type = SNDRV_CTL_ELEM_TYPE_INTEGER,44 .tlv = wm8766_tlv,45 .reg1 = WM8766_REG_DACL2,46 .reg2 = WM8766_REG_DACR2,47 .mask1 = WM8766_VOL_MASK,48 .mask2 = WM8766_VOL_MASK,49 .max = 0xff,50 .flags = WM8766_FLAG_STEREO | WM8766_FLAG_VOL_UPDATE,51 },52 [WM8766_CTL_CH3_VOL] = {53 .name = "Channel 3 Playback Volume",54 .type = SNDRV_CTL_ELEM_TYPE_INTEGER,55 .tlv = wm8766_tlv,56 .reg1 = WM8766_REG_DACL3,57 .reg2 = WM8766_REG_DACR3,58 .mask1 = WM8766_VOL_MASK,59 .mask2 = WM8766_VOL_MASK,60 .max = 0xff,61 .flags = WM8766_FLAG_STEREO | WM8766_FLAG_VOL_UPDATE,62 },63 [WM8766_CTL_CH1_SW] = {64 .name = "Channel 1 Playback Switch",65 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,66 .reg1 = WM8766_REG_DACCTRL2,67 .mask1 = WM8766_DAC2_MUTE1,68 .flags = WM8766_FLAG_INVERT,69 },70 [WM8766_CTL_CH2_SW] = {71 .name = "Channel 2 Playback Switch",72 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,73 .reg1 = WM8766_REG_DACCTRL2,74 .mask1 = WM8766_DAC2_MUTE2,75 .flags = WM8766_FLAG_INVERT,76 },77 [WM8766_CTL_CH3_SW] = {78 .name = "Channel 3 Playback Switch",79 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,80 .reg1 = WM8766_REG_DACCTRL2,81 .mask1 = WM8766_DAC2_MUTE3,82 .flags = WM8766_FLAG_INVERT,83 },84 [WM8766_CTL_PHASE1_SW] = {85 .name = "Channel 1 Phase Invert Playback Switch",86 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,87 .reg1 = WM8766_REG_IFCTRL,88 .mask1 = WM8766_PHASE_INVERT1,89 },90 [WM8766_CTL_PHASE2_SW] = {91 .name = "Channel 2 Phase Invert Playback Switch",92 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,93 .reg1 = WM8766_REG_IFCTRL,94 .mask1 = WM8766_PHASE_INVERT2,95 },96 [WM8766_CTL_PHASE3_SW] = {97 .name = "Channel 3 Phase Invert Playback Switch",98 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,99 .reg1 = WM8766_REG_IFCTRL,100 .mask1 = WM8766_PHASE_INVERT3,101 },102 [WM8766_CTL_DEEMPH1_SW] = {103 .name = "Channel 1 Deemphasis Playback Switch",104 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,105 .reg1 = WM8766_REG_DACCTRL2,106 .mask1 = WM8766_DAC2_DEEMP1,107 },108 [WM8766_CTL_DEEMPH2_SW] = {109 .name = "Channel 2 Deemphasis Playback Switch",110 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,111 .reg1 = WM8766_REG_DACCTRL2,112 .mask1 = WM8766_DAC2_DEEMP2,113 },114 [WM8766_CTL_DEEMPH3_SW] = {115 .name = "Channel 3 Deemphasis Playback Switch",116 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,117 .reg1 = WM8766_REG_DACCTRL2,118 .mask1 = WM8766_DAC2_DEEMP3,119 },120 [WM8766_CTL_IZD_SW] = {121 .name = "Infinite Zero Detect Playback Switch",122 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,123 .reg1 = WM8766_REG_DACCTRL1,124 .mask1 = WM8766_DAC_IZD,125 },126 [WM8766_CTL_ZC_SW] = {127 .name = "Zero Cross Detect Playback Switch",128 .type = SNDRV_CTL_ELEM_TYPE_BOOLEAN,129 .reg1 = WM8766_REG_DACCTRL2,130 .mask1 = WM8766_DAC2_ZCD,131 .flags = WM8766_FLAG_INVERT,132 },133};134 135/* exported functions */136 137void snd_wm8766_init(struct snd_wm8766 *wm)138{139 int i;140 static const u16 default_values[] = {141 0x000, 0x100,142 0x120, 0x000,143 0x000, 0x100, 0x000, 0x100, 0x000,144 0x000, 0x080,145 };146 147 memcpy(wm->ctl, snd_wm8766_default_ctl, sizeof(wm->ctl));148 149 snd_wm8766_write(wm, WM8766_REG_RESET, 0x00); /* reset */150 udelay(10);151 /* load defaults */152 for (i = 0; i < ARRAY_SIZE(default_values); i++)153 snd_wm8766_write(wm, i, default_values[i]);154}155 156void snd_wm8766_resume(struct snd_wm8766 *wm)157{158 int i;159 160 for (i = 0; i < WM8766_REG_COUNT; i++)161 snd_wm8766_write(wm, i, wm->regs[i]);162}163 164void snd_wm8766_set_if(struct snd_wm8766 *wm, u16 dac)165{166 u16 val = wm->regs[WM8766_REG_IFCTRL] & ~WM8766_IF_MASK;167 168 dac &= WM8766_IF_MASK;169 snd_wm8766_write(wm, WM8766_REG_IFCTRL, val | dac);170}171 172void snd_wm8766_volume_restore(struct snd_wm8766 *wm)173{174 u16 val = wm->regs[WM8766_REG_DACR1];175 /* restore volume after MCLK stopped */176 snd_wm8766_write(wm, WM8766_REG_DACR1, val | WM8766_VOL_UPDATE);177}178 179/* mixer callbacks */180 181static int snd_wm8766_volume_info(struct snd_kcontrol *kcontrol,182 struct snd_ctl_elem_info *uinfo)183{184 struct snd_wm8766 *wm = snd_kcontrol_chip(kcontrol);185 int n = kcontrol->private_value;186 187 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;188 uinfo->count = (wm->ctl[n].flags & WM8766_FLAG_STEREO) ? 2 : 1;189 uinfo->value.integer.min = wm->ctl[n].min;190 uinfo->value.integer.max = wm->ctl[n].max;191 192 return 0;193}194 195static int snd_wm8766_enum_info(struct snd_kcontrol *kcontrol,196 struct snd_ctl_elem_info *uinfo)197{198 struct snd_wm8766 *wm = snd_kcontrol_chip(kcontrol);199 int n = kcontrol->private_value;200 201 return snd_ctl_enum_info(uinfo, 1, wm->ctl[n].max,202 wm->ctl[n].enum_names);203}204 205static int snd_wm8766_ctl_get(struct snd_kcontrol *kcontrol,206 struct snd_ctl_elem_value *ucontrol)207{208 struct snd_wm8766 *wm = snd_kcontrol_chip(kcontrol);209 int n = kcontrol->private_value;210 u16 val1, val2;211 212 if (wm->ctl[n].get)213 wm->ctl[n].get(wm, &val1, &val2);214 else {215 val1 = wm->regs[wm->ctl[n].reg1] & wm->ctl[n].mask1;216 val1 >>= __ffs(wm->ctl[n].mask1);217 if (wm->ctl[n].flags & WM8766_FLAG_STEREO) {218 val2 = wm->regs[wm->ctl[n].reg2] & wm->ctl[n].mask2;219 val2 >>= __ffs(wm->ctl[n].mask2);220 if (wm->ctl[n].flags & WM8766_FLAG_VOL_UPDATE)221 val2 &= ~WM8766_VOL_UPDATE;222 }223 }224 if (wm->ctl[n].flags & WM8766_FLAG_INVERT) {225 val1 = wm->ctl[n].max - (val1 - wm->ctl[n].min);226 if (wm->ctl[n].flags & WM8766_FLAG_STEREO)227 val2 = wm->ctl[n].max - (val2 - wm->ctl[n].min);228 }229 ucontrol->value.integer.value[0] = val1;230 if (wm->ctl[n].flags & WM8766_FLAG_STEREO)231 ucontrol->value.integer.value[1] = val2;232 233 return 0;234}235 236static int snd_wm8766_ctl_put(struct snd_kcontrol *kcontrol,237 struct snd_ctl_elem_value *ucontrol)238{239 struct snd_wm8766 *wm = snd_kcontrol_chip(kcontrol);240 int n = kcontrol->private_value;241 u16 val, regval1, regval2;242 243 /* this also works for enum because value is a union */244 regval1 = ucontrol->value.integer.value[0];245 regval2 = ucontrol->value.integer.value[1];246 if (wm->ctl[n].flags & WM8766_FLAG_INVERT) {247 regval1 = wm->ctl[n].max - (regval1 - wm->ctl[n].min);248 regval2 = wm->ctl[n].max - (regval2 - wm->ctl[n].min);249 }250 if (wm->ctl[n].set)251 wm->ctl[n].set(wm, regval1, regval2);252 else {253 val = wm->regs[wm->ctl[n].reg1] & ~wm->ctl[n].mask1;254 val |= regval1 << __ffs(wm->ctl[n].mask1);255 /* both stereo controls in one register */256 if (wm->ctl[n].flags & WM8766_FLAG_STEREO &&257 wm->ctl[n].reg1 == wm->ctl[n].reg2) {258 val &= ~wm->ctl[n].mask2;259 val |= regval2 << __ffs(wm->ctl[n].mask2);260 }261 snd_wm8766_write(wm, wm->ctl[n].reg1, val);262 /* stereo controls in different registers */263 if (wm->ctl[n].flags & WM8766_FLAG_STEREO &&264 wm->ctl[n].reg1 != wm->ctl[n].reg2) {265 val = wm->regs[wm->ctl[n].reg2] & ~wm->ctl[n].mask2;266 val |= regval2 << __ffs(wm->ctl[n].mask2);267 if (wm->ctl[n].flags & WM8766_FLAG_VOL_UPDATE)268 val |= WM8766_VOL_UPDATE;269 snd_wm8766_write(wm, wm->ctl[n].reg2, val);270 }271 }272 273 return 0;274}275 276static int snd_wm8766_add_control(struct snd_wm8766 *wm, int num)277{278 struct snd_kcontrol_new cont;279 struct snd_kcontrol *ctl;280 281 memset(&cont, 0, sizeof(cont));282 cont.iface = SNDRV_CTL_ELEM_IFACE_MIXER;283 cont.private_value = num;284 cont.name = wm->ctl[num].name;285 cont.access = SNDRV_CTL_ELEM_ACCESS_READWRITE;286 if (wm->ctl[num].flags & WM8766_FLAG_LIM ||287 wm->ctl[num].flags & WM8766_FLAG_ALC)288 cont.access |= SNDRV_CTL_ELEM_ACCESS_INACTIVE;289 cont.tlv.p = NULL;290 cont.get = snd_wm8766_ctl_get;291 cont.put = snd_wm8766_ctl_put;292 293 switch (wm->ctl[num].type) {294 case SNDRV_CTL_ELEM_TYPE_INTEGER:295 cont.info = snd_wm8766_volume_info;296 cont.access |= SNDRV_CTL_ELEM_ACCESS_TLV_READ;297 cont.tlv.p = wm->ctl[num].tlv;298 break;299 case SNDRV_CTL_ELEM_TYPE_BOOLEAN:300 wm->ctl[num].max = 1;301 if (wm->ctl[num].flags & WM8766_FLAG_STEREO)302 cont.info = snd_ctl_boolean_stereo_info;303 else304 cont.info = snd_ctl_boolean_mono_info;305 break;306 case SNDRV_CTL_ELEM_TYPE_ENUMERATED:307 cont.info = snd_wm8766_enum_info;308 break;309 default:310 return -EINVAL;311 }312 ctl = snd_ctl_new1(&cont, wm);313 if (!ctl)314 return -ENOMEM;315 wm->ctl[num].kctl = ctl;316 317 return snd_ctl_add(wm->card, ctl);318}319 320int snd_wm8766_build_controls(struct snd_wm8766 *wm)321{322 int err, i;323 324 for (i = 0; i < WM8766_CTL_COUNT; i++)325 if (wm->ctl[i].name) {326 err = snd_wm8766_add_control(wm, i);327 if (err < 0)328 return err;329 }330 331 return 0;332}333