1
2
3
4
5
6
7
8
9
10#include <common.h>
11#include <audio_codec.h>
12#include <dm.h>
13#include <div64.h>
14#include <fdtdec.h>
15#include <i2c.h>
16#include <log.h>
17#include <sound.h>
18#include <asm/gpio.h>
19#include "i2s.h"
20#include "max98095.h"
21
22
23int rate_table[] = {0, 8000, 11025, 16000, 22050, 24000, 32000, 44100, 48000,
24 88200, 96000};
25
26
27
28
29
30
31
32
33
34static int rate_value(int rate, u8 *value)
35{
36 int i;
37
38 for (i = 1; i < ARRAY_SIZE(rate_table); i++) {
39 if (rate_table[i] >= rate) {
40 *value = i;
41 return 0;
42 }
43 }
44 *value = 1;
45
46 return -EINVAL;
47}
48
49
50
51
52
53
54
55
56
57
58static int max98095_hw_params(struct maxim_priv *priv,
59 enum en_max_audio_interface aif_id,
60 unsigned int rate, unsigned int bits_per_sample)
61{
62 u8 regval;
63 int error;
64 unsigned short M98095_DAI_CLKMODE;
65 unsigned short M98095_DAI_FORMAT;
66 unsigned short M98095_DAI_FILTERS;
67
68 if (aif_id == AIF1) {
69 M98095_DAI_CLKMODE = M98095_027_DAI1_CLKMODE;
70 M98095_DAI_FORMAT = M98095_02A_DAI1_FORMAT;
71 M98095_DAI_FILTERS = M98095_02E_DAI1_FILTERS;
72 } else {
73 M98095_DAI_CLKMODE = M98095_031_DAI2_CLKMODE;
74 M98095_DAI_FORMAT = M98095_034_DAI2_FORMAT;
75 M98095_DAI_FILTERS = M98095_038_DAI2_FILTERS;
76 }
77
78 switch (bits_per_sample) {
79 case 16:
80 error = maxim_bic_or(priv, M98095_DAI_FORMAT, M98095_DAI_WS, 0);
81 break;
82 case 24:
83 error = maxim_bic_or(priv, M98095_DAI_FORMAT, M98095_DAI_WS,
84 M98095_DAI_WS);
85 break;
86 default:
87 debug("%s: Illegal bits per sample %d.\n",
88 __func__, bits_per_sample);
89 return -EINVAL;
90 }
91
92 if (rate_value(rate, ®val)) {
93 debug("%s: Failed to set sample rate to %d.\n",
94 __func__, rate);
95 return -EINVAL;
96 }
97 priv->rate = rate;
98
99 error |= maxim_bic_or(priv, M98095_DAI_CLKMODE, M98095_CLKMODE_MASK,
100 regval);
101
102
103 if (rate < 50000)
104 error |= maxim_bic_or(priv, M98095_DAI_FILTERS,
105 M98095_DAI_DHF, 0);
106 else
107 error |= maxim_bic_or(priv, M98095_DAI_FILTERS,
108 M98095_DAI_DHF, M98095_DAI_DHF);
109
110 if (error < 0) {
111 debug("%s: Error setting hardware params.\n", __func__);
112 return -EIO;
113 }
114
115 return 0;
116}
117
118
119
120
121
122
123
124
125
126static int max98095_set_sysclk(struct maxim_priv *priv, unsigned int freq)
127{
128 int error = 0;
129
130
131 if (freq == priv->sysclk)
132 return 0;
133
134
135
136
137
138
139 if ((freq >= 10000000) && (freq < 20000000)) {
140 error = maxim_i2c_write(priv, M98095_026_SYS_CLK, 0x10);
141 } else if ((freq >= 20000000) && (freq < 40000000)) {
142 error = maxim_i2c_write(priv, M98095_026_SYS_CLK, 0x20);
143 } else if ((freq >= 40000000) && (freq < 60000000)) {
144 error = maxim_i2c_write(priv, M98095_026_SYS_CLK, 0x30);
145 } else {
146 debug("%s: Invalid master clock frequency\n", __func__);
147 return -EINVAL;
148 }
149
150 debug("%s: Clock at %uHz\n", __func__, freq);
151
152 if (error < 0)
153 return -EIO;
154
155 priv->sysclk = freq;
156 return 0;
157}
158
159
160
161
162
163
164
165
166
167
168static int max98095_set_fmt(struct maxim_priv *priv, int fmt,
169 enum en_max_audio_interface aif_id)
170{
171 u8 regval = 0;
172 int error = 0;
173 unsigned short M98095_DAI_CLKCFG_HI;
174 unsigned short M98095_DAI_CLKCFG_LO;
175 unsigned short M98095_DAI_FORMAT;
176 unsigned short M98095_DAI_CLOCK;
177
178 if (fmt == priv->fmt)
179 return 0;
180
181 priv->fmt = fmt;
182
183 if (aif_id == AIF1) {
184 M98095_DAI_CLKCFG_HI = M98095_028_DAI1_CLKCFG_HI;
185 M98095_DAI_CLKCFG_LO = M98095_029_DAI1_CLKCFG_LO;
186 M98095_DAI_FORMAT = M98095_02A_DAI1_FORMAT;
187 M98095_DAI_CLOCK = M98095_02B_DAI1_CLOCK;
188 } else {
189 M98095_DAI_CLKCFG_HI = M98095_032_DAI2_CLKCFG_HI;
190 M98095_DAI_CLKCFG_LO = M98095_033_DAI2_CLKCFG_LO;
191 M98095_DAI_FORMAT = M98095_034_DAI2_FORMAT;
192 M98095_DAI_CLOCK = M98095_035_DAI2_CLOCK;
193 }
194
195 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
196 case SND_SOC_DAIFMT_CBS_CFS:
197
198 error |= maxim_i2c_write(priv, M98095_DAI_CLKCFG_HI, 0x80);
199 error |= maxim_i2c_write(priv, M98095_DAI_CLKCFG_LO, 0x00);
200 break;
201 case SND_SOC_DAIFMT_CBM_CFM:
202
203 regval |= M98095_DAI_MAS;
204 break;
205 case SND_SOC_DAIFMT_CBS_CFM:
206 case SND_SOC_DAIFMT_CBM_CFS:
207 default:
208 debug("%s: Clock mode unsupported\n", __func__);
209 return -EINVAL;
210 }
211
212 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
213 case SND_SOC_DAIFMT_I2S:
214 regval |= M98095_DAI_DLY;
215 break;
216 case SND_SOC_DAIFMT_LEFT_J:
217 break;
218 default:
219 debug("%s: Unrecognized format.\n", __func__);
220 return -EINVAL;
221 }
222
223 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
224 case SND_SOC_DAIFMT_NB_NF:
225 break;
226 case SND_SOC_DAIFMT_NB_IF:
227 regval |= M98095_DAI_WCI;
228 break;
229 case SND_SOC_DAIFMT_IB_NF:
230 regval |= M98095_DAI_BCI;
231 break;
232 case SND_SOC_DAIFMT_IB_IF:
233 regval |= M98095_DAI_BCI | M98095_DAI_WCI;
234 break;
235 default:
236 debug("%s: Unrecognized inversion settings.\n", __func__);
237 return -EINVAL;
238 }
239
240 error |= maxim_bic_or(priv, M98095_DAI_FORMAT,
241 M98095_DAI_MAS | M98095_DAI_DLY |
242 M98095_DAI_BCI | M98095_DAI_WCI, regval);
243
244 error |= maxim_i2c_write(priv, M98095_DAI_CLOCK, M98095_DAI_BSEL64);
245
246 if (error < 0) {
247 debug("%s: Error setting i2s format.\n", __func__);
248 return -EIO;
249 }
250
251 return 0;
252}
253
254
255
256
257
258
259
260static int max98095_reset(struct maxim_priv *priv)
261{
262 int i, ret;
263
264
265
266
267
268 ret = maxim_i2c_write(priv, M98095_00F_HOST_CFG, 0);
269 if (ret != 0) {
270 debug("%s: Failed to reset DSP: %d\n", __func__, ret);
271 return ret;
272 }
273
274 ret = maxim_i2c_write(priv, M98095_097_PWR_SYS, 0);
275 if (ret != 0) {
276 debug("%s: Failed to reset codec: %d\n", __func__, ret);
277 return ret;
278 }
279
280
281
282
283
284 for (i = M98095_010_HOST_INT_CFG; i < M98095_REG_MAX_CACHED; i++) {
285 ret = maxim_i2c_write(priv, i, 0);
286 if (ret < 0) {
287 debug("%s: Failed to reset: %d\n", __func__, ret);
288 return ret;
289 }
290 }
291
292 return 0;
293}
294
295
296
297
298
299
300
301static int max98095_device_init(struct maxim_priv *priv)
302{
303 unsigned char id;
304 int ret;
305
306
307 ret = max98095_reset(priv);
308 if (ret != 0) {
309 debug("Reset\n");
310 return ret;
311 }
312
313
314 priv->sysclk = -1U;
315 priv->rate = -1U;
316 priv->fmt = -1U;
317
318 ret = maxim_i2c_read(priv, M98095_0FF_REV_ID, &id);
319 if (ret < 0) {
320 debug("%s: Failure reading hardware revision: %d\n",
321 __func__, id);
322 return ret;
323 }
324 debug("%s: Hardware revision: %c\n", __func__, (id - 0x40) + 'A');
325
326 return 0;
327}
328
329static int max98095_setup_interface(struct maxim_priv *priv,
330 enum en_max_audio_interface aif_id)
331{
332 int error;
333
334 error = maxim_i2c_write(priv, M98095_097_PWR_SYS, M98095_PWRSV);
335
336
337
338
339
340 if (aif_id == AIF1)
341 error |= maxim_i2c_write(priv, M98095_048_MIX_DAC_LR,
342 M98095_DAI1L_TO_DACL |
343 M98095_DAI1R_TO_DACR);
344 else
345 error |= maxim_i2c_write(priv, M98095_048_MIX_DAC_LR,
346 M98095_DAI2M_TO_DACL |
347 M98095_DAI2M_TO_DACR);
348
349 error |= maxim_i2c_write(priv, M98095_092_PWR_EN_OUT,
350 M98095_SPK_SPREADSPECTRUM);
351 error |= maxim_i2c_write(priv, M98095_04E_CFG_HP, M98095_HPNORMAL);
352 if (aif_id == AIF1)
353 error |= maxim_i2c_write(priv, M98095_02C_DAI1_IOCFG,
354 M98095_S1NORMAL | M98095_SDATA);
355 else
356 error |= maxim_i2c_write(priv, M98095_036_DAI2_IOCFG,
357 M98095_S2NORMAL | M98095_SDATA);
358
359
360 error |= maxim_bic_or(priv, M98095_097_PWR_SYS, M98095_SHDNRUN,
361 M98095_SHDNRUN);
362
363
364
365
366 error |= maxim_i2c_write(priv, M98095_050_MIX_SPK_LEFT, 0x01);
367 error |= maxim_i2c_write(priv, M98095_051_MIX_SPK_RIGHT, 0x01);
368 error |= maxim_i2c_write(priv, M98095_04C_MIX_HP_LEFT, 0x01);
369 error |= maxim_i2c_write(priv, M98095_04D_MIX_HP_RIGHT, 0x01);
370
371
372 error |= maxim_i2c_write(priv, M98095_091_PWR_EN_OUT, 0xF3);
373
374
375 error |= maxim_i2c_write(priv, M98095_064_LVL_HP_L, 15);
376 error |= maxim_i2c_write(priv, M98095_065_LVL_HP_R, 15);
377 error |= maxim_i2c_write(priv, M98095_067_LVL_SPK_L, 16);
378 error |= maxim_i2c_write(priv, M98095_068_LVL_SPK_R, 16);
379
380
381 error |= maxim_i2c_write(priv, M98095_093_BIAS_CTRL, 0x30);
382 if (aif_id == AIF1)
383 error |= maxim_i2c_write(priv, M98095_096_PWR_DAC_CK, 0x01);
384 else
385 error |= maxim_i2c_write(priv, M98095_096_PWR_DAC_CK, 0x07);
386
387 if (error < 0)
388 return -EIO;
389
390 return 0;
391}
392
393static int max98095_do_init(struct maxim_priv *priv,
394 enum en_max_audio_interface aif_id,
395 int sampling_rate, int mclk_freq,
396 int bits_per_sample)
397{
398 int ret = 0;
399
400 ret = max98095_setup_interface(priv, aif_id);
401 if (ret < 0) {
402 debug("%s: max98095 setup interface failed\n", __func__);
403 return ret;
404 }
405
406 ret = max98095_set_sysclk(priv, mclk_freq);
407 if (ret < 0) {
408 debug("%s: max98095 codec set sys clock failed\n", __func__);
409 return ret;
410 }
411
412 ret = max98095_hw_params(priv, aif_id, sampling_rate,
413 bits_per_sample);
414
415 if (ret == 0) {
416 ret = max98095_set_fmt(priv, SND_SOC_DAIFMT_I2S |
417 SND_SOC_DAIFMT_NB_NF |
418 SND_SOC_DAIFMT_CBS_CFS,
419 aif_id);
420 }
421
422 return ret;
423}
424
425static int max98095_set_params(struct udevice *dev, int interface, int rate,
426 int mclk_freq, int bits_per_sample,
427 uint channels)
428{
429 struct maxim_priv *priv = dev_get_priv(dev);
430
431 return max98095_do_init(priv, interface, rate, mclk_freq,
432 bits_per_sample);
433}
434
435static int max98095_probe(struct udevice *dev)
436{
437 struct maxim_priv *priv = dev_get_priv(dev);
438 int ret;
439
440 priv->dev = dev;
441 ret = max98095_device_init(priv);
442 if (ret < 0) {
443 debug("%s: max98095 codec chip init failed\n", __func__);
444 return ret;
445 }
446
447 return 0;
448}
449
450static const struct audio_codec_ops max98095_ops = {
451 .set_params = max98095_set_params,
452};
453
454static const struct udevice_id max98095_ids[] = {
455 { .compatible = "maxim,max98095" },
456 { }
457};
458
459U_BOOT_DRIVER(max98095) = {
460 .name = "max98095",
461 .id = UCLASS_AUDIO_CODEC,
462 .of_match = max98095_ids,
463 .probe = max98095_probe,
464 .ops = &max98095_ops,
465 .priv_auto = sizeof(struct maxim_priv),
466};
467