blob: 9015b44a9e1101d47d25ad94934de6420ca8d1a6 [file] [log] [blame]
Mark Brown07ed8732012-06-18 21:08:44 +01001/*
2 * arizona.c - Wolfson Arizona class device shared support
3 *
4 * Copyright 2012 Wolfson Microelectronics plc
5 *
6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
11 */
12
Mark Brownddbce972013-02-15 17:27:22 +000013#include <linux/delay.h>
Mark Brown07ed8732012-06-18 21:08:44 +010014#include <linux/gcd.h>
15#include <linux/module.h>
16#include <linux/pm_runtime.h>
17#include <sound/pcm.h>
18#include <sound/pcm_params.h>
19#include <sound/tlv.h>
20
21#include <linux/mfd/arizona/core.h>
Charles Keepaxb63144e2013-07-04 08:56:28 +010022#include <linux/mfd/arizona/gpio.h>
Mark Brown07ed8732012-06-18 21:08:44 +010023#include <linux/mfd/arizona/registers.h>
24
25#include "arizona.h"
26
27#define ARIZONA_AIF_BCLK_CTRL 0x00
28#define ARIZONA_AIF_TX_PIN_CTRL 0x01
29#define ARIZONA_AIF_RX_PIN_CTRL 0x02
30#define ARIZONA_AIF_RATE_CTRL 0x03
31#define ARIZONA_AIF_FORMAT 0x04
32#define ARIZONA_AIF_TX_BCLK_RATE 0x05
33#define ARIZONA_AIF_RX_BCLK_RATE 0x06
34#define ARIZONA_AIF_FRAME_CTRL_1 0x07
35#define ARIZONA_AIF_FRAME_CTRL_2 0x08
36#define ARIZONA_AIF_FRAME_CTRL_3 0x09
37#define ARIZONA_AIF_FRAME_CTRL_4 0x0A
38#define ARIZONA_AIF_FRAME_CTRL_5 0x0B
39#define ARIZONA_AIF_FRAME_CTRL_6 0x0C
40#define ARIZONA_AIF_FRAME_CTRL_7 0x0D
41#define ARIZONA_AIF_FRAME_CTRL_8 0x0E
42#define ARIZONA_AIF_FRAME_CTRL_9 0x0F
43#define ARIZONA_AIF_FRAME_CTRL_10 0x10
44#define ARIZONA_AIF_FRAME_CTRL_11 0x11
45#define ARIZONA_AIF_FRAME_CTRL_12 0x12
46#define ARIZONA_AIF_FRAME_CTRL_13 0x13
47#define ARIZONA_AIF_FRAME_CTRL_14 0x14
48#define ARIZONA_AIF_FRAME_CTRL_15 0x15
49#define ARIZONA_AIF_FRAME_CTRL_16 0x16
50#define ARIZONA_AIF_FRAME_CTRL_17 0x17
51#define ARIZONA_AIF_FRAME_CTRL_18 0x18
52#define ARIZONA_AIF_TX_ENABLES 0x19
53#define ARIZONA_AIF_RX_ENABLES 0x1A
54#define ARIZONA_AIF_FORCE_WRITE 0x1B
55
Charles Keepaxd0800342014-03-07 16:34:25 +000056#define ARIZONA_FLL_VCO_CORNER 141900000
Charles Keepax87383ac2014-03-07 16:34:18 +000057#define ARIZONA_FLL_MAX_FREF 13500000
58#define ARIZONA_FLL_MIN_FVCO 90000000
Charles Keepaxd0800342014-03-07 16:34:25 +000059#define ARIZONA_FLL_MAX_FRATIO 16
Charles Keepax87383ac2014-03-07 16:34:18 +000060#define ARIZONA_FLL_MAX_REFDIV 8
61#define ARIZONA_FLL_MIN_OUTDIV 2
62#define ARIZONA_FLL_MAX_OUTDIV 7
63
Richard Fitzgeralde9c7f342014-11-12 16:12:46 +000064#define ARIZONA_FMT_DSP_MODE_A 0
65#define ARIZONA_FMT_DSP_MODE_B 1
66#define ARIZONA_FMT_I2S_MODE 2
67#define ARIZONA_FMT_LEFT_JUSTIFIED_MODE 3
68
Mark Brown07ed8732012-06-18 21:08:44 +010069#define arizona_fll_err(_fll, fmt, ...) \
70 dev_err(_fll->arizona->dev, "FLL%d: " fmt, _fll->id, ##__VA_ARGS__)
71#define arizona_fll_warn(_fll, fmt, ...) \
72 dev_warn(_fll->arizona->dev, "FLL%d: " fmt, _fll->id, ##__VA_ARGS__)
73#define arizona_fll_dbg(_fll, fmt, ...) \
Mark Brown9092a6e2013-02-06 17:58:57 +000074 dev_dbg(_fll->arizona->dev, "FLL%d: " fmt, _fll->id, ##__VA_ARGS__)
Mark Brown07ed8732012-06-18 21:08:44 +010075
76#define arizona_aif_err(_dai, fmt, ...) \
77 dev_err(_dai->dev, "AIF%d: " fmt, _dai->id, ##__VA_ARGS__)
78#define arizona_aif_warn(_dai, fmt, ...) \
79 dev_warn(_dai->dev, "AIF%d: " fmt, _dai->id, ##__VA_ARGS__)
80#define arizona_aif_dbg(_dai, fmt, ...) \
Mark Brown9092a6e2013-02-06 17:58:57 +000081 dev_dbg(_dai->dev, "AIF%d: " fmt, _dai->id, ##__VA_ARGS__)
Mark Brown07ed8732012-06-18 21:08:44 +010082
Mark Brown56447e12013-01-10 14:45:58 +000083static int arizona_spk_ev(struct snd_soc_dapm_widget *w,
84 struct snd_kcontrol *kcontrol,
85 int event)
86{
Lars-Peter Clausen043123f2015-01-13 10:27:07 +010087 struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
Mark Brown56447e12013-01-10 14:45:58 +000088 struct arizona *arizona = dev_get_drvdata(codec->dev->parent);
89 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
90 bool manual_ena = false;
Mark Brownf4a76e72013-03-13 12:22:39 +000091 int val;
Mark Brown56447e12013-01-10 14:45:58 +000092
93 switch (arizona->type) {
94 case WM5102:
95 switch (arizona->rev) {
96 case 0:
97 break;
98 default:
99 manual_ena = true;
100 break;
101 }
102 default:
103 break;
104 }
105
106 switch (event) {
107 case SND_SOC_DAPM_PRE_PMU:
108 if (!priv->spk_ena && manual_ena) {
Mark Brown3c43c692013-12-12 00:49:22 +0000109 regmap_write_async(arizona->regmap, 0x4f5, 0x25a);
Mark Brown56447e12013-01-10 14:45:58 +0000110 priv->spk_ena_pending = true;
111 }
112 break;
113 case SND_SOC_DAPM_POST_PMU:
Mark Brownf4a76e72013-03-13 12:22:39 +0000114 val = snd_soc_read(codec, ARIZONA_INTERRUPT_RAW_STATUS_3);
Charles Keepaxc0fe2c52014-07-15 11:21:47 +0100115 if (val & ARIZONA_SPK_OVERHEAT_STS) {
Mark Brownf4a76e72013-03-13 12:22:39 +0000116 dev_crit(arizona->dev,
117 "Speaker not enabled due to temperature\n");
118 return -EBUSY;
119 }
120
Mark Brown3c43c692013-12-12 00:49:22 +0000121 regmap_update_bits_async(arizona->regmap,
122 ARIZONA_OUTPUT_ENABLES_1,
123 1 << w->shift, 1 << w->shift);
Mark Brownf4a76e72013-03-13 12:22:39 +0000124
Mark Brown56447e12013-01-10 14:45:58 +0000125 if (priv->spk_ena_pending) {
126 msleep(75);
Mark Brown3c43c692013-12-12 00:49:22 +0000127 regmap_write_async(arizona->regmap, 0x4f5, 0xda);
Mark Brown56447e12013-01-10 14:45:58 +0000128 priv->spk_ena_pending = false;
129 priv->spk_ena++;
130 }
131 break;
132 case SND_SOC_DAPM_PRE_PMD:
133 if (manual_ena) {
134 priv->spk_ena--;
135 if (!priv->spk_ena)
Mark Brown3c43c692013-12-12 00:49:22 +0000136 regmap_write_async(arizona->regmap,
137 0x4f5, 0x25a);
Mark Brown56447e12013-01-10 14:45:58 +0000138 }
Mark Brownf4a76e72013-03-13 12:22:39 +0000139
Mark Brown3c43c692013-12-12 00:49:22 +0000140 regmap_update_bits_async(arizona->regmap,
141 ARIZONA_OUTPUT_ENABLES_1,
142 1 << w->shift, 0);
Mark Brown56447e12013-01-10 14:45:58 +0000143 break;
144 case SND_SOC_DAPM_POST_PMD:
145 if (manual_ena) {
146 if (!priv->spk_ena)
Mark Brown3c43c692013-12-12 00:49:22 +0000147 regmap_write_async(arizona->regmap,
148 0x4f5, 0x0da);
Mark Brown56447e12013-01-10 14:45:58 +0000149 }
150 break;
151 }
152
153 return 0;
154}
155
Mark Brown899817e2013-03-13 12:32:10 +0000156static irqreturn_t arizona_thermal_warn(int irq, void *data)
157{
158 struct arizona *arizona = data;
159 unsigned int val;
160 int ret;
161
162 ret = regmap_read(arizona->regmap, ARIZONA_INTERRUPT_RAW_STATUS_3,
163 &val);
164 if (ret != 0) {
165 dev_err(arizona->dev, "Failed to read thermal status: %d\n",
166 ret);
Charles Keepaxc0fe2c52014-07-15 11:21:47 +0100167 } else if (val & ARIZONA_SPK_OVERHEAT_WARN_STS) {
Mark Brown899817e2013-03-13 12:32:10 +0000168 dev_crit(arizona->dev, "Thermal warning\n");
169 }
170
171 return IRQ_HANDLED;
172}
173
174static irqreturn_t arizona_thermal_shutdown(int irq, void *data)
175{
176 struct arizona *arizona = data;
177 unsigned int val;
178 int ret;
179
180 ret = regmap_read(arizona->regmap, ARIZONA_INTERRUPT_RAW_STATUS_3,
181 &val);
182 if (ret != 0) {
183 dev_err(arizona->dev, "Failed to read thermal status: %d\n",
184 ret);
Charles Keepaxc0fe2c52014-07-15 11:21:47 +0100185 } else if (val & ARIZONA_SPK_OVERHEAT_STS) {
Mark Brown899817e2013-03-13 12:32:10 +0000186 dev_crit(arizona->dev, "Thermal shutdown\n");
Mark Brownf4a76e72013-03-13 12:22:39 +0000187 ret = regmap_update_bits(arizona->regmap,
188 ARIZONA_OUTPUT_ENABLES_1,
189 ARIZONA_OUT4L_ENA |
190 ARIZONA_OUT4R_ENA, 0);
191 if (ret != 0)
192 dev_crit(arizona->dev,
193 "Failed to disable speaker outputs: %d\n",
194 ret);
Mark Brown899817e2013-03-13 12:32:10 +0000195 }
196
197 return IRQ_HANDLED;
198}
199
Mark Brown56447e12013-01-10 14:45:58 +0000200static const struct snd_soc_dapm_widget arizona_spkl =
Mark Brownf4a76e72013-03-13 12:22:39 +0000201 SND_SOC_DAPM_PGA_E("OUT4L", SND_SOC_NOPM,
Mark Brown56447e12013-01-10 14:45:58 +0000202 ARIZONA_OUT4L_ENA_SHIFT, 0, NULL, 0, arizona_spk_ev,
203 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU);
204
205static const struct snd_soc_dapm_widget arizona_spkr =
Mark Brownf4a76e72013-03-13 12:22:39 +0000206 SND_SOC_DAPM_PGA_E("OUT4R", SND_SOC_NOPM,
Mark Brown56447e12013-01-10 14:45:58 +0000207 ARIZONA_OUT4R_ENA_SHIFT, 0, NULL, 0, arizona_spk_ev,
208 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU);
209
210int arizona_init_spk(struct snd_soc_codec *codec)
211{
Mark Brown899817e2013-03-13 12:32:10 +0000212 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
213 struct arizona *arizona = priv->arizona;
Mark Brown56447e12013-01-10 14:45:58 +0000214 int ret;
215
216 ret = snd_soc_dapm_new_controls(&codec->dapm, &arizona_spkl, 1);
217 if (ret != 0)
218 return ret;
219
Charles Keepax40843ae2013-08-12 23:46:55 +0100220 switch (arizona->type) {
221 case WM8997:
222 break;
223 default:
224 ret = snd_soc_dapm_new_controls(&codec->dapm,
225 &arizona_spkr, 1);
226 if (ret != 0)
227 return ret;
228 break;
229 }
Mark Brown56447e12013-01-10 14:45:58 +0000230
Charles Keepaxc0fe2c52014-07-15 11:21:47 +0100231 ret = arizona_request_irq(arizona, ARIZONA_IRQ_SPK_OVERHEAT_WARN,
Mark Brown899817e2013-03-13 12:32:10 +0000232 "Thermal warning", arizona_thermal_warn,
233 arizona);
234 if (ret != 0)
235 dev_err(arizona->dev,
236 "Failed to get thermal warning IRQ: %d\n",
237 ret);
238
Charles Keepaxc0fe2c52014-07-15 11:21:47 +0100239 ret = arizona_request_irq(arizona, ARIZONA_IRQ_SPK_OVERHEAT,
Mark Brown899817e2013-03-13 12:32:10 +0000240 "Thermal shutdown", arizona_thermal_shutdown,
241 arizona);
242 if (ret != 0)
243 dev_err(arizona->dev,
244 "Failed to get thermal shutdown IRQ: %d\n",
245 ret);
246
Mark Brown56447e12013-01-10 14:45:58 +0000247 return 0;
248}
249EXPORT_SYMBOL_GPL(arizona_init_spk);
250
Charles Keepaxb60f3632014-06-10 18:41:02 +0100251static const struct snd_soc_dapm_route arizona_mono_routes[] = {
252 { "OUT1R", NULL, "OUT1L" },
253 { "OUT2R", NULL, "OUT2L" },
254 { "OUT3R", NULL, "OUT3L" },
255 { "OUT4R", NULL, "OUT4L" },
256 { "OUT5R", NULL, "OUT5L" },
257 { "OUT6R", NULL, "OUT6L" },
258};
259
260int arizona_init_mono(struct snd_soc_codec *codec)
261{
262 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
263 struct arizona *arizona = priv->arizona;
264 int i;
265
266 for (i = 0; i < ARIZONA_MAX_OUTPUT; ++i) {
267 if (arizona->pdata.out_mono[i])
268 snd_soc_dapm_add_routes(&codec->dapm,
269 &arizona_mono_routes[i], 1);
270 }
271
272 return 0;
273}
274EXPORT_SYMBOL_GPL(arizona_init_mono);
275
Charles Keepaxb63144e2013-07-04 08:56:28 +0100276int arizona_init_gpio(struct snd_soc_codec *codec)
277{
278 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
279 struct arizona *arizona = priv->arizona;
280 int i;
281
282 switch (arizona->type) {
283 case WM5110:
284 snd_soc_dapm_disable_pin(&codec->dapm, "DRC2 Signal Activity");
Charles Keepaxb79fae62013-07-04 16:53:03 +0100285 break;
286 default:
287 break;
Charles Keepaxb63144e2013-07-04 08:56:28 +0100288 }
289
290 snd_soc_dapm_disable_pin(&codec->dapm, "DRC1 Signal Activity");
291
292 for (i = 0; i < ARRAY_SIZE(arizona->pdata.gpio_defaults); i++) {
293 switch (arizona->pdata.gpio_defaults[i] & ARIZONA_GPN_FN_MASK) {
294 case ARIZONA_GP_FN_DRC1_SIGNAL_DETECT:
295 snd_soc_dapm_enable_pin(&codec->dapm,
296 "DRC1 Signal Activity");
297 break;
298 case ARIZONA_GP_FN_DRC2_SIGNAL_DETECT:
299 snd_soc_dapm_enable_pin(&codec->dapm,
300 "DRC2 Signal Activity");
301 break;
302 default:
303 break;
304 }
305 }
306
307 return 0;
308}
309EXPORT_SYMBOL_GPL(arizona_init_gpio);
310
Mark Brown07ed8732012-06-18 21:08:44 +0100311const char *arizona_mixer_texts[ARIZONA_NUM_MIXER_INPUTS] = {
312 "None",
313 "Tone Generator 1",
314 "Tone Generator 2",
315 "Haptics",
316 "AEC",
317 "Mic Mute Mixer",
318 "Noise Generator",
319 "IN1L",
320 "IN1R",
321 "IN2L",
322 "IN2R",
323 "IN3L",
324 "IN3R",
Mark Brownc9c56fd2012-07-09 19:09:01 +0100325 "IN4L",
326 "IN4R",
Mark Brown07ed8732012-06-18 21:08:44 +0100327 "AIF1RX1",
328 "AIF1RX2",
329 "AIF1RX3",
330 "AIF1RX4",
331 "AIF1RX5",
332 "AIF1RX6",
333 "AIF1RX7",
334 "AIF1RX8",
335 "AIF2RX1",
336 "AIF2RX2",
Richard Fitzgeralde64001e2013-11-20 13:17:07 +0000337 "AIF2RX3",
338 "AIF2RX4",
339 "AIF2RX5",
340 "AIF2RX6",
Mark Brown07ed8732012-06-18 21:08:44 +0100341 "AIF3RX1",
342 "AIF3RX2",
343 "SLIMRX1",
344 "SLIMRX2",
345 "SLIMRX3",
346 "SLIMRX4",
347 "SLIMRX5",
348 "SLIMRX6",
349 "SLIMRX7",
350 "SLIMRX8",
351 "EQ1",
352 "EQ2",
353 "EQ3",
354 "EQ4",
355 "DRC1L",
356 "DRC1R",
357 "DRC2L",
358 "DRC2R",
359 "LHPF1",
360 "LHPF2",
361 "LHPF3",
362 "LHPF4",
363 "DSP1.1",
364 "DSP1.2",
365 "DSP1.3",
366 "DSP1.4",
367 "DSP1.5",
368 "DSP1.6",
Mark Brownc922cc42012-09-26 16:43:44 +0100369 "DSP2.1",
370 "DSP2.2",
371 "DSP2.3",
372 "DSP2.4",
373 "DSP2.5",
374 "DSP2.6",
375 "DSP3.1",
376 "DSP3.2",
377 "DSP3.3",
378 "DSP3.4",
379 "DSP3.5",
380 "DSP3.6",
381 "DSP4.1",
382 "DSP4.2",
383 "DSP4.3",
384 "DSP4.4",
385 "DSP4.5",
386 "DSP4.6",
Mark Brown07ed8732012-06-18 21:08:44 +0100387 "ASRC1L",
388 "ASRC1R",
389 "ASRC2L",
390 "ASRC2R",
Mark Brown91660bd2012-12-05 20:35:24 +0900391 "ISRC1INT1",
392 "ISRC1INT2",
393 "ISRC1INT3",
394 "ISRC1INT4",
395 "ISRC1DEC1",
396 "ISRC1DEC2",
397 "ISRC1DEC3",
398 "ISRC1DEC4",
399 "ISRC2INT1",
400 "ISRC2INT2",
401 "ISRC2INT3",
402 "ISRC2INT4",
403 "ISRC2DEC1",
404 "ISRC2DEC2",
405 "ISRC2DEC3",
406 "ISRC2DEC4",
407 "ISRC3INT1",
408 "ISRC3INT2",
409 "ISRC3INT3",
410 "ISRC3INT4",
411 "ISRC3DEC1",
412 "ISRC3DEC2",
413 "ISRC3DEC3",
414 "ISRC3DEC4",
Mark Brown07ed8732012-06-18 21:08:44 +0100415};
416EXPORT_SYMBOL_GPL(arizona_mixer_texts);
417
418int arizona_mixer_values[ARIZONA_NUM_MIXER_INPUTS] = {
419 0x00, /* None */
420 0x04, /* Tone */
421 0x05,
422 0x06, /* Haptics */
423 0x08, /* AEC */
424 0x0c, /* Noise mixer */
425 0x0d, /* Comfort noise */
426 0x10, /* IN1L */
427 0x11,
428 0x12,
429 0x13,
430 0x14,
431 0x15,
Mark Brownc9c56fd2012-07-09 19:09:01 +0100432 0x16,
433 0x17,
Mark Brown07ed8732012-06-18 21:08:44 +0100434 0x20, /* AIF1RX1 */
435 0x21,
436 0x22,
437 0x23,
438 0x24,
439 0x25,
440 0x26,
441 0x27,
442 0x28, /* AIF2RX1 */
443 0x29,
Richard Fitzgeralde64001e2013-11-20 13:17:07 +0000444 0x2a,
445 0x2b,
446 0x2c,
447 0x2d,
Mark Brown07ed8732012-06-18 21:08:44 +0100448 0x30, /* AIF3RX1 */
449 0x31,
450 0x38, /* SLIMRX1 */
451 0x39,
452 0x3a,
453 0x3b,
454 0x3c,
455 0x3d,
456 0x3e,
457 0x3f,
458 0x50, /* EQ1 */
459 0x51,
460 0x52,
461 0x53,
462 0x58, /* DRC1L */
463 0x59,
464 0x5a,
465 0x5b,
466 0x60, /* LHPF1 */
467 0x61,
468 0x62,
469 0x63,
470 0x68, /* DSP1.1 */
471 0x69,
472 0x6a,
473 0x6b,
474 0x6c,
475 0x6d,
Mark Brownc922cc42012-09-26 16:43:44 +0100476 0x70, /* DSP2.1 */
477 0x71,
478 0x72,
479 0x73,
480 0x74,
481 0x75,
482 0x78, /* DSP3.1 */
483 0x79,
484 0x7a,
485 0x7b,
486 0x7c,
487 0x7d,
488 0x80, /* DSP4.1 */
489 0x81,
490 0x82,
491 0x83,
492 0x84,
493 0x85,
Mark Brown07ed8732012-06-18 21:08:44 +0100494 0x90, /* ASRC1L */
495 0x91,
496 0x92,
497 0x93,
Mark Brown91660bd2012-12-05 20:35:24 +0900498 0xa0, /* ISRC1INT1 */
499 0xa1,
500 0xa2,
501 0xa3,
502 0xa4, /* ISRC1DEC1 */
503 0xa5,
504 0xa6,
505 0xa7,
506 0xa8, /* ISRC2DEC1 */
507 0xa9,
508 0xaa,
509 0xab,
510 0xac, /* ISRC2INT1 */
511 0xad,
512 0xae,
513 0xaf,
514 0xb0, /* ISRC3DEC1 */
515 0xb1,
516 0xb2,
517 0xb3,
518 0xb4, /* ISRC3INT1 */
519 0xb5,
520 0xb6,
521 0xb7,
Mark Brown07ed8732012-06-18 21:08:44 +0100522};
523EXPORT_SYMBOL_GPL(arizona_mixer_values);
524
525const DECLARE_TLV_DB_SCALE(arizona_mixer_tlv, -3200, 100, 0);
526EXPORT_SYMBOL_GPL(arizona_mixer_tlv);
527
Mark Browndc914282013-02-18 19:09:23 +0000528const char *arizona_rate_text[ARIZONA_RATE_ENUM_SIZE] = {
529 "SYNCCLK rate", "8kHz", "16kHz", "ASYNCCLK rate",
530};
531EXPORT_SYMBOL_GPL(arizona_rate_text);
532
533const int arizona_rate_val[ARIZONA_RATE_ENUM_SIZE] = {
534 0, 1, 2, 8,
535};
536EXPORT_SYMBOL_GPL(arizona_rate_val);
537
538
Charles Keepaxfbedc8c2013-12-19 09:30:12 +0000539const struct soc_enum arizona_isrc_fsh[] = {
540 SOC_VALUE_ENUM_SINGLE(ARIZONA_ISRC_1_CTRL_1,
541 ARIZONA_ISRC1_FSH_SHIFT, 0xf,
542 ARIZONA_RATE_ENUM_SIZE,
543 arizona_rate_text, arizona_rate_val),
544 SOC_VALUE_ENUM_SINGLE(ARIZONA_ISRC_2_CTRL_1,
545 ARIZONA_ISRC2_FSH_SHIFT, 0xf,
546 ARIZONA_RATE_ENUM_SIZE,
547 arizona_rate_text, arizona_rate_val),
548 SOC_VALUE_ENUM_SINGLE(ARIZONA_ISRC_3_CTRL_1,
549 ARIZONA_ISRC3_FSH_SHIFT, 0xf,
550 ARIZONA_RATE_ENUM_SIZE,
551 arizona_rate_text, arizona_rate_val),
552};
553EXPORT_SYMBOL_GPL(arizona_isrc_fsh);
554
Mark Browndc914282013-02-18 19:09:23 +0000555const struct soc_enum arizona_isrc_fsl[] = {
556 SOC_VALUE_ENUM_SINGLE(ARIZONA_ISRC_1_CTRL_2,
557 ARIZONA_ISRC1_FSL_SHIFT, 0xf,
558 ARIZONA_RATE_ENUM_SIZE,
559 arizona_rate_text, arizona_rate_val),
560 SOC_VALUE_ENUM_SINGLE(ARIZONA_ISRC_2_CTRL_2,
561 ARIZONA_ISRC2_FSL_SHIFT, 0xf,
562 ARIZONA_RATE_ENUM_SIZE,
563 arizona_rate_text, arizona_rate_val),
564 SOC_VALUE_ENUM_SINGLE(ARIZONA_ISRC_3_CTRL_2,
565 ARIZONA_ISRC3_FSL_SHIFT, 0xf,
566 ARIZONA_RATE_ENUM_SIZE,
567 arizona_rate_text, arizona_rate_val),
568};
569EXPORT_SYMBOL_GPL(arizona_isrc_fsl);
570
Charles Keepax56d37d82013-12-19 09:30:13 +0000571const struct soc_enum arizona_asrc_rate1 =
572 SOC_VALUE_ENUM_SINGLE(ARIZONA_ASRC_RATE1,
573 ARIZONA_ASRC_RATE1_SHIFT, 0xf,
574 ARIZONA_RATE_ENUM_SIZE - 1,
575 arizona_rate_text, arizona_rate_val);
576EXPORT_SYMBOL_GPL(arizona_asrc_rate1);
577
Mark Browne853a002012-12-09 12:25:52 +0900578static const char *arizona_vol_ramp_text[] = {
579 "0ms/6dB", "0.5ms/6dB", "1ms/6dB", "2ms/6dB", "4ms/6dB", "8ms/6dB",
580 "15ms/6dB", "30ms/6dB",
581};
582
Takashi Iwai27ca2c32014-02-18 10:01:43 +0100583SOC_ENUM_SINGLE_DECL(arizona_in_vd_ramp,
584 ARIZONA_INPUT_VOLUME_RAMP,
585 ARIZONA_IN_VD_RAMP_SHIFT,
586 arizona_vol_ramp_text);
Mark Browne853a002012-12-09 12:25:52 +0900587EXPORT_SYMBOL_GPL(arizona_in_vd_ramp);
588
Takashi Iwai27ca2c32014-02-18 10:01:43 +0100589SOC_ENUM_SINGLE_DECL(arizona_in_vi_ramp,
590 ARIZONA_INPUT_VOLUME_RAMP,
591 ARIZONA_IN_VI_RAMP_SHIFT,
592 arizona_vol_ramp_text);
Mark Browne853a002012-12-09 12:25:52 +0900593EXPORT_SYMBOL_GPL(arizona_in_vi_ramp);
594
Takashi Iwai27ca2c32014-02-18 10:01:43 +0100595SOC_ENUM_SINGLE_DECL(arizona_out_vd_ramp,
596 ARIZONA_OUTPUT_VOLUME_RAMP,
597 ARIZONA_OUT_VD_RAMP_SHIFT,
598 arizona_vol_ramp_text);
Mark Browne853a002012-12-09 12:25:52 +0900599EXPORT_SYMBOL_GPL(arizona_out_vd_ramp);
600
Takashi Iwai27ca2c32014-02-18 10:01:43 +0100601SOC_ENUM_SINGLE_DECL(arizona_out_vi_ramp,
602 ARIZONA_OUTPUT_VOLUME_RAMP,
603 ARIZONA_OUT_VI_RAMP_SHIFT,
604 arizona_vol_ramp_text);
Mark Browne853a002012-12-09 12:25:52 +0900605EXPORT_SYMBOL_GPL(arizona_out_vi_ramp);
606
Mark Brown07ed8732012-06-18 21:08:44 +0100607static const char *arizona_lhpf_mode_text[] = {
608 "Low-pass", "High-pass"
609};
610
Takashi Iwai27ca2c32014-02-18 10:01:43 +0100611SOC_ENUM_SINGLE_DECL(arizona_lhpf1_mode,
612 ARIZONA_HPLPF1_1,
613 ARIZONA_LHPF1_MODE_SHIFT,
614 arizona_lhpf_mode_text);
Mark Brown07ed8732012-06-18 21:08:44 +0100615EXPORT_SYMBOL_GPL(arizona_lhpf1_mode);
616
Takashi Iwai27ca2c32014-02-18 10:01:43 +0100617SOC_ENUM_SINGLE_DECL(arizona_lhpf2_mode,
618 ARIZONA_HPLPF2_1,
619 ARIZONA_LHPF2_MODE_SHIFT,
620 arizona_lhpf_mode_text);
Mark Brown07ed8732012-06-18 21:08:44 +0100621EXPORT_SYMBOL_GPL(arizona_lhpf2_mode);
622
Takashi Iwai27ca2c32014-02-18 10:01:43 +0100623SOC_ENUM_SINGLE_DECL(arizona_lhpf3_mode,
624 ARIZONA_HPLPF3_1,
625 ARIZONA_LHPF3_MODE_SHIFT,
626 arizona_lhpf_mode_text);
Mark Brown07ed8732012-06-18 21:08:44 +0100627EXPORT_SYMBOL_GPL(arizona_lhpf3_mode);
628
Takashi Iwai27ca2c32014-02-18 10:01:43 +0100629SOC_ENUM_SINGLE_DECL(arizona_lhpf4_mode,
630 ARIZONA_HPLPF4_1,
631 ARIZONA_LHPF4_MODE_SHIFT,
632 arizona_lhpf_mode_text);
Mark Brown07ed8732012-06-18 21:08:44 +0100633EXPORT_SYMBOL_GPL(arizona_lhpf4_mode);
634
Mark Brown845571c2012-12-18 13:47:57 +0000635static const char *arizona_ng_hold_text[] = {
636 "30ms", "120ms", "250ms", "500ms",
637};
638
Takashi Iwai27ca2c32014-02-18 10:01:43 +0100639SOC_ENUM_SINGLE_DECL(arizona_ng_hold,
640 ARIZONA_NOISE_GATE_CONTROL,
641 ARIZONA_NGATE_HOLD_SHIFT,
642 arizona_ng_hold_text);
Mark Brown845571c2012-12-18 13:47:57 +0000643EXPORT_SYMBOL_GPL(arizona_ng_hold);
644
Charles Keepax254dc322013-11-19 16:04:03 +0000645static const char * const arizona_in_hpf_cut_text[] = {
646 "2.5Hz", "5Hz", "10Hz", "20Hz", "40Hz"
647};
648
Takashi Iwai27ca2c32014-02-18 10:01:43 +0100649SOC_ENUM_SINGLE_DECL(arizona_in_hpf_cut_enum,
650 ARIZONA_HPF_CONTROL,
651 ARIZONA_IN_HPF_CUT_SHIFT,
652 arizona_in_hpf_cut_text);
Charles Keepax254dc322013-11-19 16:04:03 +0000653EXPORT_SYMBOL_GPL(arizona_in_hpf_cut_enum);
654
Charles Keepaxc7f38432013-08-06 17:03:55 +0100655static const char * const arizona_in_dmic_osr_text[] = {
Charles Keepaxef326f42014-11-12 14:55:26 +0000656 "1.536MHz", "3.072MHz", "6.144MHz", "768kHz",
Charles Keepaxc7f38432013-08-06 17:03:55 +0100657};
658
659const struct soc_enum arizona_in_dmic_osr[] = {
660 SOC_ENUM_SINGLE(ARIZONA_IN1L_CONTROL, ARIZONA_IN1_OSR_SHIFT,
661 ARRAY_SIZE(arizona_in_dmic_osr_text),
662 arizona_in_dmic_osr_text),
663 SOC_ENUM_SINGLE(ARIZONA_IN2L_CONTROL, ARIZONA_IN2_OSR_SHIFT,
664 ARRAY_SIZE(arizona_in_dmic_osr_text),
665 arizona_in_dmic_osr_text),
666 SOC_ENUM_SINGLE(ARIZONA_IN3L_CONTROL, ARIZONA_IN3_OSR_SHIFT,
667 ARRAY_SIZE(arizona_in_dmic_osr_text),
668 arizona_in_dmic_osr_text),
669 SOC_ENUM_SINGLE(ARIZONA_IN4L_CONTROL, ARIZONA_IN4_OSR_SHIFT,
670 ARRAY_SIZE(arizona_in_dmic_osr_text),
671 arizona_in_dmic_osr_text),
672};
673EXPORT_SYMBOL_GPL(arizona_in_dmic_osr);
674
Mark Brownddbce972013-02-15 17:27:22 +0000675static void arizona_in_set_vu(struct snd_soc_codec *codec, int ena)
676{
677 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
678 unsigned int val;
679 int i;
680
681 if (ena)
682 val = ARIZONA_IN_VU;
683 else
684 val = 0;
685
686 for (i = 0; i < priv->num_inputs; i++)
687 snd_soc_update_bits(codec,
688 ARIZONA_ADC_DIGITAL_VOLUME_1L + (i * 4),
689 ARIZONA_IN_VU, val);
690}
691
Mark Brown07ed8732012-06-18 21:08:44 +0100692int arizona_in_ev(struct snd_soc_dapm_widget *w, struct snd_kcontrol *kcontrol,
693 int event)
694{
Lars-Peter Clausen043123f2015-01-13 10:27:07 +0100695 struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
696 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
Mark Brown43cd8bf2013-02-06 16:57:29 +0000697 unsigned int reg;
698
699 if (w->shift % 2)
700 reg = ARIZONA_ADC_DIGITAL_VOLUME_1L + ((w->shift / 2) * 8);
701 else
702 reg = ARIZONA_ADC_DIGITAL_VOLUME_1R + ((w->shift / 2) * 8);
703
704 switch (event) {
Mark Brownddbce972013-02-15 17:27:22 +0000705 case SND_SOC_DAPM_PRE_PMU:
706 priv->in_pending++;
707 break;
Mark Brown43cd8bf2013-02-06 16:57:29 +0000708 case SND_SOC_DAPM_POST_PMU:
Lars-Peter Clausen043123f2015-01-13 10:27:07 +0100709 snd_soc_update_bits(codec, reg, ARIZONA_IN1L_MUTE, 0);
Mark Brownddbce972013-02-15 17:27:22 +0000710
711 /* If this is the last input pending then allow VU */
712 priv->in_pending--;
713 if (priv->in_pending == 0) {
714 msleep(1);
Lars-Peter Clausen043123f2015-01-13 10:27:07 +0100715 arizona_in_set_vu(codec, 1);
Mark Brownddbce972013-02-15 17:27:22 +0000716 }
Mark Brown43cd8bf2013-02-06 16:57:29 +0000717 break;
718 case SND_SOC_DAPM_PRE_PMD:
Lars-Peter Clausen043123f2015-01-13 10:27:07 +0100719 snd_soc_update_bits(codec, reg,
Mark Brownddbce972013-02-15 17:27:22 +0000720 ARIZONA_IN1L_MUTE | ARIZONA_IN_VU,
721 ARIZONA_IN1L_MUTE | ARIZONA_IN_VU);
Mark Brown43cd8bf2013-02-06 16:57:29 +0000722 break;
Mark Brownddbce972013-02-15 17:27:22 +0000723 case SND_SOC_DAPM_POST_PMD:
724 /* Disable volume updates if no inputs are enabled */
Lars-Peter Clausen043123f2015-01-13 10:27:07 +0100725 reg = snd_soc_read(codec, ARIZONA_INPUT_ENABLES);
Mark Brownddbce972013-02-15 17:27:22 +0000726 if (reg == 0)
Lars-Peter Clausen043123f2015-01-13 10:27:07 +0100727 arizona_in_set_vu(codec, 0);
Mark Brown43cd8bf2013-02-06 16:57:29 +0000728 }
729
Mark Brown07ed8732012-06-18 21:08:44 +0100730 return 0;
731}
732EXPORT_SYMBOL_GPL(arizona_in_ev);
733
734int arizona_out_ev(struct snd_soc_dapm_widget *w,
735 struct snd_kcontrol *kcontrol,
736 int event)
737{
Mark Brown60d66c92015-01-27 23:50:47 +0000738 struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
739 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
Charles Keepax054e1b42015-01-20 16:31:50 +0000740
Mark Brown1a2c7d52013-03-24 22:50:23 +0000741 switch (event) {
Charles Keepaxe1ae5fb2015-01-20 16:31:51 +0000742 case SND_SOC_DAPM_PRE_PMU:
743 switch (w->shift) {
744 case ARIZONA_OUT1L_ENA_SHIFT:
745 case ARIZONA_OUT1R_ENA_SHIFT:
746 case ARIZONA_OUT2L_ENA_SHIFT:
747 case ARIZONA_OUT2R_ENA_SHIFT:
748 case ARIZONA_OUT3L_ENA_SHIFT:
749 case ARIZONA_OUT3R_ENA_SHIFT:
750 priv->out_up_pending++;
751 priv->out_up_delay += 17;
752 break;
753 default:
754 break;
755 }
756 break;
Mark Brown1a2c7d52013-03-24 22:50:23 +0000757 case SND_SOC_DAPM_POST_PMU:
758 switch (w->shift) {
759 case ARIZONA_OUT1L_ENA_SHIFT:
760 case ARIZONA_OUT1R_ENA_SHIFT:
761 case ARIZONA_OUT2L_ENA_SHIFT:
762 case ARIZONA_OUT2R_ENA_SHIFT:
763 case ARIZONA_OUT3L_ENA_SHIFT:
764 case ARIZONA_OUT3R_ENA_SHIFT:
Charles Keepaxe1ae5fb2015-01-20 16:31:51 +0000765 priv->out_up_pending--;
766 if (!priv->out_up_pending) {
767 msleep(priv->out_up_delay);
768 priv->out_up_delay = 0;
769 }
Mark Brown1a2c7d52013-03-24 22:50:23 +0000770 break;
771
772 default:
773 break;
774 }
775 break;
Charles Keepax054e1b42015-01-20 16:31:50 +0000776 case SND_SOC_DAPM_PRE_PMD:
777 switch (w->shift) {
778 case ARIZONA_OUT1L_ENA_SHIFT:
779 case ARIZONA_OUT1R_ENA_SHIFT:
780 case ARIZONA_OUT2L_ENA_SHIFT:
781 case ARIZONA_OUT2R_ENA_SHIFT:
782 case ARIZONA_OUT3L_ENA_SHIFT:
783 case ARIZONA_OUT3R_ENA_SHIFT:
784 priv->out_down_pending++;
785 priv->out_down_delay++;
786 break;
787 default:
788 break;
789 }
790 break;
791 case SND_SOC_DAPM_POST_PMD:
792 switch (w->shift) {
793 case ARIZONA_OUT1L_ENA_SHIFT:
794 case ARIZONA_OUT1R_ENA_SHIFT:
795 case ARIZONA_OUT2L_ENA_SHIFT:
796 case ARIZONA_OUT2R_ENA_SHIFT:
797 case ARIZONA_OUT3L_ENA_SHIFT:
798 case ARIZONA_OUT3R_ENA_SHIFT:
799 priv->out_down_pending--;
800 if (!priv->out_down_pending) {
801 msleep(priv->out_down_delay);
802 priv->out_down_delay = 0;
803 }
804 break;
805 default:
806 break;
807 }
808 break;
Mark Brown1a2c7d52013-03-24 22:50:23 +0000809 }
810
Mark Brown07ed8732012-06-18 21:08:44 +0100811 return 0;
812}
813EXPORT_SYMBOL_GPL(arizona_out_ev);
814
Mark Brownf607e312013-02-22 18:36:53 +0000815int arizona_hp_ev(struct snd_soc_dapm_widget *w,
816 struct snd_kcontrol *kcontrol,
817 int event)
818{
Lars-Peter Clausen043123f2015-01-13 10:27:07 +0100819 struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);
820 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
Mark Brown3c43c692013-12-12 00:49:22 +0000821 struct arizona *arizona = priv->arizona;
Mark Brownf607e312013-02-22 18:36:53 +0000822 unsigned int mask = 1 << w->shift;
823 unsigned int val;
824
825 switch (event) {
826 case SND_SOC_DAPM_POST_PMU:
827 val = mask;
828 break;
829 case SND_SOC_DAPM_PRE_PMD:
830 val = 0;
831 break;
Charles Keepaxe1ae5fb2015-01-20 16:31:51 +0000832 case SND_SOC_DAPM_PRE_PMU:
Charles Keepax054e1b42015-01-20 16:31:50 +0000833 case SND_SOC_DAPM_POST_PMD:
834 return arizona_out_ev(w, kcontrol, event);
Mark Brownf607e312013-02-22 18:36:53 +0000835 default:
836 return -EINVAL;
837 }
838
839 /* Store the desired state for the HP outputs */
840 priv->arizona->hp_ena &= ~mask;
841 priv->arizona->hp_ena |= val;
842
843 /* Force off if HPDET magic is active */
844 if (priv->arizona->hpdet_magic)
845 val = 0;
846
Mark Brown3c43c692013-12-12 00:49:22 +0000847 regmap_update_bits_async(arizona->regmap, ARIZONA_OUTPUT_ENABLES_1,
848 mask, val);
Mark Brownf607e312013-02-22 18:36:53 +0000849
850 return arizona_out_ev(w, kcontrol, event);
851}
852EXPORT_SYMBOL_GPL(arizona_hp_ev);
853
Mark Browncbd840d2012-08-08 17:52:44 +0100854static unsigned int arizona_sysclk_48k_rates[] = {
855 6144000,
856 12288000,
Dimitris Papastamos96e1f182012-11-15 11:41:30 +0000857 24576000,
Mark Browncbd840d2012-08-08 17:52:44 +0100858 49152000,
Mark Brownaeaeee12012-09-26 17:50:02 +0100859 73728000,
860 98304000,
861 147456000,
Mark Browncbd840d2012-08-08 17:52:44 +0100862};
863
864static unsigned int arizona_sysclk_44k1_rates[] = {
865 5644800,
866 11289600,
Dimitris Papastamos96e1f182012-11-15 11:41:30 +0000867 22579200,
Mark Browncbd840d2012-08-08 17:52:44 +0100868 45158400,
Mark Brownaeaeee12012-09-26 17:50:02 +0100869 67737600,
870 90316800,
871 135475200,
Mark Browncbd840d2012-08-08 17:52:44 +0100872};
873
874static int arizona_set_opclk(struct snd_soc_codec *codec, unsigned int clk,
875 unsigned int freq)
876{
877 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
878 unsigned int reg;
879 unsigned int *rates;
880 int ref, div, refclk;
881
882 switch (clk) {
883 case ARIZONA_CLK_OPCLK:
884 reg = ARIZONA_OUTPUT_SYSTEM_CLOCK;
885 refclk = priv->sysclk;
886 break;
887 case ARIZONA_CLK_ASYNC_OPCLK:
888 reg = ARIZONA_OUTPUT_ASYNC_CLOCK;
889 refclk = priv->asyncclk;
890 break;
891 default:
892 return -EINVAL;
893 }
894
895 if (refclk % 8000)
896 rates = arizona_sysclk_44k1_rates;
897 else
898 rates = arizona_sysclk_48k_rates;
899
900 for (ref = 0; ref < ARRAY_SIZE(arizona_sysclk_48k_rates) &&
901 rates[ref] <= refclk; ref++) {
902 div = 1;
903 while (rates[ref] / div >= freq && div < 32) {
904 if (rates[ref] / div == freq) {
905 dev_dbg(codec->dev, "Configured %dHz OPCLK\n",
906 freq);
907 snd_soc_update_bits(codec, reg,
908 ARIZONA_OPCLK_DIV_MASK |
909 ARIZONA_OPCLK_SEL_MASK,
910 (div <<
911 ARIZONA_OPCLK_DIV_SHIFT) |
912 ref);
913 return 0;
914 }
915 div++;
916 }
917 }
918
919 dev_err(codec->dev, "Unable to generate %dHz OPCLK\n", freq);
920 return -EINVAL;
921}
922
Mark Brown07ed8732012-06-18 21:08:44 +0100923int arizona_set_sysclk(struct snd_soc_codec *codec, int clk_id,
924 int source, unsigned int freq, int dir)
925{
926 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
927 struct arizona *arizona = priv->arizona;
928 char *name;
929 unsigned int reg;
930 unsigned int mask = ARIZONA_SYSCLK_FREQ_MASK | ARIZONA_SYSCLK_SRC_MASK;
931 unsigned int val = source << ARIZONA_SYSCLK_SRC_SHIFT;
932 unsigned int *clk;
933
934 switch (clk_id) {
935 case ARIZONA_CLK_SYSCLK:
936 name = "SYSCLK";
937 reg = ARIZONA_SYSTEM_CLOCK_1;
938 clk = &priv->sysclk;
939 mask |= ARIZONA_SYSCLK_FRAC;
940 break;
941 case ARIZONA_CLK_ASYNCCLK:
942 name = "ASYNCCLK";
943 reg = ARIZONA_ASYNC_CLOCK_1;
944 clk = &priv->asyncclk;
945 break;
Mark Browncbd840d2012-08-08 17:52:44 +0100946 case ARIZONA_CLK_OPCLK:
947 case ARIZONA_CLK_ASYNC_OPCLK:
948 return arizona_set_opclk(codec, clk_id, freq);
Mark Brown07ed8732012-06-18 21:08:44 +0100949 default:
950 return -EINVAL;
951 }
952
953 switch (freq) {
954 case 5644800:
955 case 6144000:
956 break;
957 case 11289600:
958 case 12288000:
Mark Brown3f341f72013-03-08 15:22:29 +0800959 val |= ARIZONA_CLK_12MHZ << ARIZONA_SYSCLK_FREQ_SHIFT;
Mark Brown07ed8732012-06-18 21:08:44 +0100960 break;
961 case 22579200:
962 case 24576000:
Mark Brown3f341f72013-03-08 15:22:29 +0800963 val |= ARIZONA_CLK_24MHZ << ARIZONA_SYSCLK_FREQ_SHIFT;
Mark Brown07ed8732012-06-18 21:08:44 +0100964 break;
965 case 45158400:
966 case 49152000:
Mark Brown3f341f72013-03-08 15:22:29 +0800967 val |= ARIZONA_CLK_49MHZ << ARIZONA_SYSCLK_FREQ_SHIFT;
Mark Brown07ed8732012-06-18 21:08:44 +0100968 break;
Mark Brown38113362012-11-26 16:01:37 +0000969 case 67737600:
970 case 73728000:
Mark Brown3f341f72013-03-08 15:22:29 +0800971 val |= ARIZONA_CLK_73MHZ << ARIZONA_SYSCLK_FREQ_SHIFT;
Mark Brown38113362012-11-26 16:01:37 +0000972 break;
973 case 90316800:
974 case 98304000:
Mark Brown3f341f72013-03-08 15:22:29 +0800975 val |= ARIZONA_CLK_98MHZ << ARIZONA_SYSCLK_FREQ_SHIFT;
Mark Brown38113362012-11-26 16:01:37 +0000976 break;
977 case 135475200:
978 case 147456000:
Mark Brown3f341f72013-03-08 15:22:29 +0800979 val |= ARIZONA_CLK_147MHZ << ARIZONA_SYSCLK_FREQ_SHIFT;
Mark Brown38113362012-11-26 16:01:37 +0000980 break;
Mark Brownf2c26d42013-01-21 16:09:36 +0900981 case 0:
982 dev_dbg(arizona->dev, "%s cleared\n", name);
983 *clk = freq;
984 return 0;
Mark Brown07ed8732012-06-18 21:08:44 +0100985 default:
986 return -EINVAL;
987 }
988
989 *clk = freq;
990
991 if (freq % 6144000)
992 val |= ARIZONA_SYSCLK_FRAC;
993
994 dev_dbg(arizona->dev, "%s set to %uHz", name, freq);
995
996 return regmap_update_bits(arizona->regmap, reg, mask, val);
997}
998EXPORT_SYMBOL_GPL(arizona_set_sysclk);
999
1000static int arizona_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
1001{
1002 struct snd_soc_codec *codec = dai->codec;
Mark Brown3c43c692013-12-12 00:49:22 +00001003 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
1004 struct arizona *arizona = priv->arizona;
Mark Brown07ed8732012-06-18 21:08:44 +01001005 int lrclk, bclk, mode, base;
1006
1007 base = dai->driver->base;
1008
1009 lrclk = 0;
1010 bclk = 0;
1011
1012 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1013 case SND_SOC_DAIFMT_DSP_A:
Richard Fitzgeralde9c7f342014-11-12 16:12:46 +00001014 mode = ARIZONA_FMT_DSP_MODE_A;
1015 break;
1016 case SND_SOC_DAIFMT_DSP_B:
1017 if ((fmt & SND_SOC_DAIFMT_MASTER_MASK)
1018 != SND_SOC_DAIFMT_CBM_CFM) {
1019 arizona_aif_err(dai, "DSP_B not valid in slave mode\n");
1020 return -EINVAL;
1021 }
1022 mode = ARIZONA_FMT_DSP_MODE_B;
Mark Brown07ed8732012-06-18 21:08:44 +01001023 break;
Mark Brown07ed8732012-06-18 21:08:44 +01001024 case SND_SOC_DAIFMT_I2S:
Richard Fitzgeralde9c7f342014-11-12 16:12:46 +00001025 mode = ARIZONA_FMT_I2S_MODE;
1026 break;
1027 case SND_SOC_DAIFMT_LEFT_J:
1028 if ((fmt & SND_SOC_DAIFMT_MASTER_MASK)
1029 != SND_SOC_DAIFMT_CBM_CFM) {
1030 arizona_aif_err(dai, "LEFT_J not valid in slave mode\n");
1031 return -EINVAL;
1032 }
1033 mode = ARIZONA_FMT_LEFT_JUSTIFIED_MODE;
Mark Brown07ed8732012-06-18 21:08:44 +01001034 break;
Mark Brown07ed8732012-06-18 21:08:44 +01001035 default:
1036 arizona_aif_err(dai, "Unsupported DAI format %d\n",
1037 fmt & SND_SOC_DAIFMT_FORMAT_MASK);
1038 return -EINVAL;
1039 }
1040
1041 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1042 case SND_SOC_DAIFMT_CBS_CFS:
1043 break;
1044 case SND_SOC_DAIFMT_CBS_CFM:
1045 lrclk |= ARIZONA_AIF1TX_LRCLK_MSTR;
1046 break;
1047 case SND_SOC_DAIFMT_CBM_CFS:
1048 bclk |= ARIZONA_AIF1_BCLK_MSTR;
1049 break;
1050 case SND_SOC_DAIFMT_CBM_CFM:
1051 bclk |= ARIZONA_AIF1_BCLK_MSTR;
1052 lrclk |= ARIZONA_AIF1TX_LRCLK_MSTR;
1053 break;
1054 default:
1055 arizona_aif_err(dai, "Unsupported master mode %d\n",
1056 fmt & SND_SOC_DAIFMT_MASTER_MASK);
1057 return -EINVAL;
1058 }
1059
1060 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1061 case SND_SOC_DAIFMT_NB_NF:
1062 break;
1063 case SND_SOC_DAIFMT_IB_IF:
1064 bclk |= ARIZONA_AIF1_BCLK_INV;
1065 lrclk |= ARIZONA_AIF1TX_LRCLK_INV;
1066 break;
1067 case SND_SOC_DAIFMT_IB_NF:
1068 bclk |= ARIZONA_AIF1_BCLK_INV;
1069 break;
1070 case SND_SOC_DAIFMT_NB_IF:
1071 lrclk |= ARIZONA_AIF1TX_LRCLK_INV;
1072 break;
1073 default:
1074 return -EINVAL;
1075 }
1076
Mark Brown3c43c692013-12-12 00:49:22 +00001077 regmap_update_bits_async(arizona->regmap, base + ARIZONA_AIF_BCLK_CTRL,
1078 ARIZONA_AIF1_BCLK_INV |
1079 ARIZONA_AIF1_BCLK_MSTR,
1080 bclk);
1081 regmap_update_bits_async(arizona->regmap, base + ARIZONA_AIF_TX_PIN_CTRL,
1082 ARIZONA_AIF1TX_LRCLK_INV |
1083 ARIZONA_AIF1TX_LRCLK_MSTR, lrclk);
1084 regmap_update_bits_async(arizona->regmap,
1085 base + ARIZONA_AIF_RX_PIN_CTRL,
1086 ARIZONA_AIF1RX_LRCLK_INV |
1087 ARIZONA_AIF1RX_LRCLK_MSTR, lrclk);
1088 regmap_update_bits(arizona->regmap, base + ARIZONA_AIF_FORMAT,
1089 ARIZONA_AIF1_FMT_MASK, mode);
Mark Brown07ed8732012-06-18 21:08:44 +01001090
1091 return 0;
1092}
1093
Mark Brown949e6bc2012-07-04 18:58:04 +01001094static const int arizona_48k_bclk_rates[] = {
Mark Brown07ed8732012-06-18 21:08:44 +01001095 -1,
1096 48000,
1097 64000,
1098 96000,
1099 128000,
1100 192000,
1101 256000,
1102 384000,
1103 512000,
1104 768000,
1105 1024000,
1106 1536000,
1107 2048000,
1108 3072000,
1109 4096000,
1110 6144000,
1111 8192000,
1112 12288000,
1113 24576000,
1114};
1115
Mark Brown5b2eec32012-07-04 17:32:05 +01001116static const unsigned int arizona_48k_rates[] = {
1117 12000,
1118 24000,
1119 48000,
1120 96000,
1121 192000,
1122 384000,
1123 768000,
1124 4000,
1125 8000,
1126 16000,
1127 32000,
1128 64000,
1129 128000,
1130 256000,
1131 512000,
1132};
1133
1134static const struct snd_pcm_hw_constraint_list arizona_48k_constraint = {
1135 .count = ARRAY_SIZE(arizona_48k_rates),
1136 .list = arizona_48k_rates,
1137};
1138
Mark Brown949e6bc2012-07-04 18:58:04 +01001139static const int arizona_44k1_bclk_rates[] = {
Mark Brown07ed8732012-06-18 21:08:44 +01001140 -1,
1141 44100,
1142 58800,
1143 88200,
1144 117600,
1145 177640,
1146 235200,
1147 352800,
1148 470400,
1149 705600,
1150 940800,
1151 1411200,
1152 1881600,
Heather Lomond4758be32012-09-05 05:02:10 -04001153 2822400,
Mark Brown07ed8732012-06-18 21:08:44 +01001154 3763200,
1155 5644800,
1156 7526400,
1157 11289600,
1158 22579200,
1159};
1160
Mark Brown5b2eec32012-07-04 17:32:05 +01001161static const unsigned int arizona_44k1_rates[] = {
1162 11025,
1163 22050,
1164 44100,
1165 88200,
1166 176400,
1167 352800,
1168 705600,
1169};
1170
1171static const struct snd_pcm_hw_constraint_list arizona_44k1_constraint = {
1172 .count = ARRAY_SIZE(arizona_44k1_rates),
1173 .list = arizona_44k1_rates,
1174};
1175
Mark Brown07ed8732012-06-18 21:08:44 +01001176static int arizona_sr_vals[] = {
1177 0,
1178 12000,
1179 24000,
1180 48000,
1181 96000,
1182 192000,
1183 384000,
1184 768000,
1185 0,
1186 11025,
1187 22050,
1188 44100,
1189 88200,
1190 176400,
1191 352800,
1192 705600,
1193 4000,
1194 8000,
1195 16000,
1196 32000,
1197 64000,
1198 128000,
1199 256000,
1200 512000,
1201};
1202
Mark Brown5b2eec32012-07-04 17:32:05 +01001203static int arizona_startup(struct snd_pcm_substream *substream,
1204 struct snd_soc_dai *dai)
1205{
1206 struct snd_soc_codec *codec = dai->codec;
1207 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
1208 struct arizona_dai_priv *dai_priv = &priv->dai[dai->id - 1];
1209 const struct snd_pcm_hw_constraint_list *constraint;
1210 unsigned int base_rate;
1211
1212 switch (dai_priv->clk) {
1213 case ARIZONA_CLK_SYSCLK:
1214 base_rate = priv->sysclk;
1215 break;
1216 case ARIZONA_CLK_ASYNCCLK:
1217 base_rate = priv->asyncclk;
1218 break;
1219 default:
1220 return 0;
1221 }
1222
Mark Brownf2c26d42013-01-21 16:09:36 +09001223 if (base_rate == 0)
1224 return 0;
1225
Mark Brown5b2eec32012-07-04 17:32:05 +01001226 if (base_rate % 8000)
1227 constraint = &arizona_44k1_constraint;
1228 else
1229 constraint = &arizona_48k_constraint;
1230
1231 return snd_pcm_hw_constraint_list(substream->runtime, 0,
1232 SNDRV_PCM_HW_PARAM_RATE,
1233 constraint);
1234}
1235
Charles Keepaxcc9e9242014-06-06 14:14:05 +01001236static void arizona_wm5102_set_dac_comp(struct snd_soc_codec *codec,
1237 unsigned int rate)
1238{
1239 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
1240 struct arizona *arizona = priv->arizona;
1241 struct reg_default dac_comp[] = {
1242 { 0x80, 0x3 },
1243 { ARIZONA_DAC_COMP_1, 0 },
1244 { ARIZONA_DAC_COMP_2, 0 },
1245 { 0x80, 0x0 },
1246 };
1247
Lars-Peter Clausend74bcaa2014-11-09 17:00:59 +01001248 mutex_lock(&arizona->dac_comp_lock);
Charles Keepaxcc9e9242014-06-06 14:14:05 +01001249
1250 dac_comp[1].def = arizona->dac_comp_coeff;
1251 if (rate >= 176400)
1252 dac_comp[2].def = arizona->dac_comp_enabled;
1253
Lars-Peter Clausend74bcaa2014-11-09 17:00:59 +01001254 mutex_unlock(&arizona->dac_comp_lock);
Charles Keepaxcc9e9242014-06-06 14:14:05 +01001255
1256 regmap_multi_reg_write(arizona->regmap,
1257 dac_comp,
1258 ARRAY_SIZE(dac_comp));
1259}
1260
Mark Brownb272efc2012-10-10 15:10:08 +09001261static int arizona_hw_params_rate(struct snd_pcm_substream *substream,
1262 struct snd_pcm_hw_params *params,
1263 struct snd_soc_dai *dai)
Mark Brown07ed8732012-06-18 21:08:44 +01001264{
1265 struct snd_soc_codec *codec = dai->codec;
Mark Brownc013b272012-07-04 20:05:57 +01001266 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
1267 struct arizona_dai_priv *dai_priv = &priv->dai[dai->id - 1];
Mark Brown07ed8732012-06-18 21:08:44 +01001268 int base = dai->driver->base;
Mark Brownb272efc2012-10-10 15:10:08 +09001269 int i, sr_val;
1270
1271 /*
1272 * We will need to be more flexible than this in future,
1273 * currently we use a single sample rate for SYSCLK.
1274 */
1275 for (i = 0; i < ARRAY_SIZE(arizona_sr_vals); i++)
1276 if (arizona_sr_vals[i] == params_rate(params))
1277 break;
1278 if (i == ARRAY_SIZE(arizona_sr_vals)) {
1279 arizona_aif_err(dai, "Unsupported sample rate %dHz\n",
1280 params_rate(params));
1281 return -EINVAL;
1282 }
1283 sr_val = i;
1284
1285 switch (dai_priv->clk) {
1286 case ARIZONA_CLK_SYSCLK:
Charles Keepaxcc9e9242014-06-06 14:14:05 +01001287 switch (priv->arizona->type) {
1288 case WM5102:
1289 arizona_wm5102_set_dac_comp(codec,
1290 params_rate(params));
1291 break;
1292 default:
1293 break;
1294 }
1295
Mark Brownb272efc2012-10-10 15:10:08 +09001296 snd_soc_update_bits(codec, ARIZONA_SAMPLE_RATE_1,
1297 ARIZONA_SAMPLE_RATE_1_MASK, sr_val);
1298 if (base)
1299 snd_soc_update_bits(codec, base + ARIZONA_AIF_RATE_CTRL,
1300 ARIZONA_AIF1_RATE_MASK, 0);
1301 break;
1302 case ARIZONA_CLK_ASYNCCLK:
1303 snd_soc_update_bits(codec, ARIZONA_ASYNC_SAMPLE_RATE_1,
Charles Keepaxc24084d2014-09-01 15:48:52 +01001304 ARIZONA_ASYNC_SAMPLE_RATE_1_MASK, sr_val);
Mark Brownb272efc2012-10-10 15:10:08 +09001305 if (base)
1306 snd_soc_update_bits(codec, base + ARIZONA_AIF_RATE_CTRL,
1307 ARIZONA_AIF1_RATE_MASK,
1308 8 << ARIZONA_AIF1_RATE_SHIFT);
1309 break;
1310 default:
1311 arizona_aif_err(dai, "Invalid clock %d\n", dai_priv->clk);
1312 return -EINVAL;
1313 }
1314
1315 return 0;
1316}
1317
Richard Fitzgeraldbedd4b12014-07-22 11:42:06 +01001318static bool arizona_aif_cfg_changed(struct snd_soc_codec *codec,
1319 int base, int bclk, int lrclk, int frame)
1320{
1321 int val;
1322
1323 val = snd_soc_read(codec, base + ARIZONA_AIF_BCLK_CTRL);
1324 if (bclk != (val & ARIZONA_AIF1_BCLK_FREQ_MASK))
1325 return true;
1326
1327 val = snd_soc_read(codec, base + ARIZONA_AIF_TX_BCLK_RATE);
1328 if (lrclk != (val & ARIZONA_AIF1TX_BCPF_MASK))
1329 return true;
1330
1331 val = snd_soc_read(codec, base + ARIZONA_AIF_FRAME_CTRL_1);
1332 if (frame != (val & (ARIZONA_AIF1TX_WL_MASK |
1333 ARIZONA_AIF1TX_SLOT_LEN_MASK)))
1334 return true;
1335
1336 return false;
1337}
1338
Mark Brown07ed8732012-06-18 21:08:44 +01001339static int arizona_hw_params(struct snd_pcm_substream *substream,
1340 struct snd_pcm_hw_params *params,
1341 struct snd_soc_dai *dai)
1342{
1343 struct snd_soc_codec *codec = dai->codec;
1344 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
Mark Brownc94aa302013-01-17 16:35:14 +09001345 struct arizona *arizona = priv->arizona;
Mark Brown07ed8732012-06-18 21:08:44 +01001346 int base = dai->driver->base;
1347 const int *rates;
Mark Brown76bf9692013-03-05 14:17:47 +08001348 int i, ret, val;
Charles Keepaxed70f3a2014-06-04 10:11:06 +01001349 int channels = params_channels(params);
Mark Brownc94aa302013-01-17 16:35:14 +09001350 int chan_limit = arizona->pdata.max_channels_clocked[dai->id - 1];
Charles Keepaxed70f3a2014-06-04 10:11:06 +01001351 int tdm_width = arizona->tdm_width[dai->id - 1];
1352 int tdm_slots = arizona->tdm_slots[dai->id - 1];
Mark Brownc94aa302013-01-17 16:35:14 +09001353 int bclk, lrclk, wl, frame, bclk_target;
Richard Fitzgeraldbedd4b12014-07-22 11:42:06 +01001354 bool reconfig;
1355 unsigned int aif_tx_state, aif_rx_state;
Mark Brown07ed8732012-06-18 21:08:44 +01001356
1357 if (params_rate(params) % 8000)
Mark Brown949e6bc2012-07-04 18:58:04 +01001358 rates = &arizona_44k1_bclk_rates[0];
Mark Brown07ed8732012-06-18 21:08:44 +01001359 else
Mark Brown949e6bc2012-07-04 18:58:04 +01001360 rates = &arizona_48k_bclk_rates[0];
Mark Brown07ed8732012-06-18 21:08:44 +01001361
Nikesh Oswald114e5f2014-08-12 15:30:32 +01001362 wl = snd_pcm_format_width(params_format(params));
1363
Charles Keepaxed70f3a2014-06-04 10:11:06 +01001364 if (tdm_slots) {
1365 arizona_aif_dbg(dai, "Configuring for %d %d bit TDM slots\n",
1366 tdm_slots, tdm_width);
1367 bclk_target = tdm_slots * tdm_width * params_rate(params);
1368 channels = tdm_slots;
1369 } else {
1370 bclk_target = snd_soc_params_to_bclk(params);
Nikesh Oswald114e5f2014-08-12 15:30:32 +01001371 tdm_width = wl;
Charles Keepaxed70f3a2014-06-04 10:11:06 +01001372 }
1373
1374 if (chan_limit && chan_limit < channels) {
Mark Brownc94aa302013-01-17 16:35:14 +09001375 arizona_aif_dbg(dai, "Limiting to %d channels\n", chan_limit);
Charles Keepaxed70f3a2014-06-04 10:11:06 +01001376 bclk_target /= channels;
Mark Brownc94aa302013-01-17 16:35:14 +09001377 bclk_target *= chan_limit;
1378 }
1379
Charles Keepaxed70f3a2014-06-04 10:11:06 +01001380 /* Force multiple of 2 channels for I2S mode */
Mark Brown76bf9692013-03-05 14:17:47 +08001381 val = snd_soc_read(codec, base + ARIZONA_AIF_FORMAT);
Richard Fitzgeralde9c7f342014-11-12 16:12:46 +00001382 val &= ARIZONA_AIF1_FMT_MASK;
1383 if ((channels & 1) && (val == ARIZONA_FMT_I2S_MODE)) {
Mark Brown76bf9692013-03-05 14:17:47 +08001384 arizona_aif_dbg(dai, "Forcing stereo mode\n");
Charles Keepaxed70f3a2014-06-04 10:11:06 +01001385 bclk_target /= channels;
1386 bclk_target *= channels + 1;
Mark Brown76bf9692013-03-05 14:17:47 +08001387 }
1388
Mark Brown949e6bc2012-07-04 18:58:04 +01001389 for (i = 0; i < ARRAY_SIZE(arizona_44k1_bclk_rates); i++) {
Mark Brownc94aa302013-01-17 16:35:14 +09001390 if (rates[i] >= bclk_target &&
Mark Brown50017652012-07-04 19:07:09 +01001391 rates[i] % params_rate(params) == 0) {
Mark Brown07ed8732012-06-18 21:08:44 +01001392 bclk = i;
1393 break;
1394 }
1395 }
Mark Brown949e6bc2012-07-04 18:58:04 +01001396 if (i == ARRAY_SIZE(arizona_44k1_bclk_rates)) {
Mark Brown07ed8732012-06-18 21:08:44 +01001397 arizona_aif_err(dai, "Unsupported sample rate %dHz\n",
1398 params_rate(params));
1399 return -EINVAL;
1400 }
1401
Mark Brownb59e0f82013-01-17 14:15:59 +09001402 lrclk = rates[bclk] / params_rate(params);
Mark Brown07ed8732012-06-18 21:08:44 +01001403
1404 arizona_aif_dbg(dai, "BCLK %dHz LRCLK %dHz\n",
1405 rates[bclk], rates[bclk] / lrclk);
1406
Nikesh Oswald114e5f2014-08-12 15:30:32 +01001407 frame = wl << ARIZONA_AIF1TX_WL_SHIFT | tdm_width;
Mark Brown07ed8732012-06-18 21:08:44 +01001408
Richard Fitzgeraldbedd4b12014-07-22 11:42:06 +01001409 reconfig = arizona_aif_cfg_changed(codec, base, bclk, lrclk, frame);
1410
1411 if (reconfig) {
1412 /* Save AIF TX/RX state */
1413 aif_tx_state = snd_soc_read(codec,
1414 base + ARIZONA_AIF_TX_ENABLES);
1415 aif_rx_state = snd_soc_read(codec,
1416 base + ARIZONA_AIF_RX_ENABLES);
1417 /* Disable AIF TX/RX before reconfiguring it */
1418 regmap_update_bits_async(arizona->regmap,
1419 base + ARIZONA_AIF_TX_ENABLES, 0xff, 0x0);
1420 regmap_update_bits(arizona->regmap,
1421 base + ARIZONA_AIF_RX_ENABLES, 0xff, 0x0);
1422 }
1423
Mark Brownb272efc2012-10-10 15:10:08 +09001424 ret = arizona_hw_params_rate(substream, params, dai);
1425 if (ret != 0)
Richard Fitzgeraldbedd4b12014-07-22 11:42:06 +01001426 goto restore_aif;
Mark Brownc013b272012-07-04 20:05:57 +01001427
Richard Fitzgeraldbedd4b12014-07-22 11:42:06 +01001428 if (reconfig) {
1429 regmap_update_bits_async(arizona->regmap,
1430 base + ARIZONA_AIF_BCLK_CTRL,
1431 ARIZONA_AIF1_BCLK_FREQ_MASK, bclk);
1432 regmap_update_bits_async(arizona->regmap,
1433 base + ARIZONA_AIF_TX_BCLK_RATE,
1434 ARIZONA_AIF1TX_BCPF_MASK, lrclk);
1435 regmap_update_bits_async(arizona->regmap,
1436 base + ARIZONA_AIF_RX_BCLK_RATE,
1437 ARIZONA_AIF1RX_BCPF_MASK, lrclk);
1438 regmap_update_bits_async(arizona->regmap,
1439 base + ARIZONA_AIF_FRAME_CTRL_1,
1440 ARIZONA_AIF1TX_WL_MASK |
1441 ARIZONA_AIF1TX_SLOT_LEN_MASK, frame);
1442 regmap_update_bits(arizona->regmap,
1443 base + ARIZONA_AIF_FRAME_CTRL_2,
1444 ARIZONA_AIF1RX_WL_MASK |
1445 ARIZONA_AIF1RX_SLOT_LEN_MASK, frame);
1446 }
Mark Brown07ed8732012-06-18 21:08:44 +01001447
Richard Fitzgeraldbedd4b12014-07-22 11:42:06 +01001448restore_aif:
1449 if (reconfig) {
1450 /* Restore AIF TX/RX state */
1451 regmap_update_bits_async(arizona->regmap,
1452 base + ARIZONA_AIF_TX_ENABLES,
1453 0xff, aif_tx_state);
1454 regmap_update_bits(arizona->regmap,
1455 base + ARIZONA_AIF_RX_ENABLES,
1456 0xff, aif_rx_state);
1457 }
1458 return ret;
Mark Brown07ed8732012-06-18 21:08:44 +01001459}
1460
Mark Brown410837a2012-07-05 17:26:59 +01001461static const char *arizona_dai_clk_str(int clk_id)
1462{
1463 switch (clk_id) {
1464 case ARIZONA_CLK_SYSCLK:
1465 return "SYSCLK";
1466 case ARIZONA_CLK_ASYNCCLK:
1467 return "ASYNCCLK";
1468 default:
1469 return "Unknown clock";
1470 }
1471}
1472
Mark Brown5b2eec32012-07-04 17:32:05 +01001473static int arizona_dai_set_sysclk(struct snd_soc_dai *dai,
1474 int clk_id, unsigned int freq, int dir)
1475{
1476 struct snd_soc_codec *codec = dai->codec;
1477 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
1478 struct arizona_dai_priv *dai_priv = &priv->dai[dai->id - 1];
Mark Brown410837a2012-07-05 17:26:59 +01001479 struct snd_soc_dapm_route routes[2];
Mark Brown5b2eec32012-07-04 17:32:05 +01001480
1481 switch (clk_id) {
1482 case ARIZONA_CLK_SYSCLK:
1483 case ARIZONA_CLK_ASYNCCLK:
1484 break;
1485 default:
1486 return -EINVAL;
1487 }
1488
Mark Brown410837a2012-07-05 17:26:59 +01001489 if (clk_id == dai_priv->clk)
1490 return 0;
1491
1492 if (dai->active) {
Mark Brown5b2eec32012-07-04 17:32:05 +01001493 dev_err(codec->dev, "Can't change clock on active DAI %d\n",
1494 dai->id);
1495 return -EBUSY;
1496 }
1497
Mark Brownc8d35a62012-12-07 12:49:40 +09001498 dev_dbg(codec->dev, "Setting AIF%d to %s\n", dai->id + 1,
1499 arizona_dai_clk_str(clk_id));
1500
Mark Brown410837a2012-07-05 17:26:59 +01001501 memset(&routes, 0, sizeof(routes));
1502 routes[0].sink = dai->driver->capture.stream_name;
1503 routes[1].sink = dai->driver->playback.stream_name;
Mark Brown5b2eec32012-07-04 17:32:05 +01001504
Mark Brown410837a2012-07-05 17:26:59 +01001505 routes[0].source = arizona_dai_clk_str(dai_priv->clk);
1506 routes[1].source = arizona_dai_clk_str(dai_priv->clk);
1507 snd_soc_dapm_del_routes(&codec->dapm, routes, ARRAY_SIZE(routes));
1508
1509 routes[0].source = arizona_dai_clk_str(clk_id);
1510 routes[1].source = arizona_dai_clk_str(clk_id);
1511 snd_soc_dapm_add_routes(&codec->dapm, routes, ARRAY_SIZE(routes));
1512
Mark Brown0c778e82012-12-06 18:22:25 +09001513 dai_priv->clk = clk_id;
1514
Mark Brown410837a2012-07-05 17:26:59 +01001515 return snd_soc_dapm_sync(&codec->dapm);
Mark Brown5b2eec32012-07-04 17:32:05 +01001516}
1517
Mark Brown01df2592012-12-12 16:22:08 +09001518static int arizona_set_tristate(struct snd_soc_dai *dai, int tristate)
1519{
1520 struct snd_soc_codec *codec = dai->codec;
1521 int base = dai->driver->base;
1522 unsigned int reg;
1523
1524 if (tristate)
1525 reg = ARIZONA_AIF1_TRI;
1526 else
1527 reg = 0;
1528
1529 return snd_soc_update_bits(codec, base + ARIZONA_AIF_RATE_CTRL,
1530 ARIZONA_AIF1_TRI, reg);
1531}
1532
Charles Keepaxed70f3a2014-06-04 10:11:06 +01001533static void arizona_set_channels_to_mask(struct snd_soc_dai *dai,
1534 unsigned int base,
1535 int channels, unsigned int mask)
1536{
1537 struct snd_soc_codec *codec = dai->codec;
1538 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
1539 struct arizona *arizona = priv->arizona;
1540 int slot, i;
1541
1542 for (i = 0; i < channels; ++i) {
1543 slot = ffs(mask) - 1;
1544 if (slot < 0)
1545 return;
1546
1547 regmap_write(arizona->regmap, base + i, slot);
1548
1549 mask &= ~(1 << slot);
1550 }
1551
1552 if (mask)
1553 arizona_aif_warn(dai, "Too many channels in TDM mask\n");
1554}
1555
1556static int arizona_set_tdm_slot(struct snd_soc_dai *dai, unsigned int tx_mask,
1557 unsigned int rx_mask, int slots, int slot_width)
1558{
1559 struct snd_soc_codec *codec = dai->codec;
1560 struct arizona_priv *priv = snd_soc_codec_get_drvdata(codec);
1561 struct arizona *arizona = priv->arizona;
1562 int base = dai->driver->base;
1563 int rx_max_chan = dai->driver->playback.channels_max;
1564 int tx_max_chan = dai->driver->capture.channels_max;
1565
1566 /* Only support TDM for the physical AIFs */
1567 if (dai->id > ARIZONA_MAX_AIF)
1568 return -ENOTSUPP;
1569
1570 if (slots == 0) {
1571 tx_mask = (1 << tx_max_chan) - 1;
1572 rx_mask = (1 << rx_max_chan) - 1;
1573 }
1574
1575 arizona_set_channels_to_mask(dai, base + ARIZONA_AIF_FRAME_CTRL_3,
1576 tx_max_chan, tx_mask);
1577 arizona_set_channels_to_mask(dai, base + ARIZONA_AIF_FRAME_CTRL_11,
1578 rx_max_chan, rx_mask);
1579
1580 arizona->tdm_width[dai->id - 1] = slot_width;
1581 arizona->tdm_slots[dai->id - 1] = slots;
1582
1583 return 0;
1584}
1585
Mark Brown07ed8732012-06-18 21:08:44 +01001586const struct snd_soc_dai_ops arizona_dai_ops = {
Mark Brown5b2eec32012-07-04 17:32:05 +01001587 .startup = arizona_startup,
Mark Brown07ed8732012-06-18 21:08:44 +01001588 .set_fmt = arizona_set_fmt,
Charles Keepaxed70f3a2014-06-04 10:11:06 +01001589 .set_tdm_slot = arizona_set_tdm_slot,
Mark Brown07ed8732012-06-18 21:08:44 +01001590 .hw_params = arizona_hw_params,
Mark Brown5b2eec32012-07-04 17:32:05 +01001591 .set_sysclk = arizona_dai_set_sysclk,
Mark Brown01df2592012-12-12 16:22:08 +09001592 .set_tristate = arizona_set_tristate,
Mark Brown07ed8732012-06-18 21:08:44 +01001593};
Mark Browna8379872012-07-09 12:16:41 +01001594EXPORT_SYMBOL_GPL(arizona_dai_ops);
Mark Brown07ed8732012-06-18 21:08:44 +01001595
Mark Brownbd1dd882013-05-17 13:29:03 +01001596const struct snd_soc_dai_ops arizona_simple_dai_ops = {
1597 .startup = arizona_startup,
1598 .hw_params = arizona_hw_params_rate,
1599 .set_sysclk = arizona_dai_set_sysclk,
1600};
1601EXPORT_SYMBOL_GPL(arizona_simple_dai_ops);
1602
Mark Brown5b2eec32012-07-04 17:32:05 +01001603int arizona_init_dai(struct arizona_priv *priv, int id)
1604{
1605 struct arizona_dai_priv *dai_priv = &priv->dai[id];
1606
1607 dai_priv->clk = ARIZONA_CLK_SYSCLK;
1608
1609 return 0;
1610}
1611EXPORT_SYMBOL_GPL(arizona_init_dai);
1612
Mark Brown07ed8732012-06-18 21:08:44 +01001613static irqreturn_t arizona_fll_clock_ok(int irq, void *data)
1614{
1615 struct arizona_fll *fll = data;
1616
1617 arizona_fll_dbg(fll, "clock OK\n");
1618
1619 complete(&fll->ok);
1620
1621 return IRQ_HANDLED;
1622}
1623
1624static struct {
1625 unsigned int min;
1626 unsigned int max;
1627 u16 fratio;
1628 int ratio;
1629} fll_fratios[] = {
1630 { 0, 64000, 4, 16 },
1631 { 64000, 128000, 3, 8 },
1632 { 128000, 256000, 2, 4 },
1633 { 256000, 1000000, 1, 2 },
1634 { 1000000, 13500000, 0, 1 },
1635};
1636
Mark Brown8f113d72013-03-05 12:08:57 +08001637static struct {
1638 unsigned int min;
1639 unsigned int max;
1640 u16 gain;
1641} fll_gains[] = {
1642 { 0, 256000, 0 },
1643 { 256000, 1000000, 2 },
1644 { 1000000, 13500000, 4 },
1645};
1646
Mark Brown07ed8732012-06-18 21:08:44 +01001647struct arizona_fll_cfg {
1648 int n;
1649 int theta;
1650 int lambda;
1651 int refdiv;
1652 int outdiv;
1653 int fratio;
Mark Brown8f113d72013-03-05 12:08:57 +08001654 int gain;
Mark Brown07ed8732012-06-18 21:08:44 +01001655};
1656
Charles Keepax23f785a82014-03-07 16:34:20 +00001657static int arizona_validate_fll(struct arizona_fll *fll,
1658 unsigned int Fref,
1659 unsigned int Fout)
1660{
1661 unsigned int Fvco_min;
1662
Charles Keepaxc8badda2014-07-09 17:41:49 +01001663 if (fll->fout && Fout != fll->fout) {
1664 arizona_fll_err(fll,
1665 "Can't change output on active FLL\n");
1666 return -EINVAL;
1667 }
1668
Charles Keepax23f785a82014-03-07 16:34:20 +00001669 if (Fref / ARIZONA_FLL_MAX_REFDIV > ARIZONA_FLL_MAX_FREF) {
1670 arizona_fll_err(fll,
1671 "Can't scale %dMHz in to <=13.5MHz\n",
1672 Fref);
1673 return -EINVAL;
1674 }
1675
1676 Fvco_min = ARIZONA_FLL_MIN_FVCO * fll->vco_mult;
1677 if (Fout * ARIZONA_FLL_MAX_OUTDIV < Fvco_min) {
1678 arizona_fll_err(fll, "No FLL_OUTDIV for Fout=%uHz\n",
1679 Fout);
1680 return -EINVAL;
1681 }
1682
1683 return 0;
1684}
1685
Charles Keepaxd0800342014-03-07 16:34:25 +00001686static int arizona_find_fratio(unsigned int Fref, int *fratio)
1687{
1688 int i;
1689
1690 /* Find an appropriate FLL_FRATIO */
1691 for (i = 0; i < ARRAY_SIZE(fll_fratios); i++) {
1692 if (fll_fratios[i].min <= Fref && Fref <= fll_fratios[i].max) {
1693 if (fratio)
1694 *fratio = fll_fratios[i].fratio;
1695 return fll_fratios[i].ratio;
1696 }
1697 }
1698
1699 return -EINVAL;
1700}
1701
1702static int arizona_calc_fratio(struct arizona_fll *fll,
1703 struct arizona_fll_cfg *cfg,
1704 unsigned int target,
1705 unsigned int Fref, bool sync)
1706{
1707 int init_ratio, ratio;
1708 int refdiv, div;
1709
1710 /* Fref must be <=13.5MHz, find initial refdiv */
1711 div = 1;
1712 cfg->refdiv = 0;
1713 while (Fref > ARIZONA_FLL_MAX_FREF) {
1714 div *= 2;
1715 Fref /= 2;
1716 cfg->refdiv++;
1717
1718 if (div > ARIZONA_FLL_MAX_REFDIV)
1719 return -EINVAL;
1720 }
1721
1722 /* Find an appropriate FLL_FRATIO */
1723 init_ratio = arizona_find_fratio(Fref, &cfg->fratio);
1724 if (init_ratio < 0) {
1725 arizona_fll_err(fll, "Unable to find FRATIO for Fref=%uHz\n",
1726 Fref);
1727 return init_ratio;
1728 }
1729
1730 switch (fll->arizona->type) {
1731 case WM5110:
1732 if (fll->arizona->rev < 3 || sync)
1733 return init_ratio;
1734 break;
1735 default:
1736 return init_ratio;
1737 }
1738
1739 cfg->fratio = init_ratio - 1;
1740
1741 /* Adjust FRATIO/refdiv to avoid integer mode if possible */
1742 refdiv = cfg->refdiv;
1743
1744 while (div <= ARIZONA_FLL_MAX_REFDIV) {
1745 for (ratio = init_ratio; ratio <= ARIZONA_FLL_MAX_FRATIO;
1746 ratio++) {
Charles Keepax35a730a2014-07-09 17:41:45 +01001747 if ((ARIZONA_FLL_VCO_CORNER / 2) /
1748 (fll->vco_mult * ratio) < Fref)
Charles Keepax29fee822014-07-09 17:41:44 +01001749 break;
1750
Charles Keepaxd0800342014-03-07 16:34:25 +00001751 if (target % (ratio * Fref)) {
1752 cfg->refdiv = refdiv;
1753 cfg->fratio = ratio - 1;
1754 return ratio;
1755 }
1756 }
1757
Charles Keepax4714bc02014-07-09 17:41:43 +01001758 for (ratio = init_ratio - 1; ratio > 0; ratio--) {
Charles Keepaxd0800342014-03-07 16:34:25 +00001759 if (target % (ratio * Fref)) {
1760 cfg->refdiv = refdiv;
1761 cfg->fratio = ratio - 1;
1762 return ratio;
1763 }
1764 }
1765
1766 div *= 2;
1767 Fref /= 2;
1768 refdiv++;
1769 init_ratio = arizona_find_fratio(Fref, NULL);
1770 }
1771
1772 arizona_fll_warn(fll, "Falling back to integer mode operation\n");
1773 return cfg->fratio + 1;
1774}
1775
Mark Brown07ed8732012-06-18 21:08:44 +01001776static int arizona_calc_fll(struct arizona_fll *fll,
1777 struct arizona_fll_cfg *cfg,
Charles Keepaxd0800342014-03-07 16:34:25 +00001778 unsigned int Fref, bool sync)
Mark Brown07ed8732012-06-18 21:08:44 +01001779{
1780 unsigned int target, div, gcd_fll;
1781 int i, ratio;
1782
Charles Keepax8ccefcd2014-03-07 16:34:21 +00001783 arizona_fll_dbg(fll, "Fref=%u Fout=%u\n", Fref, fll->fout);
Mark Brown07ed8732012-06-18 21:08:44 +01001784
Mark Brown2b4d39f2012-07-10 17:03:46 +01001785 /* Fvco should be over the targt; don't check the upper bound */
Charles Keepaxf641aec2014-03-07 16:34:22 +00001786 div = ARIZONA_FLL_MIN_OUTDIV;
1787 while (fll->fout * div < ARIZONA_FLL_MIN_FVCO * fll->vco_mult) {
Mark Brown07ed8732012-06-18 21:08:44 +01001788 div++;
Charles Keepaxf641aec2014-03-07 16:34:22 +00001789 if (div > ARIZONA_FLL_MAX_OUTDIV)
Mark Brown07ed8732012-06-18 21:08:44 +01001790 return -EINVAL;
Mark Brown07ed8732012-06-18 21:08:44 +01001791 }
Charles Keepaxf641aec2014-03-07 16:34:22 +00001792 target = fll->fout * div / fll->vco_mult;
Mark Brown07ed8732012-06-18 21:08:44 +01001793 cfg->outdiv = div;
1794
1795 arizona_fll_dbg(fll, "Fvco=%dHz\n", target);
1796
Charles Keepaxd0800342014-03-07 16:34:25 +00001797 /* Find an appropriate FLL_FRATIO and refdiv */
1798 ratio = arizona_calc_fratio(fll, cfg, target, Fref, sync);
1799 if (ratio < 0)
1800 return ratio;
Mark Brown07ed8732012-06-18 21:08:44 +01001801
Mark Brown07ed8732012-06-18 21:08:44 +01001802 /* Apply the division for our remaining calculations */
Charles Keepaxd0800342014-03-07 16:34:25 +00001803 Fref = Fref / (1 << cfg->refdiv);
Mark Brown8f113d72013-03-05 12:08:57 +08001804
Mark Brown07ed8732012-06-18 21:08:44 +01001805 cfg->n = target / (ratio * Fref);
1806
Ryo Tsutsui01f58152013-02-03 17:18:00 +09001807 if (target % (ratio * Fref)) {
Mark Brown07ed8732012-06-18 21:08:44 +01001808 gcd_fll = gcd(target, ratio * Fref);
1809 arizona_fll_dbg(fll, "GCD=%u\n", gcd_fll);
1810
1811 cfg->theta = (target - (cfg->n * ratio * Fref))
1812 / gcd_fll;
1813 cfg->lambda = (ratio * Fref) / gcd_fll;
1814 } else {
1815 cfg->theta = 0;
1816 cfg->lambda = 0;
1817 }
1818
Ryo Tsutsui01f58152013-02-03 17:18:00 +09001819 /* Round down to 16bit range with cost of accuracy lost.
1820 * Denominator must be bigger than numerator so we only
1821 * take care of it.
1822 */
1823 while (cfg->lambda >= (1 << 16)) {
1824 cfg->theta >>= 1;
1825 cfg->lambda >>= 1;
1826 }
1827
Charles Keepax5a3935c2014-03-07 16:34:23 +00001828 for (i = 0; i < ARRAY_SIZE(fll_gains); i++) {
1829 if (fll_gains[i].min <= Fref && Fref <= fll_gains[i].max) {
1830 cfg->gain = fll_gains[i].gain;
1831 break;
1832 }
1833 }
1834 if (i == ARRAY_SIZE(fll_gains)) {
1835 arizona_fll_err(fll, "Unable to find gain for Fref=%uHz\n",
1836 Fref);
1837 return -EINVAL;
1838 }
1839
Mark Brown07ed8732012-06-18 21:08:44 +01001840 arizona_fll_dbg(fll, "N=%x THETA=%x LAMBDA=%x\n",
1841 cfg->n, cfg->theta, cfg->lambda);
1842 arizona_fll_dbg(fll, "FRATIO=%x(%d) OUTDIV=%x REFCLK_DIV=%x\n",
1843 cfg->fratio, cfg->fratio, cfg->outdiv, cfg->refdiv);
Mark Brown8f113d72013-03-05 12:08:57 +08001844 arizona_fll_dbg(fll, "GAIN=%d\n", cfg->gain);
Mark Brown07ed8732012-06-18 21:08:44 +01001845
1846 return 0;
1847
1848}
1849
1850static void arizona_apply_fll(struct arizona *arizona, unsigned int base,
Mark Brown8f113d72013-03-05 12:08:57 +08001851 struct arizona_fll_cfg *cfg, int source,
1852 bool sync)
Mark Brown07ed8732012-06-18 21:08:44 +01001853{
Mark Brown3c43c692013-12-12 00:49:22 +00001854 regmap_update_bits_async(arizona->regmap, base + 3,
1855 ARIZONA_FLL1_THETA_MASK, cfg->theta);
1856 regmap_update_bits_async(arizona->regmap, base + 4,
1857 ARIZONA_FLL1_LAMBDA_MASK, cfg->lambda);
1858 regmap_update_bits_async(arizona->regmap, base + 5,
1859 ARIZONA_FLL1_FRATIO_MASK,
1860 cfg->fratio << ARIZONA_FLL1_FRATIO_SHIFT);
1861 regmap_update_bits_async(arizona->regmap, base + 6,
1862 ARIZONA_FLL1_CLK_REF_DIV_MASK |
1863 ARIZONA_FLL1_CLK_REF_SRC_MASK,
1864 cfg->refdiv << ARIZONA_FLL1_CLK_REF_DIV_SHIFT |
1865 source << ARIZONA_FLL1_CLK_REF_SRC_SHIFT);
Mark Brown07ed8732012-06-18 21:08:44 +01001866
Charles Keepax61719db2014-03-07 16:34:19 +00001867 if (sync) {
1868 regmap_update_bits(arizona->regmap, base + 0x7,
1869 ARIZONA_FLL1_GAIN_MASK,
1870 cfg->gain << ARIZONA_FLL1_GAIN_SHIFT);
1871 } else {
1872 regmap_update_bits(arizona->regmap, base + 0x5,
1873 ARIZONA_FLL1_OUTDIV_MASK,
1874 cfg->outdiv << ARIZONA_FLL1_OUTDIV_SHIFT);
1875 regmap_update_bits(arizona->regmap, base + 0x9,
1876 ARIZONA_FLL1_GAIN_MASK,
1877 cfg->gain << ARIZONA_FLL1_GAIN_SHIFT);
1878 }
Mark Brown8f113d72013-03-05 12:08:57 +08001879
Mark Brown3c43c692013-12-12 00:49:22 +00001880 regmap_update_bits_async(arizona->regmap, base + 2,
1881 ARIZONA_FLL1_CTRL_UPD | ARIZONA_FLL1_N_MASK,
1882 ARIZONA_FLL1_CTRL_UPD | cfg->n);
Mark Brown07ed8732012-06-18 21:08:44 +01001883}
1884
Charles Keepaxc393aca2014-07-09 17:41:47 +01001885static int arizona_is_enabled_fll(struct arizona_fll *fll)
Charles Keepaxd122d6c2013-02-20 17:28:36 +00001886{
1887 struct arizona *arizona = fll->arizona;
1888 unsigned int reg;
1889 int ret;
1890
1891 ret = regmap_read(arizona->regmap, fll->base + 1, &reg);
1892 if (ret != 0) {
1893 arizona_fll_err(fll, "Failed to read current state: %d\n",
1894 ret);
1895 return ret;
1896 }
1897
1898 return reg & ARIZONA_FLL1_ENA;
1899}
1900
Charles Keepaxc393aca2014-07-09 17:41:47 +01001901static int arizona_enable_fll(struct arizona_fll *fll)
Charles Keepax35722812013-02-20 17:28:38 +00001902{
1903 struct arizona *arizona = fll->arizona;
Nicholas Mc Guire17f4ad62015-03-08 09:16:49 -04001904 unsigned long time_left;
Charles Keepax49c60542013-09-16 15:34:35 +01001905 bool use_sync = false;
Charles Keepaxc393aca2014-07-09 17:41:47 +01001906 int already_enabled = arizona_is_enabled_fll(fll);
Charles Keepax23f785a82014-03-07 16:34:20 +00001907 struct arizona_fll_cfg cfg;
Charles Keepax35722812013-02-20 17:28:38 +00001908
Charles Keepaxc393aca2014-07-09 17:41:47 +01001909 if (already_enabled < 0)
1910 return already_enabled;
1911
Charles Keepaxc8badda2014-07-09 17:41:49 +01001912 if (already_enabled) {
1913 /* Facilitate smooth refclk across the transition */
1914 regmap_update_bits_async(fll->arizona->regmap, fll->base + 0x7,
1915 ARIZONA_FLL1_GAIN_MASK, 0);
1916 regmap_update_bits_async(fll->arizona->regmap, fll->base + 1,
1917 ARIZONA_FLL1_FREERUN,
1918 ARIZONA_FLL1_FREERUN);
1919 }
1920
Mark Brownff680a12013-03-04 16:00:19 +08001921 /*
1922 * If we have both REFCLK and SYNCCLK then enable both,
1923 * otherwise apply the SYNCCLK settings to REFCLK.
1924 */
Charles Keepax49c60542013-09-16 15:34:35 +01001925 if (fll->ref_src >= 0 && fll->ref_freq &&
1926 fll->ref_src != fll->sync_src) {
Charles Keepaxd0800342014-03-07 16:34:25 +00001927 arizona_calc_fll(fll, &cfg, fll->ref_freq, false);
Charles Keepax35722812013-02-20 17:28:38 +00001928
Charles Keepax23f785a82014-03-07 16:34:20 +00001929 arizona_apply_fll(arizona, fll->base, &cfg, fll->ref_src,
Mark Brown8f113d72013-03-05 12:08:57 +08001930 false);
Charles Keepax49c60542013-09-16 15:34:35 +01001931 if (fll->sync_src >= 0) {
Charles Keepaxd0800342014-03-07 16:34:25 +00001932 arizona_calc_fll(fll, &cfg, fll->sync_freq, true);
Charles Keepax23f785a82014-03-07 16:34:20 +00001933
1934 arizona_apply_fll(arizona, fll->base + 0x10, &cfg,
Mark Brown8f113d72013-03-05 12:08:57 +08001935 fll->sync_src, true);
Charles Keepax49c60542013-09-16 15:34:35 +01001936 use_sync = true;
1937 }
Mark Brownff680a12013-03-04 16:00:19 +08001938 } else if (fll->sync_src >= 0) {
Charles Keepaxd0800342014-03-07 16:34:25 +00001939 arizona_calc_fll(fll, &cfg, fll->sync_freq, false);
Mark Brownff680a12013-03-04 16:00:19 +08001940
Charles Keepax23f785a82014-03-07 16:34:20 +00001941 arizona_apply_fll(arizona, fll->base, &cfg,
Mark Brown8f113d72013-03-05 12:08:57 +08001942 fll->sync_src, false);
Mark Browneca2e8e2013-03-06 00:09:59 +08001943
Mark Brown3c43c692013-12-12 00:49:22 +00001944 regmap_update_bits_async(arizona->regmap, fll->base + 0x11,
1945 ARIZONA_FLL1_SYNC_ENA, 0);
Mark Brownff680a12013-03-04 16:00:19 +08001946 } else {
1947 arizona_fll_err(fll, "No clocks provided\n");
Charles Keepaxc393aca2014-07-09 17:41:47 +01001948 return -EINVAL;
Mark Brownff680a12013-03-04 16:00:19 +08001949 }
Charles Keepax35722812013-02-20 17:28:38 +00001950
Mark Brown576411be2013-03-05 12:07:16 +08001951 /*
1952 * Increase the bandwidth if we're not using a low frequency
1953 * sync source.
1954 */
Charles Keepax49c60542013-09-16 15:34:35 +01001955 if (use_sync && fll->sync_freq > 100000)
Mark Brown3c43c692013-12-12 00:49:22 +00001956 regmap_update_bits_async(arizona->regmap, fll->base + 0x17,
1957 ARIZONA_FLL1_SYNC_BW, 0);
Mark Brown576411be2013-03-05 12:07:16 +08001958 else
Mark Brown3c43c692013-12-12 00:49:22 +00001959 regmap_update_bits_async(arizona->regmap, fll->base + 0x17,
1960 ARIZONA_FLL1_SYNC_BW,
1961 ARIZONA_FLL1_SYNC_BW);
Mark Brown576411be2013-03-05 12:07:16 +08001962
Charles Keepaxc393aca2014-07-09 17:41:47 +01001963 if (!already_enabled)
Charles Keepax35722812013-02-20 17:28:38 +00001964 pm_runtime_get(arizona->dev);
1965
1966 /* Clear any pending completions */
1967 try_wait_for_completion(&fll->ok);
1968
Mark Brown3c43c692013-12-12 00:49:22 +00001969 regmap_update_bits_async(arizona->regmap, fll->base + 1,
Mark Brown3c43c692013-12-12 00:49:22 +00001970 ARIZONA_FLL1_ENA, ARIZONA_FLL1_ENA);
Charles Keepax49c60542013-09-16 15:34:35 +01001971 if (use_sync)
Mark Brown3c43c692013-12-12 00:49:22 +00001972 regmap_update_bits_async(arizona->regmap, fll->base + 0x11,
1973 ARIZONA_FLL1_SYNC_ENA,
1974 ARIZONA_FLL1_SYNC_ENA);
Charles Keepax35722812013-02-20 17:28:38 +00001975
Charles Keepaxc8badda2014-07-09 17:41:49 +01001976 if (already_enabled)
1977 regmap_update_bits_async(arizona->regmap, fll->base + 1,
1978 ARIZONA_FLL1_FREERUN, 0);
1979
Nicholas Mc Guire17f4ad62015-03-08 09:16:49 -04001980 time_left = wait_for_completion_timeout(&fll->ok,
Charles Keepax35722812013-02-20 17:28:38 +00001981 msecs_to_jiffies(250));
Nicholas Mc Guire17f4ad62015-03-08 09:16:49 -04001982 if (time_left == 0)
Charles Keepax35722812013-02-20 17:28:38 +00001983 arizona_fll_warn(fll, "Timed out waiting for lock\n");
Charles Keepaxc393aca2014-07-09 17:41:47 +01001984
1985 return 0;
Charles Keepax35722812013-02-20 17:28:38 +00001986}
1987
Charles Keepax76040542013-02-20 17:28:37 +00001988static void arizona_disable_fll(struct arizona_fll *fll)
1989{
1990 struct arizona *arizona = fll->arizona;
1991 bool change;
1992
Mark Brown3c43c692013-12-12 00:49:22 +00001993 regmap_update_bits_async(arizona->regmap, fll->base + 1,
1994 ARIZONA_FLL1_FREERUN, ARIZONA_FLL1_FREERUN);
Charles Keepax76040542013-02-20 17:28:37 +00001995 regmap_update_bits_check(arizona->regmap, fll->base + 1,
1996 ARIZONA_FLL1_ENA, 0, &change);
1997 regmap_update_bits(arizona->regmap, fll->base + 0x11,
1998 ARIZONA_FLL1_SYNC_ENA, 0);
Charles Keepax5e39a502014-07-09 17:41:48 +01001999 regmap_update_bits_async(arizona->regmap, fll->base + 1,
2000 ARIZONA_FLL1_FREERUN, 0);
Charles Keepax76040542013-02-20 17:28:37 +00002001
2002 if (change)
2003 pm_runtime_put_autosuspend(arizona->dev);
2004}
2005
Charles Keepaxee929a92013-02-20 17:28:40 +00002006int arizona_set_fll_refclk(struct arizona_fll *fll, int source,
2007 unsigned int Fref, unsigned int Fout)
2008{
Charles Keepaxc393aca2014-07-09 17:41:47 +01002009 int ret = 0;
Charles Keepaxee929a92013-02-20 17:28:40 +00002010
Charles Keepax1c5617f2013-02-22 17:10:37 +00002011 if (fll->ref_src == source && fll->ref_freq == Fref)
Charles Keepaxee929a92013-02-20 17:28:40 +00002012 return 0;
2013
Charles Keepax23f785a82014-03-07 16:34:20 +00002014 if (fll->fout && Fref > 0) {
2015 ret = arizona_validate_fll(fll, Fref, fll->fout);
2016 if (ret != 0)
2017 return ret;
Charles Keepaxee929a92013-02-20 17:28:40 +00002018 }
2019
2020 fll->ref_src = source;
2021 fll->ref_freq = Fref;
Charles Keepaxee929a92013-02-20 17:28:40 +00002022
Mark Brown86cd6842013-03-07 16:14:04 +08002023 if (fll->fout && Fref > 0) {
Charles Keepaxc393aca2014-07-09 17:41:47 +01002024 ret = arizona_enable_fll(fll);
Charles Keepaxee929a92013-02-20 17:28:40 +00002025 }
2026
Charles Keepaxc393aca2014-07-09 17:41:47 +01002027 return ret;
Charles Keepaxee929a92013-02-20 17:28:40 +00002028}
2029EXPORT_SYMBOL_GPL(arizona_set_fll_refclk);
2030
Mark Brown07ed8732012-06-18 21:08:44 +01002031int arizona_set_fll(struct arizona_fll *fll, int source,
2032 unsigned int Fref, unsigned int Fout)
2033{
Charles Keepaxc393aca2014-07-09 17:41:47 +01002034 int ret = 0;
Mark Brown07ed8732012-06-18 21:08:44 +01002035
Mark Brownff680a12013-03-04 16:00:19 +08002036 if (fll->sync_src == source &&
2037 fll->sync_freq == Fref && fll->fout == Fout)
2038 return 0;
Charles Keepaxde1e6ee2013-02-20 17:28:39 +00002039
Mark Brownff680a12013-03-04 16:00:19 +08002040 if (Fout) {
2041 if (fll->ref_src >= 0) {
Charles Keepax23f785a82014-03-07 16:34:20 +00002042 ret = arizona_validate_fll(fll, fll->ref_freq, Fout);
Charles Keepax9e359c62013-02-20 17:28:35 +00002043 if (ret != 0)
2044 return ret;
2045 }
2046
Charles Keepax23f785a82014-03-07 16:34:20 +00002047 ret = arizona_validate_fll(fll, Fref, Fout);
Mark Brownff680a12013-03-04 16:00:19 +08002048 if (ret != 0)
2049 return ret;
Charles Keepax9e359c62013-02-20 17:28:35 +00002050 }
Mark Brownff680a12013-03-04 16:00:19 +08002051
2052 fll->sync_src = source;
2053 fll->sync_freq = Fref;
Charles Keepaxde1e6ee2013-02-20 17:28:39 +00002054 fll->fout = Fout;
Charles Keepax9e359c62013-02-20 17:28:35 +00002055
Charles Keepax613124c2014-07-09 17:41:46 +01002056 if (Fout)
Charles Keepaxc393aca2014-07-09 17:41:47 +01002057 ret = arizona_enable_fll(fll);
Charles Keepax613124c2014-07-09 17:41:46 +01002058 else
Charles Keepax76040542013-02-20 17:28:37 +00002059 arizona_disable_fll(fll);
Mark Brown07ed8732012-06-18 21:08:44 +01002060
Charles Keepaxc393aca2014-07-09 17:41:47 +01002061 return ret;
Mark Brown07ed8732012-06-18 21:08:44 +01002062}
2063EXPORT_SYMBOL_GPL(arizona_set_fll);
2064
2065int arizona_init_fll(struct arizona *arizona, int id, int base, int lock_irq,
2066 int ok_irq, struct arizona_fll *fll)
2067{
2068 int ret;
Charles Keepax19b34bd2013-02-20 17:28:34 +00002069 unsigned int val;
Mark Brown07ed8732012-06-18 21:08:44 +01002070
Mark Brown07ed8732012-06-18 21:08:44 +01002071 init_completion(&fll->ok);
2072
2073 fll->id = id;
2074 fll->base = base;
2075 fll->arizona = arizona;
Charles Keepaxf3f11632013-02-20 17:28:41 +00002076 fll->sync_src = ARIZONA_FLL_SRC_NONE;
Mark Brown07ed8732012-06-18 21:08:44 +01002077
Charles Keepax19b34bd2013-02-20 17:28:34 +00002078 /* Configure default refclk to 32kHz if we have one */
2079 regmap_read(arizona->regmap, ARIZONA_CLOCK_32K_1, &val);
2080 switch (val & ARIZONA_CLK_32K_SRC_MASK) {
2081 case ARIZONA_CLK_SRC_MCLK1:
2082 case ARIZONA_CLK_SRC_MCLK2:
2083 fll->ref_src = val & ARIZONA_CLK_32K_SRC_MASK;
2084 break;
2085 default:
Charles Keepaxf3f11632013-02-20 17:28:41 +00002086 fll->ref_src = ARIZONA_FLL_SRC_NONE;
Charles Keepax19b34bd2013-02-20 17:28:34 +00002087 }
2088 fll->ref_freq = 32768;
2089
Mark Brown07ed8732012-06-18 21:08:44 +01002090 snprintf(fll->lock_name, sizeof(fll->lock_name), "FLL%d lock", id);
2091 snprintf(fll->clock_ok_name, sizeof(fll->clock_ok_name),
2092 "FLL%d clock OK", id);
2093
Mark Brown07ed8732012-06-18 21:08:44 +01002094 ret = arizona_request_irq(arizona, ok_irq, fll->clock_ok_name,
2095 arizona_fll_clock_ok, fll);
2096 if (ret != 0) {
2097 dev_err(arizona->dev, "Failed to get FLL%d clock OK IRQ: %d\n",
2098 id, ret);
2099 }
2100
Charles Keepaxe31c1942013-01-07 16:41:45 +00002101 regmap_update_bits(arizona->regmap, fll->base + 1,
2102 ARIZONA_FLL1_FREERUN, 0);
2103
Mark Brown07ed8732012-06-18 21:08:44 +01002104 return 0;
2105}
2106EXPORT_SYMBOL_GPL(arizona_init_fll);
2107
Mark Brownbc9ab6d2013-01-04 19:31:00 +00002108/**
2109 * arizona_set_output_mode - Set the mode of the specified output
2110 *
2111 * @codec: Device to configure
2112 * @output: Output number
2113 * @diff: True to set the output to differential mode
2114 *
2115 * Some systems use external analogue switches to connect more
2116 * analogue devices to the CODEC than are supported by the device. In
2117 * some systems this requires changing the switched output from single
2118 * ended to differential mode dynamically at runtime, an operation
2119 * supported using this function.
2120 *
2121 * Most systems have a single static configuration and should use
2122 * platform data instead.
2123 */
2124int arizona_set_output_mode(struct snd_soc_codec *codec, int output, bool diff)
2125{
2126 unsigned int reg, val;
2127
2128 if (output < 1 || output > 6)
2129 return -EINVAL;
2130
2131 reg = ARIZONA_OUTPUT_PATH_CONFIG_1L + (output - 1) * 8;
2132
2133 if (diff)
2134 val = ARIZONA_OUT1_MONO;
2135 else
2136 val = 0;
2137
2138 return snd_soc_update_bits(codec, reg, ARIZONA_OUT1_MONO, val);
2139}
2140EXPORT_SYMBOL_GPL(arizona_set_output_mode);
2141
Mark Brown07ed8732012-06-18 21:08:44 +01002142MODULE_DESCRIPTION("ASoC Wolfson Arizona class device support");
2143MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
2144MODULE_LICENSE("GPL");