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