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