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