Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * max98095.c -- MAX98095 ALSA SoC Audio driver
4 *
5 * Copyright 2011 Maxim Integrated Products
6 */
7
8#include <linux/module.h>
9#include <linux/moduleparam.h>
10#include <linux/kernel.h>
11#include <linux/init.h>
12#include <linux/delay.h>
13#include <linux/pm.h>
14#include <linux/i2c.h>
15#include <linux/clk.h>
16#include <linux/mutex.h>
17#include <sound/core.h>
18#include <sound/pcm.h>
19#include <sound/pcm_params.h>
20#include <sound/soc.h>
21#include <sound/initval.h>
22#include <sound/tlv.h>
23#include <linux/slab.h>
24#include <asm/div64.h>
25#include <sound/max98095.h>
26#include <sound/jack.h>
27#include "max98095.h"
28
29enum max98095_type {
30 MAX98095,
31};
32
33struct max98095_cdata {
34 unsigned int rate;
35 unsigned int fmt;
36 int eq_sel;
37 int bq_sel;
38};
39
40struct max98095_priv {
41 struct regmap *regmap;
42 enum max98095_type devtype;
43 struct max98095_pdata *pdata;
44 struct clk *mclk;
45 unsigned int sysclk;
46 struct max98095_cdata dai[3];
47 const char **eq_texts;
48 const char **bq_texts;
49 struct soc_enum eq_enum;
50 struct soc_enum bq_enum;
51 int eq_textcnt;
52 int bq_textcnt;
53 u8 lin_state;
54 unsigned int mic1pre;
55 unsigned int mic2pre;
56 struct snd_soc_jack *headphone_jack;
57 struct snd_soc_jack *mic_jack;
58 struct mutex lock;
59};
60
61static const struct reg_default max98095_reg_def[] = {
62 { 0xf, 0x00 }, /* 0F */
63 { 0x10, 0x00 }, /* 10 */
64 { 0x11, 0x00 }, /* 11 */
65 { 0x12, 0x00 }, /* 12 */
66 { 0x13, 0x00 }, /* 13 */
67 { 0x14, 0x00 }, /* 14 */
68 { 0x15, 0x00 }, /* 15 */
69 { 0x16, 0x00 }, /* 16 */
70 { 0x17, 0x00 }, /* 17 */
71 { 0x18, 0x00 }, /* 18 */
72 { 0x19, 0x00 }, /* 19 */
73 { 0x1a, 0x00 }, /* 1A */
74 { 0x1b, 0x00 }, /* 1B */
75 { 0x1c, 0x00 }, /* 1C */
76 { 0x1d, 0x00 }, /* 1D */
77 { 0x1e, 0x00 }, /* 1E */
78 { 0x1f, 0x00 }, /* 1F */
79 { 0x20, 0x00 }, /* 20 */
80 { 0x21, 0x00 }, /* 21 */
81 { 0x22, 0x00 }, /* 22 */
82 { 0x23, 0x00 }, /* 23 */
83 { 0x24, 0x00 }, /* 24 */
84 { 0x25, 0x00 }, /* 25 */
85 { 0x26, 0x00 }, /* 26 */
86 { 0x27, 0x00 }, /* 27 */
87 { 0x28, 0x00 }, /* 28 */
88 { 0x29, 0x00 }, /* 29 */
89 { 0x2a, 0x00 }, /* 2A */
90 { 0x2b, 0x00 }, /* 2B */
91 { 0x2c, 0x00 }, /* 2C */
92 { 0x2d, 0x00 }, /* 2D */
93 { 0x2e, 0x00 }, /* 2E */
94 { 0x2f, 0x00 }, /* 2F */
95 { 0x30, 0x00 }, /* 30 */
96 { 0x31, 0x00 }, /* 31 */
97 { 0x32, 0x00 }, /* 32 */
98 { 0x33, 0x00 }, /* 33 */
99 { 0x34, 0x00 }, /* 34 */
100 { 0x35, 0x00 }, /* 35 */
101 { 0x36, 0x00 }, /* 36 */
102 { 0x37, 0x00 }, /* 37 */
103 { 0x38, 0x00 }, /* 38 */
104 { 0x39, 0x00 }, /* 39 */
105 { 0x3a, 0x00 }, /* 3A */
106 { 0x3b, 0x00 }, /* 3B */
107 { 0x3c, 0x00 }, /* 3C */
108 { 0x3d, 0x00 }, /* 3D */
109 { 0x3e, 0x00 }, /* 3E */
110 { 0x3f, 0x00 }, /* 3F */
111 { 0x40, 0x00 }, /* 40 */
112 { 0x41, 0x00 }, /* 41 */
113 { 0x42, 0x00 }, /* 42 */
114 { 0x43, 0x00 }, /* 43 */
115 { 0x44, 0x00 }, /* 44 */
116 { 0x45, 0x00 }, /* 45 */
117 { 0x46, 0x00 }, /* 46 */
118 { 0x47, 0x00 }, /* 47 */
119 { 0x48, 0x00 }, /* 48 */
120 { 0x49, 0x00 }, /* 49 */
121 { 0x4a, 0x00 }, /* 4A */
122 { 0x4b, 0x00 }, /* 4B */
123 { 0x4c, 0x00 }, /* 4C */
124 { 0x4d, 0x00 }, /* 4D */
125 { 0x4e, 0x00 }, /* 4E */
126 { 0x4f, 0x00 }, /* 4F */
127 { 0x50, 0x00 }, /* 50 */
128 { 0x51, 0x00 }, /* 51 */
129 { 0x52, 0x00 }, /* 52 */
130 { 0x53, 0x00 }, /* 53 */
131 { 0x54, 0x00 }, /* 54 */
132 { 0x55, 0x00 }, /* 55 */
133 { 0x56, 0x00 }, /* 56 */
134 { 0x57, 0x00 }, /* 57 */
135 { 0x58, 0x00 }, /* 58 */
136 { 0x59, 0x00 }, /* 59 */
137 { 0x5a, 0x00 }, /* 5A */
138 { 0x5b, 0x00 }, /* 5B */
139 { 0x5c, 0x00 }, /* 5C */
140 { 0x5d, 0x00 }, /* 5D */
141 { 0x5e, 0x00 }, /* 5E */
142 { 0x5f, 0x00 }, /* 5F */
143 { 0x60, 0x00 }, /* 60 */
144 { 0x61, 0x00 }, /* 61 */
145 { 0x62, 0x00 }, /* 62 */
146 { 0x63, 0x00 }, /* 63 */
147 { 0x64, 0x00 }, /* 64 */
148 { 0x65, 0x00 }, /* 65 */
149 { 0x66, 0x00 }, /* 66 */
150 { 0x67, 0x00 }, /* 67 */
151 { 0x68, 0x00 }, /* 68 */
152 { 0x69, 0x00 }, /* 69 */
153 { 0x6a, 0x00 }, /* 6A */
154 { 0x6b, 0x00 }, /* 6B */
155 { 0x6c, 0x00 }, /* 6C */
156 { 0x6d, 0x00 }, /* 6D */
157 { 0x6e, 0x00 }, /* 6E */
158 { 0x6f, 0x00 }, /* 6F */
159 { 0x70, 0x00 }, /* 70 */
160 { 0x71, 0x00 }, /* 71 */
161 { 0x72, 0x00 }, /* 72 */
162 { 0x73, 0x00 }, /* 73 */
163 { 0x74, 0x00 }, /* 74 */
164 { 0x75, 0x00 }, /* 75 */
165 { 0x76, 0x00 }, /* 76 */
166 { 0x77, 0x00 }, /* 77 */
167 { 0x78, 0x00 }, /* 78 */
168 { 0x79, 0x00 }, /* 79 */
169 { 0x7a, 0x00 }, /* 7A */
170 { 0x7b, 0x00 }, /* 7B */
171 { 0x7c, 0x00 }, /* 7C */
172 { 0x7d, 0x00 }, /* 7D */
173 { 0x7e, 0x00 }, /* 7E */
174 { 0x7f, 0x00 }, /* 7F */
175 { 0x80, 0x00 }, /* 80 */
176 { 0x81, 0x00 }, /* 81 */
177 { 0x82, 0x00 }, /* 82 */
178 { 0x83, 0x00 }, /* 83 */
179 { 0x84, 0x00 }, /* 84 */
180 { 0x85, 0x00 }, /* 85 */
181 { 0x86, 0x00 }, /* 86 */
182 { 0x87, 0x00 }, /* 87 */
183 { 0x88, 0x00 }, /* 88 */
184 { 0x89, 0x00 }, /* 89 */
185 { 0x8a, 0x00 }, /* 8A */
186 { 0x8b, 0x00 }, /* 8B */
187 { 0x8c, 0x00 }, /* 8C */
188 { 0x8d, 0x00 }, /* 8D */
189 { 0x8e, 0x00 }, /* 8E */
190 { 0x8f, 0x00 }, /* 8F */
191 { 0x90, 0x00 }, /* 90 */
192 { 0x91, 0x00 }, /* 91 */
193 { 0x92, 0x30 }, /* 92 */
194 { 0x93, 0xF0 }, /* 93 */
195 { 0x94, 0x00 }, /* 94 */
196 { 0x95, 0x00 }, /* 95 */
197 { 0x96, 0x3F }, /* 96 */
198 { 0x97, 0x00 }, /* 97 */
199 { 0xff, 0x00 }, /* FF */
200};
201
202static bool max98095_readable(struct device *dev, unsigned int reg)
203{
204 switch (reg) {
205 case M98095_001_HOST_INT_STS ... M98095_097_PWR_SYS:
206 case M98095_0FF_REV_ID:
207 return true;
208 default:
209 return false;
210 }
211}
212
213static bool max98095_writeable(struct device *dev, unsigned int reg)
214{
215 switch (reg) {
216 case M98095_00F_HOST_CFG ... M98095_097_PWR_SYS:
217 return true;
218 default:
219 return false;
220 }
221}
222
223static bool max98095_volatile(struct device *dev, unsigned int reg)
224{
225 switch (reg) {
226 case M98095_000_HOST_DATA ... M98095_00E_TEMP_SENSOR_STS:
227 case M98095_REG_MAX_CACHED + 1 ... M98095_0FF_REV_ID:
228 return true;
229 default:
230 return false;
231 }
232}
233
234static const struct regmap_config max98095_regmap = {
235 .reg_bits = 8,
236 .val_bits = 8,
237
238 .reg_defaults = max98095_reg_def,
239 .num_reg_defaults = ARRAY_SIZE(max98095_reg_def),
240 .max_register = M98095_0FF_REV_ID,
241 .cache_type = REGCACHE_RBTREE,
242
243 .readable_reg = max98095_readable,
244 .writeable_reg = max98095_writeable,
245 .volatile_reg = max98095_volatile,
246};
247
248/*
249 * Load equalizer DSP coefficient configurations registers
250 */
251static void m98095_eq_band(struct snd_soc_component *component, unsigned int dai,
252 unsigned int band, u16 *coefs)
253{
254 unsigned int eq_reg;
255 unsigned int i;
256
257 if (WARN_ON(band > 4) ||
258 WARN_ON(dai > 1))
259 return;
260
261 /* Load the base register address */
262 eq_reg = dai ? M98095_142_DAI2_EQ_BASE : M98095_110_DAI1_EQ_BASE;
263
264 /* Add the band address offset, note adjustment for word address */
265 eq_reg += band * (M98095_COEFS_PER_BAND << 1);
266
267 /* Step through the registers and coefs */
268 for (i = 0; i < M98095_COEFS_PER_BAND; i++) {
269 snd_soc_component_write(component, eq_reg++, M98095_BYTE1(coefs[i]));
270 snd_soc_component_write(component, eq_reg++, M98095_BYTE0(coefs[i]));
271 }
272}
273
274/*
275 * Load biquad filter coefficient configurations registers
276 */
277static void m98095_biquad_band(struct snd_soc_component *component, unsigned int dai,
278 unsigned int band, u16 *coefs)
279{
280 unsigned int bq_reg;
281 unsigned int i;
282
283 if (WARN_ON(band > 1) ||
284 WARN_ON(dai > 1))
285 return;
286
287 /* Load the base register address */
288 bq_reg = dai ? M98095_17E_DAI2_BQ_BASE : M98095_174_DAI1_BQ_BASE;
289
290 /* Add the band address offset, note adjustment for word address */
291 bq_reg += band * (M98095_COEFS_PER_BAND << 1);
292
293 /* Step through the registers and coefs */
294 for (i = 0; i < M98095_COEFS_PER_BAND; i++) {
295 snd_soc_component_write(component, bq_reg++, M98095_BYTE1(coefs[i]));
296 snd_soc_component_write(component, bq_reg++, M98095_BYTE0(coefs[i]));
297 }
298}
299
300static const char * const max98095_fltr_mode[] = { "Voice", "Music" };
301static SOC_ENUM_SINGLE_DECL(max98095_dai1_filter_mode_enum,
302 M98095_02E_DAI1_FILTERS, 7,
303 max98095_fltr_mode);
304static SOC_ENUM_SINGLE_DECL(max98095_dai2_filter_mode_enum,
305 M98095_038_DAI2_FILTERS, 7,
306 max98095_fltr_mode);
307
308static const char * const max98095_extmic_text[] = { "None", "MIC1", "MIC2" };
309
310static SOC_ENUM_SINGLE_DECL(max98095_extmic_enum,
311 M98095_087_CFG_MIC, 0,
312 max98095_extmic_text);
313
314static const struct snd_kcontrol_new max98095_extmic_mux =
315 SOC_DAPM_ENUM("External MIC Mux", max98095_extmic_enum);
316
317static const char * const max98095_linein_text[] = { "INA", "INB" };
318
319static SOC_ENUM_SINGLE_DECL(max98095_linein_enum,
320 M98095_086_CFG_LINE, 6,
321 max98095_linein_text);
322
323static const struct snd_kcontrol_new max98095_linein_mux =
324 SOC_DAPM_ENUM("Linein Input Mux", max98095_linein_enum);
325
326static const char * const max98095_line_mode_text[] = {
327 "Stereo", "Differential"};
328
329static SOC_ENUM_SINGLE_DECL(max98095_linein_mode_enum,
330 M98095_086_CFG_LINE, 7,
331 max98095_line_mode_text);
332
333static SOC_ENUM_SINGLE_DECL(max98095_lineout_mode_enum,
334 M98095_086_CFG_LINE, 4,
335 max98095_line_mode_text);
336
337static const char * const max98095_dai_fltr[] = {
338 "Off", "Elliptical-HPF-16k", "Butterworth-HPF-16k",
339 "Elliptical-HPF-8k", "Butterworth-HPF-8k", "Butterworth-HPF-Fs/240"};
340static SOC_ENUM_SINGLE_DECL(max98095_dai1_dac_filter_enum,
341 M98095_02E_DAI1_FILTERS, 0,
342 max98095_dai_fltr);
343static SOC_ENUM_SINGLE_DECL(max98095_dai2_dac_filter_enum,
344 M98095_038_DAI2_FILTERS, 0,
345 max98095_dai_fltr);
346static SOC_ENUM_SINGLE_DECL(max98095_dai3_dac_filter_enum,
347 M98095_042_DAI3_FILTERS, 0,
348 max98095_dai_fltr);
349
350static int max98095_mic1pre_set(struct snd_kcontrol *kcontrol,
351 struct snd_ctl_elem_value *ucontrol)
352{
353 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
354 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
355 unsigned int sel = ucontrol->value.integer.value[0];
356
357 max98095->mic1pre = sel;
358 snd_soc_component_update_bits(component, M98095_05F_LVL_MIC1, M98095_MICPRE_MASK,
359 (1+sel)<<M98095_MICPRE_SHIFT);
360
361 return 0;
362}
363
364static int max98095_mic1pre_get(struct snd_kcontrol *kcontrol,
365 struct snd_ctl_elem_value *ucontrol)
366{
367 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
368 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
369
370 ucontrol->value.integer.value[0] = max98095->mic1pre;
371 return 0;
372}
373
374static int max98095_mic2pre_set(struct snd_kcontrol *kcontrol,
375 struct snd_ctl_elem_value *ucontrol)
376{
377 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
378 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
379 unsigned int sel = ucontrol->value.integer.value[0];
380
381 max98095->mic2pre = sel;
382 snd_soc_component_update_bits(component, M98095_060_LVL_MIC2, M98095_MICPRE_MASK,
383 (1+sel)<<M98095_MICPRE_SHIFT);
384
385 return 0;
386}
387
388static int max98095_mic2pre_get(struct snd_kcontrol *kcontrol,
389 struct snd_ctl_elem_value *ucontrol)
390{
391 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
392 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
393
394 ucontrol->value.integer.value[0] = max98095->mic2pre;
395 return 0;
396}
397
398static const DECLARE_TLV_DB_RANGE(max98095_micboost_tlv,
399 0, 1, TLV_DB_SCALE_ITEM(0, 2000, 0),
400 2, 2, TLV_DB_SCALE_ITEM(3000, 0, 0)
401);
402
403static const DECLARE_TLV_DB_SCALE(max98095_mic_tlv, 0, 100, 0);
404static const DECLARE_TLV_DB_SCALE(max98095_adc_tlv, -1200, 100, 0);
405static const DECLARE_TLV_DB_SCALE(max98095_adcboost_tlv, 0, 600, 0);
406
407static const DECLARE_TLV_DB_RANGE(max98095_hp_tlv,
408 0, 6, TLV_DB_SCALE_ITEM(-6700, 400, 0),
409 7, 14, TLV_DB_SCALE_ITEM(-4000, 300, 0),
410 15, 21, TLV_DB_SCALE_ITEM(-1700, 200, 0),
411 22, 27, TLV_DB_SCALE_ITEM(-400, 100, 0),
412 28, 31, TLV_DB_SCALE_ITEM(150, 50, 0)
413);
414
415static const DECLARE_TLV_DB_RANGE(max98095_spk_tlv,
416 0, 10, TLV_DB_SCALE_ITEM(-5900, 400, 0),
417 11, 18, TLV_DB_SCALE_ITEM(-1700, 200, 0),
418 19, 27, TLV_DB_SCALE_ITEM(-200, 100, 0),
419 28, 39, TLV_DB_SCALE_ITEM(650, 50, 0)
420);
421
422static const DECLARE_TLV_DB_RANGE(max98095_rcv_lout_tlv,
423 0, 6, TLV_DB_SCALE_ITEM(-6200, 400, 0),
424 7, 14, TLV_DB_SCALE_ITEM(-3500, 300, 0),
425 15, 21, TLV_DB_SCALE_ITEM(-1200, 200, 0),
426 22, 27, TLV_DB_SCALE_ITEM(100, 100, 0),
427 28, 31, TLV_DB_SCALE_ITEM(650, 50, 0)
428);
429
430static const DECLARE_TLV_DB_RANGE(max98095_lin_tlv,
431 0, 2, TLV_DB_SCALE_ITEM(-600, 300, 0),
432 3, 3, TLV_DB_SCALE_ITEM(300, 1100, 0),
433 4, 5, TLV_DB_SCALE_ITEM(1400, 600, 0)
434);
435
436static const struct snd_kcontrol_new max98095_snd_controls[] = {
437
438 SOC_DOUBLE_R_TLV("Headphone Volume", M98095_064_LVL_HP_L,
439 M98095_065_LVL_HP_R, 0, 31, 0, max98095_hp_tlv),
440
441 SOC_DOUBLE_R_TLV("Speaker Volume", M98095_067_LVL_SPK_L,
442 M98095_068_LVL_SPK_R, 0, 39, 0, max98095_spk_tlv),
443
444 SOC_SINGLE_TLV("Receiver Volume", M98095_066_LVL_RCV,
445 0, 31, 0, max98095_rcv_lout_tlv),
446
447 SOC_DOUBLE_R_TLV("Lineout Volume", M98095_062_LVL_LINEOUT1,
448 M98095_063_LVL_LINEOUT2, 0, 31, 0, max98095_rcv_lout_tlv),
449
450 SOC_DOUBLE_R("Headphone Switch", M98095_064_LVL_HP_L,
451 M98095_065_LVL_HP_R, 7, 1, 1),
452
453 SOC_DOUBLE_R("Speaker Switch", M98095_067_LVL_SPK_L,
454 M98095_068_LVL_SPK_R, 7, 1, 1),
455
456 SOC_SINGLE("Receiver Switch", M98095_066_LVL_RCV, 7, 1, 1),
457
458 SOC_DOUBLE_R("Lineout Switch", M98095_062_LVL_LINEOUT1,
459 M98095_063_LVL_LINEOUT2, 7, 1, 1),
460
461 SOC_SINGLE_TLV("MIC1 Volume", M98095_05F_LVL_MIC1, 0, 20, 1,
462 max98095_mic_tlv),
463
464 SOC_SINGLE_TLV("MIC2 Volume", M98095_060_LVL_MIC2, 0, 20, 1,
465 max98095_mic_tlv),
466
467 SOC_SINGLE_EXT_TLV("MIC1 Boost Volume",
468 M98095_05F_LVL_MIC1, 5, 2, 0,
469 max98095_mic1pre_get, max98095_mic1pre_set,
470 max98095_micboost_tlv),
471 SOC_SINGLE_EXT_TLV("MIC2 Boost Volume",
472 M98095_060_LVL_MIC2, 5, 2, 0,
473 max98095_mic2pre_get, max98095_mic2pre_set,
474 max98095_micboost_tlv),
475
476 SOC_SINGLE_TLV("Linein Volume", M98095_061_LVL_LINEIN, 0, 5, 1,
477 max98095_lin_tlv),
478
479 SOC_SINGLE_TLV("ADCL Volume", M98095_05D_LVL_ADC_L, 0, 15, 1,
480 max98095_adc_tlv),
481 SOC_SINGLE_TLV("ADCR Volume", M98095_05E_LVL_ADC_R, 0, 15, 1,
482 max98095_adc_tlv),
483
484 SOC_SINGLE_TLV("ADCL Boost Volume", M98095_05D_LVL_ADC_L, 4, 3, 0,
485 max98095_adcboost_tlv),
486 SOC_SINGLE_TLV("ADCR Boost Volume", M98095_05E_LVL_ADC_R, 4, 3, 0,
487 max98095_adcboost_tlv),
488
489 SOC_SINGLE("EQ1 Switch", M98095_088_CFG_LEVEL, 0, 1, 0),
490 SOC_SINGLE("EQ2 Switch", M98095_088_CFG_LEVEL, 1, 1, 0),
491
492 SOC_SINGLE("Biquad1 Switch", M98095_088_CFG_LEVEL, 2, 1, 0),
493 SOC_SINGLE("Biquad2 Switch", M98095_088_CFG_LEVEL, 3, 1, 0),
494
495 SOC_ENUM("DAI1 Filter Mode", max98095_dai1_filter_mode_enum),
496 SOC_ENUM("DAI2 Filter Mode", max98095_dai2_filter_mode_enum),
497 SOC_ENUM("DAI1 DAC Filter", max98095_dai1_dac_filter_enum),
498 SOC_ENUM("DAI2 DAC Filter", max98095_dai2_dac_filter_enum),
499 SOC_ENUM("DAI3 DAC Filter", max98095_dai3_dac_filter_enum),
500
501 SOC_ENUM("Linein Mode", max98095_linein_mode_enum),
502 SOC_ENUM("Lineout Mode", max98095_lineout_mode_enum),
503};
504
505/* Left speaker mixer switch */
506static const struct snd_kcontrol_new max98095_left_speaker_mixer_controls[] = {
507 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_050_MIX_SPK_LEFT, 0, 1, 0),
508 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_050_MIX_SPK_LEFT, 6, 1, 0),
509 SOC_DAPM_SINGLE("Mono DAC2 Switch", M98095_050_MIX_SPK_LEFT, 3, 1, 0),
510 SOC_DAPM_SINGLE("Mono DAC3 Switch", M98095_050_MIX_SPK_LEFT, 3, 1, 0),
511 SOC_DAPM_SINGLE("MIC1 Switch", M98095_050_MIX_SPK_LEFT, 4, 1, 0),
512 SOC_DAPM_SINGLE("MIC2 Switch", M98095_050_MIX_SPK_LEFT, 5, 1, 0),
513 SOC_DAPM_SINGLE("IN1 Switch", M98095_050_MIX_SPK_LEFT, 1, 1, 0),
514 SOC_DAPM_SINGLE("IN2 Switch", M98095_050_MIX_SPK_LEFT, 2, 1, 0),
515};
516
517/* Right speaker mixer switch */
518static const struct snd_kcontrol_new max98095_right_speaker_mixer_controls[] = {
519 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_051_MIX_SPK_RIGHT, 6, 1, 0),
520 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_051_MIX_SPK_RIGHT, 0, 1, 0),
521 SOC_DAPM_SINGLE("Mono DAC2 Switch", M98095_051_MIX_SPK_RIGHT, 3, 1, 0),
522 SOC_DAPM_SINGLE("Mono DAC3 Switch", M98095_051_MIX_SPK_RIGHT, 3, 1, 0),
523 SOC_DAPM_SINGLE("MIC1 Switch", M98095_051_MIX_SPK_RIGHT, 5, 1, 0),
524 SOC_DAPM_SINGLE("MIC2 Switch", M98095_051_MIX_SPK_RIGHT, 4, 1, 0),
525 SOC_DAPM_SINGLE("IN1 Switch", M98095_051_MIX_SPK_RIGHT, 1, 1, 0),
526 SOC_DAPM_SINGLE("IN2 Switch", M98095_051_MIX_SPK_RIGHT, 2, 1, 0),
527};
528
529/* Left headphone mixer switch */
530static const struct snd_kcontrol_new max98095_left_hp_mixer_controls[] = {
531 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04C_MIX_HP_LEFT, 0, 1, 0),
532 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04C_MIX_HP_LEFT, 5, 1, 0),
533 SOC_DAPM_SINGLE("MIC1 Switch", M98095_04C_MIX_HP_LEFT, 3, 1, 0),
534 SOC_DAPM_SINGLE("MIC2 Switch", M98095_04C_MIX_HP_LEFT, 4, 1, 0),
535 SOC_DAPM_SINGLE("IN1 Switch", M98095_04C_MIX_HP_LEFT, 1, 1, 0),
536 SOC_DAPM_SINGLE("IN2 Switch", M98095_04C_MIX_HP_LEFT, 2, 1, 0),
537};
538
539/* Right headphone mixer switch */
540static const struct snd_kcontrol_new max98095_right_hp_mixer_controls[] = {
541 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04D_MIX_HP_RIGHT, 5, 1, 0),
542 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04D_MIX_HP_RIGHT, 0, 1, 0),
543 SOC_DAPM_SINGLE("MIC1 Switch", M98095_04D_MIX_HP_RIGHT, 3, 1, 0),
544 SOC_DAPM_SINGLE("MIC2 Switch", M98095_04D_MIX_HP_RIGHT, 4, 1, 0),
545 SOC_DAPM_SINGLE("IN1 Switch", M98095_04D_MIX_HP_RIGHT, 1, 1, 0),
546 SOC_DAPM_SINGLE("IN2 Switch", M98095_04D_MIX_HP_RIGHT, 2, 1, 0),
547};
548
549/* Receiver earpiece mixer switch */
550static const struct snd_kcontrol_new max98095_mono_rcv_mixer_controls[] = {
551 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04F_MIX_RCV, 0, 1, 0),
552 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04F_MIX_RCV, 5, 1, 0),
553 SOC_DAPM_SINGLE("MIC1 Switch", M98095_04F_MIX_RCV, 3, 1, 0),
554 SOC_DAPM_SINGLE("MIC2 Switch", M98095_04F_MIX_RCV, 4, 1, 0),
555 SOC_DAPM_SINGLE("IN1 Switch", M98095_04F_MIX_RCV, 1, 1, 0),
556 SOC_DAPM_SINGLE("IN2 Switch", M98095_04F_MIX_RCV, 2, 1, 0),
557};
558
559/* Left lineout mixer switch */
560static const struct snd_kcontrol_new max98095_left_lineout_mixer_controls[] = {
561 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_053_MIX_LINEOUT1, 5, 1, 0),
562 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_053_MIX_LINEOUT1, 0, 1, 0),
563 SOC_DAPM_SINGLE("MIC1 Switch", M98095_053_MIX_LINEOUT1, 3, 1, 0),
564 SOC_DAPM_SINGLE("MIC2 Switch", M98095_053_MIX_LINEOUT1, 4, 1, 0),
565 SOC_DAPM_SINGLE("IN1 Switch", M98095_053_MIX_LINEOUT1, 1, 1, 0),
566 SOC_DAPM_SINGLE("IN2 Switch", M98095_053_MIX_LINEOUT1, 2, 1, 0),
567};
568
569/* Right lineout mixer switch */
570static const struct snd_kcontrol_new max98095_right_lineout_mixer_controls[] = {
571 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_054_MIX_LINEOUT2, 0, 1, 0),
572 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_054_MIX_LINEOUT2, 5, 1, 0),
573 SOC_DAPM_SINGLE("MIC1 Switch", M98095_054_MIX_LINEOUT2, 3, 1, 0),
574 SOC_DAPM_SINGLE("MIC2 Switch", M98095_054_MIX_LINEOUT2, 4, 1, 0),
575 SOC_DAPM_SINGLE("IN1 Switch", M98095_054_MIX_LINEOUT2, 1, 1, 0),
576 SOC_DAPM_SINGLE("IN2 Switch", M98095_054_MIX_LINEOUT2, 2, 1, 0),
577};
578
579/* Left ADC mixer switch */
580static const struct snd_kcontrol_new max98095_left_ADC_mixer_controls[] = {
581 SOC_DAPM_SINGLE("MIC1 Switch", M98095_04A_MIX_ADC_LEFT, 7, 1, 0),
582 SOC_DAPM_SINGLE("MIC2 Switch", M98095_04A_MIX_ADC_LEFT, 6, 1, 0),
583 SOC_DAPM_SINGLE("IN1 Switch", M98095_04A_MIX_ADC_LEFT, 3, 1, 0),
584 SOC_DAPM_SINGLE("IN2 Switch", M98095_04A_MIX_ADC_LEFT, 2, 1, 0),
585};
586
587/* Right ADC mixer switch */
588static const struct snd_kcontrol_new max98095_right_ADC_mixer_controls[] = {
589 SOC_DAPM_SINGLE("MIC1 Switch", M98095_04B_MIX_ADC_RIGHT, 7, 1, 0),
590 SOC_DAPM_SINGLE("MIC2 Switch", M98095_04B_MIX_ADC_RIGHT, 6, 1, 0),
591 SOC_DAPM_SINGLE("IN1 Switch", M98095_04B_MIX_ADC_RIGHT, 3, 1, 0),
592 SOC_DAPM_SINGLE("IN2 Switch", M98095_04B_MIX_ADC_RIGHT, 2, 1, 0),
593};
594
595static int max98095_mic_event(struct snd_soc_dapm_widget *w,
596 struct snd_kcontrol *kcontrol, int event)
597{
598 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
599 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
600
601 switch (event) {
602 case SND_SOC_DAPM_POST_PMU:
603 if (w->reg == M98095_05F_LVL_MIC1) {
604 snd_soc_component_update_bits(component, w->reg, M98095_MICPRE_MASK,
605 (1+max98095->mic1pre)<<M98095_MICPRE_SHIFT);
606 } else {
607 snd_soc_component_update_bits(component, w->reg, M98095_MICPRE_MASK,
608 (1+max98095->mic2pre)<<M98095_MICPRE_SHIFT);
609 }
610 break;
611 case SND_SOC_DAPM_POST_PMD:
612 snd_soc_component_update_bits(component, w->reg, M98095_MICPRE_MASK, 0);
613 break;
614 default:
615 return -EINVAL;
616 }
617
618 return 0;
619}
620
621/*
622 * The line inputs are stereo inputs with the left and right
623 * channels sharing a common PGA power control signal.
624 */
625static int max98095_line_pga(struct snd_soc_dapm_widget *w,
626 int event, u8 channel)
627{
628 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
629 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
630 u8 *state;
631
632 if (WARN_ON(!(channel == 1 || channel == 2)))
633 return -EINVAL;
634
635 state = &max98095->lin_state;
636
637 switch (event) {
638 case SND_SOC_DAPM_POST_PMU:
639 *state |= channel;
640 snd_soc_component_update_bits(component, w->reg,
641 (1 << w->shift), (1 << w->shift));
642 break;
643 case SND_SOC_DAPM_POST_PMD:
644 *state &= ~channel;
645 if (*state == 0) {
646 snd_soc_component_update_bits(component, w->reg,
647 (1 << w->shift), 0);
648 }
649 break;
650 default:
651 return -EINVAL;
652 }
653
654 return 0;
655}
656
657static int max98095_pga_in1_event(struct snd_soc_dapm_widget *w,
658 struct snd_kcontrol *k, int event)
659{
660 return max98095_line_pga(w, event, 1);
661}
662
663static int max98095_pga_in2_event(struct snd_soc_dapm_widget *w,
664 struct snd_kcontrol *k, int event)
665{
666 return max98095_line_pga(w, event, 2);
667}
668
669/*
670 * The stereo line out mixer outputs to two stereo line outs.
671 * The 2nd pair has a separate set of enables.
672 */
673static int max98095_lineout_event(struct snd_soc_dapm_widget *w,
674 struct snd_kcontrol *kcontrol, int event)
675{
676 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
677
678 switch (event) {
679 case SND_SOC_DAPM_POST_PMU:
680 snd_soc_component_update_bits(component, w->reg,
681 (1 << (w->shift+2)), (1 << (w->shift+2)));
682 break;
683 case SND_SOC_DAPM_POST_PMD:
684 snd_soc_component_update_bits(component, w->reg,
685 (1 << (w->shift+2)), 0);
686 break;
687 default:
688 return -EINVAL;
689 }
690
691 return 0;
692}
693
694static const struct snd_soc_dapm_widget max98095_dapm_widgets[] = {
695
696 SND_SOC_DAPM_ADC("ADCL", "HiFi Capture", M98095_090_PWR_EN_IN, 0, 0),
697 SND_SOC_DAPM_ADC("ADCR", "HiFi Capture", M98095_090_PWR_EN_IN, 1, 0),
698
699 SND_SOC_DAPM_DAC("DACL1", "HiFi Playback",
700 M98095_091_PWR_EN_OUT, 0, 0),
701 SND_SOC_DAPM_DAC("DACR1", "HiFi Playback",
702 M98095_091_PWR_EN_OUT, 1, 0),
703 SND_SOC_DAPM_DAC("DACM2", "Aux Playback",
704 M98095_091_PWR_EN_OUT, 2, 0),
705 SND_SOC_DAPM_DAC("DACM3", "Voice Playback",
706 M98095_091_PWR_EN_OUT, 2, 0),
707
708 SND_SOC_DAPM_PGA("HP Left Out", M98095_091_PWR_EN_OUT,
709 6, 0, NULL, 0),
710 SND_SOC_DAPM_PGA("HP Right Out", M98095_091_PWR_EN_OUT,
711 7, 0, NULL, 0),
712
713 SND_SOC_DAPM_PGA("SPK Left Out", M98095_091_PWR_EN_OUT,
714 4, 0, NULL, 0),
715 SND_SOC_DAPM_PGA("SPK Right Out", M98095_091_PWR_EN_OUT,
716 5, 0, NULL, 0),
717
718 SND_SOC_DAPM_PGA("RCV Mono Out", M98095_091_PWR_EN_OUT,
719 3, 0, NULL, 0),
720
721 SND_SOC_DAPM_PGA_E("LINE Left Out", M98095_092_PWR_EN_OUT,
722 0, 0, NULL, 0, max98095_lineout_event, SND_SOC_DAPM_PRE_PMD),
723 SND_SOC_DAPM_PGA_E("LINE Right Out", M98095_092_PWR_EN_OUT,
724 1, 0, NULL, 0, max98095_lineout_event, SND_SOC_DAPM_PRE_PMD),
725
726 SND_SOC_DAPM_MUX("External MIC", SND_SOC_NOPM, 0, 0,
727 &max98095_extmic_mux),
728
729 SND_SOC_DAPM_MUX("Linein Mux", SND_SOC_NOPM, 0, 0,
730 &max98095_linein_mux),
731
732 SND_SOC_DAPM_MIXER("Left Headphone Mixer", SND_SOC_NOPM, 0, 0,
733 &max98095_left_hp_mixer_controls[0],
734 ARRAY_SIZE(max98095_left_hp_mixer_controls)),
735
736 SND_SOC_DAPM_MIXER("Right Headphone Mixer", SND_SOC_NOPM, 0, 0,
737 &max98095_right_hp_mixer_controls[0],
738 ARRAY_SIZE(max98095_right_hp_mixer_controls)),
739
740 SND_SOC_DAPM_MIXER("Left Speaker Mixer", SND_SOC_NOPM, 0, 0,
741 &max98095_left_speaker_mixer_controls[0],
742 ARRAY_SIZE(max98095_left_speaker_mixer_controls)),
743
744 SND_SOC_DAPM_MIXER("Right Speaker Mixer", SND_SOC_NOPM, 0, 0,
745 &max98095_right_speaker_mixer_controls[0],
746 ARRAY_SIZE(max98095_right_speaker_mixer_controls)),
747
748 SND_SOC_DAPM_MIXER("Receiver Mixer", SND_SOC_NOPM, 0, 0,
749 &max98095_mono_rcv_mixer_controls[0],
750 ARRAY_SIZE(max98095_mono_rcv_mixer_controls)),
751
752 SND_SOC_DAPM_MIXER("Left Lineout Mixer", SND_SOC_NOPM, 0, 0,
753 &max98095_left_lineout_mixer_controls[0],
754 ARRAY_SIZE(max98095_left_lineout_mixer_controls)),
755
756 SND_SOC_DAPM_MIXER("Right Lineout Mixer", SND_SOC_NOPM, 0, 0,
757 &max98095_right_lineout_mixer_controls[0],
758 ARRAY_SIZE(max98095_right_lineout_mixer_controls)),
759
760 SND_SOC_DAPM_MIXER("Left ADC Mixer", SND_SOC_NOPM, 0, 0,
761 &max98095_left_ADC_mixer_controls[0],
762 ARRAY_SIZE(max98095_left_ADC_mixer_controls)),
763
764 SND_SOC_DAPM_MIXER("Right ADC Mixer", SND_SOC_NOPM, 0, 0,
765 &max98095_right_ADC_mixer_controls[0],
766 ARRAY_SIZE(max98095_right_ADC_mixer_controls)),
767
768 SND_SOC_DAPM_PGA_E("MIC1 Input", M98095_05F_LVL_MIC1,
769 5, 0, NULL, 0, max98095_mic_event,
770 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
771
772 SND_SOC_DAPM_PGA_E("MIC2 Input", M98095_060_LVL_MIC2,
773 5, 0, NULL, 0, max98095_mic_event,
774 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
775
776 SND_SOC_DAPM_PGA_E("IN1 Input", M98095_090_PWR_EN_IN,
777 7, 0, NULL, 0, max98095_pga_in1_event,
778 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
779
780 SND_SOC_DAPM_PGA_E("IN2 Input", M98095_090_PWR_EN_IN,
781 7, 0, NULL, 0, max98095_pga_in2_event,
782 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
783
784 SND_SOC_DAPM_MICBIAS("MICBIAS1", M98095_090_PWR_EN_IN, 2, 0),
785 SND_SOC_DAPM_MICBIAS("MICBIAS2", M98095_090_PWR_EN_IN, 3, 0),
786
787 SND_SOC_DAPM_OUTPUT("HPL"),
788 SND_SOC_DAPM_OUTPUT("HPR"),
789 SND_SOC_DAPM_OUTPUT("SPKL"),
790 SND_SOC_DAPM_OUTPUT("SPKR"),
791 SND_SOC_DAPM_OUTPUT("RCV"),
792 SND_SOC_DAPM_OUTPUT("OUT1"),
793 SND_SOC_DAPM_OUTPUT("OUT2"),
794 SND_SOC_DAPM_OUTPUT("OUT3"),
795 SND_SOC_DAPM_OUTPUT("OUT4"),
796
797 SND_SOC_DAPM_INPUT("MIC1"),
798 SND_SOC_DAPM_INPUT("MIC2"),
799 SND_SOC_DAPM_INPUT("INA1"),
800 SND_SOC_DAPM_INPUT("INA2"),
801 SND_SOC_DAPM_INPUT("INB1"),
802 SND_SOC_DAPM_INPUT("INB2"),
803};
804
805static const struct snd_soc_dapm_route max98095_audio_map[] = {
806 /* Left headphone output mixer */
807 {"Left Headphone Mixer", "Left DAC1 Switch", "DACL1"},
808 {"Left Headphone Mixer", "Right DAC1 Switch", "DACR1"},
809 {"Left Headphone Mixer", "MIC1 Switch", "MIC1 Input"},
810 {"Left Headphone Mixer", "MIC2 Switch", "MIC2 Input"},
811 {"Left Headphone Mixer", "IN1 Switch", "IN1 Input"},
812 {"Left Headphone Mixer", "IN2 Switch", "IN2 Input"},
813
814 /* Right headphone output mixer */
815 {"Right Headphone Mixer", "Left DAC1 Switch", "DACL1"},
816 {"Right Headphone Mixer", "Right DAC1 Switch", "DACR1"},
817 {"Right Headphone Mixer", "MIC1 Switch", "MIC1 Input"},
818 {"Right Headphone Mixer", "MIC2 Switch", "MIC2 Input"},
819 {"Right Headphone Mixer", "IN1 Switch", "IN1 Input"},
820 {"Right Headphone Mixer", "IN2 Switch", "IN2 Input"},
821
822 /* Left speaker output mixer */
823 {"Left Speaker Mixer", "Left DAC1 Switch", "DACL1"},
824 {"Left Speaker Mixer", "Right DAC1 Switch", "DACR1"},
825 {"Left Speaker Mixer", "Mono DAC2 Switch", "DACM2"},
826 {"Left Speaker Mixer", "Mono DAC3 Switch", "DACM3"},
827 {"Left Speaker Mixer", "MIC1 Switch", "MIC1 Input"},
828 {"Left Speaker Mixer", "MIC2 Switch", "MIC2 Input"},
829 {"Left Speaker Mixer", "IN1 Switch", "IN1 Input"},
830 {"Left Speaker Mixer", "IN2 Switch", "IN2 Input"},
831
832 /* Right speaker output mixer */
833 {"Right Speaker Mixer", "Left DAC1 Switch", "DACL1"},
834 {"Right Speaker Mixer", "Right DAC1 Switch", "DACR1"},
835 {"Right Speaker Mixer", "Mono DAC2 Switch", "DACM2"},
836 {"Right Speaker Mixer", "Mono DAC3 Switch", "DACM3"},
837 {"Right Speaker Mixer", "MIC1 Switch", "MIC1 Input"},
838 {"Right Speaker Mixer", "MIC2 Switch", "MIC2 Input"},
839 {"Right Speaker Mixer", "IN1 Switch", "IN1 Input"},
840 {"Right Speaker Mixer", "IN2 Switch", "IN2 Input"},
841
842 /* Earpiece/Receiver output mixer */
843 {"Receiver Mixer", "Left DAC1 Switch", "DACL1"},
844 {"Receiver Mixer", "Right DAC1 Switch", "DACR1"},
845 {"Receiver Mixer", "MIC1 Switch", "MIC1 Input"},
846 {"Receiver Mixer", "MIC2 Switch", "MIC2 Input"},
847 {"Receiver Mixer", "IN1 Switch", "IN1 Input"},
848 {"Receiver Mixer", "IN2 Switch", "IN2 Input"},
849
850 /* Left Lineout output mixer */
851 {"Left Lineout Mixer", "Left DAC1 Switch", "DACL1"},
852 {"Left Lineout Mixer", "Right DAC1 Switch", "DACR1"},
853 {"Left Lineout Mixer", "MIC1 Switch", "MIC1 Input"},
854 {"Left Lineout Mixer", "MIC2 Switch", "MIC2 Input"},
855 {"Left Lineout Mixer", "IN1 Switch", "IN1 Input"},
856 {"Left Lineout Mixer", "IN2 Switch", "IN2 Input"},
857
858 /* Right lineout output mixer */
859 {"Right Lineout Mixer", "Left DAC1 Switch", "DACL1"},
860 {"Right Lineout Mixer", "Right DAC1 Switch", "DACR1"},
861 {"Right Lineout Mixer", "MIC1 Switch", "MIC1 Input"},
862 {"Right Lineout Mixer", "MIC2 Switch", "MIC2 Input"},
863 {"Right Lineout Mixer", "IN1 Switch", "IN1 Input"},
864 {"Right Lineout Mixer", "IN2 Switch", "IN2 Input"},
865
866 {"HP Left Out", NULL, "Left Headphone Mixer"},
867 {"HP Right Out", NULL, "Right Headphone Mixer"},
868 {"SPK Left Out", NULL, "Left Speaker Mixer"},
869 {"SPK Right Out", NULL, "Right Speaker Mixer"},
870 {"RCV Mono Out", NULL, "Receiver Mixer"},
871 {"LINE Left Out", NULL, "Left Lineout Mixer"},
872 {"LINE Right Out", NULL, "Right Lineout Mixer"},
873
874 {"HPL", NULL, "HP Left Out"},
875 {"HPR", NULL, "HP Right Out"},
876 {"SPKL", NULL, "SPK Left Out"},
877 {"SPKR", NULL, "SPK Right Out"},
878 {"RCV", NULL, "RCV Mono Out"},
879 {"OUT1", NULL, "LINE Left Out"},
880 {"OUT2", NULL, "LINE Right Out"},
881 {"OUT3", NULL, "LINE Left Out"},
882 {"OUT4", NULL, "LINE Right Out"},
883
884 /* Left ADC input mixer */
885 {"Left ADC Mixer", "MIC1 Switch", "MIC1 Input"},
886 {"Left ADC Mixer", "MIC2 Switch", "MIC2 Input"},
887 {"Left ADC Mixer", "IN1 Switch", "IN1 Input"},
888 {"Left ADC Mixer", "IN2 Switch", "IN2 Input"},
889
890 /* Right ADC input mixer */
891 {"Right ADC Mixer", "MIC1 Switch", "MIC1 Input"},
892 {"Right ADC Mixer", "MIC2 Switch", "MIC2 Input"},
893 {"Right ADC Mixer", "IN1 Switch", "IN1 Input"},
894 {"Right ADC Mixer", "IN2 Switch", "IN2 Input"},
895
896 /* Inputs */
897 {"ADCL", NULL, "Left ADC Mixer"},
898 {"ADCR", NULL, "Right ADC Mixer"},
899
900 {"IN1 Input", NULL, "INA1"},
901 {"IN2 Input", NULL, "INA2"},
902
903 {"MIC1 Input", NULL, "MIC1"},
904 {"MIC2 Input", NULL, "MIC2"},
905};
906
907/* codec mclk clock divider coefficients */
908static const struct {
909 u32 rate;
910 u8 sr;
911} rate_table[] = {
912 {8000, 0x01},
913 {11025, 0x02},
914 {16000, 0x03},
915 {22050, 0x04},
916 {24000, 0x05},
917 {32000, 0x06},
918 {44100, 0x07},
919 {48000, 0x08},
920 {88200, 0x09},
921 {96000, 0x0A},
922};
923
924static int rate_value(int rate, u8 *value)
925{
926 int i;
927
928 for (i = 0; i < ARRAY_SIZE(rate_table); i++) {
929 if (rate_table[i].rate >= rate) {
930 *value = rate_table[i].sr;
931 return 0;
932 }
933 }
934 *value = rate_table[0].sr;
935 return -EINVAL;
936}
937
938static int max98095_dai1_hw_params(struct snd_pcm_substream *substream,
939 struct snd_pcm_hw_params *params,
940 struct snd_soc_dai *dai)
941{
942 struct snd_soc_component *component = dai->component;
943 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
944 struct max98095_cdata *cdata;
945 unsigned long long ni;
946 unsigned int rate;
947 u8 regval;
948
949 cdata = &max98095->dai[0];
950
951 rate = params_rate(params);
952
953 switch (params_width(params)) {
954 case 16:
955 snd_soc_component_update_bits(component, M98095_02A_DAI1_FORMAT,
956 M98095_DAI_WS, 0);
957 break;
958 case 24:
959 snd_soc_component_update_bits(component, M98095_02A_DAI1_FORMAT,
960 M98095_DAI_WS, M98095_DAI_WS);
961 break;
962 default:
963 return -EINVAL;
964 }
965
966 if (rate_value(rate, ®val))
967 return -EINVAL;
968
969 snd_soc_component_update_bits(component, M98095_027_DAI1_CLKMODE,
970 M98095_CLKMODE_MASK, regval);
971 cdata->rate = rate;
972
973 /* Configure NI when operating as master */
974 if (snd_soc_component_read(component, M98095_02A_DAI1_FORMAT) & M98095_DAI_MAS) {
975 if (max98095->sysclk == 0) {
976 dev_err(component->dev, "Invalid system clock frequency\n");
977 return -EINVAL;
978 }
979 ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
980 * (unsigned long long int)rate;
981 do_div(ni, (unsigned long long int)max98095->sysclk);
982 snd_soc_component_write(component, M98095_028_DAI1_CLKCFG_HI,
983 (ni >> 8) & 0x7F);
984 snd_soc_component_write(component, M98095_029_DAI1_CLKCFG_LO,
985 ni & 0xFF);
986 }
987
988 /* Update sample rate mode */
989 if (rate < 50000)
990 snd_soc_component_update_bits(component, M98095_02E_DAI1_FILTERS,
991 M98095_DAI_DHF, 0);
992 else
993 snd_soc_component_update_bits(component, M98095_02E_DAI1_FILTERS,
994 M98095_DAI_DHF, M98095_DAI_DHF);
995
996 return 0;
997}
998
999static int max98095_dai2_hw_params(struct snd_pcm_substream *substream,
1000 struct snd_pcm_hw_params *params,
1001 struct snd_soc_dai *dai)
1002{
1003 struct snd_soc_component *component = dai->component;
1004 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1005 struct max98095_cdata *cdata;
1006 unsigned long long ni;
1007 unsigned int rate;
1008 u8 regval;
1009
1010 cdata = &max98095->dai[1];
1011
1012 rate = params_rate(params);
1013
1014 switch (params_width(params)) {
1015 case 16:
1016 snd_soc_component_update_bits(component, M98095_034_DAI2_FORMAT,
1017 M98095_DAI_WS, 0);
1018 break;
1019 case 24:
1020 snd_soc_component_update_bits(component, M98095_034_DAI2_FORMAT,
1021 M98095_DAI_WS, M98095_DAI_WS);
1022 break;
1023 default:
1024 return -EINVAL;
1025 }
1026
1027 if (rate_value(rate, ®val))
1028 return -EINVAL;
1029
1030 snd_soc_component_update_bits(component, M98095_031_DAI2_CLKMODE,
1031 M98095_CLKMODE_MASK, regval);
1032 cdata->rate = rate;
1033
1034 /* Configure NI when operating as master */
1035 if (snd_soc_component_read(component, M98095_034_DAI2_FORMAT) & M98095_DAI_MAS) {
1036 if (max98095->sysclk == 0) {
1037 dev_err(component->dev, "Invalid system clock frequency\n");
1038 return -EINVAL;
1039 }
1040 ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
1041 * (unsigned long long int)rate;
1042 do_div(ni, (unsigned long long int)max98095->sysclk);
1043 snd_soc_component_write(component, M98095_032_DAI2_CLKCFG_HI,
1044 (ni >> 8) & 0x7F);
1045 snd_soc_component_write(component, M98095_033_DAI2_CLKCFG_LO,
1046 ni & 0xFF);
1047 }
1048
1049 /* Update sample rate mode */
1050 if (rate < 50000)
1051 snd_soc_component_update_bits(component, M98095_038_DAI2_FILTERS,
1052 M98095_DAI_DHF, 0);
1053 else
1054 snd_soc_component_update_bits(component, M98095_038_DAI2_FILTERS,
1055 M98095_DAI_DHF, M98095_DAI_DHF);
1056
1057 return 0;
1058}
1059
1060static int max98095_dai3_hw_params(struct snd_pcm_substream *substream,
1061 struct snd_pcm_hw_params *params,
1062 struct snd_soc_dai *dai)
1063{
1064 struct snd_soc_component *component = dai->component;
1065 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1066 struct max98095_cdata *cdata;
1067 unsigned long long ni;
1068 unsigned int rate;
1069 u8 regval;
1070
1071 cdata = &max98095->dai[2];
1072
1073 rate = params_rate(params);
1074
1075 switch (params_width(params)) {
1076 case 16:
1077 snd_soc_component_update_bits(component, M98095_03E_DAI3_FORMAT,
1078 M98095_DAI_WS, 0);
1079 break;
1080 case 24:
1081 snd_soc_component_update_bits(component, M98095_03E_DAI3_FORMAT,
1082 M98095_DAI_WS, M98095_DAI_WS);
1083 break;
1084 default:
1085 return -EINVAL;
1086 }
1087
1088 if (rate_value(rate, ®val))
1089 return -EINVAL;
1090
1091 snd_soc_component_update_bits(component, M98095_03B_DAI3_CLKMODE,
1092 M98095_CLKMODE_MASK, regval);
1093 cdata->rate = rate;
1094
1095 /* Configure NI when operating as master */
1096 if (snd_soc_component_read(component, M98095_03E_DAI3_FORMAT) & M98095_DAI_MAS) {
1097 if (max98095->sysclk == 0) {
1098 dev_err(component->dev, "Invalid system clock frequency\n");
1099 return -EINVAL;
1100 }
1101 ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
1102 * (unsigned long long int)rate;
1103 do_div(ni, (unsigned long long int)max98095->sysclk);
1104 snd_soc_component_write(component, M98095_03C_DAI3_CLKCFG_HI,
1105 (ni >> 8) & 0x7F);
1106 snd_soc_component_write(component, M98095_03D_DAI3_CLKCFG_LO,
1107 ni & 0xFF);
1108 }
1109
1110 /* Update sample rate mode */
1111 if (rate < 50000)
1112 snd_soc_component_update_bits(component, M98095_042_DAI3_FILTERS,
1113 M98095_DAI_DHF, 0);
1114 else
1115 snd_soc_component_update_bits(component, M98095_042_DAI3_FILTERS,
1116 M98095_DAI_DHF, M98095_DAI_DHF);
1117
1118 return 0;
1119}
1120
1121static int max98095_dai_set_sysclk(struct snd_soc_dai *dai,
1122 int clk_id, unsigned int freq, int dir)
1123{
1124 struct snd_soc_component *component = dai->component;
1125 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1126
1127 /* Requested clock frequency is already setup */
1128 if (freq == max98095->sysclk)
1129 return 0;
1130
1131 if (!IS_ERR(max98095->mclk)) {
1132 freq = clk_round_rate(max98095->mclk, freq);
1133 clk_set_rate(max98095->mclk, freq);
1134 }
1135
1136 /* Setup clocks for slave mode, and using the PLL
1137 * PSCLK = 0x01 (when master clk is 10MHz to 20MHz)
1138 * 0x02 (when master clk is 20MHz to 40MHz)..
1139 * 0x03 (when master clk is 40MHz to 60MHz)..
1140 */
1141 if ((freq >= 10000000) && (freq < 20000000)) {
1142 snd_soc_component_write(component, M98095_026_SYS_CLK, 0x10);
1143 } else if ((freq >= 20000000) && (freq < 40000000)) {
1144 snd_soc_component_write(component, M98095_026_SYS_CLK, 0x20);
1145 } else if ((freq >= 40000000) && (freq < 60000000)) {
1146 snd_soc_component_write(component, M98095_026_SYS_CLK, 0x30);
1147 } else {
1148 dev_err(component->dev, "Invalid master clock frequency\n");
1149 return -EINVAL;
1150 }
1151
1152 dev_dbg(dai->dev, "Clock source is %d at %uHz\n", clk_id, freq);
1153
1154 max98095->sysclk = freq;
1155 return 0;
1156}
1157
1158static int max98095_dai1_set_fmt(struct snd_soc_dai *codec_dai,
1159 unsigned int fmt)
1160{
1161 struct snd_soc_component *component = codec_dai->component;
1162 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1163 struct max98095_cdata *cdata;
1164 u8 regval = 0;
1165
1166 cdata = &max98095->dai[0];
1167
1168 if (fmt != cdata->fmt) {
1169 cdata->fmt = fmt;
1170
1171 switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
1172 case SND_SOC_DAIFMT_CBC_CFC:
1173 /* Consumer mode PLL */
1174 snd_soc_component_write(component, M98095_028_DAI1_CLKCFG_HI,
1175 0x80);
1176 snd_soc_component_write(component, M98095_029_DAI1_CLKCFG_LO,
1177 0x00);
1178 break;
1179 case SND_SOC_DAIFMT_CBP_CFP:
1180 /* Set to provider mode */
1181 regval |= M98095_DAI_MAS;
1182 break;
1183 default:
1184 dev_err(component->dev, "Clock mode unsupported");
1185 return -EINVAL;
1186 }
1187
1188 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1189 case SND_SOC_DAIFMT_I2S:
1190 regval |= M98095_DAI_DLY;
1191 break;
1192 case SND_SOC_DAIFMT_LEFT_J:
1193 break;
1194 default:
1195 return -EINVAL;
1196 }
1197
1198 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1199 case SND_SOC_DAIFMT_NB_NF:
1200 break;
1201 case SND_SOC_DAIFMT_NB_IF:
1202 regval |= M98095_DAI_WCI;
1203 break;
1204 case SND_SOC_DAIFMT_IB_NF:
1205 regval |= M98095_DAI_BCI;
1206 break;
1207 case SND_SOC_DAIFMT_IB_IF:
1208 regval |= M98095_DAI_BCI|M98095_DAI_WCI;
1209 break;
1210 default:
1211 return -EINVAL;
1212 }
1213
1214 snd_soc_component_update_bits(component, M98095_02A_DAI1_FORMAT,
1215 M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
1216 M98095_DAI_WCI, regval);
1217
1218 snd_soc_component_write(component, M98095_02B_DAI1_CLOCK, M98095_DAI_BSEL64);
1219 }
1220
1221 return 0;
1222}
1223
1224static int max98095_dai2_set_fmt(struct snd_soc_dai *codec_dai,
1225 unsigned int fmt)
1226{
1227 struct snd_soc_component *component = codec_dai->component;
1228 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1229 struct max98095_cdata *cdata;
1230 u8 regval = 0;
1231
1232 cdata = &max98095->dai[1];
1233
1234 if (fmt != cdata->fmt) {
1235 cdata->fmt = fmt;
1236
1237 switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
1238 case SND_SOC_DAIFMT_CBC_CFC:
1239 /* Consumer mode PLL */
1240 snd_soc_component_write(component, M98095_032_DAI2_CLKCFG_HI,
1241 0x80);
1242 snd_soc_component_write(component, M98095_033_DAI2_CLKCFG_LO,
1243 0x00);
1244 break;
1245 case SND_SOC_DAIFMT_CBP_CFP:
1246 /* Set to provider mode */
1247 regval |= M98095_DAI_MAS;
1248 break;
1249 default:
1250 dev_err(component->dev, "Clock mode unsupported");
1251 return -EINVAL;
1252 }
1253
1254 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1255 case SND_SOC_DAIFMT_I2S:
1256 regval |= M98095_DAI_DLY;
1257 break;
1258 case SND_SOC_DAIFMT_LEFT_J:
1259 break;
1260 default:
1261 return -EINVAL;
1262 }
1263
1264 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1265 case SND_SOC_DAIFMT_NB_NF:
1266 break;
1267 case SND_SOC_DAIFMT_NB_IF:
1268 regval |= M98095_DAI_WCI;
1269 break;
1270 case SND_SOC_DAIFMT_IB_NF:
1271 regval |= M98095_DAI_BCI;
1272 break;
1273 case SND_SOC_DAIFMT_IB_IF:
1274 regval |= M98095_DAI_BCI|M98095_DAI_WCI;
1275 break;
1276 default:
1277 return -EINVAL;
1278 }
1279
1280 snd_soc_component_update_bits(component, M98095_034_DAI2_FORMAT,
1281 M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
1282 M98095_DAI_WCI, regval);
1283
1284 snd_soc_component_write(component, M98095_035_DAI2_CLOCK,
1285 M98095_DAI_BSEL64);
1286 }
1287
1288 return 0;
1289}
1290
1291static int max98095_dai3_set_fmt(struct snd_soc_dai *codec_dai,
1292 unsigned int fmt)
1293{
1294 struct snd_soc_component *component = codec_dai->component;
1295 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1296 struct max98095_cdata *cdata;
1297 u8 regval = 0;
1298
1299 cdata = &max98095->dai[2];
1300
1301 if (fmt != cdata->fmt) {
1302 cdata->fmt = fmt;
1303
1304 switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
1305 case SND_SOC_DAIFMT_CBC_CFC:
1306 /* Consumer mode PLL */
1307 snd_soc_component_write(component, M98095_03C_DAI3_CLKCFG_HI,
1308 0x80);
1309 snd_soc_component_write(component, M98095_03D_DAI3_CLKCFG_LO,
1310 0x00);
1311 break;
1312 case SND_SOC_DAIFMT_CBP_CFP:
1313 /* Set to provider mode */
1314 regval |= M98095_DAI_MAS;
1315 break;
1316 default:
1317 dev_err(component->dev, "Clock mode unsupported");
1318 return -EINVAL;
1319 }
1320
1321 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1322 case SND_SOC_DAIFMT_I2S:
1323 regval |= M98095_DAI_DLY;
1324 break;
1325 case SND_SOC_DAIFMT_LEFT_J:
1326 break;
1327 default:
1328 return -EINVAL;
1329 }
1330
1331 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1332 case SND_SOC_DAIFMT_NB_NF:
1333 break;
1334 case SND_SOC_DAIFMT_NB_IF:
1335 regval |= M98095_DAI_WCI;
1336 break;
1337 case SND_SOC_DAIFMT_IB_NF:
1338 regval |= M98095_DAI_BCI;
1339 break;
1340 case SND_SOC_DAIFMT_IB_IF:
1341 regval |= M98095_DAI_BCI|M98095_DAI_WCI;
1342 break;
1343 default:
1344 return -EINVAL;
1345 }
1346
1347 snd_soc_component_update_bits(component, M98095_03E_DAI3_FORMAT,
1348 M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
1349 M98095_DAI_WCI, regval);
1350
1351 snd_soc_component_write(component, M98095_03F_DAI3_CLOCK,
1352 M98095_DAI_BSEL64);
1353 }
1354
1355 return 0;
1356}
1357
1358static int max98095_set_bias_level(struct snd_soc_component *component,
1359 enum snd_soc_bias_level level)
1360{
1361 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1362 int ret;
1363
1364 switch (level) {
1365 case SND_SOC_BIAS_ON:
1366 break;
1367
1368 case SND_SOC_BIAS_PREPARE:
1369 /*
1370 * SND_SOC_BIAS_PREPARE is called while preparing for a
1371 * transition to ON or away from ON. If current bias_level
1372 * is SND_SOC_BIAS_ON, then it is preparing for a transition
1373 * away from ON. Disable the clock in that case, otherwise
1374 * enable it.
1375 */
1376 if (IS_ERR(max98095->mclk))
1377 break;
1378
1379 if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_ON) {
1380 clk_disable_unprepare(max98095->mclk);
1381 } else {
1382 ret = clk_prepare_enable(max98095->mclk);
1383 if (ret)
1384 return ret;
1385 }
1386 break;
1387
1388 case SND_SOC_BIAS_STANDBY:
1389 if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) {
1390 ret = regcache_sync(max98095->regmap);
1391
1392 if (ret != 0) {
1393 dev_err(component->dev, "Failed to sync cache: %d\n", ret);
1394 return ret;
1395 }
1396 }
1397
1398 snd_soc_component_update_bits(component, M98095_090_PWR_EN_IN,
1399 M98095_MBEN, M98095_MBEN);
1400 break;
1401
1402 case SND_SOC_BIAS_OFF:
1403 snd_soc_component_update_bits(component, M98095_090_PWR_EN_IN,
1404 M98095_MBEN, 0);
1405 regcache_mark_dirty(max98095->regmap);
1406 break;
1407 }
1408 return 0;
1409}
1410
1411#define MAX98095_RATES SNDRV_PCM_RATE_8000_96000
1412#define MAX98095_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE)
1413
1414static const struct snd_soc_dai_ops max98095_dai1_ops = {
1415 .set_sysclk = max98095_dai_set_sysclk,
1416 .set_fmt = max98095_dai1_set_fmt,
1417 .hw_params = max98095_dai1_hw_params,
1418};
1419
1420static const struct snd_soc_dai_ops max98095_dai2_ops = {
1421 .set_sysclk = max98095_dai_set_sysclk,
1422 .set_fmt = max98095_dai2_set_fmt,
1423 .hw_params = max98095_dai2_hw_params,
1424};
1425
1426static const struct snd_soc_dai_ops max98095_dai3_ops = {
1427 .set_sysclk = max98095_dai_set_sysclk,
1428 .set_fmt = max98095_dai3_set_fmt,
1429 .hw_params = max98095_dai3_hw_params,
1430};
1431
1432static struct snd_soc_dai_driver max98095_dai[] = {
1433{
1434 .name = "HiFi",
1435 .playback = {
1436 .stream_name = "HiFi Playback",
1437 .channels_min = 1,
1438 .channels_max = 2,
1439 .rates = MAX98095_RATES,
1440 .formats = MAX98095_FORMATS,
1441 },
1442 .capture = {
1443 .stream_name = "HiFi Capture",
1444 .channels_min = 1,
1445 .channels_max = 2,
1446 .rates = MAX98095_RATES,
1447 .formats = MAX98095_FORMATS,
1448 },
1449 .ops = &max98095_dai1_ops,
1450},
1451{
1452 .name = "Aux",
1453 .playback = {
1454 .stream_name = "Aux Playback",
1455 .channels_min = 1,
1456 .channels_max = 1,
1457 .rates = MAX98095_RATES,
1458 .formats = MAX98095_FORMATS,
1459 },
1460 .ops = &max98095_dai2_ops,
1461},
1462{
1463 .name = "Voice",
1464 .playback = {
1465 .stream_name = "Voice Playback",
1466 .channels_min = 1,
1467 .channels_max = 1,
1468 .rates = MAX98095_RATES,
1469 .formats = MAX98095_FORMATS,
1470 },
1471 .ops = &max98095_dai3_ops,
1472}
1473
1474};
1475
1476static int max98095_get_eq_channel(const char *name)
1477{
1478 if (strcmp(name, "EQ1 Mode") == 0)
1479 return 0;
1480 if (strcmp(name, "EQ2 Mode") == 0)
1481 return 1;
1482 return -EINVAL;
1483}
1484
1485static int max98095_put_eq_enum(struct snd_kcontrol *kcontrol,
1486 struct snd_ctl_elem_value *ucontrol)
1487{
1488 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1489 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1490 struct max98095_pdata *pdata = max98095->pdata;
1491 int channel = max98095_get_eq_channel(kcontrol->id.name);
1492 struct max98095_cdata *cdata;
1493 unsigned int sel = ucontrol->value.enumerated.item[0];
1494 struct max98095_eq_cfg *coef_set;
1495 int fs, best, best_val, i;
1496 int regmask, regsave;
1497
1498 if (WARN_ON(channel > 1))
1499 return -EINVAL;
1500
1501 if (!pdata || !max98095->eq_textcnt)
1502 return 0;
1503
1504 if (sel >= pdata->eq_cfgcnt)
1505 return -EINVAL;
1506
1507 cdata = &max98095->dai[channel];
1508 cdata->eq_sel = sel;
1509 fs = cdata->rate;
1510
1511 /* Find the selected configuration with nearest sample rate */
1512 best = 0;
1513 best_val = INT_MAX;
1514 for (i = 0; i < pdata->eq_cfgcnt; i++) {
1515 if (strcmp(pdata->eq_cfg[i].name, max98095->eq_texts[sel]) == 0 &&
1516 abs(pdata->eq_cfg[i].rate - fs) < best_val) {
1517 best = i;
1518 best_val = abs(pdata->eq_cfg[i].rate - fs);
1519 }
1520 }
1521
1522 dev_dbg(component->dev, "Selected %s/%dHz for %dHz sample rate\n",
1523 pdata->eq_cfg[best].name,
1524 pdata->eq_cfg[best].rate, fs);
1525
1526 coef_set = &pdata->eq_cfg[best];
1527
1528 regmask = (channel == 0) ? M98095_EQ1EN : M98095_EQ2EN;
1529
1530 /* Disable filter while configuring, and save current on/off state */
1531 regsave = snd_soc_component_read(component, M98095_088_CFG_LEVEL);
1532 snd_soc_component_update_bits(component, M98095_088_CFG_LEVEL, regmask, 0);
1533
1534 mutex_lock(&max98095->lock);
1535 snd_soc_component_update_bits(component, M98095_00F_HOST_CFG, M98095_SEG, M98095_SEG);
1536 m98095_eq_band(component, channel, 0, coef_set->band1);
1537 m98095_eq_band(component, channel, 1, coef_set->band2);
1538 m98095_eq_band(component, channel, 2, coef_set->band3);
1539 m98095_eq_band(component, channel, 3, coef_set->band4);
1540 m98095_eq_band(component, channel, 4, coef_set->band5);
1541 snd_soc_component_update_bits(component, M98095_00F_HOST_CFG, M98095_SEG, 0);
1542 mutex_unlock(&max98095->lock);
1543
1544 /* Restore the original on/off state */
1545 snd_soc_component_update_bits(component, M98095_088_CFG_LEVEL, regmask, regsave);
1546 return 0;
1547}
1548
1549static int max98095_get_eq_enum(struct snd_kcontrol *kcontrol,
1550 struct snd_ctl_elem_value *ucontrol)
1551{
1552 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1553 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1554 int channel = max98095_get_eq_channel(kcontrol->id.name);
1555 struct max98095_cdata *cdata;
1556
1557 cdata = &max98095->dai[channel];
1558 ucontrol->value.enumerated.item[0] = cdata->eq_sel;
1559
1560 return 0;
1561}
1562
1563static void max98095_handle_eq_pdata(struct snd_soc_component *component)
1564{
1565 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1566 struct max98095_pdata *pdata = max98095->pdata;
1567 struct max98095_eq_cfg *cfg;
1568 unsigned int cfgcnt;
1569 int i, j;
1570 const char **t;
1571 int ret;
1572
1573 struct snd_kcontrol_new controls[] = {
1574 SOC_ENUM_EXT("EQ1 Mode",
1575 max98095->eq_enum,
1576 max98095_get_eq_enum,
1577 max98095_put_eq_enum),
1578 SOC_ENUM_EXT("EQ2 Mode",
1579 max98095->eq_enum,
1580 max98095_get_eq_enum,
1581 max98095_put_eq_enum),
1582 };
1583
1584 cfg = pdata->eq_cfg;
1585 cfgcnt = pdata->eq_cfgcnt;
1586
1587 /* Setup an array of texts for the equalizer enum.
1588 * This is based on Mark Brown's equalizer driver code.
1589 */
1590 max98095->eq_textcnt = 0;
1591 max98095->eq_texts = NULL;
1592 for (i = 0; i < cfgcnt; i++) {
1593 for (j = 0; j < max98095->eq_textcnt; j++) {
1594 if (strcmp(cfg[i].name, max98095->eq_texts[j]) == 0)
1595 break;
1596 }
1597
1598 if (j != max98095->eq_textcnt)
1599 continue;
1600
1601 /* Expand the array */
1602 t = krealloc(max98095->eq_texts,
1603 sizeof(char *) * (max98095->eq_textcnt + 1),
1604 GFP_KERNEL);
1605 if (t == NULL)
1606 continue;
1607
1608 /* Store the new entry */
1609 t[max98095->eq_textcnt] = cfg[i].name;
1610 max98095->eq_textcnt++;
1611 max98095->eq_texts = t;
1612 }
1613
1614 /* Now point the soc_enum to .texts array items */
1615 max98095->eq_enum.texts = max98095->eq_texts;
1616 max98095->eq_enum.items = max98095->eq_textcnt;
1617
1618 ret = snd_soc_add_component_controls(component, controls, ARRAY_SIZE(controls));
1619 if (ret != 0)
1620 dev_err(component->dev, "Failed to add EQ control: %d\n", ret);
1621}
1622
1623static const char *bq_mode_name[] = {"Biquad1 Mode", "Biquad2 Mode"};
1624
1625static int max98095_get_bq_channel(struct snd_soc_component *component,
1626 const char *name)
1627{
1628 int ret;
1629
1630 ret = match_string(bq_mode_name, ARRAY_SIZE(bq_mode_name), name);
1631 if (ret < 0)
1632 dev_err(component->dev, "Bad biquad channel name '%s'\n", name);
1633 return ret;
1634}
1635
1636static int max98095_put_bq_enum(struct snd_kcontrol *kcontrol,
1637 struct snd_ctl_elem_value *ucontrol)
1638{
1639 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1640 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1641 struct max98095_pdata *pdata = max98095->pdata;
1642 int channel = max98095_get_bq_channel(component, kcontrol->id.name);
1643 struct max98095_cdata *cdata;
1644 unsigned int sel = ucontrol->value.enumerated.item[0];
1645 struct max98095_biquad_cfg *coef_set;
1646 int fs, best, best_val, i;
1647 int regmask, regsave;
1648
1649 if (channel < 0)
1650 return channel;
1651
1652 if (!pdata || !max98095->bq_textcnt)
1653 return 0;
1654
1655 if (sel >= pdata->bq_cfgcnt)
1656 return -EINVAL;
1657
1658 cdata = &max98095->dai[channel];
1659 cdata->bq_sel = sel;
1660 fs = cdata->rate;
1661
1662 /* Find the selected configuration with nearest sample rate */
1663 best = 0;
1664 best_val = INT_MAX;
1665 for (i = 0; i < pdata->bq_cfgcnt; i++) {
1666 if (strcmp(pdata->bq_cfg[i].name, max98095->bq_texts[sel]) == 0 &&
1667 abs(pdata->bq_cfg[i].rate - fs) < best_val) {
1668 best = i;
1669 best_val = abs(pdata->bq_cfg[i].rate - fs);
1670 }
1671 }
1672
1673 dev_dbg(component->dev, "Selected %s/%dHz for %dHz sample rate\n",
1674 pdata->bq_cfg[best].name,
1675 pdata->bq_cfg[best].rate, fs);
1676
1677 coef_set = &pdata->bq_cfg[best];
1678
1679 regmask = (channel == 0) ? M98095_BQ1EN : M98095_BQ2EN;
1680
1681 /* Disable filter while configuring, and save current on/off state */
1682 regsave = snd_soc_component_read(component, M98095_088_CFG_LEVEL);
1683 snd_soc_component_update_bits(component, M98095_088_CFG_LEVEL, regmask, 0);
1684
1685 mutex_lock(&max98095->lock);
1686 snd_soc_component_update_bits(component, M98095_00F_HOST_CFG, M98095_SEG, M98095_SEG);
1687 m98095_biquad_band(component, channel, 0, coef_set->band1);
1688 m98095_biquad_band(component, channel, 1, coef_set->band2);
1689 snd_soc_component_update_bits(component, M98095_00F_HOST_CFG, M98095_SEG, 0);
1690 mutex_unlock(&max98095->lock);
1691
1692 /* Restore the original on/off state */
1693 snd_soc_component_update_bits(component, M98095_088_CFG_LEVEL, regmask, regsave);
1694 return 0;
1695}
1696
1697static int max98095_get_bq_enum(struct snd_kcontrol *kcontrol,
1698 struct snd_ctl_elem_value *ucontrol)
1699{
1700 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
1701 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1702 int channel = max98095_get_bq_channel(component, kcontrol->id.name);
1703 struct max98095_cdata *cdata;
1704
1705 if (channel < 0)
1706 return channel;
1707
1708 cdata = &max98095->dai[channel];
1709 ucontrol->value.enumerated.item[0] = cdata->bq_sel;
1710
1711 return 0;
1712}
1713
1714static void max98095_handle_bq_pdata(struct snd_soc_component *component)
1715{
1716 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1717 struct max98095_pdata *pdata = max98095->pdata;
1718 struct max98095_biquad_cfg *cfg;
1719 unsigned int cfgcnt;
1720 int i, j;
1721 const char **t;
1722 int ret;
1723
1724 struct snd_kcontrol_new controls[] = {
1725 SOC_ENUM_EXT((char *)bq_mode_name[0],
1726 max98095->bq_enum,
1727 max98095_get_bq_enum,
1728 max98095_put_bq_enum),
1729 SOC_ENUM_EXT((char *)bq_mode_name[1],
1730 max98095->bq_enum,
1731 max98095_get_bq_enum,
1732 max98095_put_bq_enum),
1733 };
1734 BUILD_BUG_ON(ARRAY_SIZE(controls) != ARRAY_SIZE(bq_mode_name));
1735
1736 cfg = pdata->bq_cfg;
1737 cfgcnt = pdata->bq_cfgcnt;
1738
1739 /* Setup an array of texts for the biquad enum.
1740 * This is based on Mark Brown's equalizer driver code.
1741 */
1742 max98095->bq_textcnt = 0;
1743 max98095->bq_texts = NULL;
1744 for (i = 0; i < cfgcnt; i++) {
1745 for (j = 0; j < max98095->bq_textcnt; j++) {
1746 if (strcmp(cfg[i].name, max98095->bq_texts[j]) == 0)
1747 break;
1748 }
1749
1750 if (j != max98095->bq_textcnt)
1751 continue;
1752
1753 /* Expand the array */
1754 t = krealloc(max98095->bq_texts,
1755 sizeof(char *) * (max98095->bq_textcnt + 1),
1756 GFP_KERNEL);
1757 if (t == NULL)
1758 continue;
1759
1760 /* Store the new entry */
1761 t[max98095->bq_textcnt] = cfg[i].name;
1762 max98095->bq_textcnt++;
1763 max98095->bq_texts = t;
1764 }
1765
1766 /* Now point the soc_enum to .texts array items */
1767 max98095->bq_enum.texts = max98095->bq_texts;
1768 max98095->bq_enum.items = max98095->bq_textcnt;
1769
1770 ret = snd_soc_add_component_controls(component, controls, ARRAY_SIZE(controls));
1771 if (ret != 0)
1772 dev_err(component->dev, "Failed to add Biquad control: %d\n", ret);
1773}
1774
1775static void max98095_handle_pdata(struct snd_soc_component *component)
1776{
1777 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1778 struct max98095_pdata *pdata = max98095->pdata;
1779 u8 regval = 0;
1780
1781 if (!pdata) {
1782 dev_dbg(component->dev, "No platform data\n");
1783 return;
1784 }
1785
1786 /* Configure mic for analog/digital mic mode */
1787 if (pdata->digmic_left_mode)
1788 regval |= M98095_DIGMIC_L;
1789
1790 if (pdata->digmic_right_mode)
1791 regval |= M98095_DIGMIC_R;
1792
1793 snd_soc_component_write(component, M98095_087_CFG_MIC, regval);
1794
1795 /* Configure equalizers */
1796 if (pdata->eq_cfgcnt)
1797 max98095_handle_eq_pdata(component);
1798
1799 /* Configure bi-quad filters */
1800 if (pdata->bq_cfgcnt)
1801 max98095_handle_bq_pdata(component);
1802}
1803
1804static irqreturn_t max98095_report_jack(int irq, void *data)
1805{
1806 struct snd_soc_component *component = data;
1807 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1808 unsigned int value;
1809 int hp_report = 0;
1810 int mic_report = 0;
1811
1812 /* Read the Jack Status Register */
1813 value = snd_soc_component_read(component, M98095_007_JACK_AUTO_STS);
1814
1815 /* If ddone is not set, then detection isn't finished yet */
1816 if ((value & M98095_DDONE) == 0)
1817 return IRQ_NONE;
1818
1819 /* if hp, check its bit, and if set, clear it */
1820 if ((value & M98095_HP_IN || value & M98095_LO_IN) &&
1821 max98095->headphone_jack)
1822 hp_report |= SND_JACK_HEADPHONE;
1823
1824 /* if mic, check its bit, and if set, clear it */
1825 if ((value & M98095_MIC_IN) && max98095->mic_jack)
1826 mic_report |= SND_JACK_MICROPHONE;
1827
1828 if (max98095->headphone_jack == max98095->mic_jack) {
1829 snd_soc_jack_report(max98095->headphone_jack,
1830 hp_report | mic_report,
1831 SND_JACK_HEADSET);
1832 } else {
1833 if (max98095->headphone_jack)
1834 snd_soc_jack_report(max98095->headphone_jack,
1835 hp_report, SND_JACK_HEADPHONE);
1836 if (max98095->mic_jack)
1837 snd_soc_jack_report(max98095->mic_jack,
1838 mic_report, SND_JACK_MICROPHONE);
1839 }
1840
1841 return IRQ_HANDLED;
1842}
1843
1844static int max98095_jack_detect_enable(struct snd_soc_component *component)
1845{
1846 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1847 int ret = 0;
1848 int detect_enable = M98095_JDEN;
1849 unsigned int slew = M98095_DEFAULT_SLEW_DELAY;
1850
1851 if (max98095->pdata->jack_detect_pin5en)
1852 detect_enable |= M98095_PIN5EN;
1853
1854 if (max98095->pdata->jack_detect_delay)
1855 slew = max98095->pdata->jack_detect_delay;
1856
1857 ret = snd_soc_component_write(component, M98095_08E_JACK_DC_SLEW, slew);
1858 if (ret < 0) {
1859 dev_err(component->dev, "Failed to cfg auto detect %d\n", ret);
1860 return ret;
1861 }
1862
1863 /* configure auto detection to be enabled */
1864 ret = snd_soc_component_write(component, M98095_089_JACK_DET_AUTO, detect_enable);
1865 if (ret < 0) {
1866 dev_err(component->dev, "Failed to cfg auto detect %d\n", ret);
1867 return ret;
1868 }
1869
1870 return ret;
1871}
1872
1873static int max98095_jack_detect_disable(struct snd_soc_component *component)
1874{
1875 int ret = 0;
1876
1877 /* configure auto detection to be disabled */
1878 ret = snd_soc_component_write(component, M98095_089_JACK_DET_AUTO, 0x0);
1879 if (ret < 0) {
1880 dev_err(component->dev, "Failed to cfg auto detect %d\n", ret);
1881 return ret;
1882 }
1883
1884 return ret;
1885}
1886
1887int max98095_jack_detect(struct snd_soc_component *component,
1888 struct snd_soc_jack *hp_jack, struct snd_soc_jack *mic_jack)
1889{
1890 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1891 struct i2c_client *client = to_i2c_client(component->dev);
1892 int ret = 0;
1893
1894 max98095->headphone_jack = hp_jack;
1895 max98095->mic_jack = mic_jack;
1896
1897 /* only progress if we have at least 1 jack pointer */
1898 if (!hp_jack && !mic_jack)
1899 return -EINVAL;
1900
1901 max98095_jack_detect_enable(component);
1902
1903 /* enable interrupts for headphone jack detection */
1904 ret = snd_soc_component_update_bits(component, M98095_013_JACK_INT_EN,
1905 M98095_IDDONE, M98095_IDDONE);
1906 if (ret < 0) {
1907 dev_err(component->dev, "Failed to cfg jack irqs %d\n", ret);
1908 return ret;
1909 }
1910
1911 max98095_report_jack(client->irq, component);
1912 return 0;
1913}
1914EXPORT_SYMBOL_GPL(max98095_jack_detect);
1915
1916#ifdef CONFIG_PM
1917static int max98095_suspend(struct snd_soc_component *component)
1918{
1919 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1920
1921 if (max98095->headphone_jack || max98095->mic_jack)
1922 max98095_jack_detect_disable(component);
1923
1924 snd_soc_component_force_bias_level(component, SND_SOC_BIAS_OFF);
1925
1926 return 0;
1927}
1928
1929static int max98095_resume(struct snd_soc_component *component)
1930{
1931 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1932 struct i2c_client *client = to_i2c_client(component->dev);
1933
1934 snd_soc_component_force_bias_level(component, SND_SOC_BIAS_STANDBY);
1935
1936 if (max98095->headphone_jack || max98095->mic_jack) {
1937 max98095_jack_detect_enable(component);
1938 max98095_report_jack(client->irq, component);
1939 }
1940
1941 return 0;
1942}
1943#else
1944#define max98095_suspend NULL
1945#define max98095_resume NULL
1946#endif
1947
1948static int max98095_reset(struct snd_soc_component *component)
1949{
1950 int i, ret;
1951
1952 /* Gracefully reset the DSP core and the codec hardware
1953 * in a proper sequence */
1954 ret = snd_soc_component_write(component, M98095_00F_HOST_CFG, 0);
1955 if (ret < 0) {
1956 dev_err(component->dev, "Failed to reset DSP: %d\n", ret);
1957 return ret;
1958 }
1959
1960 ret = snd_soc_component_write(component, M98095_097_PWR_SYS, 0);
1961 if (ret < 0) {
1962 dev_err(component->dev, "Failed to reset component: %d\n", ret);
1963 return ret;
1964 }
1965
1966 /* Reset to hardware default for registers, as there is not
1967 * a soft reset hardware control register */
1968 for (i = M98095_010_HOST_INT_CFG; i < M98095_REG_MAX_CACHED; i++) {
1969 ret = snd_soc_component_write(component, i, snd_soc_component_read(component, i));
1970 if (ret < 0) {
1971 dev_err(component->dev, "Failed to reset: %d\n", ret);
1972 return ret;
1973 }
1974 }
1975
1976 return ret;
1977}
1978
1979static int max98095_probe(struct snd_soc_component *component)
1980{
1981 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
1982 struct max98095_cdata *cdata;
1983 struct i2c_client *client;
1984 int ret = 0;
1985
1986 max98095->mclk = devm_clk_get(component->dev, "mclk");
1987 if (PTR_ERR(max98095->mclk) == -EPROBE_DEFER)
1988 return -EPROBE_DEFER;
1989
1990 /* reset the codec, the DSP core, and disable all interrupts */
1991 max98095_reset(component);
1992
1993 client = to_i2c_client(component->dev);
1994
1995 /* initialize private data */
1996
1997 max98095->sysclk = (unsigned)-1;
1998 max98095->eq_textcnt = 0;
1999 max98095->bq_textcnt = 0;
2000
2001 cdata = &max98095->dai[0];
2002 cdata->rate = (unsigned)-1;
2003 cdata->fmt = (unsigned)-1;
2004 cdata->eq_sel = 0;
2005 cdata->bq_sel = 0;
2006
2007 cdata = &max98095->dai[1];
2008 cdata->rate = (unsigned)-1;
2009 cdata->fmt = (unsigned)-1;
2010 cdata->eq_sel = 0;
2011 cdata->bq_sel = 0;
2012
2013 cdata = &max98095->dai[2];
2014 cdata->rate = (unsigned)-1;
2015 cdata->fmt = (unsigned)-1;
2016 cdata->eq_sel = 0;
2017 cdata->bq_sel = 0;
2018
2019 max98095->lin_state = 0;
2020 max98095->mic1pre = 0;
2021 max98095->mic2pre = 0;
2022
2023 if (client->irq) {
2024 /* register an audio interrupt */
2025 ret = request_threaded_irq(client->irq, NULL,
2026 max98095_report_jack,
2027 IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING |
2028 IRQF_ONESHOT, "max98095", component);
2029 if (ret) {
2030 dev_err(component->dev, "Failed to request IRQ: %d\n", ret);
2031 goto err_access;
2032 }
2033 }
2034
2035 ret = snd_soc_component_read(component, M98095_0FF_REV_ID);
2036 if (ret < 0) {
2037 dev_err(component->dev, "Failure reading hardware revision: %d\n",
2038 ret);
2039 goto err_irq;
2040 }
2041 dev_info(component->dev, "Hardware revision: %c\n", ret - 0x40 + 'A');
2042
2043 snd_soc_component_write(component, M98095_097_PWR_SYS, M98095_PWRSV);
2044
2045 snd_soc_component_write(component, M98095_048_MIX_DAC_LR,
2046 M98095_DAI1L_TO_DACL|M98095_DAI1R_TO_DACR);
2047
2048 snd_soc_component_write(component, M98095_049_MIX_DAC_M,
2049 M98095_DAI2M_TO_DACM|M98095_DAI3M_TO_DACM);
2050
2051 snd_soc_component_write(component, M98095_092_PWR_EN_OUT, M98095_SPK_SPREADSPECTRUM);
2052 snd_soc_component_write(component, M98095_045_CFG_DSP, M98095_DSPNORMAL);
2053 snd_soc_component_write(component, M98095_04E_CFG_HP, M98095_HPNORMAL);
2054
2055 snd_soc_component_write(component, M98095_02C_DAI1_IOCFG,
2056 M98095_S1NORMAL|M98095_SDATA);
2057
2058 snd_soc_component_write(component, M98095_036_DAI2_IOCFG,
2059 M98095_S2NORMAL|M98095_SDATA);
2060
2061 snd_soc_component_write(component, M98095_040_DAI3_IOCFG,
2062 M98095_S3NORMAL|M98095_SDATA);
2063
2064 max98095_handle_pdata(component);
2065
2066 /* take the codec out of the shut down */
2067 snd_soc_component_update_bits(component, M98095_097_PWR_SYS, M98095_SHDNRUN,
2068 M98095_SHDNRUN);
2069
2070 return 0;
2071
2072err_irq:
2073 if (client->irq)
2074 free_irq(client->irq, component);
2075err_access:
2076 return ret;
2077}
2078
2079static void max98095_remove(struct snd_soc_component *component)
2080{
2081 struct max98095_priv *max98095 = snd_soc_component_get_drvdata(component);
2082 struct i2c_client *client = to_i2c_client(component->dev);
2083
2084 if (max98095->headphone_jack || max98095->mic_jack)
2085 max98095_jack_detect_disable(component);
2086
2087 if (client->irq)
2088 free_irq(client->irq, component);
2089}
2090
2091static const struct snd_soc_component_driver soc_component_dev_max98095 = {
2092 .probe = max98095_probe,
2093 .remove = max98095_remove,
2094 .suspend = max98095_suspend,
2095 .resume = max98095_resume,
2096 .set_bias_level = max98095_set_bias_level,
2097 .controls = max98095_snd_controls,
2098 .num_controls = ARRAY_SIZE(max98095_snd_controls),
2099 .dapm_widgets = max98095_dapm_widgets,
2100 .num_dapm_widgets = ARRAY_SIZE(max98095_dapm_widgets),
2101 .dapm_routes = max98095_audio_map,
2102 .num_dapm_routes = ARRAY_SIZE(max98095_audio_map),
2103 .idle_bias_on = 1,
2104 .use_pmdown_time = 1,
2105 .endianness = 1,
2106};
2107
2108static const struct i2c_device_id max98095_i2c_id[] = {
2109 { "max98095", MAX98095 },
2110 { }
2111};
2112MODULE_DEVICE_TABLE(i2c, max98095_i2c_id);
2113
2114static int max98095_i2c_probe(struct i2c_client *i2c)
2115{
2116 struct max98095_priv *max98095;
2117 int ret;
2118 const struct i2c_device_id *id;
2119
2120 max98095 = devm_kzalloc(&i2c->dev, sizeof(struct max98095_priv),
2121 GFP_KERNEL);
2122 if (max98095 == NULL)
2123 return -ENOMEM;
2124
2125 mutex_init(&max98095->lock);
2126
2127 max98095->regmap = devm_regmap_init_i2c(i2c, &max98095_regmap);
2128 if (IS_ERR(max98095->regmap)) {
2129 ret = PTR_ERR(max98095->regmap);
2130 dev_err(&i2c->dev, "Failed to allocate regmap: %d\n", ret);
2131 return ret;
2132 }
2133
2134 id = i2c_match_id(max98095_i2c_id, i2c);
2135 max98095->devtype = id->driver_data;
2136 i2c_set_clientdata(i2c, max98095);
2137 max98095->pdata = i2c->dev.platform_data;
2138
2139 ret = devm_snd_soc_register_component(&i2c->dev,
2140 &soc_component_dev_max98095,
2141 max98095_dai, ARRAY_SIZE(max98095_dai));
2142 return ret;
2143}
2144
2145#ifdef CONFIG_OF
2146static const struct of_device_id max98095_of_match[] = {
2147 { .compatible = "maxim,max98095", },
2148 { }
2149};
2150MODULE_DEVICE_TABLE(of, max98095_of_match);
2151#endif
2152
2153static struct i2c_driver max98095_i2c_driver = {
2154 .driver = {
2155 .name = "max98095",
2156 .of_match_table = of_match_ptr(max98095_of_match),
2157 },
2158 .probe = max98095_i2c_probe,
2159 .id_table = max98095_i2c_id,
2160};
2161
2162module_i2c_driver(max98095_i2c_driver);
2163
2164MODULE_DESCRIPTION("ALSA SoC MAX98095 driver");
2165MODULE_AUTHOR("Peter Hsiang");
2166MODULE_LICENSE("GPL");
1/*
2 * max98095.c -- MAX98095 ALSA SoC Audio driver
3 *
4 * Copyright 2011 Maxim Integrated Products
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 */
10
11#include <linux/module.h>
12#include <linux/moduleparam.h>
13#include <linux/kernel.h>
14#include <linux/init.h>
15#include <linux/delay.h>
16#include <linux/pm.h>
17#include <linux/i2c.h>
18#include <linux/platform_device.h>
19#include <sound/core.h>
20#include <sound/pcm.h>
21#include <sound/pcm_params.h>
22#include <sound/soc.h>
23#include <sound/initval.h>
24#include <sound/tlv.h>
25#include <linux/slab.h>
26#include <asm/div64.h>
27#include <sound/max98095.h>
28#include "max98095.h"
29
30enum max98095_type {
31 MAX98095,
32};
33
34struct max98095_cdata {
35 unsigned int rate;
36 unsigned int fmt;
37 int eq_sel;
38 int bq_sel;
39};
40
41struct max98095_priv {
42 enum max98095_type devtype;
43 void *control_data;
44 struct max98095_pdata *pdata;
45 unsigned int sysclk;
46 struct max98095_cdata dai[3];
47 const char **eq_texts;
48 const char **bq_texts;
49 struct soc_enum eq_enum;
50 struct soc_enum bq_enum;
51 int eq_textcnt;
52 int bq_textcnt;
53 u8 lin_state;
54 unsigned int mic1pre;
55 unsigned int mic2pre;
56};
57
58static const u8 max98095_reg_def[M98095_REG_CNT] = {
59 0x00, /* 00 */
60 0x00, /* 01 */
61 0x00, /* 02 */
62 0x00, /* 03 */
63 0x00, /* 04 */
64 0x00, /* 05 */
65 0x00, /* 06 */
66 0x00, /* 07 */
67 0x00, /* 08 */
68 0x00, /* 09 */
69 0x00, /* 0A */
70 0x00, /* 0B */
71 0x00, /* 0C */
72 0x00, /* 0D */
73 0x00, /* 0E */
74 0x00, /* 0F */
75 0x00, /* 10 */
76 0x00, /* 11 */
77 0x00, /* 12 */
78 0x00, /* 13 */
79 0x00, /* 14 */
80 0x00, /* 15 */
81 0x00, /* 16 */
82 0x00, /* 17 */
83 0x00, /* 18 */
84 0x00, /* 19 */
85 0x00, /* 1A */
86 0x00, /* 1B */
87 0x00, /* 1C */
88 0x00, /* 1D */
89 0x00, /* 1E */
90 0x00, /* 1F */
91 0x00, /* 20 */
92 0x00, /* 21 */
93 0x00, /* 22 */
94 0x00, /* 23 */
95 0x00, /* 24 */
96 0x00, /* 25 */
97 0x00, /* 26 */
98 0x00, /* 27 */
99 0x00, /* 28 */
100 0x00, /* 29 */
101 0x00, /* 2A */
102 0x00, /* 2B */
103 0x00, /* 2C */
104 0x00, /* 2D */
105 0x00, /* 2E */
106 0x00, /* 2F */
107 0x00, /* 30 */
108 0x00, /* 31 */
109 0x00, /* 32 */
110 0x00, /* 33 */
111 0x00, /* 34 */
112 0x00, /* 35 */
113 0x00, /* 36 */
114 0x00, /* 37 */
115 0x00, /* 38 */
116 0x00, /* 39 */
117 0x00, /* 3A */
118 0x00, /* 3B */
119 0x00, /* 3C */
120 0x00, /* 3D */
121 0x00, /* 3E */
122 0x00, /* 3F */
123 0x00, /* 40 */
124 0x00, /* 41 */
125 0x00, /* 42 */
126 0x00, /* 43 */
127 0x00, /* 44 */
128 0x00, /* 45 */
129 0x00, /* 46 */
130 0x00, /* 47 */
131 0x00, /* 48 */
132 0x00, /* 49 */
133 0x00, /* 4A */
134 0x00, /* 4B */
135 0x00, /* 4C */
136 0x00, /* 4D */
137 0x00, /* 4E */
138 0x00, /* 4F */
139 0x00, /* 50 */
140 0x00, /* 51 */
141 0x00, /* 52 */
142 0x00, /* 53 */
143 0x00, /* 54 */
144 0x00, /* 55 */
145 0x00, /* 56 */
146 0x00, /* 57 */
147 0x00, /* 58 */
148 0x00, /* 59 */
149 0x00, /* 5A */
150 0x00, /* 5B */
151 0x00, /* 5C */
152 0x00, /* 5D */
153 0x00, /* 5E */
154 0x00, /* 5F */
155 0x00, /* 60 */
156 0x00, /* 61 */
157 0x00, /* 62 */
158 0x00, /* 63 */
159 0x00, /* 64 */
160 0x00, /* 65 */
161 0x00, /* 66 */
162 0x00, /* 67 */
163 0x00, /* 68 */
164 0x00, /* 69 */
165 0x00, /* 6A */
166 0x00, /* 6B */
167 0x00, /* 6C */
168 0x00, /* 6D */
169 0x00, /* 6E */
170 0x00, /* 6F */
171 0x00, /* 70 */
172 0x00, /* 71 */
173 0x00, /* 72 */
174 0x00, /* 73 */
175 0x00, /* 74 */
176 0x00, /* 75 */
177 0x00, /* 76 */
178 0x00, /* 77 */
179 0x00, /* 78 */
180 0x00, /* 79 */
181 0x00, /* 7A */
182 0x00, /* 7B */
183 0x00, /* 7C */
184 0x00, /* 7D */
185 0x00, /* 7E */
186 0x00, /* 7F */
187 0x00, /* 80 */
188 0x00, /* 81 */
189 0x00, /* 82 */
190 0x00, /* 83 */
191 0x00, /* 84 */
192 0x00, /* 85 */
193 0x00, /* 86 */
194 0x00, /* 87 */
195 0x00, /* 88 */
196 0x00, /* 89 */
197 0x00, /* 8A */
198 0x00, /* 8B */
199 0x00, /* 8C */
200 0x00, /* 8D */
201 0x00, /* 8E */
202 0x00, /* 8F */
203 0x00, /* 90 */
204 0x00, /* 91 */
205 0x30, /* 92 */
206 0xF0, /* 93 */
207 0x00, /* 94 */
208 0x00, /* 95 */
209 0x3F, /* 96 */
210 0x00, /* 97 */
211 0x00, /* 98 */
212 0x00, /* 99 */
213 0x00, /* 9A */
214 0x00, /* 9B */
215 0x00, /* 9C */
216 0x00, /* 9D */
217 0x00, /* 9E */
218 0x00, /* 9F */
219 0x00, /* A0 */
220 0x00, /* A1 */
221 0x00, /* A2 */
222 0x00, /* A3 */
223 0x00, /* A4 */
224 0x00, /* A5 */
225 0x00, /* A6 */
226 0x00, /* A7 */
227 0x00, /* A8 */
228 0x00, /* A9 */
229 0x00, /* AA */
230 0x00, /* AB */
231 0x00, /* AC */
232 0x00, /* AD */
233 0x00, /* AE */
234 0x00, /* AF */
235 0x00, /* B0 */
236 0x00, /* B1 */
237 0x00, /* B2 */
238 0x00, /* B3 */
239 0x00, /* B4 */
240 0x00, /* B5 */
241 0x00, /* B6 */
242 0x00, /* B7 */
243 0x00, /* B8 */
244 0x00, /* B9 */
245 0x00, /* BA */
246 0x00, /* BB */
247 0x00, /* BC */
248 0x00, /* BD */
249 0x00, /* BE */
250 0x00, /* BF */
251 0x00, /* C0 */
252 0x00, /* C1 */
253 0x00, /* C2 */
254 0x00, /* C3 */
255 0x00, /* C4 */
256 0x00, /* C5 */
257 0x00, /* C6 */
258 0x00, /* C7 */
259 0x00, /* C8 */
260 0x00, /* C9 */
261 0x00, /* CA */
262 0x00, /* CB */
263 0x00, /* CC */
264 0x00, /* CD */
265 0x00, /* CE */
266 0x00, /* CF */
267 0x00, /* D0 */
268 0x00, /* D1 */
269 0x00, /* D2 */
270 0x00, /* D3 */
271 0x00, /* D4 */
272 0x00, /* D5 */
273 0x00, /* D6 */
274 0x00, /* D7 */
275 0x00, /* D8 */
276 0x00, /* D9 */
277 0x00, /* DA */
278 0x00, /* DB */
279 0x00, /* DC */
280 0x00, /* DD */
281 0x00, /* DE */
282 0x00, /* DF */
283 0x00, /* E0 */
284 0x00, /* E1 */
285 0x00, /* E2 */
286 0x00, /* E3 */
287 0x00, /* E4 */
288 0x00, /* E5 */
289 0x00, /* E6 */
290 0x00, /* E7 */
291 0x00, /* E8 */
292 0x00, /* E9 */
293 0x00, /* EA */
294 0x00, /* EB */
295 0x00, /* EC */
296 0x00, /* ED */
297 0x00, /* EE */
298 0x00, /* EF */
299 0x00, /* F0 */
300 0x00, /* F1 */
301 0x00, /* F2 */
302 0x00, /* F3 */
303 0x00, /* F4 */
304 0x00, /* F5 */
305 0x00, /* F6 */
306 0x00, /* F7 */
307 0x00, /* F8 */
308 0x00, /* F9 */
309 0x00, /* FA */
310 0x00, /* FB */
311 0x00, /* FC */
312 0x00, /* FD */
313 0x00, /* FE */
314 0x00, /* FF */
315};
316
317static struct {
318 int readable;
319 int writable;
320} max98095_access[M98095_REG_CNT] = {
321 { 0x00, 0x00 }, /* 00 */
322 { 0xFF, 0x00 }, /* 01 */
323 { 0xFF, 0x00 }, /* 02 */
324 { 0xFF, 0x00 }, /* 03 */
325 { 0xFF, 0x00 }, /* 04 */
326 { 0xFF, 0x00 }, /* 05 */
327 { 0xFF, 0x00 }, /* 06 */
328 { 0xFF, 0x00 }, /* 07 */
329 { 0xFF, 0x00 }, /* 08 */
330 { 0xFF, 0x00 }, /* 09 */
331 { 0xFF, 0x00 }, /* 0A */
332 { 0xFF, 0x00 }, /* 0B */
333 { 0xFF, 0x00 }, /* 0C */
334 { 0xFF, 0x00 }, /* 0D */
335 { 0xFF, 0x00 }, /* 0E */
336 { 0xFF, 0x9F }, /* 0F */
337 { 0xFF, 0xFF }, /* 10 */
338 { 0xFF, 0xFF }, /* 11 */
339 { 0xFF, 0xFF }, /* 12 */
340 { 0xFF, 0xFF }, /* 13 */
341 { 0xFF, 0xFF }, /* 14 */
342 { 0xFF, 0xFF }, /* 15 */
343 { 0xFF, 0xFF }, /* 16 */
344 { 0xFF, 0xFF }, /* 17 */
345 { 0xFF, 0xFF }, /* 18 */
346 { 0xFF, 0xFF }, /* 19 */
347 { 0xFF, 0xFF }, /* 1A */
348 { 0xFF, 0xFF }, /* 1B */
349 { 0xFF, 0xFF }, /* 1C */
350 { 0xFF, 0xFF }, /* 1D */
351 { 0xFF, 0x77 }, /* 1E */
352 { 0xFF, 0x77 }, /* 1F */
353 { 0xFF, 0x77 }, /* 20 */
354 { 0xFF, 0x77 }, /* 21 */
355 { 0xFF, 0x77 }, /* 22 */
356 { 0xFF, 0x77 }, /* 23 */
357 { 0xFF, 0xFF }, /* 24 */
358 { 0xFF, 0x7F }, /* 25 */
359 { 0xFF, 0x31 }, /* 26 */
360 { 0xFF, 0xFF }, /* 27 */
361 { 0xFF, 0xFF }, /* 28 */
362 { 0xFF, 0xFF }, /* 29 */
363 { 0xFF, 0xF7 }, /* 2A */
364 { 0xFF, 0x2F }, /* 2B */
365 { 0xFF, 0xEF }, /* 2C */
366 { 0xFF, 0xFF }, /* 2D */
367 { 0xFF, 0xFF }, /* 2E */
368 { 0xFF, 0xFF }, /* 2F */
369 { 0xFF, 0xFF }, /* 30 */
370 { 0xFF, 0xFF }, /* 31 */
371 { 0xFF, 0xFF }, /* 32 */
372 { 0xFF, 0xFF }, /* 33 */
373 { 0xFF, 0xF7 }, /* 34 */
374 { 0xFF, 0x2F }, /* 35 */
375 { 0xFF, 0xCF }, /* 36 */
376 { 0xFF, 0xFF }, /* 37 */
377 { 0xFF, 0xFF }, /* 38 */
378 { 0xFF, 0xFF }, /* 39 */
379 { 0xFF, 0xFF }, /* 3A */
380 { 0xFF, 0xFF }, /* 3B */
381 { 0xFF, 0xFF }, /* 3C */
382 { 0xFF, 0xFF }, /* 3D */
383 { 0xFF, 0xF7 }, /* 3E */
384 { 0xFF, 0x2F }, /* 3F */
385 { 0xFF, 0xCF }, /* 40 */
386 { 0xFF, 0xFF }, /* 41 */
387 { 0xFF, 0x77 }, /* 42 */
388 { 0xFF, 0xFF }, /* 43 */
389 { 0xFF, 0xFF }, /* 44 */
390 { 0xFF, 0xFF }, /* 45 */
391 { 0xFF, 0xFF }, /* 46 */
392 { 0xFF, 0xFF }, /* 47 */
393 { 0xFF, 0xFF }, /* 48 */
394 { 0xFF, 0x0F }, /* 49 */
395 { 0xFF, 0xFF }, /* 4A */
396 { 0xFF, 0xFF }, /* 4B */
397 { 0xFF, 0x3F }, /* 4C */
398 { 0xFF, 0x3F }, /* 4D */
399 { 0xFF, 0x3F }, /* 4E */
400 { 0xFF, 0xFF }, /* 4F */
401 { 0xFF, 0x7F }, /* 50 */
402 { 0xFF, 0x7F }, /* 51 */
403 { 0xFF, 0x0F }, /* 52 */
404 { 0xFF, 0x3F }, /* 53 */
405 { 0xFF, 0x3F }, /* 54 */
406 { 0xFF, 0x3F }, /* 55 */
407 { 0xFF, 0xFF }, /* 56 */
408 { 0xFF, 0xFF }, /* 57 */
409 { 0xFF, 0xBF }, /* 58 */
410 { 0xFF, 0x1F }, /* 59 */
411 { 0xFF, 0xBF }, /* 5A */
412 { 0xFF, 0x1F }, /* 5B */
413 { 0xFF, 0xBF }, /* 5C */
414 { 0xFF, 0x3F }, /* 5D */
415 { 0xFF, 0x3F }, /* 5E */
416 { 0xFF, 0x7F }, /* 5F */
417 { 0xFF, 0x7F }, /* 60 */
418 { 0xFF, 0x47 }, /* 61 */
419 { 0xFF, 0x9F }, /* 62 */
420 { 0xFF, 0x9F }, /* 63 */
421 { 0xFF, 0x9F }, /* 64 */
422 { 0xFF, 0x9F }, /* 65 */
423 { 0xFF, 0x9F }, /* 66 */
424 { 0xFF, 0xBF }, /* 67 */
425 { 0xFF, 0xBF }, /* 68 */
426 { 0xFF, 0xFF }, /* 69 */
427 { 0xFF, 0xFF }, /* 6A */
428 { 0xFF, 0x7F }, /* 6B */
429 { 0xFF, 0xF7 }, /* 6C */
430 { 0xFF, 0xFF }, /* 6D */
431 { 0xFF, 0xFF }, /* 6E */
432 { 0xFF, 0x1F }, /* 6F */
433 { 0xFF, 0xF7 }, /* 70 */
434 { 0xFF, 0xFF }, /* 71 */
435 { 0xFF, 0xFF }, /* 72 */
436 { 0xFF, 0x1F }, /* 73 */
437 { 0xFF, 0xF7 }, /* 74 */
438 { 0xFF, 0xFF }, /* 75 */
439 { 0xFF, 0xFF }, /* 76 */
440 { 0xFF, 0x1F }, /* 77 */
441 { 0xFF, 0xF7 }, /* 78 */
442 { 0xFF, 0xFF }, /* 79 */
443 { 0xFF, 0xFF }, /* 7A */
444 { 0xFF, 0x1F }, /* 7B */
445 { 0xFF, 0xF7 }, /* 7C */
446 { 0xFF, 0xFF }, /* 7D */
447 { 0xFF, 0xFF }, /* 7E */
448 { 0xFF, 0x1F }, /* 7F */
449 { 0xFF, 0xF7 }, /* 80 */
450 { 0xFF, 0xFF }, /* 81 */
451 { 0xFF, 0xFF }, /* 82 */
452 { 0xFF, 0x1F }, /* 83 */
453 { 0xFF, 0x7F }, /* 84 */
454 { 0xFF, 0x0F }, /* 85 */
455 { 0xFF, 0xD8 }, /* 86 */
456 { 0xFF, 0xFF }, /* 87 */
457 { 0xFF, 0xEF }, /* 88 */
458 { 0xFF, 0xFE }, /* 89 */
459 { 0xFF, 0xFE }, /* 8A */
460 { 0xFF, 0xFF }, /* 8B */
461 { 0xFF, 0xFF }, /* 8C */
462 { 0xFF, 0x3F }, /* 8D */
463 { 0xFF, 0xFF }, /* 8E */
464 { 0xFF, 0x3F }, /* 8F */
465 { 0xFF, 0x8F }, /* 90 */
466 { 0xFF, 0xFF }, /* 91 */
467 { 0xFF, 0x3F }, /* 92 */
468 { 0xFF, 0xFF }, /* 93 */
469 { 0xFF, 0xFF }, /* 94 */
470 { 0xFF, 0x0F }, /* 95 */
471 { 0xFF, 0x3F }, /* 96 */
472 { 0xFF, 0x8C }, /* 97 */
473 { 0x00, 0x00 }, /* 98 */
474 { 0x00, 0x00 }, /* 99 */
475 { 0x00, 0x00 }, /* 9A */
476 { 0x00, 0x00 }, /* 9B */
477 { 0x00, 0x00 }, /* 9C */
478 { 0x00, 0x00 }, /* 9D */
479 { 0x00, 0x00 }, /* 9E */
480 { 0x00, 0x00 }, /* 9F */
481 { 0x00, 0x00 }, /* A0 */
482 { 0x00, 0x00 }, /* A1 */
483 { 0x00, 0x00 }, /* A2 */
484 { 0x00, 0x00 }, /* A3 */
485 { 0x00, 0x00 }, /* A4 */
486 { 0x00, 0x00 }, /* A5 */
487 { 0x00, 0x00 }, /* A6 */
488 { 0x00, 0x00 }, /* A7 */
489 { 0x00, 0x00 }, /* A8 */
490 { 0x00, 0x00 }, /* A9 */
491 { 0x00, 0x00 }, /* AA */
492 { 0x00, 0x00 }, /* AB */
493 { 0x00, 0x00 }, /* AC */
494 { 0x00, 0x00 }, /* AD */
495 { 0x00, 0x00 }, /* AE */
496 { 0x00, 0x00 }, /* AF */
497 { 0x00, 0x00 }, /* B0 */
498 { 0x00, 0x00 }, /* B1 */
499 { 0x00, 0x00 }, /* B2 */
500 { 0x00, 0x00 }, /* B3 */
501 { 0x00, 0x00 }, /* B4 */
502 { 0x00, 0x00 }, /* B5 */
503 { 0x00, 0x00 }, /* B6 */
504 { 0x00, 0x00 }, /* B7 */
505 { 0x00, 0x00 }, /* B8 */
506 { 0x00, 0x00 }, /* B9 */
507 { 0x00, 0x00 }, /* BA */
508 { 0x00, 0x00 }, /* BB */
509 { 0x00, 0x00 }, /* BC */
510 { 0x00, 0x00 }, /* BD */
511 { 0x00, 0x00 }, /* BE */
512 { 0x00, 0x00 }, /* BF */
513 { 0x00, 0x00 }, /* C0 */
514 { 0x00, 0x00 }, /* C1 */
515 { 0x00, 0x00 }, /* C2 */
516 { 0x00, 0x00 }, /* C3 */
517 { 0x00, 0x00 }, /* C4 */
518 { 0x00, 0x00 }, /* C5 */
519 { 0x00, 0x00 }, /* C6 */
520 { 0x00, 0x00 }, /* C7 */
521 { 0x00, 0x00 }, /* C8 */
522 { 0x00, 0x00 }, /* C9 */
523 { 0x00, 0x00 }, /* CA */
524 { 0x00, 0x00 }, /* CB */
525 { 0x00, 0x00 }, /* CC */
526 { 0x00, 0x00 }, /* CD */
527 { 0x00, 0x00 }, /* CE */
528 { 0x00, 0x00 }, /* CF */
529 { 0x00, 0x00 }, /* D0 */
530 { 0x00, 0x00 }, /* D1 */
531 { 0x00, 0x00 }, /* D2 */
532 { 0x00, 0x00 }, /* D3 */
533 { 0x00, 0x00 }, /* D4 */
534 { 0x00, 0x00 }, /* D5 */
535 { 0x00, 0x00 }, /* D6 */
536 { 0x00, 0x00 }, /* D7 */
537 { 0x00, 0x00 }, /* D8 */
538 { 0x00, 0x00 }, /* D9 */
539 { 0x00, 0x00 }, /* DA */
540 { 0x00, 0x00 }, /* DB */
541 { 0x00, 0x00 }, /* DC */
542 { 0x00, 0x00 }, /* DD */
543 { 0x00, 0x00 }, /* DE */
544 { 0x00, 0x00 }, /* DF */
545 { 0x00, 0x00 }, /* E0 */
546 { 0x00, 0x00 }, /* E1 */
547 { 0x00, 0x00 }, /* E2 */
548 { 0x00, 0x00 }, /* E3 */
549 { 0x00, 0x00 }, /* E4 */
550 { 0x00, 0x00 }, /* E5 */
551 { 0x00, 0x00 }, /* E6 */
552 { 0x00, 0x00 }, /* E7 */
553 { 0x00, 0x00 }, /* E8 */
554 { 0x00, 0x00 }, /* E9 */
555 { 0x00, 0x00 }, /* EA */
556 { 0x00, 0x00 }, /* EB */
557 { 0x00, 0x00 }, /* EC */
558 { 0x00, 0x00 }, /* ED */
559 { 0x00, 0x00 }, /* EE */
560 { 0x00, 0x00 }, /* EF */
561 { 0x00, 0x00 }, /* F0 */
562 { 0x00, 0x00 }, /* F1 */
563 { 0x00, 0x00 }, /* F2 */
564 { 0x00, 0x00 }, /* F3 */
565 { 0x00, 0x00 }, /* F4 */
566 { 0x00, 0x00 }, /* F5 */
567 { 0x00, 0x00 }, /* F6 */
568 { 0x00, 0x00 }, /* F7 */
569 { 0x00, 0x00 }, /* F8 */
570 { 0x00, 0x00 }, /* F9 */
571 { 0x00, 0x00 }, /* FA */
572 { 0x00, 0x00 }, /* FB */
573 { 0x00, 0x00 }, /* FC */
574 { 0x00, 0x00 }, /* FD */
575 { 0x00, 0x00 }, /* FE */
576 { 0xFF, 0x00 }, /* FF */
577};
578
579static int max98095_readable(struct snd_soc_codec *codec, unsigned int reg)
580{
581 if (reg >= M98095_REG_CNT)
582 return 0;
583 return max98095_access[reg].readable != 0;
584}
585
586static int max98095_volatile(struct snd_soc_codec *codec, unsigned int reg)
587{
588 if (reg > M98095_REG_MAX_CACHED)
589 return 1;
590
591 switch (reg) {
592 case M98095_000_HOST_DATA:
593 case M98095_001_HOST_INT_STS:
594 case M98095_002_HOST_RSP_STS:
595 case M98095_003_HOST_CMD_STS:
596 case M98095_004_CODEC_STS:
597 case M98095_005_DAI1_ALC_STS:
598 case M98095_006_DAI2_ALC_STS:
599 case M98095_007_JACK_AUTO_STS:
600 case M98095_008_JACK_MANUAL_STS:
601 case M98095_009_JACK_VBAT_STS:
602 case M98095_00A_ACC_ADC_STS:
603 case M98095_00B_MIC_NG_AGC_STS:
604 case M98095_00C_SPK_L_VOLT_STS:
605 case M98095_00D_SPK_R_VOLT_STS:
606 case M98095_00E_TEMP_SENSOR_STS:
607 return 1;
608 }
609
610 return 0;
611}
612
613/*
614 * Filter coefficients are in a separate register segment
615 * and they share the address space of the normal registers.
616 * The coefficient registers do not need or share the cache.
617 */
618static int max98095_hw_write(struct snd_soc_codec *codec, unsigned int reg,
619 unsigned int value)
620{
621 u8 data[2];
622
623 data[0] = reg;
624 data[1] = value;
625 if (codec->hw_write(codec->control_data, data, 2) == 2)
626 return 0;
627 else
628 return -EIO;
629}
630
631/*
632 * Load equalizer DSP coefficient configurations registers
633 */
634static void m98095_eq_band(struct snd_soc_codec *codec, unsigned int dai,
635 unsigned int band, u16 *coefs)
636{
637 unsigned int eq_reg;
638 unsigned int i;
639
640 BUG_ON(band > 4);
641 BUG_ON(dai > 1);
642
643 /* Load the base register address */
644 eq_reg = dai ? M98095_142_DAI2_EQ_BASE : M98095_110_DAI1_EQ_BASE;
645
646 /* Add the band address offset, note adjustment for word address */
647 eq_reg += band * (M98095_COEFS_PER_BAND << 1);
648
649 /* Step through the registers and coefs */
650 for (i = 0; i < M98095_COEFS_PER_BAND; i++) {
651 max98095_hw_write(codec, eq_reg++, M98095_BYTE1(coefs[i]));
652 max98095_hw_write(codec, eq_reg++, M98095_BYTE0(coefs[i]));
653 }
654}
655
656/*
657 * Load biquad filter coefficient configurations registers
658 */
659static void m98095_biquad_band(struct snd_soc_codec *codec, unsigned int dai,
660 unsigned int band, u16 *coefs)
661{
662 unsigned int bq_reg;
663 unsigned int i;
664
665 BUG_ON(band > 1);
666 BUG_ON(dai > 1);
667
668 /* Load the base register address */
669 bq_reg = dai ? M98095_17E_DAI2_BQ_BASE : M98095_174_DAI1_BQ_BASE;
670
671 /* Add the band address offset, note adjustment for word address */
672 bq_reg += band * (M98095_COEFS_PER_BAND << 1);
673
674 /* Step through the registers and coefs */
675 for (i = 0; i < M98095_COEFS_PER_BAND; i++) {
676 max98095_hw_write(codec, bq_reg++, M98095_BYTE1(coefs[i]));
677 max98095_hw_write(codec, bq_reg++, M98095_BYTE0(coefs[i]));
678 }
679}
680
681static const char * const max98095_fltr_mode[] = { "Voice", "Music" };
682static const struct soc_enum max98095_dai1_filter_mode_enum[] = {
683 SOC_ENUM_SINGLE(M98095_02E_DAI1_FILTERS, 7, 2, max98095_fltr_mode),
684};
685static const struct soc_enum max98095_dai2_filter_mode_enum[] = {
686 SOC_ENUM_SINGLE(M98095_038_DAI2_FILTERS, 7, 2, max98095_fltr_mode),
687};
688
689static const char * const max98095_extmic_text[] = { "None", "MIC1", "MIC2" };
690
691static const struct soc_enum max98095_extmic_enum =
692 SOC_ENUM_SINGLE(M98095_087_CFG_MIC, 0, 3, max98095_extmic_text);
693
694static const struct snd_kcontrol_new max98095_extmic_mux =
695 SOC_DAPM_ENUM("External MIC Mux", max98095_extmic_enum);
696
697static const char * const max98095_linein_text[] = { "INA", "INB" };
698
699static const struct soc_enum max98095_linein_enum =
700 SOC_ENUM_SINGLE(M98095_086_CFG_LINE, 6, 2, max98095_linein_text);
701
702static const struct snd_kcontrol_new max98095_linein_mux =
703 SOC_DAPM_ENUM("Linein Input Mux", max98095_linein_enum);
704
705static const char * const max98095_line_mode_text[] = {
706 "Stereo", "Differential"};
707
708static const struct soc_enum max98095_linein_mode_enum =
709 SOC_ENUM_SINGLE(M98095_086_CFG_LINE, 7, 2, max98095_line_mode_text);
710
711static const struct soc_enum max98095_lineout_mode_enum =
712 SOC_ENUM_SINGLE(M98095_086_CFG_LINE, 4, 2, max98095_line_mode_text);
713
714static const char * const max98095_dai_fltr[] = {
715 "Off", "Elliptical-HPF-16k", "Butterworth-HPF-16k",
716 "Elliptical-HPF-8k", "Butterworth-HPF-8k", "Butterworth-HPF-Fs/240"};
717static const struct soc_enum max98095_dai1_dac_filter_enum[] = {
718 SOC_ENUM_SINGLE(M98095_02E_DAI1_FILTERS, 0, 6, max98095_dai_fltr),
719};
720static const struct soc_enum max98095_dai2_dac_filter_enum[] = {
721 SOC_ENUM_SINGLE(M98095_038_DAI2_FILTERS, 0, 6, max98095_dai_fltr),
722};
723static const struct soc_enum max98095_dai3_dac_filter_enum[] = {
724 SOC_ENUM_SINGLE(M98095_042_DAI3_FILTERS, 0, 6, max98095_dai_fltr),
725};
726
727static int max98095_mic1pre_set(struct snd_kcontrol *kcontrol,
728 struct snd_ctl_elem_value *ucontrol)
729{
730 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
731 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
732 unsigned int sel = ucontrol->value.integer.value[0];
733
734 max98095->mic1pre = sel;
735 snd_soc_update_bits(codec, M98095_05F_LVL_MIC1, M98095_MICPRE_MASK,
736 (1+sel)<<M98095_MICPRE_SHIFT);
737
738 return 0;
739}
740
741static int max98095_mic1pre_get(struct snd_kcontrol *kcontrol,
742 struct snd_ctl_elem_value *ucontrol)
743{
744 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
745 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
746
747 ucontrol->value.integer.value[0] = max98095->mic1pre;
748 return 0;
749}
750
751static int max98095_mic2pre_set(struct snd_kcontrol *kcontrol,
752 struct snd_ctl_elem_value *ucontrol)
753{
754 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
755 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
756 unsigned int sel = ucontrol->value.integer.value[0];
757
758 max98095->mic2pre = sel;
759 snd_soc_update_bits(codec, M98095_060_LVL_MIC2, M98095_MICPRE_MASK,
760 (1+sel)<<M98095_MICPRE_SHIFT);
761
762 return 0;
763}
764
765static int max98095_mic2pre_get(struct snd_kcontrol *kcontrol,
766 struct snd_ctl_elem_value *ucontrol)
767{
768 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
769 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
770
771 ucontrol->value.integer.value[0] = max98095->mic2pre;
772 return 0;
773}
774
775static const unsigned int max98095_micboost_tlv[] = {
776 TLV_DB_RANGE_HEAD(2),
777 0, 1, TLV_DB_SCALE_ITEM(0, 2000, 0),
778 2, 2, TLV_DB_SCALE_ITEM(3000, 0, 0),
779};
780
781static const DECLARE_TLV_DB_SCALE(max98095_mic_tlv, 0, 100, 0);
782static const DECLARE_TLV_DB_SCALE(max98095_adc_tlv, -1200, 100, 0);
783static const DECLARE_TLV_DB_SCALE(max98095_adcboost_tlv, 0, 600, 0);
784
785static const unsigned int max98095_hp_tlv[] = {
786 TLV_DB_RANGE_HEAD(5),
787 0, 6, TLV_DB_SCALE_ITEM(-6700, 400, 0),
788 7, 14, TLV_DB_SCALE_ITEM(-4000, 300, 0),
789 15, 21, TLV_DB_SCALE_ITEM(-1700, 200, 0),
790 22, 27, TLV_DB_SCALE_ITEM(-400, 100, 0),
791 28, 31, TLV_DB_SCALE_ITEM(150, 50, 0),
792};
793
794static const unsigned int max98095_spk_tlv[] = {
795 TLV_DB_RANGE_HEAD(4),
796 0, 10, TLV_DB_SCALE_ITEM(-5900, 400, 0),
797 11, 18, TLV_DB_SCALE_ITEM(-1700, 200, 0),
798 19, 27, TLV_DB_SCALE_ITEM(-200, 100, 0),
799 28, 39, TLV_DB_SCALE_ITEM(650, 50, 0),
800};
801
802static const unsigned int max98095_rcv_lout_tlv[] = {
803 TLV_DB_RANGE_HEAD(5),
804 0, 6, TLV_DB_SCALE_ITEM(-6200, 400, 0),
805 7, 14, TLV_DB_SCALE_ITEM(-3500, 300, 0),
806 15, 21, TLV_DB_SCALE_ITEM(-1200, 200, 0),
807 22, 27, TLV_DB_SCALE_ITEM(100, 100, 0),
808 28, 31, TLV_DB_SCALE_ITEM(650, 50, 0),
809};
810
811static const unsigned int max98095_lin_tlv[] = {
812 TLV_DB_RANGE_HEAD(3),
813 0, 2, TLV_DB_SCALE_ITEM(-600, 300, 0),
814 3, 3, TLV_DB_SCALE_ITEM(300, 1100, 0),
815 4, 5, TLV_DB_SCALE_ITEM(1400, 600, 0),
816};
817
818static const struct snd_kcontrol_new max98095_snd_controls[] = {
819
820 SOC_DOUBLE_R_TLV("Headphone Volume", M98095_064_LVL_HP_L,
821 M98095_065_LVL_HP_R, 0, 31, 0, max98095_hp_tlv),
822
823 SOC_DOUBLE_R_TLV("Speaker Volume", M98095_067_LVL_SPK_L,
824 M98095_068_LVL_SPK_R, 0, 39, 0, max98095_spk_tlv),
825
826 SOC_SINGLE_TLV("Receiver Volume", M98095_066_LVL_RCV,
827 0, 31, 0, max98095_rcv_lout_tlv),
828
829 SOC_DOUBLE_R_TLV("Lineout Volume", M98095_062_LVL_LINEOUT1,
830 M98095_063_LVL_LINEOUT2, 0, 31, 0, max98095_rcv_lout_tlv),
831
832 SOC_DOUBLE_R("Headphone Switch", M98095_064_LVL_HP_L,
833 M98095_065_LVL_HP_R, 7, 1, 1),
834
835 SOC_DOUBLE_R("Speaker Switch", M98095_067_LVL_SPK_L,
836 M98095_068_LVL_SPK_R, 7, 1, 1),
837
838 SOC_SINGLE("Receiver Switch", M98095_066_LVL_RCV, 7, 1, 1),
839
840 SOC_DOUBLE_R("Lineout Switch", M98095_062_LVL_LINEOUT1,
841 M98095_063_LVL_LINEOUT2, 7, 1, 1),
842
843 SOC_SINGLE_TLV("MIC1 Volume", M98095_05F_LVL_MIC1, 0, 20, 1,
844 max98095_mic_tlv),
845
846 SOC_SINGLE_TLV("MIC2 Volume", M98095_060_LVL_MIC2, 0, 20, 1,
847 max98095_mic_tlv),
848
849 SOC_SINGLE_EXT_TLV("MIC1 Boost Volume",
850 M98095_05F_LVL_MIC1, 5, 2, 0,
851 max98095_mic1pre_get, max98095_mic1pre_set,
852 max98095_micboost_tlv),
853 SOC_SINGLE_EXT_TLV("MIC2 Boost Volume",
854 M98095_060_LVL_MIC2, 5, 2, 0,
855 max98095_mic2pre_get, max98095_mic2pre_set,
856 max98095_micboost_tlv),
857
858 SOC_SINGLE_TLV("Linein Volume", M98095_061_LVL_LINEIN, 0, 5, 1,
859 max98095_lin_tlv),
860
861 SOC_SINGLE_TLV("ADCL Volume", M98095_05D_LVL_ADC_L, 0, 15, 1,
862 max98095_adc_tlv),
863 SOC_SINGLE_TLV("ADCR Volume", M98095_05E_LVL_ADC_R, 0, 15, 1,
864 max98095_adc_tlv),
865
866 SOC_SINGLE_TLV("ADCL Boost Volume", M98095_05D_LVL_ADC_L, 4, 3, 0,
867 max98095_adcboost_tlv),
868 SOC_SINGLE_TLV("ADCR Boost Volume", M98095_05E_LVL_ADC_R, 4, 3, 0,
869 max98095_adcboost_tlv),
870
871 SOC_SINGLE("EQ1 Switch", M98095_088_CFG_LEVEL, 0, 1, 0),
872 SOC_SINGLE("EQ2 Switch", M98095_088_CFG_LEVEL, 1, 1, 0),
873
874 SOC_SINGLE("Biquad1 Switch", M98095_088_CFG_LEVEL, 2, 1, 0),
875 SOC_SINGLE("Biquad2 Switch", M98095_088_CFG_LEVEL, 3, 1, 0),
876
877 SOC_ENUM("DAI1 Filter Mode", max98095_dai1_filter_mode_enum),
878 SOC_ENUM("DAI2 Filter Mode", max98095_dai2_filter_mode_enum),
879 SOC_ENUM("DAI1 DAC Filter", max98095_dai1_dac_filter_enum),
880 SOC_ENUM("DAI2 DAC Filter", max98095_dai2_dac_filter_enum),
881 SOC_ENUM("DAI3 DAC Filter", max98095_dai3_dac_filter_enum),
882
883 SOC_ENUM("Linein Mode", max98095_linein_mode_enum),
884 SOC_ENUM("Lineout Mode", max98095_lineout_mode_enum),
885};
886
887/* Left speaker mixer switch */
888static const struct snd_kcontrol_new max98095_left_speaker_mixer_controls[] = {
889 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_050_MIX_SPK_LEFT, 0, 1, 0),
890 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_050_MIX_SPK_LEFT, 6, 1, 0),
891 SOC_DAPM_SINGLE("Mono DAC2 Switch", M98095_050_MIX_SPK_LEFT, 3, 1, 0),
892 SOC_DAPM_SINGLE("Mono DAC3 Switch", M98095_050_MIX_SPK_LEFT, 3, 1, 0),
893 SOC_DAPM_SINGLE("MIC1 Switch", M98095_050_MIX_SPK_LEFT, 4, 1, 0),
894 SOC_DAPM_SINGLE("MIC2 Switch", M98095_050_MIX_SPK_LEFT, 5, 1, 0),
895 SOC_DAPM_SINGLE("IN1 Switch", M98095_050_MIX_SPK_LEFT, 1, 1, 0),
896 SOC_DAPM_SINGLE("IN2 Switch", M98095_050_MIX_SPK_LEFT, 2, 1, 0),
897};
898
899/* Right speaker mixer switch */
900static const struct snd_kcontrol_new max98095_right_speaker_mixer_controls[] = {
901 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_051_MIX_SPK_RIGHT, 6, 1, 0),
902 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_051_MIX_SPK_RIGHT, 0, 1, 0),
903 SOC_DAPM_SINGLE("Mono DAC2 Switch", M98095_051_MIX_SPK_RIGHT, 3, 1, 0),
904 SOC_DAPM_SINGLE("Mono DAC3 Switch", M98095_051_MIX_SPK_RIGHT, 3, 1, 0),
905 SOC_DAPM_SINGLE("MIC1 Switch", M98095_051_MIX_SPK_RIGHT, 5, 1, 0),
906 SOC_DAPM_SINGLE("MIC2 Switch", M98095_051_MIX_SPK_RIGHT, 4, 1, 0),
907 SOC_DAPM_SINGLE("IN1 Switch", M98095_051_MIX_SPK_RIGHT, 1, 1, 0),
908 SOC_DAPM_SINGLE("IN2 Switch", M98095_051_MIX_SPK_RIGHT, 2, 1, 0),
909};
910
911/* Left headphone mixer switch */
912static const struct snd_kcontrol_new max98095_left_hp_mixer_controls[] = {
913 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04C_MIX_HP_LEFT, 0, 1, 0),
914 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04C_MIX_HP_LEFT, 5, 1, 0),
915 SOC_DAPM_SINGLE("MIC1 Switch", M98095_04C_MIX_HP_LEFT, 3, 1, 0),
916 SOC_DAPM_SINGLE("MIC2 Switch", M98095_04C_MIX_HP_LEFT, 4, 1, 0),
917 SOC_DAPM_SINGLE("IN1 Switch", M98095_04C_MIX_HP_LEFT, 1, 1, 0),
918 SOC_DAPM_SINGLE("IN2 Switch", M98095_04C_MIX_HP_LEFT, 2, 1, 0),
919};
920
921/* Right headphone mixer switch */
922static const struct snd_kcontrol_new max98095_right_hp_mixer_controls[] = {
923 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04D_MIX_HP_RIGHT, 5, 1, 0),
924 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04D_MIX_HP_RIGHT, 0, 1, 0),
925 SOC_DAPM_SINGLE("MIC1 Switch", M98095_04D_MIX_HP_RIGHT, 3, 1, 0),
926 SOC_DAPM_SINGLE("MIC2 Switch", M98095_04D_MIX_HP_RIGHT, 4, 1, 0),
927 SOC_DAPM_SINGLE("IN1 Switch", M98095_04D_MIX_HP_RIGHT, 1, 1, 0),
928 SOC_DAPM_SINGLE("IN2 Switch", M98095_04D_MIX_HP_RIGHT, 2, 1, 0),
929};
930
931/* Receiver earpiece mixer switch */
932static const struct snd_kcontrol_new max98095_mono_rcv_mixer_controls[] = {
933 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_04F_MIX_RCV, 0, 1, 0),
934 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_04F_MIX_RCV, 5, 1, 0),
935 SOC_DAPM_SINGLE("MIC1 Switch", M98095_04F_MIX_RCV, 3, 1, 0),
936 SOC_DAPM_SINGLE("MIC2 Switch", M98095_04F_MIX_RCV, 4, 1, 0),
937 SOC_DAPM_SINGLE("IN1 Switch", M98095_04F_MIX_RCV, 1, 1, 0),
938 SOC_DAPM_SINGLE("IN2 Switch", M98095_04F_MIX_RCV, 2, 1, 0),
939};
940
941/* Left lineout mixer switch */
942static const struct snd_kcontrol_new max98095_left_lineout_mixer_controls[] = {
943 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_053_MIX_LINEOUT1, 5, 1, 0),
944 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_053_MIX_LINEOUT1, 0, 1, 0),
945 SOC_DAPM_SINGLE("MIC1 Switch", M98095_053_MIX_LINEOUT1, 3, 1, 0),
946 SOC_DAPM_SINGLE("MIC2 Switch", M98095_053_MIX_LINEOUT1, 4, 1, 0),
947 SOC_DAPM_SINGLE("IN1 Switch", M98095_053_MIX_LINEOUT1, 1, 1, 0),
948 SOC_DAPM_SINGLE("IN2 Switch", M98095_053_MIX_LINEOUT1, 2, 1, 0),
949};
950
951/* Right lineout mixer switch */
952static const struct snd_kcontrol_new max98095_right_lineout_mixer_controls[] = {
953 SOC_DAPM_SINGLE("Left DAC1 Switch", M98095_054_MIX_LINEOUT2, 0, 1, 0),
954 SOC_DAPM_SINGLE("Right DAC1 Switch", M98095_054_MIX_LINEOUT2, 5, 1, 0),
955 SOC_DAPM_SINGLE("MIC1 Switch", M98095_054_MIX_LINEOUT2, 3, 1, 0),
956 SOC_DAPM_SINGLE("MIC2 Switch", M98095_054_MIX_LINEOUT2, 4, 1, 0),
957 SOC_DAPM_SINGLE("IN1 Switch", M98095_054_MIX_LINEOUT2, 1, 1, 0),
958 SOC_DAPM_SINGLE("IN2 Switch", M98095_054_MIX_LINEOUT2, 2, 1, 0),
959};
960
961/* Left ADC mixer switch */
962static const struct snd_kcontrol_new max98095_left_ADC_mixer_controls[] = {
963 SOC_DAPM_SINGLE("MIC1 Switch", M98095_04A_MIX_ADC_LEFT, 7, 1, 0),
964 SOC_DAPM_SINGLE("MIC2 Switch", M98095_04A_MIX_ADC_LEFT, 6, 1, 0),
965 SOC_DAPM_SINGLE("IN1 Switch", M98095_04A_MIX_ADC_LEFT, 3, 1, 0),
966 SOC_DAPM_SINGLE("IN2 Switch", M98095_04A_MIX_ADC_LEFT, 2, 1, 0),
967};
968
969/* Right ADC mixer switch */
970static const struct snd_kcontrol_new max98095_right_ADC_mixer_controls[] = {
971 SOC_DAPM_SINGLE("MIC1 Switch", M98095_04B_MIX_ADC_RIGHT, 7, 1, 0),
972 SOC_DAPM_SINGLE("MIC2 Switch", M98095_04B_MIX_ADC_RIGHT, 6, 1, 0),
973 SOC_DAPM_SINGLE("IN1 Switch", M98095_04B_MIX_ADC_RIGHT, 3, 1, 0),
974 SOC_DAPM_SINGLE("IN2 Switch", M98095_04B_MIX_ADC_RIGHT, 2, 1, 0),
975};
976
977static int max98095_mic_event(struct snd_soc_dapm_widget *w,
978 struct snd_kcontrol *kcontrol, int event)
979{
980 struct snd_soc_codec *codec = w->codec;
981 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
982
983 switch (event) {
984 case SND_SOC_DAPM_POST_PMU:
985 if (w->reg == M98095_05F_LVL_MIC1) {
986 snd_soc_update_bits(codec, w->reg, M98095_MICPRE_MASK,
987 (1+max98095->mic1pre)<<M98095_MICPRE_SHIFT);
988 } else {
989 snd_soc_update_bits(codec, w->reg, M98095_MICPRE_MASK,
990 (1+max98095->mic2pre)<<M98095_MICPRE_SHIFT);
991 }
992 break;
993 case SND_SOC_DAPM_POST_PMD:
994 snd_soc_update_bits(codec, w->reg, M98095_MICPRE_MASK, 0);
995 break;
996 default:
997 return -EINVAL;
998 }
999
1000 return 0;
1001}
1002
1003/*
1004 * The line inputs are stereo inputs with the left and right
1005 * channels sharing a common PGA power control signal.
1006 */
1007static int max98095_line_pga(struct snd_soc_dapm_widget *w,
1008 int event, u8 channel)
1009{
1010 struct snd_soc_codec *codec = w->codec;
1011 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1012 u8 *state;
1013
1014 BUG_ON(!((channel == 1) || (channel == 2)));
1015
1016 state = &max98095->lin_state;
1017
1018 switch (event) {
1019 case SND_SOC_DAPM_POST_PMU:
1020 *state |= channel;
1021 snd_soc_update_bits(codec, w->reg,
1022 (1 << w->shift), (1 << w->shift));
1023 break;
1024 case SND_SOC_DAPM_POST_PMD:
1025 *state &= ~channel;
1026 if (*state == 0) {
1027 snd_soc_update_bits(codec, w->reg,
1028 (1 << w->shift), 0);
1029 }
1030 break;
1031 default:
1032 return -EINVAL;
1033 }
1034
1035 return 0;
1036}
1037
1038static int max98095_pga_in1_event(struct snd_soc_dapm_widget *w,
1039 struct snd_kcontrol *k, int event)
1040{
1041 return max98095_line_pga(w, event, 1);
1042}
1043
1044static int max98095_pga_in2_event(struct snd_soc_dapm_widget *w,
1045 struct snd_kcontrol *k, int event)
1046{
1047 return max98095_line_pga(w, event, 2);
1048}
1049
1050/*
1051 * The stereo line out mixer outputs to two stereo line outs.
1052 * The 2nd pair has a separate set of enables.
1053 */
1054static int max98095_lineout_event(struct snd_soc_dapm_widget *w,
1055 struct snd_kcontrol *kcontrol, int event)
1056{
1057 struct snd_soc_codec *codec = w->codec;
1058
1059 switch (event) {
1060 case SND_SOC_DAPM_POST_PMU:
1061 snd_soc_update_bits(codec, w->reg,
1062 (1 << (w->shift+2)), (1 << (w->shift+2)));
1063 break;
1064 case SND_SOC_DAPM_POST_PMD:
1065 snd_soc_update_bits(codec, w->reg,
1066 (1 << (w->shift+2)), 0);
1067 break;
1068 default:
1069 return -EINVAL;
1070 }
1071
1072 return 0;
1073}
1074
1075static const struct snd_soc_dapm_widget max98095_dapm_widgets[] = {
1076
1077 SND_SOC_DAPM_ADC("ADCL", "HiFi Capture", M98095_090_PWR_EN_IN, 0, 0),
1078 SND_SOC_DAPM_ADC("ADCR", "HiFi Capture", M98095_090_PWR_EN_IN, 1, 0),
1079
1080 SND_SOC_DAPM_DAC("DACL1", "HiFi Playback",
1081 M98095_091_PWR_EN_OUT, 0, 0),
1082 SND_SOC_DAPM_DAC("DACR1", "HiFi Playback",
1083 M98095_091_PWR_EN_OUT, 1, 0),
1084 SND_SOC_DAPM_DAC("DACM2", "Aux Playback",
1085 M98095_091_PWR_EN_OUT, 2, 0),
1086 SND_SOC_DAPM_DAC("DACM3", "Voice Playback",
1087 M98095_091_PWR_EN_OUT, 2, 0),
1088
1089 SND_SOC_DAPM_PGA("HP Left Out", M98095_091_PWR_EN_OUT,
1090 6, 0, NULL, 0),
1091 SND_SOC_DAPM_PGA("HP Right Out", M98095_091_PWR_EN_OUT,
1092 7, 0, NULL, 0),
1093
1094 SND_SOC_DAPM_PGA("SPK Left Out", M98095_091_PWR_EN_OUT,
1095 4, 0, NULL, 0),
1096 SND_SOC_DAPM_PGA("SPK Right Out", M98095_091_PWR_EN_OUT,
1097 5, 0, NULL, 0),
1098
1099 SND_SOC_DAPM_PGA("RCV Mono Out", M98095_091_PWR_EN_OUT,
1100 3, 0, NULL, 0),
1101
1102 SND_SOC_DAPM_PGA_E("LINE Left Out", M98095_092_PWR_EN_OUT,
1103 0, 0, NULL, 0, max98095_lineout_event, SND_SOC_DAPM_PRE_PMD),
1104 SND_SOC_DAPM_PGA_E("LINE Right Out", M98095_092_PWR_EN_OUT,
1105 1, 0, NULL, 0, max98095_lineout_event, SND_SOC_DAPM_PRE_PMD),
1106
1107 SND_SOC_DAPM_MUX("External MIC", SND_SOC_NOPM, 0, 0,
1108 &max98095_extmic_mux),
1109
1110 SND_SOC_DAPM_MUX("Linein Mux", SND_SOC_NOPM, 0, 0,
1111 &max98095_linein_mux),
1112
1113 SND_SOC_DAPM_MIXER("Left Headphone Mixer", SND_SOC_NOPM, 0, 0,
1114 &max98095_left_hp_mixer_controls[0],
1115 ARRAY_SIZE(max98095_left_hp_mixer_controls)),
1116
1117 SND_SOC_DAPM_MIXER("Right Headphone Mixer", SND_SOC_NOPM, 0, 0,
1118 &max98095_right_hp_mixer_controls[0],
1119 ARRAY_SIZE(max98095_right_hp_mixer_controls)),
1120
1121 SND_SOC_DAPM_MIXER("Left Speaker Mixer", SND_SOC_NOPM, 0, 0,
1122 &max98095_left_speaker_mixer_controls[0],
1123 ARRAY_SIZE(max98095_left_speaker_mixer_controls)),
1124
1125 SND_SOC_DAPM_MIXER("Right Speaker Mixer", SND_SOC_NOPM, 0, 0,
1126 &max98095_right_speaker_mixer_controls[0],
1127 ARRAY_SIZE(max98095_right_speaker_mixer_controls)),
1128
1129 SND_SOC_DAPM_MIXER("Receiver Mixer", SND_SOC_NOPM, 0, 0,
1130 &max98095_mono_rcv_mixer_controls[0],
1131 ARRAY_SIZE(max98095_mono_rcv_mixer_controls)),
1132
1133 SND_SOC_DAPM_MIXER("Left Lineout Mixer", SND_SOC_NOPM, 0, 0,
1134 &max98095_left_lineout_mixer_controls[0],
1135 ARRAY_SIZE(max98095_left_lineout_mixer_controls)),
1136
1137 SND_SOC_DAPM_MIXER("Right Lineout Mixer", SND_SOC_NOPM, 0, 0,
1138 &max98095_right_lineout_mixer_controls[0],
1139 ARRAY_SIZE(max98095_right_lineout_mixer_controls)),
1140
1141 SND_SOC_DAPM_MIXER("Left ADC Mixer", SND_SOC_NOPM, 0, 0,
1142 &max98095_left_ADC_mixer_controls[0],
1143 ARRAY_SIZE(max98095_left_ADC_mixer_controls)),
1144
1145 SND_SOC_DAPM_MIXER("Right ADC Mixer", SND_SOC_NOPM, 0, 0,
1146 &max98095_right_ADC_mixer_controls[0],
1147 ARRAY_SIZE(max98095_right_ADC_mixer_controls)),
1148
1149 SND_SOC_DAPM_PGA_E("MIC1 Input", M98095_05F_LVL_MIC1,
1150 5, 0, NULL, 0, max98095_mic_event,
1151 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1152
1153 SND_SOC_DAPM_PGA_E("MIC2 Input", M98095_060_LVL_MIC2,
1154 5, 0, NULL, 0, max98095_mic_event,
1155 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1156
1157 SND_SOC_DAPM_PGA_E("IN1 Input", M98095_090_PWR_EN_IN,
1158 7, 0, NULL, 0, max98095_pga_in1_event,
1159 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1160
1161 SND_SOC_DAPM_PGA_E("IN2 Input", M98095_090_PWR_EN_IN,
1162 7, 0, NULL, 0, max98095_pga_in2_event,
1163 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1164
1165 SND_SOC_DAPM_MICBIAS("MICBIAS1", M98095_090_PWR_EN_IN, 2, 0),
1166 SND_SOC_DAPM_MICBIAS("MICBIAS2", M98095_090_PWR_EN_IN, 3, 0),
1167
1168 SND_SOC_DAPM_OUTPUT("HPL"),
1169 SND_SOC_DAPM_OUTPUT("HPR"),
1170 SND_SOC_DAPM_OUTPUT("SPKL"),
1171 SND_SOC_DAPM_OUTPUT("SPKR"),
1172 SND_SOC_DAPM_OUTPUT("RCV"),
1173 SND_SOC_DAPM_OUTPUT("OUT1"),
1174 SND_SOC_DAPM_OUTPUT("OUT2"),
1175 SND_SOC_DAPM_OUTPUT("OUT3"),
1176 SND_SOC_DAPM_OUTPUT("OUT4"),
1177
1178 SND_SOC_DAPM_INPUT("MIC1"),
1179 SND_SOC_DAPM_INPUT("MIC2"),
1180 SND_SOC_DAPM_INPUT("INA1"),
1181 SND_SOC_DAPM_INPUT("INA2"),
1182 SND_SOC_DAPM_INPUT("INB1"),
1183 SND_SOC_DAPM_INPUT("INB2"),
1184};
1185
1186static const struct snd_soc_dapm_route max98095_audio_map[] = {
1187 /* Left headphone output mixer */
1188 {"Left Headphone Mixer", "Left DAC1 Switch", "DACL1"},
1189 {"Left Headphone Mixer", "Right DAC1 Switch", "DACR1"},
1190 {"Left Headphone Mixer", "MIC1 Switch", "MIC1 Input"},
1191 {"Left Headphone Mixer", "MIC2 Switch", "MIC2 Input"},
1192 {"Left Headphone Mixer", "IN1 Switch", "IN1 Input"},
1193 {"Left Headphone Mixer", "IN2 Switch", "IN2 Input"},
1194
1195 /* Right headphone output mixer */
1196 {"Right Headphone Mixer", "Left DAC1 Switch", "DACL1"},
1197 {"Right Headphone Mixer", "Right DAC1 Switch", "DACR1"},
1198 {"Right Headphone Mixer", "MIC1 Switch", "MIC1 Input"},
1199 {"Right Headphone Mixer", "MIC2 Switch", "MIC2 Input"},
1200 {"Right Headphone Mixer", "IN1 Switch", "IN1 Input"},
1201 {"Right Headphone Mixer", "IN2 Switch", "IN2 Input"},
1202
1203 /* Left speaker output mixer */
1204 {"Left Speaker Mixer", "Left DAC1 Switch", "DACL1"},
1205 {"Left Speaker Mixer", "Right DAC1 Switch", "DACR1"},
1206 {"Left Speaker Mixer", "Mono DAC2 Switch", "DACM2"},
1207 {"Left Speaker Mixer", "Mono DAC3 Switch", "DACM3"},
1208 {"Left Speaker Mixer", "MIC1 Switch", "MIC1 Input"},
1209 {"Left Speaker Mixer", "MIC2 Switch", "MIC2 Input"},
1210 {"Left Speaker Mixer", "IN1 Switch", "IN1 Input"},
1211 {"Left Speaker Mixer", "IN2 Switch", "IN2 Input"},
1212
1213 /* Right speaker output mixer */
1214 {"Right Speaker Mixer", "Left DAC1 Switch", "DACL1"},
1215 {"Right Speaker Mixer", "Right DAC1 Switch", "DACR1"},
1216 {"Right Speaker Mixer", "Mono DAC2 Switch", "DACM2"},
1217 {"Right Speaker Mixer", "Mono DAC3 Switch", "DACM3"},
1218 {"Right Speaker Mixer", "MIC1 Switch", "MIC1 Input"},
1219 {"Right Speaker Mixer", "MIC2 Switch", "MIC2 Input"},
1220 {"Right Speaker Mixer", "IN1 Switch", "IN1 Input"},
1221 {"Right Speaker Mixer", "IN2 Switch", "IN2 Input"},
1222
1223 /* Earpiece/Receiver output mixer */
1224 {"Receiver Mixer", "Left DAC1 Switch", "DACL1"},
1225 {"Receiver Mixer", "Right DAC1 Switch", "DACR1"},
1226 {"Receiver Mixer", "MIC1 Switch", "MIC1 Input"},
1227 {"Receiver Mixer", "MIC2 Switch", "MIC2 Input"},
1228 {"Receiver Mixer", "IN1 Switch", "IN1 Input"},
1229 {"Receiver Mixer", "IN2 Switch", "IN2 Input"},
1230
1231 /* Left Lineout output mixer */
1232 {"Left Lineout Mixer", "Left DAC1 Switch", "DACL1"},
1233 {"Left Lineout Mixer", "Right DAC1 Switch", "DACR1"},
1234 {"Left Lineout Mixer", "MIC1 Switch", "MIC1 Input"},
1235 {"Left Lineout Mixer", "MIC2 Switch", "MIC2 Input"},
1236 {"Left Lineout Mixer", "IN1 Switch", "IN1 Input"},
1237 {"Left Lineout Mixer", "IN2 Switch", "IN2 Input"},
1238
1239 /* Right lineout output mixer */
1240 {"Right Lineout Mixer", "Left DAC1 Switch", "DACL1"},
1241 {"Right Lineout Mixer", "Right DAC1 Switch", "DACR1"},
1242 {"Right Lineout Mixer", "MIC1 Switch", "MIC1 Input"},
1243 {"Right Lineout Mixer", "MIC2 Switch", "MIC2 Input"},
1244 {"Right Lineout Mixer", "IN1 Switch", "IN1 Input"},
1245 {"Right Lineout Mixer", "IN2 Switch", "IN2 Input"},
1246
1247 {"HP Left Out", NULL, "Left Headphone Mixer"},
1248 {"HP Right Out", NULL, "Right Headphone Mixer"},
1249 {"SPK Left Out", NULL, "Left Speaker Mixer"},
1250 {"SPK Right Out", NULL, "Right Speaker Mixer"},
1251 {"RCV Mono Out", NULL, "Receiver Mixer"},
1252 {"LINE Left Out", NULL, "Left Lineout Mixer"},
1253 {"LINE Right Out", NULL, "Right Lineout Mixer"},
1254
1255 {"HPL", NULL, "HP Left Out"},
1256 {"HPR", NULL, "HP Right Out"},
1257 {"SPKL", NULL, "SPK Left Out"},
1258 {"SPKR", NULL, "SPK Right Out"},
1259 {"RCV", NULL, "RCV Mono Out"},
1260 {"OUT1", NULL, "LINE Left Out"},
1261 {"OUT2", NULL, "LINE Right Out"},
1262 {"OUT3", NULL, "LINE Left Out"},
1263 {"OUT4", NULL, "LINE Right Out"},
1264
1265 /* Left ADC input mixer */
1266 {"Left ADC Mixer", "MIC1 Switch", "MIC1 Input"},
1267 {"Left ADC Mixer", "MIC2 Switch", "MIC2 Input"},
1268 {"Left ADC Mixer", "IN1 Switch", "IN1 Input"},
1269 {"Left ADC Mixer", "IN2 Switch", "IN2 Input"},
1270
1271 /* Right ADC input mixer */
1272 {"Right ADC Mixer", "MIC1 Switch", "MIC1 Input"},
1273 {"Right ADC Mixer", "MIC2 Switch", "MIC2 Input"},
1274 {"Right ADC Mixer", "IN1 Switch", "IN1 Input"},
1275 {"Right ADC Mixer", "IN2 Switch", "IN2 Input"},
1276
1277 /* Inputs */
1278 {"ADCL", NULL, "Left ADC Mixer"},
1279 {"ADCR", NULL, "Right ADC Mixer"},
1280
1281 {"IN1 Input", NULL, "INA1"},
1282 {"IN2 Input", NULL, "INA2"},
1283
1284 {"MIC1 Input", NULL, "MIC1"},
1285 {"MIC2 Input", NULL, "MIC2"},
1286};
1287
1288static int max98095_add_widgets(struct snd_soc_codec *codec)
1289{
1290 snd_soc_add_controls(codec, max98095_snd_controls,
1291 ARRAY_SIZE(max98095_snd_controls));
1292
1293 return 0;
1294}
1295
1296/* codec mclk clock divider coefficients */
1297static const struct {
1298 u32 rate;
1299 u8 sr;
1300} rate_table[] = {
1301 {8000, 0x01},
1302 {11025, 0x02},
1303 {16000, 0x03},
1304 {22050, 0x04},
1305 {24000, 0x05},
1306 {32000, 0x06},
1307 {44100, 0x07},
1308 {48000, 0x08},
1309 {88200, 0x09},
1310 {96000, 0x0A},
1311};
1312
1313static int rate_value(int rate, u8 *value)
1314{
1315 int i;
1316
1317 for (i = 0; i < ARRAY_SIZE(rate_table); i++) {
1318 if (rate_table[i].rate >= rate) {
1319 *value = rate_table[i].sr;
1320 return 0;
1321 }
1322 }
1323 *value = rate_table[0].sr;
1324 return -EINVAL;
1325}
1326
1327static int max98095_dai1_hw_params(struct snd_pcm_substream *substream,
1328 struct snd_pcm_hw_params *params,
1329 struct snd_soc_dai *dai)
1330{
1331 struct snd_soc_codec *codec = dai->codec;
1332 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1333 struct max98095_cdata *cdata;
1334 unsigned long long ni;
1335 unsigned int rate;
1336 u8 regval;
1337
1338 cdata = &max98095->dai[0];
1339
1340 rate = params_rate(params);
1341
1342 switch (params_format(params)) {
1343 case SNDRV_PCM_FORMAT_S16_LE:
1344 snd_soc_update_bits(codec, M98095_02A_DAI1_FORMAT,
1345 M98095_DAI_WS, 0);
1346 break;
1347 case SNDRV_PCM_FORMAT_S24_LE:
1348 snd_soc_update_bits(codec, M98095_02A_DAI1_FORMAT,
1349 M98095_DAI_WS, M98095_DAI_WS);
1350 break;
1351 default:
1352 return -EINVAL;
1353 }
1354
1355 if (rate_value(rate, ®val))
1356 return -EINVAL;
1357
1358 snd_soc_update_bits(codec, M98095_027_DAI1_CLKMODE,
1359 M98095_CLKMODE_MASK, regval);
1360 cdata->rate = rate;
1361
1362 /* Configure NI when operating as master */
1363 if (snd_soc_read(codec, M98095_02A_DAI1_FORMAT) & M98095_DAI_MAS) {
1364 if (max98095->sysclk == 0) {
1365 dev_err(codec->dev, "Invalid system clock frequency\n");
1366 return -EINVAL;
1367 }
1368 ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
1369 * (unsigned long long int)rate;
1370 do_div(ni, (unsigned long long int)max98095->sysclk);
1371 snd_soc_write(codec, M98095_028_DAI1_CLKCFG_HI,
1372 (ni >> 8) & 0x7F);
1373 snd_soc_write(codec, M98095_029_DAI1_CLKCFG_LO,
1374 ni & 0xFF);
1375 }
1376
1377 /* Update sample rate mode */
1378 if (rate < 50000)
1379 snd_soc_update_bits(codec, M98095_02E_DAI1_FILTERS,
1380 M98095_DAI_DHF, 0);
1381 else
1382 snd_soc_update_bits(codec, M98095_02E_DAI1_FILTERS,
1383 M98095_DAI_DHF, M98095_DAI_DHF);
1384
1385 return 0;
1386}
1387
1388static int max98095_dai2_hw_params(struct snd_pcm_substream *substream,
1389 struct snd_pcm_hw_params *params,
1390 struct snd_soc_dai *dai)
1391{
1392 struct snd_soc_codec *codec = dai->codec;
1393 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1394 struct max98095_cdata *cdata;
1395 unsigned long long ni;
1396 unsigned int rate;
1397 u8 regval;
1398
1399 cdata = &max98095->dai[1];
1400
1401 rate = params_rate(params);
1402
1403 switch (params_format(params)) {
1404 case SNDRV_PCM_FORMAT_S16_LE:
1405 snd_soc_update_bits(codec, M98095_034_DAI2_FORMAT,
1406 M98095_DAI_WS, 0);
1407 break;
1408 case SNDRV_PCM_FORMAT_S24_LE:
1409 snd_soc_update_bits(codec, M98095_034_DAI2_FORMAT,
1410 M98095_DAI_WS, M98095_DAI_WS);
1411 break;
1412 default:
1413 return -EINVAL;
1414 }
1415
1416 if (rate_value(rate, ®val))
1417 return -EINVAL;
1418
1419 snd_soc_update_bits(codec, M98095_031_DAI2_CLKMODE,
1420 M98095_CLKMODE_MASK, regval);
1421 cdata->rate = rate;
1422
1423 /* Configure NI when operating as master */
1424 if (snd_soc_read(codec, M98095_034_DAI2_FORMAT) & M98095_DAI_MAS) {
1425 if (max98095->sysclk == 0) {
1426 dev_err(codec->dev, "Invalid system clock frequency\n");
1427 return -EINVAL;
1428 }
1429 ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
1430 * (unsigned long long int)rate;
1431 do_div(ni, (unsigned long long int)max98095->sysclk);
1432 snd_soc_write(codec, M98095_032_DAI2_CLKCFG_HI,
1433 (ni >> 8) & 0x7F);
1434 snd_soc_write(codec, M98095_033_DAI2_CLKCFG_LO,
1435 ni & 0xFF);
1436 }
1437
1438 /* Update sample rate mode */
1439 if (rate < 50000)
1440 snd_soc_update_bits(codec, M98095_038_DAI2_FILTERS,
1441 M98095_DAI_DHF, 0);
1442 else
1443 snd_soc_update_bits(codec, M98095_038_DAI2_FILTERS,
1444 M98095_DAI_DHF, M98095_DAI_DHF);
1445
1446 return 0;
1447}
1448
1449static int max98095_dai3_hw_params(struct snd_pcm_substream *substream,
1450 struct snd_pcm_hw_params *params,
1451 struct snd_soc_dai *dai)
1452{
1453 struct snd_soc_codec *codec = dai->codec;
1454 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1455 struct max98095_cdata *cdata;
1456 unsigned long long ni;
1457 unsigned int rate;
1458 u8 regval;
1459
1460 cdata = &max98095->dai[2];
1461
1462 rate = params_rate(params);
1463
1464 switch (params_format(params)) {
1465 case SNDRV_PCM_FORMAT_S16_LE:
1466 snd_soc_update_bits(codec, M98095_03E_DAI3_FORMAT,
1467 M98095_DAI_WS, 0);
1468 break;
1469 case SNDRV_PCM_FORMAT_S24_LE:
1470 snd_soc_update_bits(codec, M98095_03E_DAI3_FORMAT,
1471 M98095_DAI_WS, M98095_DAI_WS);
1472 break;
1473 default:
1474 return -EINVAL;
1475 }
1476
1477 if (rate_value(rate, ®val))
1478 return -EINVAL;
1479
1480 snd_soc_update_bits(codec, M98095_03B_DAI3_CLKMODE,
1481 M98095_CLKMODE_MASK, regval);
1482 cdata->rate = rate;
1483
1484 /* Configure NI when operating as master */
1485 if (snd_soc_read(codec, M98095_03E_DAI3_FORMAT) & M98095_DAI_MAS) {
1486 if (max98095->sysclk == 0) {
1487 dev_err(codec->dev, "Invalid system clock frequency\n");
1488 return -EINVAL;
1489 }
1490 ni = 65536ULL * (rate < 50000 ? 96ULL : 48ULL)
1491 * (unsigned long long int)rate;
1492 do_div(ni, (unsigned long long int)max98095->sysclk);
1493 snd_soc_write(codec, M98095_03C_DAI3_CLKCFG_HI,
1494 (ni >> 8) & 0x7F);
1495 snd_soc_write(codec, M98095_03D_DAI3_CLKCFG_LO,
1496 ni & 0xFF);
1497 }
1498
1499 /* Update sample rate mode */
1500 if (rate < 50000)
1501 snd_soc_update_bits(codec, M98095_042_DAI3_FILTERS,
1502 M98095_DAI_DHF, 0);
1503 else
1504 snd_soc_update_bits(codec, M98095_042_DAI3_FILTERS,
1505 M98095_DAI_DHF, M98095_DAI_DHF);
1506
1507 return 0;
1508}
1509
1510static int max98095_dai_set_sysclk(struct snd_soc_dai *dai,
1511 int clk_id, unsigned int freq, int dir)
1512{
1513 struct snd_soc_codec *codec = dai->codec;
1514 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1515
1516 /* Requested clock frequency is already setup */
1517 if (freq == max98095->sysclk)
1518 return 0;
1519
1520 /* Setup clocks for slave mode, and using the PLL
1521 * PSCLK = 0x01 (when master clk is 10MHz to 20MHz)
1522 * 0x02 (when master clk is 20MHz to 40MHz)..
1523 * 0x03 (when master clk is 40MHz to 60MHz)..
1524 */
1525 if ((freq >= 10000000) && (freq < 20000000)) {
1526 snd_soc_write(codec, M98095_026_SYS_CLK, 0x10);
1527 } else if ((freq >= 20000000) && (freq < 40000000)) {
1528 snd_soc_write(codec, M98095_026_SYS_CLK, 0x20);
1529 } else if ((freq >= 40000000) && (freq < 60000000)) {
1530 snd_soc_write(codec, M98095_026_SYS_CLK, 0x30);
1531 } else {
1532 dev_err(codec->dev, "Invalid master clock frequency\n");
1533 return -EINVAL;
1534 }
1535
1536 dev_dbg(dai->dev, "Clock source is %d at %uHz\n", clk_id, freq);
1537
1538 max98095->sysclk = freq;
1539 return 0;
1540}
1541
1542static int max98095_dai1_set_fmt(struct snd_soc_dai *codec_dai,
1543 unsigned int fmt)
1544{
1545 struct snd_soc_codec *codec = codec_dai->codec;
1546 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1547 struct max98095_cdata *cdata;
1548 u8 regval = 0;
1549
1550 cdata = &max98095->dai[0];
1551
1552 if (fmt != cdata->fmt) {
1553 cdata->fmt = fmt;
1554
1555 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1556 case SND_SOC_DAIFMT_CBS_CFS:
1557 /* Slave mode PLL */
1558 snd_soc_write(codec, M98095_028_DAI1_CLKCFG_HI,
1559 0x80);
1560 snd_soc_write(codec, M98095_029_DAI1_CLKCFG_LO,
1561 0x00);
1562 break;
1563 case SND_SOC_DAIFMT_CBM_CFM:
1564 /* Set to master mode */
1565 regval |= M98095_DAI_MAS;
1566 break;
1567 case SND_SOC_DAIFMT_CBS_CFM:
1568 case SND_SOC_DAIFMT_CBM_CFS:
1569 default:
1570 dev_err(codec->dev, "Clock mode unsupported");
1571 return -EINVAL;
1572 }
1573
1574 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1575 case SND_SOC_DAIFMT_I2S:
1576 regval |= M98095_DAI_DLY;
1577 break;
1578 case SND_SOC_DAIFMT_LEFT_J:
1579 break;
1580 default:
1581 return -EINVAL;
1582 }
1583
1584 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1585 case SND_SOC_DAIFMT_NB_NF:
1586 break;
1587 case SND_SOC_DAIFMT_NB_IF:
1588 regval |= M98095_DAI_WCI;
1589 break;
1590 case SND_SOC_DAIFMT_IB_NF:
1591 regval |= M98095_DAI_BCI;
1592 break;
1593 case SND_SOC_DAIFMT_IB_IF:
1594 regval |= M98095_DAI_BCI|M98095_DAI_WCI;
1595 break;
1596 default:
1597 return -EINVAL;
1598 }
1599
1600 snd_soc_update_bits(codec, M98095_02A_DAI1_FORMAT,
1601 M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
1602 M98095_DAI_WCI, regval);
1603
1604 snd_soc_write(codec, M98095_02B_DAI1_CLOCK, M98095_DAI_BSEL64);
1605 }
1606
1607 return 0;
1608}
1609
1610static int max98095_dai2_set_fmt(struct snd_soc_dai *codec_dai,
1611 unsigned int fmt)
1612{
1613 struct snd_soc_codec *codec = codec_dai->codec;
1614 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1615 struct max98095_cdata *cdata;
1616 u8 regval = 0;
1617
1618 cdata = &max98095->dai[1];
1619
1620 if (fmt != cdata->fmt) {
1621 cdata->fmt = fmt;
1622
1623 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1624 case SND_SOC_DAIFMT_CBS_CFS:
1625 /* Slave mode PLL */
1626 snd_soc_write(codec, M98095_032_DAI2_CLKCFG_HI,
1627 0x80);
1628 snd_soc_write(codec, M98095_033_DAI2_CLKCFG_LO,
1629 0x00);
1630 break;
1631 case SND_SOC_DAIFMT_CBM_CFM:
1632 /* Set to master mode */
1633 regval |= M98095_DAI_MAS;
1634 break;
1635 case SND_SOC_DAIFMT_CBS_CFM:
1636 case SND_SOC_DAIFMT_CBM_CFS:
1637 default:
1638 dev_err(codec->dev, "Clock mode unsupported");
1639 return -EINVAL;
1640 }
1641
1642 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1643 case SND_SOC_DAIFMT_I2S:
1644 regval |= M98095_DAI_DLY;
1645 break;
1646 case SND_SOC_DAIFMT_LEFT_J:
1647 break;
1648 default:
1649 return -EINVAL;
1650 }
1651
1652 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1653 case SND_SOC_DAIFMT_NB_NF:
1654 break;
1655 case SND_SOC_DAIFMT_NB_IF:
1656 regval |= M98095_DAI_WCI;
1657 break;
1658 case SND_SOC_DAIFMT_IB_NF:
1659 regval |= M98095_DAI_BCI;
1660 break;
1661 case SND_SOC_DAIFMT_IB_IF:
1662 regval |= M98095_DAI_BCI|M98095_DAI_WCI;
1663 break;
1664 default:
1665 return -EINVAL;
1666 }
1667
1668 snd_soc_update_bits(codec, M98095_034_DAI2_FORMAT,
1669 M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
1670 M98095_DAI_WCI, regval);
1671
1672 snd_soc_write(codec, M98095_035_DAI2_CLOCK,
1673 M98095_DAI_BSEL64);
1674 }
1675
1676 return 0;
1677}
1678
1679static int max98095_dai3_set_fmt(struct snd_soc_dai *codec_dai,
1680 unsigned int fmt)
1681{
1682 struct snd_soc_codec *codec = codec_dai->codec;
1683 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1684 struct max98095_cdata *cdata;
1685 u8 regval = 0;
1686
1687 cdata = &max98095->dai[2];
1688
1689 if (fmt != cdata->fmt) {
1690 cdata->fmt = fmt;
1691
1692 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1693 case SND_SOC_DAIFMT_CBS_CFS:
1694 /* Slave mode PLL */
1695 snd_soc_write(codec, M98095_03C_DAI3_CLKCFG_HI,
1696 0x80);
1697 snd_soc_write(codec, M98095_03D_DAI3_CLKCFG_LO,
1698 0x00);
1699 break;
1700 case SND_SOC_DAIFMT_CBM_CFM:
1701 /* Set to master mode */
1702 regval |= M98095_DAI_MAS;
1703 break;
1704 case SND_SOC_DAIFMT_CBS_CFM:
1705 case SND_SOC_DAIFMT_CBM_CFS:
1706 default:
1707 dev_err(codec->dev, "Clock mode unsupported");
1708 return -EINVAL;
1709 }
1710
1711 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1712 case SND_SOC_DAIFMT_I2S:
1713 regval |= M98095_DAI_DLY;
1714 break;
1715 case SND_SOC_DAIFMT_LEFT_J:
1716 break;
1717 default:
1718 return -EINVAL;
1719 }
1720
1721 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1722 case SND_SOC_DAIFMT_NB_NF:
1723 break;
1724 case SND_SOC_DAIFMT_NB_IF:
1725 regval |= M98095_DAI_WCI;
1726 break;
1727 case SND_SOC_DAIFMT_IB_NF:
1728 regval |= M98095_DAI_BCI;
1729 break;
1730 case SND_SOC_DAIFMT_IB_IF:
1731 regval |= M98095_DAI_BCI|M98095_DAI_WCI;
1732 break;
1733 default:
1734 return -EINVAL;
1735 }
1736
1737 snd_soc_update_bits(codec, M98095_03E_DAI3_FORMAT,
1738 M98095_DAI_MAS | M98095_DAI_DLY | M98095_DAI_BCI |
1739 M98095_DAI_WCI, regval);
1740
1741 snd_soc_write(codec, M98095_03F_DAI3_CLOCK,
1742 M98095_DAI_BSEL64);
1743 }
1744
1745 return 0;
1746}
1747
1748static int max98095_set_bias_level(struct snd_soc_codec *codec,
1749 enum snd_soc_bias_level level)
1750{
1751 int ret;
1752
1753 switch (level) {
1754 case SND_SOC_BIAS_ON:
1755 break;
1756
1757 case SND_SOC_BIAS_PREPARE:
1758 break;
1759
1760 case SND_SOC_BIAS_STANDBY:
1761 if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
1762 ret = snd_soc_cache_sync(codec);
1763
1764 if (ret != 0) {
1765 dev_err(codec->dev, "Failed to sync cache: %d\n", ret);
1766 return ret;
1767 }
1768 }
1769
1770 snd_soc_update_bits(codec, M98095_090_PWR_EN_IN,
1771 M98095_MBEN, M98095_MBEN);
1772 break;
1773
1774 case SND_SOC_BIAS_OFF:
1775 snd_soc_update_bits(codec, M98095_090_PWR_EN_IN,
1776 M98095_MBEN, 0);
1777 codec->cache_sync = 1;
1778 break;
1779 }
1780 codec->dapm.bias_level = level;
1781 return 0;
1782}
1783
1784#define MAX98095_RATES SNDRV_PCM_RATE_8000_96000
1785#define MAX98095_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE)
1786
1787static struct snd_soc_dai_ops max98095_dai1_ops = {
1788 .set_sysclk = max98095_dai_set_sysclk,
1789 .set_fmt = max98095_dai1_set_fmt,
1790 .hw_params = max98095_dai1_hw_params,
1791};
1792
1793static struct snd_soc_dai_ops max98095_dai2_ops = {
1794 .set_sysclk = max98095_dai_set_sysclk,
1795 .set_fmt = max98095_dai2_set_fmt,
1796 .hw_params = max98095_dai2_hw_params,
1797};
1798
1799static struct snd_soc_dai_ops max98095_dai3_ops = {
1800 .set_sysclk = max98095_dai_set_sysclk,
1801 .set_fmt = max98095_dai3_set_fmt,
1802 .hw_params = max98095_dai3_hw_params,
1803};
1804
1805static struct snd_soc_dai_driver max98095_dai[] = {
1806{
1807 .name = "HiFi",
1808 .playback = {
1809 .stream_name = "HiFi Playback",
1810 .channels_min = 1,
1811 .channels_max = 2,
1812 .rates = MAX98095_RATES,
1813 .formats = MAX98095_FORMATS,
1814 },
1815 .capture = {
1816 .stream_name = "HiFi Capture",
1817 .channels_min = 1,
1818 .channels_max = 2,
1819 .rates = MAX98095_RATES,
1820 .formats = MAX98095_FORMATS,
1821 },
1822 .ops = &max98095_dai1_ops,
1823},
1824{
1825 .name = "Aux",
1826 .playback = {
1827 .stream_name = "Aux Playback",
1828 .channels_min = 1,
1829 .channels_max = 1,
1830 .rates = MAX98095_RATES,
1831 .formats = MAX98095_FORMATS,
1832 },
1833 .ops = &max98095_dai2_ops,
1834},
1835{
1836 .name = "Voice",
1837 .playback = {
1838 .stream_name = "Voice Playback",
1839 .channels_min = 1,
1840 .channels_max = 1,
1841 .rates = MAX98095_RATES,
1842 .formats = MAX98095_FORMATS,
1843 },
1844 .ops = &max98095_dai3_ops,
1845}
1846
1847};
1848
1849static int max98095_get_eq_channel(const char *name)
1850{
1851 if (strcmp(name, "EQ1 Mode") == 0)
1852 return 0;
1853 if (strcmp(name, "EQ2 Mode") == 0)
1854 return 1;
1855 return -EINVAL;
1856}
1857
1858static int max98095_put_eq_enum(struct snd_kcontrol *kcontrol,
1859 struct snd_ctl_elem_value *ucontrol)
1860{
1861 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1862 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1863 struct max98095_pdata *pdata = max98095->pdata;
1864 int channel = max98095_get_eq_channel(kcontrol->id.name);
1865 struct max98095_cdata *cdata;
1866 int sel = ucontrol->value.integer.value[0];
1867 struct max98095_eq_cfg *coef_set;
1868 int fs, best, best_val, i;
1869 int regmask, regsave;
1870
1871 BUG_ON(channel > 1);
1872
1873 if (!pdata || !max98095->eq_textcnt)
1874 return 0;
1875
1876 if (sel >= pdata->eq_cfgcnt)
1877 return -EINVAL;
1878
1879 cdata = &max98095->dai[channel];
1880 cdata->eq_sel = sel;
1881 fs = cdata->rate;
1882
1883 /* Find the selected configuration with nearest sample rate */
1884 best = 0;
1885 best_val = INT_MAX;
1886 for (i = 0; i < pdata->eq_cfgcnt; i++) {
1887 if (strcmp(pdata->eq_cfg[i].name, max98095->eq_texts[sel]) == 0 &&
1888 abs(pdata->eq_cfg[i].rate - fs) < best_val) {
1889 best = i;
1890 best_val = abs(pdata->eq_cfg[i].rate - fs);
1891 }
1892 }
1893
1894 dev_dbg(codec->dev, "Selected %s/%dHz for %dHz sample rate\n",
1895 pdata->eq_cfg[best].name,
1896 pdata->eq_cfg[best].rate, fs);
1897
1898 coef_set = &pdata->eq_cfg[best];
1899
1900 regmask = (channel == 0) ? M98095_EQ1EN : M98095_EQ2EN;
1901
1902 /* Disable filter while configuring, and save current on/off state */
1903 regsave = snd_soc_read(codec, M98095_088_CFG_LEVEL);
1904 snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, 0);
1905
1906 mutex_lock(&codec->mutex);
1907 snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, M98095_SEG);
1908 m98095_eq_band(codec, channel, 0, coef_set->band1);
1909 m98095_eq_band(codec, channel, 1, coef_set->band2);
1910 m98095_eq_band(codec, channel, 2, coef_set->band3);
1911 m98095_eq_band(codec, channel, 3, coef_set->band4);
1912 m98095_eq_band(codec, channel, 4, coef_set->band5);
1913 snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, 0);
1914 mutex_unlock(&codec->mutex);
1915
1916 /* Restore the original on/off state */
1917 snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, regsave);
1918 return 0;
1919}
1920
1921static int max98095_get_eq_enum(struct snd_kcontrol *kcontrol,
1922 struct snd_ctl_elem_value *ucontrol)
1923{
1924 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1925 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1926 int channel = max98095_get_eq_channel(kcontrol->id.name);
1927 struct max98095_cdata *cdata;
1928
1929 cdata = &max98095->dai[channel];
1930 ucontrol->value.enumerated.item[0] = cdata->eq_sel;
1931
1932 return 0;
1933}
1934
1935static void max98095_handle_eq_pdata(struct snd_soc_codec *codec)
1936{
1937 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
1938 struct max98095_pdata *pdata = max98095->pdata;
1939 struct max98095_eq_cfg *cfg;
1940 unsigned int cfgcnt;
1941 int i, j;
1942 const char **t;
1943 int ret;
1944
1945 struct snd_kcontrol_new controls[] = {
1946 SOC_ENUM_EXT("EQ1 Mode",
1947 max98095->eq_enum,
1948 max98095_get_eq_enum,
1949 max98095_put_eq_enum),
1950 SOC_ENUM_EXT("EQ2 Mode",
1951 max98095->eq_enum,
1952 max98095_get_eq_enum,
1953 max98095_put_eq_enum),
1954 };
1955
1956 cfg = pdata->eq_cfg;
1957 cfgcnt = pdata->eq_cfgcnt;
1958
1959 /* Setup an array of texts for the equalizer enum.
1960 * This is based on Mark Brown's equalizer driver code.
1961 */
1962 max98095->eq_textcnt = 0;
1963 max98095->eq_texts = NULL;
1964 for (i = 0; i < cfgcnt; i++) {
1965 for (j = 0; j < max98095->eq_textcnt; j++) {
1966 if (strcmp(cfg[i].name, max98095->eq_texts[j]) == 0)
1967 break;
1968 }
1969
1970 if (j != max98095->eq_textcnt)
1971 continue;
1972
1973 /* Expand the array */
1974 t = krealloc(max98095->eq_texts,
1975 sizeof(char *) * (max98095->eq_textcnt + 1),
1976 GFP_KERNEL);
1977 if (t == NULL)
1978 continue;
1979
1980 /* Store the new entry */
1981 t[max98095->eq_textcnt] = cfg[i].name;
1982 max98095->eq_textcnt++;
1983 max98095->eq_texts = t;
1984 }
1985
1986 /* Now point the soc_enum to .texts array items */
1987 max98095->eq_enum.texts = max98095->eq_texts;
1988 max98095->eq_enum.max = max98095->eq_textcnt;
1989
1990 ret = snd_soc_add_controls(codec, controls, ARRAY_SIZE(controls));
1991 if (ret != 0)
1992 dev_err(codec->dev, "Failed to add EQ control: %d\n", ret);
1993}
1994
1995static int max98095_get_bq_channel(const char *name)
1996{
1997 if (strcmp(name, "Biquad1 Mode") == 0)
1998 return 0;
1999 if (strcmp(name, "Biquad2 Mode") == 0)
2000 return 1;
2001 return -EINVAL;
2002}
2003
2004static int max98095_put_bq_enum(struct snd_kcontrol *kcontrol,
2005 struct snd_ctl_elem_value *ucontrol)
2006{
2007 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2008 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2009 struct max98095_pdata *pdata = max98095->pdata;
2010 int channel = max98095_get_bq_channel(kcontrol->id.name);
2011 struct max98095_cdata *cdata;
2012 int sel = ucontrol->value.integer.value[0];
2013 struct max98095_biquad_cfg *coef_set;
2014 int fs, best, best_val, i;
2015 int regmask, regsave;
2016
2017 BUG_ON(channel > 1);
2018
2019 if (!pdata || !max98095->bq_textcnt)
2020 return 0;
2021
2022 if (sel >= pdata->bq_cfgcnt)
2023 return -EINVAL;
2024
2025 cdata = &max98095->dai[channel];
2026 cdata->bq_sel = sel;
2027 fs = cdata->rate;
2028
2029 /* Find the selected configuration with nearest sample rate */
2030 best = 0;
2031 best_val = INT_MAX;
2032 for (i = 0; i < pdata->bq_cfgcnt; i++) {
2033 if (strcmp(pdata->bq_cfg[i].name, max98095->bq_texts[sel]) == 0 &&
2034 abs(pdata->bq_cfg[i].rate - fs) < best_val) {
2035 best = i;
2036 best_val = abs(pdata->bq_cfg[i].rate - fs);
2037 }
2038 }
2039
2040 dev_dbg(codec->dev, "Selected %s/%dHz for %dHz sample rate\n",
2041 pdata->bq_cfg[best].name,
2042 pdata->bq_cfg[best].rate, fs);
2043
2044 coef_set = &pdata->bq_cfg[best];
2045
2046 regmask = (channel == 0) ? M98095_BQ1EN : M98095_BQ2EN;
2047
2048 /* Disable filter while configuring, and save current on/off state */
2049 regsave = snd_soc_read(codec, M98095_088_CFG_LEVEL);
2050 snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, 0);
2051
2052 mutex_lock(&codec->mutex);
2053 snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, M98095_SEG);
2054 m98095_biquad_band(codec, channel, 0, coef_set->band1);
2055 m98095_biquad_band(codec, channel, 1, coef_set->band2);
2056 snd_soc_update_bits(codec, M98095_00F_HOST_CFG, M98095_SEG, 0);
2057 mutex_unlock(&codec->mutex);
2058
2059 /* Restore the original on/off state */
2060 snd_soc_update_bits(codec, M98095_088_CFG_LEVEL, regmask, regsave);
2061 return 0;
2062}
2063
2064static int max98095_get_bq_enum(struct snd_kcontrol *kcontrol,
2065 struct snd_ctl_elem_value *ucontrol)
2066{
2067 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
2068 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2069 int channel = max98095_get_bq_channel(kcontrol->id.name);
2070 struct max98095_cdata *cdata;
2071
2072 cdata = &max98095->dai[channel];
2073 ucontrol->value.enumerated.item[0] = cdata->bq_sel;
2074
2075 return 0;
2076}
2077
2078static void max98095_handle_bq_pdata(struct snd_soc_codec *codec)
2079{
2080 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2081 struct max98095_pdata *pdata = max98095->pdata;
2082 struct max98095_biquad_cfg *cfg;
2083 unsigned int cfgcnt;
2084 int i, j;
2085 const char **t;
2086 int ret;
2087
2088 struct snd_kcontrol_new controls[] = {
2089 SOC_ENUM_EXT("Biquad1 Mode",
2090 max98095->bq_enum,
2091 max98095_get_bq_enum,
2092 max98095_put_bq_enum),
2093 SOC_ENUM_EXT("Biquad2 Mode",
2094 max98095->bq_enum,
2095 max98095_get_bq_enum,
2096 max98095_put_bq_enum),
2097 };
2098
2099 cfg = pdata->bq_cfg;
2100 cfgcnt = pdata->bq_cfgcnt;
2101
2102 /* Setup an array of texts for the biquad enum.
2103 * This is based on Mark Brown's equalizer driver code.
2104 */
2105 max98095->bq_textcnt = 0;
2106 max98095->bq_texts = NULL;
2107 for (i = 0; i < cfgcnt; i++) {
2108 for (j = 0; j < max98095->bq_textcnt; j++) {
2109 if (strcmp(cfg[i].name, max98095->bq_texts[j]) == 0)
2110 break;
2111 }
2112
2113 if (j != max98095->bq_textcnt)
2114 continue;
2115
2116 /* Expand the array */
2117 t = krealloc(max98095->bq_texts,
2118 sizeof(char *) * (max98095->bq_textcnt + 1),
2119 GFP_KERNEL);
2120 if (t == NULL)
2121 continue;
2122
2123 /* Store the new entry */
2124 t[max98095->bq_textcnt] = cfg[i].name;
2125 max98095->bq_textcnt++;
2126 max98095->bq_texts = t;
2127 }
2128
2129 /* Now point the soc_enum to .texts array items */
2130 max98095->bq_enum.texts = max98095->bq_texts;
2131 max98095->bq_enum.max = max98095->bq_textcnt;
2132
2133 ret = snd_soc_add_controls(codec, controls, ARRAY_SIZE(controls));
2134 if (ret != 0)
2135 dev_err(codec->dev, "Failed to add Biquad control: %d\n", ret);
2136}
2137
2138static void max98095_handle_pdata(struct snd_soc_codec *codec)
2139{
2140 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2141 struct max98095_pdata *pdata = max98095->pdata;
2142 u8 regval = 0;
2143
2144 if (!pdata) {
2145 dev_dbg(codec->dev, "No platform data\n");
2146 return;
2147 }
2148
2149 /* Configure mic for analog/digital mic mode */
2150 if (pdata->digmic_left_mode)
2151 regval |= M98095_DIGMIC_L;
2152
2153 if (pdata->digmic_right_mode)
2154 regval |= M98095_DIGMIC_R;
2155
2156 snd_soc_write(codec, M98095_087_CFG_MIC, regval);
2157
2158 /* Configure equalizers */
2159 if (pdata->eq_cfgcnt)
2160 max98095_handle_eq_pdata(codec);
2161
2162 /* Configure bi-quad filters */
2163 if (pdata->bq_cfgcnt)
2164 max98095_handle_bq_pdata(codec);
2165}
2166
2167#ifdef CONFIG_PM
2168static int max98095_suspend(struct snd_soc_codec *codec, pm_message_t state)
2169{
2170 max98095_set_bias_level(codec, SND_SOC_BIAS_OFF);
2171
2172 return 0;
2173}
2174
2175static int max98095_resume(struct snd_soc_codec *codec)
2176{
2177 max98095_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
2178
2179 return 0;
2180}
2181#else
2182#define max98095_suspend NULL
2183#define max98095_resume NULL
2184#endif
2185
2186static int max98095_reset(struct snd_soc_codec *codec)
2187{
2188 int i, ret;
2189
2190 /* Gracefully reset the DSP core and the codec hardware
2191 * in a proper sequence */
2192 ret = snd_soc_write(codec, M98095_00F_HOST_CFG, 0);
2193 if (ret < 0) {
2194 dev_err(codec->dev, "Failed to reset DSP: %d\n", ret);
2195 return ret;
2196 }
2197
2198 ret = snd_soc_write(codec, M98095_097_PWR_SYS, 0);
2199 if (ret < 0) {
2200 dev_err(codec->dev, "Failed to reset codec: %d\n", ret);
2201 return ret;
2202 }
2203
2204 /* Reset to hardware default for registers, as there is not
2205 * a soft reset hardware control register */
2206 for (i = M98095_010_HOST_INT_CFG; i < M98095_REG_MAX_CACHED; i++) {
2207 ret = snd_soc_write(codec, i, max98095_reg_def[i]);
2208 if (ret < 0) {
2209 dev_err(codec->dev, "Failed to reset: %d\n", ret);
2210 return ret;
2211 }
2212 }
2213
2214 return ret;
2215}
2216
2217static int max98095_probe(struct snd_soc_codec *codec)
2218{
2219 struct max98095_priv *max98095 = snd_soc_codec_get_drvdata(codec);
2220 struct max98095_cdata *cdata;
2221 int ret = 0;
2222
2223 ret = snd_soc_codec_set_cache_io(codec, 8, 8, SND_SOC_I2C);
2224 if (ret != 0) {
2225 dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
2226 return ret;
2227 }
2228
2229 /* reset the codec, the DSP core, and disable all interrupts */
2230 max98095_reset(codec);
2231
2232 /* initialize private data */
2233
2234 max98095->sysclk = (unsigned)-1;
2235 max98095->eq_textcnt = 0;
2236 max98095->bq_textcnt = 0;
2237
2238 cdata = &max98095->dai[0];
2239 cdata->rate = (unsigned)-1;
2240 cdata->fmt = (unsigned)-1;
2241 cdata->eq_sel = 0;
2242 cdata->bq_sel = 0;
2243
2244 cdata = &max98095->dai[1];
2245 cdata->rate = (unsigned)-1;
2246 cdata->fmt = (unsigned)-1;
2247 cdata->eq_sel = 0;
2248 cdata->bq_sel = 0;
2249
2250 cdata = &max98095->dai[2];
2251 cdata->rate = (unsigned)-1;
2252 cdata->fmt = (unsigned)-1;
2253 cdata->eq_sel = 0;
2254 cdata->bq_sel = 0;
2255
2256 max98095->lin_state = 0;
2257 max98095->mic1pre = 0;
2258 max98095->mic2pre = 0;
2259
2260 ret = snd_soc_read(codec, M98095_0FF_REV_ID);
2261 if (ret < 0) {
2262 dev_err(codec->dev, "Failure reading hardware revision: %d\n",
2263 ret);
2264 goto err_access;
2265 }
2266 dev_info(codec->dev, "Hardware revision: %c\n", ret - 0x40 + 'A');
2267
2268 snd_soc_write(codec, M98095_097_PWR_SYS, M98095_PWRSV);
2269
2270 /* initialize registers cache to hardware default */
2271 max98095_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
2272
2273 snd_soc_write(codec, M98095_048_MIX_DAC_LR,
2274 M98095_DAI1L_TO_DACL|M98095_DAI1R_TO_DACR);
2275
2276 snd_soc_write(codec, M98095_049_MIX_DAC_M,
2277 M98095_DAI2M_TO_DACM|M98095_DAI3M_TO_DACM);
2278
2279 snd_soc_write(codec, M98095_092_PWR_EN_OUT, M98095_SPK_SPREADSPECTRUM);
2280 snd_soc_write(codec, M98095_045_CFG_DSP, M98095_DSPNORMAL);
2281 snd_soc_write(codec, M98095_04E_CFG_HP, M98095_HPNORMAL);
2282
2283 snd_soc_write(codec, M98095_02C_DAI1_IOCFG,
2284 M98095_S1NORMAL|M98095_SDATA);
2285
2286 snd_soc_write(codec, M98095_036_DAI2_IOCFG,
2287 M98095_S2NORMAL|M98095_SDATA);
2288
2289 snd_soc_write(codec, M98095_040_DAI3_IOCFG,
2290 M98095_S3NORMAL|M98095_SDATA);
2291
2292 max98095_handle_pdata(codec);
2293
2294 /* take the codec out of the shut down */
2295 snd_soc_update_bits(codec, M98095_097_PWR_SYS, M98095_SHDNRUN,
2296 M98095_SHDNRUN);
2297
2298 max98095_add_widgets(codec);
2299
2300err_access:
2301 return ret;
2302}
2303
2304static int max98095_remove(struct snd_soc_codec *codec)
2305{
2306 max98095_set_bias_level(codec, SND_SOC_BIAS_OFF);
2307
2308 return 0;
2309}
2310
2311static struct snd_soc_codec_driver soc_codec_dev_max98095 = {
2312 .probe = max98095_probe,
2313 .remove = max98095_remove,
2314 .suspend = max98095_suspend,
2315 .resume = max98095_resume,
2316 .set_bias_level = max98095_set_bias_level,
2317 .reg_cache_size = ARRAY_SIZE(max98095_reg_def),
2318 .reg_word_size = sizeof(u8),
2319 .reg_cache_default = max98095_reg_def,
2320 .readable_register = max98095_readable,
2321 .volatile_register = max98095_volatile,
2322 .dapm_widgets = max98095_dapm_widgets,
2323 .num_dapm_widgets = ARRAY_SIZE(max98095_dapm_widgets),
2324 .dapm_routes = max98095_audio_map,
2325 .num_dapm_routes = ARRAY_SIZE(max98095_audio_map),
2326};
2327
2328static int max98095_i2c_probe(struct i2c_client *i2c,
2329 const struct i2c_device_id *id)
2330{
2331 struct max98095_priv *max98095;
2332 int ret;
2333
2334 max98095 = kzalloc(sizeof(struct max98095_priv), GFP_KERNEL);
2335 if (max98095 == NULL)
2336 return -ENOMEM;
2337
2338 max98095->devtype = id->driver_data;
2339 i2c_set_clientdata(i2c, max98095);
2340 max98095->control_data = i2c;
2341 max98095->pdata = i2c->dev.platform_data;
2342
2343 ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_max98095,
2344 max98095_dai, ARRAY_SIZE(max98095_dai));
2345 if (ret < 0)
2346 kfree(max98095);
2347 return ret;
2348}
2349
2350static int __devexit max98095_i2c_remove(struct i2c_client *client)
2351{
2352 snd_soc_unregister_codec(&client->dev);
2353 kfree(i2c_get_clientdata(client));
2354
2355 return 0;
2356}
2357
2358static const struct i2c_device_id max98095_i2c_id[] = {
2359 { "max98095", MAX98095 },
2360 { }
2361};
2362MODULE_DEVICE_TABLE(i2c, max98095_i2c_id);
2363
2364static struct i2c_driver max98095_i2c_driver = {
2365 .driver = {
2366 .name = "max98095",
2367 .owner = THIS_MODULE,
2368 },
2369 .probe = max98095_i2c_probe,
2370 .remove = __devexit_p(max98095_i2c_remove),
2371 .id_table = max98095_i2c_id,
2372};
2373
2374static int __init max98095_init(void)
2375{
2376 int ret;
2377
2378 ret = i2c_add_driver(&max98095_i2c_driver);
2379 if (ret)
2380 pr_err("Failed to register max98095 I2C driver: %d\n", ret);
2381
2382 return ret;
2383}
2384module_init(max98095_init);
2385
2386static void __exit max98095_exit(void)
2387{
2388 i2c_del_driver(&max98095_i2c_driver);
2389}
2390module_exit(max98095_exit);
2391
2392MODULE_DESCRIPTION("ALSA SoC MAX98095 driver");
2393MODULE_AUTHOR("Peter Hsiang");
2394MODULE_LICENSE("GPL");