1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause) 2 // 3 // This file is provided under a dual BSD/GPLv2 license. When using or 4 // redistributing this file, you may do so under either license. 5 // 6 // Copyright(c) 2022 Intel Corporation 7 // 8 9 #include <sound/pcm_params.h> 10 #include <sound/sof/ipc4/header.h> 11 #include "sof-audio.h" 12 #include "sof-priv.h" 13 #include "ops.h" 14 #include "ipc4-priv.h" 15 #include "ipc4-topology.h" 16 #include "ipc4-fw-reg.h" 17 18 /** 19 * struct sof_ipc4_timestamp_info - IPC4 timestamp info 20 * @host_copier: the host copier of the pcm stream 21 * @dai_copier: the dai copier of the pcm stream 22 * @stream_start_offset: reported by fw in memory window (converted to frames) 23 * @stream_end_offset: reported by fw in memory window (converted to frames) 24 * @llp_offset: llp offset in memory window 25 * @boundary: wrap boundary should be used for the LLP frame counter 26 * @delay: Calculated and stored in pointer callback. The stored value is 27 * returned in the delay callback. 28 */ 29 struct sof_ipc4_timestamp_info { 30 struct sof_ipc4_copier *host_copier; 31 struct sof_ipc4_copier *dai_copier; 32 u64 stream_start_offset; 33 u64 stream_end_offset; 34 u32 llp_offset; 35 36 u64 boundary; 37 snd_pcm_sframes_t delay; 38 }; 39 40 /** 41 * struct sof_ipc4_pcm_stream_priv - IPC4 specific private data 42 * @time_info: pointer to time info struct if it is supported, otherwise NULL 43 * @chain_dma_allocated: indicates the ChainDMA allocation state 44 */ 45 struct sof_ipc4_pcm_stream_priv { 46 struct sof_ipc4_timestamp_info *time_info; 47 48 bool chain_dma_allocated; 49 }; 50 51 static inline struct sof_ipc4_timestamp_info * 52 sof_ipc4_sps_to_time_info(struct snd_sof_pcm_stream *sps) 53 { 54 struct sof_ipc4_pcm_stream_priv *stream_priv = sps->private; 55 56 return stream_priv->time_info; 57 } 58 59 static int sof_ipc4_set_multi_pipeline_state(struct snd_sof_dev *sdev, u32 state, 60 struct ipc4_pipeline_set_state_data *trigger_list) 61 { 62 struct sof_ipc4_msg msg = {{ 0 }}; 63 u32 primary, ipc_size; 64 65 /* trigger a single pipeline */ 66 if (trigger_list->count == 1) 67 return sof_ipc4_set_pipeline_state(sdev, trigger_list->pipeline_instance_ids[0], 68 state); 69 70 primary = state; 71 primary |= SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_GLB_SET_PIPELINE_STATE); 72 primary |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST); 73 primary |= SOF_IPC4_MSG_TARGET(SOF_IPC4_FW_GEN_MSG); 74 msg.primary = primary; 75 76 /* trigger multiple pipelines with a single IPC */ 77 msg.extension = SOF_IPC4_GLB_PIPE_STATE_EXT_MULTI; 78 79 /* ipc_size includes the count and the pipeline IDs for the number of pipelines */ 80 ipc_size = sizeof(u32) * (trigger_list->count + 1); 81 msg.data_size = ipc_size; 82 msg.data_ptr = trigger_list; 83 84 return sof_ipc_tx_message_no_reply(sdev->ipc, &msg, ipc_size); 85 } 86 87 int sof_ipc4_set_pipeline_state(struct snd_sof_dev *sdev, u32 instance_id, u32 state) 88 { 89 struct sof_ipc4_msg msg = {{ 0 }}; 90 u32 primary; 91 92 dev_dbg(sdev->dev, "ipc4 set pipeline instance %d state %d", instance_id, state); 93 94 primary = state; 95 primary |= SOF_IPC4_GLB_PIPE_STATE_ID(instance_id); 96 primary |= SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_GLB_SET_PIPELINE_STATE); 97 primary |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST); 98 primary |= SOF_IPC4_MSG_TARGET(SOF_IPC4_FW_GEN_MSG); 99 100 msg.primary = primary; 101 102 return sof_ipc_tx_message_no_reply(sdev->ipc, &msg, 0); 103 } 104 EXPORT_SYMBOL(sof_ipc4_set_pipeline_state); 105 106 static void sof_ipc4_add_pipeline_by_priority(struct ipc4_pipeline_set_state_data *trigger_list, 107 struct snd_sof_widget *pipe_widget, 108 s8 *pipe_priority, bool ascend) 109 { 110 struct sof_ipc4_pipeline *pipeline = pipe_widget->private; 111 int i, j; 112 113 for (i = 0; i < trigger_list->count; i++) { 114 /* add pipeline from low priority to high */ 115 if (ascend && pipeline->priority < pipe_priority[i]) 116 break; 117 /* add pipeline from high priority to low */ 118 else if (!ascend && pipeline->priority > pipe_priority[i]) 119 break; 120 } 121 122 for (j = trigger_list->count - 1; j >= i; j--) { 123 trigger_list->pipeline_instance_ids[j + 1] = trigger_list->pipeline_instance_ids[j]; 124 pipe_priority[j + 1] = pipe_priority[j]; 125 } 126 127 trigger_list->pipeline_instance_ids[i] = pipe_widget->instance_id; 128 trigger_list->count++; 129 pipe_priority[i] = pipeline->priority; 130 } 131 132 static void 133 sof_ipc4_add_pipeline_to_trigger_list(struct snd_sof_dev *sdev, int state, 134 struct snd_sof_pipeline *spipe, 135 struct ipc4_pipeline_set_state_data *trigger_list, 136 s8 *pipe_priority) 137 { 138 struct snd_sof_widget *pipe_widget = spipe->pipe_widget; 139 struct sof_ipc4_pipeline *pipeline = pipe_widget->private; 140 141 if (pipeline->skip_during_fe_trigger && state != SOF_IPC4_PIPE_RESET) 142 return; 143 144 switch (state) { 145 case SOF_IPC4_PIPE_RUNNING: 146 /* 147 * Trigger pipeline if all PCMs containing it are paused or if it is RUNNING 148 * for the first time 149 */ 150 if (spipe->started_count == spipe->paused_count) 151 sof_ipc4_add_pipeline_by_priority(trigger_list, pipe_widget, pipe_priority, 152 false); 153 break; 154 case SOF_IPC4_PIPE_RESET: 155 /* RESET if the pipeline is neither running nor paused */ 156 if (!spipe->started_count && !spipe->paused_count) 157 sof_ipc4_add_pipeline_by_priority(trigger_list, pipe_widget, pipe_priority, 158 true); 159 break; 160 case SOF_IPC4_PIPE_PAUSED: 161 /* Pause the pipeline only when its started_count is 1 more than paused_count */ 162 if (spipe->paused_count == (spipe->started_count - 1)) 163 sof_ipc4_add_pipeline_by_priority(trigger_list, pipe_widget, pipe_priority, 164 true); 165 break; 166 default: 167 break; 168 } 169 } 170 171 static void 172 sof_ipc4_update_pipeline_state(struct snd_sof_dev *sdev, int state, int cmd, 173 struct snd_sof_pipeline *spipe, 174 struct ipc4_pipeline_set_state_data *trigger_list) 175 { 176 struct snd_sof_widget *pipe_widget = spipe->pipe_widget; 177 struct sof_ipc4_pipeline *pipeline = pipe_widget->private; 178 int i; 179 180 if (pipeline->skip_during_fe_trigger && state != SOF_IPC4_PIPE_RESET) 181 return; 182 183 /* set state for pipeline if it was just triggered */ 184 for (i = 0; i < trigger_list->count; i++) { 185 if (trigger_list->pipeline_instance_ids[i] == pipe_widget->instance_id) { 186 pipeline->state = state; 187 break; 188 } 189 } 190 191 switch (state) { 192 case SOF_IPC4_PIPE_PAUSED: 193 switch (cmd) { 194 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 195 /* 196 * increment paused_count if the PAUSED is the final state during 197 * the PAUSE trigger 198 */ 199 spipe->paused_count++; 200 break; 201 case SNDRV_PCM_TRIGGER_STOP: 202 case SNDRV_PCM_TRIGGER_SUSPEND: 203 /* 204 * decrement started_count if PAUSED is the final state during the 205 * STOP trigger 206 */ 207 spipe->started_count--; 208 break; 209 default: 210 break; 211 } 212 break; 213 case SOF_IPC4_PIPE_RUNNING: 214 switch (cmd) { 215 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 216 /* decrement paused_count for RELEASE */ 217 spipe->paused_count--; 218 break; 219 case SNDRV_PCM_TRIGGER_START: 220 case SNDRV_PCM_TRIGGER_RESUME: 221 /* increment started_count for START/RESUME */ 222 spipe->started_count++; 223 break; 224 default: 225 break; 226 } 227 break; 228 default: 229 break; 230 } 231 } 232 233 /* 234 * The picture below represents the pipeline state machine wrt PCM actions corresponding to the 235 * triggers and ioctls 236 * +---------------+ 237 * | | 238 * | INIT | 239 * | | 240 * +-------+-------+ 241 * | 242 * | 243 * | START 244 * | 245 * | 246 * +----------------+ +------v-------+ +-------------+ 247 * | | START | | HW_FREE | | 248 * | RUNNING <-------------+ PAUSED +--------------> + RESET | 249 * | | PAUSE | | | | 250 * +------+---------+ RELEASE +---------+----+ +-------------+ 251 * | ^ 252 * | | 253 * | | 254 * | | 255 * | PAUSE | 256 * +---------------------------------+ 257 * STOP/SUSPEND 258 * 259 * Note that during system suspend, the suspend trigger is followed by a hw_free in 260 * sof_pcm_trigger(). So, the final state during suspend would be RESET. 261 * Also, since the SOF driver doesn't support full resume, streams would be restarted with the 262 * prepare ioctl before the START trigger. 263 */ 264 265 /* 266 * Chained DMA is a special case where there is no processing on 267 * DSP. The samples are just moved over by host side DMA to a single 268 * buffer on DSP and directly from there to link DMA. However, the 269 * model on SOF driver has two notional pipelines, one at host DAI, 270 * and another at link DAI. They both shall have the use_chain_dma 271 * attribute. 272 */ 273 274 static int sof_ipc4_chain_dma_trigger(struct snd_sof_dev *sdev, 275 struct snd_sof_pcm *spcm, int direction, 276 struct snd_sof_pcm_stream_pipeline_list *pipeline_list, 277 int state, int cmd) 278 { 279 struct sof_ipc4_fw_data *ipc4_data = sdev->private; 280 struct sof_ipc4_pcm_stream_priv *stream_priv; 281 bool allocate, enable, set_fifo_size; 282 struct sof_ipc4_msg msg = {{ 0 }}; 283 int ret, i; 284 285 stream_priv = spcm->stream[direction].private; 286 287 switch (state) { 288 case SOF_IPC4_PIPE_RUNNING: /* Allocate and start chained dma */ 289 allocate = true; 290 enable = true; 291 /* 292 * SOF assumes creation of a new stream from the presence of fifo_size 293 * in the message, so we must leave it out in pause release case. 294 */ 295 if (cmd == SNDRV_PCM_TRIGGER_PAUSE_RELEASE) 296 set_fifo_size = false; 297 else 298 set_fifo_size = true; 299 break; 300 case SOF_IPC4_PIPE_PAUSED: /* Disable chained DMA. */ 301 allocate = true; 302 enable = false; 303 set_fifo_size = false; 304 break; 305 case SOF_IPC4_PIPE_RESET: /* Disable and free chained DMA. */ 306 307 /* ChainDMA can only be reset if it has been allocated */ 308 if (!stream_priv->chain_dma_allocated) 309 return 0; 310 311 allocate = false; 312 enable = false; 313 set_fifo_size = false; 314 break; 315 default: 316 spcm_err(spcm, direction, "Unexpected pipeline state %d\n", state); 317 return -EINVAL; 318 } 319 320 msg.primary = SOF_IPC4_MSG_TYPE_SET(SOF_IPC4_GLB_CHAIN_DMA); 321 msg.primary |= SOF_IPC4_MSG_DIR(SOF_IPC4_MSG_REQUEST); 322 msg.primary |= SOF_IPC4_MSG_TARGET(SOF_IPC4_FW_GEN_MSG); 323 324 /* 325 * To set-up the DMA chain, the host DMA ID and SCS setting 326 * are retrieved from the host pipeline configuration. Likewise 327 * the link DMA ID and fifo_size are retrieved from the link 328 * pipeline configuration. 329 */ 330 for (i = 0; i < pipeline_list->count; i++) { 331 struct snd_sof_pipeline *spipe = pipeline_list->pipelines[i]; 332 struct snd_sof_widget *pipe_widget = spipe->pipe_widget; 333 struct sof_ipc4_pipeline *pipeline = pipe_widget->private; 334 335 if (!pipeline->use_chain_dma) { 336 spcm_err(spcm, direction, 337 "All pipelines in chained DMA path should have use_chain_dma attribute set."); 338 return -EINVAL; 339 } 340 341 msg.primary |= pipeline->msg.primary; 342 343 /* Add fifo_size (actually DMA buffer size) field to the message */ 344 if (set_fifo_size) 345 msg.extension |= pipeline->msg.extension; 346 } 347 348 if (direction == SNDRV_PCM_STREAM_CAPTURE) { 349 /* 350 * For ChainDMA the DMA ids are unique with the following mapping: 351 * playback: 0 - (num_playback_streams - 1) 352 * capture: num_playback_streams - (num_playback_streams + 353 * num_capture_streams - 1) 354 * 355 * Add the num_playback_streams offset to the DMA ids stored in 356 * msg.primary in case capture 357 */ 358 msg.primary += SOF_IPC4_GLB_CHAIN_DMA_HOST_ID(ipc4_data->num_playback_streams); 359 msg.primary += SOF_IPC4_GLB_CHAIN_DMA_LINK_ID(ipc4_data->num_playback_streams); 360 } 361 362 if (allocate) 363 msg.primary |= SOF_IPC4_GLB_CHAIN_DMA_ALLOCATE_MASK; 364 365 if (enable) 366 msg.primary |= SOF_IPC4_GLB_CHAIN_DMA_ENABLE_MASK; 367 368 ret = sof_ipc_tx_message_no_reply(sdev->ipc, &msg, 0); 369 /* Update the ChainDMA allocation state */ 370 if (!ret) 371 stream_priv->chain_dma_allocated = allocate; 372 373 return ret; 374 } 375 376 static int sof_ipc4_trigger_pipelines(struct snd_soc_component *component, 377 struct snd_pcm_substream *substream, int state, int cmd) 378 { 379 struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(component); 380 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream); 381 struct snd_sof_pcm_stream_pipeline_list *pipeline_list; 382 struct sof_ipc4_fw_data *ipc4_data = sdev->private; 383 struct ipc4_pipeline_set_state_data *trigger_list; 384 struct snd_sof_widget *pipe_widget; 385 struct sof_ipc4_pipeline *pipeline; 386 struct snd_sof_pipeline *spipe; 387 struct snd_sof_pcm *spcm; 388 u8 *pipe_priority; 389 int ret; 390 int i; 391 392 spcm = snd_sof_find_spcm_dai(component, rtd); 393 if (!spcm) 394 return -EINVAL; 395 396 spcm_dbg(spcm, substream->stream, "cmd: %d, state: %d\n", cmd, state); 397 398 pipeline_list = &spcm->stream[substream->stream].pipeline_list; 399 400 /* nothing to trigger if the list is empty */ 401 if (!pipeline_list->pipelines || !pipeline_list->count) 402 return 0; 403 404 spipe = pipeline_list->pipelines[0]; 405 pipe_widget = spipe->pipe_widget; 406 pipeline = pipe_widget->private; 407 408 /* 409 * If use_chain_dma attribute is set we proceed to chained DMA 410 * trigger function that handles the rest for the substream. 411 */ 412 if (pipeline->use_chain_dma) 413 return sof_ipc4_chain_dma_trigger(sdev, spcm, substream->stream, 414 pipeline_list, state, cmd); 415 416 /* allocate memory for the pipeline data */ 417 trigger_list = kzalloc(struct_size(trigger_list, pipeline_instance_ids, 418 pipeline_list->count), GFP_KERNEL); 419 if (!trigger_list) 420 return -ENOMEM; 421 422 pipe_priority = kzalloc(pipeline_list->count, GFP_KERNEL); 423 if (!pipe_priority) { 424 kfree(trigger_list); 425 return -ENOMEM; 426 } 427 428 mutex_lock(&ipc4_data->pipeline_state_mutex); 429 430 /* 431 * IPC4 requires pipelines to be triggered in order starting at the sink and 432 * walking all the way to the source. So traverse the pipeline_list in the order 433 * sink->source when starting PCM's and in the reverse order to pause/stop PCM's. 434 * Skip the pipelines that have their skip_during_fe_trigger flag set. If there is a fork 435 * in the pipeline, the order of triggering between the left/right paths will be 436 * indeterministic. But the sink->source trigger order sink->source would still be 437 * guaranteed for each fork independently. 438 */ 439 if (state == SOF_IPC4_PIPE_RUNNING || state == SOF_IPC4_PIPE_RESET) 440 for (i = pipeline_list->count - 1; i >= 0; i--) { 441 spipe = pipeline_list->pipelines[i]; 442 sof_ipc4_add_pipeline_to_trigger_list(sdev, state, spipe, trigger_list, 443 pipe_priority); 444 } 445 else 446 for (i = 0; i < pipeline_list->count; i++) { 447 spipe = pipeline_list->pipelines[i]; 448 sof_ipc4_add_pipeline_to_trigger_list(sdev, state, spipe, trigger_list, 449 pipe_priority); 450 } 451 452 /* return if all pipelines are in the requested state already */ 453 if (!trigger_list->count) { 454 ret = 0; 455 goto free; 456 } 457 458 /* no need to pause before reset or before pause release */ 459 if (state == SOF_IPC4_PIPE_RESET || cmd == SNDRV_PCM_TRIGGER_PAUSE_RELEASE) 460 goto skip_pause_transition; 461 462 /* 463 * set paused state for pipelines if the final state is PAUSED or when the pipeline 464 * is set to RUNNING for the first time after the PCM is started. 465 */ 466 ret = sof_ipc4_set_multi_pipeline_state(sdev, SOF_IPC4_PIPE_PAUSED, trigger_list); 467 if (ret < 0) { 468 spcm_err(spcm, substream->stream, "failed to pause all pipelines\n"); 469 goto free; 470 } 471 472 /* update PAUSED state for all pipelines just triggered */ 473 for (i = 0; i < pipeline_list->count ; i++) { 474 spipe = pipeline_list->pipelines[i]; 475 sof_ipc4_update_pipeline_state(sdev, SOF_IPC4_PIPE_PAUSED, cmd, spipe, 476 trigger_list); 477 } 478 479 /* return if this is the final state */ 480 if (state == SOF_IPC4_PIPE_PAUSED) { 481 struct sof_ipc4_timestamp_info *time_info; 482 483 /* 484 * Invalidate the stream_start_offset to make sure that it is 485 * going to be updated if the stream resumes 486 */ 487 time_info = sof_ipc4_sps_to_time_info(&spcm->stream[substream->stream]); 488 if (time_info) 489 time_info->stream_start_offset = SOF_IPC4_INVALID_STREAM_POSITION; 490 491 goto free; 492 } 493 skip_pause_transition: 494 /* else set the RUNNING/RESET state in the DSP */ 495 ret = sof_ipc4_set_multi_pipeline_state(sdev, state, trigger_list); 496 if (ret < 0) { 497 spcm_err(spcm, substream->stream, 498 "failed to set final state %d for all pipelines\n", 499 state); 500 /* 501 * workaround: if the firmware is crashed while setting the 502 * pipelines to reset state we must ignore the error code and 503 * reset it to 0. 504 * Since the firmware is crashed we will not send IPC messages 505 * and we are going to see errors printed, but the state of the 506 * widgets will be correct for the next boot. 507 */ 508 if (sdev->fw_state != SOF_FW_CRASHED || state != SOF_IPC4_PIPE_RESET) 509 goto free; 510 511 ret = 0; 512 } 513 514 /* update RUNNING/RESET state for all pipelines that were just triggered */ 515 for (i = 0; i < pipeline_list->count; i++) { 516 spipe = pipeline_list->pipelines[i]; 517 sof_ipc4_update_pipeline_state(sdev, state, cmd, spipe, trigger_list); 518 } 519 520 free: 521 mutex_unlock(&ipc4_data->pipeline_state_mutex); 522 kfree(trigger_list); 523 kfree(pipe_priority); 524 return ret; 525 } 526 527 static int sof_ipc4_pcm_trigger(struct snd_soc_component *component, 528 struct snd_pcm_substream *substream, int cmd) 529 { 530 int state; 531 532 /* determine the pipeline state */ 533 switch (cmd) { 534 case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: 535 case SNDRV_PCM_TRIGGER_RESUME: 536 case SNDRV_PCM_TRIGGER_START: 537 state = SOF_IPC4_PIPE_RUNNING; 538 break; 539 case SNDRV_PCM_TRIGGER_PAUSE_PUSH: 540 case SNDRV_PCM_TRIGGER_SUSPEND: 541 case SNDRV_PCM_TRIGGER_STOP: 542 state = SOF_IPC4_PIPE_PAUSED; 543 break; 544 default: 545 dev_err(component->dev, "%s: unhandled trigger cmd %d\n", __func__, cmd); 546 return -EINVAL; 547 } 548 549 /* set the pipeline state */ 550 return sof_ipc4_trigger_pipelines(component, substream, state, cmd); 551 } 552 553 static int sof_ipc4_pcm_hw_free(struct snd_soc_component *component, 554 struct snd_pcm_substream *substream) 555 { 556 /* command is not relevant with RESET, so just pass 0 */ 557 return sof_ipc4_trigger_pipelines(component, substream, SOF_IPC4_PIPE_RESET, 0); 558 } 559 560 static void ipc4_ssp_dai_config_pcm_params_match(struct snd_sof_dev *sdev, const char *link_name, 561 struct snd_pcm_hw_params *params) 562 { 563 struct snd_sof_dai_link *slink; 564 struct snd_sof_dai *dai; 565 bool dai_link_found = false; 566 int i; 567 568 list_for_each_entry(slink, &sdev->dai_link_list, list) { 569 if (!strcmp(slink->link->name, link_name)) { 570 dai_link_found = true; 571 break; 572 } 573 } 574 575 if (!dai_link_found) 576 return; 577 578 for (i = 0; i < slink->num_hw_configs; i++) { 579 struct snd_soc_tplg_hw_config *hw_config = &slink->hw_configs[i]; 580 581 if (params_rate(params) == le32_to_cpu(hw_config->fsync_rate)) { 582 /* set current config for all DAI's with matching name */ 583 list_for_each_entry(dai, &sdev->dai_list, list) 584 if (!strcmp(slink->link->name, dai->name)) 585 dai->current_config = le32_to_cpu(hw_config->id); 586 break; 587 } 588 } 589 } 590 591 /* 592 * Fixup DAI link parameters for sampling rate based on 593 * DAI copier configuration. 594 */ 595 static int sof_ipc4_pcm_dai_link_fixup_rate(struct snd_sof_dev *sdev, 596 struct snd_pcm_hw_params *params, 597 struct sof_ipc4_copier *ipc4_copier) 598 { 599 struct sof_ipc4_pin_format *pin_fmts = ipc4_copier->available_fmt.input_pin_fmts; 600 struct snd_interval *rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); 601 int num_input_formats = ipc4_copier->available_fmt.num_input_formats; 602 unsigned int fe_rate = params_rate(params); 603 bool fe_be_rate_match = false; 604 bool single_be_rate = true; 605 unsigned int be_rate; 606 int i; 607 608 if (WARN_ON_ONCE(!num_input_formats)) 609 return -EINVAL; 610 611 /* 612 * Copier does not change sampling rate, so we 613 * need to only consider the input pin information. 614 */ 615 be_rate = pin_fmts[0].audio_fmt.sampling_frequency; 616 for (i = 0; i < num_input_formats; i++) { 617 unsigned int val = pin_fmts[i].audio_fmt.sampling_frequency; 618 619 if (val != be_rate) 620 single_be_rate = false; 621 622 if (val == fe_rate) { 623 fe_be_rate_match = true; 624 break; 625 } 626 } 627 628 /* 629 * If rate is different than FE rate, topology must 630 * contain an SRC. But we do require topology to 631 * define a single rate in the DAI copier config in 632 * this case (FE rate may be variable). 633 */ 634 if (!fe_be_rate_match) { 635 if (!single_be_rate) { 636 dev_err(sdev->dev, "Unable to select sampling rate for DAI link\n"); 637 return -EINVAL; 638 } 639 640 rate->min = be_rate; 641 rate->max = rate->min; 642 } 643 644 return 0; 645 } 646 647 static int sof_ipc4_pcm_dai_link_fixup(struct snd_soc_pcm_runtime *rtd, 648 struct snd_pcm_hw_params *params) 649 { 650 struct snd_soc_component *component = snd_soc_rtdcom_lookup(rtd, SOF_AUDIO_PCM_DRV_NAME); 651 struct snd_sof_dai *dai = snd_sof_find_dai(component, rtd->dai_link->name); 652 struct snd_mask *fmt = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT); 653 struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(component); 654 struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0); 655 struct sof_ipc4_audio_format *ipc4_fmt; 656 struct sof_ipc4_copier *ipc4_copier; 657 bool single_bitdepth = false; 658 u32 valid_bits = 0; 659 int dir, ret; 660 661 if (!dai) { 662 dev_err(component->dev, "%s: No DAI found with name %s\n", __func__, 663 rtd->dai_link->name); 664 return -EINVAL; 665 } 666 667 ipc4_copier = dai->private; 668 if (!ipc4_copier) { 669 dev_err(component->dev, "%s: No private data found for DAI %s\n", 670 __func__, rtd->dai_link->name); 671 return -EINVAL; 672 } 673 674 for_each_pcm_streams(dir) { 675 struct snd_soc_dapm_widget *w = snd_soc_dai_get_widget(cpu_dai, dir); 676 677 if (w) { 678 struct sof_ipc4_available_audio_format *available_fmt = 679 &ipc4_copier->available_fmt; 680 struct snd_sof_widget *swidget = w->dobj.private; 681 struct snd_sof_widget *pipe_widget = swidget->spipe->pipe_widget; 682 struct sof_ipc4_pipeline *pipeline = pipe_widget->private; 683 684 /* Chain DMA does not use copiers, so no fixup needed */ 685 if (pipeline->use_chain_dma) 686 return 0; 687 688 if (dir == SNDRV_PCM_STREAM_PLAYBACK) { 689 if (sof_ipc4_copier_is_single_bitdepth(sdev, 690 available_fmt->output_pin_fmts, 691 available_fmt->num_output_formats)) { 692 ipc4_fmt = &available_fmt->output_pin_fmts->audio_fmt; 693 single_bitdepth = true; 694 } 695 } else { 696 if (sof_ipc4_copier_is_single_bitdepth(sdev, 697 available_fmt->input_pin_fmts, 698 available_fmt->num_input_formats)) { 699 ipc4_fmt = &available_fmt->input_pin_fmts->audio_fmt; 700 single_bitdepth = true; 701 } 702 } 703 } 704 } 705 706 ret = sof_ipc4_pcm_dai_link_fixup_rate(sdev, params, ipc4_copier); 707 if (ret) 708 return ret; 709 710 if (single_bitdepth) { 711 snd_mask_none(fmt); 712 valid_bits = SOF_IPC4_AUDIO_FORMAT_CFG_V_BIT_DEPTH(ipc4_fmt->fmt_cfg); 713 dev_dbg(component->dev, "Set %s to %d bit format\n", dai->name, valid_bits); 714 } 715 716 /* Set format if it is specified */ 717 switch (valid_bits) { 718 case 16: 719 snd_mask_set_format(fmt, SNDRV_PCM_FORMAT_S16_LE); 720 break; 721 case 24: 722 snd_mask_set_format(fmt, SNDRV_PCM_FORMAT_S24_LE); 723 break; 724 case 32: 725 snd_mask_set_format(fmt, SNDRV_PCM_FORMAT_S32_LE); 726 break; 727 default: 728 break; 729 } 730 731 switch (ipc4_copier->dai_type) { 732 case SOF_DAI_INTEL_SSP: 733 ipc4_ssp_dai_config_pcm_params_match(sdev, (char *)rtd->dai_link->name, params); 734 break; 735 default: 736 break; 737 } 738 739 return 0; 740 } 741 742 static void sof_ipc4_pcm_free(struct snd_sof_dev *sdev, struct snd_sof_pcm *spcm) 743 { 744 struct snd_sof_pcm_stream_pipeline_list *pipeline_list; 745 struct sof_ipc4_pcm_stream_priv *stream_priv; 746 int stream; 747 748 for_each_pcm_streams(stream) { 749 pipeline_list = &spcm->stream[stream].pipeline_list; 750 kfree(pipeline_list->pipelines); 751 pipeline_list->pipelines = NULL; 752 753 stream_priv = spcm->stream[stream].private; 754 kfree(stream_priv->time_info); 755 kfree(spcm->stream[stream].private); 756 spcm->stream[stream].private = NULL; 757 } 758 } 759 760 static int sof_ipc4_pcm_setup(struct snd_sof_dev *sdev, struct snd_sof_pcm *spcm) 761 { 762 struct snd_sof_pcm_stream_pipeline_list *pipeline_list; 763 struct sof_ipc4_fw_data *ipc4_data = sdev->private; 764 struct sof_ipc4_pcm_stream_priv *stream_priv; 765 struct sof_ipc4_timestamp_info *time_info; 766 bool support_info = true; 767 u32 abi_version; 768 u32 abi_offset; 769 int stream; 770 771 abi_offset = offsetof(struct sof_ipc4_fw_registers, abi_ver); 772 sof_mailbox_read(sdev, sdev->fw_info_box.offset + abi_offset, &abi_version, 773 sizeof(abi_version)); 774 775 if (abi_version < SOF_IPC4_FW_REGS_ABI_VER) 776 support_info = false; 777 778 /* For delay reporting the get_host_byte_counter callback is needed */ 779 if (!sof_ops(sdev) || !sof_ops(sdev)->get_host_byte_counter) 780 support_info = false; 781 782 for_each_pcm_streams(stream) { 783 pipeline_list = &spcm->stream[stream].pipeline_list; 784 785 /* allocate memory for max number of pipeline IDs */ 786 pipeline_list->pipelines = kcalloc(ipc4_data->max_num_pipelines, 787 sizeof(struct snd_sof_widget *), GFP_KERNEL); 788 if (!pipeline_list->pipelines) { 789 sof_ipc4_pcm_free(sdev, spcm); 790 return -ENOMEM; 791 } 792 793 stream_priv = kzalloc(sizeof(*stream_priv), GFP_KERNEL); 794 if (!stream_priv) { 795 sof_ipc4_pcm_free(sdev, spcm); 796 return -ENOMEM; 797 } 798 799 spcm->stream[stream].private = stream_priv; 800 801 if (!support_info) 802 continue; 803 804 time_info = kzalloc(sizeof(*time_info), GFP_KERNEL); 805 if (!time_info) { 806 sof_ipc4_pcm_free(sdev, spcm); 807 return -ENOMEM; 808 } 809 810 stream_priv->time_info = time_info; 811 } 812 813 return 0; 814 } 815 816 static void sof_ipc4_build_time_info(struct snd_sof_dev *sdev, struct snd_sof_pcm_stream *sps) 817 { 818 struct sof_ipc4_copier *host_copier = NULL; 819 struct sof_ipc4_copier *dai_copier = NULL; 820 struct sof_ipc4_llp_reading_slot llp_slot; 821 struct sof_ipc4_timestamp_info *time_info; 822 struct snd_soc_dapm_widget *widget; 823 struct snd_sof_dai *dai; 824 int i; 825 826 /* find host & dai to locate info in memory window */ 827 for_each_dapm_widgets(sps->list, i, widget) { 828 struct snd_sof_widget *swidget = widget->dobj.private; 829 830 if (!swidget) 831 continue; 832 833 if (WIDGET_IS_AIF(swidget->widget->id)) { 834 host_copier = swidget->private; 835 } else if (WIDGET_IS_DAI(swidget->widget->id)) { 836 dai = swidget->private; 837 dai_copier = dai->private; 838 } 839 } 840 841 /* both host and dai copier must be valid for time_info */ 842 if (!host_copier || !dai_copier) { 843 dev_err(sdev->dev, "host or dai copier are not found\n"); 844 return; 845 } 846 847 time_info = sof_ipc4_sps_to_time_info(sps); 848 time_info->host_copier = host_copier; 849 time_info->dai_copier = dai_copier; 850 time_info->llp_offset = offsetof(struct sof_ipc4_fw_registers, 851 llp_gpdma_reading_slots) + sdev->fw_info_box.offset; 852 853 /* find llp slot used by current dai */ 854 for (i = 0; i < SOF_IPC4_MAX_LLP_GPDMA_READING_SLOTS; i++) { 855 sof_mailbox_read(sdev, time_info->llp_offset, &llp_slot, sizeof(llp_slot)); 856 if (llp_slot.node_id == dai_copier->data.gtw_cfg.node_id) 857 break; 858 859 time_info->llp_offset += sizeof(llp_slot); 860 } 861 862 if (i < SOF_IPC4_MAX_LLP_GPDMA_READING_SLOTS) 863 return; 864 865 /* if no llp gpdma slot is used, check aggregated sdw slot */ 866 time_info->llp_offset = offsetof(struct sof_ipc4_fw_registers, 867 llp_sndw_reading_slots) + sdev->fw_info_box.offset; 868 for (i = 0; i < SOF_IPC4_MAX_LLP_SNDW_READING_SLOTS; i++) { 869 sof_mailbox_read(sdev, time_info->llp_offset, &llp_slot, sizeof(llp_slot)); 870 if (llp_slot.node_id == dai_copier->data.gtw_cfg.node_id) 871 break; 872 873 time_info->llp_offset += sizeof(llp_slot); 874 } 875 876 if (i < SOF_IPC4_MAX_LLP_SNDW_READING_SLOTS) 877 return; 878 879 /* check EVAD slot */ 880 time_info->llp_offset = offsetof(struct sof_ipc4_fw_registers, 881 llp_evad_reading_slot) + sdev->fw_info_box.offset; 882 sof_mailbox_read(sdev, time_info->llp_offset, &llp_slot, sizeof(llp_slot)); 883 if (llp_slot.node_id != dai_copier->data.gtw_cfg.node_id) 884 time_info->llp_offset = 0; 885 } 886 887 static int sof_ipc4_pcm_hw_params(struct snd_soc_component *component, 888 struct snd_pcm_substream *substream, 889 struct snd_pcm_hw_params *params, 890 struct snd_sof_platform_stream_params *platform_params) 891 { 892 struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(component); 893 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream); 894 struct sof_ipc4_timestamp_info *time_info; 895 struct snd_sof_pcm *spcm; 896 897 spcm = snd_sof_find_spcm_dai(component, rtd); 898 if (!spcm) 899 return -EINVAL; 900 901 time_info = sof_ipc4_sps_to_time_info(&spcm->stream[substream->stream]); 902 /* delay calculation is not supported by current fw_reg ABI */ 903 if (!time_info) 904 return 0; 905 906 time_info->stream_start_offset = SOF_IPC4_INVALID_STREAM_POSITION; 907 time_info->llp_offset = 0; 908 909 sof_ipc4_build_time_info(sdev, &spcm->stream[substream->stream]); 910 911 return 0; 912 } 913 914 static int sof_ipc4_get_stream_start_offset(struct snd_sof_dev *sdev, 915 struct snd_pcm_substream *substream, 916 struct snd_sof_pcm_stream *sps, 917 struct sof_ipc4_timestamp_info *time_info) 918 { 919 struct sof_ipc4_copier *host_copier = time_info->host_copier; 920 struct sof_ipc4_copier *dai_copier = time_info->dai_copier; 921 struct sof_ipc4_pipeline_registers ppl_reg; 922 u32 dai_sample_size; 923 u32 ch, node_index; 924 u32 offset; 925 926 if (!host_copier || !dai_copier) 927 return -EINVAL; 928 929 if (host_copier->data.gtw_cfg.node_id == SOF_IPC4_INVALID_NODE_ID) 930 return -EINVAL; 931 932 node_index = SOF_IPC4_NODE_INDEX(host_copier->data.gtw_cfg.node_id); 933 offset = offsetof(struct sof_ipc4_fw_registers, pipeline_regs) + node_index * sizeof(ppl_reg); 934 sof_mailbox_read(sdev, sdev->fw_info_box.offset + offset, &ppl_reg, sizeof(ppl_reg)); 935 if (ppl_reg.stream_start_offset == SOF_IPC4_INVALID_STREAM_POSITION) 936 return -EINVAL; 937 938 ch = dai_copier->data.out_format.fmt_cfg; 939 ch = SOF_IPC4_AUDIO_FORMAT_CFG_CHANNELS_COUNT(ch); 940 dai_sample_size = (dai_copier->data.out_format.bit_depth >> 3) * ch; 941 942 /* convert offsets to frame count */ 943 time_info->stream_start_offset = ppl_reg.stream_start_offset; 944 do_div(time_info->stream_start_offset, dai_sample_size); 945 time_info->stream_end_offset = ppl_reg.stream_end_offset; 946 do_div(time_info->stream_end_offset, dai_sample_size); 947 948 /* 949 * Calculate the wrap boundary need to be used for delay calculation 950 * The host counter is in bytes, it will wrap earlier than the frames 951 * based link counter. 952 */ 953 time_info->boundary = div64_u64(~((u64)0), 954 frames_to_bytes(substream->runtime, 1)); 955 /* Initialize the delay value to 0 (no delay) */ 956 time_info->delay = 0; 957 958 return 0; 959 } 960 961 static int sof_ipc4_pcm_pointer(struct snd_soc_component *component, 962 struct snd_pcm_substream *substream, 963 snd_pcm_uframes_t *pointer) 964 { 965 struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(component); 966 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream); 967 struct sof_ipc4_timestamp_info *time_info; 968 struct sof_ipc4_llp_reading_slot llp; 969 snd_pcm_uframes_t head_cnt, tail_cnt; 970 struct snd_sof_pcm_stream *sps; 971 u64 dai_cnt, host_cnt, host_ptr; 972 struct snd_sof_pcm *spcm; 973 int ret; 974 975 spcm = snd_sof_find_spcm_dai(component, rtd); 976 if (!spcm) 977 return -EOPNOTSUPP; 978 979 sps = &spcm->stream[substream->stream]; 980 time_info = sof_ipc4_sps_to_time_info(sps); 981 if (!time_info) 982 return -EOPNOTSUPP; 983 984 /* 985 * stream_start_offset is updated to memory window by FW based on 986 * pipeline statistics and it may be invalid if host query happens before 987 * the statistics is complete. And it will not change after the first initiailization. 988 */ 989 if (time_info->stream_start_offset == SOF_IPC4_INVALID_STREAM_POSITION) { 990 ret = sof_ipc4_get_stream_start_offset(sdev, substream, sps, time_info); 991 if (ret < 0) 992 return -EOPNOTSUPP; 993 } 994 995 /* For delay calculation we need the host counter */ 996 host_cnt = snd_sof_pcm_get_host_byte_counter(sdev, component, substream); 997 host_ptr = host_cnt; 998 999 /* convert the host_cnt to frames */ 1000 host_cnt = div64_u64(host_cnt, frames_to_bytes(substream->runtime, 1)); 1001 1002 /* 1003 * If the LLP counter is not reported by firmware in the SRAM window 1004 * then read the dai (link) counter via host accessible means if 1005 * available. 1006 */ 1007 if (!time_info->llp_offset) { 1008 dai_cnt = snd_sof_pcm_get_dai_frame_counter(sdev, component, substream); 1009 if (!dai_cnt) 1010 return -EOPNOTSUPP; 1011 } else { 1012 sof_mailbox_read(sdev, time_info->llp_offset, &llp, sizeof(llp)); 1013 dai_cnt = ((u64)llp.reading.llp_u << 32) | llp.reading.llp_l; 1014 } 1015 dai_cnt += time_info->stream_end_offset; 1016 1017 /* In two cases dai dma counter is not accurate 1018 * (1) dai pipeline is started before host pipeline 1019 * (2) multiple streams mixed into one. Each stream has the same dai dma 1020 * counter 1021 * 1022 * Firmware calculates correct stream_start_offset for all cases 1023 * including above two. 1024 * Driver subtracts stream_start_offset from dai dma counter to get 1025 * accurate one 1026 */ 1027 1028 /* 1029 * On stream start the dai counter might not yet have reached the 1030 * stream_start_offset value which means that no frames have left the 1031 * DSP yet from the audio stream (on playback, capture streams have 1032 * offset of 0 as we start capturing right away). 1033 * In this case we need to adjust the distance between the counters by 1034 * increasing the host counter by (offset - dai_counter). 1035 * Otherwise the dai_counter needs to be adjusted to reflect the number 1036 * of valid frames passed on the DAI side. 1037 * 1038 * The delay is the difference between the counters on the two 1039 * sides of the DSP. 1040 */ 1041 if (dai_cnt < time_info->stream_start_offset) { 1042 host_cnt += time_info->stream_start_offset - dai_cnt; 1043 dai_cnt = 0; 1044 } else { 1045 dai_cnt -= time_info->stream_start_offset; 1046 } 1047 1048 /* Wrap the dai counter at the boundary where the host counter wraps */ 1049 div64_u64_rem(dai_cnt, time_info->boundary, &dai_cnt); 1050 1051 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 1052 head_cnt = host_cnt; 1053 tail_cnt = dai_cnt; 1054 } else { 1055 head_cnt = dai_cnt; 1056 tail_cnt = host_cnt; 1057 } 1058 1059 if (head_cnt < tail_cnt) { 1060 time_info->delay = time_info->boundary - tail_cnt + head_cnt; 1061 goto out; 1062 } 1063 1064 time_info->delay = head_cnt - tail_cnt; 1065 1066 out: 1067 /* 1068 * Convert the host byte counter to PCM pointer which wraps in buffer 1069 * and it is in frames 1070 */ 1071 div64_u64_rem(host_ptr, snd_pcm_lib_buffer_bytes(substream), &host_ptr); 1072 *pointer = bytes_to_frames(substream->runtime, host_ptr); 1073 1074 return 0; 1075 } 1076 1077 static snd_pcm_sframes_t sof_ipc4_pcm_delay(struct snd_soc_component *component, 1078 struct snd_pcm_substream *substream) 1079 { 1080 struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream); 1081 struct sof_ipc4_timestamp_info *time_info; 1082 struct snd_sof_pcm *spcm; 1083 1084 spcm = snd_sof_find_spcm_dai(component, rtd); 1085 if (!spcm) 1086 return 0; 1087 1088 time_info = sof_ipc4_sps_to_time_info(&spcm->stream[substream->stream]); 1089 /* 1090 * Report the stored delay value calculated in the pointer callback. 1091 * In the unlikely event that the calculation was skipped/aborted, the 1092 * default 0 delay returned. 1093 */ 1094 if (time_info) 1095 return time_info->delay; 1096 1097 /* No delay information available, report 0 as delay */ 1098 return 0; 1099 1100 } 1101 1102 const struct sof_ipc_pcm_ops ipc4_pcm_ops = { 1103 .hw_params = sof_ipc4_pcm_hw_params, 1104 .trigger = sof_ipc4_pcm_trigger, 1105 .hw_free = sof_ipc4_pcm_hw_free, 1106 .dai_link_fixup = sof_ipc4_pcm_dai_link_fixup, 1107 .pcm_setup = sof_ipc4_pcm_setup, 1108 .pcm_free = sof_ipc4_pcm_free, 1109 .pointer = sof_ipc4_pcm_pointer, 1110 .delay = sof_ipc4_pcm_delay, 1111 .ipc_first_on_start = true, 1112 .platform_stop_during_hw_free = true, 1113 }; 1114