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