~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/sound/soc/codecs/da7219.c

Version: ~ [ linux-5.12-rc1 ] ~ [ linux-5.11.2 ] ~ [ linux-5.10.19 ] ~ [ linux-5.9.16 ] ~ [ linux-5.8.18 ] ~ [ linux-5.7.19 ] ~ [ linux-5.6.19 ] ~ [ linux-5.5.19 ] ~ [ linux-5.4.101 ] ~ [ linux-5.3.18 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.177 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.222 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.258 ] ~ [ linux-4.8.17 ] ~ [ linux-4.7.10 ] ~ [ linux-4.6.7 ] ~ [ linux-4.5.7 ] ~ [ linux-4.4.258 ] ~ [ linux-4.3.6 ] ~ [ linux-4.2.8 ] ~ [ linux-4.1.52 ] ~ [ linux-4.0.9 ] ~ [ linux-3.18.140 ] ~ [ linux-3.16.85 ] ~ [ linux-3.14.79 ] ~ [ linux-3.12.74 ] ~ [ linux-3.10.108 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.5 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

  1 /*
  2  * da7219.c - DA7219 ALSA SoC Codec Driver
  3  *
  4  * Copyright (c) 2015 Dialog Semiconductor
  5  *
  6  * Author: Adam Thomson <Adam.Thomson.Opensource@diasemi.com>
  7  *
  8  * This program is free software; you can redistribute  it and/or modify it
  9  * under  the terms of  the GNU General  Public License as published by the
 10  * Free Software Foundation;  either version 2 of the  License, or (at your
 11  * option) any later version.
 12  */
 13 
 14 #include <linux/acpi.h>
 15 #include <linux/clk.h>
 16 #include <linux/i2c.h>
 17 #include <linux/of_device.h>
 18 #include <linux/property.h>
 19 #include <linux/regmap.h>
 20 #include <linux/slab.h>
 21 #include <linux/pm.h>
 22 #include <linux/module.h>
 23 #include <linux/delay.h>
 24 #include <linux/regulator/consumer.h>
 25 #include <sound/pcm.h>
 26 #include <sound/pcm_params.h>
 27 #include <sound/soc.h>
 28 #include <sound/soc-dapm.h>
 29 #include <sound/initval.h>
 30 #include <sound/tlv.h>
 31 #include <asm/div64.h>
 32 
 33 #include <sound/da7219.h>
 34 #include "da7219.h"
 35 #include "da7219-aad.h"
 36 
 37 
 38 /*
 39  * TLVs and Enums
 40  */
 41 
 42 /* Input TLVs */
 43 static const DECLARE_TLV_DB_SCALE(da7219_mic_gain_tlv, -600, 600, 0);
 44 static const DECLARE_TLV_DB_SCALE(da7219_mixin_gain_tlv, -450, 150, 0);
 45 static const DECLARE_TLV_DB_SCALE(da7219_adc_dig_gain_tlv, -8325, 75, 0);
 46 static const DECLARE_TLV_DB_SCALE(da7219_alc_threshold_tlv, -9450, 150, 0);
 47 static const DECLARE_TLV_DB_SCALE(da7219_alc_gain_tlv, 0, 600, 0);
 48 static const DECLARE_TLV_DB_SCALE(da7219_alc_ana_gain_tlv, 0, 600, 0);
 49 static const DECLARE_TLV_DB_SCALE(da7219_sidetone_gain_tlv, -4200, 300, 0);
 50 static const DECLARE_TLV_DB_SCALE(da7219_tonegen_gain_tlv, -4500, 300, 0);
 51 
 52 /* Output TLVs */
 53 static const DECLARE_TLV_DB_SCALE(da7219_dac_eq_band_tlv, -1050, 150, 0);
 54 
 55 static const DECLARE_TLV_DB_RANGE(da7219_dac_dig_gain_tlv,
 56         0x0, 0x07, TLV_DB_SCALE_ITEM(TLV_DB_GAIN_MUTE, 0, 1),
 57         /* -77.25dB to 12dB */
 58         0x08, 0x7f, TLV_DB_SCALE_ITEM(-7725, 75, 0)
 59 );
 60 
 61 static const DECLARE_TLV_DB_SCALE(da7219_dac_ng_threshold_tlv, -10200, 600, 0);
 62 static const DECLARE_TLV_DB_SCALE(da7219_hp_gain_tlv, -5700, 100, 0);
 63 
 64 /* Input Enums */
 65 static const char * const da7219_alc_attack_rate_txt[] = {
 66         "7.33/fs", "14.66/fs", "29.32/fs", "58.64/fs", "117.3/fs", "234.6/fs",
 67         "469.1/fs", "938.2/fs", "1876/fs", "3753/fs", "7506/fs", "15012/fs",
 68         "30024/fs"
 69 };
 70 
 71 static const struct soc_enum da7219_alc_attack_rate =
 72         SOC_ENUM_SINGLE(DA7219_ALC_CTRL2, DA7219_ALC_ATTACK_SHIFT,
 73                         DA7219_ALC_ATTACK_MAX, da7219_alc_attack_rate_txt);
 74 
 75 static const char * const da7219_alc_release_rate_txt[] = {
 76         "28.66/fs", "57.33/fs", "114.6/fs", "229.3/fs", "458.6/fs", "917.1/fs",
 77         "1834/fs", "3668/fs", "7337/fs", "14674/fs", "29348/fs"
 78 };
 79 
 80 static const struct soc_enum da7219_alc_release_rate =
 81         SOC_ENUM_SINGLE(DA7219_ALC_CTRL2, DA7219_ALC_RELEASE_SHIFT,
 82                         DA7219_ALC_RELEASE_MAX, da7219_alc_release_rate_txt);
 83 
 84 static const char * const da7219_alc_hold_time_txt[] = {
 85         "62/fs", "124/fs", "248/fs", "496/fs", "992/fs", "1984/fs", "3968/fs",
 86         "7936/fs", "15872/fs", "31744/fs", "63488/fs", "126976/fs",
 87         "253952/fs", "507904/fs", "1015808/fs", "2031616/fs"
 88 };
 89 
 90 static const struct soc_enum da7219_alc_hold_time =
 91         SOC_ENUM_SINGLE(DA7219_ALC_CTRL3, DA7219_ALC_HOLD_SHIFT,
 92                         DA7219_ALC_HOLD_MAX, da7219_alc_hold_time_txt);
 93 
 94 static const char * const da7219_alc_env_rate_txt[] = {
 95         "1/4", "1/16", "1/256", "1/65536"
 96 };
 97 
 98 static const struct soc_enum da7219_alc_env_attack_rate =
 99         SOC_ENUM_SINGLE(DA7219_ALC_CTRL3, DA7219_ALC_INTEG_ATTACK_SHIFT,
100                         DA7219_ALC_INTEG_MAX, da7219_alc_env_rate_txt);
101 
102 static const struct soc_enum da7219_alc_env_release_rate =
103         SOC_ENUM_SINGLE(DA7219_ALC_CTRL3, DA7219_ALC_INTEG_RELEASE_SHIFT,
104                         DA7219_ALC_INTEG_MAX, da7219_alc_env_rate_txt);
105 
106 static const char * const da7219_alc_anticlip_step_txt[] = {
107         "0.034dB/fs", "0.068dB/fs", "0.136dB/fs", "0.272dB/fs"
108 };
109 
110 static const struct soc_enum da7219_alc_anticlip_step =
111         SOC_ENUM_SINGLE(DA7219_ALC_ANTICLIP_CTRL,
112                         DA7219_ALC_ANTICLIP_STEP_SHIFT,
113                         DA7219_ALC_ANTICLIP_STEP_MAX,
114                         da7219_alc_anticlip_step_txt);
115 
116 /* Input/Output Enums */
117 static const char * const da7219_gain_ramp_rate_txt[] = {
118         "Nominal Rate * 8", "Nominal Rate", "Nominal Rate / 8",
119         "Nominal Rate / 16"
120 };
121 
122 static const struct soc_enum da7219_gain_ramp_rate =
123         SOC_ENUM_SINGLE(DA7219_GAIN_RAMP_CTRL, DA7219_GAIN_RAMP_RATE_SHIFT,
124                         DA7219_GAIN_RAMP_RATE_MAX, da7219_gain_ramp_rate_txt);
125 
126 static const char * const da7219_hpf_mode_txt[] = {
127         "Disabled", "Audio", "Voice"
128 };
129 
130 static const unsigned int da7219_hpf_mode_val[] = {
131         DA7219_HPF_DISABLED, DA7219_HPF_AUDIO_EN, DA7219_HPF_VOICE_EN,
132 };
133 
134 static const struct soc_enum da7219_adc_hpf_mode =
135         SOC_VALUE_ENUM_SINGLE(DA7219_ADC_FILTERS1, DA7219_HPF_MODE_SHIFT,
136                               DA7219_HPF_MODE_MASK, DA7219_HPF_MODE_MAX,
137                               da7219_hpf_mode_txt, da7219_hpf_mode_val);
138 
139 static const struct soc_enum da7219_dac_hpf_mode =
140         SOC_VALUE_ENUM_SINGLE(DA7219_DAC_FILTERS1, DA7219_HPF_MODE_SHIFT,
141                               DA7219_HPF_MODE_MASK, DA7219_HPF_MODE_MAX,
142                               da7219_hpf_mode_txt, da7219_hpf_mode_val);
143 
144 static const char * const da7219_audio_hpf_corner_txt[] = {
145         "2Hz", "4Hz", "8Hz", "16Hz"
146 };
147 
148 static const struct soc_enum da7219_adc_audio_hpf_corner =
149         SOC_ENUM_SINGLE(DA7219_ADC_FILTERS1,
150                         DA7219_ADC_AUDIO_HPF_CORNER_SHIFT,
151                         DA7219_AUDIO_HPF_CORNER_MAX,
152                         da7219_audio_hpf_corner_txt);
153 
154 static const struct soc_enum da7219_dac_audio_hpf_corner =
155         SOC_ENUM_SINGLE(DA7219_DAC_FILTERS1,
156                         DA7219_DAC_AUDIO_HPF_CORNER_SHIFT,
157                         DA7219_AUDIO_HPF_CORNER_MAX,
158                         da7219_audio_hpf_corner_txt);
159 
160 static const char * const da7219_voice_hpf_corner_txt[] = {
161         "2.5Hz", "25Hz", "50Hz", "100Hz", "150Hz", "200Hz", "300Hz", "400Hz"
162 };
163 
164 static const struct soc_enum da7219_adc_voice_hpf_corner =
165         SOC_ENUM_SINGLE(DA7219_ADC_FILTERS1,
166                         DA7219_ADC_VOICE_HPF_CORNER_SHIFT,
167                         DA7219_VOICE_HPF_CORNER_MAX,
168                         da7219_voice_hpf_corner_txt);
169 
170 static const struct soc_enum da7219_dac_voice_hpf_corner =
171         SOC_ENUM_SINGLE(DA7219_DAC_FILTERS1,
172                         DA7219_DAC_VOICE_HPF_CORNER_SHIFT,
173                         DA7219_VOICE_HPF_CORNER_MAX,
174                         da7219_voice_hpf_corner_txt);
175 
176 static const char * const da7219_tonegen_dtmf_key_txt[] = {
177         "", "1", "2", "3", "4", "5", "6", "7", "8", "9", "A", "B", "C", "D",
178         "*", "#"
179 };
180 
181 static const struct soc_enum da7219_tonegen_dtmf_key =
182         SOC_ENUM_SINGLE(DA7219_TONE_GEN_CFG1, DA7219_DTMF_REG_SHIFT,
183                         DA7219_DTMF_REG_MAX, da7219_tonegen_dtmf_key_txt);
184 
185 static const char * const da7219_tonegen_swg_sel_txt[] = {
186         "Sum", "SWG1", "SWG2", "SWG1_1-Cos"
187 };
188 
189 static const struct soc_enum da7219_tonegen_swg_sel =
190         SOC_ENUM_SINGLE(DA7219_TONE_GEN_CFG2, DA7219_SWG_SEL_SHIFT,
191                         DA7219_SWG_SEL_MAX, da7219_tonegen_swg_sel_txt);
192 
193 /* Output Enums */
194 static const char * const da7219_dac_softmute_rate_txt[] = {
195         "1 Sample", "2 Samples", "4 Samples", "8 Samples", "16 Samples",
196         "32 Samples", "64 Samples"
197 };
198 
199 static const struct soc_enum da7219_dac_softmute_rate =
200         SOC_ENUM_SINGLE(DA7219_DAC_FILTERS5, DA7219_DAC_SOFTMUTE_RATE_SHIFT,
201                         DA7219_DAC_SOFTMUTE_RATE_MAX,
202                         da7219_dac_softmute_rate_txt);
203 
204 static const char * const da7219_dac_ng_setup_time_txt[] = {
205         "256 Samples", "512 Samples", "1024 Samples", "2048 Samples"
206 };
207 
208 static const struct soc_enum da7219_dac_ng_setup_time =
209         SOC_ENUM_SINGLE(DA7219_DAC_NG_SETUP_TIME,
210                         DA7219_DAC_NG_SETUP_TIME_SHIFT,
211                         DA7219_DAC_NG_SETUP_TIME_MAX,
212                         da7219_dac_ng_setup_time_txt);
213 
214 static const char * const da7219_dac_ng_rampup_txt[] = {
215         "0.22ms/dB", "0.0138ms/dB"
216 };
217 
218 static const struct soc_enum da7219_dac_ng_rampup_rate =
219         SOC_ENUM_SINGLE(DA7219_DAC_NG_SETUP_TIME,
220                         DA7219_DAC_NG_RAMPUP_RATE_SHIFT,
221                         DA7219_DAC_NG_RAMP_RATE_MAX,
222                         da7219_dac_ng_rampup_txt);
223 
224 static const char * const da7219_dac_ng_rampdown_txt[] = {
225         "0.88ms/dB", "14.08ms/dB"
226 };
227 
228 static const struct soc_enum da7219_dac_ng_rampdown_rate =
229         SOC_ENUM_SINGLE(DA7219_DAC_NG_SETUP_TIME,
230                         DA7219_DAC_NG_RAMPDN_RATE_SHIFT,
231                         DA7219_DAC_NG_RAMP_RATE_MAX,
232                         da7219_dac_ng_rampdown_txt);
233 
234 
235 static const char * const da7219_cp_track_mode_txt[] = {
236         "Largest Volume", "DAC Volume", "Signal Magnitude"
237 };
238 
239 static const unsigned int da7219_cp_track_mode_val[] = {
240         DA7219_CP_MCHANGE_LARGEST_VOL, DA7219_CP_MCHANGE_DAC_VOL,
241         DA7219_CP_MCHANGE_SIG_MAG
242 };
243 
244 static const struct soc_enum da7219_cp_track_mode =
245         SOC_VALUE_ENUM_SINGLE(DA7219_CP_CTRL, DA7219_CP_MCHANGE_SHIFT,
246                               DA7219_CP_MCHANGE_REL_MASK, DA7219_CP_MCHANGE_MAX,
247                               da7219_cp_track_mode_txt,
248                               da7219_cp_track_mode_val);
249 
250 
251 /*
252  * Control Functions
253  */
254 
255 /* Locked Kcontrol calls */
256 static int da7219_volsw_locked_get(struct snd_kcontrol *kcontrol,
257                                    struct snd_ctl_elem_value *ucontrol)
258 {
259         struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
260         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
261         int ret;
262 
263         mutex_lock(&da7219->ctrl_lock);
264         ret = snd_soc_get_volsw(kcontrol, ucontrol);
265         mutex_unlock(&da7219->ctrl_lock);
266 
267         return ret;
268 }
269 
270 static int da7219_volsw_locked_put(struct snd_kcontrol *kcontrol,
271                                    struct snd_ctl_elem_value *ucontrol)
272 {
273         struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
274         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
275         int ret;
276 
277         mutex_lock(&da7219->ctrl_lock);
278         ret = snd_soc_put_volsw(kcontrol, ucontrol);
279         mutex_unlock(&da7219->ctrl_lock);
280 
281         return ret;
282 }
283 
284 static int da7219_enum_locked_get(struct snd_kcontrol *kcontrol,
285                                 struct snd_ctl_elem_value *ucontrol)
286 {
287         struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
288         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
289         int ret;
290 
291         mutex_lock(&da7219->ctrl_lock);
292         ret = snd_soc_get_enum_double(kcontrol, ucontrol);
293         mutex_unlock(&da7219->ctrl_lock);
294 
295         return ret;
296 }
297 
298 static int da7219_enum_locked_put(struct snd_kcontrol *kcontrol,
299                                 struct snd_ctl_elem_value *ucontrol)
300 {
301         struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
302         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
303         int ret;
304 
305         mutex_lock(&da7219->ctrl_lock);
306         ret = snd_soc_put_enum_double(kcontrol, ucontrol);
307         mutex_unlock(&da7219->ctrl_lock);
308 
309         return ret;
310 }
311 
312 /* ALC */
313 static void da7219_alc_calib(struct snd_soc_codec *codec)
314 {
315         u8 mic_ctrl, mixin_ctrl, adc_ctrl, calib_ctrl;
316 
317         /* Save current state of mic control register */
318         mic_ctrl = snd_soc_read(codec, DA7219_MIC_1_CTRL);
319 
320         /* Save current state of input mixer control register */
321         mixin_ctrl = snd_soc_read(codec, DA7219_MIXIN_L_CTRL);
322 
323         /* Save current state of input ADC control register */
324         adc_ctrl = snd_soc_read(codec, DA7219_ADC_L_CTRL);
325 
326         /* Enable then Mute MIC PGAs */
327         snd_soc_update_bits(codec, DA7219_MIC_1_CTRL, DA7219_MIC_1_AMP_EN_MASK,
328                             DA7219_MIC_1_AMP_EN_MASK);
329         snd_soc_update_bits(codec, DA7219_MIC_1_CTRL,
330                             DA7219_MIC_1_AMP_MUTE_EN_MASK,
331                             DA7219_MIC_1_AMP_MUTE_EN_MASK);
332 
333         /* Enable input mixers unmuted */
334         snd_soc_update_bits(codec, DA7219_MIXIN_L_CTRL,
335                             DA7219_MIXIN_L_AMP_EN_MASK |
336                             DA7219_MIXIN_L_AMP_MUTE_EN_MASK,
337                             DA7219_MIXIN_L_AMP_EN_MASK);
338 
339         /* Enable input filters unmuted */
340         snd_soc_update_bits(codec, DA7219_ADC_L_CTRL,
341                             DA7219_ADC_L_MUTE_EN_MASK | DA7219_ADC_L_EN_MASK,
342                             DA7219_ADC_L_EN_MASK);
343 
344         /* Perform auto calibration */
345         snd_soc_update_bits(codec, DA7219_ALC_CTRL1,
346                             DA7219_ALC_AUTO_CALIB_EN_MASK,
347                             DA7219_ALC_AUTO_CALIB_EN_MASK);
348         do {
349                 calib_ctrl = snd_soc_read(codec, DA7219_ALC_CTRL1);
350         } while (calib_ctrl & DA7219_ALC_AUTO_CALIB_EN_MASK);
351 
352         /* If auto calibration fails, disable DC offset, hybrid ALC */
353         if (calib_ctrl & DA7219_ALC_CALIB_OVERFLOW_MASK) {
354                 dev_warn(codec->dev,
355                          "ALC auto calibration failed with overflow\n");
356                 snd_soc_update_bits(codec, DA7219_ALC_CTRL1,
357                                     DA7219_ALC_OFFSET_EN_MASK |
358                                     DA7219_ALC_SYNC_MODE_MASK, 0);
359         } else {
360                 /* Enable DC offset cancellation, hybrid mode */
361                 snd_soc_update_bits(codec, DA7219_ALC_CTRL1,
362                                     DA7219_ALC_OFFSET_EN_MASK |
363                                     DA7219_ALC_SYNC_MODE_MASK,
364                                     DA7219_ALC_OFFSET_EN_MASK |
365                                     DA7219_ALC_SYNC_MODE_MASK);
366         }
367 
368         /* Restore input filter control register to original state */
369         snd_soc_write(codec, DA7219_ADC_L_CTRL, adc_ctrl);
370 
371         /* Restore input mixer control registers to original state */
372         snd_soc_write(codec, DA7219_MIXIN_L_CTRL, mixin_ctrl);
373 
374         /* Restore MIC control registers to original states */
375         snd_soc_write(codec, DA7219_MIC_1_CTRL, mic_ctrl);
376 }
377 
378 static int da7219_mixin_gain_put(struct snd_kcontrol *kcontrol,
379                                  struct snd_ctl_elem_value *ucontrol)
380 {
381         struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
382         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
383         int ret;
384 
385         ret = snd_soc_put_volsw(kcontrol, ucontrol);
386 
387         /*
388          * If ALC in operation and value of control has been updated,
389          * make sure calibrated offsets are updated.
390          */
391         if ((ret == 1) && (da7219->alc_en))
392                 da7219_alc_calib(codec);
393 
394         return ret;
395 }
396 
397 static int da7219_alc_sw_put(struct snd_kcontrol *kcontrol,
398                              struct snd_ctl_elem_value *ucontrol)
399 {
400         struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
401         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
402 
403 
404         /* Force ALC offset calibration if enabling ALC */
405         if ((ucontrol->value.integer.value[0]) && (!da7219->alc_en)) {
406                 da7219_alc_calib(codec);
407                 da7219->alc_en = true;
408         } else {
409                 da7219->alc_en = false;
410         }
411 
412         return snd_soc_put_volsw(kcontrol, ucontrol);
413 }
414 
415 /* ToneGen */
416 static int da7219_tonegen_freq_get(struct snd_kcontrol *kcontrol,
417                                    struct snd_ctl_elem_value *ucontrol)
418 {
419         struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
420         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
421         struct soc_mixer_control *mixer_ctrl =
422                 (struct soc_mixer_control *) kcontrol->private_value;
423         unsigned int reg = mixer_ctrl->reg;
424         u16 val;
425         int ret;
426 
427         mutex_lock(&da7219->ctrl_lock);
428         ret = regmap_raw_read(da7219->regmap, reg, &val, sizeof(val));
429         mutex_unlock(&da7219->ctrl_lock);
430 
431         if (ret)
432                 return ret;
433 
434         /*
435          * Frequency value spans two 8-bit registers, lower then upper byte.
436          * Therefore we need to convert to host endianness here.
437          */
438         ucontrol->value.integer.value[0] = le16_to_cpu(val);
439 
440         return 0;
441 }
442 
443 static int da7219_tonegen_freq_put(struct snd_kcontrol *kcontrol,
444                                    struct snd_ctl_elem_value *ucontrol)
445 {
446         struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
447         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
448         struct soc_mixer_control *mixer_ctrl =
449                 (struct soc_mixer_control *) kcontrol->private_value;
450         unsigned int reg = mixer_ctrl->reg;
451         u16 val;
452         int ret;
453 
454         /*
455          * Frequency value spans two 8-bit registers, lower then upper byte.
456          * Therefore we need to convert to little endian here to align with
457          * HW registers.
458          */
459         val = cpu_to_le16(ucontrol->value.integer.value[0]);
460 
461         mutex_lock(&da7219->ctrl_lock);
462         ret = regmap_raw_write(da7219->regmap, reg, &val, sizeof(val));
463         mutex_unlock(&da7219->ctrl_lock);
464 
465         return ret;
466 }
467 
468 
469 /*
470  * KControls
471  */
472 
473 static const struct snd_kcontrol_new da7219_snd_controls[] = {
474         /* Mics */
475         SOC_SINGLE_TLV("Mic Volume", DA7219_MIC_1_GAIN,
476                        DA7219_MIC_1_AMP_GAIN_SHIFT, DA7219_MIC_1_AMP_GAIN_MAX,
477                        DA7219_NO_INVERT, da7219_mic_gain_tlv),
478         SOC_SINGLE("Mic Switch", DA7219_MIC_1_CTRL,
479                    DA7219_MIC_1_AMP_MUTE_EN_SHIFT, DA7219_SWITCH_EN_MAX,
480                    DA7219_INVERT),
481 
482         /* Mixer Input */
483         SOC_SINGLE_EXT_TLV("Mixin Volume", DA7219_MIXIN_L_GAIN,
484                            DA7219_MIXIN_L_AMP_GAIN_SHIFT,
485                            DA7219_MIXIN_L_AMP_GAIN_MAX, DA7219_NO_INVERT,
486                            snd_soc_get_volsw, da7219_mixin_gain_put,
487                            da7219_mixin_gain_tlv),
488         SOC_SINGLE("Mixin Switch", DA7219_MIXIN_L_CTRL,
489                    DA7219_MIXIN_L_AMP_MUTE_EN_SHIFT, DA7219_SWITCH_EN_MAX,
490                    DA7219_INVERT),
491         SOC_SINGLE("Mixin Gain Ramp Switch", DA7219_MIXIN_L_CTRL,
492                    DA7219_MIXIN_L_AMP_RAMP_EN_SHIFT, DA7219_SWITCH_EN_MAX,
493                    DA7219_NO_INVERT),
494         SOC_SINGLE("Mixin ZC Gain Switch", DA7219_MIXIN_L_CTRL,
495                    DA7219_MIXIN_L_AMP_ZC_EN_SHIFT, DA7219_SWITCH_EN_MAX,
496                    DA7219_NO_INVERT),
497 
498         /* ADC */
499         SOC_SINGLE_TLV("Capture Digital Volume", DA7219_ADC_L_GAIN,
500                        DA7219_ADC_L_DIGITAL_GAIN_SHIFT,
501                        DA7219_ADC_L_DIGITAL_GAIN_MAX, DA7219_NO_INVERT,
502                        da7219_adc_dig_gain_tlv),
503         SOC_SINGLE("Capture Digital Switch", DA7219_ADC_L_CTRL,
504                    DA7219_ADC_L_MUTE_EN_SHIFT, DA7219_SWITCH_EN_MAX,
505                    DA7219_INVERT),
506         SOC_SINGLE("Capture Digital Gain Ramp Switch", DA7219_ADC_L_CTRL,
507                    DA7219_ADC_L_RAMP_EN_SHIFT, DA7219_SWITCH_EN_MAX,
508                    DA7219_NO_INVERT),
509 
510         /* ALC */
511         SOC_ENUM("ALC Attack Rate", da7219_alc_attack_rate),
512         SOC_ENUM("ALC Release Rate", da7219_alc_release_rate),
513         SOC_ENUM("ALC Hold Time", da7219_alc_hold_time),
514         SOC_ENUM("ALC Envelope Attack Rate", da7219_alc_env_attack_rate),
515         SOC_ENUM("ALC Envelope Release Rate", da7219_alc_env_release_rate),
516         SOC_SINGLE_TLV("ALC Noise Threshold", DA7219_ALC_NOISE,
517                        DA7219_ALC_NOISE_SHIFT, DA7219_ALC_THRESHOLD_MAX,
518                        DA7219_INVERT, da7219_alc_threshold_tlv),
519         SOC_SINGLE_TLV("ALC Min Threshold", DA7219_ALC_TARGET_MIN,
520                        DA7219_ALC_THRESHOLD_MIN_SHIFT, DA7219_ALC_THRESHOLD_MAX,
521                        DA7219_INVERT, da7219_alc_threshold_tlv),
522         SOC_SINGLE_TLV("ALC Max Threshold", DA7219_ALC_TARGET_MAX,
523                        DA7219_ALC_THRESHOLD_MAX_SHIFT, DA7219_ALC_THRESHOLD_MAX,
524                        DA7219_INVERT, da7219_alc_threshold_tlv),
525         SOC_SINGLE_TLV("ALC Max Attenuation", DA7219_ALC_GAIN_LIMITS,
526                        DA7219_ALC_ATTEN_MAX_SHIFT, DA7219_ALC_ATTEN_GAIN_MAX,
527                        DA7219_NO_INVERT, da7219_alc_gain_tlv),
528         SOC_SINGLE_TLV("ALC Max Volume", DA7219_ALC_GAIN_LIMITS,
529                        DA7219_ALC_GAIN_MAX_SHIFT, DA7219_ALC_ATTEN_GAIN_MAX,
530                        DA7219_NO_INVERT, da7219_alc_gain_tlv),
531         SOC_SINGLE_RANGE_TLV("ALC Min Analog Volume", DA7219_ALC_ANA_GAIN_LIMITS,
532                              DA7219_ALC_ANA_GAIN_MIN_SHIFT,
533                              DA7219_ALC_ANA_GAIN_MIN, DA7219_ALC_ANA_GAIN_MAX,
534                              DA7219_NO_INVERT, da7219_alc_ana_gain_tlv),
535         SOC_SINGLE_RANGE_TLV("ALC Max Analog Volume", DA7219_ALC_ANA_GAIN_LIMITS,
536                              DA7219_ALC_ANA_GAIN_MAX_SHIFT,
537                              DA7219_ALC_ANA_GAIN_MIN, DA7219_ALC_ANA_GAIN_MAX,
538                              DA7219_NO_INVERT, da7219_alc_ana_gain_tlv),
539         SOC_ENUM("ALC Anticlip Step", da7219_alc_anticlip_step),
540         SOC_SINGLE("ALC Anticlip Switch", DA7219_ALC_ANTICLIP_CTRL,
541                    DA7219_ALC_ANTIPCLIP_EN_SHIFT, DA7219_SWITCH_EN_MAX,
542                    DA7219_NO_INVERT),
543         SOC_SINGLE_EXT("ALC Switch", DA7219_ALC_CTRL1, DA7219_ALC_EN_SHIFT,
544                        DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT,
545                        snd_soc_get_volsw, da7219_alc_sw_put),
546 
547         /* Input High-Pass Filters */
548         SOC_ENUM("ADC HPF Mode", da7219_adc_hpf_mode),
549         SOC_ENUM("ADC HPF Corner Audio", da7219_adc_audio_hpf_corner),
550         SOC_ENUM("ADC HPF Corner Voice", da7219_adc_voice_hpf_corner),
551 
552         /* Sidetone Filter */
553         SOC_SINGLE_TLV("Sidetone Volume", DA7219_SIDETONE_GAIN,
554                        DA7219_SIDETONE_GAIN_SHIFT, DA7219_SIDETONE_GAIN_MAX,
555                        DA7219_NO_INVERT, da7219_sidetone_gain_tlv),
556         SOC_SINGLE("Sidetone Switch", DA7219_SIDETONE_CTRL,
557                    DA7219_SIDETONE_MUTE_EN_SHIFT, DA7219_SWITCH_EN_MAX,
558                    DA7219_INVERT),
559 
560         /* Tone Generator */
561         SOC_SINGLE_EXT_TLV("ToneGen Volume", DA7219_TONE_GEN_CFG2,
562                            DA7219_TONE_GEN_GAIN_SHIFT, DA7219_TONE_GEN_GAIN_MAX,
563                            DA7219_NO_INVERT, da7219_volsw_locked_get,
564                            da7219_volsw_locked_put, da7219_tonegen_gain_tlv),
565         SOC_ENUM_EXT("ToneGen DTMF Key", da7219_tonegen_dtmf_key,
566                      da7219_enum_locked_get, da7219_enum_locked_put),
567         SOC_SINGLE_EXT("ToneGen DTMF Switch", DA7219_TONE_GEN_CFG1,
568                        DA7219_DTMF_EN_SHIFT, DA7219_SWITCH_EN_MAX,
569                        DA7219_NO_INVERT, da7219_volsw_locked_get,
570                        da7219_volsw_locked_put),
571         SOC_ENUM_EXT("ToneGen Sinewave Gen Type", da7219_tonegen_swg_sel,
572                      da7219_enum_locked_get, da7219_enum_locked_put),
573         SOC_SINGLE_EXT("ToneGen Sinewave1 Freq", DA7219_TONE_GEN_FREQ1_L,
574                        DA7219_FREQ1_L_SHIFT, DA7219_FREQ_MAX, DA7219_NO_INVERT,
575                        da7219_tonegen_freq_get, da7219_tonegen_freq_put),
576         SOC_SINGLE_EXT("ToneGen Sinewave2 Freq", DA7219_TONE_GEN_FREQ2_L,
577                        DA7219_FREQ2_L_SHIFT, DA7219_FREQ_MAX, DA7219_NO_INVERT,
578                        da7219_tonegen_freq_get, da7219_tonegen_freq_put),
579         SOC_SINGLE_EXT("ToneGen On Time", DA7219_TONE_GEN_ON_PER,
580                        DA7219_BEEP_ON_PER_SHIFT, DA7219_BEEP_ON_OFF_MAX,
581                        DA7219_NO_INVERT, da7219_volsw_locked_get,
582                        da7219_volsw_locked_put),
583         SOC_SINGLE("ToneGen Off Time", DA7219_TONE_GEN_OFF_PER,
584                    DA7219_BEEP_OFF_PER_SHIFT, DA7219_BEEP_ON_OFF_MAX,
585                    DA7219_NO_INVERT),
586 
587         /* Gain ramping */
588         SOC_ENUM("Gain Ramp Rate", da7219_gain_ramp_rate),
589 
590         /* DAC High-Pass Filter */
591         SOC_ENUM_EXT("DAC HPF Mode", da7219_dac_hpf_mode,
592                      da7219_enum_locked_get, da7219_enum_locked_put),
593         SOC_ENUM("DAC HPF Corner Audio", da7219_dac_audio_hpf_corner),
594         SOC_ENUM("DAC HPF Corner Voice", da7219_dac_voice_hpf_corner),
595 
596         /* DAC 5-Band Equaliser */
597         SOC_SINGLE_TLV("DAC EQ Band1 Volume", DA7219_DAC_FILTERS2,
598                        DA7219_DAC_EQ_BAND1_SHIFT, DA7219_DAC_EQ_BAND_MAX,
599                        DA7219_NO_INVERT, da7219_dac_eq_band_tlv),
600         SOC_SINGLE_TLV("DAC EQ Band2 Volume", DA7219_DAC_FILTERS2,
601                        DA7219_DAC_EQ_BAND2_SHIFT, DA7219_DAC_EQ_BAND_MAX,
602                        DA7219_NO_INVERT, da7219_dac_eq_band_tlv),
603         SOC_SINGLE_TLV("DAC EQ Band3 Volume", DA7219_DAC_FILTERS3,
604                        DA7219_DAC_EQ_BAND3_SHIFT, DA7219_DAC_EQ_BAND_MAX,
605                        DA7219_NO_INVERT, da7219_dac_eq_band_tlv),
606         SOC_SINGLE_TLV("DAC EQ Band4 Volume", DA7219_DAC_FILTERS3,
607                        DA7219_DAC_EQ_BAND4_SHIFT, DA7219_DAC_EQ_BAND_MAX,
608                        DA7219_NO_INVERT, da7219_dac_eq_band_tlv),
609         SOC_SINGLE_TLV("DAC EQ Band5 Volume", DA7219_DAC_FILTERS4,
610                        DA7219_DAC_EQ_BAND5_SHIFT, DA7219_DAC_EQ_BAND_MAX,
611                        DA7219_NO_INVERT, da7219_dac_eq_band_tlv),
612         SOC_SINGLE_EXT("DAC EQ Switch", DA7219_DAC_FILTERS4,
613                        DA7219_DAC_EQ_EN_SHIFT, DA7219_SWITCH_EN_MAX,
614                        DA7219_NO_INVERT, da7219_volsw_locked_get,
615                        da7219_volsw_locked_put),
616 
617         /* DAC Softmute */
618         SOC_ENUM("DAC Soft Mute Rate", da7219_dac_softmute_rate),
619         SOC_SINGLE_EXT("DAC Soft Mute Switch", DA7219_DAC_FILTERS5,
620                        DA7219_DAC_SOFTMUTE_EN_SHIFT, DA7219_SWITCH_EN_MAX,
621                        DA7219_NO_INVERT, da7219_volsw_locked_get,
622                        da7219_volsw_locked_put),
623 
624         /* DAC Noise Gate */
625         SOC_ENUM("DAC NG Setup Time", da7219_dac_ng_setup_time),
626         SOC_ENUM("DAC NG Rampup Rate", da7219_dac_ng_rampup_rate),
627         SOC_ENUM("DAC NG Rampdown Rate", da7219_dac_ng_rampdown_rate),
628         SOC_SINGLE_TLV("DAC NG Off Threshold", DA7219_DAC_NG_OFF_THRESH,
629                        DA7219_DAC_NG_OFF_THRESHOLD_SHIFT,
630                        DA7219_DAC_NG_THRESHOLD_MAX, DA7219_NO_INVERT,
631                        da7219_dac_ng_threshold_tlv),
632         SOC_SINGLE_TLV("DAC NG On Threshold", DA7219_DAC_NG_ON_THRESH,
633                        DA7219_DAC_NG_ON_THRESHOLD_SHIFT,
634                        DA7219_DAC_NG_THRESHOLD_MAX, DA7219_NO_INVERT,
635                        da7219_dac_ng_threshold_tlv),
636         SOC_SINGLE("DAC NG Switch", DA7219_DAC_NG_CTRL, DA7219_DAC_NG_EN_SHIFT,
637                    DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
638 
639         /* DACs */
640         SOC_DOUBLE_R_EXT_TLV("Playback Digital Volume", DA7219_DAC_L_GAIN,
641                              DA7219_DAC_R_GAIN, DA7219_DAC_L_DIGITAL_GAIN_SHIFT,
642                              DA7219_DAC_DIGITAL_GAIN_MAX, DA7219_NO_INVERT,
643                              da7219_volsw_locked_get, da7219_volsw_locked_put,
644                              da7219_dac_dig_gain_tlv),
645         SOC_DOUBLE_R_EXT("Playback Digital Switch", DA7219_DAC_L_CTRL,
646                          DA7219_DAC_R_CTRL, DA7219_DAC_L_MUTE_EN_SHIFT,
647                          DA7219_SWITCH_EN_MAX, DA7219_INVERT,
648                          da7219_volsw_locked_get, da7219_volsw_locked_put),
649         SOC_DOUBLE_R("Playback Digital Gain Ramp Switch", DA7219_DAC_L_CTRL,
650                      DA7219_DAC_R_CTRL, DA7219_DAC_L_RAMP_EN_SHIFT,
651                      DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
652 
653         /* CP */
654         SOC_ENUM("Charge Pump Track Mode", da7219_cp_track_mode),
655         SOC_SINGLE("Charge Pump Threshold", DA7219_CP_VOL_THRESHOLD1,
656                    DA7219_CP_THRESH_VDD2_SHIFT, DA7219_CP_THRESH_VDD2_MAX,
657                    DA7219_NO_INVERT),
658 
659         /* Headphones */
660         SOC_DOUBLE_R_EXT_TLV("Headphone Volume", DA7219_HP_L_GAIN,
661                              DA7219_HP_R_GAIN, DA7219_HP_L_AMP_GAIN_SHIFT,
662                              DA7219_HP_AMP_GAIN_MAX, DA7219_NO_INVERT,
663                              da7219_volsw_locked_get, da7219_volsw_locked_put,
664                              da7219_hp_gain_tlv),
665         SOC_DOUBLE_R_EXT("Headphone Switch", DA7219_HP_L_CTRL, DA7219_HP_R_CTRL,
666                          DA7219_HP_L_AMP_MUTE_EN_SHIFT, DA7219_SWITCH_EN_MAX,
667                          DA7219_INVERT, da7219_volsw_locked_get,
668                          da7219_volsw_locked_put),
669         SOC_DOUBLE_R("Headphone Gain Ramp Switch", DA7219_HP_L_CTRL,
670                      DA7219_HP_R_CTRL, DA7219_HP_L_AMP_RAMP_EN_SHIFT,
671                      DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
672         SOC_DOUBLE_R("Headphone ZC Gain Switch", DA7219_HP_L_CTRL,
673                      DA7219_HP_R_CTRL, DA7219_HP_L_AMP_ZC_EN_SHIFT,
674                      DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
675 };
676 
677 
678 /*
679  * DAPM Mux Controls
680  */
681 
682 static const char * const da7219_out_sel_txt[] = {
683         "ADC", "Tone Generator", "DAIL", "DAIR"
684 };
685 
686 static const struct soc_enum da7219_out_dail_sel =
687         SOC_ENUM_SINGLE(DA7219_DIG_ROUTING_DAI,
688                         DA7219_DAI_L_SRC_SHIFT,
689                         DA7219_OUT_SRC_MAX,
690                         da7219_out_sel_txt);
691 
692 static const struct snd_kcontrol_new da7219_out_dail_sel_mux =
693         SOC_DAPM_ENUM("Out DAIL Mux", da7219_out_dail_sel);
694 
695 static const struct soc_enum da7219_out_dair_sel =
696         SOC_ENUM_SINGLE(DA7219_DIG_ROUTING_DAI,
697                         DA7219_DAI_R_SRC_SHIFT,
698                         DA7219_OUT_SRC_MAX,
699                         da7219_out_sel_txt);
700 
701 static const struct snd_kcontrol_new da7219_out_dair_sel_mux =
702         SOC_DAPM_ENUM("Out DAIR Mux", da7219_out_dair_sel);
703 
704 static const struct soc_enum da7219_out_dacl_sel =
705         SOC_ENUM_SINGLE(DA7219_DIG_ROUTING_DAC,
706                         DA7219_DAC_L_SRC_SHIFT,
707                         DA7219_OUT_SRC_MAX,
708                         da7219_out_sel_txt);
709 
710 static const struct snd_kcontrol_new da7219_out_dacl_sel_mux =
711         SOC_DAPM_ENUM("Out DACL Mux", da7219_out_dacl_sel);
712 
713 static const struct soc_enum da7219_out_dacr_sel =
714         SOC_ENUM_SINGLE(DA7219_DIG_ROUTING_DAC,
715                         DA7219_DAC_R_SRC_SHIFT,
716                         DA7219_OUT_SRC_MAX,
717                         da7219_out_sel_txt);
718 
719 static const struct snd_kcontrol_new da7219_out_dacr_sel_mux =
720         SOC_DAPM_ENUM("Out DACR Mux", da7219_out_dacr_sel);
721 
722 
723 /*
724  * DAPM Mixer Controls
725  */
726 
727 static const struct snd_kcontrol_new da7219_mixin_controls[] = {
728         SOC_DAPM_SINGLE("Mic Switch", DA7219_MIXIN_L_SELECT,
729                         DA7219_MIXIN_L_MIX_SELECT_SHIFT,
730                         DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
731 };
732 
733 static const struct snd_kcontrol_new da7219_mixout_l_controls[] = {
734         SOC_DAPM_SINGLE("DACL Switch", DA7219_MIXOUT_L_SELECT,
735                         DA7219_MIXOUT_L_MIX_SELECT_SHIFT,
736                         DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
737 };
738 
739 static const struct snd_kcontrol_new da7219_mixout_r_controls[] = {
740         SOC_DAPM_SINGLE("DACR Switch", DA7219_MIXOUT_R_SELECT,
741                         DA7219_MIXOUT_R_MIX_SELECT_SHIFT,
742                         DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),
743 };
744 
745 #define DA7219_DMIX_ST_CTRLS(reg)                                       \
746         SOC_DAPM_SINGLE("Out FilterL Switch", reg,                      \
747                         DA7219_DMIX_ST_SRC_OUTFILT1L_SHIFT,             \
748                         DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),        \
749         SOC_DAPM_SINGLE("Out FilterR Switch", reg,                      \
750                         DA7219_DMIX_ST_SRC_OUTFILT1R_SHIFT,             \
751                         DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT),        \
752         SOC_DAPM_SINGLE("Sidetone Switch", reg,                         \
753                         DA7219_DMIX_ST_SRC_SIDETONE_SHIFT,              \
754                         DA7219_SWITCH_EN_MAX, DA7219_NO_INVERT)         \
755 
756 static const struct snd_kcontrol_new da7219_st_out_filtl_mix_controls[] = {
757         DA7219_DMIX_ST_CTRLS(DA7219_DROUTING_ST_OUTFILT_1L),
758 };
759 
760 static const struct snd_kcontrol_new da7219_st_out_filtr_mix_controls[] = {
761         DA7219_DMIX_ST_CTRLS(DA7219_DROUTING_ST_OUTFILT_1R),
762 };
763 
764 
765 /*
766  * DAPM Events
767  */
768 
769 static int da7219_dai_event(struct snd_soc_dapm_widget *w,
770                             struct snd_kcontrol *kcontrol, int event)
771 {
772         struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
773         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
774         u8 pll_ctrl, pll_status;
775         int i = 0;
776         bool srm_lock = false;
777 
778         switch (event) {
779         case SND_SOC_DAPM_PRE_PMU:
780                 if (da7219->master)
781                         /* Enable DAI clks for master mode */
782                         snd_soc_update_bits(codec, DA7219_DAI_CLK_MODE,
783                                             DA7219_DAI_CLK_EN_MASK,
784                                             DA7219_DAI_CLK_EN_MASK);
785 
786                 /* PC synchronised to DAI */
787                 snd_soc_update_bits(codec, DA7219_PC_COUNT,
788                                     DA7219_PC_FREERUN_MASK, 0);
789 
790                 /* Slave mode, if SRM not enabled no need for status checks */
791                 pll_ctrl = snd_soc_read(codec, DA7219_PLL_CTRL);
792                 if ((pll_ctrl & DA7219_PLL_MODE_MASK) != DA7219_PLL_MODE_SRM)
793                         return 0;
794 
795                 /* Check SRM has locked */
796                 do {
797                         pll_status = snd_soc_read(codec, DA7219_PLL_SRM_STS);
798                         if (pll_status & DA7219_PLL_SRM_STS_SRM_LOCK) {
799                                 srm_lock = true;
800                         } else {
801                                 ++i;
802                                 msleep(50);
803                         }
804                 } while ((i < DA7219_SRM_CHECK_RETRIES) & (!srm_lock));
805 
806                 if (!srm_lock)
807                         dev_warn(codec->dev, "SRM failed to lock\n");
808 
809                 return 0;
810         case SND_SOC_DAPM_POST_PMD:
811                 /* PC free-running */
812                 snd_soc_update_bits(codec, DA7219_PC_COUNT,
813                                     DA7219_PC_FREERUN_MASK,
814                                     DA7219_PC_FREERUN_MASK);
815 
816                 /* Disable DAI clks if in master mode */
817                 if (da7219->master)
818                         snd_soc_update_bits(codec, DA7219_DAI_CLK_MODE,
819                                             DA7219_DAI_CLK_EN_MASK, 0);
820                 return 0;
821         default:
822                 return -EINVAL;
823         }
824 }
825 
826 static int da7219_settling_event(struct snd_soc_dapm_widget *w,
827                                  struct snd_kcontrol *kcontrol, int event)
828 {
829         switch (event) {
830         case SND_SOC_DAPM_POST_PMU:
831         case SND_SOC_DAPM_POST_PMD:
832                 msleep(DA7219_SETTLING_DELAY);
833                 break;
834         default:
835                 break;
836         }
837 
838         return 0;
839 }
840 
841 static int da7219_mixout_event(struct snd_soc_dapm_widget *w,
842                                struct snd_kcontrol *kcontrol, int event)
843 {
844         struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
845         u8 hp_ctrl, min_gain_mask;
846 
847         switch (w->reg) {
848         case DA7219_MIXOUT_L_CTRL:
849                 hp_ctrl = DA7219_HP_L_CTRL;
850                 min_gain_mask = DA7219_HP_L_AMP_MIN_GAIN_EN_MASK;
851                 break;
852         case DA7219_MIXOUT_R_CTRL:
853                 hp_ctrl = DA7219_HP_R_CTRL;
854                 min_gain_mask = DA7219_HP_R_AMP_MIN_GAIN_EN_MASK;
855                 break;
856         default:
857                 return -EINVAL;
858         }
859 
860         switch (event) {
861         case SND_SOC_DAPM_PRE_PMD:
862                 /* Enable minimum gain on HP to avoid pops */
863                 snd_soc_update_bits(codec, hp_ctrl, min_gain_mask,
864                                     min_gain_mask);
865 
866                 msleep(DA7219_MIN_GAIN_DELAY);
867 
868                 break;
869         case SND_SOC_DAPM_POST_PMU:
870                 /* Remove minimum gain on HP */
871                 snd_soc_update_bits(codec, hp_ctrl, min_gain_mask, 0);
872 
873                 break;
874         }
875 
876         return 0;
877 }
878 
879 static int da7219_gain_ramp_event(struct snd_soc_dapm_widget *w,
880                                   struct snd_kcontrol *kcontrol, int event)
881 {
882         struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
883         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
884 
885         switch (event) {
886         case SND_SOC_DAPM_PRE_PMU:
887         case SND_SOC_DAPM_PRE_PMD:
888                 /* Ensure nominal gain ramping for DAPM sequence */
889                 da7219->gain_ramp_ctrl =
890                         snd_soc_read(codec, DA7219_GAIN_RAMP_CTRL);
891                 snd_soc_write(codec, DA7219_GAIN_RAMP_CTRL,
892                               DA7219_GAIN_RAMP_RATE_NOMINAL);
893                 break;
894         case SND_SOC_DAPM_POST_PMU:
895         case SND_SOC_DAPM_POST_PMD:
896                 /* Restore previous gain ramp settings */
897                 snd_soc_write(codec, DA7219_GAIN_RAMP_CTRL,
898                               da7219->gain_ramp_ctrl);
899                 break;
900         }
901 
902         return 0;
903 }
904 
905 
906 /*
907  * DAPM Widgets
908  */
909 
910 static const struct snd_soc_dapm_widget da7219_dapm_widgets[] = {
911         /* Input Supplies */
912         SND_SOC_DAPM_SUPPLY("Mic Bias", DA7219_MICBIAS_CTRL,
913                             DA7219_MICBIAS1_EN_SHIFT, DA7219_NO_INVERT,
914                             NULL, 0),
915 
916         /* Inputs */
917         SND_SOC_DAPM_INPUT("MIC"),
918 
919         /* Input PGAs */
920         SND_SOC_DAPM_PGA("Mic PGA", DA7219_MIC_1_CTRL,
921                          DA7219_MIC_1_AMP_EN_SHIFT, DA7219_NO_INVERT,
922                          NULL, 0),
923         SND_SOC_DAPM_PGA("Mixin PGA", DA7219_MIXIN_L_CTRL,
924                          DA7219_MIXIN_L_AMP_EN_SHIFT, DA7219_NO_INVERT,
925                          NULL, 0),
926 
927         /* Input Filters */
928         SND_SOC_DAPM_ADC("ADC", NULL, DA7219_ADC_L_CTRL, DA7219_ADC_L_EN_SHIFT,
929                          DA7219_NO_INVERT),
930 
931         /* Tone Generator */
932         SND_SOC_DAPM_SIGGEN("TONE"),
933         SND_SOC_DAPM_PGA("Tone Generator", DA7219_TONE_GEN_CFG1,
934                          DA7219_START_STOPN_SHIFT, DA7219_NO_INVERT, NULL, 0),
935 
936         /* Sidetone Input */
937         SND_SOC_DAPM_ADC("Sidetone Filter", NULL, DA7219_SIDETONE_CTRL,
938                          DA7219_SIDETONE_EN_SHIFT, DA7219_NO_INVERT),
939 
940         /* Input Mixer Supply */
941         SND_SOC_DAPM_SUPPLY("Mixer In Supply", DA7219_MIXIN_L_CTRL,
942                             DA7219_MIXIN_L_MIX_EN_SHIFT, DA7219_NO_INVERT,
943                             NULL, 0),
944 
945         /* Input Mixer */
946         SND_SOC_DAPM_MIXER("Mixer In", SND_SOC_NOPM, 0, 0,
947                            da7219_mixin_controls,
948                            ARRAY_SIZE(da7219_mixin_controls)),
949 
950         /* Input Muxes */
951         SND_SOC_DAPM_MUX("Out DAIL Mux", SND_SOC_NOPM, 0, 0,
952                          &da7219_out_dail_sel_mux),
953         SND_SOC_DAPM_MUX("Out DAIR Mux", SND_SOC_NOPM, 0, 0,
954                          &da7219_out_dair_sel_mux),
955 
956         /* DAI Supply */
957         SND_SOC_DAPM_SUPPLY("DAI", DA7219_DAI_CTRL, DA7219_DAI_EN_SHIFT,
958                             DA7219_NO_INVERT, da7219_dai_event,
959                             SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
960 
961         /* DAI */
962         SND_SOC_DAPM_AIF_OUT("DAIOUT", "Capture", 0, DA7219_DAI_TDM_CTRL,
963                              DA7219_DAI_OE_SHIFT, DA7219_NO_INVERT),
964         SND_SOC_DAPM_AIF_IN("DAIIN", "Playback", 0, SND_SOC_NOPM, 0, 0),
965 
966         /* Output Muxes */
967         SND_SOC_DAPM_MUX("Out DACL Mux", SND_SOC_NOPM, 0, 0,
968                          &da7219_out_dacl_sel_mux),
969         SND_SOC_DAPM_MUX("Out DACR Mux", SND_SOC_NOPM, 0, 0,
970                          &da7219_out_dacr_sel_mux),
971 
972         /* Output Mixers */
973         SND_SOC_DAPM_MIXER("Mixer Out FilterL", SND_SOC_NOPM, 0, 0,
974                            da7219_mixout_l_controls,
975                            ARRAY_SIZE(da7219_mixout_l_controls)),
976         SND_SOC_DAPM_MIXER("Mixer Out FilterR", SND_SOC_NOPM, 0, 0,
977                            da7219_mixout_r_controls,
978                            ARRAY_SIZE(da7219_mixout_r_controls)),
979 
980         /* Sidetone Mixers */
981         SND_SOC_DAPM_MIXER("ST Mixer Out FilterL", SND_SOC_NOPM, 0, 0,
982                            da7219_st_out_filtl_mix_controls,
983                            ARRAY_SIZE(da7219_st_out_filtl_mix_controls)),
984         SND_SOC_DAPM_MIXER("ST Mixer Out FilterR", SND_SOC_NOPM, 0,
985                            0, da7219_st_out_filtr_mix_controls,
986                            ARRAY_SIZE(da7219_st_out_filtr_mix_controls)),
987 
988         /* DACs */
989         SND_SOC_DAPM_DAC_E("DACL", NULL, DA7219_DAC_L_CTRL,
990                            DA7219_DAC_L_EN_SHIFT, DA7219_NO_INVERT,
991                            da7219_settling_event,
992                            SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
993         SND_SOC_DAPM_DAC_E("DACR", NULL, DA7219_DAC_R_CTRL,
994                            DA7219_DAC_R_EN_SHIFT, DA7219_NO_INVERT,
995                            da7219_settling_event,
996                            SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
997 
998         /* Output PGAs */
999         SND_SOC_DAPM_PGA_E("Mixout Left PGA", DA7219_MIXOUT_L_CTRL,
1000                            DA7219_MIXOUT_L_AMP_EN_SHIFT, DA7219_NO_INVERT,
1001                            NULL, 0, da7219_mixout_event,
1002                            SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1003         SND_SOC_DAPM_PGA_E("Mixout Right PGA", DA7219_MIXOUT_R_CTRL,
1004                            DA7219_MIXOUT_R_AMP_EN_SHIFT, DA7219_NO_INVERT,
1005                            NULL, 0, da7219_mixout_event,
1006                            SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1007         SND_SOC_DAPM_SUPPLY_S("Headphone Left PGA", 1, DA7219_HP_L_CTRL,
1008                               DA7219_HP_L_AMP_EN_SHIFT, DA7219_NO_INVERT,
1009                               da7219_settling_event,
1010                               SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1011         SND_SOC_DAPM_SUPPLY_S("Headphone Right PGA", 1, DA7219_HP_R_CTRL,
1012                               DA7219_HP_R_AMP_EN_SHIFT, DA7219_NO_INVERT,
1013                               da7219_settling_event,
1014                               SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1015 
1016         /* Output Supplies */
1017         SND_SOC_DAPM_SUPPLY_S("Charge Pump", 0, DA7219_CP_CTRL,
1018                               DA7219_CP_EN_SHIFT, DA7219_NO_INVERT,
1019                               da7219_settling_event,
1020                               SND_SOC_DAPM_POST_PMU),
1021 
1022         /* Outputs */
1023         SND_SOC_DAPM_OUTPUT("HPL"),
1024         SND_SOC_DAPM_OUTPUT("HPR"),
1025 
1026         /* Pre/Post Power */
1027         SND_SOC_DAPM_PRE("Pre Power Gain Ramp", da7219_gain_ramp_event),
1028         SND_SOC_DAPM_POST("Post Power Gain Ramp", da7219_gain_ramp_event),
1029 };
1030 
1031 
1032 /*
1033  * DAPM Mux Routes
1034  */
1035 
1036 #define DA7219_OUT_DAI_MUX_ROUTES(name)                 \
1037         {name, "ADC", "Mixer In"},                      \
1038         {name, "Tone Generator", "Tone Generator"},     \
1039         {name, "DAIL", "DAIOUT"},                       \
1040         {name, "DAIR", "DAIOUT"}
1041 
1042 #define DA7219_OUT_DAC_MUX_ROUTES(name)                 \
1043         {name, "ADC", "Mixer In"},                      \
1044         {name, "Tone Generator", "Tone Generator"},             \
1045         {name, "DAIL", "DAIIN"},                        \
1046         {name, "DAIR", "DAIIN"}
1047 
1048 /*
1049  * DAPM Mixer Routes
1050  */
1051 
1052 #define DA7219_DMIX_ST_ROUTES(name)                             \
1053         {name, "Out FilterL Switch", "Mixer Out FilterL"},      \
1054         {name, "Out FilterR Switch", "Mixer Out FilterR"},      \
1055         {name, "Sidetone Switch", "Sidetone Filter"}
1056 
1057 
1058 /*
1059  * DAPM audio route definition
1060  */
1061 
1062 static const struct snd_soc_dapm_route da7219_audio_map[] = {
1063         /* Input paths */
1064         {"MIC", NULL, "Mic Bias"},
1065         {"Mic PGA", NULL, "MIC"},
1066         {"Mixin PGA", NULL, "Mic PGA"},
1067         {"ADC", NULL, "Mixin PGA"},
1068 
1069         {"Mixer In", NULL, "Mixer In Supply"},
1070         {"Mixer In", "Mic Switch", "ADC"},
1071 
1072         {"Sidetone Filter", NULL, "Mixer In"},
1073 
1074         {"Tone Generator", NULL, "TONE"},
1075 
1076         DA7219_OUT_DAI_MUX_ROUTES("Out DAIL Mux"),
1077         DA7219_OUT_DAI_MUX_ROUTES("Out DAIR Mux"),
1078 
1079         {"DAIOUT", NULL, "Out DAIL Mux"},
1080         {"DAIOUT", NULL, "Out DAIR Mux"},
1081         {"DAIOUT", NULL, "DAI"},
1082 
1083         /* Output paths */
1084         {"DAIIN", NULL, "DAI"},
1085 
1086         DA7219_OUT_DAC_MUX_ROUTES("Out DACL Mux"),
1087         DA7219_OUT_DAC_MUX_ROUTES("Out DACR Mux"),
1088 
1089         {"Mixer Out FilterL", "DACL Switch", "Out DACL Mux"},
1090         {"Mixer Out FilterR", "DACR Switch", "Out DACR Mux"},
1091 
1092         DA7219_DMIX_ST_ROUTES("ST Mixer Out FilterL"),
1093         DA7219_DMIX_ST_ROUTES("ST Mixer Out FilterR"),
1094 
1095         {"DACL", NULL, "ST Mixer Out FilterL"},
1096         {"DACR", NULL, "ST Mixer Out FilterR"},
1097 
1098         {"Mixout Left PGA", NULL, "DACL"},
1099         {"Mixout Right PGA", NULL, "DACR"},
1100 
1101         {"HPL", NULL, "Mixout Left PGA"},
1102         {"HPR", NULL, "Mixout Right PGA"},
1103 
1104         {"HPL", NULL, "Headphone Left PGA"},
1105         {"HPR", NULL, "Headphone Right PGA"},
1106 
1107         {"HPL", NULL, "Charge Pump"},
1108         {"HPR", NULL, "Charge Pump"},
1109 };
1110 
1111 
1112 /*
1113  * DAI operations
1114  */
1115 
1116 static int da7219_set_dai_sysclk(struct snd_soc_dai *codec_dai,
1117                                  int clk_id, unsigned int freq, int dir)
1118 {
1119         struct snd_soc_codec *codec = codec_dai->codec;
1120         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1121         int ret = 0;
1122 
1123         if ((da7219->clk_src == clk_id) && (da7219->mclk_rate == freq))
1124                 return 0;
1125 
1126         if ((freq < 2000000) || (freq > 54000000)) {
1127                 dev_err(codec_dai->dev, "Unsupported MCLK value %d\n",
1128                         freq);
1129                 return -EINVAL;
1130         }
1131 
1132         mutex_lock(&da7219->pll_lock);
1133 
1134         switch (clk_id) {
1135         case DA7219_CLKSRC_MCLK_SQR:
1136                 snd_soc_update_bits(codec, DA7219_PLL_CTRL,
1137                                     DA7219_PLL_MCLK_SQR_EN_MASK,
1138                                     DA7219_PLL_MCLK_SQR_EN_MASK);
1139                 break;
1140         case DA7219_CLKSRC_MCLK:
1141                 snd_soc_update_bits(codec, DA7219_PLL_CTRL,
1142                                     DA7219_PLL_MCLK_SQR_EN_MASK, 0);
1143                 break;
1144         default:
1145                 dev_err(codec_dai->dev, "Unknown clock source %d\n", clk_id);
1146                 mutex_unlock(&da7219->pll_lock);
1147                 return -EINVAL;
1148         }
1149 
1150         da7219->clk_src = clk_id;
1151 
1152         if (da7219->mclk) {
1153                 freq = clk_round_rate(da7219->mclk, freq);
1154                 ret = clk_set_rate(da7219->mclk, freq);
1155                 if (ret) {
1156                         dev_err(codec_dai->dev, "Failed to set clock rate %d\n",
1157                                 freq);
1158                         mutex_unlock(&da7219->pll_lock);
1159                         return ret;
1160                 }
1161         }
1162 
1163         da7219->mclk_rate = freq;
1164 
1165         mutex_unlock(&da7219->pll_lock);
1166 
1167         return 0;
1168 }
1169 
1170 int da7219_set_pll(struct snd_soc_codec *codec, int source, unsigned int fout)
1171 {
1172         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1173 
1174         u8 pll_ctrl, indiv_bits, indiv;
1175         u8 pll_frac_top, pll_frac_bot, pll_integer;
1176         u32 freq_ref;
1177         u64 frac_div;
1178 
1179         /* Verify 2MHz - 54MHz MCLK provided, and set input divider */
1180         if (da7219->mclk_rate < 2000000) {
1181                 dev_err(codec->dev, "PLL input clock %d below valid range\n",
1182                         da7219->mclk_rate);
1183                 return -EINVAL;
1184         } else if (da7219->mclk_rate <= 4500000) {
1185                 indiv_bits = DA7219_PLL_INDIV_2_TO_4_5_MHZ;
1186                 indiv = DA7219_PLL_INDIV_2_TO_4_5_MHZ_VAL;
1187         } else if (da7219->mclk_rate <= 9000000) {
1188                 indiv_bits = DA7219_PLL_INDIV_4_5_TO_9_MHZ;
1189                 indiv = DA7219_PLL_INDIV_4_5_TO_9_MHZ_VAL;
1190         } else if (da7219->mclk_rate <= 18000000) {
1191                 indiv_bits = DA7219_PLL_INDIV_9_TO_18_MHZ;
1192                 indiv = DA7219_PLL_INDIV_9_TO_18_MHZ_VAL;
1193         } else if (da7219->mclk_rate <= 36000000) {
1194                 indiv_bits = DA7219_PLL_INDIV_18_TO_36_MHZ;
1195                 indiv = DA7219_PLL_INDIV_18_TO_36_MHZ_VAL;
1196         } else if (da7219->mclk_rate <= 54000000) {
1197                 indiv_bits = DA7219_PLL_INDIV_36_TO_54_MHZ;
1198                 indiv = DA7219_PLL_INDIV_36_TO_54_MHZ_VAL;
1199         } else {
1200                 dev_err(codec->dev, "PLL input clock %d above valid range\n",
1201                         da7219->mclk_rate);
1202                 return -EINVAL;
1203         }
1204         freq_ref = (da7219->mclk_rate / indiv);
1205         pll_ctrl = indiv_bits;
1206 
1207         /* Configure PLL */
1208         switch (source) {
1209         case DA7219_SYSCLK_MCLK:
1210                 pll_ctrl |= DA7219_PLL_MODE_BYPASS;
1211                 snd_soc_update_bits(codec, DA7219_PLL_CTRL,
1212                                     DA7219_PLL_INDIV_MASK |
1213                                     DA7219_PLL_MODE_MASK, pll_ctrl);
1214                 return 0;
1215         case DA7219_SYSCLK_PLL:
1216                 pll_ctrl |= DA7219_PLL_MODE_NORMAL;
1217                 break;
1218         case DA7219_SYSCLK_PLL_SRM:
1219                 pll_ctrl |= DA7219_PLL_MODE_SRM;
1220                 break;
1221         default:
1222                 dev_err(codec->dev, "Invalid PLL config\n");
1223                 return -EINVAL;
1224         }
1225 
1226         /* Calculate dividers for PLL */
1227         pll_integer = fout / freq_ref;
1228         frac_div = (u64)(fout % freq_ref) * 8192ULL;
1229         do_div(frac_div, freq_ref);
1230         pll_frac_top = (frac_div >> DA7219_BYTE_SHIFT) & DA7219_BYTE_MASK;
1231         pll_frac_bot = (frac_div) & DA7219_BYTE_MASK;
1232 
1233         /* Write PLL config & dividers */
1234         snd_soc_write(codec, DA7219_PLL_FRAC_TOP, pll_frac_top);
1235         snd_soc_write(codec, DA7219_PLL_FRAC_BOT, pll_frac_bot);
1236         snd_soc_write(codec, DA7219_PLL_INTEGER, pll_integer);
1237         snd_soc_update_bits(codec, DA7219_PLL_CTRL,
1238                             DA7219_PLL_INDIV_MASK | DA7219_PLL_MODE_MASK,
1239                             pll_ctrl);
1240 
1241         return 0;
1242 }
1243 
1244 static int da7219_set_dai_pll(struct snd_soc_dai *codec_dai, int pll_id,
1245                               int source, unsigned int fref, unsigned int fout)
1246 {
1247         struct snd_soc_codec *codec = codec_dai->codec;
1248         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1249         int ret;
1250 
1251         mutex_lock(&da7219->pll_lock);
1252         ret = da7219_set_pll(codec, source, fout);
1253         mutex_unlock(&da7219->pll_lock);
1254 
1255         return ret;
1256 }
1257 
1258 static int da7219_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
1259 {
1260         struct snd_soc_codec *codec = codec_dai->codec;
1261         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1262         u8 dai_clk_mode = 0, dai_ctrl = 0;
1263 
1264         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1265         case SND_SOC_DAIFMT_CBM_CFM:
1266                 da7219->master = true;
1267                 break;
1268         case SND_SOC_DAIFMT_CBS_CFS:
1269                 da7219->master = false;
1270                 break;
1271         default:
1272                 return -EINVAL;
1273         }
1274 
1275         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1276         case SND_SOC_DAIFMT_I2S:
1277         case SND_SOC_DAIFMT_LEFT_J:
1278         case SND_SOC_DAIFMT_RIGHT_J:
1279                 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1280                 case SND_SOC_DAIFMT_NB_NF:
1281                         break;
1282                 case SND_SOC_DAIFMT_NB_IF:
1283                         dai_clk_mode |= DA7219_DAI_WCLK_POL_INV;
1284                         break;
1285                 case SND_SOC_DAIFMT_IB_NF:
1286                         dai_clk_mode |= DA7219_DAI_CLK_POL_INV;
1287                         break;
1288                 case SND_SOC_DAIFMT_IB_IF:
1289                         dai_clk_mode |= DA7219_DAI_WCLK_POL_INV |
1290                                         DA7219_DAI_CLK_POL_INV;
1291                         break;
1292                 default:
1293                         return -EINVAL;
1294                 }
1295                 break;
1296         case SND_SOC_DAIFMT_DSP_B:
1297                 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1298                 case SND_SOC_DAIFMT_NB_NF:
1299                         dai_clk_mode |= DA7219_DAI_CLK_POL_INV;
1300                         break;
1301                 case SND_SOC_DAIFMT_NB_IF:
1302                         dai_clk_mode |= DA7219_DAI_WCLK_POL_INV |
1303                                         DA7219_DAI_CLK_POL_INV;
1304                         break;
1305                 case SND_SOC_DAIFMT_IB_NF:
1306                         break;
1307                 case SND_SOC_DAIFMT_IB_IF:
1308                         dai_clk_mode |= DA7219_DAI_WCLK_POL_INV;
1309                         break;
1310                 default:
1311                         return -EINVAL;
1312                 }
1313                 break;
1314         default:
1315                 return -EINVAL;
1316         }
1317 
1318         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1319         case SND_SOC_DAIFMT_I2S:
1320                 dai_ctrl |= DA7219_DAI_FORMAT_I2S;
1321                 break;
1322         case SND_SOC_DAIFMT_LEFT_J:
1323                 dai_ctrl |= DA7219_DAI_FORMAT_LEFT_J;
1324                 break;
1325         case SND_SOC_DAIFMT_RIGHT_J:
1326                 dai_ctrl |= DA7219_DAI_FORMAT_RIGHT_J;
1327                 break;
1328         case SND_SOC_DAIFMT_DSP_B:
1329                 dai_ctrl |= DA7219_DAI_FORMAT_DSP;
1330                 break;
1331         default:
1332                 return -EINVAL;
1333         }
1334 
1335         /* By default 64 BCLKs per WCLK is supported */
1336         dai_clk_mode |= DA7219_DAI_BCLKS_PER_WCLK_64;
1337 
1338         snd_soc_update_bits(codec, DA7219_DAI_CLK_MODE,
1339                             DA7219_DAI_BCLKS_PER_WCLK_MASK |
1340                             DA7219_DAI_CLK_POL_MASK | DA7219_DAI_WCLK_POL_MASK,
1341                             dai_clk_mode);
1342         snd_soc_update_bits(codec, DA7219_DAI_CTRL, DA7219_DAI_FORMAT_MASK,
1343                             dai_ctrl);
1344 
1345         return 0;
1346 }
1347 
1348 static int da7219_set_dai_tdm_slot(struct snd_soc_dai *dai,
1349                                    unsigned int tx_mask, unsigned int rx_mask,
1350                                    int slots, int slot_width)
1351 {
1352         struct snd_soc_codec *codec = dai->codec;
1353         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1354         u8 dai_bclks_per_wclk;
1355         u16 offset;
1356         u32 frame_size;
1357 
1358         /* No channels enabled so disable TDM, revert to 64-bit frames */
1359         if (!tx_mask) {
1360                 snd_soc_update_bits(codec, DA7219_DAI_TDM_CTRL,
1361                                     DA7219_DAI_TDM_CH_EN_MASK |
1362                                     DA7219_DAI_TDM_MODE_EN_MASK, 0);
1363                 snd_soc_update_bits(codec, DA7219_DAI_CLK_MODE,
1364                                     DA7219_DAI_BCLKS_PER_WCLK_MASK,
1365                                     DA7219_DAI_BCLKS_PER_WCLK_64);
1366                 return 0;
1367         }
1368 
1369         /* Check we have valid slots */
1370         if (fls(tx_mask) > DA7219_DAI_TDM_MAX_SLOTS) {
1371                 dev_err(codec->dev, "Invalid number of slots, max = %d\n",
1372                         DA7219_DAI_TDM_MAX_SLOTS);
1373                 return -EINVAL;
1374         }
1375 
1376         /* Check we have a valid offset given */
1377         if (rx_mask > DA7219_DAI_OFFSET_MAX) {
1378                 dev_err(codec->dev, "Invalid slot offset, max = %d\n",
1379                         DA7219_DAI_OFFSET_MAX);
1380                 return -EINVAL;
1381         }
1382 
1383         /* Calculate & validate frame size based on slot info provided. */
1384         frame_size = slots * slot_width;
1385         switch (frame_size) {
1386         case 32:
1387                 dai_bclks_per_wclk = DA7219_DAI_BCLKS_PER_WCLK_32;
1388                 break;
1389         case 64:
1390                 dai_bclks_per_wclk = DA7219_DAI_BCLKS_PER_WCLK_64;
1391                 break;
1392         case 128:
1393                 dai_bclks_per_wclk = DA7219_DAI_BCLKS_PER_WCLK_128;
1394                 break;
1395         case 256:
1396                 dai_bclks_per_wclk = DA7219_DAI_BCLKS_PER_WCLK_256;
1397                 break;
1398         default:
1399                 dev_err(codec->dev, "Invalid frame size %d\n", frame_size);
1400                 return -EINVAL;
1401         }
1402 
1403         snd_soc_update_bits(codec, DA7219_DAI_CLK_MODE,
1404                             DA7219_DAI_BCLKS_PER_WCLK_MASK,
1405                             dai_bclks_per_wclk);
1406 
1407         offset = cpu_to_le16(rx_mask);
1408         regmap_bulk_write(da7219->regmap, DA7219_DAI_OFFSET_LOWER,
1409                           &offset, sizeof(offset));
1410 
1411         snd_soc_update_bits(codec, DA7219_DAI_TDM_CTRL,
1412                             DA7219_DAI_TDM_CH_EN_MASK |
1413                             DA7219_DAI_TDM_MODE_EN_MASK,
1414                             (tx_mask << DA7219_DAI_TDM_CH_EN_SHIFT) |
1415                             DA7219_DAI_TDM_MODE_EN_MASK);
1416 
1417         return 0;
1418 }
1419 
1420 static int da7219_hw_params(struct snd_pcm_substream *substream,
1421                             struct snd_pcm_hw_params *params,
1422                             struct snd_soc_dai *dai)
1423 {
1424         struct snd_soc_codec *codec = dai->codec;
1425         u8 dai_ctrl = 0, fs;
1426         unsigned int channels;
1427 
1428         switch (params_width(params)) {
1429         case 16:
1430                 dai_ctrl |= DA7219_DAI_WORD_LENGTH_S16_LE;
1431                 break;
1432         case 20:
1433                 dai_ctrl |= DA7219_DAI_WORD_LENGTH_S20_LE;
1434                 break;
1435         case 24:
1436                 dai_ctrl |= DA7219_DAI_WORD_LENGTH_S24_LE;
1437                 break;
1438         case 32:
1439                 dai_ctrl |= DA7219_DAI_WORD_LENGTH_S32_LE;
1440                 break;
1441         default:
1442                 return -EINVAL;
1443         }
1444 
1445         channels = params_channels(params);
1446         if ((channels < 1) || (channels > DA7219_DAI_CH_NUM_MAX)) {
1447                 dev_err(codec->dev,
1448                         "Invalid number of channels, only 1 to %d supported\n",
1449                         DA7219_DAI_CH_NUM_MAX);
1450                 return -EINVAL;
1451         }
1452         dai_ctrl |= channels << DA7219_DAI_CH_NUM_SHIFT;
1453 
1454         switch (params_rate(params)) {
1455         case 8000:
1456                 fs = DA7219_SR_8000;
1457                 break;
1458         case 11025:
1459                 fs = DA7219_SR_11025;
1460                 break;
1461         case 12000:
1462                 fs = DA7219_SR_12000;
1463                 break;
1464         case 16000:
1465                 fs = DA7219_SR_16000;
1466                 break;
1467         case 22050:
1468                 fs = DA7219_SR_22050;
1469                 break;
1470         case 24000:
1471                 fs = DA7219_SR_24000;
1472                 break;
1473         case 32000:
1474                 fs = DA7219_SR_32000;
1475                 break;
1476         case 44100:
1477                 fs = DA7219_SR_44100;
1478                 break;
1479         case 48000:
1480                 fs = DA7219_SR_48000;
1481                 break;
1482         case 88200:
1483                 fs = DA7219_SR_88200;
1484                 break;
1485         case 96000:
1486                 fs = DA7219_SR_96000;
1487                 break;
1488         default:
1489                 return -EINVAL;
1490         }
1491 
1492         snd_soc_update_bits(codec, DA7219_DAI_CTRL,
1493                             DA7219_DAI_WORD_LENGTH_MASK |
1494                             DA7219_DAI_CH_NUM_MASK,
1495                             dai_ctrl);
1496         snd_soc_write(codec, DA7219_SR, fs);
1497 
1498         return 0;
1499 }
1500 
1501 static const struct snd_soc_dai_ops da7219_dai_ops = {
1502         .hw_params      = da7219_hw_params,
1503         .set_sysclk     = da7219_set_dai_sysclk,
1504         .set_pll        = da7219_set_dai_pll,
1505         .set_fmt        = da7219_set_dai_fmt,
1506         .set_tdm_slot   = da7219_set_dai_tdm_slot,
1507 };
1508 
1509 #define DA7219_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
1510                         SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE)
1511 
1512 static struct snd_soc_dai_driver da7219_dai = {
1513         .name = "da7219-hifi",
1514         .playback = {
1515                 .stream_name = "Playback",
1516                 .channels_min = 1,
1517                 .channels_max = DA7219_DAI_CH_NUM_MAX,
1518                 .rates = SNDRV_PCM_RATE_8000_96000,
1519                 .formats = DA7219_FORMATS,
1520         },
1521         .capture = {
1522                 .stream_name = "Capture",
1523                 .channels_min = 1,
1524                 .channels_max = DA7219_DAI_CH_NUM_MAX,
1525                 .rates = SNDRV_PCM_RATE_8000_96000,
1526                 .formats = DA7219_FORMATS,
1527         },
1528         .ops = &da7219_dai_ops,
1529         .symmetric_rates = 1,
1530         .symmetric_channels = 1,
1531         .symmetric_samplebits = 1,
1532 };
1533 
1534 
1535 /*
1536  * DT/ACPI
1537  */
1538 
1539 static const struct of_device_id da7219_of_match[] = {
1540         { .compatible = "dlg,da7219", },
1541         { }
1542 };
1543 MODULE_DEVICE_TABLE(of, da7219_of_match);
1544 
1545 static const struct acpi_device_id da7219_acpi_match[] = {
1546         { .id = "DLGS7219", },
1547         { }
1548 };
1549 MODULE_DEVICE_TABLE(acpi, da7219_acpi_match);
1550 
1551 static enum da7219_micbias_voltage
1552         da7219_fw_micbias_lvl(struct device *dev, u32 val)
1553 {
1554         switch (val) {
1555         case 1600:
1556                 return DA7219_MICBIAS_1_6V;
1557         case 1800:
1558                 return DA7219_MICBIAS_1_8V;
1559         case 2000:
1560                 return DA7219_MICBIAS_2_0V;
1561         case 2200:
1562                 return DA7219_MICBIAS_2_2V;
1563         case 2400:
1564                 return DA7219_MICBIAS_2_4V;
1565         case 2600:
1566                 return DA7219_MICBIAS_2_6V;
1567         default:
1568                 dev_warn(dev, "Invalid micbias level");
1569                 return DA7219_MICBIAS_2_2V;
1570         }
1571 }
1572 
1573 static enum da7219_mic_amp_in_sel
1574         da7219_fw_mic_amp_in_sel(struct device *dev, const char *str)
1575 {
1576         if (!strcmp(str, "diff")) {
1577                 return DA7219_MIC_AMP_IN_SEL_DIFF;
1578         } else if (!strcmp(str, "se_p")) {
1579                 return DA7219_MIC_AMP_IN_SEL_SE_P;
1580         } else if (!strcmp(str, "se_n")) {
1581                 return DA7219_MIC_AMP_IN_SEL_SE_N;
1582         } else {
1583                 dev_warn(dev, "Invalid mic input type selection");
1584                 return DA7219_MIC_AMP_IN_SEL_DIFF;
1585         }
1586 }
1587 
1588 static struct da7219_pdata *da7219_fw_to_pdata(struct snd_soc_codec *codec)
1589 {
1590         struct device *dev = codec->dev;
1591         struct da7219_pdata *pdata;
1592         const char *of_str;
1593         u32 of_val32;
1594 
1595         pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
1596         if (!pdata)
1597                 return NULL;
1598 
1599         pdata->wakeup_source = device_property_read_bool(dev, "wakeup-source");
1600 
1601         if (device_property_read_u32(dev, "dlg,micbias-lvl", &of_val32) >= 0)
1602                 pdata->micbias_lvl = da7219_fw_micbias_lvl(dev, of_val32);
1603         else
1604                 pdata->micbias_lvl = DA7219_MICBIAS_2_2V;
1605 
1606         if (!device_property_read_string(dev, "dlg,mic-amp-in-sel", &of_str))
1607                 pdata->mic_amp_in_sel = da7219_fw_mic_amp_in_sel(dev, of_str);
1608         else
1609                 pdata->mic_amp_in_sel = DA7219_MIC_AMP_IN_SEL_DIFF;
1610 
1611         return pdata;
1612 }
1613 
1614 
1615 /*
1616  * Codec driver functions
1617  */
1618 
1619 static int da7219_set_bias_level(struct snd_soc_codec *codec,
1620                                  enum snd_soc_bias_level level)
1621 {
1622         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1623         int ret;
1624 
1625         switch (level) {
1626         case SND_SOC_BIAS_ON:
1627                 break;
1628         case SND_SOC_BIAS_PREPARE:
1629                 /* Enable MCLK for transition to ON state */
1630                 if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_STANDBY) {
1631                         if (da7219->mclk) {
1632                                 ret = clk_prepare_enable(da7219->mclk);
1633                                 if (ret) {
1634                                         dev_err(codec->dev,
1635                                                 "Failed to enable mclk\n");
1636                                         return ret;
1637                                 }
1638                         }
1639                 }
1640 
1641                 break;
1642         case SND_SOC_BIAS_STANDBY:
1643                 if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_OFF)
1644                         /* Master bias */
1645                         snd_soc_update_bits(codec, DA7219_REFERENCES,
1646                                             DA7219_BIAS_EN_MASK,
1647                                             DA7219_BIAS_EN_MASK);
1648 
1649                 if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_PREPARE) {
1650                         /* Remove MCLK */
1651                         if (da7219->mclk)
1652                                 clk_disable_unprepare(da7219->mclk);
1653                 }
1654                 break;
1655         case SND_SOC_BIAS_OFF:
1656                 /* Only disable master bias if we're not a wake-up source */
1657                 if (!da7219->wakeup_source)
1658                         snd_soc_update_bits(codec, DA7219_REFERENCES,
1659                                             DA7219_BIAS_EN_MASK, 0);
1660 
1661                 break;
1662         }
1663 
1664         return 0;
1665 }
1666 
1667 static const char *da7219_supply_names[DA7219_NUM_SUPPLIES] = {
1668         [DA7219_SUPPLY_VDD] = "VDD",
1669         [DA7219_SUPPLY_VDDMIC] = "VDDMIC",
1670         [DA7219_SUPPLY_VDDIO] = "VDDIO",
1671 };
1672 
1673 static int da7219_handle_supplies(struct snd_soc_codec *codec)
1674 {
1675         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1676         struct regulator *vddio;
1677         u8 io_voltage_lvl = DA7219_IO_VOLTAGE_LEVEL_2_5V_3_6V;
1678         int i, ret;
1679 
1680         /* Get required supplies */
1681         for (i = 0; i < DA7219_NUM_SUPPLIES; ++i)
1682                 da7219->supplies[i].supply = da7219_supply_names[i];
1683 
1684         ret = devm_regulator_bulk_get(codec->dev, DA7219_NUM_SUPPLIES,
1685                                       da7219->supplies);
1686         if (ret) {
1687                 dev_err(codec->dev, "Failed to get supplies");
1688                 return ret;
1689         }
1690 
1691         /* Determine VDDIO voltage provided */
1692         vddio = da7219->supplies[DA7219_SUPPLY_VDDIO].consumer;
1693         ret = regulator_get_voltage(vddio);
1694         if (ret < 1200000)
1695                 dev_warn(codec->dev, "Invalid VDDIO voltage\n");
1696         else if (ret < 2800000)
1697                 io_voltage_lvl = DA7219_IO_VOLTAGE_LEVEL_1_2V_2_8V;
1698 
1699         /* Enable main supplies */
1700         ret = regulator_bulk_enable(DA7219_NUM_SUPPLIES, da7219->supplies);
1701         if (ret) {
1702                 dev_err(codec->dev, "Failed to enable supplies");
1703                 return ret;
1704         }
1705 
1706         /* Ensure device in active mode */
1707         snd_soc_write(codec, DA7219_SYSTEM_ACTIVE, DA7219_SYSTEM_ACTIVE_MASK);
1708 
1709         /* Update IO voltage level range */
1710         snd_soc_write(codec, DA7219_IO_CTRL, io_voltage_lvl);
1711 
1712         return 0;
1713 }
1714 
1715 static void da7219_handle_pdata(struct snd_soc_codec *codec)
1716 {
1717         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1718         struct da7219_pdata *pdata = da7219->pdata;
1719 
1720         if (pdata) {
1721                 u8 micbias_lvl = 0;
1722 
1723                 da7219->wakeup_source = pdata->wakeup_source;
1724 
1725                 /* Mic Bias voltages */
1726                 switch (pdata->micbias_lvl) {
1727                 case DA7219_MICBIAS_1_6V:
1728                 case DA7219_MICBIAS_1_8V:
1729                 case DA7219_MICBIAS_2_0V:
1730                 case DA7219_MICBIAS_2_2V:
1731                 case DA7219_MICBIAS_2_4V:
1732                 case DA7219_MICBIAS_2_6V:
1733                         micbias_lvl |= (pdata->micbias_lvl <<
1734                                         DA7219_MICBIAS1_LEVEL_SHIFT);
1735                         break;
1736                 }
1737 
1738                 snd_soc_write(codec, DA7219_MICBIAS_CTRL, micbias_lvl);
1739 
1740                 /* Mic */
1741                 switch (pdata->mic_amp_in_sel) {
1742                 case DA7219_MIC_AMP_IN_SEL_DIFF:
1743                 case DA7219_MIC_AMP_IN_SEL_SE_P:
1744                 case DA7219_MIC_AMP_IN_SEL_SE_N:
1745                         snd_soc_write(codec, DA7219_MIC_1_SELECT,
1746                                       pdata->mic_amp_in_sel);
1747                         break;
1748                 }
1749         }
1750 }
1751 
1752 static struct reg_sequence da7219_rev_aa_patch[] = {
1753         { DA7219_REFERENCES, 0x08 },
1754 };
1755 
1756 static int da7219_probe(struct snd_soc_codec *codec)
1757 {
1758         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1759         unsigned int rev;
1760         int ret;
1761 
1762         mutex_init(&da7219->ctrl_lock);
1763         mutex_init(&da7219->pll_lock);
1764 
1765         /* Regulator configuration */
1766         ret = da7219_handle_supplies(codec);
1767         if (ret)
1768                 return ret;
1769 
1770         ret = regmap_read(da7219->regmap, DA7219_CHIP_REVISION, &rev);
1771         if (ret) {
1772                 dev_err(codec->dev, "Failed to read chip revision: %d\n", ret);
1773                 goto err_disable_reg;
1774         }
1775 
1776         switch (rev & DA7219_CHIP_MINOR_MASK) {
1777         case 0:
1778                 ret = regmap_register_patch(da7219->regmap, da7219_rev_aa_patch,
1779                                             ARRAY_SIZE(da7219_rev_aa_patch));
1780                 if (ret) {
1781                         dev_err(codec->dev, "Failed to register AA patch: %d\n",
1782                                 ret);
1783                         goto err_disable_reg;
1784                 }
1785                 break;
1786         default:
1787                 break;
1788         }
1789 
1790         /* Handle DT/ACPI/Platform data */
1791         da7219->pdata = dev_get_platdata(codec->dev);
1792         if (!da7219->pdata)
1793                 da7219->pdata = da7219_fw_to_pdata(codec);
1794 
1795         da7219_handle_pdata(codec);
1796 
1797         /* Check if MCLK provided */
1798         da7219->mclk = devm_clk_get(codec->dev, "mclk");
1799         if (IS_ERR(da7219->mclk)) {
1800                 if (PTR_ERR(da7219->mclk) != -ENOENT) {
1801                         ret = PTR_ERR(da7219->mclk);
1802                         goto err_disable_reg;
1803                 } else {
1804                         da7219->mclk = NULL;
1805                 }
1806         }
1807 
1808         /* Default PC counter to free-running */
1809         snd_soc_update_bits(codec, DA7219_PC_COUNT, DA7219_PC_FREERUN_MASK,
1810                             DA7219_PC_FREERUN_MASK);
1811 
1812         /* Default gain ramping */
1813         snd_soc_update_bits(codec, DA7219_MIXIN_L_CTRL,
1814                             DA7219_MIXIN_L_AMP_RAMP_EN_MASK,
1815                             DA7219_MIXIN_L_AMP_RAMP_EN_MASK);
1816         snd_soc_update_bits(codec, DA7219_ADC_L_CTRL, DA7219_ADC_L_RAMP_EN_MASK,
1817                             DA7219_ADC_L_RAMP_EN_MASK);
1818         snd_soc_update_bits(codec, DA7219_DAC_L_CTRL, DA7219_DAC_L_RAMP_EN_MASK,
1819                             DA7219_DAC_L_RAMP_EN_MASK);
1820         snd_soc_update_bits(codec, DA7219_DAC_R_CTRL, DA7219_DAC_R_RAMP_EN_MASK,
1821                             DA7219_DAC_R_RAMP_EN_MASK);
1822         snd_soc_update_bits(codec, DA7219_HP_L_CTRL,
1823                             DA7219_HP_L_AMP_RAMP_EN_MASK,
1824                             DA7219_HP_L_AMP_RAMP_EN_MASK);
1825         snd_soc_update_bits(codec, DA7219_HP_R_CTRL,
1826                             DA7219_HP_R_AMP_RAMP_EN_MASK,
1827                             DA7219_HP_R_AMP_RAMP_EN_MASK);
1828 
1829         /* Default minimum gain on HP to avoid pops during DAPM sequencing */
1830         snd_soc_update_bits(codec, DA7219_HP_L_CTRL,
1831                             DA7219_HP_L_AMP_MIN_GAIN_EN_MASK,
1832                             DA7219_HP_L_AMP_MIN_GAIN_EN_MASK);
1833         snd_soc_update_bits(codec, DA7219_HP_R_CTRL,
1834                             DA7219_HP_R_AMP_MIN_GAIN_EN_MASK,
1835                             DA7219_HP_R_AMP_MIN_GAIN_EN_MASK);
1836 
1837         /* Default infinite tone gen, start/stop by Kcontrol */
1838         snd_soc_write(codec, DA7219_TONE_GEN_CYCLES, DA7219_BEEP_CYCLES_MASK);
1839 
1840         /* Initialise AAD block */
1841         ret = da7219_aad_init(codec);
1842         if (ret)
1843                 goto err_disable_reg;
1844 
1845         return 0;
1846 
1847 err_disable_reg:
1848         regulator_bulk_disable(DA7219_NUM_SUPPLIES, da7219->supplies);
1849 
1850         return ret;
1851 }
1852 
1853 static int da7219_remove(struct snd_soc_codec *codec)
1854 {
1855         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1856 
1857         da7219_aad_exit(codec);
1858 
1859         /* Supplies */
1860         return regulator_bulk_disable(DA7219_NUM_SUPPLIES, da7219->supplies);
1861 }
1862 
1863 #ifdef CONFIG_PM
1864 static int da7219_suspend(struct snd_soc_codec *codec)
1865 {
1866         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1867 
1868         /* Suspend AAD if we're not a wake-up source */
1869         if (!da7219->wakeup_source)
1870                 da7219_aad_suspend(codec);
1871 
1872         snd_soc_codec_force_bias_level(codec, SND_SOC_BIAS_OFF);
1873 
1874         return 0;
1875 }
1876 
1877 static int da7219_resume(struct snd_soc_codec *codec)
1878 {
1879         struct da7219_priv *da7219 = snd_soc_codec_get_drvdata(codec);
1880 
1881         snd_soc_codec_force_bias_level(codec, SND_SOC_BIAS_STANDBY);
1882 
1883         /* Resume AAD if previously suspended */
1884         if (!da7219->wakeup_source)
1885                 da7219_aad_resume(codec);
1886 
1887         return 0;
1888 }
1889 #else
1890 #define da7219_suspend NULL
1891 #define da7219_resume NULL
1892 #endif
1893 
1894 static struct snd_soc_codec_driver soc_codec_dev_da7219 = {
1895         .probe                  = da7219_probe,
1896         .remove                 = da7219_remove,
1897         .suspend                = da7219_suspend,
1898         .resume                 = da7219_resume,
1899         .set_bias_level         = da7219_set_bias_level,
1900 
1901         .component_driver = {
1902                 .controls               = da7219_snd_controls,
1903                 .num_controls           = ARRAY_SIZE(da7219_snd_controls),
1904                 .dapm_widgets           = da7219_dapm_widgets,
1905                 .num_dapm_widgets       = ARRAY_SIZE(da7219_dapm_widgets),
1906                 .dapm_routes            = da7219_audio_map,
1907                 .num_dapm_routes        = ARRAY_SIZE(da7219_audio_map),
1908         },
1909 };
1910 
1911 
1912 /*
1913  * Regmap configs
1914  */
1915 
1916 static struct reg_default da7219_reg_defaults[] = {
1917         { DA7219_MIC_1_SELECT, 0x00 },
1918         { DA7219_CIF_TIMEOUT_CTRL, 0x01 },
1919         { DA7219_SR_24_48, 0x00 },
1920         { DA7219_SR, 0x0A },
1921         { DA7219_CIF_I2C_ADDR_CFG, 0x02 },
1922         { DA7219_PLL_CTRL, 0x10 },
1923         { DA7219_PLL_FRAC_TOP, 0x00 },
1924         { DA7219_PLL_FRAC_BOT, 0x00 },
1925         { DA7219_PLL_INTEGER, 0x20 },
1926         { DA7219_DIG_ROUTING_DAI, 0x10 },
1927         { DA7219_DAI_CLK_MODE, 0x01 },
1928         { DA7219_DAI_CTRL, 0x28 },
1929         { DA7219_DAI_TDM_CTRL, 0x40 },
1930         { DA7219_DIG_ROUTING_DAC, 0x32 },
1931         { DA7219_DAI_OFFSET_LOWER, 0x00 },
1932         { DA7219_DAI_OFFSET_UPPER, 0x00 },
1933         { DA7219_REFERENCES, 0x08 },
1934         { DA7219_MIXIN_L_SELECT, 0x00 },
1935         { DA7219_MIXIN_L_GAIN, 0x03 },
1936         { DA7219_ADC_L_GAIN, 0x6F },
1937         { DA7219_ADC_FILTERS1, 0x80 },
1938         { DA7219_MIC_1_GAIN, 0x01 },
1939         { DA7219_SIDETONE_CTRL, 0x40 },
1940         { DA7219_SIDETONE_GAIN, 0x0E },
1941         { DA7219_DROUTING_ST_OUTFILT_1L, 0x01 },
1942         { DA7219_DROUTING_ST_OUTFILT_1R, 0x02 },
1943         { DA7219_DAC_FILTERS5, 0x00 },
1944         { DA7219_DAC_FILTERS2, 0x88 },
1945         { DA7219_DAC_FILTERS3, 0x88 },
1946         { DA7219_DAC_FILTERS4, 0x08 },
1947         { DA7219_DAC_FILTERS1, 0x80 },
1948         { DA7219_DAC_L_GAIN, 0x6F },
1949         { DA7219_DAC_R_GAIN, 0x6F },
1950         { DA7219_CP_CTRL, 0x20 },
1951         { DA7219_HP_L_GAIN, 0x39 },
1952         { DA7219_HP_R_GAIN, 0x39 },
1953         { DA7219_MIXOUT_L_SELECT, 0x00 },
1954         { DA7219_MIXOUT_R_SELECT, 0x00 },
1955         { DA7219_MICBIAS_CTRL, 0x03 },
1956         { DA7219_MIC_1_CTRL, 0x40 },
1957         { DA7219_MIXIN_L_CTRL, 0x40 },
1958         { DA7219_ADC_L_CTRL, 0x40 },
1959         { DA7219_DAC_L_CTRL, 0x40 },
1960         { DA7219_DAC_R_CTRL, 0x40 },
1961         { DA7219_HP_L_CTRL, 0x40 },
1962         { DA7219_HP_R_CTRL, 0x40 },
1963         { DA7219_MIXOUT_L_CTRL, 0x10 },
1964         { DA7219_MIXOUT_R_CTRL, 0x10 },
1965         { DA7219_CHIP_ID1, 0x23 },
1966         { DA7219_CHIP_ID2, 0x93 },
1967         { DA7219_IO_CTRL, 0x00 },
1968         { DA7219_GAIN_RAMP_CTRL, 0x00 },
1969         { DA7219_PC_COUNT, 0x02 },
1970         { DA7219_CP_VOL_THRESHOLD1, 0x0E },
1971         { DA7219_DIG_CTRL, 0x00 },
1972         { DA7219_ALC_CTRL2, 0x00 },
1973         { DA7219_ALC_CTRL3, 0x00 },
1974         { DA7219_ALC_NOISE, 0x3F },
1975         { DA7219_ALC_TARGET_MIN, 0x3F },
1976         { DA7219_ALC_TARGET_MAX, 0x00 },
1977         { DA7219_ALC_GAIN_LIMITS, 0xFF },
1978         { DA7219_ALC_ANA_GAIN_LIMITS, 0x71 },
1979         { DA7219_ALC_ANTICLIP_CTRL, 0x00 },
1980         { DA7219_ALC_ANTICLIP_LEVEL, 0x00 },
1981         { DA7219_DAC_NG_SETUP_TIME, 0x00 },
1982         { DA7219_DAC_NG_OFF_THRESH, 0x00 },
1983         { DA7219_DAC_NG_ON_THRESH, 0x00 },
1984         { DA7219_DAC_NG_CTRL, 0x00 },
1985         { DA7219_TONE_GEN_CFG1, 0x00 },
1986         { DA7219_TONE_GEN_CFG2, 0x00 },
1987         { DA7219_TONE_GEN_CYCLES, 0x00 },
1988         { DA7219_TONE_GEN_FREQ1_L, 0x55 },
1989         { DA7219_TONE_GEN_FREQ1_U, 0x15 },
1990         { DA7219_TONE_GEN_FREQ2_L, 0x00 },
1991         { DA7219_TONE_GEN_FREQ2_U, 0x40 },
1992         { DA7219_TONE_GEN_ON_PER, 0x02 },
1993         { DA7219_TONE_GEN_OFF_PER, 0x01 },
1994         { DA7219_ACCDET_IRQ_MASK_A, 0x00 },
1995         { DA7219_ACCDET_IRQ_MASK_B, 0x00 },
1996         { DA7219_ACCDET_CONFIG_1, 0xD6 },
1997         { DA7219_ACCDET_CONFIG_2, 0x34 },
1998         { DA7219_ACCDET_CONFIG_3, 0x0A },
1999         { DA7219_ACCDET_CONFIG_4, 0x16 },
2000         { DA7219_ACCDET_CONFIG_5, 0x21 },
2001         { DA7219_ACCDET_CONFIG_6, 0x3E },
2002         { DA7219_ACCDET_CONFIG_7, 0x01 },
2003         { DA7219_SYSTEM_ACTIVE, 0x00 },
2004 };
2005 
2006 static bool da7219_volatile_register(struct device *dev, unsigned int reg)
2007 {
2008         switch (reg) {
2009         case DA7219_MIC_1_GAIN_STATUS:
2010         case DA7219_MIXIN_L_GAIN_STATUS:
2011         case DA7219_ADC_L_GAIN_STATUS:
2012         case DA7219_DAC_L_GAIN_STATUS:
2013         case DA7219_DAC_R_GAIN_STATUS:
2014         case DA7219_HP_L_GAIN_STATUS:
2015         case DA7219_HP_R_GAIN_STATUS:
2016         case DA7219_CIF_CTRL:
2017         case DA7219_PLL_SRM_STS:
2018         case DA7219_ALC_CTRL1:
2019         case DA7219_SYSTEM_MODES_INPUT:
2020         case DA7219_SYSTEM_MODES_OUTPUT:
2021         case DA7219_ALC_OFFSET_AUTO_M_L:
2022         case DA7219_ALC_OFFSET_AUTO_U_L:
2023         case DA7219_TONE_GEN_CFG1:
2024         case DA7219_ACCDET_STATUS_A:
2025         case DA7219_ACCDET_STATUS_B:
2026         case DA7219_ACCDET_IRQ_EVENT_A:
2027         case DA7219_ACCDET_IRQ_EVENT_B:
2028         case DA7219_ACCDET_CONFIG_8:
2029         case DA7219_SYSTEM_STATUS:
2030                 return 1;
2031         default:
2032                 return 0;
2033         }
2034 }
2035 
2036 static const struct regmap_config da7219_regmap_config = {
2037         .reg_bits = 8,
2038         .val_bits = 8,
2039 
2040         .max_register = DA7219_SYSTEM_ACTIVE,
2041         .reg_defaults = da7219_reg_defaults,
2042         .num_reg_defaults = ARRAY_SIZE(da7219_reg_defaults),
2043         .volatile_reg = da7219_volatile_register,
2044         .cache_type = REGCACHE_RBTREE,
2045 };
2046 
2047 
2048 /*
2049  * I2C layer
2050  */
2051 
2052 static int da7219_i2c_probe(struct i2c_client *i2c,
2053                             const struct i2c_device_id *id)
2054 {
2055         struct da7219_priv *da7219;
2056         unsigned int system_active, system_status;
2057         int i, ret;
2058 
2059         da7219 = devm_kzalloc(&i2c->dev, sizeof(struct da7219_priv),
2060                               GFP_KERNEL);
2061         if (!da7219)
2062                 return -ENOMEM;
2063 
2064         i2c_set_clientdata(i2c, da7219);
2065 
2066         da7219->regmap = devm_regmap_init_i2c(i2c, &da7219_regmap_config);
2067         if (IS_ERR(da7219->regmap)) {
2068                 ret = PTR_ERR(da7219->regmap);
2069                 dev_err(&i2c->dev, "regmap_init() failed: %d\n", ret);
2070                 return ret;
2071         }
2072 
2073         regcache_cache_bypass(da7219->regmap, true);
2074 
2075         /* Disable audio paths if still active from previous start */
2076         regmap_read(da7219->regmap, DA7219_SYSTEM_ACTIVE, &system_active);
2077         if (system_active) {
2078                 regmap_write(da7219->regmap, DA7219_GAIN_RAMP_CTRL,
2079                              DA7219_GAIN_RAMP_RATE_NOMINAL);
2080                 regmap_write(da7219->regmap, DA7219_SYSTEM_MODES_INPUT, 0x00);
2081                 regmap_write(da7219->regmap, DA7219_SYSTEM_MODES_OUTPUT, 0x01);
2082 
2083                 for (i = 0; i < DA7219_SYS_STAT_CHECK_RETRIES; ++i) {
2084                         regmap_read(da7219->regmap, DA7219_SYSTEM_STATUS,
2085                                     &system_status);
2086                         if (!system_status)
2087                                 break;
2088 
2089                         msleep(DA7219_SYS_STAT_CHECK_DELAY);
2090                 }
2091         }
2092 
2093         /* Soft reset codec */
2094         regmap_write_bits(da7219->regmap, DA7219_ACCDET_CONFIG_1,
2095                           DA7219_ACCDET_EN_MASK, 0);
2096         regmap_write_bits(da7219->regmap, DA7219_CIF_CTRL,
2097                           DA7219_CIF_REG_SOFT_RESET_MASK,
2098                           DA7219_CIF_REG_SOFT_RESET_MASK);
2099         regmap_write_bits(da7219->regmap, DA7219_SYSTEM_ACTIVE,
2100                           DA7219_SYSTEM_ACTIVE_MASK, 0);
2101 
2102         regcache_cache_bypass(da7219->regmap, false);
2103 
2104         ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_da7219,
2105                                      &da7219_dai, 1);
2106         if (ret < 0) {
2107                 dev_err(&i2c->dev, "Failed to register da7219 codec: %d\n",
2108                         ret);
2109         }
2110         return ret;
2111 }
2112 
2113 static int da7219_i2c_remove(struct i2c_client *client)
2114 {
2115         snd_soc_unregister_codec(&client->dev);
2116         return 0;
2117 }
2118 
2119 static const struct i2c_device_id da7219_i2c_id[] = {
2120         { "da7219", },
2121         { }
2122 };
2123 MODULE_DEVICE_TABLE(i2c, da7219_i2c_id);
2124 
2125 static struct i2c_driver da7219_i2c_driver = {
2126         .driver = {
2127                 .name = "da7219",
2128                 .of_match_table = of_match_ptr(da7219_of_match),
2129                 .acpi_match_table = ACPI_PTR(da7219_acpi_match),
2130         },
2131         .probe          = da7219_i2c_probe,
2132         .remove         = da7219_i2c_remove,
2133         .id_table       = da7219_i2c_id,
2134 };
2135 
2136 module_i2c_driver(da7219_i2c_driver);
2137 
2138 MODULE_DESCRIPTION("ASoC DA7219 Codec Driver");
2139 MODULE_AUTHOR("Adam Thomson <Adam.Thomson.Opensource@diasemi.com>");
2140 MODULE_LICENSE("GPL");
2141 

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | Wiki (Japanese) | Wiki (English) | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

osdn.jp