]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blame - sound/soc/sti/uniperif_player.c
Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/dtor/input
[mirror_ubuntu-zesty-kernel.git] / sound / soc / sti / uniperif_player.c
CommitLineData
76c2145d
AP
1/*
2 * Copyright (C) STMicroelectronics SA 2015
3 * Authors: Arnaud Pouliquen <arnaud.pouliquen@st.com>
4 * for STMicroelectronics.
5 * License terms: GNU General Public License (GPL), version 2
6 */
7
8#include <linux/clk.h>
76c2145d
AP
9#include <linux/mfd/syscon.h>
10
11#include <sound/asoundef.h>
12#include <sound/soc.h>
13
14#include "uniperif.h"
15
16/*
17 * Some hardware-related definitions
18 */
19
20/* sys config registers definitions */
21#define SYS_CFG_AUDIO_GLUE 0xA4
76c2145d
AP
22
23/*
24 * Driver specific types.
25 */
76c2145d 26
fa050796
AP
27#define UNIPERIF_PLAYER_CLK_ADJ_MIN -999999
28#define UNIPERIF_PLAYER_CLK_ADJ_MAX 1000000
3ee15cac 29#define UNIPERIF_PLAYER_I2S_OUT 1 /* player id connected to I2S/TDM TX bus */
fa050796 30
76c2145d
AP
31/*
32 * Note: snd_pcm_hardware is linked to DMA controller but is declared here to
33 * integrate DAI_CPU capability in term of rate and supported channels
34 */
f2da4542 35static const struct snd_pcm_hardware uni_player_pcm_hw = {
76c2145d
AP
36 .info = SNDRV_PCM_INFO_INTERLEAVED | SNDRV_PCM_INFO_BLOCK_TRANSFER |
37 SNDRV_PCM_INFO_PAUSE | SNDRV_PCM_INFO_MMAP |
38 SNDRV_PCM_INFO_MMAP_VALID,
39 .formats = SNDRV_PCM_FMTBIT_S32_LE | SNDRV_PCM_FMTBIT_S16_LE,
40
41 .rates = SNDRV_PCM_RATE_CONTINUOUS,
42 .rate_min = 8000,
43 .rate_max = 192000,
44
45 .channels_min = 2,
46 .channels_max = 8,
47
48 .periods_min = 2,
49 .periods_max = 48,
50
51 .period_bytes_min = 128,
52 .period_bytes_max = 64 * PAGE_SIZE,
53 .buffer_bytes_max = 256 * PAGE_SIZE
54};
55
76c2145d
AP
56/*
57 * uni_player_irq_handler
58 * In case of error audio stream is stopped; stop action is protected via PCM
59 * stream lock to avoid race condition with trigger callback.
60 */
61static irqreturn_t uni_player_irq_handler(int irq, void *dev_id)
62{
63 irqreturn_t ret = IRQ_NONE;
64 struct uniperif *player = dev_id;
65 unsigned int status;
66 unsigned int tmp;
67
68 if (player->state == UNIPERIF_STATE_STOPPED) {
69 /* Unexpected IRQ: do nothing */
70 return IRQ_NONE;
71 }
72
73 /* Get interrupt status & clear them immediately */
74 status = GET_UNIPERIF_ITS(player);
75 SET_UNIPERIF_ITS_BCLR(player, status);
76
77 /* Check for fifo error (underrun) */
78 if (unlikely(status & UNIPERIF_ITS_FIFO_ERROR_MASK(player))) {
748abba8 79 dev_err(player->dev, "FIFO underflow error detected\n");
76c2145d
AP
80
81 /* Interrupt is just for information when underflow recovery */
5a4326d1 82 if (player->underflow_enabled) {
76c2145d
AP
83 /* Update state to underflow */
84 player->state = UNIPERIF_STATE_UNDERFLOW;
85
86 } else {
87 /* Disable interrupt so doesn't continually fire */
88 SET_UNIPERIF_ITM_BCLR_FIFO_ERROR(player);
89
90 /* Stop the player */
91 snd_pcm_stream_lock(player->substream);
92 snd_pcm_stop(player->substream, SNDRV_PCM_STATE_XRUN);
93 snd_pcm_stream_unlock(player->substream);
94 }
95
96 ret = IRQ_HANDLED;
97 }
98
99 /* Check for dma error (overrun) */
100 if (unlikely(status & UNIPERIF_ITS_DMA_ERROR_MASK(player))) {
748abba8 101 dev_err(player->dev, "DMA error detected\n");
76c2145d
AP
102
103 /* Disable interrupt so doesn't continually fire */
104 SET_UNIPERIF_ITM_BCLR_DMA_ERROR(player);
105
106 /* Stop the player */
107 snd_pcm_stream_lock(player->substream);
108 snd_pcm_stop(player->substream, SNDRV_PCM_STATE_XRUN);
109 snd_pcm_stream_unlock(player->substream);
110
111 ret = IRQ_HANDLED;
112 }
113
114 /* Check for underflow recovery done */
115 if (unlikely(status & UNIPERIF_ITM_UNDERFLOW_REC_DONE_MASK(player))) {
5a4326d1 116 if (!player->underflow_enabled) {
748abba8
AP
117 dev_err(player->dev,
118 "unexpected Underflow recovering\n");
76c2145d
AP
119 return -EPERM;
120 }
121 /* Read the underflow recovery duration */
122 tmp = GET_UNIPERIF_STATUS_1_UNDERFLOW_DURATION(player);
748abba8
AP
123 dev_dbg(player->dev, "Underflow recovered (%d LR clocks max)\n",
124 tmp);
76c2145d
AP
125
126 /* Clear the underflow recovery duration */
127 SET_UNIPERIF_BIT_CONTROL_CLR_UNDERFLOW_DURATION(player);
128
129 /* Update state to started */
130 player->state = UNIPERIF_STATE_STARTED;
131
132 ret = IRQ_HANDLED;
133 }
134
135 /* Check if underflow recovery failed */
136 if (unlikely(status &
137 UNIPERIF_ITM_UNDERFLOW_REC_FAILED_MASK(player))) {
748abba8 138 dev_err(player->dev, "Underflow recovery failed\n");
76c2145d
AP
139
140 /* Stop the player */
141 snd_pcm_stream_lock(player->substream);
142 snd_pcm_stop(player->substream, SNDRV_PCM_STATE_XRUN);
143 snd_pcm_stream_unlock(player->substream);
144
145 ret = IRQ_HANDLED;
146 }
147
148 return ret;
149}
150
f2da4542 151static int uni_player_clk_set_rate(struct uniperif *player, unsigned long rate)
fa050796
AP
152{
153 int rate_adjusted, rate_achieved, delta, ret;
154 int adjustment = player->clk_adj;
155
156 /*
157 * a
158 * F = f + --------- * f = f + d
159 * 1000000
160 *
161 * a
162 * d = --------- * f
163 * 1000000
164 *
165 * where:
166 * f - nominal rate
167 * a - adjustment in ppm (parts per milion)
168 * F - rate to be set in synthesizer
169 * d - delta (difference) between f and F
170 */
171 if (adjustment < 0) {
172 /* div64_64 operates on unsigned values... */
173 delta = -1;
174 adjustment = -adjustment;
175 } else {
176 delta = 1;
177 }
178 /* 500000 ppm is 0.5, which is used to round up values */
179 delta *= (int)div64_u64((uint64_t)rate *
180 (uint64_t)adjustment + 500000, 1000000);
181 rate_adjusted = rate + delta;
182
183 /* Adjusted rate should never be == 0 */
184 if (!rate_adjusted)
185 return -EINVAL;
186
187 ret = clk_set_rate(player->clk, rate_adjusted);
188 if (ret < 0)
189 return ret;
190
191 rate_achieved = clk_get_rate(player->clk);
192 if (!rate_achieved)
193 /* If value is 0 means that clock or parent not valid */
194 return -EINVAL;
195
196 /*
197 * Using ALSA's adjustment control, we can modify the rate to be up
198 * to twice as much as requested, but no more
199 */
200 delta = rate_achieved - rate;
201 if (delta < 0) {
202 /* div64_64 operates on unsigned values... */
203 delta = -delta;
204 adjustment = -1;
205 } else {
206 adjustment = 1;
207 }
208 /* Frequency/2 is added to round up result */
209 adjustment *= (int)div64_u64((uint64_t)delta * 1000000 + rate / 2,
210 rate);
211 player->clk_adj = adjustment;
212 return 0;
213}
214
76c2145d
AP
215static void uni_player_set_channel_status(struct uniperif *player,
216 struct snd_pcm_runtime *runtime)
217{
218 int n;
219 unsigned int status;
220
221 /*
222 * Some AVRs and TVs require the channel status to contain a correct
223 * sampling frequency. If no sample rate is already specified, then
224 * set one.
225 */
36cc0935 226 mutex_lock(&player->ctrl_lock);
0d3f3c9a 227 if (runtime) {
76c2145d
AP
228 switch (runtime->rate) {
229 case 22050:
230 player->stream_settings.iec958.status[3] =
231 IEC958_AES3_CON_FS_22050;
232 break;
233 case 44100:
234 player->stream_settings.iec958.status[3] =
235 IEC958_AES3_CON_FS_44100;
236 break;
237 case 88200:
238 player->stream_settings.iec958.status[3] =
239 IEC958_AES3_CON_FS_88200;
240 break;
241 case 176400:
242 player->stream_settings.iec958.status[3] =
243 IEC958_AES3_CON_FS_176400;
244 break;
245 case 24000:
246 player->stream_settings.iec958.status[3] =
247 IEC958_AES3_CON_FS_24000;
248 break;
249 case 48000:
250 player->stream_settings.iec958.status[3] =
251 IEC958_AES3_CON_FS_48000;
252 break;
253 case 96000:
254 player->stream_settings.iec958.status[3] =
255 IEC958_AES3_CON_FS_96000;
256 break;
257 case 192000:
258 player->stream_settings.iec958.status[3] =
259 IEC958_AES3_CON_FS_192000;
260 break;
261 case 32000:
262 player->stream_settings.iec958.status[3] =
263 IEC958_AES3_CON_FS_32000;
264 break;
265 default:
266 /* Mark as sampling frequency not indicated */
267 player->stream_settings.iec958.status[3] =
268 IEC958_AES3_CON_FS_NOTID;
269 break;
270 }
271 }
272
273 /* Audio mode:
274 * Use audio mode status to select PCM or encoded mode
275 */
276 if (player->stream_settings.iec958.status[0] & IEC958_AES0_NONAUDIO)
277 player->stream_settings.encoding_mode =
278 UNIPERIF_IEC958_ENCODING_MODE_ENCODED;
279 else
280 player->stream_settings.encoding_mode =
281 UNIPERIF_IEC958_ENCODING_MODE_PCM;
282
283 if (player->stream_settings.encoding_mode ==
284 UNIPERIF_IEC958_ENCODING_MODE_PCM)
285 /* Clear user validity bits */
286 SET_UNIPERIF_USER_VALIDITY_VALIDITY_LR(player, 0);
287 else
288 /* Set user validity bits */
289 SET_UNIPERIF_USER_VALIDITY_VALIDITY_LR(player, 1);
290
291 /* Program the new channel status */
292 for (n = 0; n < 6; ++n) {
293 status =
294 player->stream_settings.iec958.status[0 + (n * 4)] & 0xf;
295 status |=
296 player->stream_settings.iec958.status[1 + (n * 4)] << 8;
297 status |=
298 player->stream_settings.iec958.status[2 + (n * 4)] << 16;
299 status |=
300 player->stream_settings.iec958.status[3 + (n * 4)] << 24;
301 SET_UNIPERIF_CHANNEL_STA_REGN(player, n, status);
302 }
36cc0935 303 mutex_unlock(&player->ctrl_lock);
76c2145d
AP
304
305 /* Update the channel status */
306 if (player->ver < SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0)
307 SET_UNIPERIF_CONFIG_CHL_STS_UPDATE(player);
308 else
309 SET_UNIPERIF_BIT_CONTROL_CHL_STS_UPDATE(player);
310}
311
312static int uni_player_prepare_iec958(struct uniperif *player,
313 struct snd_pcm_runtime *runtime)
314{
315 int clk_div;
316
317 clk_div = player->mclk / runtime->rate;
318
319 /* Oversampling must be multiple of 128 as iec958 frame is 32-bits */
320 if ((clk_div % 128) || (clk_div <= 0)) {
748abba8 321 dev_err(player->dev, "%s: invalid clk_div %d\n",
76c2145d
AP
322 __func__, clk_div);
323 return -EINVAL;
324 }
325
326 switch (runtime->format) {
327 case SNDRV_PCM_FORMAT_S16_LE:
328 /* 16/16 memory format */
329 SET_UNIPERIF_CONFIG_MEM_FMT_16_16(player);
330 /* 16-bits per sub-frame */
331 SET_UNIPERIF_I2S_FMT_NBIT_32(player);
332 /* Set 16-bit sample precision */
333 SET_UNIPERIF_I2S_FMT_DATA_SIZE_16(player);
334 break;
335 case SNDRV_PCM_FORMAT_S32_LE:
336 /* 16/0 memory format */
337 SET_UNIPERIF_CONFIG_MEM_FMT_16_0(player);
338 /* 32-bits per sub-frame */
339 SET_UNIPERIF_I2S_FMT_NBIT_32(player);
340 /* Set 24-bit sample precision */
341 SET_UNIPERIF_I2S_FMT_DATA_SIZE_24(player);
342 break;
343 default:
748abba8 344 dev_err(player->dev, "format not supported\n");
76c2145d
AP
345 return -EINVAL;
346 }
347
348 /* Set parity to be calculated by the hardware */
349 SET_UNIPERIF_CONFIG_PARITY_CNTR_BY_HW(player);
350
351 /* Set channel status bits to be inserted by the hardware */
352 SET_UNIPERIF_CONFIG_CHANNEL_STA_CNTR_BY_HW(player);
353
354 /* Set user data bits to be inserted by the hardware */
355 SET_UNIPERIF_CONFIG_USER_DAT_CNTR_BY_HW(player);
356
357 /* Set validity bits to be inserted by the hardware */
358 SET_UNIPERIF_CONFIG_VALIDITY_DAT_CNTR_BY_HW(player);
359
360 /* Set full software control to disabled */
361 SET_UNIPERIF_CONFIG_SPDIF_SW_CTRL_DISABLE(player);
362
363 SET_UNIPERIF_CTRL_ZERO_STUFF_HW(player);
364
365 /* Update the channel status */
366 uni_player_set_channel_status(player, runtime);
367
368 /* Clear the user validity user bits */
369 SET_UNIPERIF_USER_VALIDITY_VALIDITY_LR(player, 0);
370
371 /* Disable one-bit audio mode */
372 SET_UNIPERIF_CONFIG_ONE_BIT_AUD_DISABLE(player);
373
374 /* Enable consecutive frames repetition of Z preamble (not for HBRA) */
375 SET_UNIPERIF_CONFIG_REPEAT_CHL_STS_ENABLE(player);
376
377 /* Change to SUF0_SUBF1 and left/right channels swap! */
378 SET_UNIPERIF_CONFIG_SUBFRAME_SEL_SUBF1_SUBF0(player);
379
380 /* Set data output as MSB first */
381 SET_UNIPERIF_I2S_FMT_ORDER_MSB(player);
382
383 if (player->stream_settings.encoding_mode ==
384 UNIPERIF_IEC958_ENCODING_MODE_ENCODED)
385 SET_UNIPERIF_CTRL_EXIT_STBY_ON_EOBLOCK_ON(player);
386 else
387 SET_UNIPERIF_CTRL_EXIT_STBY_ON_EOBLOCK_OFF(player);
388
389 SET_UNIPERIF_I2S_FMT_NUM_CH(player, runtime->channels / 2);
390
391 /* Set rounding to off */
392 SET_UNIPERIF_CTRL_ROUNDING_OFF(player);
393
394 /* Set clock divisor */
395 SET_UNIPERIF_CTRL_DIVIDER(player, clk_div / 128);
396
397 /* Set the spdif latency to not wait before starting player */
398 SET_UNIPERIF_CTRL_SPDIF_LAT_OFF(player);
399
400 /*
401 * Ensure iec958 formatting is off. It will be enabled in function
402 * uni_player_start() at the same time as the operation
403 * mode is set to work around a silicon issue.
404 */
405 if (player->ver < SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0)
406 SET_UNIPERIF_CTRL_SPDIF_FMT_OFF(player);
407 else
408 SET_UNIPERIF_CTRL_SPDIF_FMT_ON(player);
409
410 return 0;
411}
412
413static int uni_player_prepare_pcm(struct uniperif *player,
414 struct snd_pcm_runtime *runtime)
415{
416 int output_frame_size, slot_width, clk_div;
417
418 /* Force slot width to 32 in I2S mode (HW constraint) */
419 if ((player->daifmt & SND_SOC_DAIFMT_FORMAT_MASK) ==
8d8b1e2e 420 SND_SOC_DAIFMT_I2S)
76c2145d 421 slot_width = 32;
8d8b1e2e
MG
422 else
423 slot_width = snd_pcm_format_width(runtime->format);
424
76c2145d
AP
425 output_frame_size = slot_width * runtime->channels;
426
427 clk_div = player->mclk / runtime->rate;
428 /*
429 * For 32 bits subframe clk_div must be a multiple of 128,
430 * for 16 bits must be a multiple of 64
431 */
432 if ((slot_width == 32) && (clk_div % 128)) {
748abba8 433 dev_err(player->dev, "%s: invalid clk_div\n", __func__);
76c2145d
AP
434 return -EINVAL;
435 }
436
437 if ((slot_width == 16) && (clk_div % 64)) {
748abba8 438 dev_err(player->dev, "%s: invalid clk_div\n", __func__);
76c2145d
AP
439 return -EINVAL;
440 }
441
442 /*
443 * Number of bits per subframe (which is one channel sample)
444 * on output - Transfer 16 or 32 bits from FIFO
445 */
446 switch (slot_width) {
447 case 32:
448 SET_UNIPERIF_I2S_FMT_NBIT_32(player);
449 SET_UNIPERIF_I2S_FMT_DATA_SIZE_32(player);
450 break;
451 case 16:
452 SET_UNIPERIF_I2S_FMT_NBIT_16(player);
453 SET_UNIPERIF_I2S_FMT_DATA_SIZE_16(player);
454 break;
455 default:
748abba8 456 dev_err(player->dev, "subframe format not supported\n");
76c2145d
AP
457 return -EINVAL;
458 }
459
460 /* Configure data memory format */
461 switch (runtime->format) {
462 case SNDRV_PCM_FORMAT_S16_LE:
463 /* One data word contains two samples */
464 SET_UNIPERIF_CONFIG_MEM_FMT_16_16(player);
465 break;
466
467 case SNDRV_PCM_FORMAT_S32_LE:
468 /*
469 * Actually "16 bits/0 bits" means "32/28/24/20/18/16 bits
470 * on the left than zeros (if less than 32 bytes)"... ;-)
471 */
472 SET_UNIPERIF_CONFIG_MEM_FMT_16_0(player);
473 break;
474
475 default:
748abba8 476 dev_err(player->dev, "format not supported\n");
76c2145d
AP
477 return -EINVAL;
478 }
479
480 /* Set rounding to off */
481 SET_UNIPERIF_CTRL_ROUNDING_OFF(player);
482
483 /* Set clock divisor */
484 SET_UNIPERIF_CTRL_DIVIDER(player, clk_div / (2 * output_frame_size));
485
486 /* Number of channelsmust be even*/
487 if ((runtime->channels % 2) || (runtime->channels < 2) ||
488 (runtime->channels > 10)) {
748abba8 489 dev_err(player->dev, "%s: invalid nb of channels\n", __func__);
76c2145d
AP
490 return -EINVAL;
491 }
492
493 SET_UNIPERIF_I2S_FMT_NUM_CH(player, runtime->channels / 2);
494
495 /* Set 1-bit audio format to disabled */
496 SET_UNIPERIF_CONFIG_ONE_BIT_AUD_DISABLE(player);
497
498 SET_UNIPERIF_I2S_FMT_ORDER_MSB(player);
76c2145d
AP
499
500 /* No iec958 formatting as outputting to DAC */
501 SET_UNIPERIF_CTRL_SPDIF_FMT_OFF(player);
502
503 return 0;
504}
505
8d8b1e2e
MG
506static int uni_player_prepare_tdm(struct uniperif *player,
507 struct snd_pcm_runtime *runtime)
508{
509 int tdm_frame_size; /* unip tdm frame size in bytes */
510 int user_frame_size; /* user tdm frame size in bytes */
511 /* default unip TDM_WORD_POS_X_Y */
512 unsigned int word_pos[4] = {
513 0x04060002, 0x0C0E080A, 0x14161012, 0x1C1E181A};
514 int freq, ret;
515
516 tdm_frame_size =
517 sti_uniperiph_get_unip_tdm_frame_size(player);
518 user_frame_size =
519 sti_uniperiph_get_user_frame_size(runtime);
520
521 /* fix 16/0 format */
522 SET_UNIPERIF_CONFIG_MEM_FMT_16_0(player);
523 SET_UNIPERIF_I2S_FMT_DATA_SIZE_32(player);
524
525 /* number of words inserted on the TDM line */
526 SET_UNIPERIF_I2S_FMT_NUM_CH(player, user_frame_size / 4 / 2);
527
528 SET_UNIPERIF_I2S_FMT_ORDER_MSB(player);
529 SET_UNIPERIF_I2S_FMT_ALIGN_LEFT(player);
530
531 /* Enable the tdm functionality */
532 SET_UNIPERIF_TDM_ENABLE_TDM_ENABLE(player);
533
534 /* number of 8 bits timeslots avail in unip tdm frame */
535 SET_UNIPERIF_TDM_FS_REF_DIV_NUM_TIMESLOT(player, tdm_frame_size);
536
537 /* set the timeslot allocation for words in FIFO */
538 sti_uniperiph_get_tdm_word_pos(player, word_pos);
539 SET_UNIPERIF_TDM_WORD_POS(player, 1_2, word_pos[WORD_1_2]);
540 SET_UNIPERIF_TDM_WORD_POS(player, 3_4, word_pos[WORD_3_4]);
541 SET_UNIPERIF_TDM_WORD_POS(player, 5_6, word_pos[WORD_5_6]);
542 SET_UNIPERIF_TDM_WORD_POS(player, 7_8, word_pos[WORD_7_8]);
543
544 /* set unip clk rate (not done vai set_sysclk ops) */
545 freq = runtime->rate * tdm_frame_size * 8;
546 mutex_lock(&player->ctrl_lock);
547 ret = uni_player_clk_set_rate(player, freq);
548 if (!ret)
549 player->mclk = freq;
550 mutex_unlock(&player->ctrl_lock);
551
552 return 0;
553}
554
36cc0935
AP
555/*
556 * ALSA uniperipheral iec958 controls
557 */
558static int uni_player_ctl_iec958_info(struct snd_kcontrol *kcontrol,
559 struct snd_ctl_elem_info *uinfo)
560{
561 uinfo->type = SNDRV_CTL_ELEM_TYPE_IEC958;
562 uinfo->count = 1;
563
564 return 0;
565}
566
567static int uni_player_ctl_iec958_get(struct snd_kcontrol *kcontrol,
568 struct snd_ctl_elem_value *ucontrol)
569{
570 struct snd_soc_dai *dai = snd_kcontrol_chip(kcontrol);
571 struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
572 struct uniperif *player = priv->dai_data.uni;
573 struct snd_aes_iec958 *iec958 = &player->stream_settings.iec958;
574
575 mutex_lock(&player->ctrl_lock);
576 ucontrol->value.iec958.status[0] = iec958->status[0];
577 ucontrol->value.iec958.status[1] = iec958->status[1];
578 ucontrol->value.iec958.status[2] = iec958->status[2];
579 ucontrol->value.iec958.status[3] = iec958->status[3];
580 mutex_unlock(&player->ctrl_lock);
581 return 0;
582}
583
584static int uni_player_ctl_iec958_put(struct snd_kcontrol *kcontrol,
585 struct snd_ctl_elem_value *ucontrol)
586{
587 struct snd_soc_dai *dai = snd_kcontrol_chip(kcontrol);
588 struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
589 struct uniperif *player = priv->dai_data.uni;
590 struct snd_aes_iec958 *iec958 = &player->stream_settings.iec958;
591
592 mutex_lock(&player->ctrl_lock);
593 iec958->status[0] = ucontrol->value.iec958.status[0];
594 iec958->status[1] = ucontrol->value.iec958.status[1];
595 iec958->status[2] = ucontrol->value.iec958.status[2];
596 iec958->status[3] = ucontrol->value.iec958.status[3];
597 mutex_unlock(&player->ctrl_lock);
598
1e6d3044
AP
599 if (player->substream && player->substream->runtime)
600 uni_player_set_channel_status(player,
601 player->substream->runtime);
602 else
603 uni_player_set_channel_status(player, NULL);
36cc0935
AP
604
605 return 0;
606}
607
608static struct snd_kcontrol_new uni_player_iec958_ctl = {
609 .iface = SNDRV_CTL_ELEM_IFACE_PCM,
610 .name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, DEFAULT),
611 .info = uni_player_ctl_iec958_info,
612 .get = uni_player_ctl_iec958_get,
613 .put = uni_player_ctl_iec958_put,
614};
615
fa050796
AP
616/*
617 * uniperif rate adjustement control
618 */
619static int snd_sti_clk_adjustment_info(struct snd_kcontrol *kcontrol,
620 struct snd_ctl_elem_info *uinfo)
621{
622 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
623 uinfo->count = 1;
624 uinfo->value.integer.min = UNIPERIF_PLAYER_CLK_ADJ_MIN;
625 uinfo->value.integer.max = UNIPERIF_PLAYER_CLK_ADJ_MAX;
626 uinfo->value.integer.step = 1;
627
628 return 0;
629}
630
631static int snd_sti_clk_adjustment_get(struct snd_kcontrol *kcontrol,
632 struct snd_ctl_elem_value *ucontrol)
633{
634 struct snd_soc_dai *dai = snd_kcontrol_chip(kcontrol);
635 struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
636 struct uniperif *player = priv->dai_data.uni;
637
36cc0935 638 mutex_lock(&player->ctrl_lock);
fa050796 639 ucontrol->value.integer.value[0] = player->clk_adj;
36cc0935 640 mutex_unlock(&player->ctrl_lock);
fa050796
AP
641
642 return 0;
643}
644
645static int snd_sti_clk_adjustment_put(struct snd_kcontrol *kcontrol,
646 struct snd_ctl_elem_value *ucontrol)
647{
648 struct snd_soc_dai *dai = snd_kcontrol_chip(kcontrol);
649 struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
650 struct uniperif *player = priv->dai_data.uni;
651 int ret = 0;
652
653 if ((ucontrol->value.integer.value[0] < UNIPERIF_PLAYER_CLK_ADJ_MIN) ||
654 (ucontrol->value.integer.value[0] > UNIPERIF_PLAYER_CLK_ADJ_MAX))
655 return -EINVAL;
656
657 mutex_lock(&player->ctrl_lock);
658 player->clk_adj = ucontrol->value.integer.value[0];
659
660 if (player->mclk)
661 ret = uni_player_clk_set_rate(player, player->mclk);
662 mutex_unlock(&player->ctrl_lock);
663
664 return ret;
665}
666
667static struct snd_kcontrol_new uni_player_clk_adj_ctl = {
668 .iface = SNDRV_CTL_ELEM_IFACE_PCM,
669 .name = "PCM Playback Oversampling Freq. Adjustment",
670 .info = snd_sti_clk_adjustment_info,
671 .get = snd_sti_clk_adjustment_get,
672 .put = snd_sti_clk_adjustment_put,
673};
674
36cc0935
AP
675static struct snd_kcontrol_new *snd_sti_pcm_ctl[] = {
676 &uni_player_clk_adj_ctl,
677};
678
679static struct snd_kcontrol_new *snd_sti_iec_ctl[] = {
680 &uni_player_iec958_ctl,
fa050796
AP
681 &uni_player_clk_adj_ctl,
682};
683
684static int uni_player_startup(struct snd_pcm_substream *substream,
685 struct snd_soc_dai *dai)
686{
687 struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
688 struct uniperif *player = priv->dai_data.uni;
8d8b1e2e
MG
689 int ret;
690
36a65e20 691 player->substream = substream;
fa050796
AP
692
693 player->clk_adj = 0;
694
8d8b1e2e
MG
695 if (!UNIPERIF_TYPE_IS_TDM(player))
696 return 0;
697
698 /* refine hw constraint in tdm mode */
699 ret = snd_pcm_hw_rule_add(substream->runtime, 0,
700 SNDRV_PCM_HW_PARAM_CHANNELS,
701 sti_uniperiph_fix_tdm_chan,
702 player, SNDRV_PCM_HW_PARAM_CHANNELS,
703 -1);
704 if (ret < 0)
705 return ret;
706
707 return snd_pcm_hw_rule_add(substream->runtime, 0,
708 SNDRV_PCM_HW_PARAM_FORMAT,
709 sti_uniperiph_fix_tdm_format,
710 player, SNDRV_PCM_HW_PARAM_FORMAT,
711 -1);
fa050796
AP
712}
713
76c2145d
AP
714static int uni_player_set_sysclk(struct snd_soc_dai *dai, int clk_id,
715 unsigned int freq, int dir)
716{
717 struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
718 struct uniperif *player = priv->dai_data.uni;
ed6c75f2 719 int ret;
76c2145d 720
8d8b1e2e 721 if (UNIPERIF_TYPE_IS_TDM(player) || (dir == SND_SOC_CLOCK_IN))
76c2145d
AP
722 return 0;
723
724 if (clk_id != 0)
725 return -EINVAL;
726
fa050796
AP
727 mutex_lock(&player->ctrl_lock);
728 ret = uni_player_clk_set_rate(player, freq);
ed6c75f2
AP
729 if (!ret)
730 player->mclk = freq;
fa050796 731 mutex_unlock(&player->ctrl_lock);
76c2145d 732
ed6c75f2 733 return ret;
76c2145d
AP
734}
735
736static int uni_player_prepare(struct snd_pcm_substream *substream,
737 struct snd_soc_dai *dai)
738{
739 struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
740 struct uniperif *player = priv->dai_data.uni;
741 struct snd_pcm_runtime *runtime = substream->runtime;
742 int transfer_size, trigger_limit;
743 int ret;
744
745 /* The player should be stopped */
746 if (player->state != UNIPERIF_STATE_STOPPED) {
748abba8 747 dev_err(player->dev, "%s: invalid player state %d\n", __func__,
76c2145d
AP
748 player->state);
749 return -EINVAL;
750 }
751
752 /* Calculate transfer size (in fifo cells and bytes) for frame count */
5a4326d1 753 if (player->type == SND_ST_UNIPERIF_TYPE_TDM) {
8d8b1e2e
MG
754 /* transfer size = user frame size (in 32 bits FIFO cell) */
755 transfer_size =
756 sti_uniperiph_get_user_frame_size(runtime) / 4;
757 } else {
758 transfer_size = runtime->channels * UNIPERIF_FIFO_FRAMES;
759 }
76c2145d
AP
760
761 /* Calculate number of empty cells available before asserting DREQ */
762 if (player->ver < SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0) {
763 trigger_limit = UNIPERIF_FIFO_SIZE - transfer_size;
764 } else {
765 /*
766 * Since SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0
767 * FDMA_TRIGGER_LIMIT also controls when the state switches
768 * from OFF or STANDBY to AUDIO DATA.
769 */
770 trigger_limit = transfer_size;
771 }
772
773 /* Trigger limit must be an even number */
774 if ((!trigger_limit % 2) || (trigger_limit != 1 && transfer_size % 2) ||
775 (trigger_limit > UNIPERIF_CONFIG_DMA_TRIG_LIMIT_MASK(player))) {
748abba8
AP
776 dev_err(player->dev, "invalid trigger limit %d\n",
777 trigger_limit);
76c2145d
AP
778 return -EINVAL;
779 }
780
781 SET_UNIPERIF_CONFIG_DMA_TRIG_LIMIT(player, trigger_limit);
782
783 /* Uniperipheral setup depends on player type */
5a4326d1 784 switch (player->type) {
5295a0dc 785 case SND_ST_UNIPERIF_TYPE_HDMI:
76c2145d
AP
786 ret = uni_player_prepare_iec958(player, runtime);
787 break;
5295a0dc 788 case SND_ST_UNIPERIF_TYPE_PCM:
76c2145d
AP
789 ret = uni_player_prepare_pcm(player, runtime);
790 break;
5295a0dc 791 case SND_ST_UNIPERIF_TYPE_SPDIF:
76c2145d
AP
792 ret = uni_player_prepare_iec958(player, runtime);
793 break;
8d8b1e2e
MG
794 case SND_ST_UNIPERIF_TYPE_TDM:
795 ret = uni_player_prepare_tdm(player, runtime);
796 break;
76c2145d 797 default:
748abba8 798 dev_err(player->dev, "invalid player type\n");
76c2145d
AP
799 return -EINVAL;
800 }
801
802 if (ret)
803 return ret;
804
805 switch (player->daifmt & SND_SOC_DAIFMT_INV_MASK) {
806 case SND_SOC_DAIFMT_NB_NF:
807 SET_UNIPERIF_I2S_FMT_LR_POL_LOW(player);
808 SET_UNIPERIF_I2S_FMT_SCLK_EDGE_RISING(player);
809 break;
810 case SND_SOC_DAIFMT_NB_IF:
811 SET_UNIPERIF_I2S_FMT_LR_POL_HIG(player);
812 SET_UNIPERIF_I2S_FMT_SCLK_EDGE_RISING(player);
813 break;
814 case SND_SOC_DAIFMT_IB_NF:
815 SET_UNIPERIF_I2S_FMT_LR_POL_LOW(player);
816 SET_UNIPERIF_I2S_FMT_SCLK_EDGE_FALLING(player);
817 break;
818 case SND_SOC_DAIFMT_IB_IF:
819 SET_UNIPERIF_I2S_FMT_LR_POL_HIG(player);
820 SET_UNIPERIF_I2S_FMT_SCLK_EDGE_FALLING(player);
ed6c75f2 821 break;
76c2145d
AP
822 }
823
824 switch (player->daifmt & SND_SOC_DAIFMT_FORMAT_MASK) {
825 case SND_SOC_DAIFMT_I2S:
826 SET_UNIPERIF_I2S_FMT_ALIGN_LEFT(player);
827 SET_UNIPERIF_I2S_FMT_PADDING_I2S_MODE(player);
828 break;
829 case SND_SOC_DAIFMT_LEFT_J:
830 SET_UNIPERIF_I2S_FMT_ALIGN_LEFT(player);
831 SET_UNIPERIF_I2S_FMT_PADDING_SONY_MODE(player);
832 break;
833 case SND_SOC_DAIFMT_RIGHT_J:
834 SET_UNIPERIF_I2S_FMT_ALIGN_RIGHT(player);
835 SET_UNIPERIF_I2S_FMT_PADDING_SONY_MODE(player);
836 break;
837 default:
748abba8 838 dev_err(player->dev, "format not supported\n");
76c2145d
AP
839 return -EINVAL;
840 }
841
842 SET_UNIPERIF_I2S_FMT_NO_OF_SAMPLES_TO_READ(player, 0);
843
76c2145d 844
4c88f89f 845 return sti_uniperiph_reset(player);
76c2145d
AP
846}
847
848static int uni_player_start(struct uniperif *player)
849{
850 int ret;
851
852 /* The player should be stopped */
853 if (player->state != UNIPERIF_STATE_STOPPED) {
748abba8 854 dev_err(player->dev, "%s: invalid player state\n", __func__);
76c2145d
AP
855 return -EINVAL;
856 }
857
858 ret = clk_prepare_enable(player->clk);
859 if (ret) {
748abba8 860 dev_err(player->dev, "%s: Failed to enable clock\n", __func__);
76c2145d
AP
861 return ret;
862 }
863
864 /* Clear any pending interrupts */
865 SET_UNIPERIF_ITS_BCLR(player, GET_UNIPERIF_ITS(player));
866
867 /* Set the interrupt mask */
868 SET_UNIPERIF_ITM_BSET_DMA_ERROR(player);
869 SET_UNIPERIF_ITM_BSET_FIFO_ERROR(player);
870
871 /* Enable underflow recovery interrupts */
5a4326d1 872 if (player->underflow_enabled) {
76c2145d
AP
873 SET_UNIPERIF_ITM_BSET_UNDERFLOW_REC_DONE(player);
874 SET_UNIPERIF_ITM_BSET_UNDERFLOW_REC_FAILED(player);
875 }
876
4c88f89f 877 ret = sti_uniperiph_reset(player);
b7c8c5d6
WY
878 if (ret < 0) {
879 clk_disable_unprepare(player->clk);
76c2145d 880 return ret;
b7c8c5d6 881 }
76c2145d
AP
882
883 /*
884 * Does not use IEC61937 features of the uniperipheral hardware.
885 * Instead it performs IEC61937 in software and inserts it directly
886 * into the audio data stream. As such, when encoded mode is selected,
887 * linear pcm mode is still used, but with the differences of the
888 * channel status bits set for encoded mode and the validity bits set.
889 */
890 SET_UNIPERIF_CTRL_OPERATION_PCM_DATA(player);
891
892 /*
893 * If iec958 formatting is required for hdmi or spdif, then it must be
894 * enabled after the operation mode is set. If set prior to this, it
895 * will not take affect and hang the player.
896 */
897 if (player->ver < SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0)
5295a0dc
MG
898 if (UNIPERIF_TYPE_IS_IEC958(player))
899 SET_UNIPERIF_CTRL_SPDIF_FMT_ON(player);
76c2145d
AP
900
901 /* Force channel status update (no update if clk disable) */
902 if (player->ver < SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0)
903 SET_UNIPERIF_CONFIG_CHL_STS_UPDATE(player);
904 else
905 SET_UNIPERIF_BIT_CONTROL_CHL_STS_UPDATE(player);
906
907 /* Update state to started */
908 player->state = UNIPERIF_STATE_STARTED;
909
910 return 0;
911}
912
913static int uni_player_stop(struct uniperif *player)
914{
915 int ret;
916
917 /* The player should not be in stopped state */
918 if (player->state == UNIPERIF_STATE_STOPPED) {
748abba8 919 dev_err(player->dev, "%s: invalid player state\n", __func__);
76c2145d
AP
920 return -EINVAL;
921 }
922
923 /* Turn the player off */
924 SET_UNIPERIF_CTRL_OPERATION_OFF(player);
925
4c88f89f 926 ret = sti_uniperiph_reset(player);
76c2145d
AP
927 if (ret < 0)
928 return ret;
929
930 /* Disable interrupts */
931 SET_UNIPERIF_ITM_BCLR(player, GET_UNIPERIF_ITM(player));
932
933 /* Disable clock */
934 clk_disable_unprepare(player->clk);
935
936 /* Update state to stopped and return */
937 player->state = UNIPERIF_STATE_STOPPED;
938
939 return 0;
940}
941
942int uni_player_resume(struct uniperif *player)
943{
944 int ret;
945
946 /* Select the frequency synthesizer clock */
947 if (player->clk_sel) {
948 ret = regmap_field_write(player->clk_sel, 1);
949 if (ret) {
950 dev_err(player->dev,
748abba8 951 "%s: Failed to select freq synth clock\n",
76c2145d
AP
952 __func__);
953 return ret;
954 }
955 }
956
957 SET_UNIPERIF_CONFIG_BACK_STALL_REQ_DISABLE(player);
958 SET_UNIPERIF_CTRL_ROUNDING_OFF(player);
959 SET_UNIPERIF_CTRL_SPDIF_LAT_OFF(player);
960 SET_UNIPERIF_CONFIG_IDLE_MOD_DISABLE(player);
961
962 return 0;
963}
964EXPORT_SYMBOL_GPL(uni_player_resume);
965
966static int uni_player_trigger(struct snd_pcm_substream *substream,
967 int cmd, struct snd_soc_dai *dai)
968{
969 struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
970 struct uniperif *player = priv->dai_data.uni;
971
972 switch (cmd) {
973 case SNDRV_PCM_TRIGGER_START:
974 return uni_player_start(player);
975 case SNDRV_PCM_TRIGGER_STOP:
976 return uni_player_stop(player);
977 case SNDRV_PCM_TRIGGER_RESUME:
978 return uni_player_resume(player);
979 default:
980 return -EINVAL;
981 }
982}
983
984static void uni_player_shutdown(struct snd_pcm_substream *substream,
985 struct snd_soc_dai *dai)
986{
987 struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
988 struct uniperif *player = priv->dai_data.uni;
989
990 if (player->state != UNIPERIF_STATE_STOPPED)
991 /* Stop the player */
992 uni_player_stop(player);
36a65e20
MG
993
994 player->substream = NULL;
76c2145d
AP
995}
996
3ee15cac
MG
997static int uni_player_parse_dt_audio_glue(struct platform_device *pdev,
998 struct uniperif *player)
76c2145d 999{
76c2145d
AP
1000 struct device_node *node = pdev->dev.of_node;
1001 struct regmap *regmap;
3ee15cac
MG
1002 struct reg_field regfield[2] = {
1003 /* PCM_CLK_SEL */
1004 REG_FIELD(SYS_CFG_AUDIO_GLUE,
5a4326d1
AP
1005 8 + player->id,
1006 8 + player->id),
3ee15cac
MG
1007 /* PCMP_VALID_SEL */
1008 REG_FIELD(SYS_CFG_AUDIO_GLUE, 0, 1)
1009 };
76c2145d
AP
1010
1011 regmap = syscon_regmap_lookup_by_phandle(node, "st,syscfg");
1012
7d267ddf 1013 if (IS_ERR(regmap)) {
76c2145d 1014 dev_err(&pdev->dev, "sti-audio-clk-glue syscf not found\n");
7d267ddf 1015 return PTR_ERR(regmap);
76c2145d
AP
1016 }
1017
3ee15cac
MG
1018 player->clk_sel = regmap_field_alloc(regmap, regfield[0]);
1019 player->valid_sel = regmap_field_alloc(regmap, regfield[1]);
1020
76c2145d
AP
1021 return 0;
1022}
1023
85cf604e 1024static const struct snd_soc_dai_ops uni_player_dai_ops = {
fa050796 1025 .startup = uni_player_startup,
76c2145d
AP
1026 .shutdown = uni_player_shutdown,
1027 .prepare = uni_player_prepare,
1028 .trigger = uni_player_trigger,
1029 .hw_params = sti_uniperiph_dai_hw_params,
1030 .set_fmt = sti_uniperiph_dai_set_fmt,
8d8b1e2e
MG
1031 .set_sysclk = uni_player_set_sysclk,
1032 .set_tdm_slot = sti_uniperiph_set_tdm_slot
76c2145d
AP
1033};
1034
1035int uni_player_init(struct platform_device *pdev,
1036 struct uniperif *player)
1037{
1038 int ret = 0;
1039
1040 player->dev = &pdev->dev;
1041 player->state = UNIPERIF_STATE_STOPPED;
76c2145d
AP
1042 player->dai_ops = &uni_player_dai_ops;
1043
5a4326d1
AP
1044 /* Get PCM_CLK_SEL & PCMP_VALID_SEL from audio-glue-ctrl SoC reg */
1045 ret = uni_player_parse_dt_audio_glue(pdev, player);
76c2145d
AP
1046
1047 if (ret < 0) {
748abba8 1048 dev_err(player->dev, "Failed to parse DeviceTree\n");
76c2145d
AP
1049 return ret;
1050 }
1051
5a4326d1
AP
1052 /* Underflow recovery is only supported on later ip revisions */
1053 if (player->ver >= SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0)
1054 player->underflow_enabled = 1;
1055
8d8b1e2e
MG
1056 if (UNIPERIF_TYPE_IS_TDM(player))
1057 player->hw = &uni_tdm_hw;
1058 else
1059 player->hw = &uni_player_pcm_hw;
1060
76c2145d
AP
1061 /* Get uniperif resource */
1062 player->clk = of_clk_get(pdev->dev.of_node, 0);
748abba8
AP
1063 if (IS_ERR(player->clk)) {
1064 dev_err(player->dev, "Failed to get clock\n");
ed6c75f2 1065 ret = PTR_ERR(player->clk);
748abba8 1066 }
76c2145d
AP
1067
1068 /* Select the frequency synthesizer clock */
1069 if (player->clk_sel) {
1070 ret = regmap_field_write(player->clk_sel, 1);
1071 if (ret) {
1072 dev_err(player->dev,
748abba8 1073 "%s: Failed to select freq synth clock\n",
76c2145d
AP
1074 __func__);
1075 return ret;
1076 }
1077 }
1078
3ee15cac
MG
1079 /* connect to I2S/TDM TX bus */
1080 if (player->valid_sel &&
5a4326d1
AP
1081 (player->id == UNIPERIF_PLAYER_I2S_OUT)) {
1082 ret = regmap_field_write(player->valid_sel, player->id);
3ee15cac
MG
1083 if (ret) {
1084 dev_err(player->dev,
748abba8 1085 "%s: unable to connect to tdm bus\n", __func__);
3ee15cac
MG
1086 return ret;
1087 }
1088 }
1089
76c2145d
AP
1090 ret = devm_request_irq(&pdev->dev, player->irq,
1091 uni_player_irq_handler, IRQF_SHARED,
1092 dev_name(&pdev->dev), player);
748abba8
AP
1093 if (ret < 0) {
1094 dev_err(player->dev, "unable to request IRQ %d\n", player->irq);
76c2145d 1095 return ret;
748abba8 1096 }
76c2145d 1097
fa050796
AP
1098 mutex_init(&player->ctrl_lock);
1099
76c2145d
AP
1100 /* Ensure that disabled by default */
1101 SET_UNIPERIF_CONFIG_BACK_STALL_REQ_DISABLE(player);
1102 SET_UNIPERIF_CTRL_ROUNDING_OFF(player);
1103 SET_UNIPERIF_CTRL_SPDIF_LAT_OFF(player);
1104 SET_UNIPERIF_CONFIG_IDLE_MOD_DISABLE(player);
1105
5295a0dc 1106 if (UNIPERIF_TYPE_IS_IEC958(player)) {
76c2145d
AP
1107 /* Set default iec958 status bits */
1108
1109 /* Consumer, PCM, copyright, 2ch, mode 0 */
1110 player->stream_settings.iec958.status[0] = 0x00;
1111 /* Broadcast reception category */
1112 player->stream_settings.iec958.status[1] =
1113 IEC958_AES1_CON_GENERAL;
1114 /* Do not take into account source or channel number */
1115 player->stream_settings.iec958.status[2] =
1116 IEC958_AES2_CON_SOURCE_UNSPEC;
1117 /* Sampling frequency not indicated */
1118 player->stream_settings.iec958.status[3] =
1119 IEC958_AES3_CON_FS_NOTID;
1120 /* Max sample word 24-bit, sample word length not indicated */
1121 player->stream_settings.iec958.status[4] =
1122 IEC958_AES4_CON_MAX_WORDLEN_24 |
1123 IEC958_AES4_CON_WORDLEN_24_20;
76c2145d 1124
36cc0935
AP
1125 player->num_ctrls = ARRAY_SIZE(snd_sti_iec_ctl);
1126 player->snd_ctrls = snd_sti_iec_ctl[0];
1127 } else {
1128 player->num_ctrls = ARRAY_SIZE(snd_sti_pcm_ctl);
1129 player->snd_ctrls = snd_sti_pcm_ctl[0];
1130 }
fa050796 1131
76c2145d
AP
1132 return 0;
1133}
1134EXPORT_SYMBOL_GPL(uni_player_init);