xref: /openbmc/linux/sound/soc/sof/sof-audio.c (revision fe4549b1)
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) 2019 Intel Corporation. All rights reserved.
7 //
8 // Author: Ranjani Sridharan <ranjani.sridharan@linux.intel.com>
9 //
10 
11 #include <linux/bitfield.h>
12 #include <trace/events/sof.h>
13 #include "sof-audio.h"
14 #include "sof-of-dev.h"
15 #include "ops.h"
16 
17 static bool is_virtual_widget(struct snd_sof_dev *sdev, struct snd_soc_dapm_widget *widget,
18 			      const char *func)
19 {
20 	switch (widget->id) {
21 	case snd_soc_dapm_out_drv:
22 	case snd_soc_dapm_output:
23 	case snd_soc_dapm_input:
24 		dev_dbg(sdev->dev, "%s: %s is a virtual widget\n", func, widget->name);
25 		return true;
26 	default:
27 		return false;
28 	}
29 }
30 
31 static void sof_reset_route_setup_status(struct snd_sof_dev *sdev, struct snd_sof_widget *widget)
32 {
33 	const struct sof_ipc_tplg_ops *tplg_ops = sof_ipc_get_ops(sdev, tplg);
34 	struct snd_sof_route *sroute;
35 
36 	list_for_each_entry(sroute, &sdev->route_list, list)
37 		if (sroute->src_widget == widget || sroute->sink_widget == widget) {
38 			if (sroute->setup && tplg_ops && tplg_ops->route_free)
39 				tplg_ops->route_free(sdev, sroute);
40 
41 			sroute->setup = false;
42 		}
43 }
44 
45 static int sof_widget_free_unlocked(struct snd_sof_dev *sdev,
46 				    struct snd_sof_widget *swidget)
47 {
48 	const struct sof_ipc_tplg_ops *tplg_ops = sof_ipc_get_ops(sdev, tplg);
49 	struct snd_sof_pipeline *spipe = swidget->spipe;
50 	struct snd_sof_widget *pipe_widget;
51 	int err = 0;
52 	int ret;
53 
54 	if (!swidget->private)
55 		return 0;
56 
57 	trace_sof_widget_free(swidget);
58 
59 	/* only free when use_count is 0 */
60 	if (--swidget->use_count)
61 		return 0;
62 
63 	pipe_widget = swidget->spipe->pipe_widget;
64 
65 	/* reset route setup status for all routes that contain this widget */
66 	sof_reset_route_setup_status(sdev, swidget);
67 
68 	/* free DAI config and continue to free widget even if it fails */
69 	if (WIDGET_IS_DAI(swidget->id)) {
70 		struct snd_sof_dai_config_data data;
71 		unsigned int flags = SOF_DAI_CONFIG_FLAGS_HW_FREE;
72 
73 		data.dai_data = DMA_CHAN_INVALID;
74 
75 		if (tplg_ops && tplg_ops->dai_config) {
76 			err = tplg_ops->dai_config(sdev, swidget, flags, &data);
77 			if (err < 0)
78 				dev_err(sdev->dev, "failed to free config for widget %s\n",
79 					swidget->widget->name);
80 		}
81 	}
82 
83 	/* continue to disable core even if IPC fails */
84 	if (tplg_ops && tplg_ops->widget_free) {
85 		ret = tplg_ops->widget_free(sdev, swidget);
86 		if (ret < 0 && !err)
87 			err = ret;
88 	}
89 
90 	/*
91 	 * decrement ref count for cores associated with all modules in the pipeline and clear
92 	 * the complete flag
93 	 */
94 	if (swidget->id == snd_soc_dapm_scheduler) {
95 		int i;
96 
97 		for_each_set_bit(i, &spipe->core_mask, sdev->num_cores) {
98 			ret = snd_sof_dsp_core_put(sdev, i);
99 			if (ret < 0) {
100 				dev_err(sdev->dev, "failed to disable target core: %d for pipeline %s\n",
101 					i, swidget->widget->name);
102 				if (!err)
103 					err = ret;
104 			}
105 		}
106 		swidget->spipe->complete = 0;
107 	}
108 
109 	/*
110 	 * free the scheduler widget (same as pipe_widget) associated with the current swidget.
111 	 * skip for static pipelines
112 	 */
113 	if (swidget->dynamic_pipeline_widget && swidget->id != snd_soc_dapm_scheduler) {
114 		ret = sof_widget_free_unlocked(sdev, pipe_widget);
115 		if (ret < 0 && !err)
116 			err = ret;
117 	}
118 
119 	if (!err)
120 		dev_dbg(sdev->dev, "widget %s freed\n", swidget->widget->name);
121 
122 	return err;
123 }
124 
125 int sof_widget_free(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget)
126 {
127 	int ret;
128 
129 	mutex_lock(&swidget->setup_mutex);
130 	ret = sof_widget_free_unlocked(sdev, swidget);
131 	mutex_unlock(&swidget->setup_mutex);
132 
133 	return ret;
134 }
135 EXPORT_SYMBOL(sof_widget_free);
136 
137 static int sof_widget_setup_unlocked(struct snd_sof_dev *sdev,
138 				     struct snd_sof_widget *swidget)
139 {
140 	const struct sof_ipc_tplg_ops *tplg_ops = sof_ipc_get_ops(sdev, tplg);
141 	struct snd_sof_pipeline *spipe = swidget->spipe;
142 	bool use_count_decremented = false;
143 	int ret;
144 	int i;
145 
146 	/* skip if there is no private data */
147 	if (!swidget->private)
148 		return 0;
149 
150 	trace_sof_widget_setup(swidget);
151 
152 	/* widget already set up */
153 	if (++swidget->use_count > 1)
154 		return 0;
155 
156 	/*
157 	 * The scheduler widget for a pipeline is not part of the connected DAPM
158 	 * widget list and it needs to be set up before the widgets in the pipeline
159 	 * are set up. The use_count for the scheduler widget is incremented for every
160 	 * widget in a given pipeline to ensure that it is freed only after the last
161 	 * widget in the pipeline is freed. Skip setting up scheduler widget for static pipelines.
162 	 */
163 	if (swidget->dynamic_pipeline_widget && swidget->id != snd_soc_dapm_scheduler) {
164 		if (!swidget->spipe || !swidget->spipe->pipe_widget) {
165 			dev_err(sdev->dev, "No pipeline set for %s\n", swidget->widget->name);
166 			ret = -EINVAL;
167 			goto use_count_dec;
168 		}
169 
170 		ret = sof_widget_setup_unlocked(sdev, swidget->spipe->pipe_widget);
171 		if (ret < 0)
172 			goto use_count_dec;
173 	}
174 
175 	/* update ref count for cores associated with all modules in the pipeline */
176 	if (swidget->id == snd_soc_dapm_scheduler) {
177 		for_each_set_bit(i, &spipe->core_mask, sdev->num_cores) {
178 			ret = snd_sof_dsp_core_get(sdev, i);
179 			if (ret < 0) {
180 				dev_err(sdev->dev, "failed to enable target core %d for pipeline %s\n",
181 					i, swidget->widget->name);
182 				goto pipe_widget_free;
183 			}
184 		}
185 	}
186 
187 	/* setup widget in the DSP */
188 	if (tplg_ops && tplg_ops->widget_setup) {
189 		ret = tplg_ops->widget_setup(sdev, swidget);
190 		if (ret < 0)
191 			goto pipe_widget_free;
192 	}
193 
194 	/* send config for DAI components */
195 	if (WIDGET_IS_DAI(swidget->id)) {
196 		unsigned int flags = SOF_DAI_CONFIG_FLAGS_HW_PARAMS;
197 
198 		/*
199 		 * The config flags saved during BE DAI hw_params will be used for IPC3. IPC4 does
200 		 * not use the flags argument.
201 		 */
202 		if (tplg_ops && tplg_ops->dai_config) {
203 			ret = tplg_ops->dai_config(sdev, swidget, flags, NULL);
204 			if (ret < 0)
205 				goto widget_free;
206 		}
207 	}
208 
209 	/* restore kcontrols for widget */
210 	if (tplg_ops && tplg_ops->control && tplg_ops->control->widget_kcontrol_setup) {
211 		ret = tplg_ops->control->widget_kcontrol_setup(sdev, swidget);
212 		if (ret < 0)
213 			goto widget_free;
214 	}
215 
216 	dev_dbg(sdev->dev, "widget %s setup complete\n", swidget->widget->name);
217 
218 	return 0;
219 
220 widget_free:
221 	/* widget use_count will be decremented by sof_widget_free() */
222 	sof_widget_free_unlocked(sdev, swidget);
223 	use_count_decremented = true;
224 pipe_widget_free:
225 	if (swidget->id != snd_soc_dapm_scheduler) {
226 		sof_widget_free_unlocked(sdev, swidget->spipe->pipe_widget);
227 	} else {
228 		int j;
229 
230 		/* decrement ref count for all cores that were updated previously */
231 		for_each_set_bit(j, &spipe->core_mask, sdev->num_cores) {
232 			if (j >= i)
233 				break;
234 			snd_sof_dsp_core_put(sdev, j);
235 		}
236 	}
237 use_count_dec:
238 	if (!use_count_decremented)
239 		swidget->use_count--;
240 
241 	return ret;
242 }
243 
244 int sof_widget_setup(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget)
245 {
246 	int ret;
247 
248 	mutex_lock(&swidget->setup_mutex);
249 	ret = sof_widget_setup_unlocked(sdev, swidget);
250 	mutex_unlock(&swidget->setup_mutex);
251 
252 	return ret;
253 }
254 EXPORT_SYMBOL(sof_widget_setup);
255 
256 int sof_route_setup(struct snd_sof_dev *sdev, struct snd_soc_dapm_widget *wsource,
257 		    struct snd_soc_dapm_widget *wsink)
258 {
259 	const struct sof_ipc_tplg_ops *tplg_ops = sof_ipc_get_ops(sdev, tplg);
260 	struct snd_sof_widget *src_widget = wsource->dobj.private;
261 	struct snd_sof_widget *sink_widget = wsink->dobj.private;
262 	struct snd_sof_route *sroute;
263 	bool route_found = false;
264 
265 	/* ignore routes involving virtual widgets in topology */
266 	if (is_virtual_widget(sdev, src_widget->widget, __func__) ||
267 	    is_virtual_widget(sdev, sink_widget->widget, __func__))
268 		return 0;
269 
270 	/* find route matching source and sink widgets */
271 	list_for_each_entry(sroute, &sdev->route_list, list)
272 		if (sroute->src_widget == src_widget && sroute->sink_widget == sink_widget) {
273 			route_found = true;
274 			break;
275 		}
276 
277 	if (!route_found) {
278 		dev_err(sdev->dev, "error: cannot find SOF route for source %s -> %s sink\n",
279 			wsource->name, wsink->name);
280 		return -EINVAL;
281 	}
282 
283 	/* nothing to do if route is already set up */
284 	if (sroute->setup)
285 		return 0;
286 
287 	if (tplg_ops && tplg_ops->route_setup) {
288 		int ret = tplg_ops->route_setup(sdev, sroute);
289 
290 		if (ret < 0)
291 			return ret;
292 	}
293 
294 	sroute->setup = true;
295 	return 0;
296 }
297 
298 static int sof_setup_pipeline_connections(struct snd_sof_dev *sdev,
299 					  struct snd_soc_dapm_widget_list *list, int dir)
300 {
301 	const struct sof_ipc_tplg_ops *tplg_ops = sof_ipc_get_ops(sdev, tplg);
302 	struct snd_soc_dapm_widget *widget;
303 	struct snd_sof_route *sroute;
304 	struct snd_soc_dapm_path *p;
305 	int ret = 0;
306 	int i;
307 
308 	/*
309 	 * Set up connections between widgets in the sink/source paths based on direction.
310 	 * Some non-SOF widgets exist in topology either for compatibility or for the
311 	 * purpose of connecting a pipeline from a host to a DAI in order to receive the DAPM
312 	 * events. But they are not handled by the firmware. So ignore them.
313 	 */
314 	if (dir == SNDRV_PCM_STREAM_PLAYBACK) {
315 		for_each_dapm_widgets(list, i, widget) {
316 			if (!widget->dobj.private)
317 				continue;
318 
319 			snd_soc_dapm_widget_for_each_sink_path(widget, p) {
320 				if (!widget_in_list(list, p->sink))
321 					continue;
322 
323 				if (p->sink->dobj.private) {
324 					ret = sof_route_setup(sdev, widget, p->sink);
325 					if (ret < 0)
326 						return ret;
327 				}
328 			}
329 		}
330 	} else {
331 		for_each_dapm_widgets(list, i, widget) {
332 			if (!widget->dobj.private)
333 				continue;
334 
335 			snd_soc_dapm_widget_for_each_source_path(widget, p) {
336 				if (!widget_in_list(list, p->source))
337 					continue;
338 
339 				if (p->source->dobj.private) {
340 					ret = sof_route_setup(sdev, p->source, widget);
341 					if (ret < 0)
342 						return ret;
343 				}
344 			}
345 		}
346 	}
347 
348 	/*
349 	 * The above loop handles connections between widgets that belong to the DAPM widget list.
350 	 * This is not sufficient to handle loopback cases between pipelines configured with
351 	 * different directions, e.g. a sidetone or an amplifier feedback connected to a speaker
352 	 * protection module.
353 	 */
354 	list_for_each_entry(sroute, &sdev->route_list, list) {
355 		bool src_widget_in_dapm_list, sink_widget_in_dapm_list;
356 		struct snd_sof_widget *swidget;
357 
358 		if (sroute->setup)
359 			continue;
360 
361 		src_widget_in_dapm_list = widget_in_list(list, sroute->src_widget->widget);
362 		sink_widget_in_dapm_list = widget_in_list(list, sroute->sink_widget->widget);
363 
364 		/*
365 		 * if both source and sink are in the DAPM list, the route must already have been
366 		 * set up above. And if neither are in the DAPM list, the route shouldn't be
367 		 * handled now.
368 		 */
369 		if (src_widget_in_dapm_list == sink_widget_in_dapm_list)
370 			continue;
371 
372 		/*
373 		 * At this point either the source widget or the sink widget is in the DAPM list
374 		 * with a route that might need to be set up. Check the use_count of the widget
375 		 * that is not in the DAPM list to confirm if it is in use currently before setting
376 		 * up the route.
377 		 */
378 		if (src_widget_in_dapm_list)
379 			swidget = sroute->sink_widget;
380 		else
381 			swidget = sroute->src_widget;
382 
383 		mutex_lock(&swidget->setup_mutex);
384 		if (!swidget->use_count) {
385 			mutex_unlock(&swidget->setup_mutex);
386 			continue;
387 		}
388 
389 		if (tplg_ops && tplg_ops->route_setup) {
390 			/*
391 			 * this route will get freed when either the source widget or the sink
392 			 * widget is freed during hw_free
393 			 */
394 			ret = tplg_ops->route_setup(sdev, sroute);
395 			if (!ret)
396 				sroute->setup = true;
397 		}
398 
399 		mutex_unlock(&swidget->setup_mutex);
400 
401 		if (ret < 0)
402 			return ret;
403 	}
404 
405 	return 0;
406 }
407 
408 static void
409 sof_unprepare_widgets_in_path(struct snd_sof_dev *sdev, struct snd_soc_dapm_widget *widget,
410 			      struct snd_soc_dapm_widget_list *list)
411 {
412 	const struct sof_ipc_tplg_ops *tplg_ops = sof_ipc_get_ops(sdev, tplg);
413 	struct snd_sof_widget *swidget = widget->dobj.private;
414 	const struct sof_ipc_tplg_widget_ops *widget_ops;
415 	struct snd_soc_dapm_path *p;
416 
417 	if (is_virtual_widget(sdev, widget, __func__))
418 		return;
419 
420 	/* skip if the widget is in use or if it is already unprepared */
421 	if (!swidget || !swidget->prepared || swidget->use_count > 0)
422 		goto sink_unprepare;
423 
424 	widget_ops = tplg_ops ? tplg_ops->widget : NULL;
425 	if (widget_ops && widget_ops[widget->id].ipc_unprepare)
426 		/* unprepare the source widget */
427 		widget_ops[widget->id].ipc_unprepare(swidget);
428 
429 	swidget->prepared = false;
430 
431 sink_unprepare:
432 	/* unprepare all widgets in the sink paths */
433 	snd_soc_dapm_widget_for_each_sink_path(widget, p) {
434 		if (!widget_in_list(list, p->sink))
435 			continue;
436 		if (!p->walking && p->sink->dobj.private) {
437 			p->walking = true;
438 			sof_unprepare_widgets_in_path(sdev, p->sink, list);
439 			p->walking = false;
440 		}
441 	}
442 }
443 
444 static int
445 sof_prepare_widgets_in_path(struct snd_sof_dev *sdev, struct snd_soc_dapm_widget *widget,
446 			    struct snd_pcm_hw_params *fe_params,
447 			    struct snd_sof_platform_stream_params *platform_params,
448 			    struct snd_pcm_hw_params *pipeline_params, int dir,
449 			    struct snd_soc_dapm_widget_list *list)
450 {
451 	const struct sof_ipc_tplg_ops *tplg_ops = sof_ipc_get_ops(sdev, tplg);
452 	struct snd_sof_widget *swidget = widget->dobj.private;
453 	const struct sof_ipc_tplg_widget_ops *widget_ops;
454 	struct snd_soc_dapm_path *p;
455 	int ret;
456 
457 	if (is_virtual_widget(sdev, widget, __func__))
458 		return 0;
459 
460 	widget_ops = tplg_ops ? tplg_ops->widget : NULL;
461 	if (!widget_ops)
462 		return 0;
463 
464 	if (!swidget || !widget_ops[widget->id].ipc_prepare || swidget->prepared)
465 		goto sink_prepare;
466 
467 	/* prepare the source widget */
468 	ret = widget_ops[widget->id].ipc_prepare(swidget, fe_params, platform_params,
469 					     pipeline_params, dir);
470 	if (ret < 0) {
471 		dev_err(sdev->dev, "failed to prepare widget %s\n", widget->name);
472 		return ret;
473 	}
474 
475 	swidget->prepared = true;
476 
477 sink_prepare:
478 	/* prepare all widgets in the sink paths */
479 	snd_soc_dapm_widget_for_each_sink_path(widget, p) {
480 		if (!widget_in_list(list, p->sink))
481 			continue;
482 		if (!p->walking && p->sink->dobj.private) {
483 			p->walking = true;
484 			ret = sof_prepare_widgets_in_path(sdev, p->sink,  fe_params,
485 							  platform_params, pipeline_params, dir,
486 							  list);
487 			p->walking = false;
488 			if (ret < 0) {
489 				/* unprepare the source widget */
490 				if (widget_ops[widget->id].ipc_unprepare &&
491 				    swidget && swidget->prepared) {
492 					widget_ops[widget->id].ipc_unprepare(swidget);
493 					swidget->prepared = false;
494 				}
495 				return ret;
496 			}
497 		}
498 	}
499 
500 	return 0;
501 }
502 
503 /*
504  * free all widgets in the sink path starting from the source widget
505  * (DAI type for capture, AIF type for playback)
506  */
507 static int sof_free_widgets_in_path(struct snd_sof_dev *sdev, struct snd_soc_dapm_widget *widget,
508 				    int dir, struct snd_sof_pcm *spcm)
509 {
510 	struct snd_soc_dapm_widget_list *list = spcm->stream[dir].list;
511 	struct snd_soc_dapm_path *p;
512 	int err;
513 	int ret = 0;
514 
515 	if (is_virtual_widget(sdev, widget, __func__))
516 		return 0;
517 
518 	if (widget->dobj.private) {
519 		err = sof_widget_free(sdev, widget->dobj.private);
520 		if (err < 0)
521 			ret = err;
522 	}
523 
524 	/* free all widgets in the sink paths even in case of error to keep use counts balanced */
525 	snd_soc_dapm_widget_for_each_sink_path(widget, p) {
526 		if (!p->walking) {
527 			if (!widget_in_list(list, p->sink))
528 				continue;
529 
530 			p->walking = true;
531 
532 			err = sof_free_widgets_in_path(sdev, p->sink, dir, spcm);
533 			if (err < 0)
534 				ret = err;
535 			p->walking = false;
536 		}
537 	}
538 
539 	return ret;
540 }
541 
542 /*
543  * set up all widgets in the sink path starting from the source widget
544  * (DAI type for capture, AIF type for playback).
545  * The error path in this function ensures that all successfully set up widgets getting freed.
546  */
547 static int sof_set_up_widgets_in_path(struct snd_sof_dev *sdev, struct snd_soc_dapm_widget *widget,
548 				      int dir, struct snd_sof_pcm *spcm)
549 {
550 	struct snd_sof_pcm_stream_pipeline_list *pipeline_list = &spcm->stream[dir].pipeline_list;
551 	struct snd_soc_dapm_widget_list *list = spcm->stream[dir].list;
552 	struct snd_sof_widget *swidget = widget->dobj.private;
553 	struct snd_sof_pipeline *spipe;
554 	struct snd_soc_dapm_path *p;
555 	int ret;
556 
557 	if (is_virtual_widget(sdev, widget, __func__))
558 		return 0;
559 
560 	if (swidget) {
561 		int i;
562 
563 		ret = sof_widget_setup(sdev, widget->dobj.private);
564 		if (ret < 0)
565 			return ret;
566 
567 		/* skip populating the pipe_widgets array if it is NULL */
568 		if (!pipeline_list->pipelines)
569 			goto sink_setup;
570 
571 		/*
572 		 * Add the widget's pipe_widget to the list of pipelines to be triggered if not
573 		 * already in the list. This will result in the pipelines getting added in the
574 		 * order source to sink.
575 		 */
576 		for (i = 0; i < pipeline_list->count; i++) {
577 			spipe = pipeline_list->pipelines[i];
578 			if (spipe == swidget->spipe)
579 				break;
580 		}
581 
582 		if (i == pipeline_list->count) {
583 			pipeline_list->count++;
584 			pipeline_list->pipelines[i] = swidget->spipe;
585 		}
586 	}
587 
588 sink_setup:
589 	snd_soc_dapm_widget_for_each_sink_path(widget, p) {
590 		if (!p->walking) {
591 			if (!widget_in_list(list, p->sink))
592 				continue;
593 
594 			p->walking = true;
595 
596 			ret = sof_set_up_widgets_in_path(sdev, p->sink, dir, spcm);
597 			p->walking = false;
598 			if (ret < 0) {
599 				if (swidget)
600 					sof_widget_free(sdev, swidget);
601 				return ret;
602 			}
603 		}
604 	}
605 
606 	return 0;
607 }
608 
609 static int
610 sof_walk_widgets_in_order(struct snd_sof_dev *sdev, struct snd_sof_pcm *spcm,
611 			  struct snd_pcm_hw_params *fe_params,
612 			  struct snd_sof_platform_stream_params *platform_params, int dir,
613 			  enum sof_widget_op op)
614 {
615 	struct snd_soc_dapm_widget_list *list = spcm->stream[dir].list;
616 	struct snd_soc_dapm_widget *widget;
617 	char *str;
618 	int ret = 0;
619 	int i;
620 
621 	if (!list)
622 		return 0;
623 
624 	for_each_dapm_widgets(list, i, widget) {
625 		if (is_virtual_widget(sdev, widget, __func__))
626 			continue;
627 
628 		/* starting widget for playback is AIF type */
629 		if (dir == SNDRV_PCM_STREAM_PLAYBACK && widget->id != snd_soc_dapm_aif_in)
630 			continue;
631 
632 		/* starting widget for capture is DAI type */
633 		if (dir == SNDRV_PCM_STREAM_CAPTURE && widget->id != snd_soc_dapm_dai_out)
634 			continue;
635 
636 		switch (op) {
637 		case SOF_WIDGET_SETUP:
638 			ret = sof_set_up_widgets_in_path(sdev, widget, dir, spcm);
639 			str = "set up";
640 			break;
641 		case SOF_WIDGET_FREE:
642 			ret = sof_free_widgets_in_path(sdev, widget, dir, spcm);
643 			str = "free";
644 			break;
645 		case SOF_WIDGET_PREPARE:
646 		{
647 			struct snd_pcm_hw_params pipeline_params;
648 
649 			str = "prepare";
650 			/*
651 			 * When walking the list of connected widgets, the pipeline_params for each
652 			 * widget is modified by the source widget in the path. Use a local
653 			 * copy of the runtime params as the pipeline_params so that the runtime
654 			 * params does not get overwritten.
655 			 */
656 			memcpy(&pipeline_params, fe_params, sizeof(*fe_params));
657 
658 			ret = sof_prepare_widgets_in_path(sdev, widget, fe_params, platform_params,
659 							  &pipeline_params, dir, list);
660 			break;
661 		}
662 		case SOF_WIDGET_UNPREPARE:
663 			sof_unprepare_widgets_in_path(sdev, widget, list);
664 			break;
665 		default:
666 			dev_err(sdev->dev, "Invalid widget op %d\n", op);
667 			return -EINVAL;
668 		}
669 		if (ret < 0) {
670 			dev_err(sdev->dev, "Failed to %s connected widgets\n", str);
671 			return ret;
672 		}
673 	}
674 
675 	return 0;
676 }
677 
678 int sof_widget_list_setup(struct snd_sof_dev *sdev, struct snd_sof_pcm *spcm,
679 			  struct snd_pcm_hw_params *fe_params,
680 			  struct snd_sof_platform_stream_params *platform_params,
681 			  int dir)
682 {
683 	const struct sof_ipc_tplg_ops *tplg_ops = sof_ipc_get_ops(sdev, tplg);
684 	struct snd_soc_dapm_widget_list *list = spcm->stream[dir].list;
685 	struct snd_soc_dapm_widget *widget;
686 	int i, ret;
687 
688 	/* nothing to set up */
689 	if (!list)
690 		return 0;
691 
692 	/*
693 	 * Prepare widgets for set up. The prepare step is used to allocate memory, assign
694 	 * instance ID and pick the widget configuration based on the runtime PCM params.
695 	 */
696 	ret = sof_walk_widgets_in_order(sdev, spcm, fe_params, platform_params,
697 					dir, SOF_WIDGET_PREPARE);
698 	if (ret < 0)
699 		return ret;
700 
701 	/* Set up is used to send the IPC to the DSP to create the widget */
702 	ret = sof_walk_widgets_in_order(sdev, spcm, fe_params, platform_params,
703 					dir, SOF_WIDGET_SETUP);
704 	if (ret < 0) {
705 		sof_walk_widgets_in_order(sdev, spcm, fe_params, platform_params,
706 					  dir, SOF_WIDGET_UNPREPARE);
707 		return ret;
708 	}
709 
710 	/*
711 	 * error in setting pipeline connections will result in route status being reset for
712 	 * routes that were successfully set up when the widgets are freed.
713 	 */
714 	ret = sof_setup_pipeline_connections(sdev, list, dir);
715 	if (ret < 0)
716 		goto widget_free;
717 
718 	/* complete pipelines */
719 	for_each_dapm_widgets(list, i, widget) {
720 		struct snd_sof_widget *swidget = widget->dobj.private;
721 		struct snd_sof_widget *pipe_widget;
722 		struct snd_sof_pipeline *spipe;
723 
724 		if (!swidget || sdev->dspless_mode_selected)
725 			continue;
726 
727 		spipe = swidget->spipe;
728 		if (!spipe) {
729 			dev_err(sdev->dev, "no pipeline found for %s\n",
730 				swidget->widget->name);
731 			ret = -EINVAL;
732 			goto widget_free;
733 		}
734 
735 		pipe_widget = spipe->pipe_widget;
736 		if (!pipe_widget) {
737 			dev_err(sdev->dev, "error: no pipeline widget found for %s\n",
738 				swidget->widget->name);
739 			ret = -EINVAL;
740 			goto widget_free;
741 		}
742 
743 		if (spipe->complete)
744 			continue;
745 
746 		if (tplg_ops && tplg_ops->pipeline_complete) {
747 			spipe->complete = tplg_ops->pipeline_complete(sdev, pipe_widget);
748 			if (spipe->complete < 0) {
749 				ret = spipe->complete;
750 				goto widget_free;
751 			}
752 		}
753 	}
754 
755 	return 0;
756 
757 widget_free:
758 	sof_walk_widgets_in_order(sdev, spcm, fe_params, platform_params, dir,
759 				  SOF_WIDGET_FREE);
760 	sof_walk_widgets_in_order(sdev, spcm, NULL, NULL, dir, SOF_WIDGET_UNPREPARE);
761 
762 	return ret;
763 }
764 
765 int sof_widget_list_free(struct snd_sof_dev *sdev, struct snd_sof_pcm *spcm, int dir)
766 {
767 	struct snd_sof_pcm_stream_pipeline_list *pipeline_list = &spcm->stream[dir].pipeline_list;
768 	struct snd_soc_dapm_widget_list *list = spcm->stream[dir].list;
769 	int ret;
770 
771 	/* nothing to free */
772 	if (!list)
773 		return 0;
774 
775 	/* send IPC to free widget in the DSP */
776 	ret = sof_walk_widgets_in_order(sdev, spcm, NULL, NULL, dir, SOF_WIDGET_FREE);
777 
778 	/* unprepare the widget */
779 	sof_walk_widgets_in_order(sdev, spcm, NULL, NULL, dir, SOF_WIDGET_UNPREPARE);
780 
781 	snd_soc_dapm_dai_free_widgets(&list);
782 	spcm->stream[dir].list = NULL;
783 
784 	pipeline_list->count = 0;
785 
786 	return ret;
787 }
788 
789 /*
790  * helper to determine if there are only D0i3 compatible
791  * streams active
792  */
793 bool snd_sof_dsp_only_d0i3_compatible_stream_active(struct snd_sof_dev *sdev)
794 {
795 	struct snd_pcm_substream *substream;
796 	struct snd_sof_pcm *spcm;
797 	bool d0i3_compatible_active = false;
798 	int dir;
799 
800 	list_for_each_entry(spcm, &sdev->pcm_list, list) {
801 		for_each_pcm_streams(dir) {
802 			substream = spcm->stream[dir].substream;
803 			if (!substream || !substream->runtime)
804 				continue;
805 
806 			/*
807 			 * substream->runtime being not NULL indicates
808 			 * that the stream is open. No need to check the
809 			 * stream state.
810 			 */
811 			if (!spcm->stream[dir].d0i3_compatible)
812 				return false;
813 
814 			d0i3_compatible_active = true;
815 		}
816 	}
817 
818 	return d0i3_compatible_active;
819 }
820 EXPORT_SYMBOL(snd_sof_dsp_only_d0i3_compatible_stream_active);
821 
822 bool snd_sof_stream_suspend_ignored(struct snd_sof_dev *sdev)
823 {
824 	struct snd_sof_pcm *spcm;
825 
826 	list_for_each_entry(spcm, &sdev->pcm_list, list) {
827 		if (spcm->stream[SNDRV_PCM_STREAM_PLAYBACK].suspend_ignored ||
828 		    spcm->stream[SNDRV_PCM_STREAM_CAPTURE].suspend_ignored)
829 			return true;
830 	}
831 
832 	return false;
833 }
834 
835 int sof_pcm_stream_free(struct snd_sof_dev *sdev, struct snd_pcm_substream *substream,
836 			struct snd_sof_pcm *spcm, int dir, bool free_widget_list)
837 {
838 	const struct sof_ipc_pcm_ops *pcm_ops = sof_ipc_get_ops(sdev, pcm);
839 	int ret;
840 
841 	if (spcm->prepared[substream->stream]) {
842 		/* stop DMA first if needed */
843 		if (pcm_ops && pcm_ops->platform_stop_during_hw_free)
844 			snd_sof_pcm_platform_trigger(sdev, substream, SNDRV_PCM_TRIGGER_STOP);
845 
846 		/* Send PCM_FREE IPC to reset pipeline */
847 		if (pcm_ops && pcm_ops->hw_free) {
848 			ret = pcm_ops->hw_free(sdev->component, substream);
849 			if (ret < 0)
850 				return ret;
851 		}
852 
853 		spcm->prepared[substream->stream] = false;
854 	}
855 
856 	/* reset the DMA */
857 	ret = snd_sof_pcm_platform_hw_free(sdev, substream);
858 	if (ret < 0)
859 		return ret;
860 
861 	/* free widget list */
862 	if (free_widget_list) {
863 		ret = sof_widget_list_free(sdev, spcm, dir);
864 		if (ret < 0)
865 			dev_err(sdev->dev, "failed to free widgets during suspend\n");
866 	}
867 
868 	return ret;
869 }
870 
871 /*
872  * Generic object lookup APIs.
873  */
874 
875 struct snd_sof_pcm *snd_sof_find_spcm_name(struct snd_soc_component *scomp,
876 					   const char *name)
877 {
878 	struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
879 	struct snd_sof_pcm *spcm;
880 
881 	list_for_each_entry(spcm, &sdev->pcm_list, list) {
882 		/* match with PCM dai name */
883 		if (strcmp(spcm->pcm.dai_name, name) == 0)
884 			return spcm;
885 
886 		/* match with playback caps name if set */
887 		if (*spcm->pcm.caps[0].name &&
888 		    !strcmp(spcm->pcm.caps[0].name, name))
889 			return spcm;
890 
891 		/* match with capture caps name if set */
892 		if (*spcm->pcm.caps[1].name &&
893 		    !strcmp(spcm->pcm.caps[1].name, name))
894 			return spcm;
895 	}
896 
897 	return NULL;
898 }
899 
900 struct snd_sof_pcm *snd_sof_find_spcm_comp(struct snd_soc_component *scomp,
901 					   unsigned int comp_id,
902 					   int *direction)
903 {
904 	struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
905 	struct snd_sof_pcm *spcm;
906 	int dir;
907 
908 	list_for_each_entry(spcm, &sdev->pcm_list, list) {
909 		for_each_pcm_streams(dir) {
910 			if (spcm->stream[dir].comp_id == comp_id) {
911 				*direction = dir;
912 				return spcm;
913 			}
914 		}
915 	}
916 
917 	return NULL;
918 }
919 
920 struct snd_sof_widget *snd_sof_find_swidget(struct snd_soc_component *scomp,
921 					    const char *name)
922 {
923 	struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
924 	struct snd_sof_widget *swidget;
925 
926 	list_for_each_entry(swidget, &sdev->widget_list, list) {
927 		if (strcmp(name, swidget->widget->name) == 0)
928 			return swidget;
929 	}
930 
931 	return NULL;
932 }
933 
934 /* find widget by stream name and direction */
935 struct snd_sof_widget *
936 snd_sof_find_swidget_sname(struct snd_soc_component *scomp,
937 			   const char *pcm_name, int dir)
938 {
939 	struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
940 	struct snd_sof_widget *swidget;
941 	enum snd_soc_dapm_type type;
942 
943 	if (dir == SNDRV_PCM_STREAM_PLAYBACK)
944 		type = snd_soc_dapm_aif_in;
945 	else
946 		type = snd_soc_dapm_aif_out;
947 
948 	list_for_each_entry(swidget, &sdev->widget_list, list) {
949 		if (!strcmp(pcm_name, swidget->widget->sname) &&
950 		    swidget->id == type)
951 			return swidget;
952 	}
953 
954 	return NULL;
955 }
956 
957 struct snd_sof_dai *snd_sof_find_dai(struct snd_soc_component *scomp,
958 				     const char *name)
959 {
960 	struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
961 	struct snd_sof_dai *dai;
962 
963 	list_for_each_entry(dai, &sdev->dai_list, list) {
964 		if (dai->name && (strcmp(name, dai->name) == 0))
965 			return dai;
966 	}
967 
968 	return NULL;
969 }
970 
971 static int sof_dai_get_clk(struct snd_soc_pcm_runtime *rtd, int clk_type)
972 {
973 	struct snd_soc_component *component =
974 		snd_soc_rtdcom_lookup(rtd, SOF_AUDIO_PCM_DRV_NAME);
975 	struct snd_sof_dai *dai =
976 		snd_sof_find_dai(component, (char *)rtd->dai_link->name);
977 	struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(component);
978 	const struct sof_ipc_tplg_ops *tplg_ops = sof_ipc_get_ops(sdev, tplg);
979 
980 	/* use the tplg configured mclk if existed */
981 	if (!dai)
982 		return 0;
983 
984 	if (tplg_ops && tplg_ops->dai_get_clk)
985 		return tplg_ops->dai_get_clk(sdev, dai, clk_type);
986 
987 	return 0;
988 }
989 
990 /*
991  * Helper to get SSP MCLK from a pcm_runtime.
992  * Return 0 if not exist.
993  */
994 int sof_dai_get_mclk(struct snd_soc_pcm_runtime *rtd)
995 {
996 	return sof_dai_get_clk(rtd, SOF_DAI_CLK_INTEL_SSP_MCLK);
997 }
998 EXPORT_SYMBOL(sof_dai_get_mclk);
999 
1000 /*
1001  * Helper to get SSP BCLK from a pcm_runtime.
1002  * Return 0 if not exist.
1003  */
1004 int sof_dai_get_bclk(struct snd_soc_pcm_runtime *rtd)
1005 {
1006 	return sof_dai_get_clk(rtd, SOF_DAI_CLK_INTEL_SSP_BCLK);
1007 }
1008 EXPORT_SYMBOL(sof_dai_get_bclk);
1009 
1010 static struct snd_sof_of_mach *sof_of_machine_select(struct snd_sof_dev *sdev)
1011 {
1012 	struct snd_sof_pdata *sof_pdata = sdev->pdata;
1013 	const struct sof_dev_desc *desc = sof_pdata->desc;
1014 	struct snd_sof_of_mach *mach = desc->of_machines;
1015 
1016 	if (!mach)
1017 		return NULL;
1018 
1019 	for (; mach->compatible; mach++) {
1020 		if (of_machine_is_compatible(mach->compatible)) {
1021 			sof_pdata->tplg_filename = mach->sof_tplg_filename;
1022 			if (mach->fw_filename)
1023 				sof_pdata->fw_filename = mach->fw_filename;
1024 
1025 			return mach;
1026 		}
1027 	}
1028 
1029 	return NULL;
1030 }
1031 
1032 /*
1033  * SOF Driver enumeration.
1034  */
1035 int sof_machine_check(struct snd_sof_dev *sdev)
1036 {
1037 	struct snd_sof_pdata *sof_pdata = sdev->pdata;
1038 	const struct sof_dev_desc *desc = sof_pdata->desc;
1039 	struct snd_soc_acpi_mach *mach;
1040 
1041 	if (!IS_ENABLED(CONFIG_SND_SOC_SOF_FORCE_NOCODEC_MODE)) {
1042 		const struct snd_sof_of_mach *of_mach;
1043 
1044 		if (IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC_DEBUG_SUPPORT) &&
1045 		    sof_debug_check_flag(SOF_DBG_FORCE_NOCODEC))
1046 			goto nocodec;
1047 
1048 		/* find machine */
1049 		mach = snd_sof_machine_select(sdev);
1050 		if (mach) {
1051 			sof_pdata->machine = mach;
1052 
1053 			if (sof_pdata->subsystem_id_set) {
1054 				mach->mach_params.subsystem_vendor = sof_pdata->subsystem_vendor;
1055 				mach->mach_params.subsystem_device = sof_pdata->subsystem_device;
1056 				mach->mach_params.subsystem_id_set = true;
1057 			}
1058 
1059 			snd_sof_set_mach_params(mach, sdev);
1060 			return 0;
1061 		}
1062 
1063 		of_mach = sof_of_machine_select(sdev);
1064 		if (of_mach) {
1065 			sof_pdata->of_machine = of_mach;
1066 			return 0;
1067 		}
1068 
1069 		if (!IS_ENABLED(CONFIG_SND_SOC_SOF_NOCODEC)) {
1070 			dev_err(sdev->dev, "error: no matching ASoC machine driver found - aborting probe\n");
1071 			return -ENODEV;
1072 		}
1073 	} else {
1074 		dev_warn(sdev->dev, "Force to use nocodec mode\n");
1075 	}
1076 
1077 nocodec:
1078 	/* select nocodec mode */
1079 	dev_warn(sdev->dev, "Using nocodec machine driver\n");
1080 	mach = devm_kzalloc(sdev->dev, sizeof(*mach), GFP_KERNEL);
1081 	if (!mach)
1082 		return -ENOMEM;
1083 
1084 	mach->drv_name = "sof-nocodec";
1085 	if (!sof_pdata->tplg_filename)
1086 		sof_pdata->tplg_filename = desc->nocodec_tplg_filename;
1087 
1088 	sof_pdata->machine = mach;
1089 	snd_sof_set_mach_params(mach, sdev);
1090 
1091 	return 0;
1092 }
1093 EXPORT_SYMBOL(sof_machine_check);
1094 
1095 int sof_machine_register(struct snd_sof_dev *sdev, void *pdata)
1096 {
1097 	struct snd_sof_pdata *plat_data = pdata;
1098 	const char *drv_name;
1099 	const void *mach;
1100 	int size;
1101 
1102 	drv_name = plat_data->machine->drv_name;
1103 	mach = plat_data->machine;
1104 	size = sizeof(*plat_data->machine);
1105 
1106 	/* register machine driver, pass machine info as pdata */
1107 	plat_data->pdev_mach =
1108 		platform_device_register_data(sdev->dev, drv_name,
1109 					      PLATFORM_DEVID_NONE, mach, size);
1110 	if (IS_ERR(plat_data->pdev_mach))
1111 		return PTR_ERR(plat_data->pdev_mach);
1112 
1113 	dev_dbg(sdev->dev, "created machine %s\n",
1114 		dev_name(&plat_data->pdev_mach->dev));
1115 
1116 	return 0;
1117 }
1118 EXPORT_SYMBOL(sof_machine_register);
1119 
1120 void sof_machine_unregister(struct snd_sof_dev *sdev, void *pdata)
1121 {
1122 	struct snd_sof_pdata *plat_data = pdata;
1123 
1124 	if (!IS_ERR_OR_NULL(plat_data->pdev_mach))
1125 		platform_device_unregister(plat_data->pdev_mach);
1126 }
1127 EXPORT_SYMBOL(sof_machine_unregister);
1128