1 // SPDX-License-Identifier: GPL-2.0-only
2 //
3 // Copyright(c) 2021 Intel Corporation
4 //
5 // Authors: Cezary Rojewski <cezary.rojewski@intel.com>
6 // Amadeusz Slawinski <amadeuszx.slawinski@linux.intel.com>
7 //
8
9 #include <linux/firmware.h>
10 #include <linux/uuid.h>
11 #include <sound/soc.h>
12 #include <sound/soc-acpi.h>
13 #include <sound/soc-topology.h>
14 #include <uapi/sound/intel/avs/tokens.h>
15 #include "avs.h"
16 #include "control.h"
17 #include "topology.h"
18 #include "utils.h"
19
20 /* Get pointer to vendor array at the specified offset. */
21 #define avs_tplg_vendor_array_at(array, offset) \
22 ((struct snd_soc_tplg_vendor_array *)((u8 *)array + offset))
23
24 /* Get pointer to vendor array that is next in line. */
25 #define avs_tplg_vendor_array_next(array) \
26 (avs_tplg_vendor_array_at(array, le32_to_cpu((array)->size)))
27
28 /*
29 * Scan provided block of tuples for the specified token. If found,
30 * @offset is updated with position at which first matching token is
31 * located.
32 *
33 * Returns 0 on success, -ENOENT if not found and error code otherwise.
34 */
35 static int
avs_tplg_vendor_array_lookup(struct snd_soc_tplg_vendor_array * tuples,u32 block_size,u32 token,u32 * offset)36 avs_tplg_vendor_array_lookup(struct snd_soc_tplg_vendor_array *tuples,
37 u32 block_size, u32 token, u32 *offset)
38 {
39 u32 pos = 0;
40
41 while (block_size > 0) {
42 struct snd_soc_tplg_vendor_value_elem *tuple;
43 u32 tuples_size = le32_to_cpu(tuples->size);
44
45 if (tuples_size > block_size)
46 return -EINVAL;
47
48 tuple = tuples->value;
49 if (le32_to_cpu(tuple->token) == token) {
50 *offset = pos;
51 return 0;
52 }
53
54 block_size -= tuples_size;
55 pos += tuples_size;
56 tuples = avs_tplg_vendor_array_next(tuples);
57 }
58
59 return -ENOENT;
60 }
61
62 /*
63 * See avs_tplg_vendor_array_lookup() for description.
64 *
65 * Behaves exactly like avs_tplg_vendor_lookup() but starts from the
66 * next vendor array in line. Useful when searching for the finish line
67 * of an arbitrary entry in a list of entries where each is composed of
68 * several vendor tuples and a specific token marks the beginning of
69 * a new entry block.
70 */
71 static int
avs_tplg_vendor_array_lookup_next(struct snd_soc_tplg_vendor_array * tuples,u32 block_size,u32 token,u32 * offset)72 avs_tplg_vendor_array_lookup_next(struct snd_soc_tplg_vendor_array *tuples,
73 u32 block_size, u32 token, u32 *offset)
74 {
75 u32 tuples_size = le32_to_cpu(tuples->size);
76 int ret;
77
78 if (tuples_size > block_size)
79 return -EINVAL;
80
81 tuples = avs_tplg_vendor_array_next(tuples);
82 block_size -= tuples_size;
83
84 ret = avs_tplg_vendor_array_lookup(tuples, block_size, token, offset);
85 if (!ret)
86 *offset += tuples_size;
87 return ret;
88 }
89
90 /*
91 * Scan provided block of tuples for the specified token which marks
92 * the border of an entry block. Behavior is similar to
93 * avs_tplg_vendor_array_lookup() except 0 is also returned if no
94 * matching token has been found. In such case, returned @size is
95 * assigned to @block_size as the entire block belongs to the current
96 * entry.
97 *
98 * Returns 0 on success, error code otherwise.
99 */
100 static int
avs_tplg_vendor_entry_size(struct snd_soc_tplg_vendor_array * tuples,u32 block_size,u32 entry_id_token,u32 * size)101 avs_tplg_vendor_entry_size(struct snd_soc_tplg_vendor_array *tuples,
102 u32 block_size, u32 entry_id_token, u32 *size)
103 {
104 int ret;
105
106 ret = avs_tplg_vendor_array_lookup_next(tuples, block_size, entry_id_token, size);
107 if (ret == -ENOENT) {
108 *size = block_size;
109 ret = 0;
110 }
111
112 return ret;
113 }
114
115 /*
116 * Vendor tuple parsing descriptor.
117 *
118 * @token: vendor specific token that identifies tuple
119 * @type: tuple type, one of SND_SOC_TPLG_TUPLE_TYPE_XXX
120 * @offset: offset of a struct's field to initialize
121 * @parse: parsing function, extracts and assigns value to object's field
122 */
123 struct avs_tplg_token_parser {
124 enum avs_tplg_token token;
125 u32 type;
126 u32 offset;
127 int (*parse)(struct snd_soc_component *comp, void *elem, void *object, u32 offset);
128 };
129
130 static int
avs_parse_uuid_token(struct snd_soc_component * comp,void * elem,void * object,u32 offset)131 avs_parse_uuid_token(struct snd_soc_component *comp, void *elem, void *object, u32 offset)
132 {
133 struct snd_soc_tplg_vendor_uuid_elem *tuple = elem;
134 guid_t *val = (guid_t *)((u8 *)object + offset);
135
136 guid_copy((guid_t *)val, (const guid_t *)&tuple->uuid);
137
138 return 0;
139 }
140
141 static int
avs_parse_bool_token(struct snd_soc_component * comp,void * elem,void * object,u32 offset)142 avs_parse_bool_token(struct snd_soc_component *comp, void *elem, void *object, u32 offset)
143 {
144 struct snd_soc_tplg_vendor_value_elem *tuple = elem;
145 bool *val = (bool *)((u8 *)object + offset);
146
147 *val = le32_to_cpu(tuple->value);
148
149 return 0;
150 }
151
152 static int
avs_parse_byte_token(struct snd_soc_component * comp,void * elem,void * object,u32 offset)153 avs_parse_byte_token(struct snd_soc_component *comp, void *elem, void *object, u32 offset)
154 {
155 struct snd_soc_tplg_vendor_value_elem *tuple = elem;
156 u8 *val = ((u8 *)object + offset);
157
158 *val = le32_to_cpu(tuple->value);
159
160 return 0;
161 }
162
163 static int
avs_parse_short_token(struct snd_soc_component * comp,void * elem,void * object,u32 offset)164 avs_parse_short_token(struct snd_soc_component *comp, void *elem, void *object, u32 offset)
165 {
166 struct snd_soc_tplg_vendor_value_elem *tuple = elem;
167 u16 *val = (u16 *)((u8 *)object + offset);
168
169 *val = le32_to_cpu(tuple->value);
170
171 return 0;
172 }
173
174 static int
avs_parse_word_token(struct snd_soc_component * comp,void * elem,void * object,u32 offset)175 avs_parse_word_token(struct snd_soc_component *comp, void *elem, void *object, u32 offset)
176 {
177 struct snd_soc_tplg_vendor_value_elem *tuple = elem;
178 u32 *val = (u32 *)((u8 *)object + offset);
179
180 *val = le32_to_cpu(tuple->value);
181
182 return 0;
183 }
184
185 static int
avs_parse_string_token(struct snd_soc_component * comp,void * elem,void * object,u32 offset)186 avs_parse_string_token(struct snd_soc_component *comp, void *elem, void *object, u32 offset)
187 {
188 struct snd_soc_tplg_vendor_string_elem *tuple = elem;
189 char *val = (char *)((u8 *)object + offset);
190
191 snprintf(val, SNDRV_CTL_ELEM_ID_NAME_MAXLEN, "%s", tuple->string);
192
193 return 0;
194 }
195
avs_parse_uuid_tokens(struct snd_soc_component * comp,void * object,const struct avs_tplg_token_parser * parsers,int count,struct snd_soc_tplg_vendor_array * tuples)196 static int avs_parse_uuid_tokens(struct snd_soc_component *comp, void *object,
197 const struct avs_tplg_token_parser *parsers, int count,
198 struct snd_soc_tplg_vendor_array *tuples)
199 {
200 struct snd_soc_tplg_vendor_uuid_elem *tuple;
201 int ret, i, j;
202
203 /* Parse element by element. */
204 for (i = 0; i < le32_to_cpu(tuples->num_elems); i++) {
205 tuple = &tuples->uuid[i];
206
207 for (j = 0; j < count; j++) {
208 /* Ignore non-UUID tokens. */
209 if (parsers[j].type != SND_SOC_TPLG_TUPLE_TYPE_UUID ||
210 parsers[j].token != le32_to_cpu(tuple->token))
211 continue;
212
213 ret = parsers[j].parse(comp, tuple, object, parsers[j].offset);
214 if (ret)
215 return ret;
216 }
217 }
218
219 return 0;
220 }
221
avs_parse_string_tokens(struct snd_soc_component * comp,void * object,const struct avs_tplg_token_parser * parsers,int count,struct snd_soc_tplg_vendor_array * tuples)222 static int avs_parse_string_tokens(struct snd_soc_component *comp, void *object,
223 const struct avs_tplg_token_parser *parsers, int count,
224 struct snd_soc_tplg_vendor_array *tuples)
225 {
226 struct snd_soc_tplg_vendor_string_elem *tuple;
227 int ret, i, j;
228
229 /* Parse element by element. */
230 for (i = 0; i < le32_to_cpu(tuples->num_elems); i++) {
231 tuple = &tuples->string[i];
232
233 for (j = 0; j < count; j++) {
234 /* Ignore non-string tokens. */
235 if (parsers[j].type != SND_SOC_TPLG_TUPLE_TYPE_STRING ||
236 parsers[j].token != le32_to_cpu(tuple->token))
237 continue;
238
239 ret = parsers[j].parse(comp, tuple, object, parsers[j].offset);
240 if (ret)
241 return ret;
242 }
243 }
244
245 return 0;
246 }
247
avs_parse_word_tokens(struct snd_soc_component * comp,void * object,const struct avs_tplg_token_parser * parsers,int count,struct snd_soc_tplg_vendor_array * tuples)248 static int avs_parse_word_tokens(struct snd_soc_component *comp, void *object,
249 const struct avs_tplg_token_parser *parsers, int count,
250 struct snd_soc_tplg_vendor_array *tuples)
251 {
252 struct snd_soc_tplg_vendor_value_elem *tuple;
253 int ret, i, j;
254
255 /* Parse element by element. */
256 for (i = 0; i < le32_to_cpu(tuples->num_elems); i++) {
257 tuple = &tuples->value[i];
258
259 for (j = 0; j < count; j++) {
260 /* Ignore non-integer tokens. */
261 if (!(parsers[j].type == SND_SOC_TPLG_TUPLE_TYPE_WORD ||
262 parsers[j].type == SND_SOC_TPLG_TUPLE_TYPE_SHORT ||
263 parsers[j].type == SND_SOC_TPLG_TUPLE_TYPE_BYTE ||
264 parsers[j].type == SND_SOC_TPLG_TUPLE_TYPE_BOOL))
265 continue;
266
267 if (parsers[j].token != le32_to_cpu(tuple->token))
268 continue;
269
270 ret = parsers[j].parse(comp, tuple, object, parsers[j].offset);
271 if (ret)
272 return ret;
273 }
274 }
275
276 return 0;
277 }
278
avs_parse_tokens(struct snd_soc_component * comp,void * object,const struct avs_tplg_token_parser * parsers,size_t count,struct snd_soc_tplg_vendor_array * tuples,int priv_size)279 static int avs_parse_tokens(struct snd_soc_component *comp, void *object,
280 const struct avs_tplg_token_parser *parsers, size_t count,
281 struct snd_soc_tplg_vendor_array *tuples, int priv_size)
282 {
283 int array_size, ret;
284
285 while (priv_size > 0) {
286 array_size = le32_to_cpu(tuples->size);
287
288 if (array_size <= 0) {
289 dev_err(comp->dev, "invalid array size 0x%x\n", array_size);
290 return -EINVAL;
291 }
292
293 /* Make sure there is enough data before parsing. */
294 priv_size -= array_size;
295 if (priv_size < 0) {
296 dev_err(comp->dev, "invalid array size 0x%x\n", array_size);
297 return -EINVAL;
298 }
299
300 switch (le32_to_cpu(tuples->type)) {
301 case SND_SOC_TPLG_TUPLE_TYPE_UUID:
302 ret = avs_parse_uuid_tokens(comp, object, parsers, count, tuples);
303 break;
304 case SND_SOC_TPLG_TUPLE_TYPE_STRING:
305 ret = avs_parse_string_tokens(comp, object, parsers, count, tuples);
306 break;
307 case SND_SOC_TPLG_TUPLE_TYPE_BOOL:
308 case SND_SOC_TPLG_TUPLE_TYPE_BYTE:
309 case SND_SOC_TPLG_TUPLE_TYPE_SHORT:
310 case SND_SOC_TPLG_TUPLE_TYPE_WORD:
311 ret = avs_parse_word_tokens(comp, object, parsers, count, tuples);
312 break;
313 default:
314 dev_err(comp->dev, "unknown token type %d\n", tuples->type);
315 ret = -EINVAL;
316 }
317
318 if (ret) {
319 dev_err(comp->dev, "parsing %zu tokens of %d type failed: %d\n",
320 count, tuples->type, ret);
321 return ret;
322 }
323
324 tuples = avs_tplg_vendor_array_next(tuples);
325 }
326
327 return 0;
328 }
329
330 #define AVS_DEFINE_PTR_PARSER(name, type, member) \
331 static int \
332 avs_parse_##name##_ptr(struct snd_soc_component *comp, void *elem, void *object, u32 offset) \
333 { \
334 struct snd_soc_tplg_vendor_value_elem *tuple = elem; \
335 struct avs_soc_component *acomp = to_avs_soc_component(comp); \
336 type **val = (type **)(object + offset); \
337 u32 idx; \
338 \
339 idx = le32_to_cpu(tuple->value); \
340 if (idx >= acomp->tplg->num_##member) \
341 return -EINVAL; \
342 \
343 *val = &acomp->tplg->member[idx]; \
344 \
345 return 0; \
346 }
347
348 AVS_DEFINE_PTR_PARSER(audio_format, struct avs_audio_format, fmts);
349 AVS_DEFINE_PTR_PARSER(modcfg_base, struct avs_tplg_modcfg_base, modcfgs_base);
350 AVS_DEFINE_PTR_PARSER(modcfg_ext, struct avs_tplg_modcfg_ext, modcfgs_ext);
351 AVS_DEFINE_PTR_PARSER(pplcfg, struct avs_tplg_pplcfg, pplcfgs);
352 AVS_DEFINE_PTR_PARSER(binding, struct avs_tplg_binding, bindings);
353
354 static int
parse_audio_format_bitfield(struct snd_soc_component * comp,void * elem,void * object,u32 offset)355 parse_audio_format_bitfield(struct snd_soc_component *comp, void *elem, void *object, u32 offset)
356 {
357 struct snd_soc_tplg_vendor_value_elem *velem = elem;
358 struct avs_audio_format *audio_format = object;
359
360 switch (offset) {
361 case AVS_TKN_AFMT_NUM_CHANNELS_U32:
362 audio_format->num_channels = le32_to_cpu(velem->value);
363 break;
364 case AVS_TKN_AFMT_VALID_BIT_DEPTH_U32:
365 audio_format->valid_bit_depth = le32_to_cpu(velem->value);
366 break;
367 case AVS_TKN_AFMT_SAMPLE_TYPE_U32:
368 audio_format->sample_type = le32_to_cpu(velem->value);
369 break;
370 }
371
372 return 0;
373 }
374
avs_ssp_sprint(char * buf,size_t size,const char * fmt,int port,int tdm)375 static int avs_ssp_sprint(char *buf, size_t size, const char *fmt, int port, int tdm)
376 {
377 char *needle = strstr(fmt, "%d");
378 int retsize;
379
380 /*
381 * If there is %d present in fmt string it should be replaced by either
382 * SSP or SSP:TDM, where SSP and TDM are numbers, all other formatting
383 * will be ignored.
384 */
385 if (needle) {
386 retsize = scnprintf(buf, min_t(size_t, size, needle - fmt + 1), "%s", fmt);
387 retsize += scnprintf(buf + retsize, size - retsize, "%d", port);
388 if (tdm)
389 retsize += scnprintf(buf + retsize, size - retsize, ":%d", tdm);
390 retsize += scnprintf(buf + retsize, size - retsize, "%s", needle + 2);
391 return retsize;
392 }
393
394 return snprintf(buf, size, "%s", fmt);
395 }
396
parse_link_formatted_string(struct snd_soc_component * comp,void * elem,void * object,u32 offset)397 static int parse_link_formatted_string(struct snd_soc_component *comp, void *elem,
398 void *object, u32 offset)
399 {
400 struct snd_soc_tplg_vendor_string_elem *tuple = elem;
401 struct snd_soc_acpi_mach *mach = dev_get_platdata(comp->card->dev);
402 char *val = (char *)((u8 *)object + offset);
403 int ssp_port, tdm_slot;
404
405 /*
406 * Dynamic naming - string formats, e.g.: ssp%d - supported only for
407 * topologies describing single device e.g.: an I2S codec on SSP0.
408 */
409 if (!avs_mach_singular_ssp(mach))
410 return avs_parse_string_token(comp, elem, object, offset);
411
412 ssp_port = avs_mach_ssp_port(mach);
413 if (!avs_mach_singular_tdm(mach, ssp_port))
414 return avs_parse_string_token(comp, elem, object, offset);
415
416 tdm_slot = avs_mach_ssp_tdm(mach, ssp_port);
417
418 avs_ssp_sprint(val, SNDRV_CTL_ELEM_ID_NAME_MAXLEN, tuple->string, ssp_port, tdm_slot);
419
420 return 0;
421 }
422
423 static int
parse_dictionary_header(struct snd_soc_component * comp,struct snd_soc_tplg_vendor_array * tuples,void ** dict,u32 * num_entries,size_t entry_size,u32 num_entries_token)424 parse_dictionary_header(struct snd_soc_component *comp,
425 struct snd_soc_tplg_vendor_array *tuples,
426 void **dict, u32 *num_entries, size_t entry_size,
427 u32 num_entries_token)
428 {
429 struct snd_soc_tplg_vendor_value_elem *tuple;
430
431 /* Dictionary header consists of single tuple - entry count. */
432 tuple = tuples->value;
433 if (le32_to_cpu(tuple->token) != num_entries_token) {
434 dev_err(comp->dev, "invalid dictionary header, expected: %d\n",
435 num_entries_token);
436 return -EINVAL;
437 }
438
439 *num_entries = le32_to_cpu(tuple->value);
440 *dict = devm_kcalloc(comp->card->dev, *num_entries, entry_size, GFP_KERNEL);
441 if (!*dict)
442 return -ENOMEM;
443
444 return 0;
445 }
446
447 static int
parse_dictionary_entries(struct snd_soc_component * comp,struct snd_soc_tplg_vendor_array * tuples,u32 block_size,void * dict,u32 num_entries,size_t entry_size,u32 entry_id_token,const struct avs_tplg_token_parser * parsers,size_t num_parsers)448 parse_dictionary_entries(struct snd_soc_component *comp,
449 struct snd_soc_tplg_vendor_array *tuples, u32 block_size,
450 void *dict, u32 num_entries, size_t entry_size,
451 u32 entry_id_token,
452 const struct avs_tplg_token_parser *parsers, size_t num_parsers)
453 {
454 void *pos = dict;
455 int i;
456
457 for (i = 0; i < num_entries; i++) {
458 u32 esize;
459 int ret;
460
461 ret = avs_tplg_vendor_entry_size(tuples, block_size,
462 entry_id_token, &esize);
463 if (ret)
464 return ret;
465
466 ret = avs_parse_tokens(comp, pos, parsers, num_parsers, tuples, esize);
467 if (ret < 0) {
468 dev_err(comp->dev, "parse entry: %d of type: %d failed: %d\n",
469 i, entry_id_token, ret);
470 return ret;
471 }
472
473 pos += entry_size;
474 block_size -= esize;
475 tuples = avs_tplg_vendor_array_at(tuples, esize);
476 }
477
478 return 0;
479 }
480
parse_dictionary(struct snd_soc_component * comp,struct snd_soc_tplg_vendor_array * tuples,u32 block_size,void ** dict,u32 * num_entries,size_t entry_size,u32 num_entries_token,u32 entry_id_token,const struct avs_tplg_token_parser * parsers,size_t num_parsers)481 static int parse_dictionary(struct snd_soc_component *comp,
482 struct snd_soc_tplg_vendor_array *tuples, u32 block_size,
483 void **dict, u32 *num_entries, size_t entry_size,
484 u32 num_entries_token, u32 entry_id_token,
485 const struct avs_tplg_token_parser *parsers, size_t num_parsers)
486 {
487 int ret;
488
489 ret = parse_dictionary_header(comp, tuples, dict, num_entries,
490 entry_size, num_entries_token);
491 if (ret)
492 return ret;
493
494 block_size -= le32_to_cpu(tuples->size);
495 /* With header parsed, move on to parsing entries. */
496 tuples = avs_tplg_vendor_array_next(tuples);
497
498 return parse_dictionary_entries(comp, tuples, block_size, *dict,
499 *num_entries, entry_size,
500 entry_id_token, parsers, num_parsers);
501 }
502
503 static const struct avs_tplg_token_parser library_parsers[] = {
504 {
505 .token = AVS_TKN_LIBRARY_NAME_STRING,
506 .type = SND_SOC_TPLG_TUPLE_TYPE_STRING,
507 .offset = offsetof(struct avs_tplg_library, name),
508 .parse = avs_parse_string_token,
509 },
510 };
511
avs_tplg_parse_libraries(struct snd_soc_component * comp,struct snd_soc_tplg_vendor_array * tuples,u32 block_size)512 static int avs_tplg_parse_libraries(struct snd_soc_component *comp,
513 struct snd_soc_tplg_vendor_array *tuples, u32 block_size)
514 {
515 struct avs_soc_component *acomp = to_avs_soc_component(comp);
516 struct avs_tplg *tplg = acomp->tplg;
517
518 return parse_dictionary(comp, tuples, block_size, (void **)&tplg->libs,
519 &tplg->num_libs, sizeof(*tplg->libs),
520 AVS_TKN_MANIFEST_NUM_LIBRARIES_U32,
521 AVS_TKN_LIBRARY_ID_U32,
522 library_parsers, ARRAY_SIZE(library_parsers));
523 }
524
525 static const struct avs_tplg_token_parser audio_format_parsers[] = {
526 {
527 .token = AVS_TKN_AFMT_SAMPLE_RATE_U32,
528 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
529 .offset = offsetof(struct avs_audio_format, sampling_freq),
530 .parse = avs_parse_word_token,
531 },
532 {
533 .token = AVS_TKN_AFMT_BIT_DEPTH_U32,
534 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
535 .offset = offsetof(struct avs_audio_format, bit_depth),
536 .parse = avs_parse_word_token,
537 },
538 {
539 .token = AVS_TKN_AFMT_CHANNEL_MAP_U32,
540 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
541 .offset = offsetof(struct avs_audio_format, channel_map),
542 .parse = avs_parse_word_token,
543 },
544 {
545 .token = AVS_TKN_AFMT_CHANNEL_CFG_U32,
546 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
547 .offset = offsetof(struct avs_audio_format, channel_config),
548 .parse = avs_parse_word_token,
549 },
550 {
551 .token = AVS_TKN_AFMT_INTERLEAVING_U32,
552 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
553 .offset = offsetof(struct avs_audio_format, interleaving),
554 .parse = avs_parse_word_token,
555 },
556 {
557 .token = AVS_TKN_AFMT_NUM_CHANNELS_U32,
558 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
559 .offset = AVS_TKN_AFMT_NUM_CHANNELS_U32,
560 .parse = parse_audio_format_bitfield,
561 },
562 {
563 .token = AVS_TKN_AFMT_VALID_BIT_DEPTH_U32,
564 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
565 .offset = AVS_TKN_AFMT_VALID_BIT_DEPTH_U32,
566 .parse = parse_audio_format_bitfield,
567 },
568 {
569 .token = AVS_TKN_AFMT_SAMPLE_TYPE_U32,
570 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
571 .offset = AVS_TKN_AFMT_SAMPLE_TYPE_U32,
572 .parse = parse_audio_format_bitfield,
573 },
574 };
575
avs_tplg_parse_audio_formats(struct snd_soc_component * comp,struct snd_soc_tplg_vendor_array * tuples,u32 block_size)576 static int avs_tplg_parse_audio_formats(struct snd_soc_component *comp,
577 struct snd_soc_tplg_vendor_array *tuples,
578 u32 block_size)
579 {
580 struct avs_soc_component *acomp = to_avs_soc_component(comp);
581 struct avs_tplg *tplg = acomp->tplg;
582
583 return parse_dictionary(comp, tuples, block_size, (void **)&tplg->fmts,
584 &tplg->num_fmts, sizeof(*tplg->fmts),
585 AVS_TKN_MANIFEST_NUM_AFMTS_U32,
586 AVS_TKN_AFMT_ID_U32,
587 audio_format_parsers, ARRAY_SIZE(audio_format_parsers));
588 }
589
590 static const struct avs_tplg_token_parser modcfg_base_parsers[] = {
591 {
592 .token = AVS_TKN_MODCFG_BASE_CPC_U32,
593 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
594 .offset = offsetof(struct avs_tplg_modcfg_base, cpc),
595 .parse = avs_parse_word_token,
596 },
597 {
598 .token = AVS_TKN_MODCFG_BASE_IBS_U32,
599 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
600 .offset = offsetof(struct avs_tplg_modcfg_base, ibs),
601 .parse = avs_parse_word_token,
602 },
603 {
604 .token = AVS_TKN_MODCFG_BASE_OBS_U32,
605 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
606 .offset = offsetof(struct avs_tplg_modcfg_base, obs),
607 .parse = avs_parse_word_token,
608 },
609 {
610 .token = AVS_TKN_MODCFG_BASE_PAGES_U32,
611 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
612 .offset = offsetof(struct avs_tplg_modcfg_base, is_pages),
613 .parse = avs_parse_word_token,
614 },
615 };
616
avs_tplg_parse_modcfgs_base(struct snd_soc_component * comp,struct snd_soc_tplg_vendor_array * tuples,u32 block_size)617 static int avs_tplg_parse_modcfgs_base(struct snd_soc_component *comp,
618 struct snd_soc_tplg_vendor_array *tuples,
619 u32 block_size)
620 {
621 struct avs_soc_component *acomp = to_avs_soc_component(comp);
622 struct avs_tplg *tplg = acomp->tplg;
623
624 return parse_dictionary(comp, tuples, block_size, (void **)&tplg->modcfgs_base,
625 &tplg->num_modcfgs_base, sizeof(*tplg->modcfgs_base),
626 AVS_TKN_MANIFEST_NUM_MODCFGS_BASE_U32,
627 AVS_TKN_MODCFG_BASE_ID_U32,
628 modcfg_base_parsers, ARRAY_SIZE(modcfg_base_parsers));
629 }
630
631 static const struct avs_tplg_token_parser modcfg_ext_parsers[] = {
632 {
633 .token = AVS_TKN_MODCFG_EXT_TYPE_UUID,
634 .type = SND_SOC_TPLG_TUPLE_TYPE_UUID,
635 .offset = offsetof(struct avs_tplg_modcfg_ext, type),
636 .parse = avs_parse_uuid_token,
637 },
638 {
639 .token = AVS_TKN_MODCFG_CPR_OUT_AFMT_ID_U32,
640 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
641 .offset = offsetof(struct avs_tplg_modcfg_ext, copier.out_fmt),
642 .parse = avs_parse_audio_format_ptr,
643 },
644 {
645 .token = AVS_TKN_MODCFG_CPR_FEATURE_MASK_U32,
646 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
647 .offset = offsetof(struct avs_tplg_modcfg_ext, copier.feature_mask),
648 .parse = avs_parse_word_token,
649 },
650 {
651 .token = AVS_TKN_MODCFG_CPR_VINDEX_U8,
652 .type = SND_SOC_TPLG_TUPLE_TYPE_BYTE,
653 .offset = offsetof(struct avs_tplg_modcfg_ext, copier.vindex),
654 .parse = avs_parse_byte_token,
655 },
656 {
657 .token = AVS_TKN_MODCFG_CPR_DMA_TYPE_U32,
658 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
659 .offset = offsetof(struct avs_tplg_modcfg_ext, copier.dma_type),
660 .parse = avs_parse_word_token,
661 },
662 {
663 .token = AVS_TKN_MODCFG_CPR_DMABUFF_SIZE_U32,
664 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
665 .offset = offsetof(struct avs_tplg_modcfg_ext, copier.dma_buffer_size),
666 .parse = avs_parse_word_token,
667 },
668 {
669 .token = AVS_TKN_MODCFG_CPR_BLOB_FMT_ID_U32,
670 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
671 .offset = offsetof(struct avs_tplg_modcfg_ext, copier.blob_fmt),
672 .parse = avs_parse_audio_format_ptr,
673 },
674 {
675 .token = AVS_TKN_MODCFG_MICSEL_OUT_AFMT_ID_U32,
676 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
677 .offset = offsetof(struct avs_tplg_modcfg_ext, micsel.out_fmt),
678 .parse = avs_parse_audio_format_ptr,
679 },
680 {
681 .token = AVS_TKN_MODCFG_INTELWOV_CPC_LP_MODE_U32,
682 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
683 .offset = offsetof(struct avs_tplg_modcfg_ext, wov.cpc_lp_mode),
684 .parse = avs_parse_word_token,
685 },
686 {
687 .token = AVS_TKN_MODCFG_SRC_OUT_FREQ_U32,
688 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
689 .offset = offsetof(struct avs_tplg_modcfg_ext, src.out_freq),
690 .parse = avs_parse_word_token,
691 },
692 {
693 .token = AVS_TKN_MODCFG_MUX_REF_AFMT_ID_U32,
694 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
695 .offset = offsetof(struct avs_tplg_modcfg_ext, mux.ref_fmt),
696 .parse = avs_parse_audio_format_ptr,
697 },
698 {
699 .token = AVS_TKN_MODCFG_MUX_OUT_AFMT_ID_U32,
700 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
701 .offset = offsetof(struct avs_tplg_modcfg_ext, mux.out_fmt),
702 .parse = avs_parse_audio_format_ptr,
703 },
704 {
705 .token = AVS_TKN_MODCFG_AEC_REF_AFMT_ID_U32,
706 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
707 .offset = offsetof(struct avs_tplg_modcfg_ext, aec.ref_fmt),
708 .parse = avs_parse_audio_format_ptr,
709 },
710 {
711 .token = AVS_TKN_MODCFG_AEC_OUT_AFMT_ID_U32,
712 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
713 .offset = offsetof(struct avs_tplg_modcfg_ext, aec.out_fmt),
714 .parse = avs_parse_audio_format_ptr,
715 },
716 {
717 .token = AVS_TKN_MODCFG_AEC_CPC_LP_MODE_U32,
718 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
719 .offset = offsetof(struct avs_tplg_modcfg_ext, aec.cpc_lp_mode),
720 .parse = avs_parse_word_token,
721 },
722 {
723 .token = AVS_TKN_MODCFG_ASRC_OUT_FREQ_U32,
724 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
725 .offset = offsetof(struct avs_tplg_modcfg_ext, asrc.out_freq),
726 .parse = avs_parse_word_token,
727 },
728 {
729 .token = AVS_TKN_MODCFG_ASRC_MODE_U8,
730 .type = SND_SOC_TPLG_TUPLE_TYPE_BYTE,
731 .offset = offsetof(struct avs_tplg_modcfg_ext, asrc.mode),
732 .parse = avs_parse_byte_token,
733 },
734 {
735 .token = AVS_TKN_MODCFG_ASRC_DISABLE_JITTER_U8,
736 .type = SND_SOC_TPLG_TUPLE_TYPE_BYTE,
737 .offset = offsetof(struct avs_tplg_modcfg_ext, asrc.disable_jitter_buffer),
738 .parse = avs_parse_byte_token,
739 },
740 {
741 .token = AVS_TKN_MODCFG_UPDOWN_MIX_OUT_CHAN_CFG_U32,
742 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
743 .offset = offsetof(struct avs_tplg_modcfg_ext, updown_mix.out_channel_config),
744 .parse = avs_parse_word_token,
745 },
746 {
747 .token = AVS_TKN_MODCFG_UPDOWN_MIX_COEFF_SELECT_U32,
748 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
749 .offset = offsetof(struct avs_tplg_modcfg_ext, updown_mix.coefficients_select),
750 .parse = avs_parse_word_token,
751 },
752 {
753 .token = AVS_TKN_MODCFG_UPDOWN_MIX_COEFF_0_S32,
754 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
755 .offset = offsetof(struct avs_tplg_modcfg_ext, updown_mix.coefficients[0]),
756 .parse = avs_parse_word_token,
757 },
758 {
759 .token = AVS_TKN_MODCFG_UPDOWN_MIX_COEFF_1_S32,
760 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
761 .offset = offsetof(struct avs_tplg_modcfg_ext, updown_mix.coefficients[1]),
762 .parse = avs_parse_word_token,
763 },
764 {
765 .token = AVS_TKN_MODCFG_UPDOWN_MIX_COEFF_2_S32,
766 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
767 .offset = offsetof(struct avs_tplg_modcfg_ext, updown_mix.coefficients[2]),
768 .parse = avs_parse_word_token,
769 },
770 {
771 .token = AVS_TKN_MODCFG_UPDOWN_MIX_COEFF_3_S32,
772 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
773 .offset = offsetof(struct avs_tplg_modcfg_ext, updown_mix.coefficients[3]),
774 .parse = avs_parse_word_token,
775 },
776 {
777 .token = AVS_TKN_MODCFG_UPDOWN_MIX_COEFF_4_S32,
778 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
779 .offset = offsetof(struct avs_tplg_modcfg_ext, updown_mix.coefficients[4]),
780 .parse = avs_parse_word_token,
781 },
782 {
783 .token = AVS_TKN_MODCFG_UPDOWN_MIX_COEFF_5_S32,
784 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
785 .offset = offsetof(struct avs_tplg_modcfg_ext, updown_mix.coefficients[5]),
786 .parse = avs_parse_word_token,
787 },
788 {
789 .token = AVS_TKN_MODCFG_UPDOWN_MIX_COEFF_6_S32,
790 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
791 .offset = offsetof(struct avs_tplg_modcfg_ext, updown_mix.coefficients[6]),
792 .parse = avs_parse_word_token,
793 },
794 {
795 .token = AVS_TKN_MODCFG_UPDOWN_MIX_COEFF_7_S32,
796 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
797 .offset = offsetof(struct avs_tplg_modcfg_ext, updown_mix.coefficients[7]),
798 .parse = avs_parse_word_token,
799 },
800 {
801 .token = AVS_TKN_MODCFG_UPDOWN_MIX_CHAN_MAP_U32,
802 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
803 .offset = offsetof(struct avs_tplg_modcfg_ext, updown_mix.channel_map),
804 .parse = avs_parse_word_token,
805 },
806 {
807 .token = AVS_TKN_MODCFG_EXT_NUM_INPUT_PINS_U16,
808 .type = SND_SOC_TPLG_TUPLE_TYPE_SHORT,
809 .offset = offsetof(struct avs_tplg_modcfg_ext, generic.num_input_pins),
810 .parse = avs_parse_short_token,
811 },
812 {
813 .token = AVS_TKN_MODCFG_EXT_NUM_OUTPUT_PINS_U16,
814 .type = SND_SOC_TPLG_TUPLE_TYPE_SHORT,
815 .offset = offsetof(struct avs_tplg_modcfg_ext, generic.num_output_pins),
816 .parse = avs_parse_short_token,
817 },
818 };
819
820 static const struct avs_tplg_token_parser pin_format_parsers[] = {
821 {
822 .token = AVS_TKN_PIN_FMT_INDEX_U32,
823 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
824 .offset = offsetof(struct avs_tplg_pin_format, pin_index),
825 .parse = avs_parse_word_token,
826 },
827 {
828 .token = AVS_TKN_PIN_FMT_IOBS_U32,
829 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
830 .offset = offsetof(struct avs_tplg_pin_format, iobs),
831 .parse = avs_parse_word_token,
832 },
833 {
834 .token = AVS_TKN_PIN_FMT_AFMT_ID_U32,
835 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
836 .offset = offsetof(struct avs_tplg_pin_format, fmt),
837 .parse = avs_parse_audio_format_ptr,
838 },
839 };
840
841 static void
assign_copier_gtw_instance(struct snd_soc_component * comp,struct avs_tplg_modcfg_ext * cfg)842 assign_copier_gtw_instance(struct snd_soc_component *comp, struct avs_tplg_modcfg_ext *cfg)
843 {
844 struct snd_soc_acpi_mach *mach;
845 int ssp_port, tdm_slot;
846
847 if (!guid_equal(&cfg->type, &AVS_COPIER_MOD_UUID))
848 return;
849
850 /* Only I2S boards assign port instance in ->i2s_link_mask. */
851 switch (cfg->copier.dma_type) {
852 case AVS_DMA_I2S_LINK_OUTPUT:
853 case AVS_DMA_I2S_LINK_INPUT:
854 break;
855 default:
856 return;
857 }
858
859 /* If topology sets value don't overwrite it */
860 if (cfg->copier.vindex.val)
861 return;
862
863 mach = dev_get_platdata(comp->card->dev);
864
865 if (!avs_mach_singular_ssp(mach))
866 return;
867 ssp_port = avs_mach_ssp_port(mach);
868
869 if (!avs_mach_singular_tdm(mach, ssp_port))
870 return;
871 tdm_slot = avs_mach_ssp_tdm(mach, ssp_port);
872
873 cfg->copier.vindex.i2s.instance = ssp_port;
874 cfg->copier.vindex.i2s.time_slot = tdm_slot;
875 }
876
avs_tplg_parse_modcfg_ext(struct snd_soc_component * comp,struct avs_tplg_modcfg_ext * cfg,struct snd_soc_tplg_vendor_array * tuples,u32 block_size)877 static int avs_tplg_parse_modcfg_ext(struct snd_soc_component *comp,
878 struct avs_tplg_modcfg_ext *cfg,
879 struct snd_soc_tplg_vendor_array *tuples,
880 u32 block_size)
881 {
882 u32 esize;
883 int ret;
884
885 /* See where pin block starts. */
886 ret = avs_tplg_vendor_entry_size(tuples, block_size,
887 AVS_TKN_PIN_FMT_INDEX_U32, &esize);
888 if (ret)
889 return ret;
890
891 ret = avs_parse_tokens(comp, cfg, modcfg_ext_parsers,
892 ARRAY_SIZE(modcfg_ext_parsers), tuples, esize);
893 if (ret)
894 return ret;
895
896 /* Update copier gateway based on board's i2s_link_mask. */
897 assign_copier_gtw_instance(comp, cfg);
898
899 block_size -= esize;
900 /* Parse trailing in/out pin formats if any. */
901 if (block_size) {
902 struct avs_tplg_pin_format *pins;
903 u32 num_pins;
904
905 num_pins = cfg->generic.num_input_pins + cfg->generic.num_output_pins;
906 if (!num_pins)
907 return -EINVAL;
908
909 pins = devm_kcalloc(comp->card->dev, num_pins, sizeof(*pins), GFP_KERNEL);
910 if (!pins)
911 return -ENOMEM;
912
913 tuples = avs_tplg_vendor_array_at(tuples, esize);
914 ret = parse_dictionary_entries(comp, tuples, block_size,
915 pins, num_pins, sizeof(*pins),
916 AVS_TKN_PIN_FMT_INDEX_U32,
917 pin_format_parsers,
918 ARRAY_SIZE(pin_format_parsers));
919 if (ret)
920 return ret;
921 cfg->generic.pin_fmts = pins;
922 }
923
924 return 0;
925 }
926
avs_tplg_parse_modcfgs_ext(struct snd_soc_component * comp,struct snd_soc_tplg_vendor_array * tuples,u32 block_size)927 static int avs_tplg_parse_modcfgs_ext(struct snd_soc_component *comp,
928 struct snd_soc_tplg_vendor_array *tuples,
929 u32 block_size)
930 {
931 struct avs_soc_component *acomp = to_avs_soc_component(comp);
932 struct avs_tplg *tplg = acomp->tplg;
933 int ret, i;
934
935 ret = parse_dictionary_header(comp, tuples, (void **)&tplg->modcfgs_ext,
936 &tplg->num_modcfgs_ext,
937 sizeof(*tplg->modcfgs_ext),
938 AVS_TKN_MANIFEST_NUM_MODCFGS_EXT_U32);
939 if (ret)
940 return ret;
941
942 block_size -= le32_to_cpu(tuples->size);
943 /* With header parsed, move on to parsing entries. */
944 tuples = avs_tplg_vendor_array_next(tuples);
945
946 for (i = 0; i < tplg->num_modcfgs_ext; i++) {
947 struct avs_tplg_modcfg_ext *cfg = &tplg->modcfgs_ext[i];
948 u32 esize;
949
950 ret = avs_tplg_vendor_entry_size(tuples, block_size,
951 AVS_TKN_MODCFG_EXT_ID_U32, &esize);
952 if (ret)
953 return ret;
954
955 ret = avs_tplg_parse_modcfg_ext(comp, cfg, tuples, esize);
956 if (ret)
957 return ret;
958
959 block_size -= esize;
960 tuples = avs_tplg_vendor_array_at(tuples, esize);
961 }
962
963 return 0;
964 }
965
966 static const struct avs_tplg_token_parser pplcfg_parsers[] = {
967 {
968 .token = AVS_TKN_PPLCFG_REQ_SIZE_U16,
969 .type = SND_SOC_TPLG_TUPLE_TYPE_SHORT,
970 .offset = offsetof(struct avs_tplg_pplcfg, req_size),
971 .parse = avs_parse_short_token,
972 },
973 {
974 .token = AVS_TKN_PPLCFG_PRIORITY_U8,
975 .type = SND_SOC_TPLG_TUPLE_TYPE_BYTE,
976 .offset = offsetof(struct avs_tplg_pplcfg, priority),
977 .parse = avs_parse_byte_token,
978 },
979 {
980 .token = AVS_TKN_PPLCFG_LOW_POWER_BOOL,
981 .type = SND_SOC_TPLG_TUPLE_TYPE_BOOL,
982 .offset = offsetof(struct avs_tplg_pplcfg, lp),
983 .parse = avs_parse_bool_token,
984 },
985 {
986 .token = AVS_TKN_PPLCFG_ATTRIBUTES_U16,
987 .type = SND_SOC_TPLG_TUPLE_TYPE_SHORT,
988 .offset = offsetof(struct avs_tplg_pplcfg, attributes),
989 .parse = avs_parse_short_token,
990 },
991 {
992 .token = AVS_TKN_PPLCFG_TRIGGER_U32,
993 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
994 .offset = offsetof(struct avs_tplg_pplcfg, trigger),
995 .parse = avs_parse_word_token,
996 },
997 };
998
avs_tplg_parse_pplcfgs(struct snd_soc_component * comp,struct snd_soc_tplg_vendor_array * tuples,u32 block_size)999 static int avs_tplg_parse_pplcfgs(struct snd_soc_component *comp,
1000 struct snd_soc_tplg_vendor_array *tuples,
1001 u32 block_size)
1002 {
1003 struct avs_soc_component *acomp = to_avs_soc_component(comp);
1004 struct avs_tplg *tplg = acomp->tplg;
1005
1006 return parse_dictionary(comp, tuples, block_size, (void **)&tplg->pplcfgs,
1007 &tplg->num_pplcfgs, sizeof(*tplg->pplcfgs),
1008 AVS_TKN_MANIFEST_NUM_PPLCFGS_U32,
1009 AVS_TKN_PPLCFG_ID_U32,
1010 pplcfg_parsers, ARRAY_SIZE(pplcfg_parsers));
1011 }
1012
1013 static const struct avs_tplg_token_parser binding_parsers[] = {
1014 {
1015 .token = AVS_TKN_BINDING_TARGET_TPLG_NAME_STRING,
1016 .type = SND_SOC_TPLG_TUPLE_TYPE_STRING,
1017 .offset = offsetof(struct avs_tplg_binding, target_tplg_name),
1018 .parse = parse_link_formatted_string,
1019 },
1020 {
1021 .token = AVS_TKN_BINDING_TARGET_PATH_TMPL_ID_U32,
1022 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1023 .offset = offsetof(struct avs_tplg_binding, target_path_tmpl_id),
1024 .parse = avs_parse_word_token,
1025 },
1026 {
1027 .token = AVS_TKN_BINDING_TARGET_PPL_ID_U32,
1028 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1029 .offset = offsetof(struct avs_tplg_binding, target_ppl_id),
1030 .parse = avs_parse_word_token,
1031 },
1032 {
1033 .token = AVS_TKN_BINDING_TARGET_MOD_ID_U32,
1034 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1035 .offset = offsetof(struct avs_tplg_binding, target_mod_id),
1036 .parse = avs_parse_word_token,
1037 },
1038 {
1039 .token = AVS_TKN_BINDING_TARGET_MOD_PIN_U8,
1040 .type = SND_SOC_TPLG_TUPLE_TYPE_BYTE,
1041 .offset = offsetof(struct avs_tplg_binding, target_mod_pin),
1042 .parse = avs_parse_byte_token,
1043 },
1044 {
1045 .token = AVS_TKN_BINDING_MOD_ID_U32,
1046 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1047 .offset = offsetof(struct avs_tplg_binding, mod_id),
1048 .parse = avs_parse_word_token,
1049 },
1050 {
1051 .token = AVS_TKN_BINDING_MOD_PIN_U8,
1052 .type = SND_SOC_TPLG_TUPLE_TYPE_BYTE,
1053 .offset = offsetof(struct avs_tplg_binding, mod_pin),
1054 .parse = avs_parse_byte_token,
1055 },
1056 {
1057 .token = AVS_TKN_BINDING_IS_SINK_U8,
1058 .type = SND_SOC_TPLG_TUPLE_TYPE_BYTE,
1059 .offset = offsetof(struct avs_tplg_binding, is_sink),
1060 .parse = avs_parse_byte_token,
1061 },
1062 };
1063
avs_tplg_parse_bindings(struct snd_soc_component * comp,struct snd_soc_tplg_vendor_array * tuples,u32 block_size)1064 static int avs_tplg_parse_bindings(struct snd_soc_component *comp,
1065 struct snd_soc_tplg_vendor_array *tuples,
1066 u32 block_size)
1067 {
1068 struct avs_soc_component *acomp = to_avs_soc_component(comp);
1069 struct avs_tplg *tplg = acomp->tplg;
1070
1071 return parse_dictionary(comp, tuples, block_size, (void **)&tplg->bindings,
1072 &tplg->num_bindings, sizeof(*tplg->bindings),
1073 AVS_TKN_MANIFEST_NUM_BINDINGS_U32,
1074 AVS_TKN_BINDING_ID_U32,
1075 binding_parsers, ARRAY_SIZE(binding_parsers));
1076 }
1077
1078 static const struct avs_tplg_token_parser module_parsers[] = {
1079 {
1080 .token = AVS_TKN_MOD_ID_U32,
1081 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1082 .offset = offsetof(struct avs_tplg_module, id),
1083 .parse = avs_parse_word_token,
1084 },
1085 {
1086 .token = AVS_TKN_MOD_MODCFG_BASE_ID_U32,
1087 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1088 .offset = offsetof(struct avs_tplg_module, cfg_base),
1089 .parse = avs_parse_modcfg_base_ptr,
1090 },
1091 {
1092 .token = AVS_TKN_MOD_IN_AFMT_ID_U32,
1093 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1094 .offset = offsetof(struct avs_tplg_module, in_fmt),
1095 .parse = avs_parse_audio_format_ptr,
1096 },
1097 {
1098 .token = AVS_TKN_MOD_CORE_ID_U8,
1099 .type = SND_SOC_TPLG_TUPLE_TYPE_BYTE,
1100 .offset = offsetof(struct avs_tplg_module, core_id),
1101 .parse = avs_parse_byte_token,
1102 },
1103 {
1104 .token = AVS_TKN_MOD_PROC_DOMAIN_U8,
1105 .type = SND_SOC_TPLG_TUPLE_TYPE_BYTE,
1106 .offset = offsetof(struct avs_tplg_module, domain),
1107 .parse = avs_parse_byte_token,
1108 },
1109 {
1110 .token = AVS_TKN_MOD_MODCFG_EXT_ID_U32,
1111 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1112 .offset = offsetof(struct avs_tplg_module, cfg_ext),
1113 .parse = avs_parse_modcfg_ext_ptr,
1114 },
1115 {
1116 .token = AVS_TKN_MOD_KCONTROL_ID_U32,
1117 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1118 .offset = offsetof(struct avs_tplg_module, ctl_id),
1119 .parse = avs_parse_byte_token,
1120 },
1121 {
1122 .token = AVS_TKN_MOD_INIT_CONFIG_NUM_IDS_U32,
1123 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1124 .offset = offsetof(struct avs_tplg_module, num_config_ids),
1125 .parse = avs_parse_byte_token,
1126 },
1127 };
1128
1129 static const struct avs_tplg_token_parser init_config_parsers[] = {
1130 {
1131 .token = AVS_TKN_MOD_INIT_CONFIG_ID_U32,
1132 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1133 .offset = 0,
1134 .parse = avs_parse_word_token,
1135 },
1136 };
1137
1138 static struct avs_tplg_module *
avs_tplg_module_create(struct snd_soc_component * comp,struct avs_tplg_pipeline * owner,struct snd_soc_tplg_vendor_array * tuples,u32 block_size)1139 avs_tplg_module_create(struct snd_soc_component *comp, struct avs_tplg_pipeline *owner,
1140 struct snd_soc_tplg_vendor_array *tuples, u32 block_size)
1141 {
1142 struct avs_tplg_module *module;
1143 u32 esize;
1144 int ret;
1145
1146 /* See where config id block starts. */
1147 ret = avs_tplg_vendor_entry_size(tuples, block_size,
1148 AVS_TKN_MOD_INIT_CONFIG_ID_U32, &esize);
1149 if (ret)
1150 return ERR_PTR(ret);
1151
1152 module = devm_kzalloc(comp->card->dev, sizeof(*module), GFP_KERNEL);
1153 if (!module)
1154 return ERR_PTR(-ENOMEM);
1155
1156 ret = avs_parse_tokens(comp, module, module_parsers,
1157 ARRAY_SIZE(module_parsers), tuples, esize);
1158 if (ret < 0)
1159 return ERR_PTR(ret);
1160
1161 block_size -= esize;
1162 /* Parse trailing config ids if any. */
1163 if (block_size) {
1164 u32 num_config_ids = module->num_config_ids;
1165 u32 *config_ids;
1166
1167 if (!num_config_ids)
1168 return ERR_PTR(-EINVAL);
1169
1170 config_ids = devm_kcalloc(comp->card->dev, num_config_ids, sizeof(*config_ids),
1171 GFP_KERNEL);
1172 if (!config_ids)
1173 return ERR_PTR(-ENOMEM);
1174
1175 tuples = avs_tplg_vendor_array_at(tuples, esize);
1176 ret = parse_dictionary_entries(comp, tuples, block_size,
1177 config_ids, num_config_ids, sizeof(*config_ids),
1178 AVS_TKN_MOD_INIT_CONFIG_ID_U32,
1179 init_config_parsers,
1180 ARRAY_SIZE(init_config_parsers));
1181 if (ret)
1182 return ERR_PTR(ret);
1183
1184 module->config_ids = config_ids;
1185 }
1186
1187 module->owner = owner;
1188 INIT_LIST_HEAD(&module->node);
1189
1190 return module;
1191 }
1192
1193 static const struct avs_tplg_token_parser pipeline_parsers[] = {
1194 {
1195 .token = AVS_TKN_PPL_ID_U32,
1196 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1197 .offset = offsetof(struct avs_tplg_pipeline, id),
1198 .parse = avs_parse_word_token,
1199 },
1200 {
1201 .token = AVS_TKN_PPL_PPLCFG_ID_U32,
1202 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1203 .offset = offsetof(struct avs_tplg_pipeline, cfg),
1204 .parse = avs_parse_pplcfg_ptr,
1205 },
1206 {
1207 .token = AVS_TKN_PPL_NUM_BINDING_IDS_U32,
1208 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1209 .offset = offsetof(struct avs_tplg_pipeline, num_bindings),
1210 .parse = avs_parse_word_token,
1211 },
1212 };
1213
1214 static const struct avs_tplg_token_parser bindings_parsers[] = {
1215 {
1216 .token = AVS_TKN_PPL_BINDING_ID_U32,
1217 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1218 .offset = 0, /* to treat pipeline->bindings as dictionary */
1219 .parse = avs_parse_binding_ptr,
1220 },
1221 };
1222
1223 static struct avs_tplg_pipeline *
avs_tplg_pipeline_create(struct snd_soc_component * comp,struct avs_tplg_path * owner,struct snd_soc_tplg_vendor_array * tuples,u32 block_size)1224 avs_tplg_pipeline_create(struct snd_soc_component *comp, struct avs_tplg_path *owner,
1225 struct snd_soc_tplg_vendor_array *tuples, u32 block_size)
1226 {
1227 struct avs_tplg_pipeline *pipeline;
1228 u32 modblk_size, offset;
1229 int ret;
1230
1231 pipeline = devm_kzalloc(comp->card->dev, sizeof(*pipeline), GFP_KERNEL);
1232 if (!pipeline)
1233 return ERR_PTR(-ENOMEM);
1234
1235 pipeline->owner = owner;
1236 INIT_LIST_HEAD(&pipeline->mod_list);
1237
1238 /* Pipeline header MUST be followed by at least one module. */
1239 ret = avs_tplg_vendor_array_lookup(tuples, block_size,
1240 AVS_TKN_MOD_ID_U32, &offset);
1241 if (!ret && !offset)
1242 ret = -EINVAL;
1243 if (ret)
1244 return ERR_PTR(ret);
1245
1246 /* Process header which precedes module sections. */
1247 ret = avs_parse_tokens(comp, pipeline, pipeline_parsers,
1248 ARRAY_SIZE(pipeline_parsers), tuples, offset);
1249 if (ret < 0)
1250 return ERR_PTR(ret);
1251
1252 block_size -= offset;
1253 tuples = avs_tplg_vendor_array_at(tuples, offset);
1254
1255 /* Optionally, binding sections follow module ones. */
1256 ret = avs_tplg_vendor_array_lookup_next(tuples, block_size,
1257 AVS_TKN_PPL_BINDING_ID_U32, &offset);
1258 if (ret) {
1259 if (ret != -ENOENT)
1260 return ERR_PTR(ret);
1261
1262 /* Does header information match actual block layout? */
1263 if (pipeline->num_bindings)
1264 return ERR_PTR(-EINVAL);
1265
1266 modblk_size = block_size;
1267 } else {
1268 pipeline->bindings = devm_kcalloc(comp->card->dev, pipeline->num_bindings,
1269 sizeof(*pipeline->bindings), GFP_KERNEL);
1270 if (!pipeline->bindings)
1271 return ERR_PTR(-ENOMEM);
1272
1273 modblk_size = offset;
1274 }
1275
1276 block_size -= modblk_size;
1277 do {
1278 struct avs_tplg_module *module;
1279 u32 esize;
1280
1281 ret = avs_tplg_vendor_entry_size(tuples, modblk_size,
1282 AVS_TKN_MOD_ID_U32, &esize);
1283 if (ret)
1284 return ERR_PTR(ret);
1285
1286 module = avs_tplg_module_create(comp, pipeline, tuples, esize);
1287 if (IS_ERR(module)) {
1288 dev_err(comp->dev, "parse module failed: %ld\n",
1289 PTR_ERR(module));
1290 return ERR_CAST(module);
1291 }
1292
1293 list_add_tail(&module->node, &pipeline->mod_list);
1294 modblk_size -= esize;
1295 tuples = avs_tplg_vendor_array_at(tuples, esize);
1296 } while (modblk_size > 0);
1297
1298 /* What's left is optional range of bindings. */
1299 ret = parse_dictionary_entries(comp, tuples, block_size, pipeline->bindings,
1300 pipeline->num_bindings, sizeof(*pipeline->bindings),
1301 AVS_TKN_PPL_BINDING_ID_U32,
1302 bindings_parsers, ARRAY_SIZE(bindings_parsers));
1303 if (ret)
1304 return ERR_PTR(ret);
1305
1306 return pipeline;
1307 }
1308
1309 static const struct avs_tplg_token_parser path_parsers[] = {
1310 {
1311 .token = AVS_TKN_PATH_ID_U32,
1312 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1313 .offset = offsetof(struct avs_tplg_path, id),
1314 .parse = avs_parse_word_token,
1315 },
1316 {
1317 .token = AVS_TKN_PATH_FE_FMT_ID_U32,
1318 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1319 .offset = offsetof(struct avs_tplg_path, fe_fmt),
1320 .parse = avs_parse_audio_format_ptr,
1321 },
1322 {
1323 .token = AVS_TKN_PATH_BE_FMT_ID_U32,
1324 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1325 .offset = offsetof(struct avs_tplg_path, be_fmt),
1326 .parse = avs_parse_audio_format_ptr,
1327 },
1328 };
1329
1330 static struct avs_tplg_path *
avs_tplg_path_create(struct snd_soc_component * comp,struct avs_tplg_path_template * owner,struct snd_soc_tplg_vendor_array * tuples,u32 block_size,const struct avs_tplg_token_parser * parsers,u32 num_parsers)1331 avs_tplg_path_create(struct snd_soc_component *comp, struct avs_tplg_path_template *owner,
1332 struct snd_soc_tplg_vendor_array *tuples, u32 block_size,
1333 const struct avs_tplg_token_parser *parsers, u32 num_parsers)
1334 {
1335 struct avs_tplg_pipeline *pipeline;
1336 struct avs_tplg_path *path;
1337 u32 offset;
1338 int ret;
1339
1340 path = devm_kzalloc(comp->card->dev, sizeof(*path), GFP_KERNEL);
1341 if (!path)
1342 return ERR_PTR(-ENOMEM);
1343
1344 path->owner = owner;
1345 INIT_LIST_HEAD(&path->ppl_list);
1346 INIT_LIST_HEAD(&path->node);
1347
1348 /* Path header MAY be followed by one or more pipelines. */
1349 ret = avs_tplg_vendor_array_lookup(tuples, block_size,
1350 AVS_TKN_PPL_ID_U32, &offset);
1351 if (ret == -ENOENT)
1352 offset = block_size;
1353 else if (ret)
1354 return ERR_PTR(ret);
1355 else if (!offset)
1356 return ERR_PTR(-EINVAL);
1357
1358 /* Process header which precedes pipeline sections. */
1359 ret = avs_parse_tokens(comp, path, parsers, num_parsers, tuples, offset);
1360 if (ret < 0)
1361 return ERR_PTR(ret);
1362
1363 block_size -= offset;
1364 tuples = avs_tplg_vendor_array_at(tuples, offset);
1365 while (block_size > 0) {
1366 u32 esize;
1367
1368 ret = avs_tplg_vendor_entry_size(tuples, block_size,
1369 AVS_TKN_PPL_ID_U32, &esize);
1370 if (ret)
1371 return ERR_PTR(ret);
1372
1373 pipeline = avs_tplg_pipeline_create(comp, path, tuples, esize);
1374 if (IS_ERR(pipeline)) {
1375 dev_err(comp->dev, "parse pipeline failed: %ld\n",
1376 PTR_ERR(pipeline));
1377 return ERR_CAST(pipeline);
1378 }
1379
1380 list_add_tail(&pipeline->node, &path->ppl_list);
1381 block_size -= esize;
1382 tuples = avs_tplg_vendor_array_at(tuples, esize);
1383 }
1384
1385 return path;
1386 }
1387
1388 static const struct avs_tplg_token_parser path_tmpl_parsers[] = {
1389 {
1390 .token = AVS_TKN_PATH_TMPL_ID_U32,
1391 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1392 .offset = offsetof(struct avs_tplg_path_template, id),
1393 .parse = avs_parse_word_token,
1394 },
1395 };
1396
parse_path_template(struct snd_soc_component * comp,struct snd_soc_tplg_vendor_array * tuples,u32 block_size,struct avs_tplg_path_template * template,const struct avs_tplg_token_parser * tmpl_tokens,u32 num_tmpl_tokens,const struct avs_tplg_token_parser * path_tokens,u32 num_path_tokens)1397 static int parse_path_template(struct snd_soc_component *comp,
1398 struct snd_soc_tplg_vendor_array *tuples, u32 block_size,
1399 struct avs_tplg_path_template *template,
1400 const struct avs_tplg_token_parser *tmpl_tokens, u32 num_tmpl_tokens,
1401 const struct avs_tplg_token_parser *path_tokens, u32 num_path_tokens)
1402 {
1403 struct avs_tplg_path *path;
1404 u32 offset;
1405 int ret;
1406
1407 /* Path template header MUST be followed by at least one path variant. */
1408 ret = avs_tplg_vendor_array_lookup(tuples, block_size,
1409 AVS_TKN_PATH_ID_U32, &offset);
1410 if (ret)
1411 return ret;
1412
1413 /* Process header which precedes path variants sections. */
1414 ret = avs_parse_tokens(comp, template, tmpl_tokens, num_tmpl_tokens, tuples, offset);
1415 if (ret < 0)
1416 return ret;
1417
1418 block_size -= offset;
1419 tuples = avs_tplg_vendor_array_at(tuples, offset);
1420 do {
1421 u32 esize;
1422
1423 ret = avs_tplg_vendor_entry_size(tuples, block_size,
1424 AVS_TKN_PATH_ID_U32, &esize);
1425 if (ret)
1426 return ret;
1427
1428 path = avs_tplg_path_create(comp, template, tuples, esize, path_tokens,
1429 num_path_tokens);
1430 if (IS_ERR(path)) {
1431 dev_err(comp->dev, "parse path failed: %ld\n", PTR_ERR(path));
1432 return PTR_ERR(path);
1433 }
1434
1435 list_add_tail(&path->node, &template->path_list);
1436 block_size -= esize;
1437 tuples = avs_tplg_vendor_array_at(tuples, esize);
1438 } while (block_size > 0);
1439
1440 return 0;
1441 }
1442
1443 static struct avs_tplg_path_template *
avs_tplg_path_template_create(struct snd_soc_component * comp,struct avs_tplg * owner,struct snd_soc_tplg_vendor_array * tuples,u32 block_size)1444 avs_tplg_path_template_create(struct snd_soc_component *comp, struct avs_tplg *owner,
1445 struct snd_soc_tplg_vendor_array *tuples, u32 block_size)
1446 {
1447 struct avs_tplg_path_template *template;
1448 int ret;
1449
1450 template = devm_kzalloc(comp->card->dev, sizeof(*template), GFP_KERNEL);
1451 if (!template)
1452 return ERR_PTR(-ENOMEM);
1453
1454 template->owner = owner; /* Used to access component tplg is assigned to. */
1455 INIT_LIST_HEAD(&template->path_list);
1456 INIT_LIST_HEAD(&template->node);
1457
1458 ret = parse_path_template(comp, tuples, block_size, template, path_tmpl_parsers,
1459 ARRAY_SIZE(path_tmpl_parsers), path_parsers,
1460 ARRAY_SIZE(path_parsers));
1461 if (ret)
1462 return ERR_PTR(ret);
1463
1464 return template;
1465 }
1466
1467 static const struct avs_tplg_token_parser mod_init_config_parsers[] = {
1468 {
1469 .token = AVS_TKN_MOD_INIT_CONFIG_ID_U32,
1470 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1471 .offset = offsetof(struct avs_tplg_init_config, id),
1472 .parse = avs_parse_word_token,
1473 },
1474 {
1475 .token = AVS_TKN_INIT_CONFIG_PARAM_U8,
1476 .type = SND_SOC_TPLG_TUPLE_TYPE_BYTE,
1477 .offset = offsetof(struct avs_tplg_init_config, param),
1478 .parse = avs_parse_byte_token,
1479 },
1480 {
1481 .token = AVS_TKN_INIT_CONFIG_LENGTH_U32,
1482 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1483 .offset = offsetof(struct avs_tplg_init_config, length),
1484 .parse = avs_parse_word_token,
1485 },
1486 };
1487
avs_tplg_parse_initial_configs(struct snd_soc_component * comp,struct snd_soc_tplg_vendor_array * tuples,u32 block_size)1488 static int avs_tplg_parse_initial_configs(struct snd_soc_component *comp,
1489 struct snd_soc_tplg_vendor_array *tuples,
1490 u32 block_size)
1491 {
1492 struct avs_soc_component *acomp = to_avs_soc_component(comp);
1493 struct avs_tplg *tplg = acomp->tplg;
1494 int ret, i;
1495
1496 /* Parse tuple section telling how many init configs there are. */
1497 ret = parse_dictionary_header(comp, tuples, (void **)&tplg->init_configs,
1498 &tplg->num_init_configs,
1499 sizeof(*tplg->init_configs),
1500 AVS_TKN_MANIFEST_NUM_INIT_CONFIGS_U32);
1501 if (ret)
1502 return ret;
1503
1504 block_size -= le32_to_cpu(tuples->size);
1505 /* With header parsed, move on to parsing entries. */
1506 tuples = avs_tplg_vendor_array_next(tuples);
1507
1508 for (i = 0; i < tplg->num_init_configs && block_size > 0; i++) {
1509 struct avs_tplg_init_config *config = &tplg->init_configs[i];
1510 struct snd_soc_tplg_vendor_array *tmp;
1511 void *init_config_data;
1512 u32 esize;
1513
1514 /*
1515 * Usually to get section length we search for first token of next group of data,
1516 * but in this case we can't as tuples are followed by raw data.
1517 */
1518 tmp = avs_tplg_vendor_array_next(tuples);
1519 esize = le32_to_cpu(tuples->size) + le32_to_cpu(tmp->size);
1520
1521 ret = parse_dictionary_entries(comp, tuples, esize, config, 1, sizeof(*config),
1522 AVS_TKN_MOD_INIT_CONFIG_ID_U32,
1523 mod_init_config_parsers,
1524 ARRAY_SIZE(mod_init_config_parsers));
1525
1526 block_size -= esize;
1527
1528 /* handle raw data section */
1529 init_config_data = (void *)tuples + esize;
1530 esize = config->length;
1531
1532 config->data = devm_kmemdup(comp->card->dev, init_config_data, esize, GFP_KERNEL);
1533 if (!config->data)
1534 return -ENOMEM;
1535
1536 tuples = init_config_data + esize;
1537 block_size -= esize;
1538 }
1539
1540 return 0;
1541 }
1542
avs_route_load(struct snd_soc_component * comp,int index,struct snd_soc_dapm_route * route)1543 static int avs_route_load(struct snd_soc_component *comp, int index,
1544 struct snd_soc_dapm_route *route)
1545 {
1546 struct snd_soc_acpi_mach *mach = dev_get_platdata(comp->card->dev);
1547 size_t len = SNDRV_CTL_ELEM_ID_NAME_MAXLEN;
1548 int ssp_port, tdm_slot;
1549 char *buf;
1550
1551 /* See parse_link_formatted_string() for dynamic naming when(s). */
1552 if (!avs_mach_singular_ssp(mach))
1553 return 0;
1554 ssp_port = avs_mach_ssp_port(mach);
1555
1556 if (!avs_mach_singular_tdm(mach, ssp_port))
1557 return 0;
1558 tdm_slot = avs_mach_ssp_tdm(mach, ssp_port);
1559
1560 buf = devm_kzalloc(comp->card->dev, len, GFP_KERNEL);
1561 if (!buf)
1562 return -ENOMEM;
1563 avs_ssp_sprint(buf, len, route->source, ssp_port, tdm_slot);
1564 route->source = buf;
1565
1566 buf = devm_kzalloc(comp->card->dev, len, GFP_KERNEL);
1567 if (!buf)
1568 return -ENOMEM;
1569 avs_ssp_sprint(buf, len, route->sink, ssp_port, tdm_slot);
1570 route->sink = buf;
1571
1572 if (route->control) {
1573 buf = devm_kzalloc(comp->card->dev, len, GFP_KERNEL);
1574 if (!buf)
1575 return -ENOMEM;
1576 avs_ssp_sprint(buf, len, route->control, ssp_port, tdm_slot);
1577 route->control = buf;
1578 }
1579
1580 return 0;
1581 }
1582
avs_widget_load(struct snd_soc_component * comp,int index,struct snd_soc_dapm_widget * w,struct snd_soc_tplg_dapm_widget * dw)1583 static int avs_widget_load(struct snd_soc_component *comp, int index,
1584 struct snd_soc_dapm_widget *w,
1585 struct snd_soc_tplg_dapm_widget *dw)
1586 {
1587 struct snd_soc_acpi_mach *mach;
1588 struct avs_tplg_path_template *template;
1589 struct avs_soc_component *acomp = to_avs_soc_component(comp);
1590 struct avs_tplg *tplg;
1591 int ssp_port, tdm_slot;
1592
1593 if (!le32_to_cpu(dw->priv.size))
1594 return 0;
1595
1596 w->no_wname_in_kcontrol_name = true;
1597
1598 if (w->ignore_suspend && !AVS_S0IX_SUPPORTED) {
1599 dev_info_once(comp->dev, "Device does not support S0IX, check BIOS settings\n");
1600 w->ignore_suspend = false;
1601 }
1602
1603 tplg = acomp->tplg;
1604 mach = dev_get_platdata(comp->card->dev);
1605 if (!avs_mach_singular_ssp(mach))
1606 goto static_name;
1607 ssp_port = avs_mach_ssp_port(mach);
1608
1609 /* See parse_link_formatted_string() for dynamic naming when(s). */
1610 if (avs_mach_singular_tdm(mach, ssp_port)) {
1611 /* size is based on possible %d -> SSP:TDM, where SSP and TDM < 10 + '\0' */
1612 size_t size = strlen(dw->name) + 2;
1613 char *buf;
1614
1615 tdm_slot = avs_mach_ssp_tdm(mach, ssp_port);
1616
1617 buf = kmalloc(size, GFP_KERNEL);
1618 if (!buf)
1619 return -ENOMEM;
1620 avs_ssp_sprint(buf, size, dw->name, ssp_port, tdm_slot);
1621 kfree(w->name);
1622 /* w->name is freed later by soc_tplg_dapm_widget_create() */
1623 w->name = buf;
1624 }
1625
1626 static_name:
1627 template = avs_tplg_path_template_create(comp, tplg, dw->priv.array,
1628 le32_to_cpu(dw->priv.size));
1629 if (IS_ERR(template)) {
1630 dev_err(comp->dev, "widget %s load failed: %ld\n", dw->name,
1631 PTR_ERR(template));
1632 return PTR_ERR(template);
1633 }
1634
1635 w->priv = template; /* link path information to widget */
1636 list_add_tail(&template->node, &tplg->path_tmpl_list);
1637 return 0;
1638 }
1639
avs_widget_ready(struct snd_soc_component * comp,int index,struct snd_soc_dapm_widget * w,struct snd_soc_tplg_dapm_widget * dw)1640 static int avs_widget_ready(struct snd_soc_component *comp, int index,
1641 struct snd_soc_dapm_widget *w,
1642 struct snd_soc_tplg_dapm_widget *dw)
1643 {
1644 struct avs_tplg_path_template *template = w->priv;
1645
1646 template->w = w;
1647 return 0;
1648 }
1649
avs_dai_load(struct snd_soc_component * comp,int index,struct snd_soc_dai_driver * dai_drv,struct snd_soc_tplg_pcm * pcm,struct snd_soc_dai * dai)1650 static int avs_dai_load(struct snd_soc_component *comp, int index,
1651 struct snd_soc_dai_driver *dai_drv, struct snd_soc_tplg_pcm *pcm,
1652 struct snd_soc_dai *dai)
1653 {
1654 u32 fe_subformats = SNDRV_PCM_SUBFMTBIT_MSBITS_20 |
1655 SNDRV_PCM_SUBFMTBIT_MSBITS_24 |
1656 SNDRV_PCM_SUBFMTBIT_MSBITS_MAX;
1657
1658 if (pcm) {
1659 dai_drv->ops = &avs_dai_fe_ops;
1660 dai_drv->capture.subformats = fe_subformats;
1661 dai_drv->playback.subformats = fe_subformats;
1662 }
1663
1664 return 0;
1665 }
1666
avs_link_load(struct snd_soc_component * comp,int index,struct snd_soc_dai_link * link,struct snd_soc_tplg_link_config * cfg)1667 static int avs_link_load(struct snd_soc_component *comp, int index, struct snd_soc_dai_link *link,
1668 struct snd_soc_tplg_link_config *cfg)
1669 {
1670 if (link->ignore_suspend && !AVS_S0IX_SUPPORTED) {
1671 dev_info_once(comp->dev, "Device does not support S0IX, check BIOS settings\n");
1672 link->ignore_suspend = false;
1673 }
1674
1675 if (!link->no_pcm) {
1676 /* Stream control handled by IPCs. */
1677 link->nonatomic = true;
1678
1679 /* Open LINK (BE) pipes last and close them first to prevent xruns. */
1680 link->trigger[0] = SND_SOC_DPCM_TRIGGER_PRE;
1681 link->trigger[1] = SND_SOC_DPCM_TRIGGER_PRE;
1682 } else {
1683 /* Do not ignore codec capabilities. */
1684 link->dpcm_merged_format = 1;
1685 }
1686
1687 return 0;
1688 }
1689
1690 static const struct avs_tplg_token_parser manifest_parsers[] = {
1691 {
1692 .token = AVS_TKN_MANIFEST_NAME_STRING,
1693 .type = SND_SOC_TPLG_TUPLE_TYPE_STRING,
1694 .offset = offsetof(struct avs_tplg, name),
1695 .parse = parse_link_formatted_string,
1696 },
1697 {
1698 .token = AVS_TKN_MANIFEST_VERSION_U32,
1699 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1700 .offset = offsetof(struct avs_tplg, version),
1701 .parse = avs_parse_word_token,
1702 },
1703 };
1704
avs_manifest(struct snd_soc_component * comp,int index,struct snd_soc_tplg_manifest * manifest)1705 static int avs_manifest(struct snd_soc_component *comp, int index,
1706 struct snd_soc_tplg_manifest *manifest)
1707 {
1708 struct snd_soc_tplg_vendor_array *tuples = manifest->priv.array;
1709 struct avs_soc_component *acomp = to_avs_soc_component(comp);
1710 size_t remaining = le32_to_cpu(manifest->priv.size);
1711 bool has_init_config = true;
1712 u32 offset;
1713 int ret;
1714
1715 ret = avs_tplg_vendor_array_lookup(tuples, remaining,
1716 AVS_TKN_MANIFEST_NUM_LIBRARIES_U32, &offset);
1717 /* Manifest MUST begin with a header. */
1718 if (!ret && !offset)
1719 ret = -EINVAL;
1720 if (ret) {
1721 dev_err(comp->dev, "incorrect manifest format: %d\n", ret);
1722 return ret;
1723 }
1724
1725 /* Process header which precedes any of the dictionaries. */
1726 ret = avs_parse_tokens(comp, acomp->tplg, manifest_parsers,
1727 ARRAY_SIZE(manifest_parsers), tuples, offset);
1728 if (ret < 0)
1729 return ret;
1730
1731 remaining -= offset;
1732 tuples = avs_tplg_vendor_array_at(tuples, offset);
1733
1734 ret = avs_tplg_vendor_array_lookup(tuples, remaining,
1735 AVS_TKN_MANIFEST_NUM_AFMTS_U32, &offset);
1736 if (ret) {
1737 dev_err(comp->dev, "audio formats lookup failed: %d\n", ret);
1738 return ret;
1739 }
1740
1741 /* Libraries dictionary. */
1742 ret = avs_tplg_parse_libraries(comp, tuples, offset);
1743 if (ret < 0)
1744 return ret;
1745
1746 remaining -= offset;
1747 tuples = avs_tplg_vendor_array_at(tuples, offset);
1748
1749 ret = avs_tplg_vendor_array_lookup(tuples, remaining,
1750 AVS_TKN_MANIFEST_NUM_MODCFGS_BASE_U32, &offset);
1751 if (ret) {
1752 dev_err(comp->dev, "modcfgs_base lookup failed: %d\n", ret);
1753 return ret;
1754 }
1755
1756 /* Audio formats dictionary. */
1757 ret = avs_tplg_parse_audio_formats(comp, tuples, offset);
1758 if (ret < 0)
1759 return ret;
1760
1761 remaining -= offset;
1762 tuples = avs_tplg_vendor_array_at(tuples, offset);
1763
1764 ret = avs_tplg_vendor_array_lookup(tuples, remaining,
1765 AVS_TKN_MANIFEST_NUM_MODCFGS_EXT_U32, &offset);
1766 if (ret) {
1767 dev_err(comp->dev, "modcfgs_ext lookup failed: %d\n", ret);
1768 return ret;
1769 }
1770
1771 /* Module configs-base dictionary. */
1772 ret = avs_tplg_parse_modcfgs_base(comp, tuples, offset);
1773 if (ret < 0)
1774 return ret;
1775
1776 remaining -= offset;
1777 tuples = avs_tplg_vendor_array_at(tuples, offset);
1778
1779 ret = avs_tplg_vendor_array_lookup(tuples, remaining,
1780 AVS_TKN_MANIFEST_NUM_PPLCFGS_U32, &offset);
1781 if (ret) {
1782 dev_err(comp->dev, "pplcfgs lookup failed: %d\n", ret);
1783 return ret;
1784 }
1785
1786 /* Module configs-ext dictionary. */
1787 ret = avs_tplg_parse_modcfgs_ext(comp, tuples, offset);
1788 if (ret < 0)
1789 return ret;
1790
1791 remaining -= offset;
1792 tuples = avs_tplg_vendor_array_at(tuples, offset);
1793
1794 ret = avs_tplg_vendor_array_lookup(tuples, remaining,
1795 AVS_TKN_MANIFEST_NUM_BINDINGS_U32, &offset);
1796 if (ret) {
1797 dev_err(comp->dev, "bindings lookup failed: %d\n", ret);
1798 return ret;
1799 }
1800
1801 /* Pipeline configs dictionary. */
1802 ret = avs_tplg_parse_pplcfgs(comp, tuples, offset);
1803 if (ret < 0)
1804 return ret;
1805
1806 remaining -= offset;
1807 tuples = avs_tplg_vendor_array_at(tuples, offset);
1808
1809 ret = avs_tplg_vendor_array_lookup(tuples, remaining,
1810 AVS_TKN_MANIFEST_NUM_CONDPATH_TMPLS_U32, &offset);
1811 if (ret) {
1812 dev_err(comp->dev, "condpath lookup failed: %d\n", ret);
1813 return ret;
1814 }
1815
1816 /* Bindings dictionary. */
1817 ret = avs_tplg_parse_bindings(comp, tuples, offset);
1818 if (ret < 0)
1819 return ret;
1820
1821 remaining -= offset;
1822 tuples = avs_tplg_vendor_array_at(tuples, offset);
1823
1824 ret = avs_tplg_vendor_array_lookup(tuples, remaining,
1825 AVS_TKN_MANIFEST_NUM_INIT_CONFIGS_U32, &offset);
1826 if (ret == -ENOENT) {
1827 dev_dbg(comp->dev, "init config lookup failed: %d\n", ret);
1828 has_init_config = false;
1829 } else if (ret) {
1830 dev_err(comp->dev, "init config lookup failed: %d\n", ret);
1831 return ret;
1832 }
1833
1834 if (!has_init_config)
1835 return 0;
1836
1837 remaining -= offset;
1838 tuples = avs_tplg_vendor_array_at(tuples, offset);
1839
1840 /* Initial configs dictionary. */
1841 ret = avs_tplg_parse_initial_configs(comp, tuples, remaining);
1842 if (ret < 0)
1843 return ret;
1844
1845 return 0;
1846 }
1847
1848 #define AVS_CONTROL_OPS_VOLUME 257
1849
1850 static const struct snd_soc_tplg_kcontrol_ops avs_control_ops[] = {
1851 {
1852 .id = AVS_CONTROL_OPS_VOLUME,
1853 .get = avs_control_volume_get,
1854 .put = avs_control_volume_put,
1855 },
1856 };
1857
1858 static const struct avs_tplg_token_parser control_parsers[] = {
1859 {
1860 .token = AVS_TKN_KCONTROL_ID_U32,
1861 .type = SND_SOC_TPLG_TUPLE_TYPE_WORD,
1862 .offset = offsetof(struct avs_control_data, id),
1863 .parse = avs_parse_word_token,
1864 },
1865 };
1866
1867 static int
avs_control_load(struct snd_soc_component * comp,int index,struct snd_kcontrol_new * ctmpl,struct snd_soc_tplg_ctl_hdr * hdr)1868 avs_control_load(struct snd_soc_component *comp, int index, struct snd_kcontrol_new *ctmpl,
1869 struct snd_soc_tplg_ctl_hdr *hdr)
1870 {
1871 struct snd_soc_tplg_vendor_array *tuples;
1872 struct snd_soc_tplg_mixer_control *tmc;
1873 struct avs_control_data *ctl_data;
1874 struct soc_mixer_control *mc;
1875 size_t block_size;
1876 int ret;
1877
1878 switch (le32_to_cpu(hdr->type)) {
1879 case SND_SOC_TPLG_TYPE_MIXER:
1880 tmc = container_of(hdr, typeof(*tmc), hdr);
1881 tuples = tmc->priv.array;
1882 block_size = le32_to_cpu(tmc->priv.size);
1883 break;
1884 default:
1885 return -EINVAL;
1886 }
1887
1888 ctl_data = devm_kzalloc(comp->card->dev, sizeof(*ctl_data), GFP_KERNEL);
1889 if (!ctl_data)
1890 return -ENOMEM;
1891
1892 ret = parse_dictionary_entries(comp, tuples, block_size, ctl_data, 1, sizeof(*ctl_data),
1893 AVS_TKN_KCONTROL_ID_U32, control_parsers,
1894 ARRAY_SIZE(control_parsers));
1895 if (ret)
1896 return ret;
1897
1898 mc = (struct soc_mixer_control *)ctmpl->private_value;
1899 mc->dobj.private = ctl_data;
1900 return 0;
1901 }
1902
1903 static const struct snd_soc_tplg_ops avs_tplg_ops = {
1904 .io_ops = avs_control_ops,
1905 .io_ops_count = ARRAY_SIZE(avs_control_ops),
1906 .control_load = avs_control_load,
1907 .dapm_route_load = avs_route_load,
1908 .widget_load = avs_widget_load,
1909 .widget_ready = avs_widget_ready,
1910 .dai_load = avs_dai_load,
1911 .link_load = avs_link_load,
1912 .manifest = avs_manifest,
1913 };
1914
avs_tplg_new(struct snd_soc_component * comp)1915 struct avs_tplg *avs_tplg_new(struct snd_soc_component *comp)
1916 {
1917 struct avs_tplg *tplg;
1918
1919 tplg = devm_kzalloc(comp->card->dev, sizeof(*tplg), GFP_KERNEL);
1920 if (!tplg)
1921 return NULL;
1922
1923 tplg->comp = comp;
1924 INIT_LIST_HEAD(&tplg->path_tmpl_list);
1925
1926 return tplg;
1927 }
1928
avs_load_topology(struct snd_soc_component * comp,const char * filename)1929 int avs_load_topology(struct snd_soc_component *comp, const char *filename)
1930 {
1931 const struct firmware *fw;
1932 int ret;
1933
1934 ret = request_firmware(&fw, filename, comp->dev);
1935 if (ret < 0) {
1936 dev_err(comp->dev, "request topology \"%s\" failed: %d\n", filename, ret);
1937 return ret;
1938 }
1939
1940 ret = snd_soc_tplg_component_load(comp, &avs_tplg_ops, fw);
1941 if (ret < 0)
1942 dev_err(comp->dev, "load topology \"%s\" failed: %d\n", filename, ret);
1943
1944 release_firmware(fw);
1945 return ret;
1946 }
1947
avs_remove_topology(struct snd_soc_component * comp)1948 int avs_remove_topology(struct snd_soc_component *comp)
1949 {
1950 snd_soc_tplg_component_remove(comp);
1951
1952 return 0;
1953 }
1954