1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * skl-topology.c - Implements Platform component ALSA controls/widget
4 * handlers.
5 *
6 * Copyright (C) 2014-2015 Intel Corp
7 * Author: Jeeja KP <jeeja.kp@intel.com>
8 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
9 */
10
11 #include <linux/slab.h>
12 #include <linux/types.h>
13 #include <linux/firmware.h>
14 #include <linux/uuid.h>
15 #include <sound/intel-nhlt.h>
16 #include <sound/soc.h>
17 #include <sound/soc-acpi.h>
18 #include <sound/soc-topology.h>
19 #include <uapi/sound/snd_sst_tokens.h>
20 #include <uapi/sound/skl-tplg-interface.h>
21 #include "skl-sst-dsp.h"
22 #include "skl-sst-ipc.h"
23 #include "skl-topology.h"
24 #include "skl.h"
25 #include "../common/sst-dsp.h"
26 #include "../common/sst-dsp-priv.h"
27
28 #define SKL_CH_FIXUP_MASK (1 << 0)
29 #define SKL_RATE_FIXUP_MASK (1 << 1)
30 #define SKL_FMT_FIXUP_MASK (1 << 2)
31 #define SKL_IN_DIR_BIT_MASK BIT(0)
32 #define SKL_PIN_COUNT_MASK GENMASK(7, 4)
33
34 static const int mic_mono_list[] = {
35 0, 1, 2, 3,
36 };
37 static const int mic_stereo_list[][SKL_CH_STEREO] = {
38 {0, 1}, {0, 2}, {0, 3}, {1, 2}, {1, 3}, {2, 3},
39 };
40 static const int mic_trio_list[][SKL_CH_TRIO] = {
41 {0, 1, 2}, {0, 1, 3}, {0, 2, 3}, {1, 2, 3},
42 };
43 static const int mic_quatro_list[][SKL_CH_QUATRO] = {
44 {0, 1, 2, 3},
45 };
46
47 #define CHECK_HW_PARAMS(ch, freq, bps, prm_ch, prm_freq, prm_bps) \
48 ((ch == prm_ch) && (bps == prm_bps) && (freq == prm_freq))
49
skl_tplg_d0i3_get(struct skl_dev * skl,enum d0i3_capability caps)50 void skl_tplg_d0i3_get(struct skl_dev *skl, enum d0i3_capability caps)
51 {
52 struct skl_d0i3_data *d0i3 = &skl->d0i3;
53
54 switch (caps) {
55 case SKL_D0I3_NONE:
56 d0i3->non_d0i3++;
57 break;
58
59 case SKL_D0I3_STREAMING:
60 d0i3->streaming++;
61 break;
62
63 case SKL_D0I3_NON_STREAMING:
64 d0i3->non_streaming++;
65 break;
66 }
67 }
68
skl_tplg_d0i3_put(struct skl_dev * skl,enum d0i3_capability caps)69 void skl_tplg_d0i3_put(struct skl_dev *skl, enum d0i3_capability caps)
70 {
71 struct skl_d0i3_data *d0i3 = &skl->d0i3;
72
73 switch (caps) {
74 case SKL_D0I3_NONE:
75 d0i3->non_d0i3--;
76 break;
77
78 case SKL_D0I3_STREAMING:
79 d0i3->streaming--;
80 break;
81
82 case SKL_D0I3_NON_STREAMING:
83 d0i3->non_streaming--;
84 break;
85 }
86 }
87
88 /*
89 * SKL DSP driver modelling uses only few DAPM widgets so for rest we will
90 * ignore. This helpers checks if the SKL driver handles this widget type
91 */
is_skl_dsp_widget_type(struct snd_soc_dapm_widget * w,struct device * dev)92 static int is_skl_dsp_widget_type(struct snd_soc_dapm_widget *w,
93 struct device *dev)
94 {
95 if (w->dapm->dev != dev)
96 return false;
97
98 switch (w->id) {
99 case snd_soc_dapm_dai_link:
100 case snd_soc_dapm_dai_in:
101 case snd_soc_dapm_aif_in:
102 case snd_soc_dapm_aif_out:
103 case snd_soc_dapm_dai_out:
104 case snd_soc_dapm_switch:
105 case snd_soc_dapm_output:
106 case snd_soc_dapm_mux:
107
108 return false;
109 default:
110 return true;
111 }
112 }
113
skl_dump_mconfig(struct skl_dev * skl,struct skl_module_cfg * mcfg)114 static void skl_dump_mconfig(struct skl_dev *skl, struct skl_module_cfg *mcfg)
115 {
116 struct skl_module_iface *iface = &mcfg->module->formats[mcfg->fmt_idx];
117
118 dev_dbg(skl->dev, "Dumping config\n");
119 dev_dbg(skl->dev, "Input Format:\n");
120 dev_dbg(skl->dev, "channels = %d\n", iface->inputs[0].fmt.channels);
121 dev_dbg(skl->dev, "s_freq = %d\n", iface->inputs[0].fmt.s_freq);
122 dev_dbg(skl->dev, "ch_cfg = %d\n", iface->inputs[0].fmt.ch_cfg);
123 dev_dbg(skl->dev, "valid bit depth = %d\n",
124 iface->inputs[0].fmt.valid_bit_depth);
125 dev_dbg(skl->dev, "Output Format:\n");
126 dev_dbg(skl->dev, "channels = %d\n", iface->outputs[0].fmt.channels);
127 dev_dbg(skl->dev, "s_freq = %d\n", iface->outputs[0].fmt.s_freq);
128 dev_dbg(skl->dev, "valid bit depth = %d\n",
129 iface->outputs[0].fmt.valid_bit_depth);
130 dev_dbg(skl->dev, "ch_cfg = %d\n", iface->outputs[0].fmt.ch_cfg);
131 }
132
skl_tplg_update_chmap(struct skl_module_fmt * fmt,int chs)133 static void skl_tplg_update_chmap(struct skl_module_fmt *fmt, int chs)
134 {
135 int slot_map = 0xFFFFFFFF;
136 int start_slot = 0;
137 int i;
138
139 for (i = 0; i < chs; i++) {
140 /*
141 * For 2 channels with starting slot as 0, slot map will
142 * look like 0xFFFFFF10.
143 */
144 slot_map &= (~(0xF << (4 * i)) | (start_slot << (4 * i)));
145 start_slot++;
146 }
147 fmt->ch_map = slot_map;
148 }
149
skl_tplg_update_params(struct skl_module_fmt * fmt,struct skl_pipe_params * params,int fixup)150 static void skl_tplg_update_params(struct skl_module_fmt *fmt,
151 struct skl_pipe_params *params, int fixup)
152 {
153 if (fixup & SKL_RATE_FIXUP_MASK)
154 fmt->s_freq = params->s_freq;
155 if (fixup & SKL_CH_FIXUP_MASK) {
156 fmt->channels = params->ch;
157 skl_tplg_update_chmap(fmt, fmt->channels);
158 }
159 if (fixup & SKL_FMT_FIXUP_MASK) {
160 fmt->valid_bit_depth = skl_get_bit_depth(params->s_fmt);
161
162 /*
163 * 16 bit is 16 bit container whereas 24 bit is in 32 bit
164 * container so update bit depth accordingly
165 */
166 switch (fmt->valid_bit_depth) {
167 case SKL_DEPTH_16BIT:
168 fmt->bit_depth = fmt->valid_bit_depth;
169 break;
170
171 default:
172 fmt->bit_depth = SKL_DEPTH_32BIT;
173 break;
174 }
175 }
176
177 }
178
179 /*
180 * A pipeline may have modules which impact the pcm parameters, like SRC,
181 * channel converter, format converter.
182 * We need to calculate the output params by applying the 'fixup'
183 * Topology will tell driver which type of fixup is to be applied by
184 * supplying the fixup mask, so based on that we calculate the output
185 *
186 * Now In FE the pcm hw_params is source/target format. Same is applicable
187 * for BE with its hw_params invoked.
188 * here based on FE, BE pipeline and direction we calculate the input and
189 * outfix and then apply that for a module
190 */
skl_tplg_update_params_fixup(struct skl_module_cfg * m_cfg,struct skl_pipe_params * params,bool is_fe)191 static void skl_tplg_update_params_fixup(struct skl_module_cfg *m_cfg,
192 struct skl_pipe_params *params, bool is_fe)
193 {
194 int in_fixup, out_fixup;
195 struct skl_module_fmt *in_fmt, *out_fmt;
196
197 /* Fixups will be applied to pin 0 only */
198 in_fmt = &m_cfg->module->formats[m_cfg->fmt_idx].inputs[0].fmt;
199 out_fmt = &m_cfg->module->formats[m_cfg->fmt_idx].outputs[0].fmt;
200
201 if (params->stream == SNDRV_PCM_STREAM_PLAYBACK) {
202 if (is_fe) {
203 in_fixup = m_cfg->params_fixup;
204 out_fixup = (~m_cfg->converter) &
205 m_cfg->params_fixup;
206 } else {
207 out_fixup = m_cfg->params_fixup;
208 in_fixup = (~m_cfg->converter) &
209 m_cfg->params_fixup;
210 }
211 } else {
212 if (is_fe) {
213 out_fixup = m_cfg->params_fixup;
214 in_fixup = (~m_cfg->converter) &
215 m_cfg->params_fixup;
216 } else {
217 in_fixup = m_cfg->params_fixup;
218 out_fixup = (~m_cfg->converter) &
219 m_cfg->params_fixup;
220 }
221 }
222
223 skl_tplg_update_params(in_fmt, params, in_fixup);
224 skl_tplg_update_params(out_fmt, params, out_fixup);
225 }
226
227 /*
228 * A module needs input and output buffers, which are dependent upon pcm
229 * params, so once we have calculate params, we need buffer calculation as
230 * well.
231 */
skl_tplg_update_buffer_size(struct skl_dev * skl,struct skl_module_cfg * mcfg)232 static void skl_tplg_update_buffer_size(struct skl_dev *skl,
233 struct skl_module_cfg *mcfg)
234 {
235 int multiplier = 1;
236 struct skl_module_fmt *in_fmt, *out_fmt;
237 struct skl_module_res *res;
238
239 /* Since fixups is applied to pin 0 only, ibs, obs needs
240 * change for pin 0 only
241 */
242 res = &mcfg->module->resources[mcfg->res_idx];
243 in_fmt = &mcfg->module->formats[mcfg->fmt_idx].inputs[0].fmt;
244 out_fmt = &mcfg->module->formats[mcfg->fmt_idx].outputs[0].fmt;
245
246 if (mcfg->m_type == SKL_MODULE_TYPE_SRCINT)
247 multiplier = 5;
248
249 res->ibs = DIV_ROUND_UP(in_fmt->s_freq, 1000) *
250 in_fmt->channels * (in_fmt->bit_depth >> 3) *
251 multiplier;
252
253 res->obs = DIV_ROUND_UP(out_fmt->s_freq, 1000) *
254 out_fmt->channels * (out_fmt->bit_depth >> 3) *
255 multiplier;
256 }
257
skl_tplg_be_dev_type(int dev_type)258 static u8 skl_tplg_be_dev_type(int dev_type)
259 {
260 int ret;
261
262 switch (dev_type) {
263 case SKL_DEVICE_BT:
264 ret = NHLT_DEVICE_BT;
265 break;
266
267 case SKL_DEVICE_DMIC:
268 ret = NHLT_DEVICE_DMIC;
269 break;
270
271 case SKL_DEVICE_I2S:
272 ret = NHLT_DEVICE_I2S;
273 break;
274
275 default:
276 ret = NHLT_DEVICE_INVALID;
277 break;
278 }
279
280 return ret;
281 }
282
skl_tplg_update_be_blob(struct snd_soc_dapm_widget * w,struct skl_dev * skl)283 static int skl_tplg_update_be_blob(struct snd_soc_dapm_widget *w,
284 struct skl_dev *skl)
285 {
286 struct skl_module_cfg *m_cfg = w->priv;
287 int link_type, dir;
288 u32 ch, s_freq, s_fmt, s_cont;
289 struct nhlt_specific_cfg *cfg;
290 u8 dev_type = skl_tplg_be_dev_type(m_cfg->dev_type);
291 int fmt_idx = m_cfg->fmt_idx;
292 struct skl_module_iface *m_iface = &m_cfg->module->formats[fmt_idx];
293
294 /* check if we already have blob */
295 if (m_cfg->formats_config[SKL_PARAM_INIT].caps_size > 0)
296 return 0;
297
298 dev_dbg(skl->dev, "Applying default cfg blob\n");
299 switch (m_cfg->dev_type) {
300 case SKL_DEVICE_DMIC:
301 link_type = NHLT_LINK_DMIC;
302 dir = SNDRV_PCM_STREAM_CAPTURE;
303 s_freq = m_iface->inputs[0].fmt.s_freq;
304 s_fmt = m_iface->inputs[0].fmt.valid_bit_depth;
305 s_cont = m_iface->inputs[0].fmt.bit_depth;
306 ch = m_iface->inputs[0].fmt.channels;
307 break;
308
309 case SKL_DEVICE_I2S:
310 link_type = NHLT_LINK_SSP;
311 if (m_cfg->hw_conn_type == SKL_CONN_SOURCE) {
312 dir = SNDRV_PCM_STREAM_PLAYBACK;
313 s_freq = m_iface->outputs[0].fmt.s_freq;
314 s_fmt = m_iface->outputs[0].fmt.valid_bit_depth;
315 s_cont = m_iface->outputs[0].fmt.bit_depth;
316 ch = m_iface->outputs[0].fmt.channels;
317 } else {
318 dir = SNDRV_PCM_STREAM_CAPTURE;
319 s_freq = m_iface->inputs[0].fmt.s_freq;
320 s_fmt = m_iface->inputs[0].fmt.valid_bit_depth;
321 s_cont = m_iface->inputs[0].fmt.bit_depth;
322 ch = m_iface->inputs[0].fmt.channels;
323 }
324 break;
325
326 default:
327 return -EINVAL;
328 }
329
330 /* update the blob based on virtual bus_id and default params */
331 cfg = intel_nhlt_get_endpoint_blob(skl->dev, skl->nhlt, m_cfg->vbus_id,
332 link_type, s_fmt, s_cont, ch,
333 s_freq, dir, dev_type);
334 if (cfg) {
335 m_cfg->formats_config[SKL_PARAM_INIT].caps_size = cfg->size;
336 m_cfg->formats_config[SKL_PARAM_INIT].caps = (u32 *)&cfg->caps;
337 } else {
338 dev_err(skl->dev, "Blob NULL for id %x type %d dirn %d\n",
339 m_cfg->vbus_id, link_type, dir);
340 dev_err(skl->dev, "PCM: ch %d, freq %d, fmt %d/%d\n",
341 ch, s_freq, s_fmt, s_cont);
342 return -EIO;
343 }
344
345 return 0;
346 }
347
skl_tplg_update_module_params(struct snd_soc_dapm_widget * w,struct skl_dev * skl)348 static void skl_tplg_update_module_params(struct snd_soc_dapm_widget *w,
349 struct skl_dev *skl)
350 {
351 struct skl_module_cfg *m_cfg = w->priv;
352 struct skl_pipe_params *params = m_cfg->pipe->p_params;
353 int p_conn_type = m_cfg->pipe->conn_type;
354 bool is_fe;
355
356 if (!m_cfg->params_fixup)
357 return;
358
359 dev_dbg(skl->dev, "Mconfig for widget=%s BEFORE updation\n",
360 w->name);
361
362 skl_dump_mconfig(skl, m_cfg);
363
364 if (p_conn_type == SKL_PIPE_CONN_TYPE_FE)
365 is_fe = true;
366 else
367 is_fe = false;
368
369 skl_tplg_update_params_fixup(m_cfg, params, is_fe);
370 skl_tplg_update_buffer_size(skl, m_cfg);
371
372 dev_dbg(skl->dev, "Mconfig for widget=%s AFTER updation\n",
373 w->name);
374
375 skl_dump_mconfig(skl, m_cfg);
376 }
377
378 /*
379 * some modules can have multiple params set from user control and
380 * need to be set after module is initialized. If set_param flag is
381 * set module params will be done after module is initialised.
382 */
skl_tplg_set_module_params(struct snd_soc_dapm_widget * w,struct skl_dev * skl)383 static int skl_tplg_set_module_params(struct snd_soc_dapm_widget *w,
384 struct skl_dev *skl)
385 {
386 int i, ret;
387 struct skl_module_cfg *mconfig = w->priv;
388 const struct snd_kcontrol_new *k;
389 struct soc_bytes_ext *sb;
390 struct skl_algo_data *bc;
391 struct skl_specific_cfg *sp_cfg;
392
393 if (mconfig->formats_config[SKL_PARAM_SET].caps_size > 0 &&
394 mconfig->formats_config[SKL_PARAM_SET].set_params == SKL_PARAM_SET) {
395 sp_cfg = &mconfig->formats_config[SKL_PARAM_SET];
396 ret = skl_set_module_params(skl, sp_cfg->caps,
397 sp_cfg->caps_size,
398 sp_cfg->param_id, mconfig);
399 if (ret < 0)
400 return ret;
401 }
402
403 for (i = 0; i < w->num_kcontrols; i++) {
404 k = &w->kcontrol_news[i];
405 if (k->access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) {
406 sb = (void *) k->private_value;
407 bc = (struct skl_algo_data *)sb->dobj.private;
408
409 if (bc->set_params == SKL_PARAM_SET) {
410 ret = skl_set_module_params(skl,
411 (u32 *)bc->params, bc->size,
412 bc->param_id, mconfig);
413 if (ret < 0)
414 return ret;
415 }
416 }
417 }
418
419 return 0;
420 }
421
422 /*
423 * some module param can set from user control and this is required as
424 * when module is initailzed. if module param is required in init it is
425 * identifed by set_param flag. if set_param flag is not set, then this
426 * parameter needs to set as part of module init.
427 */
skl_tplg_set_module_init_data(struct snd_soc_dapm_widget * w)428 static int skl_tplg_set_module_init_data(struct snd_soc_dapm_widget *w)
429 {
430 const struct snd_kcontrol_new *k;
431 struct soc_bytes_ext *sb;
432 struct skl_algo_data *bc;
433 struct skl_module_cfg *mconfig = w->priv;
434 int i;
435
436 for (i = 0; i < w->num_kcontrols; i++) {
437 k = &w->kcontrol_news[i];
438 if (k->access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) {
439 sb = (struct soc_bytes_ext *)k->private_value;
440 bc = (struct skl_algo_data *)sb->dobj.private;
441
442 if (bc->set_params != SKL_PARAM_INIT)
443 continue;
444
445 mconfig->formats_config[SKL_PARAM_INIT].caps =
446 (u32 *)bc->params;
447 mconfig->formats_config[SKL_PARAM_INIT].caps_size =
448 bc->size;
449
450 break;
451 }
452 }
453
454 return 0;
455 }
456
skl_tplg_module_prepare(struct skl_dev * skl,struct skl_pipe * pipe,struct snd_soc_dapm_widget * w,struct skl_module_cfg * mcfg)457 static int skl_tplg_module_prepare(struct skl_dev *skl, struct skl_pipe *pipe,
458 struct snd_soc_dapm_widget *w, struct skl_module_cfg *mcfg)
459 {
460 switch (mcfg->dev_type) {
461 case SKL_DEVICE_HDAHOST:
462 return skl_pcm_host_dma_prepare(skl->dev, pipe->p_params);
463
464 case SKL_DEVICE_HDALINK:
465 return skl_pcm_link_dma_prepare(skl->dev, pipe->p_params);
466 }
467
468 return 0;
469 }
470
471 /*
472 * Inside a pipe instance, we can have various modules. These modules need
473 * to instantiated in DSP by invoking INIT_MODULE IPC, which is achieved by
474 * skl_init_module() routine, so invoke that for all modules in a pipeline
475 */
476 static int
skl_tplg_init_pipe_modules(struct skl_dev * skl,struct skl_pipe * pipe)477 skl_tplg_init_pipe_modules(struct skl_dev *skl, struct skl_pipe *pipe)
478 {
479 struct skl_pipe_module *w_module;
480 struct snd_soc_dapm_widget *w;
481 struct skl_module_cfg *mconfig;
482 u8 cfg_idx;
483 int ret = 0;
484
485 list_for_each_entry(w_module, &pipe->w_list, node) {
486 guid_t *uuid_mod;
487 w = w_module->w;
488 mconfig = w->priv;
489
490 /* check if module ids are populated */
491 if (mconfig->id.module_id < 0) {
492 dev_err(skl->dev,
493 "module %pUL id not populated\n",
494 (guid_t *)mconfig->guid);
495 return -EIO;
496 }
497
498 cfg_idx = mconfig->pipe->cur_config_idx;
499 mconfig->fmt_idx = mconfig->mod_cfg[cfg_idx].fmt_idx;
500 mconfig->res_idx = mconfig->mod_cfg[cfg_idx].res_idx;
501
502 if (mconfig->module->loadable && skl->dsp->fw_ops.load_mod) {
503 ret = skl->dsp->fw_ops.load_mod(skl->dsp,
504 mconfig->id.module_id, mconfig->guid);
505 if (ret < 0)
506 return ret;
507 }
508
509 /* prepare the DMA if the module is gateway cpr */
510 ret = skl_tplg_module_prepare(skl, pipe, w, mconfig);
511 if (ret < 0)
512 return ret;
513
514 /* update blob if blob is null for be with default value */
515 skl_tplg_update_be_blob(w, skl);
516
517 /*
518 * apply fix/conversion to module params based on
519 * FE/BE params
520 */
521 skl_tplg_update_module_params(w, skl);
522 uuid_mod = (guid_t *)mconfig->guid;
523 mconfig->id.pvt_id = skl_get_pvt_id(skl, uuid_mod,
524 mconfig->id.instance_id);
525 if (mconfig->id.pvt_id < 0)
526 return ret;
527 skl_tplg_set_module_init_data(w);
528
529 ret = skl_dsp_get_core(skl->dsp, mconfig->core_id);
530 if (ret < 0) {
531 dev_err(skl->dev, "Failed to wake up core %d ret=%d\n",
532 mconfig->core_id, ret);
533 return ret;
534 }
535
536 ret = skl_init_module(skl, mconfig);
537 if (ret < 0) {
538 skl_put_pvt_id(skl, uuid_mod, &mconfig->id.pvt_id);
539 goto err;
540 }
541
542 ret = skl_tplg_set_module_params(w, skl);
543 if (ret < 0)
544 goto err;
545 }
546
547 return 0;
548 err:
549 skl_dsp_put_core(skl->dsp, mconfig->core_id);
550 return ret;
551 }
552
skl_tplg_unload_pipe_modules(struct skl_dev * skl,struct skl_pipe * pipe)553 static int skl_tplg_unload_pipe_modules(struct skl_dev *skl,
554 struct skl_pipe *pipe)
555 {
556 int ret = 0;
557 struct skl_pipe_module *w_module;
558 struct skl_module_cfg *mconfig;
559
560 list_for_each_entry(w_module, &pipe->w_list, node) {
561 guid_t *uuid_mod;
562 mconfig = w_module->w->priv;
563 uuid_mod = (guid_t *)mconfig->guid;
564
565 if (mconfig->module->loadable && skl->dsp->fw_ops.unload_mod) {
566 ret = skl->dsp->fw_ops.unload_mod(skl->dsp,
567 mconfig->id.module_id);
568 if (ret < 0)
569 return -EIO;
570 }
571 skl_put_pvt_id(skl, uuid_mod, &mconfig->id.pvt_id);
572
573 ret = skl_dsp_put_core(skl->dsp, mconfig->core_id);
574 if (ret < 0) {
575 /* don't return; continue with other modules */
576 dev_err(skl->dev, "Failed to sleep core %d ret=%d\n",
577 mconfig->core_id, ret);
578 }
579 }
580
581 /* no modules to unload in this path, so return */
582 return ret;
583 }
584
skl_tplg_set_pipe_config_idx(struct skl_pipe * pipe,int idx)585 static void skl_tplg_set_pipe_config_idx(struct skl_pipe *pipe, int idx)
586 {
587 pipe->cur_config_idx = idx;
588 pipe->memory_pages = pipe->configs[idx].mem_pages;
589 }
590
591 /*
592 * Here, we select pipe format based on the pipe type and pipe
593 * direction to determine the current config index for the pipeline.
594 * The config index is then used to select proper module resources.
595 * Intermediate pipes currently have a fixed format hence we select the
596 * 0th configuratation by default for such pipes.
597 */
598 static int
skl_tplg_get_pipe_config(struct skl_dev * skl,struct skl_module_cfg * mconfig)599 skl_tplg_get_pipe_config(struct skl_dev *skl, struct skl_module_cfg *mconfig)
600 {
601 struct skl_pipe *pipe = mconfig->pipe;
602 struct skl_pipe_params *params = pipe->p_params;
603 struct skl_path_config *pconfig = &pipe->configs[0];
604 struct skl_pipe_fmt *fmt = NULL;
605 bool in_fmt = false;
606 int i;
607
608 if (pipe->nr_cfgs == 0) {
609 skl_tplg_set_pipe_config_idx(pipe, 0);
610 return 0;
611 }
612
613 if (pipe->conn_type == SKL_PIPE_CONN_TYPE_NONE || pipe->nr_cfgs == 1) {
614 dev_dbg(skl->dev, "No conn_type or just 1 pathcfg, taking 0th for %d\n",
615 pipe->ppl_id);
616 skl_tplg_set_pipe_config_idx(pipe, 0);
617 return 0;
618 }
619
620 if ((pipe->conn_type == SKL_PIPE_CONN_TYPE_FE &&
621 pipe->direction == SNDRV_PCM_STREAM_PLAYBACK) ||
622 (pipe->conn_type == SKL_PIPE_CONN_TYPE_BE &&
623 pipe->direction == SNDRV_PCM_STREAM_CAPTURE))
624 in_fmt = true;
625
626 for (i = 0; i < pipe->nr_cfgs; i++) {
627 pconfig = &pipe->configs[i];
628 if (in_fmt)
629 fmt = &pconfig->in_fmt;
630 else
631 fmt = &pconfig->out_fmt;
632
633 if (CHECK_HW_PARAMS(params->ch, params->s_freq, params->s_fmt,
634 fmt->channels, fmt->freq, fmt->bps)) {
635 skl_tplg_set_pipe_config_idx(pipe, i);
636 dev_dbg(skl->dev, "Using pipe config: %d\n", i);
637 return 0;
638 }
639 }
640
641 dev_err(skl->dev, "Invalid pipe config: %d %d %d for pipe: %d\n",
642 params->ch, params->s_freq, params->s_fmt, pipe->ppl_id);
643 return -EINVAL;
644 }
645
646 /*
647 * Mixer module represents a pipeline. So in the Pre-PMU event of mixer we
648 * need create the pipeline. So we do following:
649 * - Create the pipeline
650 * - Initialize the modules in pipeline
651 * - finally bind all modules together
652 */
skl_tplg_mixer_dapm_pre_pmu_event(struct snd_soc_dapm_widget * w,struct skl_dev * skl)653 static int skl_tplg_mixer_dapm_pre_pmu_event(struct snd_soc_dapm_widget *w,
654 struct skl_dev *skl)
655 {
656 int ret;
657 struct skl_module_cfg *mconfig = w->priv;
658 struct skl_pipe_module *w_module;
659 struct skl_pipe *s_pipe = mconfig->pipe;
660 struct skl_module_cfg *src_module = NULL, *dst_module, *module;
661 struct skl_module_deferred_bind *modules;
662
663 ret = skl_tplg_get_pipe_config(skl, mconfig);
664 if (ret < 0)
665 return ret;
666
667 /*
668 * Create a list of modules for pipe.
669 * This list contains modules from source to sink
670 */
671 ret = skl_create_pipeline(skl, mconfig->pipe);
672 if (ret < 0)
673 return ret;
674
675 /* Init all pipe modules from source to sink */
676 ret = skl_tplg_init_pipe_modules(skl, s_pipe);
677 if (ret < 0)
678 return ret;
679
680 /* Bind modules from source to sink */
681 list_for_each_entry(w_module, &s_pipe->w_list, node) {
682 dst_module = w_module->w->priv;
683
684 if (src_module == NULL) {
685 src_module = dst_module;
686 continue;
687 }
688
689 ret = skl_bind_modules(skl, src_module, dst_module);
690 if (ret < 0)
691 return ret;
692
693 src_module = dst_module;
694 }
695
696 /*
697 * When the destination module is initialized, check for these modules
698 * in deferred bind list. If found, bind them.
699 */
700 list_for_each_entry(w_module, &s_pipe->w_list, node) {
701 if (list_empty(&skl->bind_list))
702 break;
703
704 list_for_each_entry(modules, &skl->bind_list, node) {
705 module = w_module->w->priv;
706 if (modules->dst == module)
707 skl_bind_modules(skl, modules->src,
708 modules->dst);
709 }
710 }
711
712 return 0;
713 }
714
skl_fill_sink_instance_id(struct skl_dev * skl,u32 * params,int size,struct skl_module_cfg * mcfg)715 static int skl_fill_sink_instance_id(struct skl_dev *skl, u32 *params,
716 int size, struct skl_module_cfg *mcfg)
717 {
718 int i, pvt_id;
719
720 if (mcfg->m_type == SKL_MODULE_TYPE_KPB) {
721 struct skl_kpb_params *kpb_params =
722 (struct skl_kpb_params *)params;
723 struct skl_mod_inst_map *inst = kpb_params->u.map;
724
725 for (i = 0; i < kpb_params->num_modules; i++) {
726 pvt_id = skl_get_pvt_instance_id_map(skl, inst->mod_id,
727 inst->inst_id);
728 if (pvt_id < 0)
729 return -EINVAL;
730
731 inst->inst_id = pvt_id;
732 inst++;
733 }
734 }
735
736 return 0;
737 }
738 /*
739 * Some modules require params to be set after the module is bound to
740 * all pins connected.
741 *
742 * The module provider initializes set_param flag for such modules and we
743 * send params after binding
744 */
skl_tplg_set_module_bind_params(struct snd_soc_dapm_widget * w,struct skl_module_cfg * mcfg,struct skl_dev * skl)745 static int skl_tplg_set_module_bind_params(struct snd_soc_dapm_widget *w,
746 struct skl_module_cfg *mcfg, struct skl_dev *skl)
747 {
748 int i, ret;
749 struct skl_module_cfg *mconfig = w->priv;
750 const struct snd_kcontrol_new *k;
751 struct soc_bytes_ext *sb;
752 struct skl_algo_data *bc;
753 struct skl_specific_cfg *sp_cfg;
754 u32 *params;
755
756 /*
757 * check all out/in pins are in bind state.
758 * if so set the module param
759 */
760 for (i = 0; i < mcfg->module->max_output_pins; i++) {
761 if (mcfg->m_out_pin[i].pin_state != SKL_PIN_BIND_DONE)
762 return 0;
763 }
764
765 for (i = 0; i < mcfg->module->max_input_pins; i++) {
766 if (mcfg->m_in_pin[i].pin_state != SKL_PIN_BIND_DONE)
767 return 0;
768 }
769
770 if (mconfig->formats_config[SKL_PARAM_BIND].caps_size > 0 &&
771 mconfig->formats_config[SKL_PARAM_BIND].set_params ==
772 SKL_PARAM_BIND) {
773 sp_cfg = &mconfig->formats_config[SKL_PARAM_BIND];
774 ret = skl_set_module_params(skl, sp_cfg->caps,
775 sp_cfg->caps_size,
776 sp_cfg->param_id, mconfig);
777 if (ret < 0)
778 return ret;
779 }
780
781 for (i = 0; i < w->num_kcontrols; i++) {
782 k = &w->kcontrol_news[i];
783 if (k->access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) {
784 sb = (void *) k->private_value;
785 bc = (struct skl_algo_data *)sb->dobj.private;
786
787 if (bc->set_params == SKL_PARAM_BIND) {
788 params = kmemdup(bc->params, bc->max, GFP_KERNEL);
789 if (!params)
790 return -ENOMEM;
791
792 skl_fill_sink_instance_id(skl, params, bc->max,
793 mconfig);
794
795 ret = skl_set_module_params(skl, params,
796 bc->max, bc->param_id, mconfig);
797 kfree(params);
798
799 if (ret < 0)
800 return ret;
801 }
802 }
803 }
804
805 return 0;
806 }
807
skl_get_module_id(struct skl_dev * skl,guid_t * uuid)808 static int skl_get_module_id(struct skl_dev *skl, guid_t *uuid)
809 {
810 struct uuid_module *module;
811
812 list_for_each_entry(module, &skl->uuid_list, list) {
813 if (guid_equal(uuid, &module->uuid))
814 return module->id;
815 }
816
817 return -EINVAL;
818 }
819
skl_tplg_find_moduleid_from_uuid(struct skl_dev * skl,const struct snd_kcontrol_new * k)820 static int skl_tplg_find_moduleid_from_uuid(struct skl_dev *skl,
821 const struct snd_kcontrol_new *k)
822 {
823 struct soc_bytes_ext *sb = (void *) k->private_value;
824 struct skl_algo_data *bc = (struct skl_algo_data *)sb->dobj.private;
825 struct skl_kpb_params *uuid_params, *params;
826 struct hdac_bus *bus = skl_to_bus(skl);
827 int i, size, module_id;
828
829 if (bc->set_params == SKL_PARAM_BIND && bc->max) {
830 uuid_params = (struct skl_kpb_params *)bc->params;
831 size = struct_size(params, u.map, uuid_params->num_modules);
832
833 params = devm_kzalloc(bus->dev, size, GFP_KERNEL);
834 if (!params)
835 return -ENOMEM;
836
837 params->num_modules = uuid_params->num_modules;
838
839 for (i = 0; i < uuid_params->num_modules; i++) {
840 module_id = skl_get_module_id(skl,
841 &uuid_params->u.map_uuid[i].mod_uuid);
842 if (module_id < 0) {
843 devm_kfree(bus->dev, params);
844 return -EINVAL;
845 }
846
847 params->u.map[i].mod_id = module_id;
848 params->u.map[i].inst_id =
849 uuid_params->u.map_uuid[i].inst_id;
850 }
851
852 devm_kfree(bus->dev, bc->params);
853 bc->params = (char *)params;
854 bc->max = size;
855 }
856
857 return 0;
858 }
859
860 /*
861 * Retrieve the module id from UUID mentioned in the
862 * post bind params
863 */
skl_tplg_add_moduleid_in_bind_params(struct skl_dev * skl,struct snd_soc_dapm_widget * w)864 void skl_tplg_add_moduleid_in_bind_params(struct skl_dev *skl,
865 struct snd_soc_dapm_widget *w)
866 {
867 struct skl_module_cfg *mconfig = w->priv;
868 int i;
869
870 /*
871 * Post bind params are used for only for KPB
872 * to set copier instances to drain the data
873 * in fast mode
874 */
875 if (mconfig->m_type != SKL_MODULE_TYPE_KPB)
876 return;
877
878 for (i = 0; i < w->num_kcontrols; i++)
879 if ((w->kcontrol_news[i].access &
880 SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) &&
881 (skl_tplg_find_moduleid_from_uuid(skl,
882 &w->kcontrol_news[i]) < 0))
883 dev_err(skl->dev,
884 "%s: invalid kpb post bind params\n",
885 __func__);
886 }
887
skl_tplg_module_add_deferred_bind(struct skl_dev * skl,struct skl_module_cfg * src,struct skl_module_cfg * dst)888 static int skl_tplg_module_add_deferred_bind(struct skl_dev *skl,
889 struct skl_module_cfg *src, struct skl_module_cfg *dst)
890 {
891 struct skl_module_deferred_bind *m_list, *modules;
892 int i;
893
894 /* only supported for module with static pin connection */
895 for (i = 0; i < dst->module->max_input_pins; i++) {
896 struct skl_module_pin *pin = &dst->m_in_pin[i];
897
898 if (pin->is_dynamic)
899 continue;
900
901 if ((pin->id.module_id == src->id.module_id) &&
902 (pin->id.instance_id == src->id.instance_id)) {
903
904 if (!list_empty(&skl->bind_list)) {
905 list_for_each_entry(modules, &skl->bind_list, node) {
906 if (modules->src == src && modules->dst == dst)
907 return 0;
908 }
909 }
910
911 m_list = kzalloc(sizeof(*m_list), GFP_KERNEL);
912 if (!m_list)
913 return -ENOMEM;
914
915 m_list->src = src;
916 m_list->dst = dst;
917
918 list_add(&m_list->node, &skl->bind_list);
919 }
920 }
921
922 return 0;
923 }
924
skl_tplg_bind_sinks(struct snd_soc_dapm_widget * w,struct skl_dev * skl,struct snd_soc_dapm_widget * src_w,struct skl_module_cfg * src_mconfig)925 static int skl_tplg_bind_sinks(struct snd_soc_dapm_widget *w,
926 struct skl_dev *skl,
927 struct snd_soc_dapm_widget *src_w,
928 struct skl_module_cfg *src_mconfig)
929 {
930 struct snd_soc_dapm_path *p;
931 struct snd_soc_dapm_widget *sink = NULL, *next_sink = NULL;
932 struct skl_module_cfg *sink_mconfig;
933 int ret;
934
935 snd_soc_dapm_widget_for_each_sink_path(w, p) {
936 if (!p->connect)
937 continue;
938
939 dev_dbg(skl->dev,
940 "%s: src widget=%s\n", __func__, w->name);
941 dev_dbg(skl->dev,
942 "%s: sink widget=%s\n", __func__, p->sink->name);
943
944 next_sink = p->sink;
945
946 if (!is_skl_dsp_widget_type(p->sink, skl->dev))
947 return skl_tplg_bind_sinks(p->sink, skl, src_w, src_mconfig);
948
949 /*
950 * here we will check widgets in sink pipelines, so that
951 * can be any widgets type and we are only interested if
952 * they are ones used for SKL so check that first
953 */
954 if ((p->sink->priv != NULL) &&
955 is_skl_dsp_widget_type(p->sink, skl->dev)) {
956
957 sink = p->sink;
958 sink_mconfig = sink->priv;
959
960 /*
961 * Modules other than PGA leaf can be connected
962 * directly or via switch to a module in another
963 * pipeline. EX: reference path
964 * when the path is enabled, the dst module that needs
965 * to be bound may not be initialized. if the module is
966 * not initialized, add these modules in the deferred
967 * bind list and when the dst module is initialised,
968 * bind this module to the dst_module in deferred list.
969 */
970 if (((src_mconfig->m_state == SKL_MODULE_INIT_DONE)
971 && (sink_mconfig->m_state == SKL_MODULE_UNINIT))) {
972
973 ret = skl_tplg_module_add_deferred_bind(skl,
974 src_mconfig, sink_mconfig);
975
976 if (ret < 0)
977 return ret;
978
979 }
980
981
982 if (src_mconfig->m_state == SKL_MODULE_UNINIT ||
983 sink_mconfig->m_state == SKL_MODULE_UNINIT)
984 continue;
985
986 /* Bind source to sink, mixin is always source */
987 ret = skl_bind_modules(skl, src_mconfig, sink_mconfig);
988 if (ret)
989 return ret;
990
991 /* set module params after bind */
992 skl_tplg_set_module_bind_params(src_w,
993 src_mconfig, skl);
994 skl_tplg_set_module_bind_params(sink,
995 sink_mconfig, skl);
996
997 /* Start sinks pipe first */
998 if (sink_mconfig->pipe->state != SKL_PIPE_STARTED) {
999 if (sink_mconfig->pipe->conn_type !=
1000 SKL_PIPE_CONN_TYPE_FE)
1001 ret = skl_run_pipe(skl,
1002 sink_mconfig->pipe);
1003 if (ret)
1004 return ret;
1005 }
1006 }
1007 }
1008
1009 if (!sink && next_sink)
1010 return skl_tplg_bind_sinks(next_sink, skl, src_w, src_mconfig);
1011
1012 return 0;
1013 }
1014
1015 /*
1016 * A PGA represents a module in a pipeline. So in the Pre-PMU event of PGA
1017 * we need to do following:
1018 * - Bind to sink pipeline
1019 * Since the sink pipes can be running and we don't get mixer event on
1020 * connect for already running mixer, we need to find the sink pipes
1021 * here and bind to them. This way dynamic connect works.
1022 * - Start sink pipeline, if not running
1023 * - Then run current pipe
1024 */
skl_tplg_pga_dapm_pre_pmu_event(struct snd_soc_dapm_widget * w,struct skl_dev * skl)1025 static int skl_tplg_pga_dapm_pre_pmu_event(struct snd_soc_dapm_widget *w,
1026 struct skl_dev *skl)
1027 {
1028 struct skl_module_cfg *src_mconfig;
1029 int ret = 0;
1030
1031 src_mconfig = w->priv;
1032
1033 /*
1034 * find which sink it is connected to, bind with the sink,
1035 * if sink is not started, start sink pipe first, then start
1036 * this pipe
1037 */
1038 ret = skl_tplg_bind_sinks(w, skl, w, src_mconfig);
1039 if (ret)
1040 return ret;
1041
1042 /* Start source pipe last after starting all sinks */
1043 if (src_mconfig->pipe->conn_type != SKL_PIPE_CONN_TYPE_FE)
1044 return skl_run_pipe(skl, src_mconfig->pipe);
1045
1046 return 0;
1047 }
1048
skl_get_src_dsp_widget(struct snd_soc_dapm_widget * w,struct skl_dev * skl)1049 static struct snd_soc_dapm_widget *skl_get_src_dsp_widget(
1050 struct snd_soc_dapm_widget *w, struct skl_dev *skl)
1051 {
1052 struct snd_soc_dapm_path *p;
1053 struct snd_soc_dapm_widget *src_w = NULL;
1054
1055 snd_soc_dapm_widget_for_each_source_path(w, p) {
1056 src_w = p->source;
1057 if (!p->connect)
1058 continue;
1059
1060 dev_dbg(skl->dev, "sink widget=%s\n", w->name);
1061 dev_dbg(skl->dev, "src widget=%s\n", p->source->name);
1062
1063 /*
1064 * here we will check widgets in sink pipelines, so that can
1065 * be any widgets type and we are only interested if they are
1066 * ones used for SKL so check that first
1067 */
1068 if ((p->source->priv != NULL) &&
1069 is_skl_dsp_widget_type(p->source, skl->dev)) {
1070 return p->source;
1071 }
1072 }
1073
1074 if (src_w != NULL)
1075 return skl_get_src_dsp_widget(src_w, skl);
1076
1077 return NULL;
1078 }
1079
1080 /*
1081 * in the Post-PMU event of mixer we need to do following:
1082 * - Check if this pipe is running
1083 * - if not, then
1084 * - bind this pipeline to its source pipeline
1085 * if source pipe is already running, this means it is a dynamic
1086 * connection and we need to bind only to that pipe
1087 * - start this pipeline
1088 */
skl_tplg_mixer_dapm_post_pmu_event(struct snd_soc_dapm_widget * w,struct skl_dev * skl)1089 static int skl_tplg_mixer_dapm_post_pmu_event(struct snd_soc_dapm_widget *w,
1090 struct skl_dev *skl)
1091 {
1092 int ret = 0;
1093 struct snd_soc_dapm_widget *source, *sink;
1094 struct skl_module_cfg *src_mconfig, *sink_mconfig;
1095 int src_pipe_started = 0;
1096
1097 sink = w;
1098 sink_mconfig = sink->priv;
1099
1100 /*
1101 * If source pipe is already started, that means source is driving
1102 * one more sink before this sink got connected, Since source is
1103 * started, bind this sink to source and start this pipe.
1104 */
1105 source = skl_get_src_dsp_widget(w, skl);
1106 if (source != NULL) {
1107 src_mconfig = source->priv;
1108 sink_mconfig = sink->priv;
1109 src_pipe_started = 1;
1110
1111 /*
1112 * check pipe state, then no need to bind or start the
1113 * pipe
1114 */
1115 if (src_mconfig->pipe->state != SKL_PIPE_STARTED)
1116 src_pipe_started = 0;
1117 }
1118
1119 if (src_pipe_started) {
1120 ret = skl_bind_modules(skl, src_mconfig, sink_mconfig);
1121 if (ret)
1122 return ret;
1123
1124 /* set module params after bind */
1125 skl_tplg_set_module_bind_params(source, src_mconfig, skl);
1126 skl_tplg_set_module_bind_params(sink, sink_mconfig, skl);
1127
1128 if (sink_mconfig->pipe->conn_type != SKL_PIPE_CONN_TYPE_FE)
1129 ret = skl_run_pipe(skl, sink_mconfig->pipe);
1130 }
1131
1132 return ret;
1133 }
1134
1135 /*
1136 * in the Pre-PMD event of mixer we need to do following:
1137 * - Stop the pipe
1138 * - find the source connections and remove that from dapm_path_list
1139 * - unbind with source pipelines if still connected
1140 */
skl_tplg_mixer_dapm_pre_pmd_event(struct snd_soc_dapm_widget * w,struct skl_dev * skl)1141 static int skl_tplg_mixer_dapm_pre_pmd_event(struct snd_soc_dapm_widget *w,
1142 struct skl_dev *skl)
1143 {
1144 struct skl_module_cfg *src_mconfig, *sink_mconfig;
1145 int ret = 0, i;
1146
1147 sink_mconfig = w->priv;
1148
1149 /* Stop the pipe */
1150 ret = skl_stop_pipe(skl, sink_mconfig->pipe);
1151 if (ret)
1152 return ret;
1153
1154 for (i = 0; i < sink_mconfig->module->max_input_pins; i++) {
1155 if (sink_mconfig->m_in_pin[i].pin_state == SKL_PIN_BIND_DONE) {
1156 src_mconfig = sink_mconfig->m_in_pin[i].tgt_mcfg;
1157 if (!src_mconfig)
1158 continue;
1159
1160 ret = skl_unbind_modules(skl,
1161 src_mconfig, sink_mconfig);
1162 }
1163 }
1164
1165 return ret;
1166 }
1167
1168 /*
1169 * in the Post-PMD event of mixer we need to do following:
1170 * - Unbind the modules within the pipeline
1171 * - Delete the pipeline (modules are not required to be explicitly
1172 * deleted, pipeline delete is enough here
1173 */
skl_tplg_mixer_dapm_post_pmd_event(struct snd_soc_dapm_widget * w,struct skl_dev * skl)1174 static int skl_tplg_mixer_dapm_post_pmd_event(struct snd_soc_dapm_widget *w,
1175 struct skl_dev *skl)
1176 {
1177 struct skl_module_cfg *mconfig = w->priv;
1178 struct skl_pipe_module *w_module;
1179 struct skl_module_cfg *src_module = NULL, *dst_module;
1180 struct skl_pipe *s_pipe = mconfig->pipe;
1181 struct skl_module_deferred_bind *modules, *tmp;
1182
1183 if (s_pipe->state == SKL_PIPE_INVALID)
1184 return -EINVAL;
1185
1186 list_for_each_entry(w_module, &s_pipe->w_list, node) {
1187 if (list_empty(&skl->bind_list))
1188 break;
1189
1190 src_module = w_module->w->priv;
1191
1192 list_for_each_entry_safe(modules, tmp, &skl->bind_list, node) {
1193 /*
1194 * When the destination module is deleted, Unbind the
1195 * modules from deferred bind list.
1196 */
1197 if (modules->dst == src_module) {
1198 skl_unbind_modules(skl, modules->src,
1199 modules->dst);
1200 }
1201
1202 /*
1203 * When the source module is deleted, remove this entry
1204 * from the deferred bind list.
1205 */
1206 if (modules->src == src_module) {
1207 list_del(&modules->node);
1208 modules->src = NULL;
1209 modules->dst = NULL;
1210 kfree(modules);
1211 }
1212 }
1213 }
1214
1215 list_for_each_entry(w_module, &s_pipe->w_list, node) {
1216 dst_module = w_module->w->priv;
1217
1218 if (src_module == NULL) {
1219 src_module = dst_module;
1220 continue;
1221 }
1222
1223 skl_unbind_modules(skl, src_module, dst_module);
1224 src_module = dst_module;
1225 }
1226
1227 skl_delete_pipe(skl, mconfig->pipe);
1228
1229 list_for_each_entry(w_module, &s_pipe->w_list, node) {
1230 src_module = w_module->w->priv;
1231 src_module->m_state = SKL_MODULE_UNINIT;
1232 }
1233
1234 return skl_tplg_unload_pipe_modules(skl, s_pipe);
1235 }
1236
1237 /*
1238 * in the Post-PMD event of PGA we need to do following:
1239 * - Stop the pipeline
1240 * - In source pipe is connected, unbind with source pipelines
1241 */
skl_tplg_pga_dapm_post_pmd_event(struct snd_soc_dapm_widget * w,struct skl_dev * skl)1242 static int skl_tplg_pga_dapm_post_pmd_event(struct snd_soc_dapm_widget *w,
1243 struct skl_dev *skl)
1244 {
1245 struct skl_module_cfg *src_mconfig, *sink_mconfig;
1246 int ret = 0, i;
1247
1248 src_mconfig = w->priv;
1249
1250 /* Stop the pipe since this is a mixin module */
1251 ret = skl_stop_pipe(skl, src_mconfig->pipe);
1252 if (ret)
1253 return ret;
1254
1255 for (i = 0; i < src_mconfig->module->max_output_pins; i++) {
1256 if (src_mconfig->m_out_pin[i].pin_state == SKL_PIN_BIND_DONE) {
1257 sink_mconfig = src_mconfig->m_out_pin[i].tgt_mcfg;
1258 if (!sink_mconfig)
1259 continue;
1260 /*
1261 * This is a connecter and if path is found that means
1262 * unbind between source and sink has not happened yet
1263 */
1264 ret = skl_unbind_modules(skl, src_mconfig,
1265 sink_mconfig);
1266 }
1267 }
1268
1269 return ret;
1270 }
1271
1272 /*
1273 * In modelling, we assume there will be ONLY one mixer in a pipeline. If a
1274 * second one is required that is created as another pipe entity.
1275 * The mixer is responsible for pipe management and represent a pipeline
1276 * instance
1277 */
skl_tplg_mixer_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * k,int event)1278 static int skl_tplg_mixer_event(struct snd_soc_dapm_widget *w,
1279 struct snd_kcontrol *k, int event)
1280 {
1281 struct snd_soc_dapm_context *dapm = w->dapm;
1282 struct skl_dev *skl = get_skl_ctx(dapm->dev);
1283
1284 switch (event) {
1285 case SND_SOC_DAPM_PRE_PMU:
1286 return skl_tplg_mixer_dapm_pre_pmu_event(w, skl);
1287
1288 case SND_SOC_DAPM_POST_PMU:
1289 return skl_tplg_mixer_dapm_post_pmu_event(w, skl);
1290
1291 case SND_SOC_DAPM_PRE_PMD:
1292 return skl_tplg_mixer_dapm_pre_pmd_event(w, skl);
1293
1294 case SND_SOC_DAPM_POST_PMD:
1295 return skl_tplg_mixer_dapm_post_pmd_event(w, skl);
1296 }
1297
1298 return 0;
1299 }
1300
1301 /*
1302 * In modelling, we assumed rest of the modules in pipeline are PGA. But we
1303 * are interested in last PGA (leaf PGA) in a pipeline to disconnect with
1304 * the sink when it is running (two FE to one BE or one FE to two BE)
1305 * scenarios
1306 */
skl_tplg_pga_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * k,int event)1307 static int skl_tplg_pga_event(struct snd_soc_dapm_widget *w,
1308 struct snd_kcontrol *k, int event)
1309
1310 {
1311 struct snd_soc_dapm_context *dapm = w->dapm;
1312 struct skl_dev *skl = get_skl_ctx(dapm->dev);
1313
1314 switch (event) {
1315 case SND_SOC_DAPM_PRE_PMU:
1316 return skl_tplg_pga_dapm_pre_pmu_event(w, skl);
1317
1318 case SND_SOC_DAPM_POST_PMD:
1319 return skl_tplg_pga_dapm_post_pmd_event(w, skl);
1320 }
1321
1322 return 0;
1323 }
1324
skl_tplg_multi_config_set_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol,bool is_set)1325 static int skl_tplg_multi_config_set_get(struct snd_kcontrol *kcontrol,
1326 struct snd_ctl_elem_value *ucontrol,
1327 bool is_set)
1328 {
1329 struct snd_soc_component *component =
1330 snd_soc_kcontrol_component(kcontrol);
1331 struct hdac_bus *bus = snd_soc_component_get_drvdata(component);
1332 struct skl_dev *skl = bus_to_skl(bus);
1333 struct skl_pipeline *ppl;
1334 struct skl_pipe *pipe = NULL;
1335 struct soc_enum *ec = (struct soc_enum *)kcontrol->private_value;
1336 u32 *pipe_id;
1337
1338 if (!ec)
1339 return -EINVAL;
1340
1341 if (is_set && ucontrol->value.enumerated.item[0] > ec->items)
1342 return -EINVAL;
1343
1344 pipe_id = ec->dobj.private;
1345
1346 list_for_each_entry(ppl, &skl->ppl_list, node) {
1347 if (ppl->pipe->ppl_id == *pipe_id) {
1348 pipe = ppl->pipe;
1349 break;
1350 }
1351 }
1352 if (!pipe)
1353 return -EIO;
1354
1355 if (is_set)
1356 skl_tplg_set_pipe_config_idx(pipe, ucontrol->value.enumerated.item[0]);
1357 else
1358 ucontrol->value.enumerated.item[0] = pipe->cur_config_idx;
1359
1360 return 0;
1361 }
1362
skl_tplg_multi_config_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1363 static int skl_tplg_multi_config_get(struct snd_kcontrol *kcontrol,
1364 struct snd_ctl_elem_value *ucontrol)
1365 {
1366 return skl_tplg_multi_config_set_get(kcontrol, ucontrol, false);
1367 }
1368
skl_tplg_multi_config_set(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1369 static int skl_tplg_multi_config_set(struct snd_kcontrol *kcontrol,
1370 struct snd_ctl_elem_value *ucontrol)
1371 {
1372 return skl_tplg_multi_config_set_get(kcontrol, ucontrol, true);
1373 }
1374
skl_tplg_multi_config_get_dmic(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1375 static int skl_tplg_multi_config_get_dmic(struct snd_kcontrol *kcontrol,
1376 struct snd_ctl_elem_value *ucontrol)
1377 {
1378 return skl_tplg_multi_config_set_get(kcontrol, ucontrol, false);
1379 }
1380
skl_tplg_multi_config_set_dmic(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1381 static int skl_tplg_multi_config_set_dmic(struct snd_kcontrol *kcontrol,
1382 struct snd_ctl_elem_value *ucontrol)
1383 {
1384 return skl_tplg_multi_config_set_get(kcontrol, ucontrol, true);
1385 }
1386
skl_tplg_tlv_control_get(struct snd_kcontrol * kcontrol,unsigned int __user * data,unsigned int size)1387 static int skl_tplg_tlv_control_get(struct snd_kcontrol *kcontrol,
1388 unsigned int __user *data, unsigned int size)
1389 {
1390 struct soc_bytes_ext *sb =
1391 (struct soc_bytes_ext *)kcontrol->private_value;
1392 struct skl_algo_data *bc = (struct skl_algo_data *)sb->dobj.private;
1393 struct snd_soc_dapm_widget *w = snd_soc_dapm_kcontrol_widget(kcontrol);
1394 struct skl_module_cfg *mconfig = w->priv;
1395 struct skl_dev *skl = get_skl_ctx(w->dapm->dev);
1396
1397 if (w->power)
1398 skl_get_module_params(skl, (u32 *)bc->params,
1399 bc->size, bc->param_id, mconfig);
1400
1401 /* decrement size for TLV header */
1402 size -= 2 * sizeof(u32);
1403
1404 /* check size as we don't want to send kernel data */
1405 if (size > bc->max)
1406 size = bc->max;
1407
1408 if (bc->params) {
1409 if (copy_to_user(data, &bc->param_id, sizeof(u32)))
1410 return -EFAULT;
1411 if (copy_to_user(data + 1, &size, sizeof(u32)))
1412 return -EFAULT;
1413 if (copy_to_user(data + 2, bc->params, size))
1414 return -EFAULT;
1415 }
1416
1417 return 0;
1418 }
1419
1420 #define SKL_PARAM_VENDOR_ID 0xff
1421
skl_tplg_tlv_control_set(struct snd_kcontrol * kcontrol,const unsigned int __user * data,unsigned int size)1422 static int skl_tplg_tlv_control_set(struct snd_kcontrol *kcontrol,
1423 const unsigned int __user *data, unsigned int size)
1424 {
1425 struct snd_soc_dapm_widget *w = snd_soc_dapm_kcontrol_widget(kcontrol);
1426 struct skl_module_cfg *mconfig = w->priv;
1427 struct soc_bytes_ext *sb =
1428 (struct soc_bytes_ext *)kcontrol->private_value;
1429 struct skl_algo_data *ac = (struct skl_algo_data *)sb->dobj.private;
1430 struct skl_dev *skl = get_skl_ctx(w->dapm->dev);
1431
1432 if (ac->params) {
1433 if (size > ac->max)
1434 return -EINVAL;
1435 ac->size = size;
1436
1437 if (copy_from_user(ac->params, data, size))
1438 return -EFAULT;
1439
1440 if (w->power)
1441 return skl_set_module_params(skl,
1442 (u32 *)ac->params, ac->size,
1443 ac->param_id, mconfig);
1444 }
1445
1446 return 0;
1447 }
1448
skl_tplg_mic_control_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1449 static int skl_tplg_mic_control_get(struct snd_kcontrol *kcontrol,
1450 struct snd_ctl_elem_value *ucontrol)
1451 {
1452 struct snd_soc_dapm_widget *w = snd_soc_dapm_kcontrol_widget(kcontrol);
1453 struct skl_module_cfg *mconfig = w->priv;
1454 struct soc_enum *ec = (struct soc_enum *)kcontrol->private_value;
1455 u32 ch_type = *((u32 *)ec->dobj.private);
1456
1457 if (mconfig->dmic_ch_type == ch_type)
1458 ucontrol->value.enumerated.item[0] =
1459 mconfig->dmic_ch_combo_index;
1460 else
1461 ucontrol->value.enumerated.item[0] = 0;
1462
1463 return 0;
1464 }
1465
skl_fill_mic_sel_params(struct skl_module_cfg * mconfig,struct skl_mic_sel_config * mic_cfg,struct device * dev)1466 static int skl_fill_mic_sel_params(struct skl_module_cfg *mconfig,
1467 struct skl_mic_sel_config *mic_cfg, struct device *dev)
1468 {
1469 struct skl_specific_cfg *sp_cfg =
1470 &mconfig->formats_config[SKL_PARAM_INIT];
1471
1472 sp_cfg->caps_size = sizeof(struct skl_mic_sel_config);
1473 sp_cfg->set_params = SKL_PARAM_SET;
1474 sp_cfg->param_id = 0x00;
1475 if (!sp_cfg->caps) {
1476 sp_cfg->caps = devm_kzalloc(dev, sp_cfg->caps_size, GFP_KERNEL);
1477 if (!sp_cfg->caps)
1478 return -ENOMEM;
1479 }
1480
1481 mic_cfg->mic_switch = SKL_MIC_SEL_SWITCH;
1482 mic_cfg->flags = 0;
1483 memcpy(sp_cfg->caps, mic_cfg, sp_cfg->caps_size);
1484
1485 return 0;
1486 }
1487
skl_tplg_mic_control_set(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1488 static int skl_tplg_mic_control_set(struct snd_kcontrol *kcontrol,
1489 struct snd_ctl_elem_value *ucontrol)
1490 {
1491 struct snd_soc_dapm_widget *w = snd_soc_dapm_kcontrol_widget(kcontrol);
1492 struct skl_module_cfg *mconfig = w->priv;
1493 struct skl_mic_sel_config mic_cfg = {0};
1494 struct soc_enum *ec = (struct soc_enum *)kcontrol->private_value;
1495 u32 ch_type = *((u32 *)ec->dobj.private);
1496 const int *list;
1497 u8 in_ch, out_ch, index;
1498
1499 mconfig->dmic_ch_type = ch_type;
1500 mconfig->dmic_ch_combo_index = ucontrol->value.enumerated.item[0];
1501
1502 /* enum control index 0 is INVALID, so no channels to be set */
1503 if (mconfig->dmic_ch_combo_index == 0)
1504 return 0;
1505
1506 /* No valid channel selection map for index 0, so offset by 1 */
1507 index = mconfig->dmic_ch_combo_index - 1;
1508
1509 switch (ch_type) {
1510 case SKL_CH_MONO:
1511 if (mconfig->dmic_ch_combo_index > ARRAY_SIZE(mic_mono_list))
1512 return -EINVAL;
1513
1514 list = &mic_mono_list[index];
1515 break;
1516
1517 case SKL_CH_STEREO:
1518 if (mconfig->dmic_ch_combo_index > ARRAY_SIZE(mic_stereo_list))
1519 return -EINVAL;
1520
1521 list = mic_stereo_list[index];
1522 break;
1523
1524 case SKL_CH_TRIO:
1525 if (mconfig->dmic_ch_combo_index > ARRAY_SIZE(mic_trio_list))
1526 return -EINVAL;
1527
1528 list = mic_trio_list[index];
1529 break;
1530
1531 case SKL_CH_QUATRO:
1532 if (mconfig->dmic_ch_combo_index > ARRAY_SIZE(mic_quatro_list))
1533 return -EINVAL;
1534
1535 list = mic_quatro_list[index];
1536 break;
1537
1538 default:
1539 dev_err(w->dapm->dev,
1540 "Invalid channel %d for mic_select module\n",
1541 ch_type);
1542 return -EINVAL;
1543
1544 }
1545
1546 /* channel type enum map to number of chanels for that type */
1547 for (out_ch = 0; out_ch < ch_type; out_ch++) {
1548 in_ch = list[out_ch];
1549 mic_cfg.blob[out_ch][in_ch] = SKL_DEFAULT_MIC_SEL_GAIN;
1550 }
1551
1552 return skl_fill_mic_sel_params(mconfig, &mic_cfg, w->dapm->dev);
1553 }
1554
1555 /*
1556 * Fill the dma id for host and link. In case of passthrough
1557 * pipeline, this will both host and link in the same
1558 * pipeline, so need to copy the link and host based on dev_type
1559 */
skl_tplg_fill_dma_id(struct skl_module_cfg * mcfg,struct skl_pipe_params * params)1560 static void skl_tplg_fill_dma_id(struct skl_module_cfg *mcfg,
1561 struct skl_pipe_params *params)
1562 {
1563 struct skl_pipe *pipe = mcfg->pipe;
1564
1565 if (pipe->passthru) {
1566 switch (mcfg->dev_type) {
1567 case SKL_DEVICE_HDALINK:
1568 pipe->p_params->link_dma_id = params->link_dma_id;
1569 pipe->p_params->link_index = params->link_index;
1570 pipe->p_params->link_bps = params->link_bps;
1571 break;
1572
1573 case SKL_DEVICE_HDAHOST:
1574 pipe->p_params->host_dma_id = params->host_dma_id;
1575 pipe->p_params->host_bps = params->host_bps;
1576 break;
1577
1578 default:
1579 break;
1580 }
1581 pipe->p_params->s_fmt = params->s_fmt;
1582 pipe->p_params->ch = params->ch;
1583 pipe->p_params->s_freq = params->s_freq;
1584 pipe->p_params->stream = params->stream;
1585 pipe->p_params->format = params->format;
1586
1587 } else {
1588 memcpy(pipe->p_params, params, sizeof(*params));
1589 }
1590 }
1591
1592 /*
1593 * The FE params are passed by hw_params of the DAI.
1594 * On hw_params, the params are stored in Gateway module of the FE and we
1595 * need to calculate the format in DSP module configuration, that
1596 * conversion is done here
1597 */
skl_tplg_update_pipe_params(struct device * dev,struct skl_module_cfg * mconfig,struct skl_pipe_params * params)1598 int skl_tplg_update_pipe_params(struct device *dev,
1599 struct skl_module_cfg *mconfig,
1600 struct skl_pipe_params *params)
1601 {
1602 struct skl_module_res *res;
1603 struct skl_dev *skl = get_skl_ctx(dev);
1604 struct skl_module_fmt *format = NULL;
1605 u8 cfg_idx = mconfig->pipe->cur_config_idx;
1606
1607 res = &mconfig->module->resources[mconfig->res_idx];
1608 skl_tplg_fill_dma_id(mconfig, params);
1609 mconfig->fmt_idx = mconfig->mod_cfg[cfg_idx].fmt_idx;
1610 mconfig->res_idx = mconfig->mod_cfg[cfg_idx].res_idx;
1611
1612 if (skl->nr_modules)
1613 return 0;
1614
1615 if (params->stream == SNDRV_PCM_STREAM_PLAYBACK)
1616 format = &mconfig->module->formats[mconfig->fmt_idx].inputs[0].fmt;
1617 else
1618 format = &mconfig->module->formats[mconfig->fmt_idx].outputs[0].fmt;
1619
1620 /* set the hw_params */
1621 format->s_freq = params->s_freq;
1622 format->channels = params->ch;
1623 format->valid_bit_depth = skl_get_bit_depth(params->s_fmt);
1624
1625 /*
1626 * 16 bit is 16 bit container whereas 24 bit is in 32 bit
1627 * container so update bit depth accordingly
1628 */
1629 switch (format->valid_bit_depth) {
1630 case SKL_DEPTH_16BIT:
1631 format->bit_depth = format->valid_bit_depth;
1632 break;
1633
1634 case SKL_DEPTH_24BIT:
1635 case SKL_DEPTH_32BIT:
1636 format->bit_depth = SKL_DEPTH_32BIT;
1637 break;
1638
1639 default:
1640 dev_err(dev, "Invalid bit depth %x for pipe\n",
1641 format->valid_bit_depth);
1642 return -EINVAL;
1643 }
1644
1645 if (params->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1646 res->ibs = (format->s_freq / 1000) *
1647 (format->channels) *
1648 (format->bit_depth >> 3);
1649 } else {
1650 res->obs = (format->s_freq / 1000) *
1651 (format->channels) *
1652 (format->bit_depth >> 3);
1653 }
1654
1655 return 0;
1656 }
1657
1658 /*
1659 * Query the module config for the FE DAI
1660 * This is used to find the hw_params set for that DAI and apply to FE
1661 * pipeline
1662 */
1663 struct skl_module_cfg *
skl_tplg_fe_get_cpr_module(struct snd_soc_dai * dai,int stream)1664 skl_tplg_fe_get_cpr_module(struct snd_soc_dai *dai, int stream)
1665 {
1666 struct snd_soc_dapm_widget *w = snd_soc_dai_get_widget(dai, stream);
1667 struct snd_soc_dapm_path *p = NULL;
1668
1669 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
1670 snd_soc_dapm_widget_for_each_sink_path(w, p) {
1671 if (p->connect && p->sink->power &&
1672 !is_skl_dsp_widget_type(p->sink, dai->dev))
1673 continue;
1674
1675 if (p->sink->priv) {
1676 dev_dbg(dai->dev, "set params for %s\n",
1677 p->sink->name);
1678 return p->sink->priv;
1679 }
1680 }
1681 } else {
1682 snd_soc_dapm_widget_for_each_source_path(w, p) {
1683 if (p->connect && p->source->power &&
1684 !is_skl_dsp_widget_type(p->source, dai->dev))
1685 continue;
1686
1687 if (p->source->priv) {
1688 dev_dbg(dai->dev, "set params for %s\n",
1689 p->source->name);
1690 return p->source->priv;
1691 }
1692 }
1693 }
1694
1695 return NULL;
1696 }
1697
skl_get_mconfig_pb_cpr(struct snd_soc_dai * dai,struct snd_soc_dapm_widget * w)1698 static struct skl_module_cfg *skl_get_mconfig_pb_cpr(
1699 struct snd_soc_dai *dai, struct snd_soc_dapm_widget *w)
1700 {
1701 struct snd_soc_dapm_path *p;
1702 struct skl_module_cfg *mconfig = NULL;
1703
1704 snd_soc_dapm_widget_for_each_source_path(w, p) {
1705 if (w->endpoints[SND_SOC_DAPM_DIR_OUT] > 0) {
1706 if (p->connect &&
1707 (p->sink->id == snd_soc_dapm_aif_out) &&
1708 p->source->priv) {
1709 mconfig = p->source->priv;
1710 return mconfig;
1711 }
1712 mconfig = skl_get_mconfig_pb_cpr(dai, p->source);
1713 if (mconfig)
1714 return mconfig;
1715 }
1716 }
1717 return mconfig;
1718 }
1719
skl_get_mconfig_cap_cpr(struct snd_soc_dai * dai,struct snd_soc_dapm_widget * w)1720 static struct skl_module_cfg *skl_get_mconfig_cap_cpr(
1721 struct snd_soc_dai *dai, struct snd_soc_dapm_widget *w)
1722 {
1723 struct snd_soc_dapm_path *p;
1724 struct skl_module_cfg *mconfig = NULL;
1725
1726 snd_soc_dapm_widget_for_each_sink_path(w, p) {
1727 if (w->endpoints[SND_SOC_DAPM_DIR_IN] > 0) {
1728 if (p->connect &&
1729 (p->source->id == snd_soc_dapm_aif_in) &&
1730 p->sink->priv) {
1731 mconfig = p->sink->priv;
1732 return mconfig;
1733 }
1734 mconfig = skl_get_mconfig_cap_cpr(dai, p->sink);
1735 if (mconfig)
1736 return mconfig;
1737 }
1738 }
1739 return mconfig;
1740 }
1741
1742 struct skl_module_cfg *
skl_tplg_be_get_cpr_module(struct snd_soc_dai * dai,int stream)1743 skl_tplg_be_get_cpr_module(struct snd_soc_dai *dai, int stream)
1744 {
1745 struct snd_soc_dapm_widget *w = snd_soc_dai_get_widget(dai, stream);
1746 struct skl_module_cfg *mconfig;
1747
1748 if (stream == SNDRV_PCM_STREAM_PLAYBACK) {
1749 mconfig = skl_get_mconfig_pb_cpr(dai, w);
1750 } else {
1751 mconfig = skl_get_mconfig_cap_cpr(dai, w);
1752 }
1753 return mconfig;
1754 }
1755
skl_tplg_be_link_type(int dev_type)1756 static u8 skl_tplg_be_link_type(int dev_type)
1757 {
1758 int ret;
1759
1760 switch (dev_type) {
1761 case SKL_DEVICE_BT:
1762 ret = NHLT_LINK_SSP;
1763 break;
1764
1765 case SKL_DEVICE_DMIC:
1766 ret = NHLT_LINK_DMIC;
1767 break;
1768
1769 case SKL_DEVICE_I2S:
1770 ret = NHLT_LINK_SSP;
1771 break;
1772
1773 case SKL_DEVICE_HDALINK:
1774 ret = NHLT_LINK_HDA;
1775 break;
1776
1777 default:
1778 ret = NHLT_LINK_INVALID;
1779 break;
1780 }
1781
1782 return ret;
1783 }
1784
1785 /*
1786 * Fill the BE gateway parameters
1787 * The BE gateway expects a blob of parameters which are kept in the ACPI
1788 * NHLT blob, so query the blob for interface type (i2s/pdm) and instance.
1789 * The port can have multiple settings so pick based on the pipeline
1790 * parameters
1791 */
skl_tplg_be_fill_pipe_params(struct snd_soc_dai * dai,struct skl_module_cfg * mconfig,struct skl_pipe_params * params)1792 static int skl_tplg_be_fill_pipe_params(struct snd_soc_dai *dai,
1793 struct skl_module_cfg *mconfig,
1794 struct skl_pipe_params *params)
1795 {
1796 struct nhlt_specific_cfg *cfg;
1797 struct skl_pipe *pipe = mconfig->pipe;
1798 struct skl_pipe_params save = *pipe->p_params;
1799 struct skl_pipe_fmt *pipe_fmt;
1800 struct skl_dev *skl = get_skl_ctx(dai->dev);
1801 int link_type = skl_tplg_be_link_type(mconfig->dev_type);
1802 u8 dev_type = skl_tplg_be_dev_type(mconfig->dev_type);
1803 int ret;
1804
1805 skl_tplg_fill_dma_id(mconfig, params);
1806
1807 if (link_type == NHLT_LINK_HDA)
1808 return 0;
1809
1810 *pipe->p_params = *params;
1811 ret = skl_tplg_get_pipe_config(skl, mconfig);
1812 if (ret)
1813 goto err;
1814
1815 dev_dbg(skl->dev, "%s using pipe config: %d\n", __func__, pipe->cur_config_idx);
1816 if (pipe->direction == SNDRV_PCM_STREAM_PLAYBACK)
1817 pipe_fmt = &pipe->configs[pipe->cur_config_idx].out_fmt;
1818 else
1819 pipe_fmt = &pipe->configs[pipe->cur_config_idx].in_fmt;
1820
1821 /* update the blob based on virtual bus_id*/
1822 cfg = intel_nhlt_get_endpoint_blob(dai->dev, skl->nhlt,
1823 mconfig->vbus_id, link_type,
1824 pipe_fmt->bps, params->s_cont,
1825 pipe_fmt->channels, pipe_fmt->freq,
1826 pipe->direction, dev_type);
1827 if (cfg) {
1828 mconfig->formats_config[SKL_PARAM_INIT].caps_size = cfg->size;
1829 mconfig->formats_config[SKL_PARAM_INIT].caps = (u32 *)&cfg->caps;
1830 } else {
1831 dev_err(dai->dev, "Blob NULL for id:%d type:%d dirn:%d ch:%d, freq:%d, fmt:%d\n",
1832 mconfig->vbus_id, link_type, params->stream,
1833 params->ch, params->s_freq, params->s_fmt);
1834 ret = -EINVAL;
1835 goto err;
1836 }
1837
1838 return 0;
1839
1840 err:
1841 *pipe->p_params = save;
1842 return ret;
1843 }
1844
skl_tplg_be_set_src_pipe_params(struct snd_soc_dai * dai,struct snd_soc_dapm_widget * w,struct skl_pipe_params * params)1845 static int skl_tplg_be_set_src_pipe_params(struct snd_soc_dai *dai,
1846 struct snd_soc_dapm_widget *w,
1847 struct skl_pipe_params *params)
1848 {
1849 struct snd_soc_dapm_path *p;
1850 int ret = -EIO;
1851
1852 snd_soc_dapm_widget_for_each_source_path(w, p) {
1853 if (p->connect && is_skl_dsp_widget_type(p->source, dai->dev) &&
1854 p->source->priv) {
1855
1856 ret = skl_tplg_be_fill_pipe_params(dai,
1857 p->source->priv, params);
1858 if (ret < 0)
1859 return ret;
1860 } else {
1861 ret = skl_tplg_be_set_src_pipe_params(dai,
1862 p->source, params);
1863 if (ret < 0)
1864 return ret;
1865 }
1866 }
1867
1868 return ret;
1869 }
1870
skl_tplg_be_set_sink_pipe_params(struct snd_soc_dai * dai,struct snd_soc_dapm_widget * w,struct skl_pipe_params * params)1871 static int skl_tplg_be_set_sink_pipe_params(struct snd_soc_dai *dai,
1872 struct snd_soc_dapm_widget *w, struct skl_pipe_params *params)
1873 {
1874 struct snd_soc_dapm_path *p;
1875 int ret = -EIO;
1876
1877 snd_soc_dapm_widget_for_each_sink_path(w, p) {
1878 if (p->connect && is_skl_dsp_widget_type(p->sink, dai->dev) &&
1879 p->sink->priv) {
1880
1881 ret = skl_tplg_be_fill_pipe_params(dai,
1882 p->sink->priv, params);
1883 if (ret < 0)
1884 return ret;
1885 } else {
1886 ret = skl_tplg_be_set_sink_pipe_params(
1887 dai, p->sink, params);
1888 if (ret < 0)
1889 return ret;
1890 }
1891 }
1892
1893 return ret;
1894 }
1895
1896 /*
1897 * BE hw_params can be a source parameters (capture) or sink parameters
1898 * (playback). Based on sink and source we need to either find the source
1899 * list or the sink list and set the pipeline parameters
1900 */
skl_tplg_be_update_params(struct snd_soc_dai * dai,struct skl_pipe_params * params)1901 int skl_tplg_be_update_params(struct snd_soc_dai *dai,
1902 struct skl_pipe_params *params)
1903 {
1904 struct snd_soc_dapm_widget *w = snd_soc_dai_get_widget(dai, params->stream);
1905
1906 if (params->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1907 return skl_tplg_be_set_src_pipe_params(dai, w, params);
1908 } else {
1909 return skl_tplg_be_set_sink_pipe_params(dai, w, params);
1910 }
1911 }
1912
1913 static const struct snd_soc_tplg_widget_events skl_tplg_widget_ops[] = {
1914 {SKL_MIXER_EVENT, skl_tplg_mixer_event},
1915 {SKL_VMIXER_EVENT, skl_tplg_mixer_event},
1916 {SKL_PGA_EVENT, skl_tplg_pga_event},
1917 };
1918
1919 static const struct snd_soc_tplg_bytes_ext_ops skl_tlv_ops[] = {
1920 {SKL_CONTROL_TYPE_BYTE_TLV, skl_tplg_tlv_control_get,
1921 skl_tplg_tlv_control_set},
1922 };
1923
1924 static const struct snd_soc_tplg_kcontrol_ops skl_tplg_kcontrol_ops[] = {
1925 {
1926 .id = SKL_CONTROL_TYPE_MIC_SELECT,
1927 .get = skl_tplg_mic_control_get,
1928 .put = skl_tplg_mic_control_set,
1929 },
1930 {
1931 .id = SKL_CONTROL_TYPE_MULTI_IO_SELECT,
1932 .get = skl_tplg_multi_config_get,
1933 .put = skl_tplg_multi_config_set,
1934 },
1935 {
1936 .id = SKL_CONTROL_TYPE_MULTI_IO_SELECT_DMIC,
1937 .get = skl_tplg_multi_config_get_dmic,
1938 .put = skl_tplg_multi_config_set_dmic,
1939 }
1940 };
1941
skl_tplg_fill_pipe_cfg(struct device * dev,struct skl_pipe * pipe,u32 tkn,u32 tkn_val,int conf_idx,int dir)1942 static int skl_tplg_fill_pipe_cfg(struct device *dev,
1943 struct skl_pipe *pipe, u32 tkn,
1944 u32 tkn_val, int conf_idx, int dir)
1945 {
1946 struct skl_pipe_fmt *fmt;
1947 struct skl_path_config *config;
1948
1949 switch (dir) {
1950 case SKL_DIR_IN:
1951 fmt = &pipe->configs[conf_idx].in_fmt;
1952 break;
1953
1954 case SKL_DIR_OUT:
1955 fmt = &pipe->configs[conf_idx].out_fmt;
1956 break;
1957
1958 default:
1959 dev_err(dev, "Invalid direction: %d\n", dir);
1960 return -EINVAL;
1961 }
1962
1963 config = &pipe->configs[conf_idx];
1964
1965 switch (tkn) {
1966 case SKL_TKN_U32_CFG_FREQ:
1967 fmt->freq = tkn_val;
1968 break;
1969
1970 case SKL_TKN_U8_CFG_CHAN:
1971 fmt->channels = tkn_val;
1972 break;
1973
1974 case SKL_TKN_U8_CFG_BPS:
1975 fmt->bps = tkn_val;
1976 break;
1977
1978 case SKL_TKN_U32_PATH_MEM_PGS:
1979 config->mem_pages = tkn_val;
1980 break;
1981
1982 default:
1983 dev_err(dev, "Invalid token config: %d\n", tkn);
1984 return -EINVAL;
1985 }
1986
1987 return 0;
1988 }
1989
skl_tplg_fill_pipe_tkn(struct device * dev,struct skl_pipe * pipe,u32 tkn,u32 tkn_val)1990 static int skl_tplg_fill_pipe_tkn(struct device *dev,
1991 struct skl_pipe *pipe, u32 tkn,
1992 u32 tkn_val)
1993 {
1994
1995 switch (tkn) {
1996 case SKL_TKN_U32_PIPE_CONN_TYPE:
1997 pipe->conn_type = tkn_val;
1998 break;
1999
2000 case SKL_TKN_U32_PIPE_PRIORITY:
2001 pipe->pipe_priority = tkn_val;
2002 break;
2003
2004 case SKL_TKN_U32_PIPE_MEM_PGS:
2005 pipe->memory_pages = tkn_val;
2006 break;
2007
2008 case SKL_TKN_U32_PMODE:
2009 pipe->lp_mode = tkn_val;
2010 break;
2011
2012 case SKL_TKN_U32_PIPE_DIRECTION:
2013 pipe->direction = tkn_val;
2014 break;
2015
2016 case SKL_TKN_U32_NUM_CONFIGS:
2017 pipe->nr_cfgs = tkn_val;
2018 break;
2019
2020 default:
2021 dev_err(dev, "Token not handled %d\n", tkn);
2022 return -EINVAL;
2023 }
2024
2025 return 0;
2026 }
2027
2028 /*
2029 * Add pipeline by parsing the relevant tokens
2030 * Return an existing pipe if the pipe already exists.
2031 */
skl_tplg_add_pipe(struct device * dev,struct skl_module_cfg * mconfig,struct skl_dev * skl,struct snd_soc_tplg_vendor_value_elem * tkn_elem)2032 static int skl_tplg_add_pipe(struct device *dev,
2033 struct skl_module_cfg *mconfig, struct skl_dev *skl,
2034 struct snd_soc_tplg_vendor_value_elem *tkn_elem)
2035 {
2036 struct skl_pipeline *ppl;
2037 struct skl_pipe *pipe;
2038 struct skl_pipe_params *params;
2039
2040 list_for_each_entry(ppl, &skl->ppl_list, node) {
2041 if (ppl->pipe->ppl_id == tkn_elem->value) {
2042 mconfig->pipe = ppl->pipe;
2043 return -EEXIST;
2044 }
2045 }
2046
2047 ppl = devm_kzalloc(dev, sizeof(*ppl), GFP_KERNEL);
2048 if (!ppl)
2049 return -ENOMEM;
2050
2051 pipe = devm_kzalloc(dev, sizeof(*pipe), GFP_KERNEL);
2052 if (!pipe)
2053 return -ENOMEM;
2054
2055 params = devm_kzalloc(dev, sizeof(*params), GFP_KERNEL);
2056 if (!params)
2057 return -ENOMEM;
2058
2059 pipe->p_params = params;
2060 pipe->ppl_id = tkn_elem->value;
2061 INIT_LIST_HEAD(&pipe->w_list);
2062
2063 ppl->pipe = pipe;
2064 list_add(&ppl->node, &skl->ppl_list);
2065
2066 mconfig->pipe = pipe;
2067 mconfig->pipe->state = SKL_PIPE_INVALID;
2068
2069 return 0;
2070 }
2071
skl_tplg_get_uuid(struct device * dev,guid_t * guid,struct snd_soc_tplg_vendor_uuid_elem * uuid_tkn)2072 static int skl_tplg_get_uuid(struct device *dev, guid_t *guid,
2073 struct snd_soc_tplg_vendor_uuid_elem *uuid_tkn)
2074 {
2075 if (uuid_tkn->token == SKL_TKN_UUID) {
2076 import_guid(guid, uuid_tkn->uuid);
2077 return 0;
2078 }
2079
2080 dev_err(dev, "Not an UUID token %d\n", uuid_tkn->token);
2081
2082 return -EINVAL;
2083 }
2084
skl_tplg_fill_pin(struct device * dev,struct snd_soc_tplg_vendor_value_elem * tkn_elem,struct skl_module_pin * m_pin,int pin_index)2085 static int skl_tplg_fill_pin(struct device *dev,
2086 struct snd_soc_tplg_vendor_value_elem *tkn_elem,
2087 struct skl_module_pin *m_pin,
2088 int pin_index)
2089 {
2090 int ret;
2091
2092 switch (tkn_elem->token) {
2093 case SKL_TKN_U32_PIN_MOD_ID:
2094 m_pin[pin_index].id.module_id = tkn_elem->value;
2095 break;
2096
2097 case SKL_TKN_U32_PIN_INST_ID:
2098 m_pin[pin_index].id.instance_id = tkn_elem->value;
2099 break;
2100
2101 case SKL_TKN_UUID:
2102 ret = skl_tplg_get_uuid(dev, &m_pin[pin_index].id.mod_uuid,
2103 (struct snd_soc_tplg_vendor_uuid_elem *)tkn_elem);
2104 if (ret < 0)
2105 return ret;
2106
2107 break;
2108
2109 default:
2110 dev_err(dev, "%d Not a pin token\n", tkn_elem->token);
2111 return -EINVAL;
2112 }
2113
2114 return 0;
2115 }
2116
2117 /*
2118 * Parse for pin config specific tokens to fill up the
2119 * module private data
2120 */
skl_tplg_fill_pins_info(struct device * dev,struct skl_module_cfg * mconfig,struct snd_soc_tplg_vendor_value_elem * tkn_elem,int dir,int pin_count)2121 static int skl_tplg_fill_pins_info(struct device *dev,
2122 struct skl_module_cfg *mconfig,
2123 struct snd_soc_tplg_vendor_value_elem *tkn_elem,
2124 int dir, int pin_count)
2125 {
2126 int ret;
2127 struct skl_module_pin *m_pin;
2128
2129 switch (dir) {
2130 case SKL_DIR_IN:
2131 m_pin = mconfig->m_in_pin;
2132 break;
2133
2134 case SKL_DIR_OUT:
2135 m_pin = mconfig->m_out_pin;
2136 break;
2137
2138 default:
2139 dev_err(dev, "Invalid direction value\n");
2140 return -EINVAL;
2141 }
2142
2143 ret = skl_tplg_fill_pin(dev, tkn_elem, m_pin, pin_count);
2144 if (ret < 0)
2145 return ret;
2146
2147 m_pin[pin_count].in_use = false;
2148 m_pin[pin_count].pin_state = SKL_PIN_UNBIND;
2149
2150 return 0;
2151 }
2152
2153 /*
2154 * Fill up input/output module config format based
2155 * on the direction
2156 */
skl_tplg_fill_fmt(struct device * dev,struct skl_module_fmt * dst_fmt,u32 tkn,u32 value)2157 static int skl_tplg_fill_fmt(struct device *dev,
2158 struct skl_module_fmt *dst_fmt,
2159 u32 tkn, u32 value)
2160 {
2161 switch (tkn) {
2162 case SKL_TKN_U32_FMT_CH:
2163 dst_fmt->channels = value;
2164 break;
2165
2166 case SKL_TKN_U32_FMT_FREQ:
2167 dst_fmt->s_freq = value;
2168 break;
2169
2170 case SKL_TKN_U32_FMT_BIT_DEPTH:
2171 dst_fmt->bit_depth = value;
2172 break;
2173
2174 case SKL_TKN_U32_FMT_SAMPLE_SIZE:
2175 dst_fmt->valid_bit_depth = value;
2176 break;
2177
2178 case SKL_TKN_U32_FMT_CH_CONFIG:
2179 dst_fmt->ch_cfg = value;
2180 break;
2181
2182 case SKL_TKN_U32_FMT_INTERLEAVE:
2183 dst_fmt->interleaving_style = value;
2184 break;
2185
2186 case SKL_TKN_U32_FMT_SAMPLE_TYPE:
2187 dst_fmt->sample_type = value;
2188 break;
2189
2190 case SKL_TKN_U32_FMT_CH_MAP:
2191 dst_fmt->ch_map = value;
2192 break;
2193
2194 default:
2195 dev_err(dev, "Invalid token %d\n", tkn);
2196 return -EINVAL;
2197 }
2198
2199 return 0;
2200 }
2201
skl_tplg_widget_fill_fmt(struct device * dev,struct skl_module_iface * fmt,u32 tkn,u32 val,u32 dir,int fmt_idx)2202 static int skl_tplg_widget_fill_fmt(struct device *dev,
2203 struct skl_module_iface *fmt,
2204 u32 tkn, u32 val, u32 dir, int fmt_idx)
2205 {
2206 struct skl_module_fmt *dst_fmt;
2207
2208 if (!fmt)
2209 return -EINVAL;
2210
2211 switch (dir) {
2212 case SKL_DIR_IN:
2213 dst_fmt = &fmt->inputs[fmt_idx].fmt;
2214 break;
2215
2216 case SKL_DIR_OUT:
2217 dst_fmt = &fmt->outputs[fmt_idx].fmt;
2218 break;
2219
2220 default:
2221 dev_err(dev, "Invalid direction: %d\n", dir);
2222 return -EINVAL;
2223 }
2224
2225 return skl_tplg_fill_fmt(dev, dst_fmt, tkn, val);
2226 }
2227
skl_tplg_fill_pin_dynamic_val(struct skl_module_pin * mpin,u32 pin_count,u32 value)2228 static void skl_tplg_fill_pin_dynamic_val(
2229 struct skl_module_pin *mpin, u32 pin_count, u32 value)
2230 {
2231 int i;
2232
2233 for (i = 0; i < pin_count; i++)
2234 mpin[i].is_dynamic = value;
2235 }
2236
2237 /*
2238 * Resource table in the manifest has pin specific resources
2239 * like pin and pin buffer size
2240 */
skl_tplg_manifest_pin_res_tkn(struct device * dev,struct snd_soc_tplg_vendor_value_elem * tkn_elem,struct skl_module_res * res,int pin_idx,int dir)2241 static int skl_tplg_manifest_pin_res_tkn(struct device *dev,
2242 struct snd_soc_tplg_vendor_value_elem *tkn_elem,
2243 struct skl_module_res *res, int pin_idx, int dir)
2244 {
2245 struct skl_module_pin_resources *m_pin;
2246
2247 switch (dir) {
2248 case SKL_DIR_IN:
2249 m_pin = &res->input[pin_idx];
2250 break;
2251
2252 case SKL_DIR_OUT:
2253 m_pin = &res->output[pin_idx];
2254 break;
2255
2256 default:
2257 dev_err(dev, "Invalid pin direction: %d\n", dir);
2258 return -EINVAL;
2259 }
2260
2261 switch (tkn_elem->token) {
2262 case SKL_TKN_MM_U32_RES_PIN_ID:
2263 m_pin->pin_index = tkn_elem->value;
2264 break;
2265
2266 case SKL_TKN_MM_U32_PIN_BUF:
2267 m_pin->buf_size = tkn_elem->value;
2268 break;
2269
2270 default:
2271 dev_err(dev, "Invalid token: %d\n", tkn_elem->token);
2272 return -EINVAL;
2273 }
2274
2275 return 0;
2276 }
2277
2278 /*
2279 * Fill module specific resources from the manifest's resource
2280 * table like CPS, DMA size, mem_pages.
2281 */
skl_tplg_fill_res_tkn(struct device * dev,struct snd_soc_tplg_vendor_value_elem * tkn_elem,struct skl_module_res * res,int pin_idx,int dir)2282 static int skl_tplg_fill_res_tkn(struct device *dev,
2283 struct snd_soc_tplg_vendor_value_elem *tkn_elem,
2284 struct skl_module_res *res,
2285 int pin_idx, int dir)
2286 {
2287 int ret, tkn_count = 0;
2288
2289 if (!res)
2290 return -EINVAL;
2291
2292 switch (tkn_elem->token) {
2293 case SKL_TKN_MM_U32_DMA_SIZE:
2294 res->dma_buffer_size = tkn_elem->value;
2295 break;
2296
2297 case SKL_TKN_MM_U32_CPC:
2298 res->cpc = tkn_elem->value;
2299 break;
2300
2301 case SKL_TKN_U32_MEM_PAGES:
2302 res->is_pages = tkn_elem->value;
2303 break;
2304
2305 case SKL_TKN_U32_OBS:
2306 res->obs = tkn_elem->value;
2307 break;
2308
2309 case SKL_TKN_U32_IBS:
2310 res->ibs = tkn_elem->value;
2311 break;
2312
2313 case SKL_TKN_MM_U32_RES_PIN_ID:
2314 case SKL_TKN_MM_U32_PIN_BUF:
2315 ret = skl_tplg_manifest_pin_res_tkn(dev, tkn_elem, res,
2316 pin_idx, dir);
2317 if (ret < 0)
2318 return ret;
2319 break;
2320
2321 case SKL_TKN_MM_U32_CPS:
2322 case SKL_TKN_U32_MAX_MCPS:
2323 /* ignore unused tokens */
2324 break;
2325
2326 default:
2327 dev_err(dev, "Not a res type token: %d", tkn_elem->token);
2328 return -EINVAL;
2329
2330 }
2331 tkn_count++;
2332
2333 return tkn_count;
2334 }
2335
2336 /*
2337 * Parse tokens to fill up the module private data
2338 */
skl_tplg_get_token(struct device * dev,struct snd_soc_tplg_vendor_value_elem * tkn_elem,struct skl_dev * skl,struct skl_module_cfg * mconfig)2339 static int skl_tplg_get_token(struct device *dev,
2340 struct snd_soc_tplg_vendor_value_elem *tkn_elem,
2341 struct skl_dev *skl, struct skl_module_cfg *mconfig)
2342 {
2343 int tkn_count = 0;
2344 int ret;
2345 static int is_pipe_exists;
2346 static int pin_index, dir, conf_idx;
2347 struct skl_module_iface *iface = NULL;
2348 struct skl_module_res *res = NULL;
2349 int res_idx = mconfig->res_idx;
2350 int fmt_idx = mconfig->fmt_idx;
2351
2352 /*
2353 * If the manifest structure contains no modules, fill all
2354 * the module data to 0th index.
2355 * res_idx and fmt_idx are default set to 0.
2356 */
2357 if (skl->nr_modules == 0) {
2358 res = &mconfig->module->resources[res_idx];
2359 iface = &mconfig->module->formats[fmt_idx];
2360 }
2361
2362 if (tkn_elem->token > SKL_TKN_MAX)
2363 return -EINVAL;
2364
2365 switch (tkn_elem->token) {
2366 case SKL_TKN_U8_IN_QUEUE_COUNT:
2367 mconfig->module->max_input_pins = tkn_elem->value;
2368 break;
2369
2370 case SKL_TKN_U8_OUT_QUEUE_COUNT:
2371 mconfig->module->max_output_pins = tkn_elem->value;
2372 break;
2373
2374 case SKL_TKN_U8_DYN_IN_PIN:
2375 if (!mconfig->m_in_pin)
2376 mconfig->m_in_pin =
2377 devm_kcalloc(dev, MAX_IN_QUEUE,
2378 sizeof(*mconfig->m_in_pin),
2379 GFP_KERNEL);
2380 if (!mconfig->m_in_pin)
2381 return -ENOMEM;
2382
2383 skl_tplg_fill_pin_dynamic_val(mconfig->m_in_pin, MAX_IN_QUEUE,
2384 tkn_elem->value);
2385 break;
2386
2387 case SKL_TKN_U8_DYN_OUT_PIN:
2388 if (!mconfig->m_out_pin)
2389 mconfig->m_out_pin =
2390 devm_kcalloc(dev, MAX_IN_QUEUE,
2391 sizeof(*mconfig->m_in_pin),
2392 GFP_KERNEL);
2393 if (!mconfig->m_out_pin)
2394 return -ENOMEM;
2395
2396 skl_tplg_fill_pin_dynamic_val(mconfig->m_out_pin, MAX_OUT_QUEUE,
2397 tkn_elem->value);
2398 break;
2399
2400 case SKL_TKN_U8_TIME_SLOT:
2401 mconfig->time_slot = tkn_elem->value;
2402 break;
2403
2404 case SKL_TKN_U8_CORE_ID:
2405 mconfig->core_id = tkn_elem->value;
2406 break;
2407
2408 case SKL_TKN_U8_MOD_TYPE:
2409 mconfig->m_type = tkn_elem->value;
2410 break;
2411
2412 case SKL_TKN_U8_DEV_TYPE:
2413 mconfig->dev_type = tkn_elem->value;
2414 break;
2415
2416 case SKL_TKN_U8_HW_CONN_TYPE:
2417 mconfig->hw_conn_type = tkn_elem->value;
2418 break;
2419
2420 case SKL_TKN_U16_MOD_INST_ID:
2421 mconfig->id.instance_id =
2422 tkn_elem->value;
2423 break;
2424
2425 case SKL_TKN_U32_MEM_PAGES:
2426 case SKL_TKN_U32_MAX_MCPS:
2427 case SKL_TKN_U32_OBS:
2428 case SKL_TKN_U32_IBS:
2429 ret = skl_tplg_fill_res_tkn(dev, tkn_elem, res, pin_index, dir);
2430 if (ret < 0)
2431 return ret;
2432
2433 break;
2434
2435 case SKL_TKN_U32_VBUS_ID:
2436 mconfig->vbus_id = tkn_elem->value;
2437 break;
2438
2439 case SKL_TKN_U32_PARAMS_FIXUP:
2440 mconfig->params_fixup = tkn_elem->value;
2441 break;
2442
2443 case SKL_TKN_U32_CONVERTER:
2444 mconfig->converter = tkn_elem->value;
2445 break;
2446
2447 case SKL_TKN_U32_D0I3_CAPS:
2448 mconfig->d0i3_caps = tkn_elem->value;
2449 break;
2450
2451 case SKL_TKN_U32_PIPE_ID:
2452 ret = skl_tplg_add_pipe(dev,
2453 mconfig, skl, tkn_elem);
2454
2455 if (ret < 0) {
2456 if (ret == -EEXIST) {
2457 is_pipe_exists = 1;
2458 break;
2459 }
2460 return is_pipe_exists;
2461 }
2462
2463 break;
2464
2465 case SKL_TKN_U32_PIPE_CONFIG_ID:
2466 conf_idx = tkn_elem->value;
2467 break;
2468
2469 case SKL_TKN_U32_PIPE_CONN_TYPE:
2470 case SKL_TKN_U32_PIPE_PRIORITY:
2471 case SKL_TKN_U32_PIPE_MEM_PGS:
2472 case SKL_TKN_U32_PMODE:
2473 case SKL_TKN_U32_PIPE_DIRECTION:
2474 case SKL_TKN_U32_NUM_CONFIGS:
2475 if (is_pipe_exists) {
2476 ret = skl_tplg_fill_pipe_tkn(dev, mconfig->pipe,
2477 tkn_elem->token, tkn_elem->value);
2478 if (ret < 0)
2479 return ret;
2480 }
2481
2482 break;
2483
2484 case SKL_TKN_U32_PATH_MEM_PGS:
2485 case SKL_TKN_U32_CFG_FREQ:
2486 case SKL_TKN_U8_CFG_CHAN:
2487 case SKL_TKN_U8_CFG_BPS:
2488 if (mconfig->pipe->nr_cfgs) {
2489 ret = skl_tplg_fill_pipe_cfg(dev, mconfig->pipe,
2490 tkn_elem->token, tkn_elem->value,
2491 conf_idx, dir);
2492 if (ret < 0)
2493 return ret;
2494 }
2495 break;
2496
2497 case SKL_TKN_CFG_MOD_RES_ID:
2498 mconfig->mod_cfg[conf_idx].res_idx = tkn_elem->value;
2499 break;
2500
2501 case SKL_TKN_CFG_MOD_FMT_ID:
2502 mconfig->mod_cfg[conf_idx].fmt_idx = tkn_elem->value;
2503 break;
2504
2505 /*
2506 * SKL_TKN_U32_DIR_PIN_COUNT token has the value for both
2507 * direction and the pin count. The first four bits represent
2508 * direction and next four the pin count.
2509 */
2510 case SKL_TKN_U32_DIR_PIN_COUNT:
2511 dir = tkn_elem->value & SKL_IN_DIR_BIT_MASK;
2512 pin_index = (tkn_elem->value &
2513 SKL_PIN_COUNT_MASK) >> 4;
2514
2515 break;
2516
2517 case SKL_TKN_U32_FMT_CH:
2518 case SKL_TKN_U32_FMT_FREQ:
2519 case SKL_TKN_U32_FMT_BIT_DEPTH:
2520 case SKL_TKN_U32_FMT_SAMPLE_SIZE:
2521 case SKL_TKN_U32_FMT_CH_CONFIG:
2522 case SKL_TKN_U32_FMT_INTERLEAVE:
2523 case SKL_TKN_U32_FMT_SAMPLE_TYPE:
2524 case SKL_TKN_U32_FMT_CH_MAP:
2525 ret = skl_tplg_widget_fill_fmt(dev, iface, tkn_elem->token,
2526 tkn_elem->value, dir, pin_index);
2527
2528 if (ret < 0)
2529 return ret;
2530
2531 break;
2532
2533 case SKL_TKN_U32_PIN_MOD_ID:
2534 case SKL_TKN_U32_PIN_INST_ID:
2535 case SKL_TKN_UUID:
2536 ret = skl_tplg_fill_pins_info(dev,
2537 mconfig, tkn_elem, dir,
2538 pin_index);
2539 if (ret < 0)
2540 return ret;
2541
2542 break;
2543
2544 case SKL_TKN_U32_FMT_CFG_IDX:
2545 if (tkn_elem->value > SKL_MAX_PARAMS_TYPES)
2546 return -EINVAL;
2547
2548 mconfig->fmt_cfg_idx = tkn_elem->value;
2549 break;
2550
2551 case SKL_TKN_U32_CAPS_SIZE:
2552 mconfig->formats_config[mconfig->fmt_cfg_idx].caps_size =
2553 tkn_elem->value;
2554
2555 break;
2556
2557 case SKL_TKN_U32_CAPS_SET_PARAMS:
2558 mconfig->formats_config[mconfig->fmt_cfg_idx].set_params =
2559 tkn_elem->value;
2560 break;
2561
2562 case SKL_TKN_U32_CAPS_PARAMS_ID:
2563 mconfig->formats_config[mconfig->fmt_cfg_idx].param_id =
2564 tkn_elem->value;
2565 break;
2566
2567 case SKL_TKN_U32_PROC_DOMAIN:
2568 mconfig->domain =
2569 tkn_elem->value;
2570
2571 break;
2572
2573 case SKL_TKN_U32_DMA_BUF_SIZE:
2574 mconfig->dma_buffer_size = tkn_elem->value;
2575 break;
2576
2577 case SKL_TKN_U8_IN_PIN_TYPE:
2578 case SKL_TKN_U8_OUT_PIN_TYPE:
2579 case SKL_TKN_U8_CONN_TYPE:
2580 break;
2581
2582 default:
2583 dev_err(dev, "Token %d not handled\n",
2584 tkn_elem->token);
2585 return -EINVAL;
2586 }
2587
2588 tkn_count++;
2589
2590 return tkn_count;
2591 }
2592
2593 /*
2594 * Parse the vendor array for specific tokens to construct
2595 * module private data
2596 */
skl_tplg_get_tokens(struct device * dev,char * pvt_data,struct skl_dev * skl,struct skl_module_cfg * mconfig,int block_size)2597 static int skl_tplg_get_tokens(struct device *dev,
2598 char *pvt_data, struct skl_dev *skl,
2599 struct skl_module_cfg *mconfig, int block_size)
2600 {
2601 struct snd_soc_tplg_vendor_array *array;
2602 struct snd_soc_tplg_vendor_value_elem *tkn_elem;
2603 int tkn_count = 0, ret;
2604 int off = 0, tuple_size = 0;
2605 bool is_module_guid = true;
2606
2607 if (block_size <= 0)
2608 return -EINVAL;
2609
2610 while (tuple_size < block_size) {
2611 array = (struct snd_soc_tplg_vendor_array *)(pvt_data + off);
2612
2613 off += array->size;
2614
2615 switch (array->type) {
2616 case SND_SOC_TPLG_TUPLE_TYPE_STRING:
2617 dev_warn(dev, "no string tokens expected for skl tplg\n");
2618 continue;
2619
2620 case SND_SOC_TPLG_TUPLE_TYPE_UUID:
2621 if (is_module_guid) {
2622 ret = skl_tplg_get_uuid(dev, (guid_t *)mconfig->guid,
2623 array->uuid);
2624 is_module_guid = false;
2625 } else {
2626 ret = skl_tplg_get_token(dev, array->value, skl,
2627 mconfig);
2628 }
2629
2630 if (ret < 0)
2631 return ret;
2632
2633 tuple_size += sizeof(*array->uuid);
2634
2635 continue;
2636
2637 default:
2638 tkn_elem = array->value;
2639 tkn_count = 0;
2640 break;
2641 }
2642
2643 while (tkn_count <= (array->num_elems - 1)) {
2644 ret = skl_tplg_get_token(dev, tkn_elem,
2645 skl, mconfig);
2646
2647 if (ret < 0)
2648 return ret;
2649
2650 tkn_count = tkn_count + ret;
2651 tkn_elem++;
2652 }
2653
2654 tuple_size += tkn_count * sizeof(*tkn_elem);
2655 }
2656
2657 return off;
2658 }
2659
2660 /*
2661 * Every data block is preceded by a descriptor to read the number
2662 * of data blocks, they type of the block and it's size
2663 */
skl_tplg_get_desc_blocks(struct device * dev,struct snd_soc_tplg_vendor_array * array)2664 static int skl_tplg_get_desc_blocks(struct device *dev,
2665 struct snd_soc_tplg_vendor_array *array)
2666 {
2667 struct snd_soc_tplg_vendor_value_elem *tkn_elem;
2668
2669 tkn_elem = array->value;
2670
2671 switch (tkn_elem->token) {
2672 case SKL_TKN_U8_NUM_BLOCKS:
2673 case SKL_TKN_U8_BLOCK_TYPE:
2674 case SKL_TKN_U16_BLOCK_SIZE:
2675 return tkn_elem->value;
2676
2677 default:
2678 dev_err(dev, "Invalid descriptor token %d\n", tkn_elem->token);
2679 break;
2680 }
2681
2682 return -EINVAL;
2683 }
2684
2685 /* Functions to parse private data from configuration file format v4 */
2686
2687 /*
2688 * Add pipeline from topology binary into driver pipeline list
2689 *
2690 * If already added we return that instance
2691 * Otherwise we create a new instance and add into driver list
2692 */
skl_tplg_add_pipe_v4(struct device * dev,struct skl_module_cfg * mconfig,struct skl_dev * skl,struct skl_dfw_v4_pipe * dfw_pipe)2693 static int skl_tplg_add_pipe_v4(struct device *dev,
2694 struct skl_module_cfg *mconfig, struct skl_dev *skl,
2695 struct skl_dfw_v4_pipe *dfw_pipe)
2696 {
2697 struct skl_pipeline *ppl;
2698 struct skl_pipe *pipe;
2699 struct skl_pipe_params *params;
2700
2701 list_for_each_entry(ppl, &skl->ppl_list, node) {
2702 if (ppl->pipe->ppl_id == dfw_pipe->pipe_id) {
2703 mconfig->pipe = ppl->pipe;
2704 return 0;
2705 }
2706 }
2707
2708 ppl = devm_kzalloc(dev, sizeof(*ppl), GFP_KERNEL);
2709 if (!ppl)
2710 return -ENOMEM;
2711
2712 pipe = devm_kzalloc(dev, sizeof(*pipe), GFP_KERNEL);
2713 if (!pipe)
2714 return -ENOMEM;
2715
2716 params = devm_kzalloc(dev, sizeof(*params), GFP_KERNEL);
2717 if (!params)
2718 return -ENOMEM;
2719
2720 pipe->ppl_id = dfw_pipe->pipe_id;
2721 pipe->memory_pages = dfw_pipe->memory_pages;
2722 pipe->pipe_priority = dfw_pipe->pipe_priority;
2723 pipe->conn_type = dfw_pipe->conn_type;
2724 pipe->state = SKL_PIPE_INVALID;
2725 pipe->p_params = params;
2726 INIT_LIST_HEAD(&pipe->w_list);
2727
2728 ppl->pipe = pipe;
2729 list_add(&ppl->node, &skl->ppl_list);
2730
2731 mconfig->pipe = pipe;
2732
2733 return 0;
2734 }
2735
skl_fill_module_pin_info_v4(struct skl_dfw_v4_module_pin * dfw_pin,struct skl_module_pin * m_pin,bool is_dynamic,int max_pin)2736 static void skl_fill_module_pin_info_v4(struct skl_dfw_v4_module_pin *dfw_pin,
2737 struct skl_module_pin *m_pin,
2738 bool is_dynamic, int max_pin)
2739 {
2740 int i;
2741
2742 for (i = 0; i < max_pin; i++) {
2743 m_pin[i].id.module_id = dfw_pin[i].module_id;
2744 m_pin[i].id.instance_id = dfw_pin[i].instance_id;
2745 m_pin[i].in_use = false;
2746 m_pin[i].is_dynamic = is_dynamic;
2747 m_pin[i].pin_state = SKL_PIN_UNBIND;
2748 }
2749 }
2750
skl_tplg_fill_fmt_v4(struct skl_module_pin_fmt * dst_fmt,struct skl_dfw_v4_module_fmt * src_fmt,int pins)2751 static void skl_tplg_fill_fmt_v4(struct skl_module_pin_fmt *dst_fmt,
2752 struct skl_dfw_v4_module_fmt *src_fmt,
2753 int pins)
2754 {
2755 int i;
2756
2757 for (i = 0; i < pins; i++) {
2758 dst_fmt[i].fmt.channels = src_fmt[i].channels;
2759 dst_fmt[i].fmt.s_freq = src_fmt[i].freq;
2760 dst_fmt[i].fmt.bit_depth = src_fmt[i].bit_depth;
2761 dst_fmt[i].fmt.valid_bit_depth = src_fmt[i].valid_bit_depth;
2762 dst_fmt[i].fmt.ch_cfg = src_fmt[i].ch_cfg;
2763 dst_fmt[i].fmt.ch_map = src_fmt[i].ch_map;
2764 dst_fmt[i].fmt.interleaving_style =
2765 src_fmt[i].interleaving_style;
2766 dst_fmt[i].fmt.sample_type = src_fmt[i].sample_type;
2767 }
2768 }
2769
skl_tplg_get_pvt_data_v4(struct snd_soc_tplg_dapm_widget * tplg_w,struct skl_dev * skl,struct device * dev,struct skl_module_cfg * mconfig)2770 static int skl_tplg_get_pvt_data_v4(struct snd_soc_tplg_dapm_widget *tplg_w,
2771 struct skl_dev *skl, struct device *dev,
2772 struct skl_module_cfg *mconfig)
2773 {
2774 struct skl_dfw_v4_module *dfw =
2775 (struct skl_dfw_v4_module *)tplg_w->priv.data;
2776 int ret;
2777 int idx = mconfig->fmt_cfg_idx;
2778
2779 dev_dbg(dev, "Parsing Skylake v4 widget topology data\n");
2780
2781 ret = guid_parse(dfw->uuid, (guid_t *)mconfig->guid);
2782 if (ret)
2783 return ret;
2784 mconfig->id.module_id = -1;
2785 mconfig->id.instance_id = dfw->instance_id;
2786 mconfig->module->resources[0].cpc = dfw->max_mcps / 1000;
2787 mconfig->module->resources[0].ibs = dfw->ibs;
2788 mconfig->module->resources[0].obs = dfw->obs;
2789 mconfig->core_id = dfw->core_id;
2790 mconfig->module->max_input_pins = dfw->max_in_queue;
2791 mconfig->module->max_output_pins = dfw->max_out_queue;
2792 mconfig->module->loadable = dfw->is_loadable;
2793 skl_tplg_fill_fmt_v4(mconfig->module->formats[0].inputs, dfw->in_fmt,
2794 MAX_IN_QUEUE);
2795 skl_tplg_fill_fmt_v4(mconfig->module->formats[0].outputs, dfw->out_fmt,
2796 MAX_OUT_QUEUE);
2797
2798 mconfig->params_fixup = dfw->params_fixup;
2799 mconfig->converter = dfw->converter;
2800 mconfig->m_type = dfw->module_type;
2801 mconfig->vbus_id = dfw->vbus_id;
2802 mconfig->module->resources[0].is_pages = dfw->mem_pages;
2803
2804 ret = skl_tplg_add_pipe_v4(dev, mconfig, skl, &dfw->pipe);
2805 if (ret)
2806 return ret;
2807
2808 mconfig->dev_type = dfw->dev_type;
2809 mconfig->hw_conn_type = dfw->hw_conn_type;
2810 mconfig->time_slot = dfw->time_slot;
2811 mconfig->formats_config[idx].caps_size = dfw->caps.caps_size;
2812
2813 mconfig->m_in_pin = devm_kcalloc(dev,
2814 MAX_IN_QUEUE, sizeof(*mconfig->m_in_pin),
2815 GFP_KERNEL);
2816 if (!mconfig->m_in_pin)
2817 return -ENOMEM;
2818
2819 mconfig->m_out_pin = devm_kcalloc(dev,
2820 MAX_OUT_QUEUE, sizeof(*mconfig->m_out_pin),
2821 GFP_KERNEL);
2822 if (!mconfig->m_out_pin)
2823 return -ENOMEM;
2824
2825 skl_fill_module_pin_info_v4(dfw->in_pin, mconfig->m_in_pin,
2826 dfw->is_dynamic_in_pin,
2827 mconfig->module->max_input_pins);
2828 skl_fill_module_pin_info_v4(dfw->out_pin, mconfig->m_out_pin,
2829 dfw->is_dynamic_out_pin,
2830 mconfig->module->max_output_pins);
2831
2832 if (mconfig->formats_config[idx].caps_size) {
2833 mconfig->formats_config[idx].set_params = dfw->caps.set_params;
2834 mconfig->formats_config[idx].param_id = dfw->caps.param_id;
2835 mconfig->formats_config[idx].caps =
2836 devm_kzalloc(dev, mconfig->formats_config[idx].caps_size,
2837 GFP_KERNEL);
2838 if (!mconfig->formats_config[idx].caps)
2839 return -ENOMEM;
2840 memcpy(mconfig->formats_config[idx].caps, dfw->caps.caps,
2841 dfw->caps.caps_size);
2842 }
2843
2844 return 0;
2845 }
2846
skl_tplg_get_caps_data(struct device * dev,char * data,struct skl_module_cfg * mconfig)2847 static int skl_tplg_get_caps_data(struct device *dev, char *data,
2848 struct skl_module_cfg *mconfig)
2849 {
2850 int idx = mconfig->fmt_cfg_idx;
2851
2852 if (mconfig->formats_config[idx].caps_size > 0) {
2853 mconfig->formats_config[idx].caps =
2854 devm_kzalloc(dev, mconfig->formats_config[idx].caps_size,
2855 GFP_KERNEL);
2856 if (!mconfig->formats_config[idx].caps)
2857 return -ENOMEM;
2858 memcpy(mconfig->formats_config[idx].caps, data,
2859 mconfig->formats_config[idx].caps_size);
2860 }
2861
2862 return mconfig->formats_config[idx].caps_size;
2863 }
2864
2865 /*
2866 * Parse the private data for the token and corresponding value.
2867 * The private data can have multiple data blocks. So, a data block
2868 * is preceded by a descriptor for number of blocks and a descriptor
2869 * for the type and size of the suceeding data block.
2870 */
skl_tplg_get_pvt_data(struct snd_soc_tplg_dapm_widget * tplg_w,struct skl_dev * skl,struct device * dev,struct skl_module_cfg * mconfig)2871 static int skl_tplg_get_pvt_data(struct snd_soc_tplg_dapm_widget *tplg_w,
2872 struct skl_dev *skl, struct device *dev,
2873 struct skl_module_cfg *mconfig)
2874 {
2875 struct snd_soc_tplg_vendor_array *array;
2876 int num_blocks, block_size, block_type, off = 0;
2877 char *data;
2878 int ret;
2879
2880 /*
2881 * v4 configuration files have a valid UUID at the start of
2882 * the widget's private data.
2883 */
2884 if (uuid_is_valid((char *)tplg_w->priv.data))
2885 return skl_tplg_get_pvt_data_v4(tplg_w, skl, dev, mconfig);
2886
2887 /* Read the NUM_DATA_BLOCKS descriptor */
2888 array = (struct snd_soc_tplg_vendor_array *)tplg_w->priv.data;
2889 ret = skl_tplg_get_desc_blocks(dev, array);
2890 if (ret < 0)
2891 return ret;
2892 num_blocks = ret;
2893
2894 off += array->size;
2895 /* Read the BLOCK_TYPE and BLOCK_SIZE descriptor */
2896 while (num_blocks > 0) {
2897 array = (struct snd_soc_tplg_vendor_array *)
2898 (tplg_w->priv.data + off);
2899
2900 ret = skl_tplg_get_desc_blocks(dev, array);
2901
2902 if (ret < 0)
2903 return ret;
2904 block_type = ret;
2905 off += array->size;
2906
2907 array = (struct snd_soc_tplg_vendor_array *)
2908 (tplg_w->priv.data + off);
2909
2910 ret = skl_tplg_get_desc_blocks(dev, array);
2911
2912 if (ret < 0)
2913 return ret;
2914 block_size = ret;
2915 off += array->size;
2916
2917 data = (tplg_w->priv.data + off);
2918
2919 if (block_type == SKL_TYPE_TUPLE) {
2920 ret = skl_tplg_get_tokens(dev, data,
2921 skl, mconfig, block_size);
2922 } else {
2923 ret = skl_tplg_get_caps_data(dev, data, mconfig);
2924 }
2925
2926 if (ret < 0)
2927 return ret;
2928
2929 --num_blocks;
2930 off += ret;
2931 }
2932
2933 return 0;
2934 }
2935
skl_clear_pin_config(struct snd_soc_component * component,struct snd_soc_dapm_widget * w)2936 static void skl_clear_pin_config(struct snd_soc_component *component,
2937 struct snd_soc_dapm_widget *w)
2938 {
2939 int i;
2940 struct skl_module_cfg *mconfig;
2941 struct skl_pipe *pipe;
2942
2943 if (!strncmp(w->dapm->component->name, component->name,
2944 strlen(component->name))) {
2945 mconfig = w->priv;
2946 pipe = mconfig->pipe;
2947 for (i = 0; i < mconfig->module->max_input_pins; i++) {
2948 mconfig->m_in_pin[i].in_use = false;
2949 mconfig->m_in_pin[i].pin_state = SKL_PIN_UNBIND;
2950 }
2951 for (i = 0; i < mconfig->module->max_output_pins; i++) {
2952 mconfig->m_out_pin[i].in_use = false;
2953 mconfig->m_out_pin[i].pin_state = SKL_PIN_UNBIND;
2954 }
2955 pipe->state = SKL_PIPE_INVALID;
2956 mconfig->m_state = SKL_MODULE_UNINIT;
2957 }
2958 }
2959
skl_cleanup_resources(struct skl_dev * skl)2960 void skl_cleanup_resources(struct skl_dev *skl)
2961 {
2962 struct snd_soc_component *soc_component = skl->component;
2963 struct snd_soc_dapm_widget *w;
2964 struct snd_soc_card *card;
2965
2966 if (soc_component == NULL)
2967 return;
2968
2969 card = soc_component->card;
2970 if (!snd_soc_card_is_instantiated(card))
2971 return;
2972
2973 list_for_each_entry(w, &card->widgets, list) {
2974 if (is_skl_dsp_widget_type(w, skl->dev) && w->priv != NULL)
2975 skl_clear_pin_config(soc_component, w);
2976 }
2977
2978 skl_clear_module_cnt(skl->dsp);
2979 }
2980
2981 /*
2982 * Topology core widget load callback
2983 *
2984 * This is used to save the private data for each widget which gives
2985 * information to the driver about module and pipeline parameters which DSP
2986 * FW expects like ids, resource values, formats etc
2987 */
skl_tplg_widget_load(struct snd_soc_component * cmpnt,int index,struct snd_soc_dapm_widget * w,struct snd_soc_tplg_dapm_widget * tplg_w)2988 static int skl_tplg_widget_load(struct snd_soc_component *cmpnt, int index,
2989 struct snd_soc_dapm_widget *w,
2990 struct snd_soc_tplg_dapm_widget *tplg_w)
2991 {
2992 int ret;
2993 struct hdac_bus *bus = snd_soc_component_get_drvdata(cmpnt);
2994 struct skl_dev *skl = bus_to_skl(bus);
2995 struct skl_module_cfg *mconfig;
2996
2997 if (!tplg_w->priv.size)
2998 goto bind_event;
2999
3000 mconfig = devm_kzalloc(bus->dev, sizeof(*mconfig), GFP_KERNEL);
3001
3002 if (!mconfig)
3003 return -ENOMEM;
3004
3005 if (skl->nr_modules == 0) {
3006 mconfig->module = devm_kzalloc(bus->dev,
3007 sizeof(*mconfig->module), GFP_KERNEL);
3008 if (!mconfig->module)
3009 return -ENOMEM;
3010 }
3011
3012 w->priv = mconfig;
3013
3014 /*
3015 * module binary can be loaded later, so set it to query when
3016 * module is load for a use case
3017 */
3018 mconfig->id.module_id = -1;
3019
3020 /* To provide backward compatibility, set default as SKL_PARAM_INIT */
3021 mconfig->fmt_cfg_idx = SKL_PARAM_INIT;
3022
3023 /* Parse private data for tuples */
3024 ret = skl_tplg_get_pvt_data(tplg_w, skl, bus->dev, mconfig);
3025 if (ret < 0)
3026 return ret;
3027
3028 skl_debug_init_module(skl->debugfs, w, mconfig);
3029
3030 bind_event:
3031 if (tplg_w->event_type == 0) {
3032 dev_dbg(bus->dev, "ASoC: No event handler required\n");
3033 return 0;
3034 }
3035
3036 ret = snd_soc_tplg_widget_bind_event(w, skl_tplg_widget_ops,
3037 ARRAY_SIZE(skl_tplg_widget_ops),
3038 tplg_w->event_type);
3039
3040 if (ret) {
3041 dev_err(bus->dev, "%s: No matching event handlers found for %d\n",
3042 __func__, tplg_w->event_type);
3043 return -EINVAL;
3044 }
3045
3046 return 0;
3047 }
3048
skl_init_algo_data(struct device * dev,struct soc_bytes_ext * be,struct snd_soc_tplg_bytes_control * bc)3049 static int skl_init_algo_data(struct device *dev, struct soc_bytes_ext *be,
3050 struct snd_soc_tplg_bytes_control *bc)
3051 {
3052 struct skl_algo_data *ac;
3053 struct skl_dfw_algo_data *dfw_ac =
3054 (struct skl_dfw_algo_data *)bc->priv.data;
3055
3056 ac = devm_kzalloc(dev, sizeof(*ac), GFP_KERNEL);
3057 if (!ac)
3058 return -ENOMEM;
3059
3060 /* Fill private data */
3061 ac->max = dfw_ac->max;
3062 ac->param_id = dfw_ac->param_id;
3063 ac->set_params = dfw_ac->set_params;
3064 ac->size = dfw_ac->max;
3065
3066 if (ac->max) {
3067 ac->params = devm_kzalloc(dev, ac->max, GFP_KERNEL);
3068 if (!ac->params)
3069 return -ENOMEM;
3070
3071 memcpy(ac->params, dfw_ac->params, ac->max);
3072 }
3073
3074 be->dobj.private = ac;
3075 return 0;
3076 }
3077
skl_init_enum_data(struct device * dev,struct soc_enum * se,struct snd_soc_tplg_enum_control * ec)3078 static int skl_init_enum_data(struct device *dev, struct soc_enum *se,
3079 struct snd_soc_tplg_enum_control *ec)
3080 {
3081
3082 void *data;
3083
3084 if (ec->priv.size) {
3085 data = devm_kzalloc(dev, sizeof(ec->priv.size), GFP_KERNEL);
3086 if (!data)
3087 return -ENOMEM;
3088 memcpy(data, ec->priv.data, ec->priv.size);
3089 se->dobj.private = data;
3090 }
3091
3092 return 0;
3093
3094 }
3095
skl_tplg_control_load(struct snd_soc_component * cmpnt,int index,struct snd_kcontrol_new * kctl,struct snd_soc_tplg_ctl_hdr * hdr)3096 static int skl_tplg_control_load(struct snd_soc_component *cmpnt,
3097 int index,
3098 struct snd_kcontrol_new *kctl,
3099 struct snd_soc_tplg_ctl_hdr *hdr)
3100 {
3101 struct soc_bytes_ext *sb;
3102 struct snd_soc_tplg_bytes_control *tplg_bc;
3103 struct snd_soc_tplg_enum_control *tplg_ec;
3104 struct hdac_bus *bus = snd_soc_component_get_drvdata(cmpnt);
3105 struct soc_enum *se;
3106
3107 switch (hdr->ops.info) {
3108 case SND_SOC_TPLG_CTL_BYTES:
3109 tplg_bc = container_of(hdr,
3110 struct snd_soc_tplg_bytes_control, hdr);
3111 if (kctl->access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) {
3112 sb = (struct soc_bytes_ext *)kctl->private_value;
3113 if (tplg_bc->priv.size)
3114 return skl_init_algo_data(
3115 bus->dev, sb, tplg_bc);
3116 }
3117 break;
3118
3119 case SND_SOC_TPLG_CTL_ENUM:
3120 tplg_ec = container_of(hdr,
3121 struct snd_soc_tplg_enum_control, hdr);
3122 if (kctl->access & SNDRV_CTL_ELEM_ACCESS_READ) {
3123 se = (struct soc_enum *)kctl->private_value;
3124 if (tplg_ec->priv.size)
3125 skl_init_enum_data(bus->dev, se, tplg_ec);
3126 }
3127
3128 /*
3129 * now that the control initializations are done, remove
3130 * write permission for the DMIC configuration enums to
3131 * avoid conflicts between NHLT settings and user interaction
3132 */
3133
3134 if (hdr->ops.get == SKL_CONTROL_TYPE_MULTI_IO_SELECT_DMIC)
3135 kctl->access = SNDRV_CTL_ELEM_ACCESS_READ;
3136
3137 break;
3138
3139 default:
3140 dev_dbg(bus->dev, "Control load not supported %d:%d:%d\n",
3141 hdr->ops.get, hdr->ops.put, hdr->ops.info);
3142 break;
3143 }
3144
3145 return 0;
3146 }
3147
skl_tplg_fill_str_mfest_tkn(struct device * dev,struct snd_soc_tplg_vendor_string_elem * str_elem,struct skl_dev * skl)3148 static int skl_tplg_fill_str_mfest_tkn(struct device *dev,
3149 struct snd_soc_tplg_vendor_string_elem *str_elem,
3150 struct skl_dev *skl)
3151 {
3152 int tkn_count = 0;
3153 static int ref_count;
3154
3155 switch (str_elem->token) {
3156 case SKL_TKN_STR_LIB_NAME:
3157 if (ref_count > skl->lib_count - 1) {
3158 ref_count = 0;
3159 return -EINVAL;
3160 }
3161
3162 strncpy(skl->lib_info[ref_count].name,
3163 str_elem->string,
3164 ARRAY_SIZE(skl->lib_info[ref_count].name));
3165 ref_count++;
3166 break;
3167
3168 default:
3169 dev_err(dev, "Not a string token %d\n", str_elem->token);
3170 break;
3171 }
3172 tkn_count++;
3173
3174 return tkn_count;
3175 }
3176
skl_tplg_get_str_tkn(struct device * dev,struct snd_soc_tplg_vendor_array * array,struct skl_dev * skl)3177 static int skl_tplg_get_str_tkn(struct device *dev,
3178 struct snd_soc_tplg_vendor_array *array,
3179 struct skl_dev *skl)
3180 {
3181 int tkn_count = 0, ret;
3182 struct snd_soc_tplg_vendor_string_elem *str_elem;
3183
3184 str_elem = (struct snd_soc_tplg_vendor_string_elem *)array->value;
3185 while (tkn_count < array->num_elems) {
3186 ret = skl_tplg_fill_str_mfest_tkn(dev, str_elem, skl);
3187 str_elem++;
3188
3189 if (ret < 0)
3190 return ret;
3191
3192 tkn_count = tkn_count + ret;
3193 }
3194
3195 return tkn_count;
3196 }
3197
skl_tplg_manifest_fill_fmt(struct device * dev,struct skl_module_iface * fmt,struct snd_soc_tplg_vendor_value_elem * tkn_elem,u32 dir,int fmt_idx)3198 static int skl_tplg_manifest_fill_fmt(struct device *dev,
3199 struct skl_module_iface *fmt,
3200 struct snd_soc_tplg_vendor_value_elem *tkn_elem,
3201 u32 dir, int fmt_idx)
3202 {
3203 struct skl_module_pin_fmt *dst_fmt;
3204 struct skl_module_fmt *mod_fmt;
3205 int ret;
3206
3207 if (!fmt)
3208 return -EINVAL;
3209
3210 switch (dir) {
3211 case SKL_DIR_IN:
3212 dst_fmt = &fmt->inputs[fmt_idx];
3213 break;
3214
3215 case SKL_DIR_OUT:
3216 dst_fmt = &fmt->outputs[fmt_idx];
3217 break;
3218
3219 default:
3220 dev_err(dev, "Invalid direction: %d\n", dir);
3221 return -EINVAL;
3222 }
3223
3224 mod_fmt = &dst_fmt->fmt;
3225
3226 switch (tkn_elem->token) {
3227 case SKL_TKN_MM_U32_INTF_PIN_ID:
3228 dst_fmt->id = tkn_elem->value;
3229 break;
3230
3231 default:
3232 ret = skl_tplg_fill_fmt(dev, mod_fmt, tkn_elem->token,
3233 tkn_elem->value);
3234 if (ret < 0)
3235 return ret;
3236 break;
3237 }
3238
3239 return 0;
3240 }
3241
skl_tplg_fill_mod_info(struct device * dev,struct snd_soc_tplg_vendor_value_elem * tkn_elem,struct skl_module * mod)3242 static int skl_tplg_fill_mod_info(struct device *dev,
3243 struct snd_soc_tplg_vendor_value_elem *tkn_elem,
3244 struct skl_module *mod)
3245 {
3246
3247 if (!mod)
3248 return -EINVAL;
3249
3250 switch (tkn_elem->token) {
3251 case SKL_TKN_U8_IN_PIN_TYPE:
3252 mod->input_pin_type = tkn_elem->value;
3253 break;
3254
3255 case SKL_TKN_U8_OUT_PIN_TYPE:
3256 mod->output_pin_type = tkn_elem->value;
3257 break;
3258
3259 case SKL_TKN_U8_IN_QUEUE_COUNT:
3260 mod->max_input_pins = tkn_elem->value;
3261 break;
3262
3263 case SKL_TKN_U8_OUT_QUEUE_COUNT:
3264 mod->max_output_pins = tkn_elem->value;
3265 break;
3266
3267 case SKL_TKN_MM_U8_NUM_RES:
3268 mod->nr_resources = tkn_elem->value;
3269 break;
3270
3271 case SKL_TKN_MM_U8_NUM_INTF:
3272 mod->nr_interfaces = tkn_elem->value;
3273 break;
3274
3275 default:
3276 dev_err(dev, "Invalid mod info token %d", tkn_elem->token);
3277 return -EINVAL;
3278 }
3279
3280 return 0;
3281 }
3282
3283
skl_tplg_get_int_tkn(struct device * dev,struct snd_soc_tplg_vendor_value_elem * tkn_elem,struct skl_dev * skl)3284 static int skl_tplg_get_int_tkn(struct device *dev,
3285 struct snd_soc_tplg_vendor_value_elem *tkn_elem,
3286 struct skl_dev *skl)
3287 {
3288 int tkn_count = 0, ret;
3289 static int mod_idx, res_val_idx, intf_val_idx, dir, pin_idx;
3290 struct skl_module_res *res = NULL;
3291 struct skl_module_iface *fmt = NULL;
3292 struct skl_module *mod = NULL;
3293 static struct skl_astate_param *astate_table;
3294 static int astate_cfg_idx, count;
3295 int i;
3296 size_t size;
3297
3298 if (skl->modules) {
3299 mod = skl->modules[mod_idx];
3300 res = &mod->resources[res_val_idx];
3301 fmt = &mod->formats[intf_val_idx];
3302 }
3303
3304 switch (tkn_elem->token) {
3305 case SKL_TKN_U32_LIB_COUNT:
3306 skl->lib_count = tkn_elem->value;
3307 break;
3308
3309 case SKL_TKN_U8_NUM_MOD:
3310 skl->nr_modules = tkn_elem->value;
3311 skl->modules = devm_kcalloc(dev, skl->nr_modules,
3312 sizeof(*skl->modules), GFP_KERNEL);
3313 if (!skl->modules)
3314 return -ENOMEM;
3315
3316 for (i = 0; i < skl->nr_modules; i++) {
3317 skl->modules[i] = devm_kzalloc(dev,
3318 sizeof(struct skl_module), GFP_KERNEL);
3319 if (!skl->modules[i])
3320 return -ENOMEM;
3321 }
3322 break;
3323
3324 case SKL_TKN_MM_U8_MOD_IDX:
3325 mod_idx = tkn_elem->value;
3326 break;
3327
3328 case SKL_TKN_U32_ASTATE_COUNT:
3329 if (astate_table != NULL) {
3330 dev_err(dev, "More than one entry for A-State count");
3331 return -EINVAL;
3332 }
3333
3334 if (tkn_elem->value > SKL_MAX_ASTATE_CFG) {
3335 dev_err(dev, "Invalid A-State count %d\n",
3336 tkn_elem->value);
3337 return -EINVAL;
3338 }
3339
3340 size = struct_size(skl->cfg.astate_cfg, astate_table,
3341 tkn_elem->value);
3342 skl->cfg.astate_cfg = devm_kzalloc(dev, size, GFP_KERNEL);
3343 if (!skl->cfg.astate_cfg)
3344 return -ENOMEM;
3345
3346 astate_table = skl->cfg.astate_cfg->astate_table;
3347 count = skl->cfg.astate_cfg->count = tkn_elem->value;
3348 break;
3349
3350 case SKL_TKN_U32_ASTATE_IDX:
3351 if (tkn_elem->value >= count) {
3352 dev_err(dev, "Invalid A-State index %d\n",
3353 tkn_elem->value);
3354 return -EINVAL;
3355 }
3356
3357 astate_cfg_idx = tkn_elem->value;
3358 break;
3359
3360 case SKL_TKN_U32_ASTATE_KCPS:
3361 astate_table[astate_cfg_idx].kcps = tkn_elem->value;
3362 break;
3363
3364 case SKL_TKN_U32_ASTATE_CLK_SRC:
3365 astate_table[astate_cfg_idx].clk_src = tkn_elem->value;
3366 break;
3367
3368 case SKL_TKN_U8_IN_PIN_TYPE:
3369 case SKL_TKN_U8_OUT_PIN_TYPE:
3370 case SKL_TKN_U8_IN_QUEUE_COUNT:
3371 case SKL_TKN_U8_OUT_QUEUE_COUNT:
3372 case SKL_TKN_MM_U8_NUM_RES:
3373 case SKL_TKN_MM_U8_NUM_INTF:
3374 ret = skl_tplg_fill_mod_info(dev, tkn_elem, mod);
3375 if (ret < 0)
3376 return ret;
3377 break;
3378
3379 case SKL_TKN_U32_DIR_PIN_COUNT:
3380 dir = tkn_elem->value & SKL_IN_DIR_BIT_MASK;
3381 pin_idx = (tkn_elem->value & SKL_PIN_COUNT_MASK) >> 4;
3382 break;
3383
3384 case SKL_TKN_MM_U32_RES_ID:
3385 if (!res)
3386 return -EINVAL;
3387
3388 res->id = tkn_elem->value;
3389 res_val_idx = tkn_elem->value;
3390 break;
3391
3392 case SKL_TKN_MM_U32_FMT_ID:
3393 if (!fmt)
3394 return -EINVAL;
3395
3396 fmt->fmt_idx = tkn_elem->value;
3397 intf_val_idx = tkn_elem->value;
3398 break;
3399
3400 case SKL_TKN_MM_U32_CPS:
3401 case SKL_TKN_MM_U32_DMA_SIZE:
3402 case SKL_TKN_MM_U32_CPC:
3403 case SKL_TKN_U32_MEM_PAGES:
3404 case SKL_TKN_U32_OBS:
3405 case SKL_TKN_U32_IBS:
3406 case SKL_TKN_MM_U32_RES_PIN_ID:
3407 case SKL_TKN_MM_U32_PIN_BUF:
3408 ret = skl_tplg_fill_res_tkn(dev, tkn_elem, res, pin_idx, dir);
3409 if (ret < 0)
3410 return ret;
3411
3412 break;
3413
3414 case SKL_TKN_MM_U32_NUM_IN_FMT:
3415 if (!fmt)
3416 return -EINVAL;
3417
3418 res->nr_input_pins = tkn_elem->value;
3419 break;
3420
3421 case SKL_TKN_MM_U32_NUM_OUT_FMT:
3422 if (!fmt)
3423 return -EINVAL;
3424
3425 res->nr_output_pins = tkn_elem->value;
3426 break;
3427
3428 case SKL_TKN_U32_FMT_CH:
3429 case SKL_TKN_U32_FMT_FREQ:
3430 case SKL_TKN_U32_FMT_BIT_DEPTH:
3431 case SKL_TKN_U32_FMT_SAMPLE_SIZE:
3432 case SKL_TKN_U32_FMT_CH_CONFIG:
3433 case SKL_TKN_U32_FMT_INTERLEAVE:
3434 case SKL_TKN_U32_FMT_SAMPLE_TYPE:
3435 case SKL_TKN_U32_FMT_CH_MAP:
3436 case SKL_TKN_MM_U32_INTF_PIN_ID:
3437 ret = skl_tplg_manifest_fill_fmt(dev, fmt, tkn_elem,
3438 dir, pin_idx);
3439 if (ret < 0)
3440 return ret;
3441 break;
3442
3443 default:
3444 dev_err(dev, "Not a manifest token %d\n", tkn_elem->token);
3445 return -EINVAL;
3446 }
3447 tkn_count++;
3448
3449 return tkn_count;
3450 }
3451
3452 /*
3453 * Fill the manifest structure by parsing the tokens based on the
3454 * type.
3455 */
skl_tplg_get_manifest_tkn(struct device * dev,char * pvt_data,struct skl_dev * skl,int block_size)3456 static int skl_tplg_get_manifest_tkn(struct device *dev,
3457 char *pvt_data, struct skl_dev *skl,
3458 int block_size)
3459 {
3460 int tkn_count = 0, ret;
3461 int off = 0, tuple_size = 0;
3462 u8 uuid_index = 0;
3463 struct snd_soc_tplg_vendor_array *array;
3464 struct snd_soc_tplg_vendor_value_elem *tkn_elem;
3465
3466 if (block_size <= 0)
3467 return -EINVAL;
3468
3469 while (tuple_size < block_size) {
3470 array = (struct snd_soc_tplg_vendor_array *)(pvt_data + off);
3471 off += array->size;
3472 switch (array->type) {
3473 case SND_SOC_TPLG_TUPLE_TYPE_STRING:
3474 ret = skl_tplg_get_str_tkn(dev, array, skl);
3475
3476 if (ret < 0)
3477 return ret;
3478 tkn_count = ret;
3479
3480 tuple_size += tkn_count *
3481 sizeof(struct snd_soc_tplg_vendor_string_elem);
3482 continue;
3483
3484 case SND_SOC_TPLG_TUPLE_TYPE_UUID:
3485 if (array->uuid->token != SKL_TKN_UUID) {
3486 dev_err(dev, "Not an UUID token: %d\n",
3487 array->uuid->token);
3488 return -EINVAL;
3489 }
3490 if (uuid_index >= skl->nr_modules) {
3491 dev_err(dev, "Too many UUID tokens\n");
3492 return -EINVAL;
3493 }
3494 import_guid(&skl->modules[uuid_index++]->uuid,
3495 array->uuid->uuid);
3496
3497 tuple_size += sizeof(*array->uuid);
3498 continue;
3499
3500 default:
3501 tkn_elem = array->value;
3502 tkn_count = 0;
3503 break;
3504 }
3505
3506 while (tkn_count <= array->num_elems - 1) {
3507 ret = skl_tplg_get_int_tkn(dev,
3508 tkn_elem, skl);
3509 if (ret < 0)
3510 return ret;
3511
3512 tkn_count = tkn_count + ret;
3513 tkn_elem++;
3514 }
3515 tuple_size += (tkn_count * sizeof(*tkn_elem));
3516 tkn_count = 0;
3517 }
3518
3519 return off;
3520 }
3521
3522 /*
3523 * Parse manifest private data for tokens. The private data block is
3524 * preceded by descriptors for type and size of data block.
3525 */
skl_tplg_get_manifest_data(struct snd_soc_tplg_manifest * manifest,struct device * dev,struct skl_dev * skl)3526 static int skl_tplg_get_manifest_data(struct snd_soc_tplg_manifest *manifest,
3527 struct device *dev, struct skl_dev *skl)
3528 {
3529 struct snd_soc_tplg_vendor_array *array;
3530 int num_blocks, block_size = 0, block_type, off = 0;
3531 char *data;
3532 int ret;
3533
3534 /* Read the NUM_DATA_BLOCKS descriptor */
3535 array = (struct snd_soc_tplg_vendor_array *)manifest->priv.data;
3536 ret = skl_tplg_get_desc_blocks(dev, array);
3537 if (ret < 0)
3538 return ret;
3539 num_blocks = ret;
3540
3541 off += array->size;
3542 /* Read the BLOCK_TYPE and BLOCK_SIZE descriptor */
3543 while (num_blocks > 0) {
3544 array = (struct snd_soc_tplg_vendor_array *)
3545 (manifest->priv.data + off);
3546 ret = skl_tplg_get_desc_blocks(dev, array);
3547
3548 if (ret < 0)
3549 return ret;
3550 block_type = ret;
3551 off += array->size;
3552
3553 array = (struct snd_soc_tplg_vendor_array *)
3554 (manifest->priv.data + off);
3555
3556 ret = skl_tplg_get_desc_blocks(dev, array);
3557
3558 if (ret < 0)
3559 return ret;
3560 block_size = ret;
3561 off += array->size;
3562
3563 data = (manifest->priv.data + off);
3564
3565 if (block_type == SKL_TYPE_TUPLE) {
3566 ret = skl_tplg_get_manifest_tkn(dev, data, skl,
3567 block_size);
3568
3569 if (ret < 0)
3570 return ret;
3571
3572 --num_blocks;
3573 } else {
3574 return -EINVAL;
3575 }
3576 off += ret;
3577 }
3578
3579 return 0;
3580 }
3581
skl_manifest_load(struct snd_soc_component * cmpnt,int index,struct snd_soc_tplg_manifest * manifest)3582 static int skl_manifest_load(struct snd_soc_component *cmpnt, int index,
3583 struct snd_soc_tplg_manifest *manifest)
3584 {
3585 struct hdac_bus *bus = snd_soc_component_get_drvdata(cmpnt);
3586 struct skl_dev *skl = bus_to_skl(bus);
3587
3588 /* proceed only if we have private data defined */
3589 if (manifest->priv.size == 0)
3590 return 0;
3591
3592 skl_tplg_get_manifest_data(manifest, bus->dev, skl);
3593
3594 if (skl->lib_count > SKL_MAX_LIB) {
3595 dev_err(bus->dev, "Exceeding max Library count. Got:%d\n",
3596 skl->lib_count);
3597 return -EINVAL;
3598 }
3599
3600 return 0;
3601 }
3602
skl_tplg_complete(struct snd_soc_component * component)3603 static int skl_tplg_complete(struct snd_soc_component *component)
3604 {
3605 struct snd_soc_dobj *dobj;
3606 struct snd_soc_acpi_mach *mach;
3607 struct snd_ctl_elem_value *val;
3608 int i;
3609
3610 val = kmalloc(sizeof(*val), GFP_KERNEL);
3611 if (!val)
3612 return -ENOMEM;
3613
3614 mach = dev_get_platdata(component->card->dev);
3615 list_for_each_entry(dobj, &component->dobj_list, list) {
3616 struct snd_kcontrol *kcontrol = dobj->control.kcontrol;
3617 struct soc_enum *se;
3618 char **texts;
3619 char chan_text[4];
3620
3621 if (dobj->type != SND_SOC_DOBJ_ENUM || !kcontrol ||
3622 kcontrol->put != skl_tplg_multi_config_set_dmic)
3623 continue;
3624
3625 se = (struct soc_enum *)kcontrol->private_value;
3626 texts = dobj->control.dtexts;
3627 sprintf(chan_text, "c%d", mach->mach_params.dmic_num);
3628
3629 for (i = 0; i < se->items; i++) {
3630 if (strstr(texts[i], chan_text)) {
3631 memset(val, 0, sizeof(*val));
3632 val->value.enumerated.item[0] = i;
3633 kcontrol->put(kcontrol, val);
3634 }
3635 }
3636 }
3637
3638 kfree(val);
3639 return 0;
3640 }
3641
3642 static struct snd_soc_tplg_ops skl_tplg_ops = {
3643 .widget_load = skl_tplg_widget_load,
3644 .control_load = skl_tplg_control_load,
3645 .bytes_ext_ops = skl_tlv_ops,
3646 .bytes_ext_ops_count = ARRAY_SIZE(skl_tlv_ops),
3647 .io_ops = skl_tplg_kcontrol_ops,
3648 .io_ops_count = ARRAY_SIZE(skl_tplg_kcontrol_ops),
3649 .manifest = skl_manifest_load,
3650 .dai_load = skl_dai_load,
3651 .complete = skl_tplg_complete,
3652 };
3653
3654 /*
3655 * A pipe can have multiple modules, each of them will be a DAPM widget as
3656 * well. While managing a pipeline we need to get the list of all the
3657 * widgets in a pipelines, so this helper - skl_tplg_create_pipe_widget_list()
3658 * helps to get the SKL type widgets in that pipeline
3659 */
skl_tplg_create_pipe_widget_list(struct snd_soc_component * component)3660 static int skl_tplg_create_pipe_widget_list(struct snd_soc_component *component)
3661 {
3662 struct snd_soc_dapm_widget *w;
3663 struct skl_module_cfg *mcfg = NULL;
3664 struct skl_pipe_module *p_module = NULL;
3665 struct skl_pipe *pipe;
3666
3667 list_for_each_entry(w, &component->card->widgets, list) {
3668 if (is_skl_dsp_widget_type(w, component->dev) && w->priv) {
3669 mcfg = w->priv;
3670 pipe = mcfg->pipe;
3671
3672 p_module = devm_kzalloc(component->dev,
3673 sizeof(*p_module), GFP_KERNEL);
3674 if (!p_module)
3675 return -ENOMEM;
3676
3677 p_module->w = w;
3678 list_add_tail(&p_module->node, &pipe->w_list);
3679 }
3680 }
3681
3682 return 0;
3683 }
3684
skl_tplg_set_pipe_type(struct skl_dev * skl,struct skl_pipe * pipe)3685 static void skl_tplg_set_pipe_type(struct skl_dev *skl, struct skl_pipe *pipe)
3686 {
3687 struct skl_pipe_module *w_module;
3688 struct snd_soc_dapm_widget *w;
3689 struct skl_module_cfg *mconfig;
3690 bool host_found = false, link_found = false;
3691
3692 list_for_each_entry(w_module, &pipe->w_list, node) {
3693 w = w_module->w;
3694 mconfig = w->priv;
3695
3696 if (mconfig->dev_type == SKL_DEVICE_HDAHOST)
3697 host_found = true;
3698 else if (mconfig->dev_type != SKL_DEVICE_NONE)
3699 link_found = true;
3700 }
3701
3702 if (host_found && link_found)
3703 pipe->passthru = true;
3704 else
3705 pipe->passthru = false;
3706 }
3707
3708 /*
3709 * SKL topology init routine
3710 */
skl_tplg_init(struct snd_soc_component * component,struct hdac_bus * bus)3711 int skl_tplg_init(struct snd_soc_component *component, struct hdac_bus *bus)
3712 {
3713 int ret;
3714 const struct firmware *fw;
3715 struct skl_dev *skl = bus_to_skl(bus);
3716 struct skl_pipeline *ppl;
3717
3718 ret = request_firmware(&fw, skl->tplg_name, bus->dev);
3719 if (ret < 0) {
3720 char alt_tplg_name[64];
3721
3722 snprintf(alt_tplg_name, sizeof(alt_tplg_name), "%s-tplg.bin",
3723 skl->mach->drv_name);
3724 dev_info(bus->dev, "tplg fw %s load failed with %d, trying alternative tplg name %s",
3725 skl->tplg_name, ret, alt_tplg_name);
3726
3727 ret = request_firmware(&fw, alt_tplg_name, bus->dev);
3728 if (!ret)
3729 goto component_load;
3730
3731 dev_info(bus->dev, "tplg %s failed with %d, falling back to dfw_sst.bin",
3732 alt_tplg_name, ret);
3733
3734 ret = request_firmware(&fw, "dfw_sst.bin", bus->dev);
3735 if (ret < 0) {
3736 dev_err(bus->dev, "Fallback tplg fw %s load failed with %d\n",
3737 "dfw_sst.bin", ret);
3738 return ret;
3739 }
3740 }
3741
3742 component_load:
3743 ret = snd_soc_tplg_component_load(component, &skl_tplg_ops, fw);
3744 if (ret < 0) {
3745 dev_err(bus->dev, "tplg component load failed%d\n", ret);
3746 goto err;
3747 }
3748
3749 ret = skl_tplg_create_pipe_widget_list(component);
3750 if (ret < 0) {
3751 dev_err(bus->dev, "tplg create pipe widget list failed%d\n",
3752 ret);
3753 goto err;
3754 }
3755
3756 list_for_each_entry(ppl, &skl->ppl_list, node)
3757 skl_tplg_set_pipe_type(skl, ppl->pipe);
3758
3759 err:
3760 release_firmware(fw);
3761 return ret;
3762 }
3763
skl_tplg_exit(struct snd_soc_component * component,struct hdac_bus * bus)3764 void skl_tplg_exit(struct snd_soc_component *component, struct hdac_bus *bus)
3765 {
3766 struct skl_dev *skl = bus_to_skl(bus);
3767 struct skl_pipeline *ppl, *tmp;
3768
3769 list_for_each_entry_safe(ppl, tmp, &skl->ppl_list, node)
3770 list_del(&ppl->node);
3771
3772 /* clean up topology */
3773 snd_soc_tplg_component_remove(component);
3774 }
3775