1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
2 //
3 // This file is provided under a dual BSD/GPLv2 license. When using or
4 // redistributing this file, you may do so under either license.
5 //
6 // Copyright(c) 2021 Intel Corporation. All rights reserved.
7 //
8 //
9
10 #include <uapi/sound/sof/tokens.h>
11 #include <sound/pcm_params.h>
12 #include "sof-priv.h"
13 #include "sof-audio.h"
14 #include "ipc3-priv.h"
15 #include "ops.h"
16
17 /* Full volume for default values */
18 #define VOL_ZERO_DB BIT(VOLUME_FWL)
19
20 struct sof_widget_data {
21 int ctrl_type;
22 int ipc_cmd;
23 void *pdata;
24 size_t pdata_size;
25 struct snd_sof_control *control;
26 };
27
28 struct sof_process_types {
29 const char *name;
30 enum sof_ipc_process_type type;
31 enum sof_comp_type comp_type;
32 };
33
34 static const struct sof_process_types sof_process[] = {
35 {"EQFIR", SOF_PROCESS_EQFIR, SOF_COMP_EQ_FIR},
36 {"EQIIR", SOF_PROCESS_EQIIR, SOF_COMP_EQ_IIR},
37 {"KEYWORD_DETECT", SOF_PROCESS_KEYWORD_DETECT, SOF_COMP_KEYWORD_DETECT},
38 {"KPB", SOF_PROCESS_KPB, SOF_COMP_KPB},
39 {"CHAN_SELECTOR", SOF_PROCESS_CHAN_SELECTOR, SOF_COMP_SELECTOR},
40 {"MUX", SOF_PROCESS_MUX, SOF_COMP_MUX},
41 {"DEMUX", SOF_PROCESS_DEMUX, SOF_COMP_DEMUX},
42 {"DCBLOCK", SOF_PROCESS_DCBLOCK, SOF_COMP_DCBLOCK},
43 {"SMART_AMP", SOF_PROCESS_SMART_AMP, SOF_COMP_SMART_AMP},
44 };
45
find_process(const char * name)46 static enum sof_ipc_process_type find_process(const char *name)
47 {
48 int i;
49
50 for (i = 0; i < ARRAY_SIZE(sof_process); i++) {
51 if (strcmp(name, sof_process[i].name) == 0)
52 return sof_process[i].type;
53 }
54
55 return SOF_PROCESS_NONE;
56 }
57
get_token_process_type(void * elem,void * object,u32 offset)58 static int get_token_process_type(void *elem, void *object, u32 offset)
59 {
60 u32 *val = (u32 *)((u8 *)object + offset);
61
62 *val = find_process((const char *)elem);
63 return 0;
64 }
65
66 /* Buffers */
67 static const struct sof_topology_token buffer_tokens[] = {
68 {SOF_TKN_BUF_SIZE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
69 offsetof(struct sof_ipc_buffer, size)},
70 {SOF_TKN_BUF_CAPS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
71 offsetof(struct sof_ipc_buffer, caps)},
72 };
73
74 /* DAI */
75 static const struct sof_topology_token dai_tokens[] = {
76 {SOF_TKN_DAI_TYPE, SND_SOC_TPLG_TUPLE_TYPE_STRING, get_token_dai_type,
77 offsetof(struct sof_ipc_comp_dai, type)},
78 {SOF_TKN_DAI_INDEX, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
79 offsetof(struct sof_ipc_comp_dai, dai_index)},
80 {SOF_TKN_DAI_DIRECTION, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
81 offsetof(struct sof_ipc_comp_dai, direction)},
82 };
83
84 /* BE DAI link */
85 static const struct sof_topology_token dai_link_tokens[] = {
86 {SOF_TKN_DAI_TYPE, SND_SOC_TPLG_TUPLE_TYPE_STRING, get_token_dai_type,
87 offsetof(struct sof_ipc_dai_config, type)},
88 {SOF_TKN_DAI_INDEX, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
89 offsetof(struct sof_ipc_dai_config, dai_index)},
90 };
91
92 /* scheduling */
93 static const struct sof_topology_token sched_tokens[] = {
94 {SOF_TKN_SCHED_PERIOD, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
95 offsetof(struct sof_ipc_pipe_new, period)},
96 {SOF_TKN_SCHED_PRIORITY, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
97 offsetof(struct sof_ipc_pipe_new, priority)},
98 {SOF_TKN_SCHED_MIPS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
99 offsetof(struct sof_ipc_pipe_new, period_mips)},
100 {SOF_TKN_SCHED_CORE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
101 offsetof(struct sof_ipc_pipe_new, core)},
102 {SOF_TKN_SCHED_FRAMES, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
103 offsetof(struct sof_ipc_pipe_new, frames_per_sched)},
104 {SOF_TKN_SCHED_TIME_DOMAIN, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
105 offsetof(struct sof_ipc_pipe_new, time_domain)},
106 };
107
108 static const struct sof_topology_token pipeline_tokens[] = {
109 {SOF_TKN_SCHED_DYNAMIC_PIPELINE, SND_SOC_TPLG_TUPLE_TYPE_BOOL, get_token_u16,
110 offsetof(struct snd_sof_widget, dynamic_pipeline_widget)},
111
112 };
113
114 /* volume */
115 static const struct sof_topology_token volume_tokens[] = {
116 {SOF_TKN_VOLUME_RAMP_STEP_TYPE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
117 offsetof(struct sof_ipc_comp_volume, ramp)},
118 {SOF_TKN_VOLUME_RAMP_STEP_MS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
119 offsetof(struct sof_ipc_comp_volume, initial_ramp)},
120 };
121
122 /* SRC */
123 static const struct sof_topology_token src_tokens[] = {
124 {SOF_TKN_SRC_RATE_IN, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
125 offsetof(struct sof_ipc_comp_src, source_rate)},
126 {SOF_TKN_SRC_RATE_OUT, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
127 offsetof(struct sof_ipc_comp_src, sink_rate)},
128 };
129
130 /* ASRC */
131 static const struct sof_topology_token asrc_tokens[] = {
132 {SOF_TKN_ASRC_RATE_IN, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
133 offsetof(struct sof_ipc_comp_asrc, source_rate)},
134 {SOF_TKN_ASRC_RATE_OUT, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
135 offsetof(struct sof_ipc_comp_asrc, sink_rate)},
136 {SOF_TKN_ASRC_ASYNCHRONOUS_MODE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
137 offsetof(struct sof_ipc_comp_asrc, asynchronous_mode)},
138 {SOF_TKN_ASRC_OPERATION_MODE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
139 offsetof(struct sof_ipc_comp_asrc, operation_mode)},
140 };
141
142 /* EFFECT */
143 static const struct sof_topology_token process_tokens[] = {
144 {SOF_TKN_PROCESS_TYPE, SND_SOC_TPLG_TUPLE_TYPE_STRING, get_token_process_type,
145 offsetof(struct sof_ipc_comp_process, type)},
146 };
147
148 /* PCM */
149 static const struct sof_topology_token pcm_tokens[] = {
150 {SOF_TKN_PCM_DMAC_CONFIG, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
151 offsetof(struct sof_ipc_comp_host, dmac_config)},
152 };
153
154 /* Generic components */
155 static const struct sof_topology_token comp_tokens[] = {
156 {SOF_TKN_COMP_PERIOD_SINK_COUNT, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
157 offsetof(struct sof_ipc_comp_config, periods_sink)},
158 {SOF_TKN_COMP_PERIOD_SOURCE_COUNT, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
159 offsetof(struct sof_ipc_comp_config, periods_source)},
160 {SOF_TKN_COMP_FORMAT,
161 SND_SOC_TPLG_TUPLE_TYPE_STRING, get_token_comp_format,
162 offsetof(struct sof_ipc_comp_config, frame_fmt)},
163 };
164
165 /* SSP */
166 static const struct sof_topology_token ssp_tokens[] = {
167 {SOF_TKN_INTEL_SSP_CLKS_CONTROL, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
168 offsetof(struct sof_ipc_dai_ssp_params, clks_control)},
169 {SOF_TKN_INTEL_SSP_MCLK_ID, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
170 offsetof(struct sof_ipc_dai_ssp_params, mclk_id)},
171 {SOF_TKN_INTEL_SSP_SAMPLE_BITS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
172 offsetof(struct sof_ipc_dai_ssp_params, sample_valid_bits)},
173 {SOF_TKN_INTEL_SSP_FRAME_PULSE_WIDTH, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
174 offsetof(struct sof_ipc_dai_ssp_params, frame_pulse_width)},
175 {SOF_TKN_INTEL_SSP_QUIRKS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
176 offsetof(struct sof_ipc_dai_ssp_params, quirks)},
177 {SOF_TKN_INTEL_SSP_TDM_PADDING_PER_SLOT, SND_SOC_TPLG_TUPLE_TYPE_BOOL, get_token_u16,
178 offsetof(struct sof_ipc_dai_ssp_params, tdm_per_slot_padding_flag)},
179 {SOF_TKN_INTEL_SSP_BCLK_DELAY, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
180 offsetof(struct sof_ipc_dai_ssp_params, bclk_delay)},
181 };
182
183 /* ALH */
184 static const struct sof_topology_token alh_tokens[] = {
185 {SOF_TKN_INTEL_ALH_RATE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
186 offsetof(struct sof_ipc_dai_alh_params, rate)},
187 {SOF_TKN_INTEL_ALH_CH, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
188 offsetof(struct sof_ipc_dai_alh_params, channels)},
189 };
190
191 /* DMIC */
192 static const struct sof_topology_token dmic_tokens[] = {
193 {SOF_TKN_INTEL_DMIC_DRIVER_VERSION, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
194 offsetof(struct sof_ipc_dai_dmic_params, driver_ipc_version)},
195 {SOF_TKN_INTEL_DMIC_CLK_MIN, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
196 offsetof(struct sof_ipc_dai_dmic_params, pdmclk_min)},
197 {SOF_TKN_INTEL_DMIC_CLK_MAX, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
198 offsetof(struct sof_ipc_dai_dmic_params, pdmclk_max)},
199 {SOF_TKN_INTEL_DMIC_SAMPLE_RATE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
200 offsetof(struct sof_ipc_dai_dmic_params, fifo_fs)},
201 {SOF_TKN_INTEL_DMIC_DUTY_MIN, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
202 offsetof(struct sof_ipc_dai_dmic_params, duty_min)},
203 {SOF_TKN_INTEL_DMIC_DUTY_MAX, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
204 offsetof(struct sof_ipc_dai_dmic_params, duty_max)},
205 {SOF_TKN_INTEL_DMIC_NUM_PDM_ACTIVE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
206 offsetof(struct sof_ipc_dai_dmic_params, num_pdm_active)},
207 {SOF_TKN_INTEL_DMIC_FIFO_WORD_LENGTH, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
208 offsetof(struct sof_ipc_dai_dmic_params, fifo_bits)},
209 {SOF_TKN_INTEL_DMIC_UNMUTE_RAMP_TIME_MS, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
210 offsetof(struct sof_ipc_dai_dmic_params, unmute_ramp_time)},
211 };
212
213 /* ESAI */
214 static const struct sof_topology_token esai_tokens[] = {
215 {SOF_TKN_IMX_ESAI_MCLK_ID, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
216 offsetof(struct sof_ipc_dai_esai_params, mclk_id)},
217 };
218
219 /* SAI */
220 static const struct sof_topology_token sai_tokens[] = {
221 {SOF_TKN_IMX_SAI_MCLK_ID, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
222 offsetof(struct sof_ipc_dai_sai_params, mclk_id)},
223 };
224
225 /*
226 * DMIC PDM Tokens
227 * SOF_TKN_INTEL_DMIC_PDM_CTRL_ID should be the first token
228 * as it increments the index while parsing the array of pdm tokens
229 * and determines the correct offset
230 */
231 static const struct sof_topology_token dmic_pdm_tokens[] = {
232 {SOF_TKN_INTEL_DMIC_PDM_CTRL_ID, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
233 offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, id)},
234 {SOF_TKN_INTEL_DMIC_PDM_MIC_A_Enable, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
235 offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, enable_mic_a)},
236 {SOF_TKN_INTEL_DMIC_PDM_MIC_B_Enable, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
237 offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, enable_mic_b)},
238 {SOF_TKN_INTEL_DMIC_PDM_POLARITY_A, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
239 offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, polarity_mic_a)},
240 {SOF_TKN_INTEL_DMIC_PDM_POLARITY_B, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
241 offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, polarity_mic_b)},
242 {SOF_TKN_INTEL_DMIC_PDM_CLK_EDGE, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
243 offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, clk_edge)},
244 {SOF_TKN_INTEL_DMIC_PDM_SKEW, SND_SOC_TPLG_TUPLE_TYPE_SHORT, get_token_u16,
245 offsetof(struct sof_ipc_dai_dmic_pdm_ctrl, skew)},
246 };
247
248 /* HDA */
249 static const struct sof_topology_token hda_tokens[] = {
250 {SOF_TKN_INTEL_HDA_RATE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
251 offsetof(struct sof_ipc_dai_hda_params, rate)},
252 {SOF_TKN_INTEL_HDA_CH, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
253 offsetof(struct sof_ipc_dai_hda_params, channels)},
254 };
255
256 /* AFE */
257 static const struct sof_topology_token afe_tokens[] = {
258 {SOF_TKN_MEDIATEK_AFE_RATE, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
259 offsetof(struct sof_ipc_dai_mtk_afe_params, rate)},
260 {SOF_TKN_MEDIATEK_AFE_CH, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
261 offsetof(struct sof_ipc_dai_mtk_afe_params, channels)},
262 {SOF_TKN_MEDIATEK_AFE_FORMAT, SND_SOC_TPLG_TUPLE_TYPE_STRING, get_token_comp_format,
263 offsetof(struct sof_ipc_dai_mtk_afe_params, format)},
264 };
265
266 /* Core tokens */
267 static const struct sof_topology_token core_tokens[] = {
268 {SOF_TKN_COMP_CORE_ID, SND_SOC_TPLG_TUPLE_TYPE_WORD, get_token_u32,
269 offsetof(struct sof_ipc_comp, core)},
270 };
271
272 /* Component extended tokens */
273 static const struct sof_topology_token comp_ext_tokens[] = {
274 {SOF_TKN_COMP_UUID, SND_SOC_TPLG_TUPLE_TYPE_UUID, get_token_uuid,
275 offsetof(struct snd_sof_widget, uuid)},
276 };
277
278 static const struct sof_token_info ipc3_token_list[SOF_TOKEN_COUNT] = {
279 [SOF_PCM_TOKENS] = {"PCM tokens", pcm_tokens, ARRAY_SIZE(pcm_tokens)},
280 [SOF_PIPELINE_TOKENS] = {"Pipeline tokens", pipeline_tokens, ARRAY_SIZE(pipeline_tokens)},
281 [SOF_SCHED_TOKENS] = {"Scheduler tokens", sched_tokens, ARRAY_SIZE(sched_tokens)},
282 [SOF_COMP_TOKENS] = {"Comp tokens", comp_tokens, ARRAY_SIZE(comp_tokens)},
283 [SOF_CORE_TOKENS] = {"Core tokens", core_tokens, ARRAY_SIZE(core_tokens)},
284 [SOF_COMP_EXT_TOKENS] = {"AFE tokens", comp_ext_tokens, ARRAY_SIZE(comp_ext_tokens)},
285 [SOF_BUFFER_TOKENS] = {"Buffer tokens", buffer_tokens, ARRAY_SIZE(buffer_tokens)},
286 [SOF_VOLUME_TOKENS] = {"Volume tokens", volume_tokens, ARRAY_SIZE(volume_tokens)},
287 [SOF_SRC_TOKENS] = {"SRC tokens", src_tokens, ARRAY_SIZE(src_tokens)},
288 [SOF_ASRC_TOKENS] = {"ASRC tokens", asrc_tokens, ARRAY_SIZE(asrc_tokens)},
289 [SOF_PROCESS_TOKENS] = {"Process tokens", process_tokens, ARRAY_SIZE(process_tokens)},
290 [SOF_DAI_TOKENS] = {"DAI tokens", dai_tokens, ARRAY_SIZE(dai_tokens)},
291 [SOF_DAI_LINK_TOKENS] = {"DAI link tokens", dai_link_tokens, ARRAY_SIZE(dai_link_tokens)},
292 [SOF_HDA_TOKENS] = {"HDA tokens", hda_tokens, ARRAY_SIZE(hda_tokens)},
293 [SOF_SSP_TOKENS] = {"SSP tokens", ssp_tokens, ARRAY_SIZE(ssp_tokens)},
294 [SOF_ALH_TOKENS] = {"ALH tokens", alh_tokens, ARRAY_SIZE(alh_tokens)},
295 [SOF_DMIC_TOKENS] = {"DMIC tokens", dmic_tokens, ARRAY_SIZE(dmic_tokens)},
296 [SOF_DMIC_PDM_TOKENS] = {"DMIC PDM tokens", dmic_pdm_tokens, ARRAY_SIZE(dmic_pdm_tokens)},
297 [SOF_ESAI_TOKENS] = {"ESAI tokens", esai_tokens, ARRAY_SIZE(esai_tokens)},
298 [SOF_SAI_TOKENS] = {"SAI tokens", sai_tokens, ARRAY_SIZE(sai_tokens)},
299 [SOF_AFE_TOKENS] = {"AFE tokens", afe_tokens, ARRAY_SIZE(afe_tokens)},
300 };
301
302 /**
303 * sof_comp_alloc - allocate and initialize buffer for a new component
304 * @swidget: pointer to struct snd_sof_widget containing extended data
305 * @ipc_size: IPC payload size that will be updated depending on valid
306 * extended data.
307 * @index: ID of the pipeline the component belongs to
308 *
309 * Return: The pointer to the new allocated component, NULL if failed.
310 */
sof_comp_alloc(struct snd_sof_widget * swidget,size_t * ipc_size,int index)311 static void *sof_comp_alloc(struct snd_sof_widget *swidget, size_t *ipc_size,
312 int index)
313 {
314 struct sof_ipc_comp *comp;
315 size_t total_size = *ipc_size;
316 size_t ext_size = sizeof(swidget->uuid);
317
318 /* only non-zero UUID is valid */
319 if (!guid_is_null(&swidget->uuid))
320 total_size += ext_size;
321
322 comp = kzalloc(total_size, GFP_KERNEL);
323 if (!comp)
324 return NULL;
325
326 /* configure comp new IPC message */
327 comp->hdr.size = total_size;
328 comp->hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_COMP_NEW;
329 comp->id = swidget->comp_id;
330 comp->pipeline_id = index;
331 comp->core = swidget->core;
332
333 /* handle the extended data if needed */
334 if (total_size > *ipc_size) {
335 /* append extended data to the end of the component */
336 memcpy((u8 *)comp + *ipc_size, &swidget->uuid, ext_size);
337 comp->ext_data_length = ext_size;
338 }
339
340 /* update ipc_size and return */
341 *ipc_size = total_size;
342 return comp;
343 }
344
sof_dbg_comp_config(struct snd_soc_component * scomp,struct sof_ipc_comp_config * config)345 static void sof_dbg_comp_config(struct snd_soc_component *scomp, struct sof_ipc_comp_config *config)
346 {
347 dev_dbg(scomp->dev, " config: periods snk %d src %d fmt %d\n",
348 config->periods_sink, config->periods_source,
349 config->frame_fmt);
350 }
351
sof_ipc3_widget_setup_comp_host(struct snd_sof_widget * swidget)352 static int sof_ipc3_widget_setup_comp_host(struct snd_sof_widget *swidget)
353 {
354 struct snd_soc_component *scomp = swidget->scomp;
355 struct sof_ipc_comp_host *host;
356 size_t ipc_size = sizeof(*host);
357 int ret;
358
359 host = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
360 if (!host)
361 return -ENOMEM;
362 swidget->private = host;
363
364 /* configure host comp IPC message */
365 host->comp.type = SOF_COMP_HOST;
366 host->config.hdr.size = sizeof(host->config);
367
368 if (swidget->id == snd_soc_dapm_aif_out)
369 host->direction = SOF_IPC_STREAM_CAPTURE;
370 else
371 host->direction = SOF_IPC_STREAM_PLAYBACK;
372
373 /* parse one set of pcm_tokens */
374 ret = sof_update_ipc_object(scomp, host, SOF_PCM_TOKENS, swidget->tuples,
375 swidget->num_tuples, sizeof(*host), 1);
376 if (ret < 0)
377 goto err;
378
379 /* parse one set of comp_tokens */
380 ret = sof_update_ipc_object(scomp, &host->config, SOF_COMP_TOKENS, swidget->tuples,
381 swidget->num_tuples, sizeof(host->config), 1);
382 if (ret < 0)
383 goto err;
384
385 dev_dbg(scomp->dev, "loaded host %s\n", swidget->widget->name);
386 sof_dbg_comp_config(scomp, &host->config);
387
388 return 0;
389 err:
390 kfree(swidget->private);
391 swidget->private = NULL;
392
393 return ret;
394 }
395
sof_ipc3_widget_free_comp(struct snd_sof_widget * swidget)396 static void sof_ipc3_widget_free_comp(struct snd_sof_widget *swidget)
397 {
398 kfree(swidget->private);
399 }
400
sof_ipc3_widget_setup_comp_tone(struct snd_sof_widget * swidget)401 static int sof_ipc3_widget_setup_comp_tone(struct snd_sof_widget *swidget)
402 {
403 struct snd_soc_component *scomp = swidget->scomp;
404 struct sof_ipc_comp_tone *tone;
405 size_t ipc_size = sizeof(*tone);
406 int ret;
407
408 tone = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
409 if (!tone)
410 return -ENOMEM;
411
412 swidget->private = tone;
413
414 /* configure siggen IPC message */
415 tone->comp.type = SOF_COMP_TONE;
416 tone->config.hdr.size = sizeof(tone->config);
417
418 /* parse one set of comp tokens */
419 ret = sof_update_ipc_object(scomp, &tone->config, SOF_COMP_TOKENS, swidget->tuples,
420 swidget->num_tuples, sizeof(tone->config), 1);
421 if (ret < 0) {
422 kfree(swidget->private);
423 swidget->private = NULL;
424 return ret;
425 }
426
427 dev_dbg(scomp->dev, "tone %s: frequency %d amplitude %d\n",
428 swidget->widget->name, tone->frequency, tone->amplitude);
429 sof_dbg_comp_config(scomp, &tone->config);
430
431 return 0;
432 }
433
sof_ipc3_widget_setup_comp_mixer(struct snd_sof_widget * swidget)434 static int sof_ipc3_widget_setup_comp_mixer(struct snd_sof_widget *swidget)
435 {
436 struct snd_soc_component *scomp = swidget->scomp;
437 struct sof_ipc_comp_mixer *mixer;
438 size_t ipc_size = sizeof(*mixer);
439 int ret;
440
441 mixer = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
442 if (!mixer)
443 return -ENOMEM;
444
445 swidget->private = mixer;
446
447 /* configure mixer IPC message */
448 mixer->comp.type = SOF_COMP_MIXER;
449 mixer->config.hdr.size = sizeof(mixer->config);
450
451 /* parse one set of comp tokens */
452 ret = sof_update_ipc_object(scomp, &mixer->config, SOF_COMP_TOKENS,
453 swidget->tuples, swidget->num_tuples,
454 sizeof(mixer->config), 1);
455 if (ret < 0) {
456 kfree(swidget->private);
457 swidget->private = NULL;
458
459 return ret;
460 }
461
462 dev_dbg(scomp->dev, "loaded mixer %s\n", swidget->widget->name);
463 sof_dbg_comp_config(scomp, &mixer->config);
464
465 return 0;
466 }
467
sof_ipc3_widget_setup_comp_pipeline(struct snd_sof_widget * swidget)468 static int sof_ipc3_widget_setup_comp_pipeline(struct snd_sof_widget *swidget)
469 {
470 struct snd_soc_component *scomp = swidget->scomp;
471 struct sof_ipc_pipe_new *pipeline;
472 struct snd_sof_widget *comp_swidget;
473 int ret;
474
475 pipeline = kzalloc(sizeof(*pipeline), GFP_KERNEL);
476 if (!pipeline)
477 return -ENOMEM;
478
479 /* configure pipeline IPC message */
480 pipeline->hdr.size = sizeof(*pipeline);
481 pipeline->hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_PIPE_NEW;
482 pipeline->pipeline_id = swidget->pipeline_id;
483 pipeline->comp_id = swidget->comp_id;
484
485 swidget->private = pipeline;
486
487 /* component at start of pipeline is our stream id */
488 comp_swidget = snd_sof_find_swidget(scomp, swidget->widget->sname);
489 if (!comp_swidget) {
490 dev_err(scomp->dev, "scheduler %s refers to non existent widget %s\n",
491 swidget->widget->name, swidget->widget->sname);
492 ret = -EINVAL;
493 goto err;
494 }
495
496 pipeline->sched_id = comp_swidget->comp_id;
497
498 /* parse one set of scheduler tokens */
499 ret = sof_update_ipc_object(scomp, pipeline, SOF_SCHED_TOKENS, swidget->tuples,
500 swidget->num_tuples, sizeof(*pipeline), 1);
501 if (ret < 0)
502 goto err;
503
504 /* parse one set of pipeline tokens */
505 ret = sof_update_ipc_object(scomp, swidget, SOF_PIPELINE_TOKENS, swidget->tuples,
506 swidget->num_tuples, sizeof(*swidget), 1);
507 if (ret < 0)
508 goto err;
509
510 if (sof_debug_check_flag(SOF_DBG_DISABLE_MULTICORE))
511 pipeline->core = SOF_DSP_PRIMARY_CORE;
512
513 if (sof_debug_check_flag(SOF_DBG_DYNAMIC_PIPELINES_OVERRIDE))
514 swidget->dynamic_pipeline_widget =
515 sof_debug_check_flag(SOF_DBG_DYNAMIC_PIPELINES_ENABLE);
516
517 dev_dbg(scomp->dev, "pipeline %s: period %d pri %d mips %d core %d frames %d dynamic %d\n",
518 swidget->widget->name, pipeline->period, pipeline->priority,
519 pipeline->period_mips, pipeline->core, pipeline->frames_per_sched,
520 swidget->dynamic_pipeline_widget);
521
522 swidget->core = pipeline->core;
523
524 return 0;
525
526 err:
527 kfree(swidget->private);
528 swidget->private = NULL;
529
530 return ret;
531 }
532
sof_ipc3_widget_setup_comp_buffer(struct snd_sof_widget * swidget)533 static int sof_ipc3_widget_setup_comp_buffer(struct snd_sof_widget *swidget)
534 {
535 struct snd_soc_component *scomp = swidget->scomp;
536 struct sof_ipc_buffer *buffer;
537 int ret;
538
539 buffer = kzalloc(sizeof(*buffer), GFP_KERNEL);
540 if (!buffer)
541 return -ENOMEM;
542
543 swidget->private = buffer;
544
545 /* configure dai IPC message */
546 buffer->comp.hdr.size = sizeof(*buffer);
547 buffer->comp.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_BUFFER_NEW;
548 buffer->comp.id = swidget->comp_id;
549 buffer->comp.type = SOF_COMP_BUFFER;
550 buffer->comp.pipeline_id = swidget->pipeline_id;
551 buffer->comp.core = swidget->core;
552
553 /* parse one set of buffer tokens */
554 ret = sof_update_ipc_object(scomp, buffer, SOF_BUFFER_TOKENS, swidget->tuples,
555 swidget->num_tuples, sizeof(*buffer), 1);
556 if (ret < 0) {
557 kfree(swidget->private);
558 swidget->private = NULL;
559 return ret;
560 }
561
562 dev_dbg(scomp->dev, "buffer %s: size %d caps 0x%x\n",
563 swidget->widget->name, buffer->size, buffer->caps);
564
565 return 0;
566 }
567
sof_ipc3_widget_setup_comp_src(struct snd_sof_widget * swidget)568 static int sof_ipc3_widget_setup_comp_src(struct snd_sof_widget *swidget)
569 {
570 struct snd_soc_component *scomp = swidget->scomp;
571 struct sof_ipc_comp_src *src;
572 size_t ipc_size = sizeof(*src);
573 int ret;
574
575 src = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
576 if (!src)
577 return -ENOMEM;
578
579 swidget->private = src;
580
581 /* configure src IPC message */
582 src->comp.type = SOF_COMP_SRC;
583 src->config.hdr.size = sizeof(src->config);
584
585 /* parse one set of src tokens */
586 ret = sof_update_ipc_object(scomp, src, SOF_SRC_TOKENS, swidget->tuples,
587 swidget->num_tuples, sizeof(*src), 1);
588 if (ret < 0)
589 goto err;
590
591 /* parse one set of comp tokens */
592 ret = sof_update_ipc_object(scomp, &src->config, SOF_COMP_TOKENS,
593 swidget->tuples, swidget->num_tuples, sizeof(src->config), 1);
594 if (ret < 0)
595 goto err;
596
597 dev_dbg(scomp->dev, "src %s: source rate %d sink rate %d\n",
598 swidget->widget->name, src->source_rate, src->sink_rate);
599 sof_dbg_comp_config(scomp, &src->config);
600
601 return 0;
602 err:
603 kfree(swidget->private);
604 swidget->private = NULL;
605
606 return ret;
607 }
608
sof_ipc3_widget_setup_comp_asrc(struct snd_sof_widget * swidget)609 static int sof_ipc3_widget_setup_comp_asrc(struct snd_sof_widget *swidget)
610 {
611 struct snd_soc_component *scomp = swidget->scomp;
612 struct sof_ipc_comp_asrc *asrc;
613 size_t ipc_size = sizeof(*asrc);
614 int ret;
615
616 asrc = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
617 if (!asrc)
618 return -ENOMEM;
619
620 swidget->private = asrc;
621
622 /* configure ASRC IPC message */
623 asrc->comp.type = SOF_COMP_ASRC;
624 asrc->config.hdr.size = sizeof(asrc->config);
625
626 /* parse one set of asrc tokens */
627 ret = sof_update_ipc_object(scomp, asrc, SOF_ASRC_TOKENS, swidget->tuples,
628 swidget->num_tuples, sizeof(*asrc), 1);
629 if (ret < 0)
630 goto err;
631
632 /* parse one set of comp tokens */
633 ret = sof_update_ipc_object(scomp, &asrc->config, SOF_COMP_TOKENS,
634 swidget->tuples, swidget->num_tuples, sizeof(asrc->config), 1);
635 if (ret < 0)
636 goto err;
637
638 dev_dbg(scomp->dev, "asrc %s: source rate %d sink rate %d asynch %d operation %d\n",
639 swidget->widget->name, asrc->source_rate, asrc->sink_rate,
640 asrc->asynchronous_mode, asrc->operation_mode);
641
642 sof_dbg_comp_config(scomp, &asrc->config);
643
644 return 0;
645 err:
646 kfree(swidget->private);
647 swidget->private = NULL;
648
649 return ret;
650 }
651
652 /*
653 * Mux topology
654 */
sof_ipc3_widget_setup_comp_mux(struct snd_sof_widget * swidget)655 static int sof_ipc3_widget_setup_comp_mux(struct snd_sof_widget *swidget)
656 {
657 struct snd_soc_component *scomp = swidget->scomp;
658 struct sof_ipc_comp_mux *mux;
659 size_t ipc_size = sizeof(*mux);
660 int ret;
661
662 mux = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
663 if (!mux)
664 return -ENOMEM;
665
666 swidget->private = mux;
667
668 /* configure mux IPC message */
669 mux->comp.type = SOF_COMP_MUX;
670 mux->config.hdr.size = sizeof(mux->config);
671
672 /* parse one set of comp tokens */
673 ret = sof_update_ipc_object(scomp, &mux->config, SOF_COMP_TOKENS,
674 swidget->tuples, swidget->num_tuples, sizeof(mux->config), 1);
675 if (ret < 0) {
676 kfree(swidget->private);
677 swidget->private = NULL;
678 return ret;
679 }
680
681 dev_dbg(scomp->dev, "loaded mux %s\n", swidget->widget->name);
682 sof_dbg_comp_config(scomp, &mux->config);
683
684 return 0;
685 }
686
687 /*
688 * PGA Topology
689 */
690
sof_ipc3_widget_setup_comp_pga(struct snd_sof_widget * swidget)691 static int sof_ipc3_widget_setup_comp_pga(struct snd_sof_widget *swidget)
692 {
693 struct snd_soc_component *scomp = swidget->scomp;
694 struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
695 struct sof_ipc_comp_volume *volume;
696 struct snd_sof_control *scontrol;
697 size_t ipc_size = sizeof(*volume);
698 int min_step, max_step;
699 int ret;
700
701 volume = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
702 if (!volume)
703 return -ENOMEM;
704
705 swidget->private = volume;
706
707 /* configure volume IPC message */
708 volume->comp.type = SOF_COMP_VOLUME;
709 volume->config.hdr.size = sizeof(volume->config);
710
711 /* parse one set of volume tokens */
712 ret = sof_update_ipc_object(scomp, volume, SOF_VOLUME_TOKENS, swidget->tuples,
713 swidget->num_tuples, sizeof(*volume), 1);
714 if (ret < 0)
715 goto err;
716
717 /* parse one set of comp tokens */
718 ret = sof_update_ipc_object(scomp, &volume->config, SOF_COMP_TOKENS,
719 swidget->tuples, swidget->num_tuples,
720 sizeof(volume->config), 1);
721 if (ret < 0)
722 goto err;
723
724 dev_dbg(scomp->dev, "loaded PGA %s\n", swidget->widget->name);
725 sof_dbg_comp_config(scomp, &volume->config);
726
727 list_for_each_entry(scontrol, &sdev->kcontrol_list, list) {
728 if (scontrol->comp_id == swidget->comp_id &&
729 scontrol->volume_table) {
730 min_step = scontrol->min_volume_step;
731 max_step = scontrol->max_volume_step;
732 volume->min_value = scontrol->volume_table[min_step];
733 volume->max_value = scontrol->volume_table[max_step];
734 volume->channels = scontrol->num_channels;
735 break;
736 }
737 }
738
739 return 0;
740 err:
741 kfree(swidget->private);
742 swidget->private = NULL;
743
744 return ret;
745 }
746
sof_get_control_data(struct snd_soc_component * scomp,struct snd_soc_dapm_widget * widget,struct sof_widget_data * wdata,size_t * size)747 static int sof_get_control_data(struct snd_soc_component *scomp,
748 struct snd_soc_dapm_widget *widget,
749 struct sof_widget_data *wdata, size_t *size)
750 {
751 const struct snd_kcontrol_new *kc;
752 struct sof_ipc_ctrl_data *cdata;
753 struct soc_mixer_control *sm;
754 struct soc_bytes_ext *sbe;
755 struct soc_enum *se;
756 int i;
757
758 *size = 0;
759
760 for (i = 0; i < widget->num_kcontrols; i++) {
761 kc = &widget->kcontrol_news[i];
762
763 switch (widget->dobj.widget.kcontrol_type[i]) {
764 case SND_SOC_TPLG_TYPE_MIXER:
765 sm = (struct soc_mixer_control *)kc->private_value;
766 wdata[i].control = sm->dobj.private;
767 break;
768 case SND_SOC_TPLG_TYPE_BYTES:
769 sbe = (struct soc_bytes_ext *)kc->private_value;
770 wdata[i].control = sbe->dobj.private;
771 break;
772 case SND_SOC_TPLG_TYPE_ENUM:
773 se = (struct soc_enum *)kc->private_value;
774 wdata[i].control = se->dobj.private;
775 break;
776 default:
777 dev_err(scomp->dev, "Unknown kcontrol type %u in widget %s\n",
778 widget->dobj.widget.kcontrol_type[i], widget->name);
779 return -EINVAL;
780 }
781
782 if (!wdata[i].control) {
783 dev_err(scomp->dev, "No scontrol for widget %s\n", widget->name);
784 return -EINVAL;
785 }
786
787 cdata = wdata[i].control->ipc_control_data;
788
789 if (widget->dobj.widget.kcontrol_type[i] == SND_SOC_TPLG_TYPE_BYTES) {
790 /* make sure data is valid - data can be updated at runtime */
791 if (cdata->data->magic != SOF_ABI_MAGIC)
792 return -EINVAL;
793
794 wdata[i].pdata = cdata->data->data;
795 wdata[i].pdata_size = cdata->data->size;
796 } else {
797 /* points to the control data union */
798 wdata[i].pdata = cdata->chanv;
799 /*
800 * wdata[i].control->size is calculated with struct_size
801 * and includes the size of struct sof_ipc_ctrl_data
802 */
803 wdata[i].pdata_size = wdata[i].control->size -
804 sizeof(struct sof_ipc_ctrl_data);
805 }
806
807 *size += wdata[i].pdata_size;
808
809 /* get data type */
810 switch (cdata->cmd) {
811 case SOF_CTRL_CMD_VOLUME:
812 case SOF_CTRL_CMD_ENUM:
813 case SOF_CTRL_CMD_SWITCH:
814 wdata[i].ipc_cmd = SOF_IPC_COMP_SET_VALUE;
815 wdata[i].ctrl_type = SOF_CTRL_TYPE_VALUE_CHAN_SET;
816 break;
817 case SOF_CTRL_CMD_BINARY:
818 wdata[i].ipc_cmd = SOF_IPC_COMP_SET_DATA;
819 wdata[i].ctrl_type = SOF_CTRL_TYPE_DATA_SET;
820 break;
821 default:
822 break;
823 }
824 }
825
826 return 0;
827 }
828
sof_process_load(struct snd_soc_component * scomp,struct snd_sof_widget * swidget,int type)829 static int sof_process_load(struct snd_soc_component *scomp,
830 struct snd_sof_widget *swidget, int type)
831 {
832 struct snd_soc_dapm_widget *widget = swidget->widget;
833 struct sof_ipc_comp_process *process;
834 struct sof_widget_data *wdata = NULL;
835 size_t ipc_data_size = 0;
836 size_t ipc_size;
837 int offset = 0;
838 int ret;
839 int i;
840
841 /* allocate struct for widget control data sizes and types */
842 if (widget->num_kcontrols) {
843 wdata = kcalloc(widget->num_kcontrols, sizeof(*wdata), GFP_KERNEL);
844 if (!wdata)
845 return -ENOMEM;
846
847 /* get possible component controls and get size of all pdata */
848 ret = sof_get_control_data(scomp, widget, wdata, &ipc_data_size);
849 if (ret < 0)
850 goto out;
851 }
852
853 ipc_size = sizeof(struct sof_ipc_comp_process) + ipc_data_size;
854
855 /* we are exceeding max ipc size, config needs to be sent separately */
856 if (ipc_size > SOF_IPC_MSG_MAX_SIZE) {
857 ipc_size -= ipc_data_size;
858 ipc_data_size = 0;
859 }
860
861 process = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
862 if (!process) {
863 ret = -ENOMEM;
864 goto out;
865 }
866
867 swidget->private = process;
868
869 /* configure iir IPC message */
870 process->comp.type = type;
871 process->config.hdr.size = sizeof(process->config);
872
873 /* parse one set of comp tokens */
874 ret = sof_update_ipc_object(scomp, &process->config, SOF_COMP_TOKENS,
875 swidget->tuples, swidget->num_tuples,
876 sizeof(process->config), 1);
877 if (ret < 0)
878 goto err;
879
880 dev_dbg(scomp->dev, "loaded process %s\n", swidget->widget->name);
881 sof_dbg_comp_config(scomp, &process->config);
882
883 /*
884 * found private data in control, so copy it.
885 * get possible component controls - get size of all pdata,
886 * then memcpy with headers
887 */
888 if (ipc_data_size) {
889 for (i = 0; i < widget->num_kcontrols; i++) {
890 if (!wdata[i].pdata_size)
891 continue;
892
893 memcpy(&process->data[offset], wdata[i].pdata,
894 wdata[i].pdata_size);
895 offset += wdata[i].pdata_size;
896 }
897 }
898
899 process->size = ipc_data_size;
900
901 kfree(wdata);
902
903 return 0;
904 err:
905 kfree(swidget->private);
906 swidget->private = NULL;
907 out:
908 kfree(wdata);
909 return ret;
910 }
911
find_process_comp_type(enum sof_ipc_process_type type)912 static enum sof_comp_type find_process_comp_type(enum sof_ipc_process_type type)
913 {
914 int i;
915
916 for (i = 0; i < ARRAY_SIZE(sof_process); i++) {
917 if (sof_process[i].type == type)
918 return sof_process[i].comp_type;
919 }
920
921 return SOF_COMP_NONE;
922 }
923
924 /*
925 * Processing Component Topology - can be "effect", "codec", or general
926 * "processing".
927 */
928
sof_widget_update_ipc_comp_process(struct snd_sof_widget * swidget)929 static int sof_widget_update_ipc_comp_process(struct snd_sof_widget *swidget)
930 {
931 struct snd_soc_component *scomp = swidget->scomp;
932 struct sof_ipc_comp_process config;
933 int ret;
934
935 memset(&config, 0, sizeof(config));
936 config.comp.core = swidget->core;
937
938 /* parse one set of process tokens */
939 ret = sof_update_ipc_object(scomp, &config, SOF_PROCESS_TOKENS, swidget->tuples,
940 swidget->num_tuples, sizeof(config), 1);
941 if (ret < 0)
942 return ret;
943
944 /* now load process specific data and send IPC */
945 return sof_process_load(scomp, swidget, find_process_comp_type(config.type));
946 }
947
sof_link_hda_load(struct snd_soc_component * scomp,struct snd_sof_dai_link * slink,struct sof_ipc_dai_config * config,struct snd_sof_dai * dai)948 static int sof_link_hda_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
949 struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
950 {
951 struct sof_dai_private_data *private = dai->private;
952 u32 size = sizeof(*config);
953 int ret;
954
955 /* init IPC */
956 memset(&config->hda, 0, sizeof(config->hda));
957 config->hdr.size = size;
958
959 /* parse one set of HDA tokens */
960 ret = sof_update_ipc_object(scomp, &config->hda, SOF_HDA_TOKENS, slink->tuples,
961 slink->num_tuples, size, 1);
962 if (ret < 0)
963 return ret;
964
965 dev_dbg(scomp->dev, "HDA config rate %d channels %d\n",
966 config->hda.rate, config->hda.channels);
967
968 config->hda.link_dma_ch = DMA_CHAN_INVALID;
969
970 dai->number_configs = 1;
971 dai->current_config = 0;
972 private->dai_config = kmemdup(config, size, GFP_KERNEL);
973 if (!private->dai_config)
974 return -ENOMEM;
975
976 return 0;
977 }
978
sof_dai_set_format(struct snd_soc_tplg_hw_config * hw_config,struct sof_ipc_dai_config * config)979 static void sof_dai_set_format(struct snd_soc_tplg_hw_config *hw_config,
980 struct sof_ipc_dai_config *config)
981 {
982 /* clock directions wrt codec */
983 config->format &= ~SOF_DAI_FMT_CLOCK_PROVIDER_MASK;
984 if (hw_config->bclk_provider == SND_SOC_TPLG_BCLK_CP) {
985 /* codec is bclk provider */
986 if (hw_config->fsync_provider == SND_SOC_TPLG_FSYNC_CP)
987 config->format |= SOF_DAI_FMT_CBP_CFP;
988 else
989 config->format |= SOF_DAI_FMT_CBP_CFC;
990 } else {
991 /* codec is bclk consumer */
992 if (hw_config->fsync_provider == SND_SOC_TPLG_FSYNC_CP)
993 config->format |= SOF_DAI_FMT_CBC_CFP;
994 else
995 config->format |= SOF_DAI_FMT_CBC_CFC;
996 }
997
998 /* inverted clocks ? */
999 config->format &= ~SOF_DAI_FMT_INV_MASK;
1000 if (hw_config->invert_bclk) {
1001 if (hw_config->invert_fsync)
1002 config->format |= SOF_DAI_FMT_IB_IF;
1003 else
1004 config->format |= SOF_DAI_FMT_IB_NF;
1005 } else {
1006 if (hw_config->invert_fsync)
1007 config->format |= SOF_DAI_FMT_NB_IF;
1008 else
1009 config->format |= SOF_DAI_FMT_NB_NF;
1010 }
1011 }
1012
sof_link_sai_load(struct snd_soc_component * scomp,struct snd_sof_dai_link * slink,struct sof_ipc_dai_config * config,struct snd_sof_dai * dai)1013 static int sof_link_sai_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
1014 struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
1015 {
1016 struct snd_soc_tplg_hw_config *hw_config = slink->hw_configs;
1017 struct sof_dai_private_data *private = dai->private;
1018 u32 size = sizeof(*config);
1019 int ret;
1020
1021 /* handle master/slave and inverted clocks */
1022 sof_dai_set_format(hw_config, config);
1023
1024 /* init IPC */
1025 memset(&config->sai, 0, sizeof(config->sai));
1026 config->hdr.size = size;
1027
1028 /* parse one set of SAI tokens */
1029 ret = sof_update_ipc_object(scomp, &config->sai, SOF_SAI_TOKENS, slink->tuples,
1030 slink->num_tuples, size, 1);
1031 if (ret < 0)
1032 return ret;
1033
1034 config->sai.mclk_rate = le32_to_cpu(hw_config->mclk_rate);
1035 config->sai.bclk_rate = le32_to_cpu(hw_config->bclk_rate);
1036 config->sai.fsync_rate = le32_to_cpu(hw_config->fsync_rate);
1037 config->sai.mclk_direction = hw_config->mclk_direction;
1038
1039 config->sai.tdm_slots = le32_to_cpu(hw_config->tdm_slots);
1040 config->sai.tdm_slot_width = le32_to_cpu(hw_config->tdm_slot_width);
1041 config->sai.rx_slots = le32_to_cpu(hw_config->rx_slots);
1042 config->sai.tx_slots = le32_to_cpu(hw_config->tx_slots);
1043
1044 dev_info(scomp->dev,
1045 "tplg: config SAI%d fmt 0x%x mclk %d width %d slots %d mclk id %d\n",
1046 config->dai_index, config->format,
1047 config->sai.mclk_rate, config->sai.tdm_slot_width,
1048 config->sai.tdm_slots, config->sai.mclk_id);
1049
1050 if (config->sai.tdm_slots < 1 || config->sai.tdm_slots > 8) {
1051 dev_err(scomp->dev, "Invalid channel count for SAI%d\n", config->dai_index);
1052 return -EINVAL;
1053 }
1054
1055 dai->number_configs = 1;
1056 dai->current_config = 0;
1057 private->dai_config = kmemdup(config, size, GFP_KERNEL);
1058 if (!private->dai_config)
1059 return -ENOMEM;
1060
1061 return 0;
1062 }
1063
sof_link_esai_load(struct snd_soc_component * scomp,struct snd_sof_dai_link * slink,struct sof_ipc_dai_config * config,struct snd_sof_dai * dai)1064 static int sof_link_esai_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
1065 struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
1066 {
1067 struct snd_soc_tplg_hw_config *hw_config = slink->hw_configs;
1068 struct sof_dai_private_data *private = dai->private;
1069 u32 size = sizeof(*config);
1070 int ret;
1071
1072 /* handle master/slave and inverted clocks */
1073 sof_dai_set_format(hw_config, config);
1074
1075 /* init IPC */
1076 memset(&config->esai, 0, sizeof(config->esai));
1077 config->hdr.size = size;
1078
1079 /* parse one set of ESAI tokens */
1080 ret = sof_update_ipc_object(scomp, &config->esai, SOF_ESAI_TOKENS, slink->tuples,
1081 slink->num_tuples, size, 1);
1082 if (ret < 0)
1083 return ret;
1084
1085 config->esai.mclk_rate = le32_to_cpu(hw_config->mclk_rate);
1086 config->esai.bclk_rate = le32_to_cpu(hw_config->bclk_rate);
1087 config->esai.fsync_rate = le32_to_cpu(hw_config->fsync_rate);
1088 config->esai.mclk_direction = hw_config->mclk_direction;
1089 config->esai.tdm_slots = le32_to_cpu(hw_config->tdm_slots);
1090 config->esai.tdm_slot_width = le32_to_cpu(hw_config->tdm_slot_width);
1091 config->esai.rx_slots = le32_to_cpu(hw_config->rx_slots);
1092 config->esai.tx_slots = le32_to_cpu(hw_config->tx_slots);
1093
1094 dev_info(scomp->dev,
1095 "tplg: config ESAI%d fmt 0x%x mclk %d width %d slots %d mclk id %d\n",
1096 config->dai_index, config->format,
1097 config->esai.mclk_rate, config->esai.tdm_slot_width,
1098 config->esai.tdm_slots, config->esai.mclk_id);
1099
1100 if (config->esai.tdm_slots < 1 || config->esai.tdm_slots > 8) {
1101 dev_err(scomp->dev, "Invalid channel count for ESAI%d\n", config->dai_index);
1102 return -EINVAL;
1103 }
1104
1105 dai->number_configs = 1;
1106 dai->current_config = 0;
1107 private->dai_config = kmemdup(config, size, GFP_KERNEL);
1108 if (!private->dai_config)
1109 return -ENOMEM;
1110
1111 return 0;
1112 }
1113
sof_link_acp_dmic_load(struct snd_soc_component * scomp,struct snd_sof_dai_link * slink,struct sof_ipc_dai_config * config,struct snd_sof_dai * dai)1114 static int sof_link_acp_dmic_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
1115 struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
1116 {
1117 struct snd_soc_tplg_hw_config *hw_config = slink->hw_configs;
1118 struct sof_dai_private_data *private = dai->private;
1119 u32 size = sizeof(*config);
1120
1121 /* handle master/slave and inverted clocks */
1122 sof_dai_set_format(hw_config, config);
1123
1124 /* init IPC */
1125 memset(&config->acpdmic, 0, sizeof(config->acpdmic));
1126 config->hdr.size = size;
1127
1128 config->acpdmic.fsync_rate = le32_to_cpu(hw_config->fsync_rate);
1129 config->acpdmic.tdm_slots = le32_to_cpu(hw_config->tdm_slots);
1130
1131 dev_info(scomp->dev, "ACP_DMIC config ACP%d channel %d rate %d\n",
1132 config->dai_index, config->acpdmic.tdm_slots,
1133 config->acpdmic.fsync_rate);
1134
1135 dai->number_configs = 1;
1136 dai->current_config = 0;
1137 private->dai_config = kmemdup(config, size, GFP_KERNEL);
1138 if (!private->dai_config)
1139 return -ENOMEM;
1140
1141 return 0;
1142 }
1143
sof_link_acp_bt_load(struct snd_soc_component * scomp,struct snd_sof_dai_link * slink,struct sof_ipc_dai_config * config,struct snd_sof_dai * dai)1144 static int sof_link_acp_bt_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
1145 struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
1146 {
1147 struct snd_soc_tplg_hw_config *hw_config = slink->hw_configs;
1148 struct sof_dai_private_data *private = dai->private;
1149 u32 size = sizeof(*config);
1150
1151 /* handle master/slave and inverted clocks */
1152 sof_dai_set_format(hw_config, config);
1153
1154 /* init IPC */
1155 memset(&config->acpbt, 0, sizeof(config->acpbt));
1156 config->hdr.size = size;
1157
1158 config->acpbt.fsync_rate = le32_to_cpu(hw_config->fsync_rate);
1159 config->acpbt.tdm_slots = le32_to_cpu(hw_config->tdm_slots);
1160
1161 dev_info(scomp->dev, "ACP_BT config ACP%d channel %d rate %d\n",
1162 config->dai_index, config->acpbt.tdm_slots,
1163 config->acpbt.fsync_rate);
1164
1165 dai->number_configs = 1;
1166 dai->current_config = 0;
1167 private->dai_config = kmemdup(config, size, GFP_KERNEL);
1168 if (!private->dai_config)
1169 return -ENOMEM;
1170
1171 return 0;
1172 }
1173
sof_link_acp_sp_load(struct snd_soc_component * scomp,struct snd_sof_dai_link * slink,struct sof_ipc_dai_config * config,struct snd_sof_dai * dai)1174 static int sof_link_acp_sp_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
1175 struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
1176 {
1177 struct snd_soc_tplg_hw_config *hw_config = slink->hw_configs;
1178 struct sof_dai_private_data *private = dai->private;
1179 u32 size = sizeof(*config);
1180
1181 /* handle master/slave and inverted clocks */
1182 sof_dai_set_format(hw_config, config);
1183
1184 /* init IPC */
1185 memset(&config->acpsp, 0, sizeof(config->acpsp));
1186 config->hdr.size = size;
1187
1188 config->acpsp.fsync_rate = le32_to_cpu(hw_config->fsync_rate);
1189 config->acpsp.tdm_slots = le32_to_cpu(hw_config->tdm_slots);
1190
1191 dev_info(scomp->dev, "ACP_SP config ACP%d channel %d rate %d\n",
1192 config->dai_index, config->acpsp.tdm_slots,
1193 config->acpsp.fsync_rate);
1194
1195 dai->number_configs = 1;
1196 dai->current_config = 0;
1197 private->dai_config = kmemdup(config, size, GFP_KERNEL);
1198 if (!private->dai_config)
1199 return -ENOMEM;
1200
1201 return 0;
1202 }
1203
sof_link_afe_load(struct snd_soc_component * scomp,struct snd_sof_dai_link * slink,struct sof_ipc_dai_config * config,struct snd_sof_dai * dai)1204 static int sof_link_afe_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
1205 struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
1206 {
1207 struct sof_dai_private_data *private = dai->private;
1208 u32 size = sizeof(*config);
1209 int ret;
1210
1211 config->hdr.size = size;
1212
1213 /* parse the required set of AFE tokens based on num_hw_cfgs */
1214 ret = sof_update_ipc_object(scomp, &config->afe, SOF_AFE_TOKENS, slink->tuples,
1215 slink->num_tuples, size, slink->num_hw_configs);
1216 if (ret < 0)
1217 return ret;
1218
1219 dev_dbg(scomp->dev, "AFE config rate %d channels %d format:%d\n",
1220 config->afe.rate, config->afe.channels, config->afe.format);
1221
1222 config->afe.stream_id = DMA_CHAN_INVALID;
1223
1224 dai->number_configs = 1;
1225 dai->current_config = 0;
1226 private->dai_config = kmemdup(config, size, GFP_KERNEL);
1227 if (!private->dai_config)
1228 return -ENOMEM;
1229
1230 return 0;
1231 }
1232
sof_link_ssp_load(struct snd_soc_component * scomp,struct snd_sof_dai_link * slink,struct sof_ipc_dai_config * config,struct snd_sof_dai * dai)1233 static int sof_link_ssp_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
1234 struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
1235 {
1236 struct snd_soc_tplg_hw_config *hw_config = slink->hw_configs;
1237 struct sof_dai_private_data *private = dai->private;
1238 u32 size = sizeof(*config);
1239 int current_config = 0;
1240 int i, ret;
1241
1242 /*
1243 * Parse common data, we should have 1 common data per hw_config.
1244 */
1245 ret = sof_update_ipc_object(scomp, &config->ssp, SOF_SSP_TOKENS, slink->tuples,
1246 slink->num_tuples, size, slink->num_hw_configs);
1247 if (ret < 0)
1248 return ret;
1249
1250 /* process all possible hw configs */
1251 for (i = 0; i < slink->num_hw_configs; i++) {
1252 if (le32_to_cpu(hw_config[i].id) == slink->default_hw_cfg_id)
1253 current_config = i;
1254
1255 /* handle master/slave and inverted clocks */
1256 sof_dai_set_format(&hw_config[i], &config[i]);
1257
1258 config[i].hdr.size = size;
1259
1260 /* copy differentiating hw configs to ipc structs */
1261 config[i].ssp.mclk_rate = le32_to_cpu(hw_config[i].mclk_rate);
1262 config[i].ssp.bclk_rate = le32_to_cpu(hw_config[i].bclk_rate);
1263 config[i].ssp.fsync_rate = le32_to_cpu(hw_config[i].fsync_rate);
1264 config[i].ssp.tdm_slots = le32_to_cpu(hw_config[i].tdm_slots);
1265 config[i].ssp.tdm_slot_width = le32_to_cpu(hw_config[i].tdm_slot_width);
1266 config[i].ssp.mclk_direction = hw_config[i].mclk_direction;
1267 config[i].ssp.rx_slots = le32_to_cpu(hw_config[i].rx_slots);
1268 config[i].ssp.tx_slots = le32_to_cpu(hw_config[i].tx_slots);
1269
1270 dev_dbg(scomp->dev, "tplg: config SSP%d fmt %#x mclk %d bclk %d fclk %d width (%d)%d slots %d mclk id %d quirks %d clks_control %#x\n",
1271 config[i].dai_index, config[i].format,
1272 config[i].ssp.mclk_rate, config[i].ssp.bclk_rate,
1273 config[i].ssp.fsync_rate, config[i].ssp.sample_valid_bits,
1274 config[i].ssp.tdm_slot_width, config[i].ssp.tdm_slots,
1275 config[i].ssp.mclk_id, config[i].ssp.quirks, config[i].ssp.clks_control);
1276
1277 /* validate SSP fsync rate and channel count */
1278 if (config[i].ssp.fsync_rate < 8000 || config[i].ssp.fsync_rate > 192000) {
1279 dev_err(scomp->dev, "Invalid fsync rate for SSP%d\n", config[i].dai_index);
1280 return -EINVAL;
1281 }
1282
1283 if (config[i].ssp.tdm_slots < 1 || config[i].ssp.tdm_slots > 8) {
1284 dev_err(scomp->dev, "Invalid channel count for SSP%d\n",
1285 config[i].dai_index);
1286 return -EINVAL;
1287 }
1288 }
1289
1290 dai->number_configs = slink->num_hw_configs;
1291 dai->current_config = current_config;
1292 private->dai_config = kmemdup(config, size * slink->num_hw_configs, GFP_KERNEL);
1293 if (!private->dai_config)
1294 return -ENOMEM;
1295
1296 return 0;
1297 }
1298
sof_link_dmic_load(struct snd_soc_component * scomp,struct snd_sof_dai_link * slink,struct sof_ipc_dai_config * config,struct snd_sof_dai * dai)1299 static int sof_link_dmic_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
1300 struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
1301 {
1302 struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
1303 struct sof_dai_private_data *private = dai->private;
1304 struct sof_ipc_fw_ready *ready = &sdev->fw_ready;
1305 struct sof_ipc_fw_version *v = &ready->version;
1306 size_t size = sizeof(*config);
1307 int i, ret;
1308
1309 /* Ensure the entire DMIC config struct is zeros */
1310 memset(&config->dmic, 0, sizeof(config->dmic));
1311
1312 /* parse the required set of DMIC tokens based on num_hw_cfgs */
1313 ret = sof_update_ipc_object(scomp, &config->dmic, SOF_DMIC_TOKENS, slink->tuples,
1314 slink->num_tuples, size, slink->num_hw_configs);
1315 if (ret < 0)
1316 return ret;
1317
1318 /* parse the required set of DMIC PDM tokens based on number of active PDM's */
1319 ret = sof_update_ipc_object(scomp, &config->dmic.pdm[0], SOF_DMIC_PDM_TOKENS,
1320 slink->tuples, slink->num_tuples,
1321 sizeof(struct sof_ipc_dai_dmic_pdm_ctrl),
1322 config->dmic.num_pdm_active);
1323 if (ret < 0)
1324 return ret;
1325
1326 /* set IPC header size */
1327 config->hdr.size = size;
1328
1329 /* debug messages */
1330 dev_dbg(scomp->dev, "tplg: config DMIC%d driver version %d\n",
1331 config->dai_index, config->dmic.driver_ipc_version);
1332 dev_dbg(scomp->dev, "pdmclk_min %d pdm_clkmax %d duty_min %d\n",
1333 config->dmic.pdmclk_min, config->dmic.pdmclk_max,
1334 config->dmic.duty_min);
1335 dev_dbg(scomp->dev, "duty_max %d fifo_fs %d num_pdms active %d\n",
1336 config->dmic.duty_max, config->dmic.fifo_fs,
1337 config->dmic.num_pdm_active);
1338 dev_dbg(scomp->dev, "fifo word length %d\n", config->dmic.fifo_bits);
1339
1340 for (i = 0; i < config->dmic.num_pdm_active; i++) {
1341 dev_dbg(scomp->dev, "pdm %d mic a %d mic b %d\n",
1342 config->dmic.pdm[i].id,
1343 config->dmic.pdm[i].enable_mic_a,
1344 config->dmic.pdm[i].enable_mic_b);
1345 dev_dbg(scomp->dev, "pdm %d polarity a %d polarity b %d\n",
1346 config->dmic.pdm[i].id,
1347 config->dmic.pdm[i].polarity_mic_a,
1348 config->dmic.pdm[i].polarity_mic_b);
1349 dev_dbg(scomp->dev, "pdm %d clk_edge %d skew %d\n",
1350 config->dmic.pdm[i].id,
1351 config->dmic.pdm[i].clk_edge,
1352 config->dmic.pdm[i].skew);
1353 }
1354
1355 /*
1356 * this takes care of backwards compatible handling of fifo_bits_b.
1357 * It is deprecated since firmware ABI version 3.0.1.
1358 */
1359 if (SOF_ABI_VER(v->major, v->minor, v->micro) < SOF_ABI_VER(3, 0, 1))
1360 config->dmic.fifo_bits_b = config->dmic.fifo_bits;
1361
1362 dai->number_configs = 1;
1363 dai->current_config = 0;
1364 private->dai_config = kmemdup(config, size, GFP_KERNEL);
1365 if (!private->dai_config)
1366 return -ENOMEM;
1367
1368 return 0;
1369 }
1370
sof_link_alh_load(struct snd_soc_component * scomp,struct snd_sof_dai_link * slink,struct sof_ipc_dai_config * config,struct snd_sof_dai * dai)1371 static int sof_link_alh_load(struct snd_soc_component *scomp, struct snd_sof_dai_link *slink,
1372 struct sof_ipc_dai_config *config, struct snd_sof_dai *dai)
1373 {
1374 struct sof_dai_private_data *private = dai->private;
1375 u32 size = sizeof(*config);
1376 int ret;
1377
1378 /* parse the required set of ALH tokens based on num_hw_cfgs */
1379 ret = sof_update_ipc_object(scomp, &config->alh, SOF_ALH_TOKENS, slink->tuples,
1380 slink->num_tuples, size, slink->num_hw_configs);
1381 if (ret < 0)
1382 return ret;
1383
1384 /* init IPC */
1385 config->hdr.size = size;
1386
1387 /* set config for all DAI's with name matching the link name */
1388 dai->number_configs = 1;
1389 dai->current_config = 0;
1390 private->dai_config = kmemdup(config, size, GFP_KERNEL);
1391 if (!private->dai_config)
1392 return -ENOMEM;
1393
1394 return 0;
1395 }
1396
sof_ipc3_widget_setup_comp_dai(struct snd_sof_widget * swidget)1397 static int sof_ipc3_widget_setup_comp_dai(struct snd_sof_widget *swidget)
1398 {
1399 struct snd_soc_component *scomp = swidget->scomp;
1400 struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
1401 struct snd_sof_dai *dai = swidget->private;
1402 struct sof_dai_private_data *private;
1403 struct sof_ipc_comp_dai *comp_dai;
1404 size_t ipc_size = sizeof(*comp_dai);
1405 struct sof_ipc_dai_config *config;
1406 struct snd_sof_dai_link *slink;
1407 int ret;
1408
1409 private = kzalloc(sizeof(*private), GFP_KERNEL);
1410 if (!private)
1411 return -ENOMEM;
1412
1413 dai->private = private;
1414
1415 private->comp_dai = sof_comp_alloc(swidget, &ipc_size, swidget->pipeline_id);
1416 if (!private->comp_dai) {
1417 ret = -ENOMEM;
1418 goto free;
1419 }
1420
1421 /* configure dai IPC message */
1422 comp_dai = private->comp_dai;
1423 comp_dai->comp.type = SOF_COMP_DAI;
1424 comp_dai->config.hdr.size = sizeof(comp_dai->config);
1425
1426 /* parse one set of DAI tokens */
1427 ret = sof_update_ipc_object(scomp, comp_dai, SOF_DAI_TOKENS, swidget->tuples,
1428 swidget->num_tuples, sizeof(*comp_dai), 1);
1429 if (ret < 0)
1430 goto free;
1431
1432 /* update comp_tokens */
1433 ret = sof_update_ipc_object(scomp, &comp_dai->config, SOF_COMP_TOKENS,
1434 swidget->tuples, swidget->num_tuples,
1435 sizeof(comp_dai->config), 1);
1436 if (ret < 0)
1437 goto free;
1438
1439 dev_dbg(scomp->dev, "%s dai %s: type %d index %d\n",
1440 __func__, swidget->widget->name, comp_dai->type, comp_dai->dai_index);
1441 sof_dbg_comp_config(scomp, &comp_dai->config);
1442
1443 /* now update DAI config */
1444 list_for_each_entry(slink, &sdev->dai_link_list, list) {
1445 struct sof_ipc_dai_config common_config;
1446 int i;
1447
1448 if (strcmp(slink->link->name, dai->name))
1449 continue;
1450
1451 /* Reserve memory for all hw configs, eventually freed by widget */
1452 config = kcalloc(slink->num_hw_configs, sizeof(*config), GFP_KERNEL);
1453 if (!config) {
1454 ret = -ENOMEM;
1455 goto free_comp;
1456 }
1457
1458 /* parse one set of DAI link tokens */
1459 ret = sof_update_ipc_object(scomp, &common_config, SOF_DAI_LINK_TOKENS,
1460 slink->tuples, slink->num_tuples,
1461 sizeof(common_config), 1);
1462 if (ret < 0)
1463 goto free_config;
1464
1465 for (i = 0; i < slink->num_hw_configs; i++) {
1466 config[i].hdr.cmd = SOF_IPC_GLB_DAI_MSG | SOF_IPC_DAI_CONFIG;
1467 config[i].format = le32_to_cpu(slink->hw_configs[i].fmt);
1468 config[i].type = common_config.type;
1469 config[i].dai_index = comp_dai->dai_index;
1470 }
1471
1472 switch (common_config.type) {
1473 case SOF_DAI_INTEL_SSP:
1474 ret = sof_link_ssp_load(scomp, slink, config, dai);
1475 break;
1476 case SOF_DAI_INTEL_DMIC:
1477 ret = sof_link_dmic_load(scomp, slink, config, dai);
1478 break;
1479 case SOF_DAI_INTEL_HDA:
1480 ret = sof_link_hda_load(scomp, slink, config, dai);
1481 break;
1482 case SOF_DAI_INTEL_ALH:
1483 ret = sof_link_alh_load(scomp, slink, config, dai);
1484 break;
1485 case SOF_DAI_IMX_SAI:
1486 ret = sof_link_sai_load(scomp, slink, config, dai);
1487 break;
1488 case SOF_DAI_IMX_ESAI:
1489 ret = sof_link_esai_load(scomp, slink, config, dai);
1490 break;
1491 case SOF_DAI_AMD_BT:
1492 ret = sof_link_acp_bt_load(scomp, slink, config, dai);
1493 break;
1494 case SOF_DAI_AMD_SP:
1495 ret = sof_link_acp_sp_load(scomp, slink, config, dai);
1496 break;
1497 case SOF_DAI_AMD_DMIC:
1498 ret = sof_link_acp_dmic_load(scomp, slink, config, dai);
1499 break;
1500 case SOF_DAI_MEDIATEK_AFE:
1501 ret = sof_link_afe_load(scomp, slink, config, dai);
1502 break;
1503 default:
1504 break;
1505 }
1506 if (ret < 0) {
1507 dev_err(scomp->dev, "failed to load config for dai %s\n", dai->name);
1508 goto free_config;
1509 }
1510
1511 kfree(config);
1512 }
1513
1514 return 0;
1515 free_config:
1516 kfree(config);
1517 free_comp:
1518 kfree(comp_dai);
1519 free:
1520 kfree(private);
1521 dai->private = NULL;
1522 return ret;
1523 }
1524
sof_ipc3_widget_free_comp_dai(struct snd_sof_widget * swidget)1525 static void sof_ipc3_widget_free_comp_dai(struct snd_sof_widget *swidget)
1526 {
1527 switch (swidget->id) {
1528 case snd_soc_dapm_dai_in:
1529 case snd_soc_dapm_dai_out:
1530 {
1531 struct snd_sof_dai *dai = swidget->private;
1532 struct sof_dai_private_data *dai_data;
1533
1534 if (!dai)
1535 return;
1536
1537 dai_data = dai->private;
1538 if (dai_data) {
1539 kfree(dai_data->comp_dai);
1540 kfree(dai_data->dai_config);
1541 kfree(dai_data);
1542 }
1543 kfree(dai);
1544 break;
1545 }
1546 default:
1547 break;
1548 }
1549 }
1550
sof_ipc3_route_setup(struct snd_sof_dev * sdev,struct snd_sof_route * sroute)1551 static int sof_ipc3_route_setup(struct snd_sof_dev *sdev, struct snd_sof_route *sroute)
1552 {
1553 struct sof_ipc_pipe_comp_connect connect;
1554 struct sof_ipc_reply reply;
1555 int ret;
1556
1557 connect.hdr.size = sizeof(connect);
1558 connect.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_COMP_CONNECT;
1559 connect.source_id = sroute->src_widget->comp_id;
1560 connect.sink_id = sroute->sink_widget->comp_id;
1561
1562 dev_dbg(sdev->dev, "setting up route %s -> %s\n",
1563 sroute->src_widget->widget->name,
1564 sroute->sink_widget->widget->name);
1565
1566 /* send ipc */
1567 ret = sof_ipc_tx_message(sdev->ipc, &connect, sizeof(connect), &reply, sizeof(reply));
1568 if (ret < 0)
1569 dev_err(sdev->dev, "%s: route %s -> %s failed\n", __func__,
1570 sroute->src_widget->widget->name, sroute->sink_widget->widget->name);
1571
1572 return ret;
1573 }
1574
sof_ipc3_control_load_bytes(struct snd_sof_dev * sdev,struct snd_sof_control * scontrol)1575 static int sof_ipc3_control_load_bytes(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
1576 {
1577 struct sof_ipc_ctrl_data *cdata;
1578 int ret;
1579
1580 if (scontrol->max_size < (sizeof(*cdata) + sizeof(struct sof_abi_hdr))) {
1581 dev_err(sdev->dev, "%s: insufficient size for a bytes control: %zu.\n",
1582 __func__, scontrol->max_size);
1583 return -EINVAL;
1584 }
1585
1586 if (scontrol->priv_size > scontrol->max_size - sizeof(*cdata)) {
1587 dev_err(sdev->dev,
1588 "%s: bytes data size %zu exceeds max %zu.\n", __func__,
1589 scontrol->priv_size, scontrol->max_size - sizeof(*cdata));
1590 return -EINVAL;
1591 }
1592
1593 scontrol->ipc_control_data = kzalloc(scontrol->max_size, GFP_KERNEL);
1594 if (!scontrol->ipc_control_data)
1595 return -ENOMEM;
1596
1597 scontrol->size = sizeof(struct sof_ipc_ctrl_data) + scontrol->priv_size;
1598
1599 cdata = scontrol->ipc_control_data;
1600 cdata->cmd = SOF_CTRL_CMD_BINARY;
1601 cdata->index = scontrol->index;
1602
1603 if (scontrol->priv_size > 0) {
1604 memcpy(cdata->data, scontrol->priv, scontrol->priv_size);
1605 kfree(scontrol->priv);
1606 scontrol->priv = NULL;
1607
1608 if (cdata->data->magic != SOF_ABI_MAGIC) {
1609 dev_err(sdev->dev, "Wrong ABI magic 0x%08x.\n", cdata->data->magic);
1610 ret = -EINVAL;
1611 goto err;
1612 }
1613
1614 if (SOF_ABI_VERSION_INCOMPATIBLE(SOF_ABI_VERSION, cdata->data->abi)) {
1615 dev_err(sdev->dev, "Incompatible ABI version 0x%08x.\n",
1616 cdata->data->abi);
1617 ret = -EINVAL;
1618 goto err;
1619 }
1620
1621 if (cdata->data->size + sizeof(struct sof_abi_hdr) != scontrol->priv_size) {
1622 dev_err(sdev->dev, "Conflict in bytes vs. priv size.\n");
1623 ret = -EINVAL;
1624 goto err;
1625 }
1626 }
1627
1628 return 0;
1629 err:
1630 kfree(scontrol->ipc_control_data);
1631 scontrol->ipc_control_data = NULL;
1632 return ret;
1633 }
1634
sof_ipc3_control_load_volume(struct snd_sof_dev * sdev,struct snd_sof_control * scontrol)1635 static int sof_ipc3_control_load_volume(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
1636 {
1637 struct sof_ipc_ctrl_data *cdata;
1638 int i;
1639
1640 /* init the volume get/put data */
1641 scontrol->size = struct_size(cdata, chanv, scontrol->num_channels);
1642
1643 scontrol->ipc_control_data = kzalloc(scontrol->size, GFP_KERNEL);
1644 if (!scontrol->ipc_control_data)
1645 return -ENOMEM;
1646
1647 cdata = scontrol->ipc_control_data;
1648 cdata->index = scontrol->index;
1649
1650 /* set cmd for mixer control */
1651 if (scontrol->max == 1) {
1652 cdata->cmd = SOF_CTRL_CMD_SWITCH;
1653 return 0;
1654 }
1655
1656 cdata->cmd = SOF_CTRL_CMD_VOLUME;
1657
1658 /* set default volume values to 0dB in control */
1659 for (i = 0; i < scontrol->num_channels; i++) {
1660 cdata->chanv[i].channel = i;
1661 cdata->chanv[i].value = VOL_ZERO_DB;
1662 }
1663
1664 return 0;
1665 }
1666
sof_ipc3_control_load_enum(struct snd_sof_dev * sdev,struct snd_sof_control * scontrol)1667 static int sof_ipc3_control_load_enum(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
1668 {
1669 struct sof_ipc_ctrl_data *cdata;
1670
1671 /* init the enum get/put data */
1672 scontrol->size = struct_size(cdata, chanv, scontrol->num_channels);
1673
1674 scontrol->ipc_control_data = kzalloc(scontrol->size, GFP_KERNEL);
1675 if (!scontrol->ipc_control_data)
1676 return -ENOMEM;
1677
1678 cdata = scontrol->ipc_control_data;
1679 cdata->index = scontrol->index;
1680 cdata->cmd = SOF_CTRL_CMD_ENUM;
1681
1682 return 0;
1683 }
1684
sof_ipc3_control_setup(struct snd_sof_dev * sdev,struct snd_sof_control * scontrol)1685 static int sof_ipc3_control_setup(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
1686 {
1687 switch (scontrol->info_type) {
1688 case SND_SOC_TPLG_CTL_VOLSW:
1689 case SND_SOC_TPLG_CTL_VOLSW_SX:
1690 case SND_SOC_TPLG_CTL_VOLSW_XR_SX:
1691 return sof_ipc3_control_load_volume(sdev, scontrol);
1692 case SND_SOC_TPLG_CTL_BYTES:
1693 return sof_ipc3_control_load_bytes(sdev, scontrol);
1694 case SND_SOC_TPLG_CTL_ENUM:
1695 case SND_SOC_TPLG_CTL_ENUM_VALUE:
1696 return sof_ipc3_control_load_enum(sdev, scontrol);
1697 default:
1698 break;
1699 }
1700
1701 return 0;
1702 }
1703
sof_ipc3_control_free(struct snd_sof_dev * sdev,struct snd_sof_control * scontrol)1704 static int sof_ipc3_control_free(struct snd_sof_dev *sdev, struct snd_sof_control *scontrol)
1705 {
1706 struct sof_ipc_free fcomp;
1707
1708 fcomp.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_COMP_FREE;
1709 fcomp.hdr.size = sizeof(fcomp);
1710 fcomp.id = scontrol->comp_id;
1711
1712 /* send IPC to the DSP */
1713 return sof_ipc_tx_message(sdev->ipc, &fcomp, sizeof(fcomp), NULL, 0);
1714 }
1715
1716 /* send pcm params ipc */
sof_ipc3_keyword_detect_pcm_params(struct snd_sof_widget * swidget,int dir)1717 static int sof_ipc3_keyword_detect_pcm_params(struct snd_sof_widget *swidget, int dir)
1718 {
1719 struct snd_soc_component *scomp = swidget->scomp;
1720 struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
1721 struct sof_ipc_pcm_params_reply ipc_params_reply;
1722 struct snd_pcm_hw_params *params;
1723 struct sof_ipc_pcm_params pcm;
1724 struct snd_sof_pcm *spcm;
1725 int ret;
1726
1727 /* get runtime PCM params using widget's stream name */
1728 spcm = snd_sof_find_spcm_name(scomp, swidget->widget->sname);
1729 if (!spcm) {
1730 dev_err(scomp->dev, "Cannot find PCM for %s\n", swidget->widget->name);
1731 return -EINVAL;
1732 }
1733
1734 params = &spcm->params[dir];
1735
1736 /* set IPC PCM params */
1737 memset(&pcm, 0, sizeof(pcm));
1738 pcm.hdr.size = sizeof(pcm);
1739 pcm.hdr.cmd = SOF_IPC_GLB_STREAM_MSG | SOF_IPC_STREAM_PCM_PARAMS;
1740 pcm.comp_id = swidget->comp_id;
1741 pcm.params.hdr.size = sizeof(pcm.params);
1742 pcm.params.direction = dir;
1743 pcm.params.sample_valid_bytes = params_width(params) >> 3;
1744 pcm.params.buffer_fmt = SOF_IPC_BUFFER_INTERLEAVED;
1745 pcm.params.rate = params_rate(params);
1746 pcm.params.channels = params_channels(params);
1747 pcm.params.host_period_bytes = params_period_bytes(params);
1748
1749 /* set format */
1750 switch (params_format(params)) {
1751 case SNDRV_PCM_FORMAT_S16:
1752 pcm.params.frame_fmt = SOF_IPC_FRAME_S16_LE;
1753 break;
1754 case SNDRV_PCM_FORMAT_S24:
1755 pcm.params.frame_fmt = SOF_IPC_FRAME_S24_4LE;
1756 break;
1757 case SNDRV_PCM_FORMAT_S32:
1758 pcm.params.frame_fmt = SOF_IPC_FRAME_S32_LE;
1759 break;
1760 default:
1761 return -EINVAL;
1762 }
1763
1764 /* send IPC to the DSP */
1765 ret = sof_ipc_tx_message(sdev->ipc, &pcm, sizeof(pcm),
1766 &ipc_params_reply, sizeof(ipc_params_reply));
1767 if (ret < 0)
1768 dev_err(scomp->dev, "%s: PCM params failed for %s\n", __func__,
1769 swidget->widget->name);
1770
1771 return ret;
1772 }
1773
1774 /* send stream trigger ipc */
sof_ipc3_keyword_detect_trigger(struct snd_sof_widget * swidget,int cmd)1775 static int sof_ipc3_keyword_detect_trigger(struct snd_sof_widget *swidget, int cmd)
1776 {
1777 struct snd_soc_component *scomp = swidget->scomp;
1778 struct snd_sof_dev *sdev = snd_soc_component_get_drvdata(scomp);
1779 struct sof_ipc_stream stream;
1780 struct sof_ipc_reply reply;
1781 int ret;
1782
1783 /* set IPC stream params */
1784 stream.hdr.size = sizeof(stream);
1785 stream.hdr.cmd = SOF_IPC_GLB_STREAM_MSG | cmd;
1786 stream.comp_id = swidget->comp_id;
1787
1788 /* send IPC to the DSP */
1789 ret = sof_ipc_tx_message(sdev->ipc, &stream, sizeof(stream), &reply, sizeof(reply));
1790 if (ret < 0)
1791 dev_err(scomp->dev, "%s: Failed to trigger %s\n", __func__, swidget->widget->name);
1792
1793 return ret;
1794 }
1795
sof_ipc3_keyword_dapm_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * k,int event)1796 static int sof_ipc3_keyword_dapm_event(struct snd_soc_dapm_widget *w,
1797 struct snd_kcontrol *k, int event)
1798 {
1799 struct snd_sof_widget *swidget = w->dobj.private;
1800 struct snd_soc_component *scomp;
1801 int stream = SNDRV_PCM_STREAM_CAPTURE;
1802 struct snd_sof_pcm *spcm;
1803 int ret = 0;
1804
1805 if (!swidget)
1806 return 0;
1807
1808 scomp = swidget->scomp;
1809
1810 dev_dbg(scomp->dev, "received event %d for widget %s\n",
1811 event, w->name);
1812
1813 /* get runtime PCM params using widget's stream name */
1814 spcm = snd_sof_find_spcm_name(scomp, swidget->widget->sname);
1815 if (!spcm) {
1816 dev_err(scomp->dev, "%s: Cannot find PCM for %s\n", __func__,
1817 swidget->widget->name);
1818 return -EINVAL;
1819 }
1820
1821 /* process events */
1822 switch (event) {
1823 case SND_SOC_DAPM_PRE_PMU:
1824 if (spcm->stream[stream].suspend_ignored) {
1825 dev_dbg(scomp->dev, "PRE_PMU event ignored, KWD pipeline is already RUNNING\n");
1826 return 0;
1827 }
1828
1829 /* set pcm params */
1830 ret = sof_ipc3_keyword_detect_pcm_params(swidget, stream);
1831 if (ret < 0) {
1832 dev_err(scomp->dev, "%s: Failed to set pcm params for widget %s\n",
1833 __func__, swidget->widget->name);
1834 break;
1835 }
1836
1837 /* start trigger */
1838 ret = sof_ipc3_keyword_detect_trigger(swidget, SOF_IPC_STREAM_TRIG_START);
1839 if (ret < 0)
1840 dev_err(scomp->dev, "%s: Failed to trigger widget %s\n", __func__,
1841 swidget->widget->name);
1842 break;
1843 case SND_SOC_DAPM_POST_PMD:
1844 if (spcm->stream[stream].suspend_ignored) {
1845 dev_dbg(scomp->dev,
1846 "POST_PMD event ignored, KWD pipeline will remain RUNNING\n");
1847 return 0;
1848 }
1849
1850 /* stop trigger */
1851 ret = sof_ipc3_keyword_detect_trigger(swidget, SOF_IPC_STREAM_TRIG_STOP);
1852 if (ret < 0)
1853 dev_err(scomp->dev, "%s: Failed to trigger widget %s\n", __func__,
1854 swidget->widget->name);
1855
1856 /* pcm free */
1857 ret = sof_ipc3_keyword_detect_trigger(swidget, SOF_IPC_STREAM_PCM_FREE);
1858 if (ret < 0)
1859 dev_err(scomp->dev, "%s: Failed to free PCM for widget %s\n", __func__,
1860 swidget->widget->name);
1861 break;
1862 default:
1863 break;
1864 }
1865
1866 return ret;
1867 }
1868
1869 /* event handlers for keyword detect component */
1870 static const struct snd_soc_tplg_widget_events sof_kwd_events[] = {
1871 {SOF_KEYWORD_DETECT_DAPM_EVENT, sof_ipc3_keyword_dapm_event},
1872 };
1873
sof_ipc3_widget_bind_event(struct snd_soc_component * scomp,struct snd_sof_widget * swidget,u16 event_type)1874 static int sof_ipc3_widget_bind_event(struct snd_soc_component *scomp,
1875 struct snd_sof_widget *swidget, u16 event_type)
1876 {
1877 struct sof_ipc_comp *ipc_comp;
1878
1879 /* validate widget event type */
1880 switch (event_type) {
1881 case SOF_KEYWORD_DETECT_DAPM_EVENT:
1882 /* only KEYWORD_DETECT comps should handle this */
1883 if (swidget->id != snd_soc_dapm_effect)
1884 break;
1885
1886 ipc_comp = swidget->private;
1887 if (ipc_comp && ipc_comp->type != SOF_COMP_KEYWORD_DETECT)
1888 break;
1889
1890 /* bind event to keyword detect comp */
1891 return snd_soc_tplg_widget_bind_event(swidget->widget, sof_kwd_events,
1892 ARRAY_SIZE(sof_kwd_events), event_type);
1893 default:
1894 break;
1895 }
1896
1897 dev_err(scomp->dev, "Invalid event type %d for widget %s\n", event_type,
1898 swidget->widget->name);
1899
1900 return -EINVAL;
1901 }
1902
sof_ipc3_complete_pipeline(struct snd_sof_dev * sdev,struct snd_sof_widget * swidget)1903 static int sof_ipc3_complete_pipeline(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget)
1904 {
1905 struct sof_ipc_pipe_ready ready;
1906 struct sof_ipc_reply reply;
1907 int ret;
1908
1909 dev_dbg(sdev->dev, "tplg: complete pipeline %s id %d\n",
1910 swidget->widget->name, swidget->comp_id);
1911
1912 memset(&ready, 0, sizeof(ready));
1913 ready.hdr.size = sizeof(ready);
1914 ready.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_PIPE_COMPLETE;
1915 ready.comp_id = swidget->comp_id;
1916
1917 ret = sof_ipc_tx_message(sdev->ipc, &ready, sizeof(ready), &reply, sizeof(reply));
1918 if (ret < 0)
1919 return ret;
1920
1921 return 1;
1922 }
1923
sof_ipc3_widget_free(struct snd_sof_dev * sdev,struct snd_sof_widget * swidget)1924 static int sof_ipc3_widget_free(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget)
1925 {
1926 struct sof_ipc_free ipc_free = {
1927 .hdr = {
1928 .size = sizeof(ipc_free),
1929 .cmd = SOF_IPC_GLB_TPLG_MSG,
1930 },
1931 .id = swidget->comp_id,
1932 };
1933 struct sof_ipc_reply reply;
1934 int ret;
1935
1936 if (!swidget->private)
1937 return 0;
1938
1939 switch (swidget->id) {
1940 case snd_soc_dapm_scheduler:
1941 {
1942 ipc_free.hdr.cmd |= SOF_IPC_TPLG_PIPE_FREE;
1943 break;
1944 }
1945 case snd_soc_dapm_buffer:
1946 ipc_free.hdr.cmd |= SOF_IPC_TPLG_BUFFER_FREE;
1947 break;
1948 default:
1949 ipc_free.hdr.cmd |= SOF_IPC_TPLG_COMP_FREE;
1950 break;
1951 }
1952
1953 ret = sof_ipc_tx_message(sdev->ipc, &ipc_free, sizeof(ipc_free),
1954 &reply, sizeof(reply));
1955 if (ret < 0)
1956 dev_err(sdev->dev, "failed to free widget %s\n", swidget->widget->name);
1957
1958 return ret;
1959 }
1960
sof_ipc3_dai_config(struct snd_sof_dev * sdev,struct snd_sof_widget * swidget,unsigned int flags,struct snd_sof_dai_config_data * data)1961 static int sof_ipc3_dai_config(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget,
1962 unsigned int flags, struct snd_sof_dai_config_data *data)
1963 {
1964 struct sof_ipc_fw_version *v = &sdev->fw_ready.version;
1965 struct snd_sof_dai *dai = swidget->private;
1966 struct sof_dai_private_data *private;
1967 struct sof_ipc_dai_config *config;
1968 struct sof_ipc_reply reply;
1969 int ret = 0;
1970
1971 if (!dai || !dai->private) {
1972 dev_err(sdev->dev, "No private data for DAI %s\n", swidget->widget->name);
1973 return -EINVAL;
1974 }
1975
1976 private = dai->private;
1977 if (!private->dai_config) {
1978 dev_err(sdev->dev, "No config for DAI %s\n", dai->name);
1979 return -EINVAL;
1980 }
1981
1982 config = &private->dai_config[dai->current_config];
1983 if (!config) {
1984 dev_err(sdev->dev, "Invalid current config for DAI %s\n", dai->name);
1985 return -EINVAL;
1986 }
1987
1988 switch (config->type) {
1989 case SOF_DAI_INTEL_SSP:
1990 /*
1991 * DAI_CONFIG IPC during hw_params/hw_free for SSP DAI's is not supported in older
1992 * firmware
1993 */
1994 if (v->abi_version < SOF_ABI_VER(3, 18, 0) &&
1995 ((flags & SOF_DAI_CONFIG_FLAGS_HW_PARAMS) ||
1996 (flags & SOF_DAI_CONFIG_FLAGS_HW_FREE)))
1997 return 0;
1998 break;
1999 case SOF_DAI_INTEL_HDA:
2000 if (data)
2001 config->hda.link_dma_ch = data->dai_data;
2002 break;
2003 case SOF_DAI_INTEL_ALH:
2004 if (data) {
2005 config->dai_index = data->dai_index;
2006 config->alh.stream_id = data->dai_data;
2007 }
2008 break;
2009 default:
2010 break;
2011 }
2012
2013 config->flags = flags;
2014
2015 /* only send the IPC if the widget is set up in the DSP */
2016 if (swidget->use_count > 0) {
2017 ret = sof_ipc_tx_message(sdev->ipc, config, config->hdr.size,
2018 &reply, sizeof(reply));
2019 if (ret < 0)
2020 dev_err(sdev->dev, "Failed to set dai config for %s\n", dai->name);
2021 }
2022
2023 return ret;
2024 }
2025
sof_ipc3_widget_setup(struct snd_sof_dev * sdev,struct snd_sof_widget * swidget)2026 static int sof_ipc3_widget_setup(struct snd_sof_dev *sdev, struct snd_sof_widget *swidget)
2027 {
2028 struct sof_ipc_comp_reply reply;
2029 int ret;
2030
2031 if (!swidget->private)
2032 return 0;
2033
2034 switch (swidget->id) {
2035 case snd_soc_dapm_dai_in:
2036 case snd_soc_dapm_dai_out:
2037 {
2038 struct snd_sof_dai *dai = swidget->private;
2039 struct sof_dai_private_data *dai_data = dai->private;
2040 struct sof_ipc_comp *comp = &dai_data->comp_dai->comp;
2041
2042 ret = sof_ipc_tx_message(sdev->ipc, dai_data->comp_dai,
2043 comp->hdr.size, &reply, sizeof(reply));
2044 break;
2045 }
2046 case snd_soc_dapm_scheduler:
2047 {
2048 struct sof_ipc_pipe_new *pipeline;
2049
2050 pipeline = swidget->private;
2051 ret = sof_ipc_tx_message(sdev->ipc, pipeline, sizeof(*pipeline),
2052 &reply, sizeof(reply));
2053 break;
2054 }
2055 default:
2056 {
2057 struct sof_ipc_cmd_hdr *hdr;
2058
2059 hdr = swidget->private;
2060 ret = sof_ipc_tx_message(sdev->ipc, swidget->private, hdr->size,
2061 &reply, sizeof(reply));
2062 break;
2063 }
2064 }
2065 if (ret < 0)
2066 dev_err(sdev->dev, "Failed to setup widget %s\n", swidget->widget->name);
2067
2068 return ret;
2069 }
2070
sof_ipc3_set_up_all_pipelines(struct snd_sof_dev * sdev,bool verify)2071 static int sof_ipc3_set_up_all_pipelines(struct snd_sof_dev *sdev, bool verify)
2072 {
2073 struct sof_ipc_fw_version *v = &sdev->fw_ready.version;
2074 struct snd_sof_widget *swidget;
2075 struct snd_sof_route *sroute;
2076 int ret;
2077
2078 /* restore pipeline components */
2079 list_for_each_entry(swidget, &sdev->widget_list, list) {
2080 /* only set up the widgets belonging to static pipelines */
2081 if (!verify && swidget->dynamic_pipeline_widget)
2082 continue;
2083
2084 /*
2085 * For older firmware, skip scheduler widgets in this loop,
2086 * sof_widget_setup() will be called in the 'complete pipeline' loop
2087 */
2088 if (v->abi_version < SOF_ABI_VER(3, 19, 0) &&
2089 swidget->id == snd_soc_dapm_scheduler)
2090 continue;
2091
2092 /* update DAI config. The IPC will be sent in sof_widget_setup() */
2093 if (WIDGET_IS_DAI(swidget->id)) {
2094 struct snd_sof_dai *dai = swidget->private;
2095 struct sof_dai_private_data *private;
2096 struct sof_ipc_dai_config *config;
2097
2098 if (!dai || !dai->private)
2099 continue;
2100 private = dai->private;
2101 if (!private->dai_config)
2102 continue;
2103
2104 config = private->dai_config;
2105 /*
2106 * The link DMA channel would be invalidated for running
2107 * streams but not for streams that were in the PAUSED
2108 * state during suspend. So invalidate it here before setting
2109 * the dai config in the DSP.
2110 */
2111 if (config->type == SOF_DAI_INTEL_HDA)
2112 config->hda.link_dma_ch = DMA_CHAN_INVALID;
2113 }
2114
2115 ret = sof_widget_setup(sdev, swidget);
2116 if (ret < 0)
2117 return ret;
2118 }
2119
2120 /* restore pipeline connections */
2121 list_for_each_entry(sroute, &sdev->route_list, list) {
2122 /* only set up routes belonging to static pipelines */
2123 if (!verify && (sroute->src_widget->dynamic_pipeline_widget ||
2124 sroute->sink_widget->dynamic_pipeline_widget))
2125 continue;
2126
2127 /*
2128 * For virtual routes, both sink and source are not buffer. IPC3 only supports
2129 * connections between a buffer and a component. Ignore the rest.
2130 */
2131 if (sroute->src_widget->id != snd_soc_dapm_buffer &&
2132 sroute->sink_widget->id != snd_soc_dapm_buffer)
2133 continue;
2134
2135 ret = sof_route_setup(sdev, sroute->src_widget->widget,
2136 sroute->sink_widget->widget);
2137 if (ret < 0) {
2138 dev_err(sdev->dev, "%s: route set up failed\n", __func__);
2139 return ret;
2140 }
2141 }
2142
2143 /* complete pipeline */
2144 list_for_each_entry(swidget, &sdev->widget_list, list) {
2145 switch (swidget->id) {
2146 case snd_soc_dapm_scheduler:
2147 /* only complete static pipelines */
2148 if (!verify && swidget->dynamic_pipeline_widget)
2149 continue;
2150
2151 if (v->abi_version < SOF_ABI_VER(3, 19, 0)) {
2152 ret = sof_widget_setup(sdev, swidget);
2153 if (ret < 0)
2154 return ret;
2155 }
2156
2157 swidget->complete = sof_ipc3_complete_pipeline(sdev, swidget);
2158 if (swidget->complete < 0)
2159 return swidget->complete;
2160 break;
2161 default:
2162 break;
2163 }
2164 }
2165
2166 return 0;
2167 }
2168
2169 /*
2170 * Free the PCM, its associated widgets and set the prepared flag to false for all PCMs that
2171 * did not get suspended(ex: paused streams) so the widgets can be set up again during resume.
2172 */
sof_tear_down_left_over_pipelines(struct snd_sof_dev * sdev)2173 static int sof_tear_down_left_over_pipelines(struct snd_sof_dev *sdev)
2174 {
2175 struct snd_sof_widget *swidget;
2176 struct snd_sof_pcm *spcm;
2177 int dir, ret;
2178
2179 /*
2180 * free all PCMs and their associated DAPM widgets if their connected DAPM widget
2181 * list is not NULL. This should only be true for paused streams at this point.
2182 * This is equivalent to the handling of FE DAI suspend trigger for running streams.
2183 */
2184 list_for_each_entry(spcm, &sdev->pcm_list, list) {
2185 for_each_pcm_streams(dir) {
2186 struct snd_pcm_substream *substream = spcm->stream[dir].substream;
2187
2188 if (!substream || !substream->runtime)
2189 continue;
2190
2191 if (spcm->stream[dir].list) {
2192 ret = sof_pcm_stream_free(sdev, substream, spcm, dir, true);
2193 if (ret < 0)
2194 return ret;
2195 }
2196 }
2197 }
2198
2199 /*
2200 * free any left over DAI widgets. This is equivalent to the handling of suspend trigger
2201 * for the BE DAI for running streams.
2202 */
2203 list_for_each_entry(swidget, &sdev->widget_list, list)
2204 if (WIDGET_IS_DAI(swidget->id) && swidget->use_count == 1) {
2205 ret = sof_widget_free(sdev, swidget);
2206 if (ret < 0)
2207 return ret;
2208 }
2209
2210 return 0;
2211 }
2212
2213 /*
2214 * For older firmware, this function doesn't free widgets for static pipelines during suspend.
2215 * It only resets use_count for all widgets.
2216 */
sof_ipc3_tear_down_all_pipelines(struct snd_sof_dev * sdev,bool verify)2217 static int sof_ipc3_tear_down_all_pipelines(struct snd_sof_dev *sdev, bool verify)
2218 {
2219 struct sof_ipc_fw_version *v = &sdev->fw_ready.version;
2220 struct snd_sof_widget *swidget;
2221 struct snd_sof_route *sroute;
2222 int ret;
2223
2224 /*
2225 * This function is called during suspend and for one-time topology verification during
2226 * first boot. In both cases, there is no need to protect swidget->use_count and
2227 * sroute->setup because during suspend all running streams are suspended and during
2228 * topology loading the sound card unavailable to open PCMs.
2229 */
2230 list_for_each_entry(swidget, &sdev->widget_list, list) {
2231 if (swidget->dynamic_pipeline_widget)
2232 continue;
2233
2234 /* Do not free widgets for static pipelines with FW ABI older than 3.19 */
2235 if (!verify && !swidget->dynamic_pipeline_widget &&
2236 v->abi_version < SOF_ABI_VER(3, 19, 0)) {
2237 swidget->use_count = 0;
2238 swidget->complete = 0;
2239 continue;
2240 }
2241
2242 ret = sof_widget_free(sdev, swidget);
2243 if (ret < 0)
2244 return ret;
2245 }
2246
2247 /*
2248 * Tear down all pipelines associated with PCMs that did not get suspended
2249 * and unset the prepare flag so that they can be set up again during resume.
2250 * Skip this step for older firmware.
2251 */
2252 if (!verify && v->abi_version >= SOF_ABI_VER(3, 19, 0)) {
2253 ret = sof_tear_down_left_over_pipelines(sdev);
2254 if (ret < 0) {
2255 dev_err(sdev->dev, "failed to tear down paused pipelines\n");
2256 return ret;
2257 }
2258 }
2259
2260 list_for_each_entry(sroute, &sdev->route_list, list)
2261 sroute->setup = false;
2262
2263 /*
2264 * before suspending, make sure the refcounts are all zeroed out. There's no way
2265 * to recover at this point but this will help root cause bad sequences leading to
2266 * more issues on resume
2267 */
2268 list_for_each_entry(swidget, &sdev->widget_list, list) {
2269 if (swidget->use_count != 0) {
2270 dev_err(sdev->dev, "%s: widget %s is still in use: count %d\n",
2271 __func__, swidget->widget->name, swidget->use_count);
2272 }
2273 }
2274
2275 return 0;
2276 }
2277
sof_ipc3_dai_get_clk(struct snd_sof_dev * sdev,struct snd_sof_dai * dai,int clk_type)2278 static int sof_ipc3_dai_get_clk(struct snd_sof_dev *sdev, struct snd_sof_dai *dai, int clk_type)
2279 {
2280 struct sof_dai_private_data *private = dai->private;
2281
2282 if (!private || !private->dai_config)
2283 return 0;
2284
2285 switch (private->dai_config->type) {
2286 case SOF_DAI_INTEL_SSP:
2287 switch (clk_type) {
2288 case SOF_DAI_CLK_INTEL_SSP_MCLK:
2289 return private->dai_config->ssp.mclk_rate;
2290 case SOF_DAI_CLK_INTEL_SSP_BCLK:
2291 return private->dai_config->ssp.bclk_rate;
2292 default:
2293 break;
2294 }
2295 dev_err(sdev->dev, "fail to get SSP clk %d rate\n", clk_type);
2296 break;
2297 default:
2298 /* not yet implemented for platforms other than the above */
2299 dev_err(sdev->dev, "DAI type %d not supported yet!\n", private->dai_config->type);
2300 break;
2301 }
2302
2303 return -EINVAL;
2304 }
2305
2306 /* token list for each topology object */
2307 static enum sof_tokens host_token_list[] = {
2308 SOF_CORE_TOKENS,
2309 SOF_COMP_EXT_TOKENS,
2310 SOF_PCM_TOKENS,
2311 SOF_COMP_TOKENS,
2312 };
2313
2314 static enum sof_tokens comp_generic_token_list[] = {
2315 SOF_CORE_TOKENS,
2316 SOF_COMP_EXT_TOKENS,
2317 SOF_COMP_TOKENS,
2318 };
2319
2320 static enum sof_tokens buffer_token_list[] = {
2321 SOF_BUFFER_TOKENS,
2322 };
2323
2324 static enum sof_tokens pipeline_token_list[] = {
2325 SOF_CORE_TOKENS,
2326 SOF_COMP_EXT_TOKENS,
2327 SOF_PIPELINE_TOKENS,
2328 SOF_SCHED_TOKENS,
2329 };
2330
2331 static enum sof_tokens asrc_token_list[] = {
2332 SOF_CORE_TOKENS,
2333 SOF_COMP_EXT_TOKENS,
2334 SOF_ASRC_TOKENS,
2335 SOF_COMP_TOKENS,
2336 };
2337
2338 static enum sof_tokens src_token_list[] = {
2339 SOF_CORE_TOKENS,
2340 SOF_COMP_EXT_TOKENS,
2341 SOF_SRC_TOKENS,
2342 SOF_COMP_TOKENS
2343 };
2344
2345 static enum sof_tokens pga_token_list[] = {
2346 SOF_CORE_TOKENS,
2347 SOF_COMP_EXT_TOKENS,
2348 SOF_VOLUME_TOKENS,
2349 SOF_COMP_TOKENS,
2350 };
2351
2352 static enum sof_tokens dai_token_list[] = {
2353 SOF_CORE_TOKENS,
2354 SOF_COMP_EXT_TOKENS,
2355 SOF_DAI_TOKENS,
2356 SOF_COMP_TOKENS,
2357 };
2358
2359 static enum sof_tokens process_token_list[] = {
2360 SOF_CORE_TOKENS,
2361 SOF_COMP_EXT_TOKENS,
2362 SOF_PROCESS_TOKENS,
2363 SOF_COMP_TOKENS,
2364 };
2365
2366 static const struct sof_ipc_tplg_widget_ops tplg_ipc3_widget_ops[SND_SOC_DAPM_TYPE_COUNT] = {
2367 [snd_soc_dapm_aif_in] = {sof_ipc3_widget_setup_comp_host, sof_ipc3_widget_free_comp,
2368 host_token_list, ARRAY_SIZE(host_token_list), NULL},
2369 [snd_soc_dapm_aif_out] = {sof_ipc3_widget_setup_comp_host, sof_ipc3_widget_free_comp,
2370 host_token_list, ARRAY_SIZE(host_token_list), NULL},
2371
2372 [snd_soc_dapm_dai_in] = {sof_ipc3_widget_setup_comp_dai, sof_ipc3_widget_free_comp_dai,
2373 dai_token_list, ARRAY_SIZE(dai_token_list), NULL},
2374 [snd_soc_dapm_dai_out] = {sof_ipc3_widget_setup_comp_dai, sof_ipc3_widget_free_comp_dai,
2375 dai_token_list, ARRAY_SIZE(dai_token_list), NULL},
2376 [snd_soc_dapm_buffer] = {sof_ipc3_widget_setup_comp_buffer, sof_ipc3_widget_free_comp,
2377 buffer_token_list, ARRAY_SIZE(buffer_token_list), NULL},
2378 [snd_soc_dapm_mixer] = {sof_ipc3_widget_setup_comp_mixer, sof_ipc3_widget_free_comp,
2379 comp_generic_token_list, ARRAY_SIZE(comp_generic_token_list),
2380 NULL},
2381 [snd_soc_dapm_src] = {sof_ipc3_widget_setup_comp_src, sof_ipc3_widget_free_comp,
2382 src_token_list, ARRAY_SIZE(src_token_list), NULL},
2383 [snd_soc_dapm_asrc] = {sof_ipc3_widget_setup_comp_asrc, sof_ipc3_widget_free_comp,
2384 asrc_token_list, ARRAY_SIZE(asrc_token_list), NULL},
2385 [snd_soc_dapm_siggen] = {sof_ipc3_widget_setup_comp_tone, sof_ipc3_widget_free_comp,
2386 comp_generic_token_list, ARRAY_SIZE(comp_generic_token_list),
2387 NULL},
2388 [snd_soc_dapm_scheduler] = {sof_ipc3_widget_setup_comp_pipeline, sof_ipc3_widget_free_comp,
2389 pipeline_token_list, ARRAY_SIZE(pipeline_token_list), NULL},
2390 [snd_soc_dapm_pga] = {sof_ipc3_widget_setup_comp_pga, sof_ipc3_widget_free_comp,
2391 pga_token_list, ARRAY_SIZE(pga_token_list), NULL},
2392 [snd_soc_dapm_mux] = {sof_ipc3_widget_setup_comp_mux, sof_ipc3_widget_free_comp,
2393 comp_generic_token_list, ARRAY_SIZE(comp_generic_token_list), NULL},
2394 [snd_soc_dapm_demux] = {sof_ipc3_widget_setup_comp_mux, sof_ipc3_widget_free_comp,
2395 comp_generic_token_list, ARRAY_SIZE(comp_generic_token_list),
2396 NULL},
2397 [snd_soc_dapm_effect] = {sof_widget_update_ipc_comp_process, sof_ipc3_widget_free_comp,
2398 process_token_list, ARRAY_SIZE(process_token_list),
2399 sof_ipc3_widget_bind_event},
2400 };
2401
2402 const struct sof_ipc_tplg_ops ipc3_tplg_ops = {
2403 .widget = tplg_ipc3_widget_ops,
2404 .control = &tplg_ipc3_control_ops,
2405 .route_setup = sof_ipc3_route_setup,
2406 .control_setup = sof_ipc3_control_setup,
2407 .control_free = sof_ipc3_control_free,
2408 .pipeline_complete = sof_ipc3_complete_pipeline,
2409 .token_list = ipc3_token_list,
2410 .widget_free = sof_ipc3_widget_free,
2411 .widget_setup = sof_ipc3_widget_setup,
2412 .dai_config = sof_ipc3_dai_config,
2413 .dai_get_clk = sof_ipc3_dai_get_clk,
2414 .set_up_all_pipelines = sof_ipc3_set_up_all_pipelines,
2415 .tear_down_all_pipelines = sof_ipc3_tear_down_all_pipelines,
2416 };
2417