Commit | Line | Data |
---|---|---|
af873fce | 1 | // SPDX-License-Identifier: GPL-2.0-only |
76c2145d AP |
2 | /* |
3 | * Copyright (C) STMicroelectronics SA 2015 | |
4 | * Authors: Arnaud Pouliquen <arnaud.pouliquen@st.com> | |
5 | * for STMicroelectronics. | |
76c2145d AP |
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 | 35 | static 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 | */ | |
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 | ||
d05d862e AP |
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; | |
76c2145d AP |
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))) { | |
748abba8 | 82 | dev_err(player->dev, "FIFO underflow error detected\n"); |
76c2145d AP |
83 | |
84 | /* Interrupt is just for information when underflow recovery */ | |
5a4326d1 | 85 | if (player->underflow_enabled) { |
76c2145d AP |
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 */ | |
dc865fb9 | 94 | snd_pcm_stop_xrun(player->substream); |
76c2145d AP |
95 | } |
96 | ||
97 | ret = IRQ_HANDLED; | |
98 | } | |
99 | ||
100 | /* Check for dma error (overrun) */ | |
101 | if (unlikely(status & UNIPERIF_ITS_DMA_ERROR_MASK(player))) { | |
748abba8 | 102 | dev_err(player->dev, "DMA error detected\n"); |
76c2145d AP |
103 | |
104 | /* Disable interrupt so doesn't continually fire */ | |
105 | SET_UNIPERIF_ITM_BCLR_DMA_ERROR(player); | |
106 | ||
107 | /* Stop the player */ | |
dc865fb9 | 108 | snd_pcm_stop_xrun(player->substream); |
76c2145d AP |
109 | |
110 | ret = IRQ_HANDLED; | |
111 | } | |
112 | ||
113 | /* Check for underflow recovery done */ | |
114 | if (unlikely(status & UNIPERIF_ITM_UNDERFLOW_REC_DONE_MASK(player))) { | |
5a4326d1 | 115 | if (!player->underflow_enabled) { |
748abba8 AP |
116 | dev_err(player->dev, |
117 | "unexpected Underflow recovering\n"); | |
d05d862e AP |
118 | ret = -EPERM; |
119 | goto stream_unlock; | |
76c2145d AP |
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 */ | |
dc865fb9 | 141 | snd_pcm_stop_xrun(player->substream); |
76c2145d AP |
142 | |
143 | ret = IRQ_HANDLED; | |
144 | } | |
145 | ||
d05d862e AP |
146 | stream_unlock: |
147 | snd_pcm_stream_unlock(player->substream); | |
148 | irq_spin_unlock: | |
149 | spin_unlock(&player->irq_lock); | |
150 | ||
76c2145d AP |
151 | return ret; |
152 | } | |
153 | ||
f2da4542 | 154 | static int uni_player_clk_set_rate(struct uniperif *player, unsigned long rate) |
fa050796 AP |
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 | ||
76c2145d AP |
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 | */ | |
36cc0935 | 229 | mutex_lock(&player->ctrl_lock); |
0d3f3c9a | 230 | if (runtime) { |
76c2145d AP |
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 | } | |
36cc0935 | 306 | mutex_unlock(&player->ctrl_lock); |
76c2145d AP |
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)) { | |
748abba8 | 324 | dev_err(player->dev, "%s: invalid clk_div %d\n", |
76c2145d AP |
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: | |
748abba8 | 347 | dev_err(player->dev, "format not supported\n"); |
76c2145d AP |
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) == | |
8d8b1e2e | 423 | SND_SOC_DAIFMT_I2S) |
76c2145d | 424 | slot_width = 32; |
8d8b1e2e MG |
425 | else |
426 | slot_width = snd_pcm_format_width(runtime->format); | |
427 | ||
76c2145d AP |
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)) { | |
748abba8 | 436 | dev_err(player->dev, "%s: invalid clk_div\n", __func__); |
76c2145d AP |
437 | return -EINVAL; |
438 | } | |
439 | ||
440 | if ((slot_width == 16) && (clk_div % 64)) { | |
748abba8 | 441 | dev_err(player->dev, "%s: invalid clk_div\n", __func__); |
76c2145d AP |
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: | |
748abba8 | 459 | dev_err(player->dev, "subframe format not supported\n"); |
76c2145d AP |
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: | |
748abba8 | 479 | dev_err(player->dev, "format not supported\n"); |
76c2145d AP |
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)) { | |
748abba8 | 492 | dev_err(player->dev, "%s: invalid nb of channels\n", __func__); |
76c2145d AP |
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); | |
76c2145d AP |
502 | |
503 | /* No iec958 formatting as outputting to DAC */ | |
504 | SET_UNIPERIF_CTRL_SPDIF_FMT_OFF(player); | |
505 | ||
506 | return 0; | |
507 | } | |
508 | ||
8d8b1e2e MG |
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 | ||
36cc0935 AP |
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; | |
d05d862e | 594 | unsigned long flags; |
36cc0935 AP |
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 | ||
d05d862e | 603 | spin_lock_irqsave(&player->irq_lock, flags); |
1e6d3044 AP |
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); | |
36cc0935 | 609 | |
d05d862e | 610 | spin_unlock_irqrestore(&player->irq_lock, flags); |
36cc0935 AP |
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 | ||
fa050796 AP |
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 | ||
36cc0935 | 644 | mutex_lock(&player->ctrl_lock); |
fa050796 | 645 | ucontrol->value.integer.value[0] = player->clk_adj; |
36cc0935 | 646 | mutex_unlock(&player->ctrl_lock); |
fa050796 AP |
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 | ||
36cc0935 AP |
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, | |
fa050796 AP |
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; | |
d05d862e | 695 | unsigned long flags; |
8d8b1e2e MG |
696 | int ret; |
697 | ||
d05d862e | 698 | spin_lock_irqsave(&player->irq_lock, flags); |
36a65e20 | 699 | player->substream = substream; |
d05d862e | 700 | spin_unlock_irqrestore(&player->irq_lock, flags); |
fa050796 AP |
701 | |
702 | player->clk_adj = 0; | |
703 | ||
8d8b1e2e MG |
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); | |
fa050796 AP |
721 | } |
722 | ||
76c2145d AP |
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; | |
ed6c75f2 | 728 | int ret; |
76c2145d | 729 | |
8d8b1e2e | 730 | if (UNIPERIF_TYPE_IS_TDM(player) || (dir == SND_SOC_CLOCK_IN)) |
76c2145d AP |
731 | return 0; |
732 | ||
733 | if (clk_id != 0) | |
734 | return -EINVAL; | |
735 | ||
fa050796 AP |
736 | mutex_lock(&player->ctrl_lock); |
737 | ret = uni_player_clk_set_rate(player, freq); | |
ed6c75f2 AP |
738 | if (!ret) |
739 | player->mclk = freq; | |
fa050796 | 740 | mutex_unlock(&player->ctrl_lock); |
76c2145d | 741 | |
ed6c75f2 | 742 | return ret; |
76c2145d AP |
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) { | |
748abba8 | 756 | dev_err(player->dev, "%s: invalid player state %d\n", __func__, |
76c2145d AP |
757 | player->state); |
758 | return -EINVAL; | |
759 | } | |
760 | ||
761 | /* Calculate transfer size (in fifo cells and bytes) for frame count */ | |
5a4326d1 | 762 | if (player->type == SND_ST_UNIPERIF_TYPE_TDM) { |
8d8b1e2e MG |
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 | } | |
76c2145d AP |
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))) { | |
748abba8 AP |
785 | dev_err(player->dev, "invalid trigger limit %d\n", |
786 | trigger_limit); | |
76c2145d AP |
787 | return -EINVAL; |
788 | } | |
789 | ||
790 | SET_UNIPERIF_CONFIG_DMA_TRIG_LIMIT(player, trigger_limit); | |
791 | ||
792 | /* Uniperipheral setup depends on player type */ | |
5a4326d1 | 793 | switch (player->type) { |
5295a0dc | 794 | case SND_ST_UNIPERIF_TYPE_HDMI: |
76c2145d AP |
795 | ret = uni_player_prepare_iec958(player, runtime); |
796 | break; | |
5295a0dc | 797 | case SND_ST_UNIPERIF_TYPE_PCM: |
76c2145d AP |
798 | ret = uni_player_prepare_pcm(player, runtime); |
799 | break; | |
5295a0dc | 800 | case SND_ST_UNIPERIF_TYPE_SPDIF: |
76c2145d AP |
801 | ret = uni_player_prepare_iec958(player, runtime); |
802 | break; | |
8d8b1e2e MG |
803 | case SND_ST_UNIPERIF_TYPE_TDM: |
804 | ret = uni_player_prepare_tdm(player, runtime); | |
805 | break; | |
76c2145d | 806 | default: |
748abba8 | 807 | dev_err(player->dev, "invalid player type\n"); |
76c2145d AP |
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); | |
ed6c75f2 | 830 | break; |
76c2145d AP |
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: | |
748abba8 | 847 | dev_err(player->dev, "format not supported\n"); |
76c2145d AP |
848 | return -EINVAL; |
849 | } | |
850 | ||
851 | SET_UNIPERIF_I2S_FMT_NO_OF_SAMPLES_TO_READ(player, 0); | |
852 | ||
76c2145d | 853 | |
4c88f89f | 854 | return sti_uniperiph_reset(player); |
76c2145d AP |
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) { | |
748abba8 | 863 | dev_err(player->dev, "%s: invalid player state\n", __func__); |
76c2145d AP |
864 | return -EINVAL; |
865 | } | |
866 | ||
867 | ret = clk_prepare_enable(player->clk); | |
868 | if (ret) { | |
748abba8 | 869 | dev_err(player->dev, "%s: Failed to enable clock\n", __func__); |
76c2145d AP |
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 */ | |
5a4326d1 | 881 | if (player->underflow_enabled) { |
76c2145d AP |
882 | SET_UNIPERIF_ITM_BSET_UNDERFLOW_REC_DONE(player); |
883 | SET_UNIPERIF_ITM_BSET_UNDERFLOW_REC_FAILED(player); | |
884 | } | |
885 | ||
4c88f89f | 886 | ret = sti_uniperiph_reset(player); |
b7c8c5d6 WY |
887 | if (ret < 0) { |
888 | clk_disable_unprepare(player->clk); | |
76c2145d | 889 | return ret; |
b7c8c5d6 | 890 | } |
76c2145d AP |
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) | |
5295a0dc MG |
907 | if (UNIPERIF_TYPE_IS_IEC958(player)) |
908 | SET_UNIPERIF_CTRL_SPDIF_FMT_ON(player); | |
76c2145d AP |
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) { | |
748abba8 | 928 | dev_err(player->dev, "%s: invalid player state\n", __func__); |
76c2145d AP |
929 | return -EINVAL; |
930 | } | |
931 | ||
932 | /* Turn the player off */ | |
933 | SET_UNIPERIF_CTRL_OPERATION_OFF(player); | |
934 | ||
4c88f89f | 935 | ret = sti_uniperiph_reset(player); |
76c2145d AP |
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, | |
748abba8 | 960 | "%s: Failed to select freq synth clock\n", |
76c2145d AP |
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; | |
d05d862e | 998 | unsigned long flags; |
76c2145d | 999 | |
d05d862e | 1000 | spin_lock_irqsave(&player->irq_lock, flags); |
76c2145d AP |
1001 | if (player->state != UNIPERIF_STATE_STOPPED) |
1002 | /* Stop the player */ | |
1003 | uni_player_stop(player); | |
36a65e20 MG |
1004 | |
1005 | player->substream = NULL; | |
d05d862e | 1006 | spin_unlock_irqrestore(&player->irq_lock, flags); |
76c2145d AP |
1007 | } |
1008 | ||
3ee15cac MG |
1009 | static int uni_player_parse_dt_audio_glue(struct platform_device *pdev, |
1010 | struct uniperif *player) | |
76c2145d | 1011 | { |
76c2145d AP |
1012 | struct device_node *node = pdev->dev.of_node; |
1013 | struct regmap *regmap; | |
3ee15cac MG |
1014 | struct reg_field regfield[2] = { |
1015 | /* PCM_CLK_SEL */ | |
1016 | REG_FIELD(SYS_CFG_AUDIO_GLUE, | |
5a4326d1 AP |
1017 | 8 + player->id, |
1018 | 8 + player->id), | |
3ee15cac MG |
1019 | /* PCMP_VALID_SEL */ |
1020 | REG_FIELD(SYS_CFG_AUDIO_GLUE, 0, 1) | |
1021 | }; | |
76c2145d AP |
1022 | |
1023 | regmap = syscon_regmap_lookup_by_phandle(node, "st,syscfg"); | |
1024 | ||
7d267ddf | 1025 | if (IS_ERR(regmap)) { |
76c2145d | 1026 | dev_err(&pdev->dev, "sti-audio-clk-glue syscf not found\n"); |
7d267ddf | 1027 | return PTR_ERR(regmap); |
76c2145d AP |
1028 | } |
1029 | ||
3ee15cac MG |
1030 | player->clk_sel = regmap_field_alloc(regmap, regfield[0]); |
1031 | player->valid_sel = regmap_field_alloc(regmap, regfield[1]); | |
1032 | ||
76c2145d AP |
1033 | return 0; |
1034 | } | |
1035 | ||
85cf604e | 1036 | static const struct snd_soc_dai_ops uni_player_dai_ops = { |
fa050796 | 1037 | .startup = uni_player_startup, |
76c2145d AP |
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, | |
8d8b1e2e MG |
1043 | .set_sysclk = uni_player_set_sysclk, |
1044 | .set_tdm_slot = sti_uniperiph_set_tdm_slot | |
76c2145d AP |
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; | |
76c2145d AP |
1054 | player->dai_ops = &uni_player_dai_ops; |
1055 | ||
5a4326d1 AP |
1056 | /* Get PCM_CLK_SEL & PCMP_VALID_SEL from audio-glue-ctrl SoC reg */ |
1057 | ret = uni_player_parse_dt_audio_glue(pdev, player); | |
76c2145d AP |
1058 | |
1059 | if (ret < 0) { | |
748abba8 | 1060 | dev_err(player->dev, "Failed to parse DeviceTree\n"); |
76c2145d AP |
1061 | return ret; |
1062 | } | |
1063 | ||
5a4326d1 AP |
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 | ||
8d8b1e2e MG |
1068 | if (UNIPERIF_TYPE_IS_TDM(player)) |
1069 | player->hw = &uni_tdm_hw; | |
1070 | else | |
1071 | player->hw = &uni_player_pcm_hw; | |
1072 | ||
76c2145d AP |
1073 | /* Get uniperif resource */ |
1074 | player->clk = of_clk_get(pdev->dev.of_node, 0); | |
748abba8 AP |
1075 | if (IS_ERR(player->clk)) { |
1076 | dev_err(player->dev, "Failed to get clock\n"); | |
65ed0a8d | 1077 | return PTR_ERR(player->clk); |
748abba8 | 1078 | } |
76c2145d AP |
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, | |
748abba8 | 1085 | "%s: Failed to select freq synth clock\n", |
76c2145d AP |
1086 | __func__); |
1087 | return ret; | |
1088 | } | |
1089 | } | |
1090 | ||
3ee15cac MG |
1091 | /* connect to I2S/TDM TX bus */ |
1092 | if (player->valid_sel && | |
5a4326d1 AP |
1093 | (player->id == UNIPERIF_PLAYER_I2S_OUT)) { |
1094 | ret = regmap_field_write(player->valid_sel, player->id); | |
3ee15cac MG |
1095 | if (ret) { |
1096 | dev_err(player->dev, | |
748abba8 | 1097 | "%s: unable to connect to tdm bus\n", __func__); |
3ee15cac MG |
1098 | return ret; |
1099 | } | |
1100 | } | |
1101 | ||
76c2145d AP |
1102 | ret = devm_request_irq(&pdev->dev, player->irq, |
1103 | uni_player_irq_handler, IRQF_SHARED, | |
1104 | dev_name(&pdev->dev), player); | |
748abba8 AP |
1105 | if (ret < 0) { |
1106 | dev_err(player->dev, "unable to request IRQ %d\n", player->irq); | |
76c2145d | 1107 | return ret; |
748abba8 | 1108 | } |
76c2145d | 1109 | |
fa050796 | 1110 | mutex_init(&player->ctrl_lock); |
d05d862e | 1111 | spin_lock_init(&player->irq_lock); |
fa050796 | 1112 | |
76c2145d AP |
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 | ||
5295a0dc | 1119 | if (UNIPERIF_TYPE_IS_IEC958(player)) { |
76c2145d AP |
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; | |
76c2145d | 1137 | |
36cc0935 AP |
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 | } | |
fa050796 | 1144 | |
76c2145d AP |
1145 | return 0; |
1146 | } | |
1147 | EXPORT_SYMBOL_GPL(uni_player_init); |