xref: /linux/sound/soc/soc-topology.c (revision 005438a8eef063495ac059d128eea71b58de50e5)
1 /*
2  * soc-topology.c  --  ALSA SoC Topology
3  *
4  * Copyright (C) 2012 Texas Instruments Inc.
5  * Copyright (C) 2015 Intel Corporation.
6  *
7  * Authors: Liam Girdwood <liam.r.girdwood@linux.intel.com>
8  *		K, Mythri P <mythri.p.k@intel.com>
9  *		Prusty, Subhransu S <subhransu.s.prusty@intel.com>
10  *		B, Jayachandran <jayachandran.b@intel.com>
11  *		Abdullah, Omair M <omair.m.abdullah@intel.com>
12  *		Jin, Yao <yao.jin@intel.com>
13  *		Lin, Mengdong <mengdong.lin@intel.com>
14  *
15  *  This program is free software; you can redistribute  it and/or modify it
16  *  under  the terms of  the GNU General  Public License as published by the
17  *  Free Software Foundation;  either version 2 of the  License, or (at your
18  *  option) any later version.
19  *
20  *  Add support to read audio firmware topology alongside firmware text. The
21  *  topology data can contain kcontrols, DAPM graphs, widgets, DAIs, DAI links,
22  *  equalizers, firmware, coefficients etc.
23  *
24  *  This file only manages the core ALSA and ASoC components, all other bespoke
25  *  firmware topology data is passed to component drivers for bespoke handling.
26  */
27 
28 #include <linux/kernel.h>
29 #include <linux/export.h>
30 #include <linux/list.h>
31 #include <linux/firmware.h>
32 #include <linux/slab.h>
33 #include <sound/soc.h>
34 #include <sound/soc-dapm.h>
35 #include <sound/soc-topology.h>
36 
37 /*
38  * We make several passes over the data (since it wont necessarily be ordered)
39  * and process objects in the following order. This guarantees the component
40  * drivers will be ready with any vendor data before the mixers and DAPM objects
41  * are loaded (that may make use of the vendor data).
42  */
43 #define SOC_TPLG_PASS_MANIFEST		0
44 #define SOC_TPLG_PASS_VENDOR		1
45 #define SOC_TPLG_PASS_MIXER		2
46 #define SOC_TPLG_PASS_WIDGET		3
47 #define SOC_TPLG_PASS_GRAPH		4
48 #define SOC_TPLG_PASS_PINS		5
49 #define SOC_TPLG_PASS_PCM_DAI		6
50 
51 #define SOC_TPLG_PASS_START	SOC_TPLG_PASS_MANIFEST
52 #define SOC_TPLG_PASS_END	SOC_TPLG_PASS_PCM_DAI
53 
54 struct soc_tplg {
55 	const struct firmware *fw;
56 
57 	/* runtime FW parsing */
58 	const u8 *pos;		/* read postion */
59 	const u8 *hdr_pos;	/* header position */
60 	unsigned int pass;	/* pass number */
61 
62 	/* component caller */
63 	struct device *dev;
64 	struct snd_soc_component *comp;
65 	u32 index;	/* current block index */
66 	u32 req_index;	/* required index, only loaded/free matching blocks */
67 
68 	/* kcontrol operations */
69 	const struct snd_soc_tplg_kcontrol_ops *io_ops;
70 	int io_ops_count;
71 
72 	/* optional fw loading callbacks to component drivers */
73 	struct snd_soc_tplg_ops *ops;
74 };
75 
76 static int soc_tplg_process_headers(struct soc_tplg *tplg);
77 static void soc_tplg_complete(struct soc_tplg *tplg);
78 struct snd_soc_dapm_widget *
79 snd_soc_dapm_new_control_unlocked(struct snd_soc_dapm_context *dapm,
80 			 const struct snd_soc_dapm_widget *widget);
81 struct snd_soc_dapm_widget *
82 snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
83 			 const struct snd_soc_dapm_widget *widget);
84 
85 /* check we dont overflow the data for this control chunk */
86 static int soc_tplg_check_elem_count(struct soc_tplg *tplg, size_t elem_size,
87 	unsigned int count, size_t bytes, const char *elem_type)
88 {
89 	const u8 *end = tplg->pos + elem_size * count;
90 
91 	if (end > tplg->fw->data + tplg->fw->size) {
92 		dev_err(tplg->dev, "ASoC: %s overflow end of data\n",
93 			elem_type);
94 		return -EINVAL;
95 	}
96 
97 	/* check there is enough room in chunk for control.
98 	   extra bytes at the end of control are for vendor data here  */
99 	if (elem_size * count > bytes) {
100 		dev_err(tplg->dev,
101 			"ASoC: %s count %d of size %zu is bigger than chunk %zu\n",
102 			elem_type, count, elem_size, bytes);
103 		return -EINVAL;
104 	}
105 
106 	return 0;
107 }
108 
109 static inline int soc_tplg_is_eof(struct soc_tplg *tplg)
110 {
111 	const u8 *end = tplg->hdr_pos;
112 
113 	if (end >= tplg->fw->data + tplg->fw->size)
114 		return 1;
115 	return 0;
116 }
117 
118 static inline unsigned long soc_tplg_get_hdr_offset(struct soc_tplg *tplg)
119 {
120 	return (unsigned long)(tplg->hdr_pos - tplg->fw->data);
121 }
122 
123 static inline unsigned long soc_tplg_get_offset(struct soc_tplg *tplg)
124 {
125 	return (unsigned long)(tplg->pos - tplg->fw->data);
126 }
127 
128 /* mapping of Kcontrol types and associated operations. */
129 static const struct snd_soc_tplg_kcontrol_ops io_ops[] = {
130 	{SND_SOC_TPLG_CTL_VOLSW, snd_soc_get_volsw,
131 		snd_soc_put_volsw, snd_soc_info_volsw},
132 	{SND_SOC_TPLG_CTL_VOLSW_SX, snd_soc_get_volsw_sx,
133 		snd_soc_put_volsw_sx, NULL},
134 	{SND_SOC_TPLG_CTL_ENUM, snd_soc_get_enum_double,
135 		snd_soc_put_enum_double, snd_soc_info_enum_double},
136 	{SND_SOC_TPLG_CTL_ENUM_VALUE, snd_soc_get_enum_double,
137 		snd_soc_put_enum_double, NULL},
138 	{SND_SOC_TPLG_CTL_BYTES, snd_soc_bytes_get,
139 		snd_soc_bytes_put, snd_soc_bytes_info},
140 	{SND_SOC_TPLG_CTL_RANGE, snd_soc_get_volsw_range,
141 		snd_soc_put_volsw_range, snd_soc_info_volsw_range},
142 	{SND_SOC_TPLG_CTL_VOLSW_XR_SX, snd_soc_get_xr_sx,
143 		snd_soc_put_xr_sx, snd_soc_info_xr_sx},
144 	{SND_SOC_TPLG_CTL_STROBE, snd_soc_get_strobe,
145 		snd_soc_put_strobe, NULL},
146 	{SND_SOC_TPLG_DAPM_CTL_VOLSW, snd_soc_dapm_get_volsw,
147 		snd_soc_dapm_put_volsw, NULL},
148 	{SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE, snd_soc_dapm_get_enum_double,
149 		snd_soc_dapm_put_enum_double, snd_soc_info_enum_double},
150 	{SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT, snd_soc_dapm_get_enum_double,
151 		snd_soc_dapm_put_enum_double, NULL},
152 	{SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE, snd_soc_dapm_get_enum_double,
153 		snd_soc_dapm_put_enum_double, NULL},
154 	{SND_SOC_TPLG_DAPM_CTL_PIN, snd_soc_dapm_get_pin_switch,
155 		snd_soc_dapm_put_pin_switch, snd_soc_dapm_info_pin_switch},
156 };
157 
158 struct soc_tplg_map {
159 	int uid;
160 	int kid;
161 };
162 
163 /* mapping of widget types from UAPI IDs to kernel IDs */
164 static const struct soc_tplg_map dapm_map[] = {
165 	{SND_SOC_TPLG_DAPM_INPUT, snd_soc_dapm_input},
166 	{SND_SOC_TPLG_DAPM_OUTPUT, snd_soc_dapm_output},
167 	{SND_SOC_TPLG_DAPM_MUX, snd_soc_dapm_mux},
168 	{SND_SOC_TPLG_DAPM_MIXER, snd_soc_dapm_mixer},
169 	{SND_SOC_TPLG_DAPM_PGA, snd_soc_dapm_pga},
170 	{SND_SOC_TPLG_DAPM_OUT_DRV, snd_soc_dapm_out_drv},
171 	{SND_SOC_TPLG_DAPM_ADC, snd_soc_dapm_adc},
172 	{SND_SOC_TPLG_DAPM_DAC, snd_soc_dapm_dac},
173 	{SND_SOC_TPLG_DAPM_SWITCH, snd_soc_dapm_switch},
174 	{SND_SOC_TPLG_DAPM_PRE, snd_soc_dapm_pre},
175 	{SND_SOC_TPLG_DAPM_POST, snd_soc_dapm_post},
176 	{SND_SOC_TPLG_DAPM_AIF_IN, snd_soc_dapm_aif_in},
177 	{SND_SOC_TPLG_DAPM_AIF_OUT, snd_soc_dapm_aif_out},
178 	{SND_SOC_TPLG_DAPM_DAI_IN, snd_soc_dapm_dai_in},
179 	{SND_SOC_TPLG_DAPM_DAI_OUT, snd_soc_dapm_dai_out},
180 	{SND_SOC_TPLG_DAPM_DAI_LINK, snd_soc_dapm_dai_link},
181 };
182 
183 static int tplc_chan_get_reg(struct soc_tplg *tplg,
184 	struct snd_soc_tplg_channel *chan, int map)
185 {
186 	int i;
187 
188 	for (i = 0; i < SND_SOC_TPLG_MAX_CHAN; i++) {
189 		if (chan[i].id == map)
190 			return chan[i].reg;
191 	}
192 
193 	return -EINVAL;
194 }
195 
196 static int tplc_chan_get_shift(struct soc_tplg *tplg,
197 	struct snd_soc_tplg_channel *chan, int map)
198 {
199 	int i;
200 
201 	for (i = 0; i < SND_SOC_TPLG_MAX_CHAN; i++) {
202 		if (chan[i].id == map)
203 			return chan[i].shift;
204 	}
205 
206 	return -EINVAL;
207 }
208 
209 static int get_widget_id(int tplg_type)
210 {
211 	int i;
212 
213 	for (i = 0; i < ARRAY_SIZE(dapm_map); i++) {
214 		if (tplg_type == dapm_map[i].uid)
215 			return dapm_map[i].kid;
216 	}
217 
218 	return -EINVAL;
219 }
220 
221 static enum snd_soc_dobj_type get_dobj_mixer_type(
222 	struct snd_soc_tplg_ctl_hdr *control_hdr)
223 {
224 	if (control_hdr == NULL)
225 		return SND_SOC_DOBJ_NONE;
226 
227 	switch (control_hdr->ops.info) {
228 	case SND_SOC_TPLG_CTL_VOLSW:
229 	case SND_SOC_TPLG_CTL_VOLSW_SX:
230 	case SND_SOC_TPLG_CTL_VOLSW_XR_SX:
231 	case SND_SOC_TPLG_CTL_RANGE:
232 	case SND_SOC_TPLG_CTL_STROBE:
233 		return SND_SOC_DOBJ_MIXER;
234 	case SND_SOC_TPLG_CTL_ENUM:
235 	case SND_SOC_TPLG_CTL_ENUM_VALUE:
236 		return SND_SOC_DOBJ_ENUM;
237 	case SND_SOC_TPLG_CTL_BYTES:
238 		return SND_SOC_DOBJ_BYTES;
239 	default:
240 		return SND_SOC_DOBJ_NONE;
241 	}
242 }
243 
244 static enum snd_soc_dobj_type get_dobj_type(struct snd_soc_tplg_hdr *hdr,
245 	struct snd_soc_tplg_ctl_hdr *control_hdr)
246 {
247 	switch (hdr->type) {
248 	case SND_SOC_TPLG_TYPE_MIXER:
249 		return get_dobj_mixer_type(control_hdr);
250 	case SND_SOC_TPLG_TYPE_DAPM_GRAPH:
251 	case SND_SOC_TPLG_TYPE_MANIFEST:
252 		return SND_SOC_DOBJ_NONE;
253 	case SND_SOC_TPLG_TYPE_DAPM_WIDGET:
254 		return SND_SOC_DOBJ_WIDGET;
255 	case SND_SOC_TPLG_TYPE_DAI_LINK:
256 		return SND_SOC_DOBJ_DAI_LINK;
257 	case SND_SOC_TPLG_TYPE_PCM:
258 		return SND_SOC_DOBJ_PCM;
259 	case SND_SOC_TPLG_TYPE_CODEC_LINK:
260 		return SND_SOC_DOBJ_CODEC_LINK;
261 	default:
262 		return SND_SOC_DOBJ_NONE;
263 	}
264 }
265 
266 static inline void soc_bind_err(struct soc_tplg *tplg,
267 	struct snd_soc_tplg_ctl_hdr *hdr, int index)
268 {
269 	dev_err(tplg->dev,
270 		"ASoC: invalid control type (g,p,i) %d:%d:%d index %d at 0x%lx\n",
271 		hdr->ops.get, hdr->ops.put, hdr->ops.info, index,
272 		soc_tplg_get_offset(tplg));
273 }
274 
275 static inline void soc_control_err(struct soc_tplg *tplg,
276 	struct snd_soc_tplg_ctl_hdr *hdr, const char *name)
277 {
278 	dev_err(tplg->dev,
279 		"ASoC: no complete mixer IO handler for %s type (g,p,i) %d:%d:%d at 0x%lx\n",
280 		name, hdr->ops.get, hdr->ops.put, hdr->ops.info,
281 		soc_tplg_get_offset(tplg));
282 }
283 
284 /* pass vendor data to component driver for processing */
285 static int soc_tplg_vendor_load_(struct soc_tplg *tplg,
286 	struct snd_soc_tplg_hdr *hdr)
287 {
288 	int ret = 0;
289 
290 	if (tplg->comp && tplg->ops && tplg->ops->vendor_load)
291 		ret = tplg->ops->vendor_load(tplg->comp, hdr);
292 	else {
293 		dev_err(tplg->dev, "ASoC: no vendor load callback for ID %d\n",
294 			hdr->vendor_type);
295 		return -EINVAL;
296 	}
297 
298 	if (ret < 0)
299 		dev_err(tplg->dev,
300 			"ASoC: vendor load failed at hdr offset %ld/0x%lx for type %d:%d\n",
301 			soc_tplg_get_hdr_offset(tplg),
302 			soc_tplg_get_hdr_offset(tplg),
303 			hdr->type, hdr->vendor_type);
304 	return ret;
305 }
306 
307 /* pass vendor data to component driver for processing */
308 static int soc_tplg_vendor_load(struct soc_tplg *tplg,
309 	struct snd_soc_tplg_hdr *hdr)
310 {
311 	if (tplg->pass != SOC_TPLG_PASS_VENDOR)
312 		return 0;
313 
314 	return soc_tplg_vendor_load_(tplg, hdr);
315 }
316 
317 /* optionally pass new dynamic widget to component driver. This is mainly for
318  * external widgets where we can assign private data/ops */
319 static int soc_tplg_widget_load(struct soc_tplg *tplg,
320 	struct snd_soc_dapm_widget *w, struct snd_soc_tplg_dapm_widget *tplg_w)
321 {
322 	if (tplg->comp && tplg->ops && tplg->ops->widget_load)
323 		return tplg->ops->widget_load(tplg->comp, w, tplg_w);
324 
325 	return 0;
326 }
327 
328 /* pass dynamic FEs configurations to component driver */
329 static int soc_tplg_pcm_dai_load(struct soc_tplg *tplg,
330 	struct snd_soc_tplg_pcm_dai *pcm_dai, int num_pcm_dai)
331 {
332 	if (tplg->comp && tplg->ops && tplg->ops->pcm_dai_load)
333 		return tplg->ops->pcm_dai_load(tplg->comp, pcm_dai, num_pcm_dai);
334 
335 	return 0;
336 }
337 
338 /* tell the component driver that all firmware has been loaded in this request */
339 static void soc_tplg_complete(struct soc_tplg *tplg)
340 {
341 	if (tplg->comp && tplg->ops && tplg->ops->complete)
342 		tplg->ops->complete(tplg->comp);
343 }
344 
345 /* add a dynamic kcontrol */
346 static int soc_tplg_add_dcontrol(struct snd_card *card, struct device *dev,
347 	const struct snd_kcontrol_new *control_new, const char *prefix,
348 	void *data, struct snd_kcontrol **kcontrol)
349 {
350 	int err;
351 
352 	*kcontrol = snd_soc_cnew(control_new, data, control_new->name, prefix);
353 	if (*kcontrol == NULL) {
354 		dev_err(dev, "ASoC: Failed to create new kcontrol %s\n",
355 		control_new->name);
356 		return -ENOMEM;
357 	}
358 
359 	err = snd_ctl_add(card, *kcontrol);
360 	if (err < 0) {
361 		dev_err(dev, "ASoC: Failed to add %s: %d\n",
362 			control_new->name, err);
363 		return err;
364 	}
365 
366 	return 0;
367 }
368 
369 /* add a dynamic kcontrol for component driver */
370 static int soc_tplg_add_kcontrol(struct soc_tplg *tplg,
371 	struct snd_kcontrol_new *k, struct snd_kcontrol **kcontrol)
372 {
373 	struct snd_soc_component *comp = tplg->comp;
374 
375 	return soc_tplg_add_dcontrol(comp->card->snd_card,
376 				comp->dev, k, NULL, comp, kcontrol);
377 }
378 
379 /* remove a mixer kcontrol */
380 static void remove_mixer(struct snd_soc_component *comp,
381 	struct snd_soc_dobj *dobj, int pass)
382 {
383 	struct snd_card *card = comp->card->snd_card;
384 	struct soc_mixer_control *sm =
385 		container_of(dobj, struct soc_mixer_control, dobj);
386 	const unsigned int *p = NULL;
387 
388 	if (pass != SOC_TPLG_PASS_MIXER)
389 		return;
390 
391 	if (dobj->ops && dobj->ops->control_unload)
392 		dobj->ops->control_unload(comp, dobj);
393 
394 	if (sm->dobj.control.kcontrol->tlv.p)
395 		p = sm->dobj.control.kcontrol->tlv.p;
396 	snd_ctl_remove(card, sm->dobj.control.kcontrol);
397 	list_del(&sm->dobj.list);
398 	kfree(sm);
399 	kfree(p);
400 }
401 
402 /* remove an enum kcontrol */
403 static void remove_enum(struct snd_soc_component *comp,
404 	struct snd_soc_dobj *dobj, int pass)
405 {
406 	struct snd_card *card = comp->card->snd_card;
407 	struct soc_enum *se = container_of(dobj, struct soc_enum, dobj);
408 	int i;
409 
410 	if (pass != SOC_TPLG_PASS_MIXER)
411 		return;
412 
413 	if (dobj->ops && dobj->ops->control_unload)
414 		dobj->ops->control_unload(comp, dobj);
415 
416 	snd_ctl_remove(card, se->dobj.control.kcontrol);
417 	list_del(&se->dobj.list);
418 
419 	kfree(se->dobj.control.dvalues);
420 	for (i = 0; i < se->items; i++)
421 		kfree(se->dobj.control.dtexts[i]);
422 	kfree(se);
423 }
424 
425 /* remove a byte kcontrol */
426 static void remove_bytes(struct snd_soc_component *comp,
427 	struct snd_soc_dobj *dobj, int pass)
428 {
429 	struct snd_card *card = comp->card->snd_card;
430 	struct soc_bytes_ext *sb =
431 		container_of(dobj, struct soc_bytes_ext, dobj);
432 
433 	if (pass != SOC_TPLG_PASS_MIXER)
434 		return;
435 
436 	if (dobj->ops && dobj->ops->control_unload)
437 		dobj->ops->control_unload(comp, dobj);
438 
439 	snd_ctl_remove(card, sb->dobj.control.kcontrol);
440 	list_del(&sb->dobj.list);
441 	kfree(sb);
442 }
443 
444 /* remove a widget and it's kcontrols - routes must be removed first */
445 static void remove_widget(struct snd_soc_component *comp,
446 	struct snd_soc_dobj *dobj, int pass)
447 {
448 	struct snd_card *card = comp->card->snd_card;
449 	struct snd_soc_dapm_widget *w =
450 		container_of(dobj, struct snd_soc_dapm_widget, dobj);
451 	int i;
452 
453 	if (pass != SOC_TPLG_PASS_WIDGET)
454 		return;
455 
456 	if (dobj->ops && dobj->ops->widget_unload)
457 		dobj->ops->widget_unload(comp, dobj);
458 
459 	/*
460 	 * Dynamic Widgets either have 1 enum kcontrol or 1..N mixers.
461 	 * The enum may either have an array of values or strings.
462 	 */
463 	if (dobj->widget.kcontrol_enum) {
464 		/* enumerated widget mixer */
465 		struct soc_enum *se =
466 			(struct soc_enum *)w->kcontrols[0]->private_value;
467 
468 		snd_ctl_remove(card, w->kcontrols[0]);
469 
470 		kfree(se->dobj.control.dvalues);
471 		for (i = 0; i < se->items; i++)
472 			kfree(se->dobj.control.dtexts[i]);
473 
474 		kfree(se);
475 		kfree(w->kcontrol_news);
476 	} else {
477 		/* non enumerated widget mixer */
478 		for (i = 0; i < w->num_kcontrols; i++) {
479 			struct snd_kcontrol *kcontrol = w->kcontrols[i];
480 			struct soc_mixer_control *sm =
481 			(struct soc_mixer_control *) kcontrol->private_value;
482 
483 			kfree(w->kcontrols[i]->tlv.p);
484 
485 			snd_ctl_remove(card, w->kcontrols[i]);
486 			kfree(sm);
487 		}
488 		kfree(w->kcontrol_news);
489 	}
490 	/* widget w is freed by soc-dapm.c */
491 }
492 
493 /* remove PCM DAI configurations */
494 static void remove_pcm_dai(struct snd_soc_component *comp,
495 	struct snd_soc_dobj *dobj, int pass)
496 {
497 	if (pass != SOC_TPLG_PASS_PCM_DAI)
498 		return;
499 
500 	if (dobj->ops && dobj->ops->pcm_dai_unload)
501 		dobj->ops->pcm_dai_unload(comp, dobj);
502 
503 	list_del(&dobj->list);
504 	kfree(dobj);
505 }
506 
507 /* bind a kcontrol to it's IO handlers */
508 static int soc_tplg_kcontrol_bind_io(struct snd_soc_tplg_ctl_hdr *hdr,
509 	struct snd_kcontrol_new *k,
510 	const struct snd_soc_tplg_kcontrol_ops *ops, int num_ops,
511 	const struct snd_soc_tplg_kcontrol_ops *bops, int num_bops)
512 {
513 	int i;
514 
515 	/* try and map standard kcontrols handler first */
516 	for (i = 0; i < num_ops; i++) {
517 
518 		if (ops[i].id == hdr->ops.put)
519 			k->put = ops[i].put;
520 		if (ops[i].id == hdr->ops.get)
521 			k->get = ops[i].get;
522 		if (ops[i].id == hdr->ops.info)
523 			k->info = ops[i].info;
524 	}
525 
526 	/* standard handlers found ? */
527 	if (k->put && k->get && k->info)
528 		return 0;
529 
530 	/* none found so try bespoke handlers */
531 	for (i = 0; i < num_bops; i++) {
532 
533 		if (k->put == NULL && bops[i].id == hdr->ops.put)
534 			k->put = bops[i].put;
535 		if (k->get == NULL && bops[i].id == hdr->ops.get)
536 			k->get = bops[i].get;
537 		if (k->info == NULL && ops[i].id == hdr->ops.info)
538 			k->info = bops[i].info;
539 	}
540 
541 	/* bespoke handlers found ? */
542 	if (k->put && k->get && k->info)
543 		return 0;
544 
545 	/* nothing to bind */
546 	return -EINVAL;
547 }
548 
549 /* bind a widgets to it's evnt handlers */
550 int snd_soc_tplg_widget_bind_event(struct snd_soc_dapm_widget *w,
551 		const struct snd_soc_tplg_widget_events *events,
552 		int num_events, u16 event_type)
553 {
554 	int i;
555 
556 	w->event = NULL;
557 
558 	for (i = 0; i < num_events; i++) {
559 		if (event_type == events[i].type) {
560 
561 			/* found - so assign event */
562 			w->event = events[i].event_handler;
563 			return 0;
564 		}
565 	}
566 
567 	/* not found */
568 	return -EINVAL;
569 }
570 EXPORT_SYMBOL_GPL(snd_soc_tplg_widget_bind_event);
571 
572 /* optionally pass new dynamic kcontrol to component driver. */
573 static int soc_tplg_init_kcontrol(struct soc_tplg *tplg,
574 	struct snd_kcontrol_new *k, struct snd_soc_tplg_ctl_hdr *hdr)
575 {
576 	if (tplg->comp && tplg->ops && tplg->ops->control_load)
577 		return tplg->ops->control_load(tplg->comp, k, hdr);
578 
579 	return 0;
580 }
581 
582 static int soc_tplg_create_tlv(struct soc_tplg *tplg,
583 	struct snd_kcontrol_new *kc, u32 tlv_size)
584 {
585 	struct snd_soc_tplg_ctl_tlv *tplg_tlv;
586 	struct snd_ctl_tlv *tlv;
587 
588 	if (tlv_size == 0)
589 		return 0;
590 
591 	tplg_tlv = (struct snd_soc_tplg_ctl_tlv *) tplg->pos;
592 	tplg->pos += tlv_size;
593 
594 	tlv = kzalloc(sizeof(*tlv) + tlv_size, GFP_KERNEL);
595 	if (tlv == NULL)
596 		return -ENOMEM;
597 
598 	dev_dbg(tplg->dev, " created TLV type %d size %d bytes\n",
599 		tplg_tlv->numid, tplg_tlv->size);
600 
601 	tlv->numid = tplg_tlv->numid;
602 	tlv->length = tplg_tlv->size;
603 	memcpy(tlv->tlv, tplg_tlv + 1, tplg_tlv->size);
604 	kc->tlv.p = (void *)tlv;
605 
606 	return 0;
607 }
608 
609 static inline void soc_tplg_free_tlv(struct soc_tplg *tplg,
610 	struct snd_kcontrol_new *kc)
611 {
612 	kfree(kc->tlv.p);
613 }
614 
615 static int soc_tplg_dbytes_create(struct soc_tplg *tplg, unsigned int count,
616 	size_t size)
617 {
618 	struct snd_soc_tplg_bytes_control *be;
619 	struct soc_bytes_ext *sbe;
620 	struct snd_kcontrol_new kc;
621 	int i, err;
622 
623 	if (soc_tplg_check_elem_count(tplg,
624 		sizeof(struct snd_soc_tplg_bytes_control), count,
625 			size, "mixer bytes")) {
626 		dev_err(tplg->dev, "ASoC: Invalid count %d for byte control\n",
627 			count);
628 		return -EINVAL;
629 	}
630 
631 	for (i = 0; i < count; i++) {
632 		be = (struct snd_soc_tplg_bytes_control *)tplg->pos;
633 
634 		/* validate kcontrol */
635 		if (strnlen(be->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
636 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
637 			return -EINVAL;
638 
639 		sbe = kzalloc(sizeof(*sbe), GFP_KERNEL);
640 		if (sbe == NULL)
641 			return -ENOMEM;
642 
643 		tplg->pos += (sizeof(struct snd_soc_tplg_bytes_control) +
644 			be->priv.size);
645 
646 		dev_dbg(tplg->dev,
647 			"ASoC: adding bytes kcontrol %s with access 0x%x\n",
648 			be->hdr.name, be->hdr.access);
649 
650 		memset(&kc, 0, sizeof(kc));
651 		kc.name = be->hdr.name;
652 		kc.private_value = (long)sbe;
653 		kc.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
654 		kc.access = be->hdr.access;
655 
656 		sbe->max = be->max;
657 		sbe->dobj.type = SND_SOC_DOBJ_BYTES;
658 		sbe->dobj.ops = tplg->ops;
659 		INIT_LIST_HEAD(&sbe->dobj.list);
660 
661 		/* map io handlers */
662 		err = soc_tplg_kcontrol_bind_io(&be->hdr, &kc, io_ops,
663 			ARRAY_SIZE(io_ops), tplg->io_ops, tplg->io_ops_count);
664 		if (err) {
665 			soc_control_err(tplg, &be->hdr, be->hdr.name);
666 			kfree(sbe);
667 			continue;
668 		}
669 
670 		/* pass control to driver for optional further init */
671 		err = soc_tplg_init_kcontrol(tplg, &kc,
672 			(struct snd_soc_tplg_ctl_hdr *)be);
673 		if (err < 0) {
674 			dev_err(tplg->dev, "ASoC: failed to init %s\n",
675 				be->hdr.name);
676 			kfree(sbe);
677 			continue;
678 		}
679 
680 		/* register control here */
681 		err = soc_tplg_add_kcontrol(tplg, &kc,
682 			&sbe->dobj.control.kcontrol);
683 		if (err < 0) {
684 			dev_err(tplg->dev, "ASoC: failed to add %s\n",
685 				be->hdr.name);
686 			kfree(sbe);
687 			continue;
688 		}
689 
690 		list_add(&sbe->dobj.list, &tplg->comp->dobj_list);
691 	}
692 	return 0;
693 
694 }
695 
696 static int soc_tplg_dmixer_create(struct soc_tplg *tplg, unsigned int count,
697 	size_t size)
698 {
699 	struct snd_soc_tplg_mixer_control *mc;
700 	struct soc_mixer_control *sm;
701 	struct snd_kcontrol_new kc;
702 	int i, err;
703 
704 	if (soc_tplg_check_elem_count(tplg,
705 		sizeof(struct snd_soc_tplg_mixer_control),
706 		count, size, "mixers")) {
707 
708 		dev_err(tplg->dev, "ASoC: invalid count %d for controls\n",
709 			count);
710 		return -EINVAL;
711 	}
712 
713 	for (i = 0; i < count; i++) {
714 		mc = (struct snd_soc_tplg_mixer_control *)tplg->pos;
715 
716 		/* validate kcontrol */
717 		if (strnlen(mc->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
718 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
719 			return -EINVAL;
720 
721 		sm = kzalloc(sizeof(*sm), GFP_KERNEL);
722 		if (sm == NULL)
723 			return -ENOMEM;
724 		tplg->pos += (sizeof(struct snd_soc_tplg_mixer_control) +
725 			mc->priv.size);
726 
727 		dev_dbg(tplg->dev,
728 			"ASoC: adding mixer kcontrol %s with access 0x%x\n",
729 			mc->hdr.name, mc->hdr.access);
730 
731 		memset(&kc, 0, sizeof(kc));
732 		kc.name = mc->hdr.name;
733 		kc.private_value = (long)sm;
734 		kc.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
735 		kc.access = mc->hdr.access;
736 
737 		/* we only support FL/FR channel mapping atm */
738 		sm->reg = tplc_chan_get_reg(tplg, mc->channel,
739 			SNDRV_CHMAP_FL);
740 		sm->rreg = tplc_chan_get_reg(tplg, mc->channel,
741 			SNDRV_CHMAP_FR);
742 		sm->shift = tplc_chan_get_shift(tplg, mc->channel,
743 			SNDRV_CHMAP_FL);
744 		sm->rshift = tplc_chan_get_shift(tplg, mc->channel,
745 			SNDRV_CHMAP_FR);
746 
747 		sm->max = mc->max;
748 		sm->min = mc->min;
749 		sm->invert = mc->invert;
750 		sm->platform_max = mc->platform_max;
751 		sm->dobj.index = tplg->index;
752 		sm->dobj.ops = tplg->ops;
753 		sm->dobj.type = SND_SOC_DOBJ_MIXER;
754 		INIT_LIST_HEAD(&sm->dobj.list);
755 
756 		/* map io handlers */
757 		err = soc_tplg_kcontrol_bind_io(&mc->hdr, &kc, io_ops,
758 			ARRAY_SIZE(io_ops), tplg->io_ops, tplg->io_ops_count);
759 		if (err) {
760 			soc_control_err(tplg, &mc->hdr, mc->hdr.name);
761 			kfree(sm);
762 			continue;
763 		}
764 
765 		/* pass control to driver for optional further init */
766 		err = soc_tplg_init_kcontrol(tplg, &kc,
767 			(struct snd_soc_tplg_ctl_hdr *) mc);
768 		if (err < 0) {
769 			dev_err(tplg->dev, "ASoC: failed to init %s\n",
770 				mc->hdr.name);
771 			kfree(sm);
772 			continue;
773 		}
774 
775 		/* create any TLV data */
776 		soc_tplg_create_tlv(tplg, &kc, mc->hdr.tlv_size);
777 
778 		/* register control here */
779 		err = soc_tplg_add_kcontrol(tplg, &kc,
780 			&sm->dobj.control.kcontrol);
781 		if (err < 0) {
782 			dev_err(tplg->dev, "ASoC: failed to add %s\n",
783 				mc->hdr.name);
784 			soc_tplg_free_tlv(tplg, &kc);
785 			kfree(sm);
786 			continue;
787 		}
788 
789 		list_add(&sm->dobj.list, &tplg->comp->dobj_list);
790 	}
791 
792 	return 0;
793 }
794 
795 static int soc_tplg_denum_create_texts(struct soc_enum *se,
796 	struct snd_soc_tplg_enum_control *ec)
797 {
798 	int i, ret;
799 
800 	se->dobj.control.dtexts =
801 		kzalloc(sizeof(char *) * ec->items, GFP_KERNEL);
802 	if (se->dobj.control.dtexts == NULL)
803 		return -ENOMEM;
804 
805 	for (i = 0; i < ec->items; i++) {
806 
807 		if (strnlen(ec->texts[i], SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
808 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN) {
809 			ret = -EINVAL;
810 			goto err;
811 		}
812 
813 		se->dobj.control.dtexts[i] = kstrdup(ec->texts[i], GFP_KERNEL);
814 		if (!se->dobj.control.dtexts[i]) {
815 			ret = -ENOMEM;
816 			goto err;
817 		}
818 	}
819 
820 	return 0;
821 
822 err:
823 	for (--i; i >= 0; i--)
824 		kfree(se->dobj.control.dtexts[i]);
825 	kfree(se->dobj.control.dtexts);
826 	return ret;
827 }
828 
829 static int soc_tplg_denum_create_values(struct soc_enum *se,
830 	struct snd_soc_tplg_enum_control *ec)
831 {
832 	if (ec->items > sizeof(*ec->values))
833 		return -EINVAL;
834 
835 	se->dobj.control.dvalues =
836 		kmalloc(ec->items * sizeof(u32), GFP_KERNEL);
837 	if (!se->dobj.control.dvalues)
838 		return -ENOMEM;
839 
840 	memcpy(se->dobj.control.dvalues, ec->values, ec->items * sizeof(u32));
841 	return 0;
842 }
843 
844 static int soc_tplg_denum_create(struct soc_tplg *tplg, unsigned int count,
845 	size_t size)
846 {
847 	struct snd_soc_tplg_enum_control *ec;
848 	struct soc_enum *se;
849 	struct snd_kcontrol_new kc;
850 	int i, ret, err;
851 
852 	if (soc_tplg_check_elem_count(tplg,
853 		sizeof(struct snd_soc_tplg_enum_control),
854 		count, size, "enums")) {
855 
856 		dev_err(tplg->dev, "ASoC: invalid count %d for enum controls\n",
857 			count);
858 		return -EINVAL;
859 	}
860 
861 	for (i = 0; i < count; i++) {
862 		ec = (struct snd_soc_tplg_enum_control *)tplg->pos;
863 		tplg->pos += (sizeof(struct snd_soc_tplg_enum_control) +
864 			ec->priv.size);
865 
866 		/* validate kcontrol */
867 		if (strnlen(ec->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
868 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
869 			return -EINVAL;
870 
871 		se = kzalloc((sizeof(*se)), GFP_KERNEL);
872 		if (se == NULL)
873 			return -ENOMEM;
874 
875 		dev_dbg(tplg->dev, "ASoC: adding enum kcontrol %s size %d\n",
876 			ec->hdr.name, ec->items);
877 
878 		memset(&kc, 0, sizeof(kc));
879 		kc.name = ec->hdr.name;
880 		kc.private_value = (long)se;
881 		kc.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
882 		kc.access = ec->hdr.access;
883 
884 		se->reg = tplc_chan_get_reg(tplg, ec->channel, SNDRV_CHMAP_FL);
885 		se->shift_l = tplc_chan_get_shift(tplg, ec->channel,
886 			SNDRV_CHMAP_FL);
887 		se->shift_r = tplc_chan_get_shift(tplg, ec->channel,
888 			SNDRV_CHMAP_FL);
889 
890 		se->items = ec->items;
891 		se->mask = ec->mask;
892 		se->dobj.index = tplg->index;
893 		se->dobj.type = SND_SOC_DOBJ_ENUM;
894 		se->dobj.ops = tplg->ops;
895 		INIT_LIST_HEAD(&se->dobj.list);
896 
897 		switch (ec->hdr.ops.info) {
898 		case SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE:
899 		case SND_SOC_TPLG_CTL_ENUM_VALUE:
900 			err = soc_tplg_denum_create_values(se, ec);
901 			if (err < 0) {
902 				dev_err(tplg->dev,
903 					"ASoC: could not create values for %s\n",
904 					ec->hdr.name);
905 				kfree(se);
906 				continue;
907 			}
908 			/* fall through and create texts */
909 		case SND_SOC_TPLG_CTL_ENUM:
910 		case SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE:
911 		case SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT:
912 			err = soc_tplg_denum_create_texts(se, ec);
913 			if (err < 0) {
914 				dev_err(tplg->dev,
915 					"ASoC: could not create texts for %s\n",
916 					ec->hdr.name);
917 				kfree(se);
918 				continue;
919 			}
920 			break;
921 		default:
922 			dev_err(tplg->dev,
923 				"ASoC: invalid enum control type %d for %s\n",
924 				ec->hdr.ops.info, ec->hdr.name);
925 			kfree(se);
926 			continue;
927 		}
928 
929 		/* map io handlers */
930 		err = soc_tplg_kcontrol_bind_io(&ec->hdr, &kc, io_ops,
931 			ARRAY_SIZE(io_ops), tplg->io_ops, tplg->io_ops_count);
932 		if (err) {
933 			soc_control_err(tplg, &ec->hdr, ec->hdr.name);
934 			kfree(se);
935 			continue;
936 		}
937 
938 		/* pass control to driver for optional further init */
939 		err = soc_tplg_init_kcontrol(tplg, &kc,
940 			(struct snd_soc_tplg_ctl_hdr *) ec);
941 		if (err < 0) {
942 			dev_err(tplg->dev, "ASoC: failed to init %s\n",
943 				ec->hdr.name);
944 			kfree(se);
945 			continue;
946 		}
947 
948 		/* register control here */
949 		ret = soc_tplg_add_kcontrol(tplg,
950 			&kc, &se->dobj.control.kcontrol);
951 		if (ret < 0) {
952 			dev_err(tplg->dev, "ASoC: could not add kcontrol %s\n",
953 				ec->hdr.name);
954 			kfree(se);
955 			continue;
956 		}
957 
958 		list_add(&se->dobj.list, &tplg->comp->dobj_list);
959 	}
960 
961 	return 0;
962 }
963 
964 static int soc_tplg_kcontrol_elems_load(struct soc_tplg *tplg,
965 	struct snd_soc_tplg_hdr *hdr)
966 {
967 	struct snd_soc_tplg_ctl_hdr *control_hdr;
968 	int i;
969 
970 	if (tplg->pass != SOC_TPLG_PASS_MIXER) {
971 		tplg->pos += hdr->size + hdr->payload_size;
972 		return 0;
973 	}
974 
975 	dev_dbg(tplg->dev, "ASoC: adding %d kcontrols at 0x%lx\n", hdr->count,
976 		soc_tplg_get_offset(tplg));
977 
978 	for (i = 0; i < hdr->count; i++) {
979 
980 		control_hdr = (struct snd_soc_tplg_ctl_hdr *)tplg->pos;
981 
982 		switch (control_hdr->ops.info) {
983 		case SND_SOC_TPLG_CTL_VOLSW:
984 		case SND_SOC_TPLG_CTL_STROBE:
985 		case SND_SOC_TPLG_CTL_VOLSW_SX:
986 		case SND_SOC_TPLG_CTL_VOLSW_XR_SX:
987 		case SND_SOC_TPLG_CTL_RANGE:
988 		case SND_SOC_TPLG_DAPM_CTL_VOLSW:
989 		case SND_SOC_TPLG_DAPM_CTL_PIN:
990 			soc_tplg_dmixer_create(tplg, 1, hdr->payload_size);
991 			break;
992 		case SND_SOC_TPLG_CTL_ENUM:
993 		case SND_SOC_TPLG_CTL_ENUM_VALUE:
994 		case SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE:
995 		case SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT:
996 		case SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE:
997 			soc_tplg_denum_create(tplg, 1, hdr->payload_size);
998 			break;
999 		case SND_SOC_TPLG_CTL_BYTES:
1000 			soc_tplg_dbytes_create(tplg, 1, hdr->payload_size);
1001 			break;
1002 		default:
1003 			soc_bind_err(tplg, control_hdr, i);
1004 			return -EINVAL;
1005 		}
1006 	}
1007 
1008 	return 0;
1009 }
1010 
1011 static int soc_tplg_dapm_graph_elems_load(struct soc_tplg *tplg,
1012 	struct snd_soc_tplg_hdr *hdr)
1013 {
1014 	struct snd_soc_dapm_context *dapm = &tplg->comp->dapm;
1015 	struct snd_soc_dapm_route route;
1016 	struct snd_soc_tplg_dapm_graph_elem *elem;
1017 	int count = hdr->count, i;
1018 
1019 	if (tplg->pass != SOC_TPLG_PASS_GRAPH) {
1020 		tplg->pos += hdr->size + hdr->payload_size;
1021 		return 0;
1022 	}
1023 
1024 	if (soc_tplg_check_elem_count(tplg,
1025 		sizeof(struct snd_soc_tplg_dapm_graph_elem),
1026 		count, hdr->payload_size, "graph")) {
1027 
1028 		dev_err(tplg->dev, "ASoC: invalid count %d for DAPM routes\n",
1029 			count);
1030 		return -EINVAL;
1031 	}
1032 
1033 	dev_dbg(tplg->dev, "ASoC: adding %d DAPM routes\n", count);
1034 
1035 	for (i = 0; i < count; i++) {
1036 		elem = (struct snd_soc_tplg_dapm_graph_elem *)tplg->pos;
1037 		tplg->pos += sizeof(struct snd_soc_tplg_dapm_graph_elem);
1038 
1039 		/* validate routes */
1040 		if (strnlen(elem->source, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
1041 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
1042 			return -EINVAL;
1043 		if (strnlen(elem->sink, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
1044 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
1045 			return -EINVAL;
1046 		if (strnlen(elem->control, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
1047 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
1048 			return -EINVAL;
1049 
1050 		route.source = elem->source;
1051 		route.sink = elem->sink;
1052 		route.connected = NULL; /* set to NULL atm for tplg users */
1053 		if (strnlen(elem->control, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 0)
1054 			route.control = NULL;
1055 		else
1056 			route.control = elem->control;
1057 
1058 		/* add route, but keep going if some fail */
1059 		snd_soc_dapm_add_routes(dapm, &route, 1);
1060 	}
1061 
1062 	return 0;
1063 }
1064 
1065 static struct snd_kcontrol_new *soc_tplg_dapm_widget_dmixer_create(
1066 	struct soc_tplg *tplg, int num_kcontrols)
1067 {
1068 	struct snd_kcontrol_new *kc;
1069 	struct soc_mixer_control *sm;
1070 	struct snd_soc_tplg_mixer_control *mc;
1071 	int i, err;
1072 
1073 	kc = kzalloc(sizeof(*kc) * num_kcontrols, GFP_KERNEL);
1074 	if (kc == NULL)
1075 		return NULL;
1076 
1077 	for (i = 0; i < num_kcontrols; i++) {
1078 		mc = (struct snd_soc_tplg_mixer_control *)tplg->pos;
1079 		sm = kzalloc(sizeof(*sm), GFP_KERNEL);
1080 		if (sm == NULL)
1081 			goto err;
1082 
1083 		tplg->pos += (sizeof(struct snd_soc_tplg_mixer_control) +
1084 			mc->priv.size);
1085 
1086 		/* validate kcontrol */
1087 		if (strnlen(mc->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
1088 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
1089 			goto err_str;
1090 
1091 		dev_dbg(tplg->dev, " adding DAPM widget mixer control %s at %d\n",
1092 			mc->hdr.name, i);
1093 
1094 		kc[i].name = mc->hdr.name;
1095 		kc[i].private_value = (long)sm;
1096 		kc[i].iface = SNDRV_CTL_ELEM_IFACE_MIXER;
1097 		kc[i].access = mc->hdr.access;
1098 
1099 		/* we only support FL/FR channel mapping atm */
1100 		sm->reg = tplc_chan_get_reg(tplg, mc->channel,
1101 			SNDRV_CHMAP_FL);
1102 		sm->rreg = tplc_chan_get_reg(tplg, mc->channel,
1103 			SNDRV_CHMAP_FR);
1104 		sm->shift = tplc_chan_get_shift(tplg, mc->channel,
1105 			SNDRV_CHMAP_FL);
1106 		sm->rshift = tplc_chan_get_shift(tplg, mc->channel,
1107 			SNDRV_CHMAP_FR);
1108 
1109 		sm->max = mc->max;
1110 		sm->min = mc->min;
1111 		sm->invert = mc->invert;
1112 		sm->platform_max = mc->platform_max;
1113 		sm->dobj.index = tplg->index;
1114 		INIT_LIST_HEAD(&sm->dobj.list);
1115 
1116 		/* map io handlers */
1117 		err = soc_tplg_kcontrol_bind_io(&mc->hdr, &kc[i], io_ops,
1118 			ARRAY_SIZE(io_ops), tplg->io_ops, tplg->io_ops_count);
1119 		if (err) {
1120 			soc_control_err(tplg, &mc->hdr, mc->hdr.name);
1121 			kfree(sm);
1122 			continue;
1123 		}
1124 
1125 		/* pass control to driver for optional further init */
1126 		err = soc_tplg_init_kcontrol(tplg, &kc[i],
1127 			(struct snd_soc_tplg_ctl_hdr *)mc);
1128 		if (err < 0) {
1129 			dev_err(tplg->dev, "ASoC: failed to init %s\n",
1130 				mc->hdr.name);
1131 			kfree(sm);
1132 			continue;
1133 		}
1134 	}
1135 	return kc;
1136 
1137 err_str:
1138 	kfree(sm);
1139 err:
1140 	for (--i; i >= 0; i--)
1141 		kfree((void *)kc[i].private_value);
1142 	kfree(kc);
1143 	return NULL;
1144 }
1145 
1146 static struct snd_kcontrol_new *soc_tplg_dapm_widget_denum_create(
1147 	struct soc_tplg *tplg)
1148 {
1149 	struct snd_kcontrol_new *kc;
1150 	struct snd_soc_tplg_enum_control *ec;
1151 	struct soc_enum *se;
1152 	int i, err;
1153 
1154 	ec = (struct snd_soc_tplg_enum_control *)tplg->pos;
1155 	tplg->pos += (sizeof(struct snd_soc_tplg_enum_control) +
1156 		ec->priv.size);
1157 
1158 	/* validate kcontrol */
1159 	if (strnlen(ec->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
1160 		SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
1161 		return NULL;
1162 
1163 	kc = kzalloc(sizeof(*kc), GFP_KERNEL);
1164 	if (kc == NULL)
1165 		return NULL;
1166 
1167 	se = kzalloc(sizeof(*se), GFP_KERNEL);
1168 	if (se == NULL)
1169 		goto err;
1170 
1171 	dev_dbg(tplg->dev, " adding DAPM widget enum control %s\n",
1172 		ec->hdr.name);
1173 
1174 	kc->name = ec->hdr.name;
1175 	kc->private_value = (long)se;
1176 	kc->iface = SNDRV_CTL_ELEM_IFACE_MIXER;
1177 	kc->access = ec->hdr.access;
1178 
1179 	/* we only support FL/FR channel mapping atm */
1180 	se->reg = tplc_chan_get_reg(tplg, ec->channel, SNDRV_CHMAP_FL);
1181 	se->shift_l = tplc_chan_get_shift(tplg, ec->channel, SNDRV_CHMAP_FL);
1182 	se->shift_r = tplc_chan_get_shift(tplg, ec->channel, SNDRV_CHMAP_FR);
1183 
1184 	se->items = ec->items;
1185 	se->mask = ec->mask;
1186 	se->dobj.index = tplg->index;
1187 
1188 	switch (ec->hdr.ops.info) {
1189 	case SND_SOC_TPLG_CTL_ENUM_VALUE:
1190 	case SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE:
1191 		err = soc_tplg_denum_create_values(se, ec);
1192 		if (err < 0) {
1193 			dev_err(tplg->dev, "ASoC: could not create values for %s\n",
1194 				ec->hdr.name);
1195 			goto err_se;
1196 		}
1197 		/* fall through to create texts */
1198 	case SND_SOC_TPLG_CTL_ENUM:
1199 	case SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE:
1200 	case SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT:
1201 		err = soc_tplg_denum_create_texts(se, ec);
1202 		if (err < 0) {
1203 			dev_err(tplg->dev, "ASoC: could not create texts for %s\n",
1204 				ec->hdr.name);
1205 			goto err_se;
1206 		}
1207 		break;
1208 	default:
1209 		dev_err(tplg->dev, "ASoC: invalid enum control type %d for %s\n",
1210 			ec->hdr.ops.info, ec->hdr.name);
1211 		goto err_se;
1212 	}
1213 
1214 	/* map io handlers */
1215 	err = soc_tplg_kcontrol_bind_io(&ec->hdr, kc, io_ops,
1216 		ARRAY_SIZE(io_ops), tplg->io_ops, tplg->io_ops_count);
1217 	if (err) {
1218 		soc_control_err(tplg, &ec->hdr, ec->hdr.name);
1219 		goto err_se;
1220 	}
1221 
1222 	/* pass control to driver for optional further init */
1223 	err = soc_tplg_init_kcontrol(tplg, kc,
1224 		(struct snd_soc_tplg_ctl_hdr *)ec);
1225 	if (err < 0) {
1226 		dev_err(tplg->dev, "ASoC: failed to init %s\n",
1227 			ec->hdr.name);
1228 		goto err_se;
1229 	}
1230 
1231 	return kc;
1232 
1233 err_se:
1234 	/* free values and texts */
1235 	kfree(se->dobj.control.dvalues);
1236 	for (i = 0; i < ec->items; i++)
1237 		kfree(se->dobj.control.dtexts[i]);
1238 
1239 	kfree(se);
1240 err:
1241 	kfree(kc);
1242 
1243 	return NULL;
1244 }
1245 
1246 static struct snd_kcontrol_new *soc_tplg_dapm_widget_dbytes_create(
1247 	struct soc_tplg *tplg, int count)
1248 {
1249 	struct snd_soc_tplg_bytes_control *be;
1250 	struct soc_bytes_ext  *sbe;
1251 	struct snd_kcontrol_new *kc;
1252 	int i, err;
1253 
1254 	kc = kzalloc(sizeof(*kc) * count, GFP_KERNEL);
1255 	if (!kc)
1256 		return NULL;
1257 
1258 	for (i = 0; i < count; i++) {
1259 		be = (struct snd_soc_tplg_bytes_control *)tplg->pos;
1260 
1261 		/* validate kcontrol */
1262 		if (strnlen(be->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
1263 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
1264 			goto err;
1265 
1266 		sbe = kzalloc(sizeof(*sbe), GFP_KERNEL);
1267 		if (sbe == NULL)
1268 			goto err;
1269 
1270 		tplg->pos += (sizeof(struct snd_soc_tplg_bytes_control) +
1271 			be->priv.size);
1272 
1273 		dev_dbg(tplg->dev,
1274 			"ASoC: adding bytes kcontrol %s with access 0x%x\n",
1275 			be->hdr.name, be->hdr.access);
1276 
1277 		memset(kc, 0, sizeof(*kc));
1278 		kc[i].name = be->hdr.name;
1279 		kc[i].private_value = (long)sbe;
1280 		kc[i].iface = SNDRV_CTL_ELEM_IFACE_MIXER;
1281 		kc[i].access = be->hdr.access;
1282 
1283 		sbe->max = be->max;
1284 		INIT_LIST_HEAD(&sbe->dobj.list);
1285 
1286 		/* map standard io handlers and check for external handlers */
1287 		err = soc_tplg_kcontrol_bind_io(&be->hdr, &kc[i], io_ops,
1288 				ARRAY_SIZE(io_ops), tplg->io_ops,
1289 				tplg->io_ops_count);
1290 		if (err) {
1291 			soc_control_err(tplg, &be->hdr, be->hdr.name);
1292 			kfree(sbe);
1293 			continue;
1294 		}
1295 
1296 		/* pass control to driver for optional further init */
1297 		err = soc_tplg_init_kcontrol(tplg, &kc[i],
1298 			(struct snd_soc_tplg_ctl_hdr *)be);
1299 		if (err < 0) {
1300 			dev_err(tplg->dev, "ASoC: failed to init %s\n",
1301 				be->hdr.name);
1302 			kfree(sbe);
1303 			continue;
1304 		}
1305 	}
1306 
1307 	return kc;
1308 
1309 err:
1310 	for (--i; i >= 0; i--)
1311 		kfree((void *)kc[i].private_value);
1312 
1313 	kfree(kc);
1314 	return NULL;
1315 }
1316 
1317 static int soc_tplg_dapm_widget_create(struct soc_tplg *tplg,
1318 	struct snd_soc_tplg_dapm_widget *w)
1319 {
1320 	struct snd_soc_dapm_context *dapm = &tplg->comp->dapm;
1321 	struct snd_soc_dapm_widget template, *widget;
1322 	struct snd_soc_tplg_ctl_hdr *control_hdr;
1323 	struct snd_soc_card *card = tplg->comp->card;
1324 	int ret = 0;
1325 
1326 	if (strnlen(w->name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
1327 		SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
1328 		return -EINVAL;
1329 	if (strnlen(w->sname, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
1330 		SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
1331 		return -EINVAL;
1332 
1333 	dev_dbg(tplg->dev, "ASoC: creating DAPM widget %s id %d\n",
1334 		w->name, w->id);
1335 
1336 	memset(&template, 0, sizeof(template));
1337 
1338 	/* map user to kernel widget ID */
1339 	template.id = get_widget_id(w->id);
1340 	if (template.id < 0)
1341 		return template.id;
1342 
1343 	template.name = kstrdup(w->name, GFP_KERNEL);
1344 	if (!template.name)
1345 		return -ENOMEM;
1346 	template.sname = kstrdup(w->sname, GFP_KERNEL);
1347 	if (!template.sname) {
1348 		ret = -ENOMEM;
1349 		goto err;
1350 	}
1351 	template.reg = w->reg;
1352 	template.shift = w->shift;
1353 	template.mask = w->mask;
1354 	template.on_val = w->invert ? 0 : 1;
1355 	template.off_val = w->invert ? 1 : 0;
1356 	template.ignore_suspend = w->ignore_suspend;
1357 	template.event_flags = w->event_flags;
1358 	template.dobj.index = tplg->index;
1359 
1360 	tplg->pos +=
1361 		(sizeof(struct snd_soc_tplg_dapm_widget) + w->priv.size);
1362 	if (w->num_kcontrols == 0) {
1363 		template.num_kcontrols = 0;
1364 		goto widget;
1365 	}
1366 
1367 	control_hdr = (struct snd_soc_tplg_ctl_hdr *)tplg->pos;
1368 	dev_dbg(tplg->dev, "ASoC: template %s has %d controls of type %x\n",
1369 		w->name, w->num_kcontrols, control_hdr->type);
1370 
1371 	switch (control_hdr->ops.info) {
1372 	case SND_SOC_TPLG_CTL_VOLSW:
1373 	case SND_SOC_TPLG_CTL_STROBE:
1374 	case SND_SOC_TPLG_CTL_VOLSW_SX:
1375 	case SND_SOC_TPLG_CTL_VOLSW_XR_SX:
1376 	case SND_SOC_TPLG_CTL_RANGE:
1377 	case SND_SOC_TPLG_DAPM_CTL_VOLSW:
1378 		template.num_kcontrols = w->num_kcontrols;
1379 		template.kcontrol_news =
1380 			soc_tplg_dapm_widget_dmixer_create(tplg,
1381 			template.num_kcontrols);
1382 		if (!template.kcontrol_news) {
1383 			ret = -ENOMEM;
1384 			goto hdr_err;
1385 		}
1386 		break;
1387 	case SND_SOC_TPLG_CTL_ENUM:
1388 	case SND_SOC_TPLG_CTL_ENUM_VALUE:
1389 	case SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE:
1390 	case SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT:
1391 	case SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE:
1392 		template.dobj.widget.kcontrol_enum = 1;
1393 		template.num_kcontrols = 1;
1394 		template.kcontrol_news =
1395 			soc_tplg_dapm_widget_denum_create(tplg);
1396 		if (!template.kcontrol_news) {
1397 			ret = -ENOMEM;
1398 			goto hdr_err;
1399 		}
1400 		break;
1401 	case SND_SOC_TPLG_CTL_BYTES:
1402 		template.num_kcontrols = w->num_kcontrols;
1403 		template.kcontrol_news =
1404 			soc_tplg_dapm_widget_dbytes_create(tplg,
1405 				template.num_kcontrols);
1406 		if (!template.kcontrol_news) {
1407 			ret = -ENOMEM;
1408 			goto hdr_err;
1409 		}
1410 		break;
1411 	default:
1412 		dev_err(tplg->dev, "ASoC: invalid widget control type %d:%d:%d\n",
1413 			control_hdr->ops.get, control_hdr->ops.put,
1414 			control_hdr->ops.info);
1415 		ret = -EINVAL;
1416 		goto hdr_err;
1417 	}
1418 
1419 widget:
1420 	ret = soc_tplg_widget_load(tplg, &template, w);
1421 	if (ret < 0)
1422 		goto hdr_err;
1423 
1424 	/* card dapm mutex is held by the core if we are loading topology
1425 	 * data during sound card init. */
1426 	if (card->instantiated)
1427 		widget = snd_soc_dapm_new_control(dapm, &template);
1428 	else
1429 		widget = snd_soc_dapm_new_control_unlocked(dapm, &template);
1430 	if (widget == NULL) {
1431 		dev_err(tplg->dev, "ASoC: failed to create widget %s controls\n",
1432 			w->name);
1433 		goto hdr_err;
1434 	}
1435 
1436 	widget->dobj.type = SND_SOC_DOBJ_WIDGET;
1437 	widget->dobj.ops = tplg->ops;
1438 	widget->dobj.index = tplg->index;
1439 	list_add(&widget->dobj.list, &tplg->comp->dobj_list);
1440 	return 0;
1441 
1442 hdr_err:
1443 	kfree(template.sname);
1444 err:
1445 	kfree(template.name);
1446 	return ret;
1447 }
1448 
1449 static int soc_tplg_dapm_widget_elems_load(struct soc_tplg *tplg,
1450 	struct snd_soc_tplg_hdr *hdr)
1451 {
1452 	struct snd_soc_tplg_dapm_widget *widget;
1453 	int ret, count = hdr->count, i;
1454 
1455 	if (tplg->pass != SOC_TPLG_PASS_WIDGET)
1456 		return 0;
1457 
1458 	dev_dbg(tplg->dev, "ASoC: adding %d DAPM widgets\n", count);
1459 
1460 	for (i = 0; i < count; i++) {
1461 		widget = (struct snd_soc_tplg_dapm_widget *) tplg->pos;
1462 		ret = soc_tplg_dapm_widget_create(tplg, widget);
1463 		if (ret < 0)
1464 			dev_err(tplg->dev, "ASoC: failed to load widget %s\n",
1465 				widget->name);
1466 	}
1467 
1468 	return 0;
1469 }
1470 
1471 static int soc_tplg_dapm_complete(struct soc_tplg *tplg)
1472 {
1473 	struct snd_soc_card *card = tplg->comp->card;
1474 	int ret;
1475 
1476 	/* Card might not have been registered at this point.
1477 	 * If so, just return success.
1478 	*/
1479 	if (!card || !card->instantiated) {
1480 		dev_warn(tplg->dev, "ASoC: Parent card not yet available,"
1481 				"Do not add new widgets now\n");
1482 		return 0;
1483 	}
1484 
1485 	ret = snd_soc_dapm_new_widgets(card);
1486 	if (ret < 0)
1487 		dev_err(tplg->dev, "ASoC: failed to create new widgets %d\n",
1488 			ret);
1489 
1490 	return 0;
1491 }
1492 
1493 static int soc_tplg_pcm_dai_elems_load(struct soc_tplg *tplg,
1494 	struct snd_soc_tplg_hdr *hdr)
1495 {
1496 	struct snd_soc_tplg_pcm_dai *pcm_dai;
1497 	struct snd_soc_dobj *dobj;
1498 	int count = hdr->count;
1499 	int ret;
1500 
1501 	if (tplg->pass != SOC_TPLG_PASS_PCM_DAI)
1502 		return 0;
1503 
1504 	pcm_dai = (struct snd_soc_tplg_pcm_dai *)tplg->pos;
1505 
1506 	if (soc_tplg_check_elem_count(tplg,
1507 		sizeof(struct snd_soc_tplg_pcm_dai), count,
1508 		hdr->payload_size, "PCM DAI")) {
1509 		dev_err(tplg->dev, "ASoC: invalid count %d for PCM DAI elems\n",
1510 			count);
1511 		return -EINVAL;
1512 	}
1513 
1514 	dev_dbg(tplg->dev, "ASoC: adding %d PCM DAIs\n", count);
1515 	tplg->pos += sizeof(struct snd_soc_tplg_pcm_dai) * count;
1516 
1517 	dobj = kzalloc(sizeof(struct snd_soc_dobj), GFP_KERNEL);
1518 	if (dobj == NULL)
1519 		return -ENOMEM;
1520 
1521 	/* Call the platform driver call back to register the dais */
1522 	ret = soc_tplg_pcm_dai_load(tplg, pcm_dai, count);
1523 	if (ret < 0) {
1524 		dev_err(tplg->comp->dev, "ASoC: PCM DAI loading failed\n");
1525 		goto err;
1526 	}
1527 
1528 	dobj->type = get_dobj_type(hdr, NULL);
1529 	dobj->pcm_dai.count = count;
1530 	dobj->pcm_dai.pd = pcm_dai;
1531 	dobj->ops = tplg->ops;
1532 	dobj->index = tplg->index;
1533 	list_add(&dobj->list, &tplg->comp->dobj_list);
1534 	return 0;
1535 
1536 err:
1537 	kfree(dobj);
1538 	return ret;
1539 }
1540 
1541 static int soc_tplg_manifest_load(struct soc_tplg *tplg,
1542 	struct snd_soc_tplg_hdr *hdr)
1543 {
1544 	struct snd_soc_tplg_manifest *manifest;
1545 
1546 	if (tplg->pass != SOC_TPLG_PASS_MANIFEST)
1547 		return 0;
1548 
1549 	manifest = (struct snd_soc_tplg_manifest *)tplg->pos;
1550 	tplg->pos += sizeof(struct snd_soc_tplg_manifest);
1551 
1552 	if (tplg->comp && tplg->ops && tplg->ops->manifest)
1553 		return tplg->ops->manifest(tplg->comp, manifest);
1554 
1555 	dev_err(tplg->dev, "ASoC: Firmware manifest not supported\n");
1556 	return 0;
1557 }
1558 
1559 /* validate header magic, size and type */
1560 static int soc_valid_header(struct soc_tplg *tplg,
1561 	struct snd_soc_tplg_hdr *hdr)
1562 {
1563 	if (soc_tplg_get_hdr_offset(tplg) >= tplg->fw->size)
1564 		return 0;
1565 
1566 	/* big endian firmware objects not supported atm */
1567 	if (hdr->magic == cpu_to_be32(SND_SOC_TPLG_MAGIC)) {
1568 		dev_err(tplg->dev,
1569 			"ASoC: pass %d big endian not supported header got %x at offset 0x%lx size 0x%zx.\n",
1570 			tplg->pass, hdr->magic,
1571 			soc_tplg_get_hdr_offset(tplg), tplg->fw->size);
1572 		return -EINVAL;
1573 	}
1574 
1575 	if (hdr->magic != SND_SOC_TPLG_MAGIC) {
1576 		dev_err(tplg->dev,
1577 			"ASoC: pass %d does not have a valid header got %x at offset 0x%lx size 0x%zx.\n",
1578 			tplg->pass, hdr->magic,
1579 			soc_tplg_get_hdr_offset(tplg), tplg->fw->size);
1580 		return -EINVAL;
1581 	}
1582 
1583 	if (hdr->abi != SND_SOC_TPLG_ABI_VERSION) {
1584 		dev_err(tplg->dev,
1585 			"ASoC: pass %d invalid ABI version got 0x%x need 0x%x at offset 0x%lx size 0x%zx.\n",
1586 			tplg->pass, hdr->abi,
1587 			SND_SOC_TPLG_ABI_VERSION, soc_tplg_get_hdr_offset(tplg),
1588 			tplg->fw->size);
1589 		return -EINVAL;
1590 	}
1591 
1592 	if (hdr->payload_size == 0) {
1593 		dev_err(tplg->dev, "ASoC: header has 0 size at offset 0x%lx.\n",
1594 			soc_tplg_get_hdr_offset(tplg));
1595 		return -EINVAL;
1596 	}
1597 
1598 	if (tplg->pass == hdr->type)
1599 		dev_dbg(tplg->dev,
1600 			"ASoC: Got 0x%x bytes of type %d version %d vendor %d at pass %d\n",
1601 			hdr->payload_size, hdr->type, hdr->version,
1602 			hdr->vendor_type, tplg->pass);
1603 
1604 	return 1;
1605 }
1606 
1607 /* check header type and call appropriate handler */
1608 static int soc_tplg_load_header(struct soc_tplg *tplg,
1609 	struct snd_soc_tplg_hdr *hdr)
1610 {
1611 	tplg->pos = tplg->hdr_pos + sizeof(struct snd_soc_tplg_hdr);
1612 
1613 	/* check for matching ID */
1614 	if (hdr->index != tplg->req_index &&
1615 		hdr->index != SND_SOC_TPLG_INDEX_ALL)
1616 		return 0;
1617 
1618 	tplg->index = hdr->index;
1619 
1620 	switch (hdr->type) {
1621 	case SND_SOC_TPLG_TYPE_MIXER:
1622 	case SND_SOC_TPLG_TYPE_ENUM:
1623 	case SND_SOC_TPLG_TYPE_BYTES:
1624 		return soc_tplg_kcontrol_elems_load(tplg, hdr);
1625 	case SND_SOC_TPLG_TYPE_DAPM_GRAPH:
1626 		return soc_tplg_dapm_graph_elems_load(tplg, hdr);
1627 	case SND_SOC_TPLG_TYPE_DAPM_WIDGET:
1628 		return soc_tplg_dapm_widget_elems_load(tplg, hdr);
1629 	case SND_SOC_TPLG_TYPE_PCM:
1630 	case SND_SOC_TPLG_TYPE_DAI_LINK:
1631 	case SND_SOC_TPLG_TYPE_CODEC_LINK:
1632 		return soc_tplg_pcm_dai_elems_load(tplg, hdr);
1633 	case SND_SOC_TPLG_TYPE_MANIFEST:
1634 		return soc_tplg_manifest_load(tplg, hdr);
1635 	default:
1636 		/* bespoke vendor data object */
1637 		return soc_tplg_vendor_load(tplg, hdr);
1638 	}
1639 
1640 	return 0;
1641 }
1642 
1643 /* process the topology file headers */
1644 static int soc_tplg_process_headers(struct soc_tplg *tplg)
1645 {
1646 	struct snd_soc_tplg_hdr *hdr;
1647 	int ret;
1648 
1649 	tplg->pass = SOC_TPLG_PASS_START;
1650 
1651 	/* process the header types from start to end */
1652 	while (tplg->pass <= SOC_TPLG_PASS_END) {
1653 
1654 		tplg->hdr_pos = tplg->fw->data;
1655 		hdr = (struct snd_soc_tplg_hdr *)tplg->hdr_pos;
1656 
1657 		while (!soc_tplg_is_eof(tplg)) {
1658 
1659 			/* make sure header is valid before loading */
1660 			ret = soc_valid_header(tplg, hdr);
1661 			if (ret < 0)
1662 				return ret;
1663 			else if (ret == 0)
1664 				break;
1665 
1666 			/* load the header object */
1667 			ret = soc_tplg_load_header(tplg, hdr);
1668 			if (ret < 0)
1669 				return ret;
1670 
1671 			/* goto next header */
1672 			tplg->hdr_pos += hdr->payload_size +
1673 				sizeof(struct snd_soc_tplg_hdr);
1674 			hdr = (struct snd_soc_tplg_hdr *)tplg->hdr_pos;
1675 		}
1676 
1677 		/* next data type pass */
1678 		tplg->pass++;
1679 	}
1680 
1681 	/* signal DAPM we are complete */
1682 	ret = soc_tplg_dapm_complete(tplg);
1683 	if (ret < 0)
1684 		dev_err(tplg->dev,
1685 			"ASoC: failed to initialise DAPM from Firmware\n");
1686 
1687 	return ret;
1688 }
1689 
1690 static int soc_tplg_load(struct soc_tplg *tplg)
1691 {
1692 	int ret;
1693 
1694 	ret = soc_tplg_process_headers(tplg);
1695 	if (ret == 0)
1696 		soc_tplg_complete(tplg);
1697 
1698 	return ret;
1699 }
1700 
1701 /* load audio component topology from "firmware" file */
1702 int snd_soc_tplg_component_load(struct snd_soc_component *comp,
1703 	struct snd_soc_tplg_ops *ops, const struct firmware *fw, u32 id)
1704 {
1705 	struct soc_tplg tplg;
1706 
1707 	/* setup parsing context */
1708 	memset(&tplg, 0, sizeof(tplg));
1709 	tplg.fw = fw;
1710 	tplg.dev = comp->dev;
1711 	tplg.comp = comp;
1712 	tplg.ops = ops;
1713 	tplg.req_index = id;
1714 	tplg.io_ops = ops->io_ops;
1715 	tplg.io_ops_count = ops->io_ops_count;
1716 
1717 	return soc_tplg_load(&tplg);
1718 }
1719 EXPORT_SYMBOL_GPL(snd_soc_tplg_component_load);
1720 
1721 /* remove this dynamic widget */
1722 void snd_soc_tplg_widget_remove(struct snd_soc_dapm_widget *w)
1723 {
1724 	/* make sure we are a widget */
1725 	if (w->dobj.type != SND_SOC_DOBJ_WIDGET)
1726 		return;
1727 
1728 	remove_widget(w->dapm->component, &w->dobj, SOC_TPLG_PASS_WIDGET);
1729 }
1730 EXPORT_SYMBOL_GPL(snd_soc_tplg_widget_remove);
1731 
1732 /* remove all dynamic widgets from this DAPM context */
1733 void snd_soc_tplg_widget_remove_all(struct snd_soc_dapm_context *dapm,
1734 	u32 index)
1735 {
1736 	struct snd_soc_dapm_widget *w, *next_w;
1737 	struct snd_soc_dapm_path *p, *next_p;
1738 
1739 	list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) {
1740 
1741 		/* make sure we are a widget with correct context */
1742 		if (w->dobj.type != SND_SOC_DOBJ_WIDGET || w->dapm != dapm)
1743 			continue;
1744 
1745 		/* match ID */
1746 		if (w->dobj.index != index &&
1747 			w->dobj.index != SND_SOC_TPLG_INDEX_ALL)
1748 			continue;
1749 
1750 		list_del(&w->list);
1751 
1752 		/*
1753 		 * remove source and sink paths associated to this widget.
1754 		 * While removing the path, remove reference to it from both
1755 		 * source and sink widgets so that path is removed only once.
1756 		 */
1757 		list_for_each_entry_safe(p, next_p, &w->sources, list_sink) {
1758 			list_del(&p->list_sink);
1759 			list_del(&p->list_source);
1760 			list_del(&p->list);
1761 			kfree(p);
1762 		}
1763 		list_for_each_entry_safe(p, next_p, &w->sinks, list_source) {
1764 			list_del(&p->list_sink);
1765 			list_del(&p->list_source);
1766 			list_del(&p->list);
1767 			kfree(p);
1768 		}
1769 		/* check and free and dynamic widget kcontrols */
1770 		snd_soc_tplg_widget_remove(w);
1771 		kfree(w->kcontrols);
1772 		kfree(w->name);
1773 		kfree(w);
1774 	}
1775 }
1776 EXPORT_SYMBOL_GPL(snd_soc_tplg_widget_remove_all);
1777 
1778 /* remove dynamic controls from the component driver */
1779 int snd_soc_tplg_component_remove(struct snd_soc_component *comp, u32 index)
1780 {
1781 	struct snd_soc_dobj *dobj, *next_dobj;
1782 	int pass = SOC_TPLG_PASS_END;
1783 
1784 	/* process the header types from end to start */
1785 	while (pass >= SOC_TPLG_PASS_START) {
1786 
1787 		/* remove mixer controls */
1788 		list_for_each_entry_safe(dobj, next_dobj, &comp->dobj_list,
1789 			list) {
1790 
1791 			/* match index */
1792 			if (dobj->index != index &&
1793 				dobj->index != SND_SOC_TPLG_INDEX_ALL)
1794 				continue;
1795 
1796 			switch (dobj->type) {
1797 			case SND_SOC_DOBJ_MIXER:
1798 				remove_mixer(comp, dobj, pass);
1799 				break;
1800 			case SND_SOC_DOBJ_ENUM:
1801 				remove_enum(comp, dobj, pass);
1802 				break;
1803 			case SND_SOC_DOBJ_BYTES:
1804 				remove_bytes(comp, dobj, pass);
1805 				break;
1806 			case SND_SOC_DOBJ_WIDGET:
1807 				remove_widget(comp, dobj, pass);
1808 				break;
1809 			case SND_SOC_DOBJ_PCM:
1810 			case SND_SOC_DOBJ_DAI_LINK:
1811 			case SND_SOC_DOBJ_CODEC_LINK:
1812 				remove_pcm_dai(comp, dobj, pass);
1813 				break;
1814 			default:
1815 				dev_err(comp->dev, "ASoC: invalid component type %d for removal\n",
1816 					dobj->type);
1817 				break;
1818 			}
1819 		}
1820 		pass--;
1821 	}
1822 
1823 	/* let caller know if FW can be freed when no objects are left */
1824 	return !list_empty(&comp->dobj_list);
1825 }
1826 EXPORT_SYMBOL_GPL(snd_soc_tplg_component_remove);
1827