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