2 * skl-topology.c - Implements Platform component ALSA controls/widget
5 * Copyright (C) 2014-2015 Intel Corp
6 * Author: Jeeja KP <jeeja.kp@intel.com>
7 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as version 2, as
11 * published by the Free Software Foundation.
13 * This program is distributed in the hope that it will be useful, but
14 * WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16 * General Public License for more details.
19 #include <linux/slab.h>
20 #include <linux/types.h>
21 #include <linux/firmware.h>
22 #include <sound/soc.h>
23 #include <sound/soc-topology.h>
24 #include "skl-sst-dsp.h"
25 #include "skl-sst-ipc.h"
26 #include "skl-topology.h"
28 #include "skl-tplg-interface.h"
29 #include "../common/sst-dsp.h"
30 #include "../common/sst-dsp-priv.h"
32 #define SKL_CH_FIXUP_MASK (1 << 0)
33 #define SKL_RATE_FIXUP_MASK (1 << 1)
34 #define SKL_FMT_FIXUP_MASK (1 << 2)
37 * SKL DSP driver modelling uses only few DAPM widgets so for rest we will
38 * ignore. This helpers checks if the SKL driver handles this widget type
40 static int is_skl_dsp_widget_type(struct snd_soc_dapm_widget
*w
)
43 case snd_soc_dapm_dai_link
:
44 case snd_soc_dapm_dai_in
:
45 case snd_soc_dapm_aif_in
:
46 case snd_soc_dapm_aif_out
:
47 case snd_soc_dapm_dai_out
:
48 case snd_soc_dapm_switch
:
56 * Each pipelines needs memory to be allocated. Check if we have free memory
57 * from available pool.
59 static bool skl_is_pipe_mem_avail(struct skl
*skl
,
60 struct skl_module_cfg
*mconfig
)
62 struct skl_sst
*ctx
= skl
->skl_sst
;
64 if (skl
->resource
.mem
+ mconfig
->pipe
->memory_pages
>
65 skl
->resource
.max_mem
) {
67 "%s: module_id %d instance %d\n", __func__
,
68 mconfig
->id
.module_id
,
69 mconfig
->id
.instance_id
);
71 "exceeds ppl memory available %d mem %d\n",
72 skl
->resource
.max_mem
, skl
->resource
.mem
);
80 * Add the mem to the mem pool. This is freed when pipe is deleted.
81 * Note: DSP does actual memory management we only keep track for complete
84 static void skl_tplg_alloc_pipe_mem(struct skl
*skl
,
85 struct skl_module_cfg
*mconfig
)
87 skl
->resource
.mem
+= mconfig
->pipe
->memory_pages
;
91 * Pipeline needs needs DSP CPU resources for computation, this is
92 * quantified in MCPS (Million Clocks Per Second) required for module/pipe
94 * Each pipelines needs mcps to be allocated. Check if we have mcps for this
98 static bool skl_is_pipe_mcps_avail(struct skl
*skl
,
99 struct skl_module_cfg
*mconfig
)
101 struct skl_sst
*ctx
= skl
->skl_sst
;
103 if (skl
->resource
.mcps
+ mconfig
->mcps
> skl
->resource
.max_mcps
) {
105 "%s: module_id %d instance %d\n", __func__
,
106 mconfig
->id
.module_id
, mconfig
->id
.instance_id
);
108 "exceeds ppl mcps available %d > mem %d\n",
109 skl
->resource
.max_mcps
, skl
->resource
.mcps
);
116 static void skl_tplg_alloc_pipe_mcps(struct skl
*skl
,
117 struct skl_module_cfg
*mconfig
)
119 skl
->resource
.mcps
+= mconfig
->mcps
;
123 * Free the mcps when tearing down
126 skl_tplg_free_pipe_mcps(struct skl
*skl
, struct skl_module_cfg
*mconfig
)
128 skl
->resource
.mcps
-= mconfig
->mcps
;
132 * Free the memory when tearing down
135 skl_tplg_free_pipe_mem(struct skl
*skl
, struct skl_module_cfg
*mconfig
)
137 skl
->resource
.mem
-= mconfig
->pipe
->memory_pages
;
141 static void skl_dump_mconfig(struct skl_sst
*ctx
,
142 struct skl_module_cfg
*mcfg
)
144 dev_dbg(ctx
->dev
, "Dumping config\n");
145 dev_dbg(ctx
->dev
, "Input Format:\n");
146 dev_dbg(ctx
->dev
, "channels = %d\n", mcfg
->in_fmt
[0].channels
);
147 dev_dbg(ctx
->dev
, "s_freq = %d\n", mcfg
->in_fmt
[0].s_freq
);
148 dev_dbg(ctx
->dev
, "ch_cfg = %d\n", mcfg
->in_fmt
[0].ch_cfg
);
149 dev_dbg(ctx
->dev
, "valid bit depth = %d\n", mcfg
->in_fmt
[0].valid_bit_depth
);
150 dev_dbg(ctx
->dev
, "Output Format:\n");
151 dev_dbg(ctx
->dev
, "channels = %d\n", mcfg
->out_fmt
[0].channels
);
152 dev_dbg(ctx
->dev
, "s_freq = %d\n", mcfg
->out_fmt
[0].s_freq
);
153 dev_dbg(ctx
->dev
, "valid bit depth = %d\n", mcfg
->out_fmt
[0].valid_bit_depth
);
154 dev_dbg(ctx
->dev
, "ch_cfg = %d\n", mcfg
->out_fmt
[0].ch_cfg
);
157 static void skl_tplg_update_params(struct skl_module_fmt
*fmt
,
158 struct skl_pipe_params
*params
, int fixup
)
160 if (fixup
& SKL_RATE_FIXUP_MASK
)
161 fmt
->s_freq
= params
->s_freq
;
162 if (fixup
& SKL_CH_FIXUP_MASK
)
163 fmt
->channels
= params
->ch
;
164 if (fixup
& SKL_FMT_FIXUP_MASK
) {
165 fmt
->valid_bit_depth
= skl_get_bit_depth(params
->s_fmt
);
168 * 16 bit is 16 bit container whereas 24 bit is in 32 bit
169 * container so update bit depth accordingly
171 switch (fmt
->valid_bit_depth
) {
172 case SKL_DEPTH_16BIT
:
173 fmt
->bit_depth
= fmt
->valid_bit_depth
;
177 fmt
->bit_depth
= SKL_DEPTH_32BIT
;
185 * A pipeline may have modules which impact the pcm parameters, like SRC,
186 * channel converter, format converter.
187 * We need to calculate the output params by applying the 'fixup'
188 * Topology will tell driver which type of fixup is to be applied by
189 * supplying the fixup mask, so based on that we calculate the output
191 * Now In FE the pcm hw_params is source/target format. Same is applicable
192 * for BE with its hw_params invoked.
193 * here based on FE, BE pipeline and direction we calculate the input and
194 * outfix and then apply that for a module
196 static void skl_tplg_update_params_fixup(struct skl_module_cfg
*m_cfg
,
197 struct skl_pipe_params
*params
, bool is_fe
)
199 int in_fixup
, out_fixup
;
200 struct skl_module_fmt
*in_fmt
, *out_fmt
;
202 /* Fixups will be applied to pin 0 only */
203 in_fmt
= &m_cfg
->in_fmt
[0];
204 out_fmt
= &m_cfg
->out_fmt
[0];
206 if (params
->stream
== SNDRV_PCM_STREAM_PLAYBACK
) {
208 in_fixup
= m_cfg
->params_fixup
;
209 out_fixup
= (~m_cfg
->converter
) &
212 out_fixup
= m_cfg
->params_fixup
;
213 in_fixup
= (~m_cfg
->converter
) &
218 out_fixup
= m_cfg
->params_fixup
;
219 in_fixup
= (~m_cfg
->converter
) &
222 in_fixup
= m_cfg
->params_fixup
;
223 out_fixup
= (~m_cfg
->converter
) &
228 skl_tplg_update_params(in_fmt
, params
, in_fixup
);
229 skl_tplg_update_params(out_fmt
, params
, out_fixup
);
233 * A module needs input and output buffers, which are dependent upon pcm
234 * params, so once we have calculate params, we need buffer calculation as
237 static void skl_tplg_update_buffer_size(struct skl_sst
*ctx
,
238 struct skl_module_cfg
*mcfg
)
241 struct skl_module_fmt
*in_fmt
, *out_fmt
;
242 int in_rate
, out_rate
;
245 /* Since fixups is applied to pin 0 only, ibs, obs needs
246 * change for pin 0 only
248 in_fmt
= &mcfg
->in_fmt
[0];
249 out_fmt
= &mcfg
->out_fmt
[0];
251 if (mcfg
->m_type
== SKL_MODULE_TYPE_SRCINT
)
254 if (in_fmt
->s_freq
% 1000)
255 in_rate
= (in_fmt
->s_freq
/ 1000) + 1;
257 in_rate
= (in_fmt
->s_freq
/ 1000);
259 mcfg
->ibs
= in_rate
* (mcfg
->in_fmt
->channels
) *
260 (mcfg
->in_fmt
->bit_depth
>> 3) *
263 if (mcfg
->out_fmt
->s_freq
% 1000)
264 out_rate
= (mcfg
->out_fmt
->s_freq
/ 1000) + 1;
266 out_rate
= (mcfg
->out_fmt
->s_freq
/ 1000);
268 mcfg
->obs
= out_rate
* (mcfg
->out_fmt
->channels
) *
269 (mcfg
->out_fmt
->bit_depth
>> 3) *
273 static int skl_tplg_update_be_blob(struct snd_soc_dapm_widget
*w
,
276 struct skl_module_cfg
*m_cfg
= w
->priv
;
278 u32 ch
, s_freq
, s_fmt
;
279 struct nhlt_specific_cfg
*cfg
;
280 struct skl
*skl
= get_skl_ctx(ctx
->dev
);
282 /* check if we already have blob */
283 if (m_cfg
->formats_config
.caps_size
> 0)
286 dev_dbg(ctx
->dev
, "Applying default cfg blob\n");
287 switch (m_cfg
->dev_type
) {
288 case SKL_DEVICE_DMIC
:
289 link_type
= NHLT_LINK_DMIC
;
290 dir
= SNDRV_PCM_STREAM_CAPTURE
;
291 s_freq
= m_cfg
->in_fmt
[0].s_freq
;
292 s_fmt
= m_cfg
->in_fmt
[0].bit_depth
;
293 ch
= m_cfg
->in_fmt
[0].channels
;
297 link_type
= NHLT_LINK_SSP
;
298 if (m_cfg
->hw_conn_type
== SKL_CONN_SOURCE
) {
299 dir
= SNDRV_PCM_STREAM_PLAYBACK
;
300 s_freq
= m_cfg
->out_fmt
[0].s_freq
;
301 s_fmt
= m_cfg
->out_fmt
[0].bit_depth
;
302 ch
= m_cfg
->out_fmt
[0].channels
;
304 dir
= SNDRV_PCM_STREAM_CAPTURE
;
305 s_freq
= m_cfg
->in_fmt
[0].s_freq
;
306 s_fmt
= m_cfg
->in_fmt
[0].bit_depth
;
307 ch
= m_cfg
->in_fmt
[0].channels
;
315 /* update the blob based on virtual bus_id and default params */
316 cfg
= skl_get_ep_blob(skl
, m_cfg
->vbus_id
, link_type
,
317 s_fmt
, ch
, s_freq
, dir
);
319 m_cfg
->formats_config
.caps_size
= cfg
->size
;
320 m_cfg
->formats_config
.caps
= (u32
*) &cfg
->caps
;
322 dev_err(ctx
->dev
, "Blob NULL for id %x type %d dirn %d\n",
323 m_cfg
->vbus_id
, link_type
, dir
);
324 dev_err(ctx
->dev
, "PCM: ch %d, freq %d, fmt %d\n",
332 static void skl_tplg_update_module_params(struct snd_soc_dapm_widget
*w
,
335 struct skl_module_cfg
*m_cfg
= w
->priv
;
336 struct skl_pipe_params
*params
= m_cfg
->pipe
->p_params
;
337 int p_conn_type
= m_cfg
->pipe
->conn_type
;
340 if (!m_cfg
->params_fixup
)
343 dev_dbg(ctx
->dev
, "Mconfig for widget=%s BEFORE updation\n",
346 skl_dump_mconfig(ctx
, m_cfg
);
348 if (p_conn_type
== SKL_PIPE_CONN_TYPE_FE
)
353 skl_tplg_update_params_fixup(m_cfg
, params
, is_fe
);
354 skl_tplg_update_buffer_size(ctx
, m_cfg
);
356 dev_dbg(ctx
->dev
, "Mconfig for widget=%s AFTER updation\n",
359 skl_dump_mconfig(ctx
, m_cfg
);
363 * A pipe can have multiple modules, each of them will be a DAPM widget as
364 * well. While managing a pipeline we need to get the list of all the
365 * widgets in a pipelines, so this helper - skl_tplg_get_pipe_widget() helps
366 * to get the SKL type widgets in that pipeline
368 static int skl_tplg_alloc_pipe_widget(struct device
*dev
,
369 struct snd_soc_dapm_widget
*w
, struct skl_pipe
*pipe
)
371 struct skl_module_cfg
*src_module
= NULL
;
372 struct snd_soc_dapm_path
*p
= NULL
;
373 struct skl_pipe_module
*p_module
= NULL
;
375 p_module
= devm_kzalloc(dev
, sizeof(*p_module
), GFP_KERNEL
);
380 list_add_tail(&p_module
->node
, &pipe
->w_list
);
382 snd_soc_dapm_widget_for_each_sink_path(w
, p
) {
383 if ((p
->sink
->priv
== NULL
)
384 && (!is_skl_dsp_widget_type(w
)))
387 if ((p
->sink
->priv
!= NULL
) && p
->connect
388 && is_skl_dsp_widget_type(p
->sink
)) {
390 src_module
= p
->sink
->priv
;
391 if (pipe
->ppl_id
== src_module
->pipe
->ppl_id
)
392 skl_tplg_alloc_pipe_widget(dev
,
400 * some modules can have multiple params set from user control and
401 * need to be set after module is initialized. If set_param flag is
402 * set module params will be done after module is initialised.
404 static int skl_tplg_set_module_params(struct snd_soc_dapm_widget
*w
,
408 struct skl_module_cfg
*mconfig
= w
->priv
;
409 const struct snd_kcontrol_new
*k
;
410 struct soc_bytes_ext
*sb
;
411 struct skl_algo_data
*bc
;
412 struct skl_specific_cfg
*sp_cfg
;
414 if (mconfig
->formats_config
.caps_size
> 0 &&
415 mconfig
->formats_config
.set_params
== SKL_PARAM_SET
) {
416 sp_cfg
= &mconfig
->formats_config
;
417 ret
= skl_set_module_params(ctx
, sp_cfg
->caps
,
419 sp_cfg
->param_id
, mconfig
);
424 for (i
= 0; i
< w
->num_kcontrols
; i
++) {
425 k
= &w
->kcontrol_news
[i
];
426 if (k
->access
& SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK
) {
427 sb
= (void *) k
->private_value
;
428 bc
= (struct skl_algo_data
*)sb
->dobj
.private;
430 if (bc
->set_params
== SKL_PARAM_SET
) {
431 ret
= skl_set_module_params(ctx
,
432 (u32
*)bc
->params
, bc
->max
,
433 bc
->param_id
, mconfig
);
444 * some module param can set from user control and this is required as
445 * when module is initailzed. if module param is required in init it is
446 * identifed by set_param flag. if set_param flag is not set, then this
447 * parameter needs to set as part of module init.
449 static int skl_tplg_set_module_init_data(struct snd_soc_dapm_widget
*w
)
451 const struct snd_kcontrol_new
*k
;
452 struct soc_bytes_ext
*sb
;
453 struct skl_algo_data
*bc
;
454 struct skl_module_cfg
*mconfig
= w
->priv
;
457 for (i
= 0; i
< w
->num_kcontrols
; i
++) {
458 k
= &w
->kcontrol_news
[i
];
459 if (k
->access
& SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK
) {
460 sb
= (struct soc_bytes_ext
*)k
->private_value
;
461 bc
= (struct skl_algo_data
*)sb
->dobj
.private;
463 if (bc
->set_params
!= SKL_PARAM_INIT
)
466 mconfig
->formats_config
.caps
= (u32
*)&bc
->params
;
467 mconfig
->formats_config
.caps_size
= bc
->max
;
477 * Inside a pipe instance, we can have various modules. These modules need
478 * to instantiated in DSP by invoking INIT_MODULE IPC, which is achieved by
479 * skl_init_module() routine, so invoke that for all modules in a pipeline
482 skl_tplg_init_pipe_modules(struct skl
*skl
, struct skl_pipe
*pipe
)
484 struct skl_pipe_module
*w_module
;
485 struct snd_soc_dapm_widget
*w
;
486 struct skl_module_cfg
*mconfig
;
487 struct skl_sst
*ctx
= skl
->skl_sst
;
490 list_for_each_entry(w_module
, &pipe
->w_list
, node
) {
494 /* check resource available */
495 if (!skl_is_pipe_mcps_avail(skl
, mconfig
))
498 skl_tplg_alloc_pipe_mcps(skl
, mconfig
);
500 if (mconfig
->is_loadable
&& ctx
->dsp
->fw_ops
.load_mod
) {
501 ret
= ctx
->dsp
->fw_ops
.load_mod(ctx
->dsp
,
502 mconfig
->id
.module_id
, mconfig
->guid
);
506 mconfig
->m_state
= SKL_MODULE_LOADED
;
509 /* update blob if blob is null for be with default value */
510 skl_tplg_update_be_blob(w
, ctx
);
513 * apply fix/conversion to module params based on
516 skl_tplg_update_module_params(w
, ctx
);
518 skl_tplg_set_module_init_data(w
);
519 ret
= skl_init_module(ctx
, mconfig
);
523 ret
= skl_tplg_set_module_params(w
, ctx
);
531 static int skl_tplg_unload_pipe_modules(struct skl_sst
*ctx
,
532 struct skl_pipe
*pipe
)
534 struct skl_pipe_module
*w_module
= NULL
;
535 struct skl_module_cfg
*mconfig
= NULL
;
537 list_for_each_entry(w_module
, &pipe
->w_list
, node
) {
538 mconfig
= w_module
->w
->priv
;
540 if (mconfig
->is_loadable
&& ctx
->dsp
->fw_ops
.unload_mod
&&
541 mconfig
->m_state
> SKL_MODULE_UNINIT
)
542 return ctx
->dsp
->fw_ops
.unload_mod(ctx
->dsp
,
543 mconfig
->id
.module_id
);
546 /* no modules to unload in this path, so return */
551 * Mixer module represents a pipeline. So in the Pre-PMU event of mixer we
552 * need create the pipeline. So we do following:
553 * - check the resources
554 * - Create the pipeline
555 * - Initialize the modules in pipeline
556 * - finally bind all modules together
558 static int skl_tplg_mixer_dapm_pre_pmu_event(struct snd_soc_dapm_widget
*w
,
562 struct skl_module_cfg
*mconfig
= w
->priv
;
563 struct skl_pipe_module
*w_module
;
564 struct skl_pipe
*s_pipe
= mconfig
->pipe
;
565 struct skl_module_cfg
*src_module
= NULL
, *dst_module
;
566 struct skl_sst
*ctx
= skl
->skl_sst
;
568 /* check resource available */
569 if (!skl_is_pipe_mcps_avail(skl
, mconfig
))
572 if (!skl_is_pipe_mem_avail(skl
, mconfig
))
575 skl_tplg_alloc_pipe_mem(skl
, mconfig
);
576 skl_tplg_alloc_pipe_mcps(skl
, mconfig
);
579 * Create a list of modules for pipe.
580 * This list contains modules from source to sink
582 ret
= skl_create_pipeline(ctx
, mconfig
->pipe
);
587 * we create a w_list of all widgets in that pipe. This list is not
588 * freed on PMD event as widgets within a pipe are static. This
589 * saves us cycles to get widgets in pipe every time.
591 * So if we have already initialized all the widgets of a pipeline
592 * we skip, so check for list_empty and create the list if empty
594 if (list_empty(&s_pipe
->w_list
)) {
595 ret
= skl_tplg_alloc_pipe_widget(ctx
->dev
, w
, s_pipe
);
600 /* Init all pipe modules from source to sink */
601 ret
= skl_tplg_init_pipe_modules(skl
, s_pipe
);
605 /* Bind modules from source to sink */
606 list_for_each_entry(w_module
, &s_pipe
->w_list
, node
) {
607 dst_module
= w_module
->w
->priv
;
609 if (src_module
== NULL
) {
610 src_module
= dst_module
;
614 ret
= skl_bind_modules(ctx
, src_module
, dst_module
);
618 src_module
= dst_module
;
625 * Some modules require params to be set after the module is bound to
626 * all pins connected.
628 * The module provider initializes set_param flag for such modules and we
629 * send params after binding
631 static int skl_tplg_set_module_bind_params(struct snd_soc_dapm_widget
*w
,
632 struct skl_module_cfg
*mcfg
, struct skl_sst
*ctx
)
635 struct skl_module_cfg
*mconfig
= w
->priv
;
636 const struct snd_kcontrol_new
*k
;
637 struct soc_bytes_ext
*sb
;
638 struct skl_algo_data
*bc
;
639 struct skl_specific_cfg
*sp_cfg
;
642 * check all out/in pins are in bind state.
643 * if so set the module param
645 for (i
= 0; i
< mcfg
->max_out_queue
; i
++) {
646 if (mcfg
->m_out_pin
[i
].pin_state
!= SKL_PIN_BIND_DONE
)
650 for (i
= 0; i
< mcfg
->max_in_queue
; i
++) {
651 if (mcfg
->m_in_pin
[i
].pin_state
!= SKL_PIN_BIND_DONE
)
655 if (mconfig
->formats_config
.caps_size
> 0 &&
656 mconfig
->formats_config
.set_params
== SKL_PARAM_BIND
) {
657 sp_cfg
= &mconfig
->formats_config
;
658 ret
= skl_set_module_params(ctx
, sp_cfg
->caps
,
660 sp_cfg
->param_id
, mconfig
);
665 for (i
= 0; i
< w
->num_kcontrols
; i
++) {
666 k
= &w
->kcontrol_news
[i
];
667 if (k
->access
& SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK
) {
668 sb
= (void *) k
->private_value
;
669 bc
= (struct skl_algo_data
*)sb
->dobj
.private;
671 if (bc
->set_params
== SKL_PARAM_BIND
) {
672 ret
= skl_set_module_params(ctx
,
673 (u32
*)bc
->params
, bc
->max
,
674 bc
->param_id
, mconfig
);
684 static int skl_tplg_bind_sinks(struct snd_soc_dapm_widget
*w
,
686 struct snd_soc_dapm_widget
*src_w
,
687 struct skl_module_cfg
*src_mconfig
)
689 struct snd_soc_dapm_path
*p
;
690 struct snd_soc_dapm_widget
*sink
= NULL
, *next_sink
= NULL
;
691 struct skl_module_cfg
*sink_mconfig
;
692 struct skl_sst
*ctx
= skl
->skl_sst
;
695 snd_soc_dapm_widget_for_each_sink_path(w
, p
) {
699 dev_dbg(ctx
->dev
, "%s: src widget=%s\n", __func__
, w
->name
);
700 dev_dbg(ctx
->dev
, "%s: sink widget=%s\n", __func__
, p
->sink
->name
);
704 if (!is_skl_dsp_widget_type(p
->sink
))
705 return skl_tplg_bind_sinks(p
->sink
, skl
, src_w
, src_mconfig
);
708 * here we will check widgets in sink pipelines, so that
709 * can be any widgets type and we are only interested if
710 * they are ones used for SKL so check that first
712 if ((p
->sink
->priv
!= NULL
) &&
713 is_skl_dsp_widget_type(p
->sink
)) {
716 sink_mconfig
= sink
->priv
;
718 if (src_mconfig
->m_state
== SKL_MODULE_UNINIT
||
719 sink_mconfig
->m_state
== SKL_MODULE_UNINIT
)
722 /* Bind source to sink, mixin is always source */
723 ret
= skl_bind_modules(ctx
, src_mconfig
, sink_mconfig
);
727 /* set module params after bind */
728 skl_tplg_set_module_bind_params(src_w
, src_mconfig
, ctx
);
729 skl_tplg_set_module_bind_params(sink
, sink_mconfig
, ctx
);
731 /* Start sinks pipe first */
732 if (sink_mconfig
->pipe
->state
!= SKL_PIPE_STARTED
) {
733 if (sink_mconfig
->pipe
->conn_type
!=
734 SKL_PIPE_CONN_TYPE_FE
)
735 ret
= skl_run_pipe(ctx
,
744 return skl_tplg_bind_sinks(next_sink
, skl
, src_w
, src_mconfig
);
750 * A PGA represents a module in a pipeline. So in the Pre-PMU event of PGA
751 * we need to do following:
752 * - Bind to sink pipeline
753 * Since the sink pipes can be running and we don't get mixer event on
754 * connect for already running mixer, we need to find the sink pipes
755 * here and bind to them. This way dynamic connect works.
756 * - Start sink pipeline, if not running
757 * - Then run current pipe
759 static int skl_tplg_pga_dapm_pre_pmu_event(struct snd_soc_dapm_widget
*w
,
762 struct skl_module_cfg
*src_mconfig
;
763 struct skl_sst
*ctx
= skl
->skl_sst
;
766 src_mconfig
= w
->priv
;
769 * find which sink it is connected to, bind with the sink,
770 * if sink is not started, start sink pipe first, then start
773 ret
= skl_tplg_bind_sinks(w
, skl
, w
, src_mconfig
);
777 /* Start source pipe last after starting all sinks */
778 if (src_mconfig
->pipe
->conn_type
!= SKL_PIPE_CONN_TYPE_FE
)
779 return skl_run_pipe(ctx
, src_mconfig
->pipe
);
784 static struct snd_soc_dapm_widget
*skl_get_src_dsp_widget(
785 struct snd_soc_dapm_widget
*w
, struct skl
*skl
)
787 struct snd_soc_dapm_path
*p
;
788 struct snd_soc_dapm_widget
*src_w
= NULL
;
789 struct skl_sst
*ctx
= skl
->skl_sst
;
791 snd_soc_dapm_widget_for_each_source_path(w
, p
) {
796 dev_dbg(ctx
->dev
, "sink widget=%s\n", w
->name
);
797 dev_dbg(ctx
->dev
, "src widget=%s\n", p
->source
->name
);
800 * here we will check widgets in sink pipelines, so that can
801 * be any widgets type and we are only interested if they are
802 * ones used for SKL so check that first
804 if ((p
->source
->priv
!= NULL
) &&
805 is_skl_dsp_widget_type(p
->source
)) {
811 return skl_get_src_dsp_widget(src_w
, skl
);
817 * in the Post-PMU event of mixer we need to do following:
818 * - Check if this pipe is running
820 * - bind this pipeline to its source pipeline
821 * if source pipe is already running, this means it is a dynamic
822 * connection and we need to bind only to that pipe
823 * - start this pipeline
825 static int skl_tplg_mixer_dapm_post_pmu_event(struct snd_soc_dapm_widget
*w
,
829 struct snd_soc_dapm_widget
*source
, *sink
;
830 struct skl_module_cfg
*src_mconfig
, *sink_mconfig
;
831 struct skl_sst
*ctx
= skl
->skl_sst
;
832 int src_pipe_started
= 0;
835 sink_mconfig
= sink
->priv
;
838 * If source pipe is already started, that means source is driving
839 * one more sink before this sink got connected, Since source is
840 * started, bind this sink to source and start this pipe.
842 source
= skl_get_src_dsp_widget(w
, skl
);
843 if (source
!= NULL
) {
844 src_mconfig
= source
->priv
;
845 sink_mconfig
= sink
->priv
;
846 src_pipe_started
= 1;
849 * check pipe state, then no need to bind or start the
852 if (src_mconfig
->pipe
->state
!= SKL_PIPE_STARTED
)
853 src_pipe_started
= 0;
856 if (src_pipe_started
) {
857 ret
= skl_bind_modules(ctx
, src_mconfig
, sink_mconfig
);
861 /* set module params after bind */
862 skl_tplg_set_module_bind_params(source
, src_mconfig
, ctx
);
863 skl_tplg_set_module_bind_params(sink
, sink_mconfig
, ctx
);
865 if (sink_mconfig
->pipe
->conn_type
!= SKL_PIPE_CONN_TYPE_FE
)
866 ret
= skl_run_pipe(ctx
, sink_mconfig
->pipe
);
873 * in the Pre-PMD event of mixer we need to do following:
875 * - find the source connections and remove that from dapm_path_list
876 * - unbind with source pipelines if still connected
878 static int skl_tplg_mixer_dapm_pre_pmd_event(struct snd_soc_dapm_widget
*w
,
881 struct skl_module_cfg
*src_mconfig
, *sink_mconfig
;
883 struct skl_sst
*ctx
= skl
->skl_sst
;
885 sink_mconfig
= w
->priv
;
888 ret
= skl_stop_pipe(ctx
, sink_mconfig
->pipe
);
892 for (i
= 0; i
< sink_mconfig
->max_in_queue
; i
++) {
893 if (sink_mconfig
->m_in_pin
[i
].pin_state
== SKL_PIN_BIND_DONE
) {
894 src_mconfig
= sink_mconfig
->m_in_pin
[i
].tgt_mcfg
;
898 * If path_found == 1, that means pmd for source
899 * pipe has not occurred, source is connected to
900 * some other sink. so its responsibility of sink
901 * to unbind itself from source.
903 ret
= skl_stop_pipe(ctx
, src_mconfig
->pipe
);
907 ret
= skl_unbind_modules(ctx
,
908 src_mconfig
, sink_mconfig
);
916 * in the Post-PMD event of mixer we need to do following:
917 * - Free the mcps used
918 * - Free the mem used
919 * - Unbind the modules within the pipeline
920 * - Delete the pipeline (modules are not required to be explicitly
921 * deleted, pipeline delete is enough here
923 static int skl_tplg_mixer_dapm_post_pmd_event(struct snd_soc_dapm_widget
*w
,
926 struct skl_module_cfg
*mconfig
= w
->priv
;
927 struct skl_pipe_module
*w_module
;
928 struct skl_module_cfg
*src_module
= NULL
, *dst_module
;
929 struct skl_sst
*ctx
= skl
->skl_sst
;
930 struct skl_pipe
*s_pipe
= mconfig
->pipe
;
933 skl_tplg_free_pipe_mcps(skl
, mconfig
);
934 skl_tplg_free_pipe_mem(skl
, mconfig
);
936 list_for_each_entry(w_module
, &s_pipe
->w_list
, node
) {
937 dst_module
= w_module
->w
->priv
;
939 skl_tplg_free_pipe_mcps(skl
, dst_module
);
940 if (src_module
== NULL
) {
941 src_module
= dst_module
;
945 skl_unbind_modules(ctx
, src_module
, dst_module
);
946 src_module
= dst_module
;
949 ret
= skl_delete_pipe(ctx
, mconfig
->pipe
);
951 return skl_tplg_unload_pipe_modules(ctx
, s_pipe
);
955 * in the Post-PMD event of PGA we need to do following:
956 * - Free the mcps used
957 * - Stop the pipeline
958 * - In source pipe is connected, unbind with source pipelines
960 static int skl_tplg_pga_dapm_post_pmd_event(struct snd_soc_dapm_widget
*w
,
963 struct skl_module_cfg
*src_mconfig
, *sink_mconfig
;
965 struct skl_sst
*ctx
= skl
->skl_sst
;
967 src_mconfig
= w
->priv
;
969 /* Stop the pipe since this is a mixin module */
970 ret
= skl_stop_pipe(ctx
, src_mconfig
->pipe
);
974 for (i
= 0; i
< src_mconfig
->max_out_queue
; i
++) {
975 if (src_mconfig
->m_out_pin
[i
].pin_state
== SKL_PIN_BIND_DONE
) {
976 sink_mconfig
= src_mconfig
->m_out_pin
[i
].tgt_mcfg
;
980 * This is a connecter and if path is found that means
981 * unbind between source and sink has not happened yet
983 ret
= skl_unbind_modules(ctx
, src_mconfig
,
992 * In modelling, we assume there will be ONLY one mixer in a pipeline. If
993 * mixer is not required then it is treated as static mixer aka vmixer with
994 * a hard path to source module
995 * So we don't need to check if source is started or not as hard path puts
996 * dependency on each other
998 static int skl_tplg_vmixer_event(struct snd_soc_dapm_widget
*w
,
999 struct snd_kcontrol
*k
, int event
)
1001 struct snd_soc_dapm_context
*dapm
= w
->dapm
;
1002 struct skl
*skl
= get_skl_ctx(dapm
->dev
);
1005 case SND_SOC_DAPM_PRE_PMU
:
1006 return skl_tplg_mixer_dapm_pre_pmu_event(w
, skl
);
1008 case SND_SOC_DAPM_POST_PMU
:
1009 return skl_tplg_mixer_dapm_post_pmu_event(w
, skl
);
1011 case SND_SOC_DAPM_PRE_PMD
:
1012 return skl_tplg_mixer_dapm_pre_pmd_event(w
, skl
);
1014 case SND_SOC_DAPM_POST_PMD
:
1015 return skl_tplg_mixer_dapm_post_pmd_event(w
, skl
);
1022 * In modelling, we assume there will be ONLY one mixer in a pipeline. If a
1023 * second one is required that is created as another pipe entity.
1024 * The mixer is responsible for pipe management and represent a pipeline
1027 static int skl_tplg_mixer_event(struct snd_soc_dapm_widget
*w
,
1028 struct snd_kcontrol
*k
, int event
)
1030 struct snd_soc_dapm_context
*dapm
= w
->dapm
;
1031 struct skl
*skl
= get_skl_ctx(dapm
->dev
);
1034 case SND_SOC_DAPM_PRE_PMU
:
1035 return skl_tplg_mixer_dapm_pre_pmu_event(w
, skl
);
1037 case SND_SOC_DAPM_POST_PMU
:
1038 return skl_tplg_mixer_dapm_post_pmu_event(w
, skl
);
1040 case SND_SOC_DAPM_PRE_PMD
:
1041 return skl_tplg_mixer_dapm_pre_pmd_event(w
, skl
);
1043 case SND_SOC_DAPM_POST_PMD
:
1044 return skl_tplg_mixer_dapm_post_pmd_event(w
, skl
);
1051 * In modelling, we assumed rest of the modules in pipeline are PGA. But we
1052 * are interested in last PGA (leaf PGA) in a pipeline to disconnect with
1053 * the sink when it is running (two FE to one BE or one FE to two BE)
1056 static int skl_tplg_pga_event(struct snd_soc_dapm_widget
*w
,
1057 struct snd_kcontrol
*k
, int event
)
1060 struct snd_soc_dapm_context
*dapm
= w
->dapm
;
1061 struct skl
*skl
= get_skl_ctx(dapm
->dev
);
1064 case SND_SOC_DAPM_PRE_PMU
:
1065 return skl_tplg_pga_dapm_pre_pmu_event(w
, skl
);
1067 case SND_SOC_DAPM_POST_PMD
:
1068 return skl_tplg_pga_dapm_post_pmd_event(w
, skl
);
1074 static int skl_tplg_tlv_control_get(struct snd_kcontrol
*kcontrol
,
1075 unsigned int __user
*data
, unsigned int size
)
1077 struct soc_bytes_ext
*sb
=
1078 (struct soc_bytes_ext
*)kcontrol
->private_value
;
1079 struct skl_algo_data
*bc
= (struct skl_algo_data
*)sb
->dobj
.private;
1080 struct snd_soc_dapm_widget
*w
= snd_soc_dapm_kcontrol_widget(kcontrol
);
1081 struct skl_module_cfg
*mconfig
= w
->priv
;
1082 struct skl
*skl
= get_skl_ctx(w
->dapm
->dev
);
1085 skl_get_module_params(skl
->skl_sst
, (u32
*)bc
->params
,
1086 bc
->max
, bc
->param_id
, mconfig
);
1088 /* decrement size for TLV header */
1089 size
-= 2 * sizeof(u32
);
1091 /* check size as we don't want to send kernel data */
1096 if (copy_to_user(data
, &bc
->param_id
, sizeof(u32
)))
1098 if (copy_to_user(data
+ 1, &size
, sizeof(u32
)))
1100 if (copy_to_user(data
+ 2, bc
->params
, size
))
1107 #define SKL_PARAM_VENDOR_ID 0xff
1109 static int skl_tplg_tlv_control_set(struct snd_kcontrol
*kcontrol
,
1110 const unsigned int __user
*data
, unsigned int size
)
1112 struct snd_soc_dapm_widget
*w
= snd_soc_dapm_kcontrol_widget(kcontrol
);
1113 struct skl_module_cfg
*mconfig
= w
->priv
;
1114 struct soc_bytes_ext
*sb
=
1115 (struct soc_bytes_ext
*)kcontrol
->private_value
;
1116 struct skl_algo_data
*ac
= (struct skl_algo_data
*)sb
->dobj
.private;
1117 struct skl
*skl
= get_skl_ctx(w
->dapm
->dev
);
1121 * if the param_is is of type Vendor, firmware expects actual
1122 * parameter id and size from the control.
1124 if (ac
->param_id
== SKL_PARAM_VENDOR_ID
) {
1125 if (copy_from_user(ac
->params
, data
, size
))
1128 if (copy_from_user(ac
->params
,
1134 return skl_set_module_params(skl
->skl_sst
,
1135 (u32
*)ac
->params
, ac
->max
,
1136 ac
->param_id
, mconfig
);
1143 * The FE params are passed by hw_params of the DAI.
1144 * On hw_params, the params are stored in Gateway module of the FE and we
1145 * need to calculate the format in DSP module configuration, that
1146 * conversion is done here
1148 int skl_tplg_update_pipe_params(struct device
*dev
,
1149 struct skl_module_cfg
*mconfig
,
1150 struct skl_pipe_params
*params
)
1152 struct skl_pipe
*pipe
= mconfig
->pipe
;
1153 struct skl_module_fmt
*format
= NULL
;
1155 memcpy(pipe
->p_params
, params
, sizeof(*params
));
1157 if (params
->stream
== SNDRV_PCM_STREAM_PLAYBACK
)
1158 format
= &mconfig
->in_fmt
[0];
1160 format
= &mconfig
->out_fmt
[0];
1162 /* set the hw_params */
1163 format
->s_freq
= params
->s_freq
;
1164 format
->channels
= params
->ch
;
1165 format
->valid_bit_depth
= skl_get_bit_depth(params
->s_fmt
);
1168 * 16 bit is 16 bit container whereas 24 bit is in 32 bit
1169 * container so update bit depth accordingly
1171 switch (format
->valid_bit_depth
) {
1172 case SKL_DEPTH_16BIT
:
1173 format
->bit_depth
= format
->valid_bit_depth
;
1176 case SKL_DEPTH_24BIT
:
1177 case SKL_DEPTH_32BIT
:
1178 format
->bit_depth
= SKL_DEPTH_32BIT
;
1182 dev_err(dev
, "Invalid bit depth %x for pipe\n",
1183 format
->valid_bit_depth
);
1187 if (params
->stream
== SNDRV_PCM_STREAM_PLAYBACK
) {
1188 mconfig
->ibs
= (format
->s_freq
/ 1000) *
1189 (format
->channels
) *
1190 (format
->bit_depth
>> 3);
1192 mconfig
->obs
= (format
->s_freq
/ 1000) *
1193 (format
->channels
) *
1194 (format
->bit_depth
>> 3);
1201 * Query the module config for the FE DAI
1202 * This is used to find the hw_params set for that DAI and apply to FE
1205 struct skl_module_cfg
*
1206 skl_tplg_fe_get_cpr_module(struct snd_soc_dai
*dai
, int stream
)
1208 struct snd_soc_dapm_widget
*w
;
1209 struct snd_soc_dapm_path
*p
= NULL
;
1211 if (stream
== SNDRV_PCM_STREAM_PLAYBACK
) {
1212 w
= dai
->playback_widget
;
1213 snd_soc_dapm_widget_for_each_sink_path(w
, p
) {
1214 if (p
->connect
&& p
->sink
->power
&&
1215 !is_skl_dsp_widget_type(p
->sink
))
1218 if (p
->sink
->priv
) {
1219 dev_dbg(dai
->dev
, "set params for %s\n",
1221 return p
->sink
->priv
;
1225 w
= dai
->capture_widget
;
1226 snd_soc_dapm_widget_for_each_source_path(w
, p
) {
1227 if (p
->connect
&& p
->source
->power
&&
1228 !is_skl_dsp_widget_type(p
->source
))
1231 if (p
->source
->priv
) {
1232 dev_dbg(dai
->dev
, "set params for %s\n",
1234 return p
->source
->priv
;
1242 static struct skl_module_cfg
*skl_get_mconfig_pb_cpr(
1243 struct snd_soc_dai
*dai
, struct snd_soc_dapm_widget
*w
)
1245 struct snd_soc_dapm_path
*p
;
1246 struct skl_module_cfg
*mconfig
= NULL
;
1248 snd_soc_dapm_widget_for_each_source_path(w
, p
) {
1249 if (w
->endpoints
[SND_SOC_DAPM_DIR_OUT
] > 0) {
1251 (p
->sink
->id
== snd_soc_dapm_aif_out
) &&
1253 mconfig
= p
->source
->priv
;
1256 mconfig
= skl_get_mconfig_pb_cpr(dai
, p
->source
);
1264 static struct skl_module_cfg
*skl_get_mconfig_cap_cpr(
1265 struct snd_soc_dai
*dai
, struct snd_soc_dapm_widget
*w
)
1267 struct snd_soc_dapm_path
*p
;
1268 struct skl_module_cfg
*mconfig
= NULL
;
1270 snd_soc_dapm_widget_for_each_sink_path(w
, p
) {
1271 if (w
->endpoints
[SND_SOC_DAPM_DIR_IN
] > 0) {
1273 (p
->source
->id
== snd_soc_dapm_aif_in
) &&
1275 mconfig
= p
->sink
->priv
;
1278 mconfig
= skl_get_mconfig_cap_cpr(dai
, p
->sink
);
1286 struct skl_module_cfg
*
1287 skl_tplg_be_get_cpr_module(struct snd_soc_dai
*dai
, int stream
)
1289 struct snd_soc_dapm_widget
*w
;
1290 struct skl_module_cfg
*mconfig
;
1292 if (stream
== SNDRV_PCM_STREAM_PLAYBACK
) {
1293 w
= dai
->playback_widget
;
1294 mconfig
= skl_get_mconfig_pb_cpr(dai
, w
);
1296 w
= dai
->capture_widget
;
1297 mconfig
= skl_get_mconfig_cap_cpr(dai
, w
);
1302 static u8
skl_tplg_be_link_type(int dev_type
)
1308 ret
= NHLT_LINK_SSP
;
1311 case SKL_DEVICE_DMIC
:
1312 ret
= NHLT_LINK_DMIC
;
1315 case SKL_DEVICE_I2S
:
1316 ret
= NHLT_LINK_SSP
;
1319 case SKL_DEVICE_HDALINK
:
1320 ret
= NHLT_LINK_HDA
;
1324 ret
= NHLT_LINK_INVALID
;
1332 * Fill the BE gateway parameters
1333 * The BE gateway expects a blob of parameters which are kept in the ACPI
1334 * NHLT blob, so query the blob for interface type (i2s/pdm) and instance.
1335 * The port can have multiple settings so pick based on the PCM
1338 static int skl_tplg_be_fill_pipe_params(struct snd_soc_dai
*dai
,
1339 struct skl_module_cfg
*mconfig
,
1340 struct skl_pipe_params
*params
)
1342 struct skl_pipe
*pipe
= mconfig
->pipe
;
1343 struct nhlt_specific_cfg
*cfg
;
1344 struct skl
*skl
= get_skl_ctx(dai
->dev
);
1345 int link_type
= skl_tplg_be_link_type(mconfig
->dev_type
);
1347 memcpy(pipe
->p_params
, params
, sizeof(*params
));
1349 if (link_type
== NHLT_LINK_HDA
)
1352 /* update the blob based on virtual bus_id*/
1353 cfg
= skl_get_ep_blob(skl
, mconfig
->vbus_id
, link_type
,
1354 params
->s_fmt
, params
->ch
,
1355 params
->s_freq
, params
->stream
);
1357 mconfig
->formats_config
.caps_size
= cfg
->size
;
1358 mconfig
->formats_config
.caps
= (u32
*) &cfg
->caps
;
1360 dev_err(dai
->dev
, "Blob NULL for id %x type %d dirn %d\n",
1361 mconfig
->vbus_id
, link_type
,
1363 dev_err(dai
->dev
, "PCM: ch %d, freq %d, fmt %d\n",
1364 params
->ch
, params
->s_freq
, params
->s_fmt
);
1371 static int skl_tplg_be_set_src_pipe_params(struct snd_soc_dai
*dai
,
1372 struct snd_soc_dapm_widget
*w
,
1373 struct skl_pipe_params
*params
)
1375 struct snd_soc_dapm_path
*p
;
1378 snd_soc_dapm_widget_for_each_source_path(w
, p
) {
1379 if (p
->connect
&& is_skl_dsp_widget_type(p
->source
) &&
1382 ret
= skl_tplg_be_fill_pipe_params(dai
,
1383 p
->source
->priv
, params
);
1387 ret
= skl_tplg_be_set_src_pipe_params(dai
,
1397 static int skl_tplg_be_set_sink_pipe_params(struct snd_soc_dai
*dai
,
1398 struct snd_soc_dapm_widget
*w
, struct skl_pipe_params
*params
)
1400 struct snd_soc_dapm_path
*p
= NULL
;
1403 snd_soc_dapm_widget_for_each_sink_path(w
, p
) {
1404 if (p
->connect
&& is_skl_dsp_widget_type(p
->sink
) &&
1407 ret
= skl_tplg_be_fill_pipe_params(dai
,
1408 p
->sink
->priv
, params
);
1412 ret
= skl_tplg_be_set_sink_pipe_params(
1413 dai
, p
->sink
, params
);
1423 * BE hw_params can be a source parameters (capture) or sink parameters
1424 * (playback). Based on sink and source we need to either find the source
1425 * list or the sink list and set the pipeline parameters
1427 int skl_tplg_be_update_params(struct snd_soc_dai
*dai
,
1428 struct skl_pipe_params
*params
)
1430 struct snd_soc_dapm_widget
*w
;
1432 if (params
->stream
== SNDRV_PCM_STREAM_PLAYBACK
) {
1433 w
= dai
->playback_widget
;
1435 return skl_tplg_be_set_src_pipe_params(dai
, w
, params
);
1438 w
= dai
->capture_widget
;
1440 return skl_tplg_be_set_sink_pipe_params(dai
, w
, params
);
1446 static const struct snd_soc_tplg_widget_events skl_tplg_widget_ops
[] = {
1447 {SKL_MIXER_EVENT
, skl_tplg_mixer_event
},
1448 {SKL_VMIXER_EVENT
, skl_tplg_vmixer_event
},
1449 {SKL_PGA_EVENT
, skl_tplg_pga_event
},
1452 static const struct snd_soc_tplg_bytes_ext_ops skl_tlv_ops
[] = {
1453 {SKL_CONTROL_TYPE_BYTE_TLV
, skl_tplg_tlv_control_get
,
1454 skl_tplg_tlv_control_set
},
1458 * The topology binary passes the pin info for a module so initialize the pin
1459 * info passed into module instance
1461 static void skl_fill_module_pin_info(struct skl_dfw_module_pin
*dfw_pin
,
1462 struct skl_module_pin
*m_pin
,
1463 bool is_dynamic
, int max_pin
)
1467 for (i
= 0; i
< max_pin
; i
++) {
1468 m_pin
[i
].id
.module_id
= dfw_pin
[i
].module_id
;
1469 m_pin
[i
].id
.instance_id
= dfw_pin
[i
].instance_id
;
1470 m_pin
[i
].in_use
= false;
1471 m_pin
[i
].is_dynamic
= is_dynamic
;
1472 m_pin
[i
].pin_state
= SKL_PIN_UNBIND
;
1477 * Add pipeline from topology binary into driver pipeline list
1479 * If already added we return that instance
1480 * Otherwise we create a new instance and add into driver list
1482 static struct skl_pipe
*skl_tplg_add_pipe(struct device
*dev
,
1483 struct skl
*skl
, struct skl_dfw_pipe
*dfw_pipe
)
1485 struct skl_pipeline
*ppl
;
1486 struct skl_pipe
*pipe
;
1487 struct skl_pipe_params
*params
;
1489 list_for_each_entry(ppl
, &skl
->ppl_list
, node
) {
1490 if (ppl
->pipe
->ppl_id
== dfw_pipe
->pipe_id
)
1494 ppl
= devm_kzalloc(dev
, sizeof(*ppl
), GFP_KERNEL
);
1498 pipe
= devm_kzalloc(dev
, sizeof(*pipe
), GFP_KERNEL
);
1502 params
= devm_kzalloc(dev
, sizeof(*params
), GFP_KERNEL
);
1506 pipe
->ppl_id
= dfw_pipe
->pipe_id
;
1507 pipe
->memory_pages
= dfw_pipe
->memory_pages
;
1508 pipe
->pipe_priority
= dfw_pipe
->pipe_priority
;
1509 pipe
->conn_type
= dfw_pipe
->conn_type
;
1510 pipe
->state
= SKL_PIPE_INVALID
;
1511 pipe
->p_params
= params
;
1512 INIT_LIST_HEAD(&pipe
->w_list
);
1515 list_add(&ppl
->node
, &skl
->ppl_list
);
1520 static void skl_tplg_fill_fmt(struct skl_module_fmt
*dst_fmt
,
1521 struct skl_dfw_module_fmt
*src_fmt
,
1526 for (i
= 0; i
< pins
; i
++) {
1527 dst_fmt
[i
].channels
= src_fmt
[i
].channels
;
1528 dst_fmt
[i
].s_freq
= src_fmt
[i
].freq
;
1529 dst_fmt
[i
].bit_depth
= src_fmt
[i
].bit_depth
;
1530 dst_fmt
[i
].valid_bit_depth
= src_fmt
[i
].valid_bit_depth
;
1531 dst_fmt
[i
].ch_cfg
= src_fmt
[i
].ch_cfg
;
1532 dst_fmt
[i
].ch_map
= src_fmt
[i
].ch_map
;
1533 dst_fmt
[i
].interleaving_style
= src_fmt
[i
].interleaving_style
;
1534 dst_fmt
[i
].sample_type
= src_fmt
[i
].sample_type
;
1539 * Topology core widget load callback
1541 * This is used to save the private data for each widget which gives
1542 * information to the driver about module and pipeline parameters which DSP
1543 * FW expects like ids, resource values, formats etc
1545 static int skl_tplg_widget_load(struct snd_soc_component
*cmpnt
,
1546 struct snd_soc_dapm_widget
*w
,
1547 struct snd_soc_tplg_dapm_widget
*tplg_w
)
1550 struct hdac_ext_bus
*ebus
= snd_soc_component_get_drvdata(cmpnt
);
1551 struct skl
*skl
= ebus_to_skl(ebus
);
1552 struct hdac_bus
*bus
= ebus_to_hbus(ebus
);
1553 struct skl_module_cfg
*mconfig
;
1554 struct skl_pipe
*pipe
;
1555 struct skl_dfw_module
*dfw_config
=
1556 (struct skl_dfw_module
*)tplg_w
->priv
.data
;
1558 if (!tplg_w
->priv
.size
)
1561 mconfig
= devm_kzalloc(bus
->dev
, sizeof(*mconfig
), GFP_KERNEL
);
1567 memcpy(&mconfig
->guid
, &dfw_config
->uuid
, 16);
1569 mconfig
->id
.module_id
= dfw_config
->module_id
;
1570 mconfig
->id
.instance_id
= dfw_config
->instance_id
;
1571 mconfig
->mcps
= dfw_config
->max_mcps
;
1572 mconfig
->ibs
= dfw_config
->ibs
;
1573 mconfig
->obs
= dfw_config
->obs
;
1574 mconfig
->core_id
= dfw_config
->core_id
;
1575 mconfig
->max_in_queue
= dfw_config
->max_in_queue
;
1576 mconfig
->max_out_queue
= dfw_config
->max_out_queue
;
1577 mconfig
->is_loadable
= dfw_config
->is_loadable
;
1578 skl_tplg_fill_fmt(mconfig
->in_fmt
, dfw_config
->in_fmt
,
1579 MODULE_MAX_IN_PINS
);
1580 skl_tplg_fill_fmt(mconfig
->out_fmt
, dfw_config
->out_fmt
,
1581 MODULE_MAX_OUT_PINS
);
1583 mconfig
->params_fixup
= dfw_config
->params_fixup
;
1584 mconfig
->converter
= dfw_config
->converter
;
1585 mconfig
->m_type
= dfw_config
->module_type
;
1586 mconfig
->vbus_id
= dfw_config
->vbus_id
;
1587 mconfig
->mem_pages
= dfw_config
->mem_pages
;
1589 pipe
= skl_tplg_add_pipe(bus
->dev
, skl
, &dfw_config
->pipe
);
1591 mconfig
->pipe
= pipe
;
1593 mconfig
->dev_type
= dfw_config
->dev_type
;
1594 mconfig
->hw_conn_type
= dfw_config
->hw_conn_type
;
1595 mconfig
->time_slot
= dfw_config
->time_slot
;
1596 mconfig
->formats_config
.caps_size
= dfw_config
->caps
.caps_size
;
1598 mconfig
->m_in_pin
= devm_kzalloc(bus
->dev
, (mconfig
->max_in_queue
) *
1599 sizeof(*mconfig
->m_in_pin
),
1601 if (!mconfig
->m_in_pin
)
1604 mconfig
->m_out_pin
= devm_kzalloc(bus
->dev
, (mconfig
->max_out_queue
) *
1605 sizeof(*mconfig
->m_out_pin
),
1607 if (!mconfig
->m_out_pin
)
1610 skl_fill_module_pin_info(dfw_config
->in_pin
, mconfig
->m_in_pin
,
1611 dfw_config
->is_dynamic_in_pin
,
1612 mconfig
->max_in_queue
);
1614 skl_fill_module_pin_info(dfw_config
->out_pin
, mconfig
->m_out_pin
,
1615 dfw_config
->is_dynamic_out_pin
,
1616 mconfig
->max_out_queue
);
1619 if (mconfig
->formats_config
.caps_size
== 0)
1622 mconfig
->formats_config
.caps
= (u32
*)devm_kzalloc(bus
->dev
,
1623 mconfig
->formats_config
.caps_size
, GFP_KERNEL
);
1625 if (mconfig
->formats_config
.caps
== NULL
)
1628 memcpy(mconfig
->formats_config
.caps
, dfw_config
->caps
.caps
,
1629 dfw_config
->caps
.caps_size
);
1630 mconfig
->formats_config
.param_id
= dfw_config
->caps
.param_id
;
1631 mconfig
->formats_config
.set_params
= dfw_config
->caps
.set_params
;
1634 if (tplg_w
->event_type
== 0) {
1635 dev_dbg(bus
->dev
, "ASoC: No event handler required\n");
1639 ret
= snd_soc_tplg_widget_bind_event(w
, skl_tplg_widget_ops
,
1640 ARRAY_SIZE(skl_tplg_widget_ops
),
1641 tplg_w
->event_type
);
1644 dev_err(bus
->dev
, "%s: No matching event handlers found for %d\n",
1645 __func__
, tplg_w
->event_type
);
1652 static int skl_init_algo_data(struct device
*dev
, struct soc_bytes_ext
*be
,
1653 struct snd_soc_tplg_bytes_control
*bc
)
1655 struct skl_algo_data
*ac
;
1656 struct skl_dfw_algo_data
*dfw_ac
=
1657 (struct skl_dfw_algo_data
*)bc
->priv
.data
;
1659 ac
= devm_kzalloc(dev
, sizeof(*ac
), GFP_KERNEL
);
1663 /* Fill private data */
1664 ac
->max
= dfw_ac
->max
;
1665 ac
->param_id
= dfw_ac
->param_id
;
1666 ac
->set_params
= dfw_ac
->set_params
;
1669 ac
->params
= (char *) devm_kzalloc(dev
, ac
->max
, GFP_KERNEL
);
1673 memcpy(ac
->params
, dfw_ac
->params
, ac
->max
);
1676 be
->dobj
.private = ac
;
1680 static int skl_tplg_control_load(struct snd_soc_component
*cmpnt
,
1681 struct snd_kcontrol_new
*kctl
,
1682 struct snd_soc_tplg_ctl_hdr
*hdr
)
1684 struct soc_bytes_ext
*sb
;
1685 struct snd_soc_tplg_bytes_control
*tplg_bc
;
1686 struct hdac_ext_bus
*ebus
= snd_soc_component_get_drvdata(cmpnt
);
1687 struct hdac_bus
*bus
= ebus_to_hbus(ebus
);
1689 switch (hdr
->ops
.info
) {
1690 case SND_SOC_TPLG_CTL_BYTES
:
1691 tplg_bc
= container_of(hdr
,
1692 struct snd_soc_tplg_bytes_control
, hdr
);
1693 if (kctl
->access
& SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK
) {
1694 sb
= (struct soc_bytes_ext
*)kctl
->private_value
;
1695 if (tplg_bc
->priv
.size
)
1696 return skl_init_algo_data(
1697 bus
->dev
, sb
, tplg_bc
);
1702 dev_warn(bus
->dev
, "Control load not supported %d:%d:%d\n",
1703 hdr
->ops
.get
, hdr
->ops
.put
, hdr
->ops
.info
);
1710 static struct snd_soc_tplg_ops skl_tplg_ops
= {
1711 .widget_load
= skl_tplg_widget_load
,
1712 .control_load
= skl_tplg_control_load
,
1713 .bytes_ext_ops
= skl_tlv_ops
,
1714 .bytes_ext_ops_count
= ARRAY_SIZE(skl_tlv_ops
),
1717 /* This will be read from topology manifest, currently defined here */
1718 #define SKL_MAX_MCPS 30000000
1719 #define SKL_FW_MAX_MEM 1000000
1722 * SKL topology init routine
1724 int skl_tplg_init(struct snd_soc_platform
*platform
, struct hdac_ext_bus
*ebus
)
1727 const struct firmware
*fw
;
1728 struct hdac_bus
*bus
= ebus_to_hbus(ebus
);
1729 struct skl
*skl
= ebus_to_skl(ebus
);
1731 ret
= request_firmware(&fw
, skl
->tplg_name
, bus
->dev
);
1733 dev_err(bus
->dev
, "tplg fw %s load failed with %d\n",
1734 skl
->tplg_name
, ret
);
1735 ret
= request_firmware(&fw
, "dfw_sst.bin", bus
->dev
);
1737 dev_err(bus
->dev
, "Fallback tplg fw %s load failed with %d\n",
1738 "dfw_sst.bin", ret
);
1744 * The complete tplg for SKL is loaded as index 0, we don't use
1747 ret
= snd_soc_tplg_component_load(&platform
->component
,
1748 &skl_tplg_ops
, fw
, 0);
1750 dev_err(bus
->dev
, "tplg component load failed%d\n", ret
);
1751 release_firmware(fw
);
1755 skl
->resource
.max_mcps
= SKL_MAX_MCPS
;
1756 skl
->resource
.max_mem
= SKL_FW_MAX_MEM
;