xref: /linux/sound/soc/sti/uniperif_player.c (revision 377773dd6be500d17b94de08271ff9ed643554f1)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (C) STMicroelectronics SA 2015
4  * Authors: Arnaud Pouliquen <arnaud.pouliquen@st.com>
5  *          for STMicroelectronics.
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  */
uni_player_irq_handler(int irq,void * dev_id)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 
uni_player_clk_set_rate(struct uniperif * player,unsigned long rate)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 
uni_player_set_channel_status(struct uniperif * player,struct snd_pcm_runtime * runtime)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 	if (runtime) {
230 		switch (runtime->rate) {
231 		case 22050:
232 			player->stream_settings.iec958.status[3] =
233 						IEC958_AES3_CON_FS_22050;
234 			break;
235 		case 44100:
236 			player->stream_settings.iec958.status[3] =
237 						IEC958_AES3_CON_FS_44100;
238 			break;
239 		case 88200:
240 			player->stream_settings.iec958.status[3] =
241 						IEC958_AES3_CON_FS_88200;
242 			break;
243 		case 176400:
244 			player->stream_settings.iec958.status[3] =
245 						IEC958_AES3_CON_FS_176400;
246 			break;
247 		case 24000:
248 			player->stream_settings.iec958.status[3] =
249 						IEC958_AES3_CON_FS_24000;
250 			break;
251 		case 48000:
252 			player->stream_settings.iec958.status[3] =
253 						IEC958_AES3_CON_FS_48000;
254 			break;
255 		case 96000:
256 			player->stream_settings.iec958.status[3] =
257 						IEC958_AES3_CON_FS_96000;
258 			break;
259 		case 192000:
260 			player->stream_settings.iec958.status[3] =
261 						IEC958_AES3_CON_FS_192000;
262 			break;
263 		case 32000:
264 			player->stream_settings.iec958.status[3] =
265 						IEC958_AES3_CON_FS_32000;
266 			break;
267 		default:
268 			/* Mark as sampling frequency not indicated */
269 			player->stream_settings.iec958.status[3] =
270 						IEC958_AES3_CON_FS_NOTID;
271 			break;
272 		}
273 	}
274 
275 	/* Audio mode:
276 	 * Use audio mode status to select PCM or encoded mode
277 	 */
278 	if (player->stream_settings.iec958.status[0] & IEC958_AES0_NONAUDIO)
279 		player->stream_settings.encoding_mode =
280 			UNIPERIF_IEC958_ENCODING_MODE_ENCODED;
281 	else
282 		player->stream_settings.encoding_mode =
283 			UNIPERIF_IEC958_ENCODING_MODE_PCM;
284 
285 	if (player->stream_settings.encoding_mode ==
286 		UNIPERIF_IEC958_ENCODING_MODE_PCM)
287 		/* Clear user validity bits */
288 		SET_UNIPERIF_USER_VALIDITY_VALIDITY_LR(player, 0);
289 	else
290 		/* Set user validity bits */
291 		SET_UNIPERIF_USER_VALIDITY_VALIDITY_LR(player, 1);
292 
293 	/* Program the new channel status */
294 	for (n = 0; n < 6; ++n) {
295 		status  =
296 		player->stream_settings.iec958.status[0 + (n * 4)] & 0xf;
297 		status |=
298 		player->stream_settings.iec958.status[1 + (n * 4)] << 8;
299 		status |=
300 		player->stream_settings.iec958.status[2 + (n * 4)] << 16;
301 		status |=
302 		player->stream_settings.iec958.status[3 + (n * 4)] << 24;
303 		SET_UNIPERIF_CHANNEL_STA_REGN(player, n, status);
304 	}
305 
306 	/* Update the channel status */
307 	if (player->ver < SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0)
308 		SET_UNIPERIF_CONFIG_CHL_STS_UPDATE(player);
309 	else
310 		SET_UNIPERIF_BIT_CONTROL_CHL_STS_UPDATE(player);
311 }
312 
uni_player_prepare_iec958(struct uniperif * player,struct snd_pcm_runtime * runtime)313 static int uni_player_prepare_iec958(struct uniperif *player,
314 				     struct snd_pcm_runtime *runtime)
315 {
316 	int clk_div;
317 
318 	clk_div = player->mclk / runtime->rate;
319 
320 	/* Oversampling must be multiple of 128 as iec958 frame is 32-bits */
321 	if ((clk_div % 128) || (clk_div <= 0)) {
322 		dev_err(player->dev, "%s: invalid clk_div %d\n",
323 			__func__, clk_div);
324 		return -EINVAL;
325 	}
326 
327 	switch (runtime->format) {
328 	case SNDRV_PCM_FORMAT_S16_LE:
329 		/* 16/16 memory format */
330 		SET_UNIPERIF_CONFIG_MEM_FMT_16_16(player);
331 		/* 16-bits per sub-frame */
332 		SET_UNIPERIF_I2S_FMT_NBIT_32(player);
333 		/* Set 16-bit sample precision */
334 		SET_UNIPERIF_I2S_FMT_DATA_SIZE_16(player);
335 		break;
336 	case SNDRV_PCM_FORMAT_S32_LE:
337 		/* 16/0 memory format */
338 		SET_UNIPERIF_CONFIG_MEM_FMT_16_0(player);
339 		/* 32-bits per sub-frame */
340 		SET_UNIPERIF_I2S_FMT_NBIT_32(player);
341 		/* Set 24-bit sample precision */
342 		SET_UNIPERIF_I2S_FMT_DATA_SIZE_24(player);
343 		break;
344 	default:
345 		dev_err(player->dev, "format not supported\n");
346 		return -EINVAL;
347 	}
348 
349 	/* Set parity to be calculated by the hardware */
350 	SET_UNIPERIF_CONFIG_PARITY_CNTR_BY_HW(player);
351 
352 	/* Set channel status bits to be inserted by the hardware */
353 	SET_UNIPERIF_CONFIG_CHANNEL_STA_CNTR_BY_HW(player);
354 
355 	/* Set user data bits to be inserted by the hardware */
356 	SET_UNIPERIF_CONFIG_USER_DAT_CNTR_BY_HW(player);
357 
358 	/* Set validity bits to be inserted by the hardware */
359 	SET_UNIPERIF_CONFIG_VALIDITY_DAT_CNTR_BY_HW(player);
360 
361 	/* Set full software control to disabled */
362 	SET_UNIPERIF_CONFIG_SPDIF_SW_CTRL_DISABLE(player);
363 
364 	SET_UNIPERIF_CTRL_ZERO_STUFF_HW(player);
365 
366 	mutex_lock(&player->ctrl_lock);
367 	/* Update the channel status */
368 	uni_player_set_channel_status(player, runtime);
369 	mutex_unlock(&player->ctrl_lock);
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 
uni_player_prepare_pcm(struct uniperif * player,struct snd_pcm_runtime * runtime)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 
uni_player_prepare_tdm(struct uniperif * player,struct snd_pcm_runtime * runtime)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  */
uni_player_ctl_iec958_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)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 
uni_player_ctl_iec958_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)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 
uni_player_ctl_iec958_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)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 
602 	spin_lock_irqsave(&player->irq_lock, flags);
603 	if (player->substream && player->substream->runtime)
604 		uni_player_set_channel_status(player,
605 					      player->substream->runtime);
606 	else
607 		uni_player_set_channel_status(player, NULL);
608 
609 	spin_unlock_irqrestore(&player->irq_lock, flags);
610 	mutex_unlock(&player->ctrl_lock);
611 
612 	return 0;
613 }
614 
615 static struct snd_kcontrol_new uni_player_iec958_ctl = {
616 	.iface = SNDRV_CTL_ELEM_IFACE_PCM,
617 	.name = SNDRV_CTL_NAME_IEC958("", PLAYBACK, DEFAULT),
618 	.info = uni_player_ctl_iec958_info,
619 	.get = uni_player_ctl_iec958_get,
620 	.put = uni_player_ctl_iec958_put,
621 };
622 
623 /*
624  * uniperif rate adjustement control
625  */
snd_sti_clk_adjustment_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)626 static int snd_sti_clk_adjustment_info(struct snd_kcontrol *kcontrol,
627 				       struct snd_ctl_elem_info *uinfo)
628 {
629 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
630 	uinfo->count = 1;
631 	uinfo->value.integer.min = UNIPERIF_PLAYER_CLK_ADJ_MIN;
632 	uinfo->value.integer.max = UNIPERIF_PLAYER_CLK_ADJ_MAX;
633 	uinfo->value.integer.step = 1;
634 
635 	return 0;
636 }
637 
snd_sti_clk_adjustment_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)638 static int snd_sti_clk_adjustment_get(struct snd_kcontrol *kcontrol,
639 				      struct snd_ctl_elem_value *ucontrol)
640 {
641 	struct snd_soc_dai *dai = snd_kcontrol_chip(kcontrol);
642 	struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
643 	struct uniperif *player = priv->dai_data.uni;
644 
645 	mutex_lock(&player->ctrl_lock);
646 	ucontrol->value.integer.value[0] = player->clk_adj;
647 	mutex_unlock(&player->ctrl_lock);
648 
649 	return 0;
650 }
651 
snd_sti_clk_adjustment_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)652 static int snd_sti_clk_adjustment_put(struct snd_kcontrol *kcontrol,
653 				      struct snd_ctl_elem_value *ucontrol)
654 {
655 	struct snd_soc_dai *dai = snd_kcontrol_chip(kcontrol);
656 	struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
657 	struct uniperif *player = priv->dai_data.uni;
658 	int ret = 0;
659 
660 	if ((ucontrol->value.integer.value[0] < UNIPERIF_PLAYER_CLK_ADJ_MIN) ||
661 	    (ucontrol->value.integer.value[0] > UNIPERIF_PLAYER_CLK_ADJ_MAX))
662 		return -EINVAL;
663 
664 	mutex_lock(&player->ctrl_lock);
665 	player->clk_adj = ucontrol->value.integer.value[0];
666 
667 	if (player->mclk)
668 		ret = uni_player_clk_set_rate(player, player->mclk);
669 	mutex_unlock(&player->ctrl_lock);
670 
671 	return ret;
672 }
673 
674 static struct snd_kcontrol_new uni_player_clk_adj_ctl = {
675 	.iface = SNDRV_CTL_ELEM_IFACE_PCM,
676 	.name = "PCM Playback Oversampling Freq. Adjustment",
677 	.info = snd_sti_clk_adjustment_info,
678 	.get = snd_sti_clk_adjustment_get,
679 	.put = snd_sti_clk_adjustment_put,
680 };
681 
682 static struct snd_kcontrol_new *snd_sti_pcm_ctl[] = {
683 	&uni_player_clk_adj_ctl,
684 };
685 
686 static struct snd_kcontrol_new *snd_sti_iec_ctl[] = {
687 	&uni_player_iec958_ctl,
688 	&uni_player_clk_adj_ctl,
689 };
690 
uni_player_startup(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)691 static int uni_player_startup(struct snd_pcm_substream *substream,
692 			      struct snd_soc_dai *dai)
693 {
694 	struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
695 	struct uniperif *player = priv->dai_data.uni;
696 	unsigned long flags;
697 	int ret;
698 
699 	spin_lock_irqsave(&player->irq_lock, flags);
700 	player->substream = substream;
701 	spin_unlock_irqrestore(&player->irq_lock, flags);
702 
703 	player->clk_adj = 0;
704 
705 	if (!UNIPERIF_TYPE_IS_TDM(player))
706 		return 0;
707 
708 	/* refine hw constraint in tdm mode */
709 	ret = snd_pcm_hw_rule_add(substream->runtime, 0,
710 				  SNDRV_PCM_HW_PARAM_CHANNELS,
711 				  sti_uniperiph_fix_tdm_chan,
712 				  player, SNDRV_PCM_HW_PARAM_CHANNELS,
713 				  -1);
714 	if (ret < 0)
715 		return ret;
716 
717 	return snd_pcm_hw_rule_add(substream->runtime, 0,
718 				   SNDRV_PCM_HW_PARAM_FORMAT,
719 				   sti_uniperiph_fix_tdm_format,
720 				   player, SNDRV_PCM_HW_PARAM_FORMAT,
721 				   -1);
722 }
723 
uni_player_set_sysclk(struct snd_soc_dai * dai,int clk_id,unsigned int freq,int dir)724 static int uni_player_set_sysclk(struct snd_soc_dai *dai, int clk_id,
725 				 unsigned int freq, int dir)
726 {
727 	struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
728 	struct uniperif *player = priv->dai_data.uni;
729 	int ret;
730 
731 	if (UNIPERIF_TYPE_IS_TDM(player) || (dir == SND_SOC_CLOCK_IN))
732 		return 0;
733 
734 	if (clk_id != 0)
735 		return -EINVAL;
736 
737 	mutex_lock(&player->ctrl_lock);
738 	ret = uni_player_clk_set_rate(player, freq);
739 	if (!ret)
740 		player->mclk = freq;
741 	mutex_unlock(&player->ctrl_lock);
742 
743 	return ret;
744 }
745 
uni_player_prepare(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)746 static int uni_player_prepare(struct snd_pcm_substream *substream,
747 			      struct snd_soc_dai *dai)
748 {
749 	struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
750 	struct uniperif *player = priv->dai_data.uni;
751 	struct snd_pcm_runtime *runtime = substream->runtime;
752 	int transfer_size, trigger_limit;
753 	int ret;
754 
755 	/* The player should be stopped */
756 	if (player->state != UNIPERIF_STATE_STOPPED) {
757 		dev_err(player->dev, "%s: invalid player state %d\n", __func__,
758 			player->state);
759 		return -EINVAL;
760 	}
761 
762 	/* Calculate transfer size (in fifo cells and bytes) for frame count */
763 	if (player->type == SND_ST_UNIPERIF_TYPE_TDM) {
764 		/* transfer size = user frame size (in 32 bits FIFO cell) */
765 		transfer_size =
766 			sti_uniperiph_get_user_frame_size(runtime) / 4;
767 	} else {
768 		transfer_size = runtime->channels * UNIPERIF_FIFO_FRAMES;
769 	}
770 
771 	/* Calculate number of empty cells available before asserting DREQ */
772 	if (player->ver < SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0) {
773 		trigger_limit = UNIPERIF_FIFO_SIZE - transfer_size;
774 	} else {
775 		/*
776 		 * Since SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0
777 		 * FDMA_TRIGGER_LIMIT also controls when the state switches
778 		 * from OFF or STANDBY to AUDIO DATA.
779 		 */
780 		trigger_limit = transfer_size;
781 	}
782 
783 	/* Trigger limit must be an even number */
784 	if ((!trigger_limit % 2) || (trigger_limit != 1 && transfer_size % 2) ||
785 	    (trigger_limit > UNIPERIF_CONFIG_DMA_TRIG_LIMIT_MASK(player))) {
786 		dev_err(player->dev, "invalid trigger limit %d\n",
787 			trigger_limit);
788 		return -EINVAL;
789 	}
790 
791 	SET_UNIPERIF_CONFIG_DMA_TRIG_LIMIT(player, trigger_limit);
792 
793 	/* Uniperipheral setup depends on player type */
794 	switch (player->type) {
795 	case SND_ST_UNIPERIF_TYPE_HDMI:
796 		ret = uni_player_prepare_iec958(player, runtime);
797 		break;
798 	case SND_ST_UNIPERIF_TYPE_PCM:
799 		ret = uni_player_prepare_pcm(player, runtime);
800 		break;
801 	case SND_ST_UNIPERIF_TYPE_SPDIF:
802 		ret = uni_player_prepare_iec958(player, runtime);
803 		break;
804 	case SND_ST_UNIPERIF_TYPE_TDM:
805 		ret = uni_player_prepare_tdm(player, runtime);
806 		break;
807 	default:
808 		dev_err(player->dev, "invalid player type\n");
809 		return -EINVAL;
810 	}
811 
812 	if (ret)
813 		return ret;
814 
815 	switch (player->daifmt & SND_SOC_DAIFMT_INV_MASK) {
816 	case SND_SOC_DAIFMT_NB_NF:
817 		SET_UNIPERIF_I2S_FMT_LR_POL_LOW(player);
818 		SET_UNIPERIF_I2S_FMT_SCLK_EDGE_RISING(player);
819 		break;
820 	case SND_SOC_DAIFMT_NB_IF:
821 		SET_UNIPERIF_I2S_FMT_LR_POL_HIG(player);
822 		SET_UNIPERIF_I2S_FMT_SCLK_EDGE_RISING(player);
823 		break;
824 	case SND_SOC_DAIFMT_IB_NF:
825 		SET_UNIPERIF_I2S_FMT_LR_POL_LOW(player);
826 		SET_UNIPERIF_I2S_FMT_SCLK_EDGE_FALLING(player);
827 		break;
828 	case SND_SOC_DAIFMT_IB_IF:
829 		SET_UNIPERIF_I2S_FMT_LR_POL_HIG(player);
830 		SET_UNIPERIF_I2S_FMT_SCLK_EDGE_FALLING(player);
831 		break;
832 	}
833 
834 	switch (player->daifmt & SND_SOC_DAIFMT_FORMAT_MASK) {
835 	case SND_SOC_DAIFMT_I2S:
836 		SET_UNIPERIF_I2S_FMT_ALIGN_LEFT(player);
837 		SET_UNIPERIF_I2S_FMT_PADDING_I2S_MODE(player);
838 		break;
839 	case SND_SOC_DAIFMT_LEFT_J:
840 		SET_UNIPERIF_I2S_FMT_ALIGN_LEFT(player);
841 		SET_UNIPERIF_I2S_FMT_PADDING_SONY_MODE(player);
842 		break;
843 	case SND_SOC_DAIFMT_RIGHT_J:
844 		SET_UNIPERIF_I2S_FMT_ALIGN_RIGHT(player);
845 		SET_UNIPERIF_I2S_FMT_PADDING_SONY_MODE(player);
846 		break;
847 	default:
848 		dev_err(player->dev, "format not supported\n");
849 		return -EINVAL;
850 	}
851 
852 	SET_UNIPERIF_I2S_FMT_NO_OF_SAMPLES_TO_READ(player, 0);
853 
854 
855 	return sti_uniperiph_reset(player);
856 }
857 
uni_player_start(struct uniperif * player)858 static int uni_player_start(struct uniperif *player)
859 {
860 	int ret;
861 
862 	/* The player should be stopped */
863 	if (player->state != UNIPERIF_STATE_STOPPED) {
864 		dev_err(player->dev, "%s: invalid player state\n", __func__);
865 		return -EINVAL;
866 	}
867 
868 	ret = clk_prepare_enable(player->clk);
869 	if (ret) {
870 		dev_err(player->dev, "%s: Failed to enable clock\n", __func__);
871 		return ret;
872 	}
873 
874 	/* Clear any pending interrupts */
875 	SET_UNIPERIF_ITS_BCLR(player, GET_UNIPERIF_ITS(player));
876 
877 	/* Set the interrupt mask */
878 	SET_UNIPERIF_ITM_BSET_DMA_ERROR(player);
879 	SET_UNIPERIF_ITM_BSET_FIFO_ERROR(player);
880 
881 	/* Enable underflow recovery interrupts */
882 	if (player->underflow_enabled) {
883 		SET_UNIPERIF_ITM_BSET_UNDERFLOW_REC_DONE(player);
884 		SET_UNIPERIF_ITM_BSET_UNDERFLOW_REC_FAILED(player);
885 	}
886 
887 	ret = sti_uniperiph_reset(player);
888 	if (ret < 0) {
889 		clk_disable_unprepare(player->clk);
890 		return ret;
891 	}
892 
893 	/*
894 	 * Does not use IEC61937 features of the uniperipheral hardware.
895 	 * Instead it performs IEC61937 in software and inserts it directly
896 	 * into the audio data stream. As such, when encoded mode is selected,
897 	 * linear pcm mode is still used, but with the differences of the
898 	 * channel status bits set for encoded mode and the validity bits set.
899 	 */
900 	SET_UNIPERIF_CTRL_OPERATION_PCM_DATA(player);
901 
902 	/*
903 	 * If iec958 formatting is required for hdmi or spdif, then it must be
904 	 * enabled after the operation mode is set. If set prior to this, it
905 	 * will not take affect and hang the player.
906 	 */
907 	if (player->ver < SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0)
908 		if (UNIPERIF_TYPE_IS_IEC958(player))
909 			SET_UNIPERIF_CTRL_SPDIF_FMT_ON(player);
910 
911 	/* Force channel status update (no update if clk disable) */
912 	if (player->ver < SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0)
913 		SET_UNIPERIF_CONFIG_CHL_STS_UPDATE(player);
914 	else
915 		SET_UNIPERIF_BIT_CONTROL_CHL_STS_UPDATE(player);
916 
917 	/* Update state to started */
918 	player->state = UNIPERIF_STATE_STARTED;
919 
920 	return 0;
921 }
922 
uni_player_stop(struct uniperif * player)923 static int uni_player_stop(struct uniperif *player)
924 {
925 	int ret;
926 
927 	/* The player should not be in stopped state */
928 	if (player->state == UNIPERIF_STATE_STOPPED) {
929 		dev_err(player->dev, "%s: invalid player state\n", __func__);
930 		return -EINVAL;
931 	}
932 
933 	/* Turn the player off */
934 	SET_UNIPERIF_CTRL_OPERATION_OFF(player);
935 
936 	ret = sti_uniperiph_reset(player);
937 	if (ret < 0)
938 		return ret;
939 
940 	/* Disable interrupts */
941 	SET_UNIPERIF_ITM_BCLR(player, GET_UNIPERIF_ITM(player));
942 
943 	/* Disable clock */
944 	clk_disable_unprepare(player->clk);
945 
946 	/* Update state to stopped and return */
947 	player->state = UNIPERIF_STATE_STOPPED;
948 
949 	return 0;
950 }
951 
uni_player_resume(struct uniperif * player)952 int uni_player_resume(struct uniperif *player)
953 {
954 	int ret;
955 
956 	/* Select the frequency synthesizer clock */
957 	if (player->clk_sel) {
958 		ret = regmap_field_write(player->clk_sel, 1);
959 		if (ret) {
960 			dev_err(player->dev,
961 				"%s: Failed to select freq synth clock\n",
962 				__func__);
963 			return ret;
964 		}
965 	}
966 
967 	SET_UNIPERIF_CONFIG_BACK_STALL_REQ_DISABLE(player);
968 	SET_UNIPERIF_CTRL_ROUNDING_OFF(player);
969 	SET_UNIPERIF_CTRL_SPDIF_LAT_OFF(player);
970 	SET_UNIPERIF_CONFIG_IDLE_MOD_DISABLE(player);
971 
972 	return 0;
973 }
974 EXPORT_SYMBOL_GPL(uni_player_resume);
975 
uni_player_trigger(struct snd_pcm_substream * substream,int cmd,struct snd_soc_dai * dai)976 static int uni_player_trigger(struct snd_pcm_substream *substream,
977 			      int cmd, struct snd_soc_dai *dai)
978 {
979 	struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
980 	struct uniperif *player = priv->dai_data.uni;
981 
982 	switch (cmd) {
983 	case SNDRV_PCM_TRIGGER_START:
984 		return uni_player_start(player);
985 	case SNDRV_PCM_TRIGGER_STOP:
986 		return uni_player_stop(player);
987 	case SNDRV_PCM_TRIGGER_RESUME:
988 		return uni_player_resume(player);
989 	default:
990 		return -EINVAL;
991 	}
992 }
993 
uni_player_shutdown(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)994 static void uni_player_shutdown(struct snd_pcm_substream *substream,
995 				struct snd_soc_dai *dai)
996 {
997 	struct sti_uniperiph_data *priv = snd_soc_dai_get_drvdata(dai);
998 	struct uniperif *player = priv->dai_data.uni;
999 	unsigned long flags;
1000 
1001 	spin_lock_irqsave(&player->irq_lock, flags);
1002 	if (player->state != UNIPERIF_STATE_STOPPED)
1003 		/* Stop the player */
1004 		uni_player_stop(player);
1005 
1006 	player->substream = NULL;
1007 	spin_unlock_irqrestore(&player->irq_lock, flags);
1008 }
1009 
uni_player_parse_dt_audio_glue(struct platform_device * pdev,struct uniperif * player)1010 static int uni_player_parse_dt_audio_glue(struct platform_device *pdev,
1011 					  struct uniperif *player)
1012 {
1013 	struct device_node *node = pdev->dev.of_node;
1014 	struct regmap *regmap;
1015 	struct reg_field regfield[2] = {
1016 		/* PCM_CLK_SEL */
1017 		REG_FIELD(SYS_CFG_AUDIO_GLUE,
1018 			  8 + player->id,
1019 			  8 + player->id),
1020 		/* PCMP_VALID_SEL */
1021 		REG_FIELD(SYS_CFG_AUDIO_GLUE, 0, 1)
1022 	};
1023 
1024 	regmap = syscon_regmap_lookup_by_phandle(node, "st,syscfg");
1025 
1026 	if (IS_ERR(regmap)) {
1027 		dev_err(&pdev->dev, "sti-audio-clk-glue syscf not found\n");
1028 		return PTR_ERR(regmap);
1029 	}
1030 
1031 	player->clk_sel = regmap_field_alloc(regmap, regfield[0]);
1032 	player->valid_sel = regmap_field_alloc(regmap, regfield[1]);
1033 
1034 	return 0;
1035 }
1036 
1037 static const struct snd_soc_dai_ops uni_player_dai_ops = {
1038 		.startup = uni_player_startup,
1039 		.shutdown = uni_player_shutdown,
1040 		.prepare = uni_player_prepare,
1041 		.probe = sti_uniperiph_dai_probe,
1042 		.trigger = uni_player_trigger,
1043 		.hw_params = sti_uniperiph_dai_hw_params,
1044 		.set_fmt = sti_uniperiph_dai_set_fmt,
1045 		.set_sysclk = uni_player_set_sysclk,
1046 		.set_tdm_slot = sti_uniperiph_set_tdm_slot
1047 };
1048 
uni_player_init(struct platform_device * pdev,struct uniperif * player)1049 int uni_player_init(struct platform_device *pdev,
1050 		    struct uniperif *player)
1051 {
1052 	int ret = 0;
1053 
1054 	player->dev = &pdev->dev;
1055 	player->state = UNIPERIF_STATE_STOPPED;
1056 	player->dai_ops = &uni_player_dai_ops;
1057 
1058 	/* Get PCM_CLK_SEL & PCMP_VALID_SEL from audio-glue-ctrl SoC reg */
1059 	ret = uni_player_parse_dt_audio_glue(pdev, player);
1060 
1061 	if (ret < 0) {
1062 		dev_err(player->dev, "Failed to parse DeviceTree\n");
1063 		return ret;
1064 	}
1065 
1066 	/* Underflow recovery is only supported on later ip revisions */
1067 	if (player->ver >= SND_ST_UNIPERIF_VERSION_UNI_PLR_TOP_1_0)
1068 		player->underflow_enabled = 1;
1069 
1070 	if (UNIPERIF_TYPE_IS_TDM(player))
1071 		player->hw = &uni_tdm_hw;
1072 	else
1073 		player->hw = &uni_player_pcm_hw;
1074 
1075 	/* Get uniperif resource */
1076 	player->clk = of_clk_get(pdev->dev.of_node, 0);
1077 	if (IS_ERR(player->clk)) {
1078 		dev_err(player->dev, "Failed to get clock\n");
1079 		return PTR_ERR(player->clk);
1080 	}
1081 
1082 	/* Select the frequency synthesizer clock */
1083 	if (player->clk_sel) {
1084 		ret = regmap_field_write(player->clk_sel, 1);
1085 		if (ret) {
1086 			dev_err(player->dev,
1087 				"%s: Failed to select freq synth clock\n",
1088 				__func__);
1089 			return ret;
1090 		}
1091 	}
1092 
1093 	/* connect to I2S/TDM TX bus */
1094 	if (player->valid_sel &&
1095 	    (player->id == UNIPERIF_PLAYER_I2S_OUT)) {
1096 		ret = regmap_field_write(player->valid_sel, player->id);
1097 		if (ret) {
1098 			dev_err(player->dev,
1099 				"%s: unable to connect to tdm bus\n", __func__);
1100 			return ret;
1101 		}
1102 	}
1103 
1104 	ret = devm_request_irq(&pdev->dev, player->irq,
1105 			       uni_player_irq_handler, IRQF_SHARED,
1106 			       dev_name(&pdev->dev), player);
1107 	if (ret < 0) {
1108 		dev_err(player->dev, "unable to request IRQ %d\n", player->irq);
1109 		return ret;
1110 	}
1111 
1112 	mutex_init(&player->ctrl_lock);
1113 	spin_lock_init(&player->irq_lock);
1114 
1115 	/* Ensure that disabled by default */
1116 	SET_UNIPERIF_CONFIG_BACK_STALL_REQ_DISABLE(player);
1117 	SET_UNIPERIF_CTRL_ROUNDING_OFF(player);
1118 	SET_UNIPERIF_CTRL_SPDIF_LAT_OFF(player);
1119 	SET_UNIPERIF_CONFIG_IDLE_MOD_DISABLE(player);
1120 
1121 	if (UNIPERIF_TYPE_IS_IEC958(player)) {
1122 		/* Set default iec958 status bits  */
1123 
1124 		/* Consumer, PCM, copyright, 2ch, mode 0 */
1125 		player->stream_settings.iec958.status[0] = 0x00;
1126 		/* Broadcast reception category */
1127 		player->stream_settings.iec958.status[1] =
1128 					IEC958_AES1_CON_GENERAL;
1129 		/* Do not take into account source or channel number */
1130 		player->stream_settings.iec958.status[2] =
1131 					IEC958_AES2_CON_SOURCE_UNSPEC;
1132 		/* Sampling frequency not indicated */
1133 		player->stream_settings.iec958.status[3] =
1134 					IEC958_AES3_CON_FS_NOTID;
1135 		/* Max sample word 24-bit, sample word length not indicated */
1136 		player->stream_settings.iec958.status[4] =
1137 					IEC958_AES4_CON_MAX_WORDLEN_24 |
1138 					IEC958_AES4_CON_WORDLEN_24_20;
1139 
1140 		player->num_ctrls = ARRAY_SIZE(snd_sti_iec_ctl);
1141 		player->snd_ctrls = snd_sti_iec_ctl[0];
1142 	} else {
1143 		player->num_ctrls = ARRAY_SIZE(snd_sti_pcm_ctl);
1144 		player->snd_ctrls = snd_sti_pcm_ctl[0];
1145 	}
1146 
1147 	return 0;
1148 }
1149 EXPORT_SYMBOL_GPL(uni_player_init);
1150