xref: /linux/sound/soc/intel/avs/topology.c (revision a1ff5a7d78a036d6c2178ee5acd6ba4946243800)
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