xref: /openbmc/linux/sound/soc/soc-topology.c (revision 55726dc9)
18a978234SLiam Girdwood /*
28a978234SLiam Girdwood  * soc-topology.c  --  ALSA SoC Topology
38a978234SLiam Girdwood  *
48a978234SLiam Girdwood  * Copyright (C) 2012 Texas Instruments Inc.
58a978234SLiam Girdwood  * Copyright (C) 2015 Intel Corporation.
68a978234SLiam Girdwood  *
78a978234SLiam Girdwood  * Authors: Liam Girdwood <liam.r.girdwood@linux.intel.com>
88a978234SLiam Girdwood  *		K, Mythri P <mythri.p.k@intel.com>
98a978234SLiam Girdwood  *		Prusty, Subhransu S <subhransu.s.prusty@intel.com>
108a978234SLiam Girdwood  *		B, Jayachandran <jayachandran.b@intel.com>
118a978234SLiam Girdwood  *		Abdullah, Omair M <omair.m.abdullah@intel.com>
128a978234SLiam Girdwood  *		Jin, Yao <yao.jin@intel.com>
138a978234SLiam Girdwood  *		Lin, Mengdong <mengdong.lin@intel.com>
148a978234SLiam Girdwood  *
158a978234SLiam Girdwood  *  This program is free software; you can redistribute  it and/or modify it
168a978234SLiam Girdwood  *  under  the terms of  the GNU General  Public License as published by the
178a978234SLiam Girdwood  *  Free Software Foundation;  either version 2 of the  License, or (at your
188a978234SLiam Girdwood  *  option) any later version.
198a978234SLiam Girdwood  *
208a978234SLiam Girdwood  *  Add support to read audio firmware topology alongside firmware text. The
218a978234SLiam Girdwood  *  topology data can contain kcontrols, DAPM graphs, widgets, DAIs, DAI links,
228a978234SLiam Girdwood  *  equalizers, firmware, coefficients etc.
238a978234SLiam Girdwood  *
248a978234SLiam Girdwood  *  This file only manages the core ALSA and ASoC components, all other bespoke
258a978234SLiam Girdwood  *  firmware topology data is passed to component drivers for bespoke handling.
268a978234SLiam Girdwood  */
278a978234SLiam Girdwood 
288a978234SLiam Girdwood #include <linux/kernel.h>
298a978234SLiam Girdwood #include <linux/export.h>
308a978234SLiam Girdwood #include <linux/list.h>
318a978234SLiam Girdwood #include <linux/firmware.h>
328a978234SLiam Girdwood #include <linux/slab.h>
338a978234SLiam Girdwood #include <sound/soc.h>
348a978234SLiam Girdwood #include <sound/soc-dapm.h>
358a978234SLiam Girdwood #include <sound/soc-topology.h>
3628a87eebSMengdong Lin #include <sound/tlv.h>
378a978234SLiam Girdwood 
388a978234SLiam Girdwood /*
398a978234SLiam Girdwood  * We make several passes over the data (since it wont necessarily be ordered)
408a978234SLiam Girdwood  * and process objects in the following order. This guarantees the component
418a978234SLiam Girdwood  * drivers will be ready with any vendor data before the mixers and DAPM objects
428a978234SLiam Girdwood  * are loaded (that may make use of the vendor data).
438a978234SLiam Girdwood  */
448a978234SLiam Girdwood #define SOC_TPLG_PASS_MANIFEST		0
458a978234SLiam Girdwood #define SOC_TPLG_PASS_VENDOR		1
468a978234SLiam Girdwood #define SOC_TPLG_PASS_MIXER		2
478a978234SLiam Girdwood #define SOC_TPLG_PASS_WIDGET		3
481a8e7fabSMengdong Lin #define SOC_TPLG_PASS_PCM_DAI		4
491a8e7fabSMengdong Lin #define SOC_TPLG_PASS_GRAPH		5
501a8e7fabSMengdong Lin #define SOC_TPLG_PASS_PINS		6
510038be9aSMengdong Lin #define SOC_TPLG_PASS_BE_DAI		7
528a978234SLiam Girdwood 
538a978234SLiam Girdwood #define SOC_TPLG_PASS_START	SOC_TPLG_PASS_MANIFEST
540038be9aSMengdong Lin #define SOC_TPLG_PASS_END	SOC_TPLG_PASS_BE_DAI
558a978234SLiam Girdwood 
56583958faSMengdong Lin /*
57583958faSMengdong Lin  * Old version of ABI structs, supported for backward compatibility.
58583958faSMengdong Lin  */
59583958faSMengdong Lin 
60583958faSMengdong Lin /* Manifest v4 */
61583958faSMengdong Lin struct snd_soc_tplg_manifest_v4 {
62583958faSMengdong Lin 	__le32 size;		/* in bytes of this structure */
63583958faSMengdong Lin 	__le32 control_elems;	/* number of control elements */
64583958faSMengdong Lin 	__le32 widget_elems;	/* number of widget elements */
65583958faSMengdong Lin 	__le32 graph_elems;	/* number of graph elements */
66583958faSMengdong Lin 	__le32 pcm_elems;	/* number of PCM elements */
67583958faSMengdong Lin 	__le32 dai_link_elems;	/* number of DAI link elements */
68583958faSMengdong Lin 	struct snd_soc_tplg_private priv;
69583958faSMengdong Lin } __packed;
70583958faSMengdong Lin 
71*55726dc9SMengdong Lin /* Stream Capabilities v4 */
72*55726dc9SMengdong Lin struct snd_soc_tplg_stream_caps_v4 {
73*55726dc9SMengdong Lin 	__le32 size;		/* in bytes of this structure */
74*55726dc9SMengdong Lin 	char name[SNDRV_CTL_ELEM_ID_NAME_MAXLEN];
75*55726dc9SMengdong Lin 	__le64 formats;	/* supported formats SNDRV_PCM_FMTBIT_* */
76*55726dc9SMengdong Lin 	__le32 rates;		/* supported rates SNDRV_PCM_RATE_* */
77*55726dc9SMengdong Lin 	__le32 rate_min;	/* min rate */
78*55726dc9SMengdong Lin 	__le32 rate_max;	/* max rate */
79*55726dc9SMengdong Lin 	__le32 channels_min;	/* min channels */
80*55726dc9SMengdong Lin 	__le32 channels_max;	/* max channels */
81*55726dc9SMengdong Lin 	__le32 periods_min;	/* min number of periods */
82*55726dc9SMengdong Lin 	__le32 periods_max;	/* max number of periods */
83*55726dc9SMengdong Lin 	__le32 period_size_min;	/* min period size bytes */
84*55726dc9SMengdong Lin 	__le32 period_size_max;	/* max period size bytes */
85*55726dc9SMengdong Lin 	__le32 buffer_size_min;	/* min buffer size bytes */
86*55726dc9SMengdong Lin 	__le32 buffer_size_max;	/* max buffer size bytes */
87*55726dc9SMengdong Lin } __packed;
88*55726dc9SMengdong Lin 
89*55726dc9SMengdong Lin /* PCM v4 */
90*55726dc9SMengdong Lin struct snd_soc_tplg_pcm_v4 {
91*55726dc9SMengdong Lin 	__le32 size;		/* in bytes of this structure */
92*55726dc9SMengdong Lin 	char pcm_name[SNDRV_CTL_ELEM_ID_NAME_MAXLEN];
93*55726dc9SMengdong Lin 	char dai_name[SNDRV_CTL_ELEM_ID_NAME_MAXLEN];
94*55726dc9SMengdong Lin 	__le32 pcm_id;		/* unique ID - used to match with DAI link */
95*55726dc9SMengdong Lin 	__le32 dai_id;		/* unique ID - used to match */
96*55726dc9SMengdong Lin 	__le32 playback;	/* supports playback mode */
97*55726dc9SMengdong Lin 	__le32 capture;		/* supports capture mode */
98*55726dc9SMengdong Lin 	__le32 compress;	/* 1 = compressed; 0 = PCM */
99*55726dc9SMengdong Lin 	struct snd_soc_tplg_stream stream[SND_SOC_TPLG_STREAM_CONFIG_MAX]; /* for DAI link */
100*55726dc9SMengdong Lin 	__le32 num_streams;	/* number of streams */
101*55726dc9SMengdong Lin 	struct snd_soc_tplg_stream_caps_v4 caps[2]; /* playback and capture for DAI */
102*55726dc9SMengdong Lin } __packed;
103*55726dc9SMengdong Lin 
104583958faSMengdong Lin /* topology context */
1058a978234SLiam Girdwood struct soc_tplg {
1068a978234SLiam Girdwood 	const struct firmware *fw;
1078a978234SLiam Girdwood 
1088a978234SLiam Girdwood 	/* runtime FW parsing */
1098a978234SLiam Girdwood 	const u8 *pos;		/* read postion */
1108a978234SLiam Girdwood 	const u8 *hdr_pos;	/* header position */
1118a978234SLiam Girdwood 	unsigned int pass;	/* pass number */
1128a978234SLiam Girdwood 
1138a978234SLiam Girdwood 	/* component caller */
1148a978234SLiam Girdwood 	struct device *dev;
1158a978234SLiam Girdwood 	struct snd_soc_component *comp;
1168a978234SLiam Girdwood 	u32 index;	/* current block index */
1178a978234SLiam Girdwood 	u32 req_index;	/* required index, only loaded/free matching blocks */
1188a978234SLiam Girdwood 
11988a17d8fSMengdong Lin 	/* vendor specific kcontrol operations */
1208a978234SLiam Girdwood 	const struct snd_soc_tplg_kcontrol_ops *io_ops;
1218a978234SLiam Girdwood 	int io_ops_count;
1228a978234SLiam Girdwood 
1231a3232d2SMengdong Lin 	/* vendor specific bytes ext handlers, for TLV bytes controls */
1241a3232d2SMengdong Lin 	const struct snd_soc_tplg_bytes_ext_ops *bytes_ext_ops;
1251a3232d2SMengdong Lin 	int bytes_ext_ops_count;
1261a3232d2SMengdong Lin 
1278a978234SLiam Girdwood 	/* optional fw loading callbacks to component drivers */
1288a978234SLiam Girdwood 	struct snd_soc_tplg_ops *ops;
1298a978234SLiam Girdwood };
1308a978234SLiam Girdwood 
1318a978234SLiam Girdwood static int soc_tplg_process_headers(struct soc_tplg *tplg);
1328a978234SLiam Girdwood static void soc_tplg_complete(struct soc_tplg *tplg);
1338a978234SLiam Girdwood struct snd_soc_dapm_widget *
1348a978234SLiam Girdwood snd_soc_dapm_new_control_unlocked(struct snd_soc_dapm_context *dapm,
1358a978234SLiam Girdwood 			 const struct snd_soc_dapm_widget *widget);
1368a978234SLiam Girdwood struct snd_soc_dapm_widget *
1378a978234SLiam Girdwood snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm,
1388a978234SLiam Girdwood 			 const struct snd_soc_dapm_widget *widget);
1398a978234SLiam Girdwood 
1408a978234SLiam Girdwood /* check we dont overflow the data for this control chunk */
1418a978234SLiam Girdwood static int soc_tplg_check_elem_count(struct soc_tplg *tplg, size_t elem_size,
1428a978234SLiam Girdwood 	unsigned int count, size_t bytes, const char *elem_type)
1438a978234SLiam Girdwood {
1448a978234SLiam Girdwood 	const u8 *end = tplg->pos + elem_size * count;
1458a978234SLiam Girdwood 
1468a978234SLiam Girdwood 	if (end > tplg->fw->data + tplg->fw->size) {
1478a978234SLiam Girdwood 		dev_err(tplg->dev, "ASoC: %s overflow end of data\n",
1488a978234SLiam Girdwood 			elem_type);
1498a978234SLiam Girdwood 		return -EINVAL;
1508a978234SLiam Girdwood 	}
1518a978234SLiam Girdwood 
1528a978234SLiam Girdwood 	/* check there is enough room in chunk for control.
1538a978234SLiam Girdwood 	   extra bytes at the end of control are for vendor data here  */
1548a978234SLiam Girdwood 	if (elem_size * count > bytes) {
1558a978234SLiam Girdwood 		dev_err(tplg->dev,
1568a978234SLiam Girdwood 			"ASoC: %s count %d of size %zu is bigger than chunk %zu\n",
1578a978234SLiam Girdwood 			elem_type, count, elem_size, bytes);
1588a978234SLiam Girdwood 		return -EINVAL;
1598a978234SLiam Girdwood 	}
1608a978234SLiam Girdwood 
1618a978234SLiam Girdwood 	return 0;
1628a978234SLiam Girdwood }
1638a978234SLiam Girdwood 
1648a978234SLiam Girdwood static inline int soc_tplg_is_eof(struct soc_tplg *tplg)
1658a978234SLiam Girdwood {
1668a978234SLiam Girdwood 	const u8 *end = tplg->hdr_pos;
1678a978234SLiam Girdwood 
1688a978234SLiam Girdwood 	if (end >= tplg->fw->data + tplg->fw->size)
1698a978234SLiam Girdwood 		return 1;
1708a978234SLiam Girdwood 	return 0;
1718a978234SLiam Girdwood }
1728a978234SLiam Girdwood 
1738a978234SLiam Girdwood static inline unsigned long soc_tplg_get_hdr_offset(struct soc_tplg *tplg)
1748a978234SLiam Girdwood {
1758a978234SLiam Girdwood 	return (unsigned long)(tplg->hdr_pos - tplg->fw->data);
1768a978234SLiam Girdwood }
1778a978234SLiam Girdwood 
1788a978234SLiam Girdwood static inline unsigned long soc_tplg_get_offset(struct soc_tplg *tplg)
1798a978234SLiam Girdwood {
1808a978234SLiam Girdwood 	return (unsigned long)(tplg->pos - tplg->fw->data);
1818a978234SLiam Girdwood }
1828a978234SLiam Girdwood 
1838a978234SLiam Girdwood /* mapping of Kcontrol types and associated operations. */
1848a978234SLiam Girdwood static const struct snd_soc_tplg_kcontrol_ops io_ops[] = {
1858a978234SLiam Girdwood 	{SND_SOC_TPLG_CTL_VOLSW, snd_soc_get_volsw,
1868a978234SLiam Girdwood 		snd_soc_put_volsw, snd_soc_info_volsw},
1878a978234SLiam Girdwood 	{SND_SOC_TPLG_CTL_VOLSW_SX, snd_soc_get_volsw_sx,
1888a978234SLiam Girdwood 		snd_soc_put_volsw_sx, NULL},
1898a978234SLiam Girdwood 	{SND_SOC_TPLG_CTL_ENUM, snd_soc_get_enum_double,
1908a978234SLiam Girdwood 		snd_soc_put_enum_double, snd_soc_info_enum_double},
1918a978234SLiam Girdwood 	{SND_SOC_TPLG_CTL_ENUM_VALUE, snd_soc_get_enum_double,
1928a978234SLiam Girdwood 		snd_soc_put_enum_double, NULL},
1938a978234SLiam Girdwood 	{SND_SOC_TPLG_CTL_BYTES, snd_soc_bytes_get,
1948a978234SLiam Girdwood 		snd_soc_bytes_put, snd_soc_bytes_info},
1958a978234SLiam Girdwood 	{SND_SOC_TPLG_CTL_RANGE, snd_soc_get_volsw_range,
1968a978234SLiam Girdwood 		snd_soc_put_volsw_range, snd_soc_info_volsw_range},
1978a978234SLiam Girdwood 	{SND_SOC_TPLG_CTL_VOLSW_XR_SX, snd_soc_get_xr_sx,
1988a978234SLiam Girdwood 		snd_soc_put_xr_sx, snd_soc_info_xr_sx},
1998a978234SLiam Girdwood 	{SND_SOC_TPLG_CTL_STROBE, snd_soc_get_strobe,
2008a978234SLiam Girdwood 		snd_soc_put_strobe, NULL},
2018a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_CTL_VOLSW, snd_soc_dapm_get_volsw,
2022c57d478SJeeja KP 		snd_soc_dapm_put_volsw, snd_soc_info_volsw},
2038a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE, snd_soc_dapm_get_enum_double,
2048a978234SLiam Girdwood 		snd_soc_dapm_put_enum_double, snd_soc_info_enum_double},
2058a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT, snd_soc_dapm_get_enum_double,
2068a978234SLiam Girdwood 		snd_soc_dapm_put_enum_double, NULL},
2078a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE, snd_soc_dapm_get_enum_double,
2088a978234SLiam Girdwood 		snd_soc_dapm_put_enum_double, NULL},
2098a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_CTL_PIN, snd_soc_dapm_get_pin_switch,
2108a978234SLiam Girdwood 		snd_soc_dapm_put_pin_switch, snd_soc_dapm_info_pin_switch},
2118a978234SLiam Girdwood };
2128a978234SLiam Girdwood 
2138a978234SLiam Girdwood struct soc_tplg_map {
2148a978234SLiam Girdwood 	int uid;
2158a978234SLiam Girdwood 	int kid;
2168a978234SLiam Girdwood };
2178a978234SLiam Girdwood 
2188a978234SLiam Girdwood /* mapping of widget types from UAPI IDs to kernel IDs */
2198a978234SLiam Girdwood static const struct soc_tplg_map dapm_map[] = {
2208a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_INPUT, snd_soc_dapm_input},
2218a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_OUTPUT, snd_soc_dapm_output},
2228a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_MUX, snd_soc_dapm_mux},
2238a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_MIXER, snd_soc_dapm_mixer},
2248a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_PGA, snd_soc_dapm_pga},
2258a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_OUT_DRV, snd_soc_dapm_out_drv},
2268a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_ADC, snd_soc_dapm_adc},
2278a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_DAC, snd_soc_dapm_dac},
2288a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_SWITCH, snd_soc_dapm_switch},
2298a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_PRE, snd_soc_dapm_pre},
2308a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_POST, snd_soc_dapm_post},
2318a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_AIF_IN, snd_soc_dapm_aif_in},
2328a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_AIF_OUT, snd_soc_dapm_aif_out},
2338a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_DAI_IN, snd_soc_dapm_dai_in},
2348a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_DAI_OUT, snd_soc_dapm_dai_out},
2358a978234SLiam Girdwood 	{SND_SOC_TPLG_DAPM_DAI_LINK, snd_soc_dapm_dai_link},
2368a978234SLiam Girdwood };
2378a978234SLiam Girdwood 
2388a978234SLiam Girdwood static int tplc_chan_get_reg(struct soc_tplg *tplg,
2398a978234SLiam Girdwood 	struct snd_soc_tplg_channel *chan, int map)
2408a978234SLiam Girdwood {
2418a978234SLiam Girdwood 	int i;
2428a978234SLiam Girdwood 
2438a978234SLiam Girdwood 	for (i = 0; i < SND_SOC_TPLG_MAX_CHAN; i++) {
2448a978234SLiam Girdwood 		if (chan[i].id == map)
2458a978234SLiam Girdwood 			return chan[i].reg;
2468a978234SLiam Girdwood 	}
2478a978234SLiam Girdwood 
2488a978234SLiam Girdwood 	return -EINVAL;
2498a978234SLiam Girdwood }
2508a978234SLiam Girdwood 
2518a978234SLiam Girdwood static int tplc_chan_get_shift(struct soc_tplg *tplg,
2528a978234SLiam Girdwood 	struct snd_soc_tplg_channel *chan, int map)
2538a978234SLiam Girdwood {
2548a978234SLiam Girdwood 	int i;
2558a978234SLiam Girdwood 
2568a978234SLiam Girdwood 	for (i = 0; i < SND_SOC_TPLG_MAX_CHAN; i++) {
2578a978234SLiam Girdwood 		if (chan[i].id == map)
2588a978234SLiam Girdwood 			return chan[i].shift;
2598a978234SLiam Girdwood 	}
2608a978234SLiam Girdwood 
2618a978234SLiam Girdwood 	return -EINVAL;
2628a978234SLiam Girdwood }
2638a978234SLiam Girdwood 
2648a978234SLiam Girdwood static int get_widget_id(int tplg_type)
2658a978234SLiam Girdwood {
2668a978234SLiam Girdwood 	int i;
2678a978234SLiam Girdwood 
2688a978234SLiam Girdwood 	for (i = 0; i < ARRAY_SIZE(dapm_map); i++) {
2698a978234SLiam Girdwood 		if (tplg_type == dapm_map[i].uid)
2708a978234SLiam Girdwood 			return dapm_map[i].kid;
2718a978234SLiam Girdwood 	}
2728a978234SLiam Girdwood 
2738a978234SLiam Girdwood 	return -EINVAL;
2748a978234SLiam Girdwood }
2758a978234SLiam Girdwood 
2768a978234SLiam Girdwood static inline void soc_bind_err(struct soc_tplg *tplg,
2778a978234SLiam Girdwood 	struct snd_soc_tplg_ctl_hdr *hdr, int index)
2788a978234SLiam Girdwood {
2798a978234SLiam Girdwood 	dev_err(tplg->dev,
2808a978234SLiam Girdwood 		"ASoC: invalid control type (g,p,i) %d:%d:%d index %d at 0x%lx\n",
2818a978234SLiam Girdwood 		hdr->ops.get, hdr->ops.put, hdr->ops.info, index,
2828a978234SLiam Girdwood 		soc_tplg_get_offset(tplg));
2838a978234SLiam Girdwood }
2848a978234SLiam Girdwood 
2858a978234SLiam Girdwood static inline void soc_control_err(struct soc_tplg *tplg,
2868a978234SLiam Girdwood 	struct snd_soc_tplg_ctl_hdr *hdr, const char *name)
2878a978234SLiam Girdwood {
2888a978234SLiam Girdwood 	dev_err(tplg->dev,
2898a978234SLiam Girdwood 		"ASoC: no complete mixer IO handler for %s type (g,p,i) %d:%d:%d at 0x%lx\n",
2908a978234SLiam Girdwood 		name, hdr->ops.get, hdr->ops.put, hdr->ops.info,
2918a978234SLiam Girdwood 		soc_tplg_get_offset(tplg));
2928a978234SLiam Girdwood }
2938a978234SLiam Girdwood 
2948a978234SLiam Girdwood /* pass vendor data to component driver for processing */
2958a978234SLiam Girdwood static int soc_tplg_vendor_load_(struct soc_tplg *tplg,
2968a978234SLiam Girdwood 	struct snd_soc_tplg_hdr *hdr)
2978a978234SLiam Girdwood {
2988a978234SLiam Girdwood 	int ret = 0;
2998a978234SLiam Girdwood 
3008a978234SLiam Girdwood 	if (tplg->comp && tplg->ops && tplg->ops->vendor_load)
3018a978234SLiam Girdwood 		ret = tplg->ops->vendor_load(tplg->comp, hdr);
3028a978234SLiam Girdwood 	else {
3038a978234SLiam Girdwood 		dev_err(tplg->dev, "ASoC: no vendor load callback for ID %d\n",
3048a978234SLiam Girdwood 			hdr->vendor_type);
3058a978234SLiam Girdwood 		return -EINVAL;
3068a978234SLiam Girdwood 	}
3078a978234SLiam Girdwood 
3088a978234SLiam Girdwood 	if (ret < 0)
3098a978234SLiam Girdwood 		dev_err(tplg->dev,
3108a978234SLiam Girdwood 			"ASoC: vendor load failed at hdr offset %ld/0x%lx for type %d:%d\n",
3118a978234SLiam Girdwood 			soc_tplg_get_hdr_offset(tplg),
3128a978234SLiam Girdwood 			soc_tplg_get_hdr_offset(tplg),
3138a978234SLiam Girdwood 			hdr->type, hdr->vendor_type);
3148a978234SLiam Girdwood 	return ret;
3158a978234SLiam Girdwood }
3168a978234SLiam Girdwood 
3178a978234SLiam Girdwood /* pass vendor data to component driver for processing */
3188a978234SLiam Girdwood static int soc_tplg_vendor_load(struct soc_tplg *tplg,
3198a978234SLiam Girdwood 	struct snd_soc_tplg_hdr *hdr)
3208a978234SLiam Girdwood {
3218a978234SLiam Girdwood 	if (tplg->pass != SOC_TPLG_PASS_VENDOR)
3228a978234SLiam Girdwood 		return 0;
3238a978234SLiam Girdwood 
3248a978234SLiam Girdwood 	return soc_tplg_vendor_load_(tplg, hdr);
3258a978234SLiam Girdwood }
3268a978234SLiam Girdwood 
3278a978234SLiam Girdwood /* optionally pass new dynamic widget to component driver. This is mainly for
3288a978234SLiam Girdwood  * external widgets where we can assign private data/ops */
3298a978234SLiam Girdwood static int soc_tplg_widget_load(struct soc_tplg *tplg,
3308a978234SLiam Girdwood 	struct snd_soc_dapm_widget *w, struct snd_soc_tplg_dapm_widget *tplg_w)
3318a978234SLiam Girdwood {
3328a978234SLiam Girdwood 	if (tplg->comp && tplg->ops && tplg->ops->widget_load)
3338a978234SLiam Girdwood 		return tplg->ops->widget_load(tplg->comp, w, tplg_w);
3348a978234SLiam Girdwood 
3358a978234SLiam Girdwood 	return 0;
3368a978234SLiam Girdwood }
3378a978234SLiam Girdwood 
33864527e8aSMengdong Lin /* pass DAI configurations to component driver for extra intialization */
33964527e8aSMengdong Lin static int soc_tplg_dai_load(struct soc_tplg *tplg,
34064527e8aSMengdong Lin 	struct snd_soc_dai_driver *dai_drv)
3418a978234SLiam Girdwood {
34264527e8aSMengdong Lin 	if (tplg->comp && tplg->ops && tplg->ops->dai_load)
34364527e8aSMengdong Lin 		return tplg->ops->dai_load(tplg->comp, dai_drv);
3448a978234SLiam Girdwood 
3458a978234SLiam Girdwood 	return 0;
3468a978234SLiam Girdwood }
3478a978234SLiam Girdwood 
348acfc7d46SMengdong Lin /* pass link configurations to component driver for extra intialization */
349acfc7d46SMengdong Lin static int soc_tplg_dai_link_load(struct soc_tplg *tplg,
350acfc7d46SMengdong Lin 	struct snd_soc_dai_link *link)
351acfc7d46SMengdong Lin {
352acfc7d46SMengdong Lin 	if (tplg->comp && tplg->ops && tplg->ops->link_load)
353acfc7d46SMengdong Lin 		return tplg->ops->link_load(tplg->comp, link);
354acfc7d46SMengdong Lin 
355acfc7d46SMengdong Lin 	return 0;
356acfc7d46SMengdong Lin }
357acfc7d46SMengdong Lin 
3588a978234SLiam Girdwood /* tell the component driver that all firmware has been loaded in this request */
3598a978234SLiam Girdwood static void soc_tplg_complete(struct soc_tplg *tplg)
3608a978234SLiam Girdwood {
3618a978234SLiam Girdwood 	if (tplg->comp && tplg->ops && tplg->ops->complete)
3628a978234SLiam Girdwood 		tplg->ops->complete(tplg->comp);
3638a978234SLiam Girdwood }
3648a978234SLiam Girdwood 
3658a978234SLiam Girdwood /* add a dynamic kcontrol */
3668a978234SLiam Girdwood static int soc_tplg_add_dcontrol(struct snd_card *card, struct device *dev,
3678a978234SLiam Girdwood 	const struct snd_kcontrol_new *control_new, const char *prefix,
3688a978234SLiam Girdwood 	void *data, struct snd_kcontrol **kcontrol)
3698a978234SLiam Girdwood {
3708a978234SLiam Girdwood 	int err;
3718a978234SLiam Girdwood 
3728a978234SLiam Girdwood 	*kcontrol = snd_soc_cnew(control_new, data, control_new->name, prefix);
3738a978234SLiam Girdwood 	if (*kcontrol == NULL) {
3748a978234SLiam Girdwood 		dev_err(dev, "ASoC: Failed to create new kcontrol %s\n",
3758a978234SLiam Girdwood 		control_new->name);
3768a978234SLiam Girdwood 		return -ENOMEM;
3778a978234SLiam Girdwood 	}
3788a978234SLiam Girdwood 
3798a978234SLiam Girdwood 	err = snd_ctl_add(card, *kcontrol);
3808a978234SLiam Girdwood 	if (err < 0) {
3818a978234SLiam Girdwood 		dev_err(dev, "ASoC: Failed to add %s: %d\n",
3828a978234SLiam Girdwood 			control_new->name, err);
3838a978234SLiam Girdwood 		return err;
3848a978234SLiam Girdwood 	}
3858a978234SLiam Girdwood 
3868a978234SLiam Girdwood 	return 0;
3878a978234SLiam Girdwood }
3888a978234SLiam Girdwood 
3898a978234SLiam Girdwood /* add a dynamic kcontrol for component driver */
3908a978234SLiam Girdwood static int soc_tplg_add_kcontrol(struct soc_tplg *tplg,
3918a978234SLiam Girdwood 	struct snd_kcontrol_new *k, struct snd_kcontrol **kcontrol)
3928a978234SLiam Girdwood {
3938a978234SLiam Girdwood 	struct snd_soc_component *comp = tplg->comp;
3948a978234SLiam Girdwood 
3958a978234SLiam Girdwood 	return soc_tplg_add_dcontrol(comp->card->snd_card,
3968a978234SLiam Girdwood 				comp->dev, k, NULL, comp, kcontrol);
3978a978234SLiam Girdwood }
3988a978234SLiam Girdwood 
3998a978234SLiam Girdwood /* remove a mixer kcontrol */
4008a978234SLiam Girdwood static void remove_mixer(struct snd_soc_component *comp,
4018a978234SLiam Girdwood 	struct snd_soc_dobj *dobj, int pass)
4028a978234SLiam Girdwood {
4038a978234SLiam Girdwood 	struct snd_card *card = comp->card->snd_card;
4048a978234SLiam Girdwood 	struct soc_mixer_control *sm =
4058a978234SLiam Girdwood 		container_of(dobj, struct soc_mixer_control, dobj);
4068a978234SLiam Girdwood 	const unsigned int *p = NULL;
4078a978234SLiam Girdwood 
4088a978234SLiam Girdwood 	if (pass != SOC_TPLG_PASS_MIXER)
4098a978234SLiam Girdwood 		return;
4108a978234SLiam Girdwood 
4118a978234SLiam Girdwood 	if (dobj->ops && dobj->ops->control_unload)
4128a978234SLiam Girdwood 		dobj->ops->control_unload(comp, dobj);
4138a978234SLiam Girdwood 
4148a978234SLiam Girdwood 	if (sm->dobj.control.kcontrol->tlv.p)
4158a978234SLiam Girdwood 		p = sm->dobj.control.kcontrol->tlv.p;
4168a978234SLiam Girdwood 	snd_ctl_remove(card, sm->dobj.control.kcontrol);
4178a978234SLiam Girdwood 	list_del(&sm->dobj.list);
4188a978234SLiam Girdwood 	kfree(sm);
4198a978234SLiam Girdwood 	kfree(p);
4208a978234SLiam Girdwood }
4218a978234SLiam Girdwood 
4228a978234SLiam Girdwood /* remove an enum kcontrol */
4238a978234SLiam Girdwood static void remove_enum(struct snd_soc_component *comp,
4248a978234SLiam Girdwood 	struct snd_soc_dobj *dobj, int pass)
4258a978234SLiam Girdwood {
4268a978234SLiam Girdwood 	struct snd_card *card = comp->card->snd_card;
4278a978234SLiam Girdwood 	struct soc_enum *se = container_of(dobj, struct soc_enum, dobj);
4288a978234SLiam Girdwood 	int i;
4298a978234SLiam Girdwood 
4308a978234SLiam Girdwood 	if (pass != SOC_TPLG_PASS_MIXER)
4318a978234SLiam Girdwood 		return;
4328a978234SLiam Girdwood 
4338a978234SLiam Girdwood 	if (dobj->ops && dobj->ops->control_unload)
4348a978234SLiam Girdwood 		dobj->ops->control_unload(comp, dobj);
4358a978234SLiam Girdwood 
4368a978234SLiam Girdwood 	snd_ctl_remove(card, se->dobj.control.kcontrol);
4378a978234SLiam Girdwood 	list_del(&se->dobj.list);
4388a978234SLiam Girdwood 
4398a978234SLiam Girdwood 	kfree(se->dobj.control.dvalues);
4408a978234SLiam Girdwood 	for (i = 0; i < se->items; i++)
4418a978234SLiam Girdwood 		kfree(se->dobj.control.dtexts[i]);
4428a978234SLiam Girdwood 	kfree(se);
4438a978234SLiam Girdwood }
4448a978234SLiam Girdwood 
4458a978234SLiam Girdwood /* remove a byte kcontrol */
4468a978234SLiam Girdwood static void remove_bytes(struct snd_soc_component *comp,
4478a978234SLiam Girdwood 	struct snd_soc_dobj *dobj, int pass)
4488a978234SLiam Girdwood {
4498a978234SLiam Girdwood 	struct snd_card *card = comp->card->snd_card;
4508a978234SLiam Girdwood 	struct soc_bytes_ext *sb =
4518a978234SLiam Girdwood 		container_of(dobj, struct soc_bytes_ext, dobj);
4528a978234SLiam Girdwood 
4538a978234SLiam Girdwood 	if (pass != SOC_TPLG_PASS_MIXER)
4548a978234SLiam Girdwood 		return;
4558a978234SLiam Girdwood 
4568a978234SLiam Girdwood 	if (dobj->ops && dobj->ops->control_unload)
4578a978234SLiam Girdwood 		dobj->ops->control_unload(comp, dobj);
4588a978234SLiam Girdwood 
4598a978234SLiam Girdwood 	snd_ctl_remove(card, sb->dobj.control.kcontrol);
4608a978234SLiam Girdwood 	list_del(&sb->dobj.list);
4618a978234SLiam Girdwood 	kfree(sb);
4628a978234SLiam Girdwood }
4638a978234SLiam Girdwood 
4648a978234SLiam Girdwood /* remove a widget and it's kcontrols - routes must be removed first */
4658a978234SLiam Girdwood static void remove_widget(struct snd_soc_component *comp,
4668a978234SLiam Girdwood 	struct snd_soc_dobj *dobj, int pass)
4678a978234SLiam Girdwood {
4688a978234SLiam Girdwood 	struct snd_card *card = comp->card->snd_card;
4698a978234SLiam Girdwood 	struct snd_soc_dapm_widget *w =
4708a978234SLiam Girdwood 		container_of(dobj, struct snd_soc_dapm_widget, dobj);
4718a978234SLiam Girdwood 	int i;
4728a978234SLiam Girdwood 
4738a978234SLiam Girdwood 	if (pass != SOC_TPLG_PASS_WIDGET)
4748a978234SLiam Girdwood 		return;
4758a978234SLiam Girdwood 
4768a978234SLiam Girdwood 	if (dobj->ops && dobj->ops->widget_unload)
4778a978234SLiam Girdwood 		dobj->ops->widget_unload(comp, dobj);
4788a978234SLiam Girdwood 
4798a978234SLiam Girdwood 	/*
4808a978234SLiam Girdwood 	 * Dynamic Widgets either have 1 enum kcontrol or 1..N mixers.
4818a978234SLiam Girdwood 	 * The enum may either have an array of values or strings.
4828a978234SLiam Girdwood 	 */
4838a978234SLiam Girdwood 	if (dobj->widget.kcontrol_enum) {
4848a978234SLiam Girdwood 		/* enumerated widget mixer */
4858a978234SLiam Girdwood 		struct soc_enum *se =
4868a978234SLiam Girdwood 			(struct soc_enum *)w->kcontrols[0]->private_value;
4878a978234SLiam Girdwood 
4888a978234SLiam Girdwood 		snd_ctl_remove(card, w->kcontrols[0]);
4898a978234SLiam Girdwood 
4908a978234SLiam Girdwood 		kfree(se->dobj.control.dvalues);
4918a978234SLiam Girdwood 		for (i = 0; i < se->items; i++)
4928a978234SLiam Girdwood 			kfree(se->dobj.control.dtexts[i]);
4938a978234SLiam Girdwood 
4948a978234SLiam Girdwood 		kfree(se);
4958a978234SLiam Girdwood 		kfree(w->kcontrol_news);
4968a978234SLiam Girdwood 	} else {
4978a978234SLiam Girdwood 		/* non enumerated widget mixer */
4988a978234SLiam Girdwood 		for (i = 0; i < w->num_kcontrols; i++) {
4998a978234SLiam Girdwood 			struct snd_kcontrol *kcontrol = w->kcontrols[i];
5008a978234SLiam Girdwood 			struct soc_mixer_control *sm =
5018a978234SLiam Girdwood 			(struct soc_mixer_control *) kcontrol->private_value;
5028a978234SLiam Girdwood 
5038a978234SLiam Girdwood 			kfree(w->kcontrols[i]->tlv.p);
5048a978234SLiam Girdwood 
5058a978234SLiam Girdwood 			snd_ctl_remove(card, w->kcontrols[i]);
5068a978234SLiam Girdwood 			kfree(sm);
5078a978234SLiam Girdwood 		}
5088a978234SLiam Girdwood 		kfree(w->kcontrol_news);
5098a978234SLiam Girdwood 	}
5108a978234SLiam Girdwood 	/* widget w is freed by soc-dapm.c */
5118a978234SLiam Girdwood }
5128a978234SLiam Girdwood 
51364527e8aSMengdong Lin /* remove DAI configurations */
51464527e8aSMengdong Lin static void remove_dai(struct snd_soc_component *comp,
5158a978234SLiam Girdwood 	struct snd_soc_dobj *dobj, int pass)
5168a978234SLiam Girdwood {
51764527e8aSMengdong Lin 	struct snd_soc_dai_driver *dai_drv =
51864527e8aSMengdong Lin 		container_of(dobj, struct snd_soc_dai_driver, dobj);
51964527e8aSMengdong Lin 
5208a978234SLiam Girdwood 	if (pass != SOC_TPLG_PASS_PCM_DAI)
5218a978234SLiam Girdwood 		return;
5228a978234SLiam Girdwood 
52364527e8aSMengdong Lin 	if (dobj->ops && dobj->ops->dai_unload)
52464527e8aSMengdong Lin 		dobj->ops->dai_unload(comp, dobj);
5258a978234SLiam Girdwood 
5268a978234SLiam Girdwood 	list_del(&dobj->list);
52764527e8aSMengdong Lin 	kfree(dai_drv);
5288a978234SLiam Girdwood }
5298a978234SLiam Girdwood 
530acfc7d46SMengdong Lin /* remove link configurations */
531acfc7d46SMengdong Lin static void remove_link(struct snd_soc_component *comp,
532acfc7d46SMengdong Lin 	struct snd_soc_dobj *dobj, int pass)
533acfc7d46SMengdong Lin {
534acfc7d46SMengdong Lin 	struct snd_soc_dai_link *link =
535acfc7d46SMengdong Lin 		container_of(dobj, struct snd_soc_dai_link, dobj);
536acfc7d46SMengdong Lin 
537acfc7d46SMengdong Lin 	if (pass != SOC_TPLG_PASS_PCM_DAI)
538acfc7d46SMengdong Lin 		return;
539acfc7d46SMengdong Lin 
540acfc7d46SMengdong Lin 	if (dobj->ops && dobj->ops->link_unload)
541acfc7d46SMengdong Lin 		dobj->ops->link_unload(comp, dobj);
542acfc7d46SMengdong Lin 
543acfc7d46SMengdong Lin 	list_del(&dobj->list);
544acfc7d46SMengdong Lin 	snd_soc_remove_dai_link(comp->card, link);
545acfc7d46SMengdong Lin 	kfree(link);
546acfc7d46SMengdong Lin }
547acfc7d46SMengdong Lin 
5488a978234SLiam Girdwood /* bind a kcontrol to it's IO handlers */
5498a978234SLiam Girdwood static int soc_tplg_kcontrol_bind_io(struct snd_soc_tplg_ctl_hdr *hdr,
5508a978234SLiam Girdwood 	struct snd_kcontrol_new *k,
5512b5cdb91SMengdong Lin 	const struct soc_tplg *tplg)
5528a978234SLiam Girdwood {
5532b5cdb91SMengdong Lin 	const struct snd_soc_tplg_kcontrol_ops *ops;
5541a3232d2SMengdong Lin 	const struct snd_soc_tplg_bytes_ext_ops *ext_ops;
5552b5cdb91SMengdong Lin 	int num_ops, i;
5568a978234SLiam Girdwood 
5571a3232d2SMengdong Lin 	if (hdr->ops.info == SND_SOC_TPLG_CTL_BYTES
5581a3232d2SMengdong Lin 		&& k->iface & SNDRV_CTL_ELEM_IFACE_MIXER
5591a3232d2SMengdong Lin 		&& k->access & SNDRV_CTL_ELEM_ACCESS_TLV_READWRITE
5601a3232d2SMengdong Lin 		&& k->access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) {
5611a3232d2SMengdong Lin 		struct soc_bytes_ext *sbe;
5621a3232d2SMengdong Lin 		struct snd_soc_tplg_bytes_control *be;
5631a3232d2SMengdong Lin 
5641a3232d2SMengdong Lin 		sbe = (struct soc_bytes_ext *)k->private_value;
5651a3232d2SMengdong Lin 		be = container_of(hdr, struct snd_soc_tplg_bytes_control, hdr);
5661a3232d2SMengdong Lin 
5671a3232d2SMengdong Lin 		/* TLV bytes controls need standard kcontrol info handler,
5681a3232d2SMengdong Lin 		 * TLV callback and extended put/get handlers.
5691a3232d2SMengdong Lin 		 */
570f4be978bSOmair M Abdullah 		k->info = snd_soc_bytes_info_ext;
5711a3232d2SMengdong Lin 		k->tlv.c = snd_soc_bytes_tlv_callback;
5721a3232d2SMengdong Lin 
5731a3232d2SMengdong Lin 		ext_ops = tplg->bytes_ext_ops;
5741a3232d2SMengdong Lin 		num_ops = tplg->bytes_ext_ops_count;
5751a3232d2SMengdong Lin 		for (i = 0; i < num_ops; i++) {
5761a3232d2SMengdong Lin 			if (!sbe->put && ext_ops[i].id == be->ext_ops.put)
5771a3232d2SMengdong Lin 				sbe->put = ext_ops[i].put;
5781a3232d2SMengdong Lin 			if (!sbe->get && ext_ops[i].id == be->ext_ops.get)
5791a3232d2SMengdong Lin 				sbe->get = ext_ops[i].get;
5801a3232d2SMengdong Lin 		}
5811a3232d2SMengdong Lin 
5821a3232d2SMengdong Lin 		if (sbe->put && sbe->get)
5831a3232d2SMengdong Lin 			return 0;
5841a3232d2SMengdong Lin 		else
5851a3232d2SMengdong Lin 			return -EINVAL;
5861a3232d2SMengdong Lin 	}
5871a3232d2SMengdong Lin 
58888a17d8fSMengdong Lin 	/* try and map vendor specific kcontrol handlers first */
5892b5cdb91SMengdong Lin 	ops = tplg->io_ops;
5902b5cdb91SMengdong Lin 	num_ops = tplg->io_ops_count;
5918a978234SLiam Girdwood 	for (i = 0; i < num_ops; i++) {
5928a978234SLiam Girdwood 
5932b5cdb91SMengdong Lin 		if (k->put == NULL && ops[i].id == hdr->ops.put)
5948a978234SLiam Girdwood 			k->put = ops[i].put;
5952b5cdb91SMengdong Lin 		if (k->get == NULL && ops[i].id == hdr->ops.get)
5968a978234SLiam Girdwood 			k->get = ops[i].get;
5972b5cdb91SMengdong Lin 		if (k->info == NULL && ops[i].id == hdr->ops.info)
5982b5cdb91SMengdong Lin 			k->info = ops[i].info;
5998a978234SLiam Girdwood 	}
6008a978234SLiam Girdwood 
60188a17d8fSMengdong Lin 	/* vendor specific handlers found ? */
60288a17d8fSMengdong Lin 	if (k->put && k->get && k->info)
60388a17d8fSMengdong Lin 		return 0;
60488a17d8fSMengdong Lin 
60588a17d8fSMengdong Lin 	/* none found so try standard kcontrol handlers */
6062b5cdb91SMengdong Lin 	ops = io_ops;
6072b5cdb91SMengdong Lin 	num_ops = ARRAY_SIZE(io_ops);
60888a17d8fSMengdong Lin 	for (i = 0; i < num_ops; i++) {
60988a17d8fSMengdong Lin 
61088a17d8fSMengdong Lin 		if (k->put == NULL && ops[i].id == hdr->ops.put)
61188a17d8fSMengdong Lin 			k->put = ops[i].put;
61288a17d8fSMengdong Lin 		if (k->get == NULL && ops[i].id == hdr->ops.get)
61388a17d8fSMengdong Lin 			k->get = ops[i].get;
61488a17d8fSMengdong Lin 		if (k->info == NULL && ops[i].id == hdr->ops.info)
6158a978234SLiam Girdwood 			k->info = ops[i].info;
6168a978234SLiam Girdwood 	}
6178a978234SLiam Girdwood 
6188a978234SLiam Girdwood 	/* standard handlers found ? */
6198a978234SLiam Girdwood 	if (k->put && k->get && k->info)
6208a978234SLiam Girdwood 		return 0;
6218a978234SLiam Girdwood 
6228a978234SLiam Girdwood 	/* nothing to bind */
6238a978234SLiam Girdwood 	return -EINVAL;
6248a978234SLiam Girdwood }
6258a978234SLiam Girdwood 
6268a978234SLiam Girdwood /* bind a widgets to it's evnt handlers */
6278a978234SLiam Girdwood int snd_soc_tplg_widget_bind_event(struct snd_soc_dapm_widget *w,
6288a978234SLiam Girdwood 		const struct snd_soc_tplg_widget_events *events,
6298a978234SLiam Girdwood 		int num_events, u16 event_type)
6308a978234SLiam Girdwood {
6318a978234SLiam Girdwood 	int i;
6328a978234SLiam Girdwood 
6338a978234SLiam Girdwood 	w->event = NULL;
6348a978234SLiam Girdwood 
6358a978234SLiam Girdwood 	for (i = 0; i < num_events; i++) {
6368a978234SLiam Girdwood 		if (event_type == events[i].type) {
6378a978234SLiam Girdwood 
6388a978234SLiam Girdwood 			/* found - so assign event */
6398a978234SLiam Girdwood 			w->event = events[i].event_handler;
6408a978234SLiam Girdwood 			return 0;
6418a978234SLiam Girdwood 		}
6428a978234SLiam Girdwood 	}
6438a978234SLiam Girdwood 
6448a978234SLiam Girdwood 	/* not found */
6458a978234SLiam Girdwood 	return -EINVAL;
6468a978234SLiam Girdwood }
6478a978234SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_tplg_widget_bind_event);
6488a978234SLiam Girdwood 
6498a978234SLiam Girdwood /* optionally pass new dynamic kcontrol to component driver. */
6508a978234SLiam Girdwood static int soc_tplg_init_kcontrol(struct soc_tplg *tplg,
6518a978234SLiam Girdwood 	struct snd_kcontrol_new *k, struct snd_soc_tplg_ctl_hdr *hdr)
6528a978234SLiam Girdwood {
6538a978234SLiam Girdwood 	if (tplg->comp && tplg->ops && tplg->ops->control_load)
6548a978234SLiam Girdwood 		return tplg->ops->control_load(tplg->comp, k, hdr);
6558a978234SLiam Girdwood 
6568a978234SLiam Girdwood 	return 0;
6578a978234SLiam Girdwood }
6588a978234SLiam Girdwood 
65928a87eebSMengdong Lin 
66028a87eebSMengdong Lin static int soc_tplg_create_tlv_db_scale(struct soc_tplg *tplg,
66128a87eebSMengdong Lin 	struct snd_kcontrol_new *kc, struct snd_soc_tplg_tlv_dbscale *scale)
6628a978234SLiam Girdwood {
66328a87eebSMengdong Lin 	unsigned int item_len = 2 * sizeof(unsigned int);
66428a87eebSMengdong Lin 	unsigned int *p;
6658a978234SLiam Girdwood 
66628a87eebSMengdong Lin 	p = kzalloc(item_len + 2 * sizeof(unsigned int), GFP_KERNEL);
66728a87eebSMengdong Lin 	if (!p)
6688a978234SLiam Girdwood 		return -ENOMEM;
6698a978234SLiam Girdwood 
67028a87eebSMengdong Lin 	p[0] = SNDRV_CTL_TLVT_DB_SCALE;
67128a87eebSMengdong Lin 	p[1] = item_len;
67228a87eebSMengdong Lin 	p[2] = scale->min;
67328a87eebSMengdong Lin 	p[3] = (scale->step & TLV_DB_SCALE_MASK)
67428a87eebSMengdong Lin 			| (scale->mute ? TLV_DB_SCALE_MUTE : 0);
6758a978234SLiam Girdwood 
67628a87eebSMengdong Lin 	kc->tlv.p = (void *)p;
67728a87eebSMengdong Lin 	return 0;
67828a87eebSMengdong Lin }
67928a87eebSMengdong Lin 
68028a87eebSMengdong Lin static int soc_tplg_create_tlv(struct soc_tplg *tplg,
68128a87eebSMengdong Lin 	struct snd_kcontrol_new *kc, struct snd_soc_tplg_ctl_hdr *tc)
68228a87eebSMengdong Lin {
68328a87eebSMengdong Lin 	struct snd_soc_tplg_ctl_tlv *tplg_tlv;
68428a87eebSMengdong Lin 
68528a87eebSMengdong Lin 	if (!(tc->access & SNDRV_CTL_ELEM_ACCESS_TLV_READWRITE))
68628a87eebSMengdong Lin 		return 0;
68728a87eebSMengdong Lin 
6881a3232d2SMengdong Lin 	if (!(tc->access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK)) {
68928a87eebSMengdong Lin 		tplg_tlv = &tc->tlv;
69028a87eebSMengdong Lin 		switch (tplg_tlv->type) {
69128a87eebSMengdong Lin 		case SNDRV_CTL_TLVT_DB_SCALE:
69228a87eebSMengdong Lin 			return soc_tplg_create_tlv_db_scale(tplg, kc,
69328a87eebSMengdong Lin 					&tplg_tlv->scale);
69428a87eebSMengdong Lin 
69528a87eebSMengdong Lin 		/* TODO: add support for other TLV types */
69628a87eebSMengdong Lin 		default:
69728a87eebSMengdong Lin 			dev_dbg(tplg->dev, "Unsupported TLV type %d\n",
69828a87eebSMengdong Lin 					tplg_tlv->type);
69928a87eebSMengdong Lin 			return -EINVAL;
70028a87eebSMengdong Lin 		}
70128a87eebSMengdong Lin 	}
7028a978234SLiam Girdwood 
7038a978234SLiam Girdwood 	return 0;
7048a978234SLiam Girdwood }
7058a978234SLiam Girdwood 
7068a978234SLiam Girdwood static inline void soc_tplg_free_tlv(struct soc_tplg *tplg,
7078a978234SLiam Girdwood 	struct snd_kcontrol_new *kc)
7088a978234SLiam Girdwood {
7098a978234SLiam Girdwood 	kfree(kc->tlv.p);
7108a978234SLiam Girdwood }
7118a978234SLiam Girdwood 
7128a978234SLiam Girdwood static int soc_tplg_dbytes_create(struct soc_tplg *tplg, unsigned int count,
7138a978234SLiam Girdwood 	size_t size)
7148a978234SLiam Girdwood {
7158a978234SLiam Girdwood 	struct snd_soc_tplg_bytes_control *be;
7168a978234SLiam Girdwood 	struct soc_bytes_ext *sbe;
7178a978234SLiam Girdwood 	struct snd_kcontrol_new kc;
7188a978234SLiam Girdwood 	int i, err;
7198a978234SLiam Girdwood 
7208a978234SLiam Girdwood 	if (soc_tplg_check_elem_count(tplg,
7218a978234SLiam Girdwood 		sizeof(struct snd_soc_tplg_bytes_control), count,
7228a978234SLiam Girdwood 			size, "mixer bytes")) {
7238a978234SLiam Girdwood 		dev_err(tplg->dev, "ASoC: Invalid count %d for byte control\n",
7248a978234SLiam Girdwood 			count);
7258a978234SLiam Girdwood 		return -EINVAL;
7268a978234SLiam Girdwood 	}
7278a978234SLiam Girdwood 
7288a978234SLiam Girdwood 	for (i = 0; i < count; i++) {
7298a978234SLiam Girdwood 		be = (struct snd_soc_tplg_bytes_control *)tplg->pos;
7308a978234SLiam Girdwood 
7318a978234SLiam Girdwood 		/* validate kcontrol */
7328a978234SLiam Girdwood 		if (strnlen(be->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
7338a978234SLiam Girdwood 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
7348a978234SLiam Girdwood 			return -EINVAL;
7358a978234SLiam Girdwood 
7368a978234SLiam Girdwood 		sbe = kzalloc(sizeof(*sbe), GFP_KERNEL);
7378a978234SLiam Girdwood 		if (sbe == NULL)
7388a978234SLiam Girdwood 			return -ENOMEM;
7398a978234SLiam Girdwood 
7408a978234SLiam Girdwood 		tplg->pos += (sizeof(struct snd_soc_tplg_bytes_control) +
7418a978234SLiam Girdwood 			be->priv.size);
7428a978234SLiam Girdwood 
7438a978234SLiam Girdwood 		dev_dbg(tplg->dev,
7448a978234SLiam Girdwood 			"ASoC: adding bytes kcontrol %s with access 0x%x\n",
7458a978234SLiam Girdwood 			be->hdr.name, be->hdr.access);
7468a978234SLiam Girdwood 
7478a978234SLiam Girdwood 		memset(&kc, 0, sizeof(kc));
7488a978234SLiam Girdwood 		kc.name = be->hdr.name;
7498a978234SLiam Girdwood 		kc.private_value = (long)sbe;
7508a978234SLiam Girdwood 		kc.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
7518a978234SLiam Girdwood 		kc.access = be->hdr.access;
7528a978234SLiam Girdwood 
7538a978234SLiam Girdwood 		sbe->max = be->max;
7548a978234SLiam Girdwood 		sbe->dobj.type = SND_SOC_DOBJ_BYTES;
7558a978234SLiam Girdwood 		sbe->dobj.ops = tplg->ops;
7568a978234SLiam Girdwood 		INIT_LIST_HEAD(&sbe->dobj.list);
7578a978234SLiam Girdwood 
7588a978234SLiam Girdwood 		/* map io handlers */
7592b5cdb91SMengdong Lin 		err = soc_tplg_kcontrol_bind_io(&be->hdr, &kc, tplg);
7608a978234SLiam Girdwood 		if (err) {
7618a978234SLiam Girdwood 			soc_control_err(tplg, &be->hdr, be->hdr.name);
7628a978234SLiam Girdwood 			kfree(sbe);
7638a978234SLiam Girdwood 			continue;
7648a978234SLiam Girdwood 		}
7658a978234SLiam Girdwood 
7668a978234SLiam Girdwood 		/* pass control to driver for optional further init */
7678a978234SLiam Girdwood 		err = soc_tplg_init_kcontrol(tplg, &kc,
7688a978234SLiam Girdwood 			(struct snd_soc_tplg_ctl_hdr *)be);
7698a978234SLiam Girdwood 		if (err < 0) {
7708a978234SLiam Girdwood 			dev_err(tplg->dev, "ASoC: failed to init %s\n",
7718a978234SLiam Girdwood 				be->hdr.name);
7728a978234SLiam Girdwood 			kfree(sbe);
7738a978234SLiam Girdwood 			continue;
7748a978234SLiam Girdwood 		}
7758a978234SLiam Girdwood 
7768a978234SLiam Girdwood 		/* register control here */
7778a978234SLiam Girdwood 		err = soc_tplg_add_kcontrol(tplg, &kc,
7788a978234SLiam Girdwood 			&sbe->dobj.control.kcontrol);
7798a978234SLiam Girdwood 		if (err < 0) {
7808a978234SLiam Girdwood 			dev_err(tplg->dev, "ASoC: failed to add %s\n",
7818a978234SLiam Girdwood 				be->hdr.name);
7828a978234SLiam Girdwood 			kfree(sbe);
7838a978234SLiam Girdwood 			continue;
7848a978234SLiam Girdwood 		}
7858a978234SLiam Girdwood 
7868a978234SLiam Girdwood 		list_add(&sbe->dobj.list, &tplg->comp->dobj_list);
7878a978234SLiam Girdwood 	}
7888a978234SLiam Girdwood 	return 0;
7898a978234SLiam Girdwood 
7908a978234SLiam Girdwood }
7918a978234SLiam Girdwood 
7928a978234SLiam Girdwood static int soc_tplg_dmixer_create(struct soc_tplg *tplg, unsigned int count,
7938a978234SLiam Girdwood 	size_t size)
7948a978234SLiam Girdwood {
7958a978234SLiam Girdwood 	struct snd_soc_tplg_mixer_control *mc;
7968a978234SLiam Girdwood 	struct soc_mixer_control *sm;
7978a978234SLiam Girdwood 	struct snd_kcontrol_new kc;
7988a978234SLiam Girdwood 	int i, err;
7998a978234SLiam Girdwood 
8008a978234SLiam Girdwood 	if (soc_tplg_check_elem_count(tplg,
8018a978234SLiam Girdwood 		sizeof(struct snd_soc_tplg_mixer_control),
8028a978234SLiam Girdwood 		count, size, "mixers")) {
8038a978234SLiam Girdwood 
8048a978234SLiam Girdwood 		dev_err(tplg->dev, "ASoC: invalid count %d for controls\n",
8058a978234SLiam Girdwood 			count);
8068a978234SLiam Girdwood 		return -EINVAL;
8078a978234SLiam Girdwood 	}
8088a978234SLiam Girdwood 
8098a978234SLiam Girdwood 	for (i = 0; i < count; i++) {
8108a978234SLiam Girdwood 		mc = (struct snd_soc_tplg_mixer_control *)tplg->pos;
8118a978234SLiam Girdwood 
8128a978234SLiam Girdwood 		/* validate kcontrol */
8138a978234SLiam Girdwood 		if (strnlen(mc->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
8148a978234SLiam Girdwood 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
8158a978234SLiam Girdwood 			return -EINVAL;
8168a978234SLiam Girdwood 
8178a978234SLiam Girdwood 		sm = kzalloc(sizeof(*sm), GFP_KERNEL);
8188a978234SLiam Girdwood 		if (sm == NULL)
8198a978234SLiam Girdwood 			return -ENOMEM;
8208a978234SLiam Girdwood 		tplg->pos += (sizeof(struct snd_soc_tplg_mixer_control) +
8218a978234SLiam Girdwood 			mc->priv.size);
8228a978234SLiam Girdwood 
8238a978234SLiam Girdwood 		dev_dbg(tplg->dev,
8248a978234SLiam Girdwood 			"ASoC: adding mixer kcontrol %s with access 0x%x\n",
8258a978234SLiam Girdwood 			mc->hdr.name, mc->hdr.access);
8268a978234SLiam Girdwood 
8278a978234SLiam Girdwood 		memset(&kc, 0, sizeof(kc));
8288a978234SLiam Girdwood 		kc.name = mc->hdr.name;
8298a978234SLiam Girdwood 		kc.private_value = (long)sm;
8308a978234SLiam Girdwood 		kc.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
8318a978234SLiam Girdwood 		kc.access = mc->hdr.access;
8328a978234SLiam Girdwood 
8338a978234SLiam Girdwood 		/* we only support FL/FR channel mapping atm */
8348a978234SLiam Girdwood 		sm->reg = tplc_chan_get_reg(tplg, mc->channel,
8358a978234SLiam Girdwood 			SNDRV_CHMAP_FL);
8368a978234SLiam Girdwood 		sm->rreg = tplc_chan_get_reg(tplg, mc->channel,
8378a978234SLiam Girdwood 			SNDRV_CHMAP_FR);
8388a978234SLiam Girdwood 		sm->shift = tplc_chan_get_shift(tplg, mc->channel,
8398a978234SLiam Girdwood 			SNDRV_CHMAP_FL);
8408a978234SLiam Girdwood 		sm->rshift = tplc_chan_get_shift(tplg, mc->channel,
8418a978234SLiam Girdwood 			SNDRV_CHMAP_FR);
8428a978234SLiam Girdwood 
8438a978234SLiam Girdwood 		sm->max = mc->max;
8448a978234SLiam Girdwood 		sm->min = mc->min;
8458a978234SLiam Girdwood 		sm->invert = mc->invert;
8468a978234SLiam Girdwood 		sm->platform_max = mc->platform_max;
8478a978234SLiam Girdwood 		sm->dobj.index = tplg->index;
8488a978234SLiam Girdwood 		sm->dobj.ops = tplg->ops;
8498a978234SLiam Girdwood 		sm->dobj.type = SND_SOC_DOBJ_MIXER;
8508a978234SLiam Girdwood 		INIT_LIST_HEAD(&sm->dobj.list);
8518a978234SLiam Girdwood 
8528a978234SLiam Girdwood 		/* map io handlers */
8532b5cdb91SMengdong Lin 		err = soc_tplg_kcontrol_bind_io(&mc->hdr, &kc, tplg);
8548a978234SLiam Girdwood 		if (err) {
8558a978234SLiam Girdwood 			soc_control_err(tplg, &mc->hdr, mc->hdr.name);
8568a978234SLiam Girdwood 			kfree(sm);
8578a978234SLiam Girdwood 			continue;
8588a978234SLiam Girdwood 		}
8598a978234SLiam Girdwood 
8608a978234SLiam Girdwood 		/* pass control to driver for optional further init */
8618a978234SLiam Girdwood 		err = soc_tplg_init_kcontrol(tplg, &kc,
8628a978234SLiam Girdwood 			(struct snd_soc_tplg_ctl_hdr *) mc);
8638a978234SLiam Girdwood 		if (err < 0) {
8648a978234SLiam Girdwood 			dev_err(tplg->dev, "ASoC: failed to init %s\n",
8658a978234SLiam Girdwood 				mc->hdr.name);
8668a978234SLiam Girdwood 			kfree(sm);
8678a978234SLiam Girdwood 			continue;
8688a978234SLiam Girdwood 		}
8698a978234SLiam Girdwood 
8708a978234SLiam Girdwood 		/* create any TLV data */
87128a87eebSMengdong Lin 		soc_tplg_create_tlv(tplg, &kc, &mc->hdr);
8728a978234SLiam Girdwood 
8738a978234SLiam Girdwood 		/* register control here */
8748a978234SLiam Girdwood 		err = soc_tplg_add_kcontrol(tplg, &kc,
8758a978234SLiam Girdwood 			&sm->dobj.control.kcontrol);
8768a978234SLiam Girdwood 		if (err < 0) {
8778a978234SLiam Girdwood 			dev_err(tplg->dev, "ASoC: failed to add %s\n",
8788a978234SLiam Girdwood 				mc->hdr.name);
8798a978234SLiam Girdwood 			soc_tplg_free_tlv(tplg, &kc);
8808a978234SLiam Girdwood 			kfree(sm);
8818a978234SLiam Girdwood 			continue;
8828a978234SLiam Girdwood 		}
8838a978234SLiam Girdwood 
8848a978234SLiam Girdwood 		list_add(&sm->dobj.list, &tplg->comp->dobj_list);
8858a978234SLiam Girdwood 	}
8868a978234SLiam Girdwood 
8878a978234SLiam Girdwood 	return 0;
8888a978234SLiam Girdwood }
8898a978234SLiam Girdwood 
8908a978234SLiam Girdwood static int soc_tplg_denum_create_texts(struct soc_enum *se,
8918a978234SLiam Girdwood 	struct snd_soc_tplg_enum_control *ec)
8928a978234SLiam Girdwood {
8938a978234SLiam Girdwood 	int i, ret;
8948a978234SLiam Girdwood 
8958a978234SLiam Girdwood 	se->dobj.control.dtexts =
8968a978234SLiam Girdwood 		kzalloc(sizeof(char *) * ec->items, GFP_KERNEL);
8978a978234SLiam Girdwood 	if (se->dobj.control.dtexts == NULL)
8988a978234SLiam Girdwood 		return -ENOMEM;
8998a978234SLiam Girdwood 
9008a978234SLiam Girdwood 	for (i = 0; i < ec->items; i++) {
9018a978234SLiam Girdwood 
9028a978234SLiam Girdwood 		if (strnlen(ec->texts[i], SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
9038a978234SLiam Girdwood 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN) {
9048a978234SLiam Girdwood 			ret = -EINVAL;
9058a978234SLiam Girdwood 			goto err;
9068a978234SLiam Girdwood 		}
9078a978234SLiam Girdwood 
9088a978234SLiam Girdwood 		se->dobj.control.dtexts[i] = kstrdup(ec->texts[i], GFP_KERNEL);
9098a978234SLiam Girdwood 		if (!se->dobj.control.dtexts[i]) {
9108a978234SLiam Girdwood 			ret = -ENOMEM;
9118a978234SLiam Girdwood 			goto err;
9128a978234SLiam Girdwood 		}
9138a978234SLiam Girdwood 	}
9148a978234SLiam Girdwood 
9158a978234SLiam Girdwood 	return 0;
9168a978234SLiam Girdwood 
9178a978234SLiam Girdwood err:
9188a978234SLiam Girdwood 	for (--i; i >= 0; i--)
9198a978234SLiam Girdwood 		kfree(se->dobj.control.dtexts[i]);
9208a978234SLiam Girdwood 	kfree(se->dobj.control.dtexts);
9218a978234SLiam Girdwood 	return ret;
9228a978234SLiam Girdwood }
9238a978234SLiam Girdwood 
9248a978234SLiam Girdwood static int soc_tplg_denum_create_values(struct soc_enum *se,
9258a978234SLiam Girdwood 	struct snd_soc_tplg_enum_control *ec)
9268a978234SLiam Girdwood {
9278a978234SLiam Girdwood 	if (ec->items > sizeof(*ec->values))
9288a978234SLiam Girdwood 		return -EINVAL;
9298a978234SLiam Girdwood 
930376c0afeSAndrzej Hajda 	se->dobj.control.dvalues = kmemdup(ec->values,
931376c0afeSAndrzej Hajda 					   ec->items * sizeof(u32),
932376c0afeSAndrzej Hajda 					   GFP_KERNEL);
9338a978234SLiam Girdwood 	if (!se->dobj.control.dvalues)
9348a978234SLiam Girdwood 		return -ENOMEM;
9358a978234SLiam Girdwood 
9368a978234SLiam Girdwood 	return 0;
9378a978234SLiam Girdwood }
9388a978234SLiam Girdwood 
9398a978234SLiam Girdwood static int soc_tplg_denum_create(struct soc_tplg *tplg, unsigned int count,
9408a978234SLiam Girdwood 	size_t size)
9418a978234SLiam Girdwood {
9428a978234SLiam Girdwood 	struct snd_soc_tplg_enum_control *ec;
9438a978234SLiam Girdwood 	struct soc_enum *se;
9448a978234SLiam Girdwood 	struct snd_kcontrol_new kc;
9458a978234SLiam Girdwood 	int i, ret, err;
9468a978234SLiam Girdwood 
9478a978234SLiam Girdwood 	if (soc_tplg_check_elem_count(tplg,
9488a978234SLiam Girdwood 		sizeof(struct snd_soc_tplg_enum_control),
9498a978234SLiam Girdwood 		count, size, "enums")) {
9508a978234SLiam Girdwood 
9518a978234SLiam Girdwood 		dev_err(tplg->dev, "ASoC: invalid count %d for enum controls\n",
9528a978234SLiam Girdwood 			count);
9538a978234SLiam Girdwood 		return -EINVAL;
9548a978234SLiam Girdwood 	}
9558a978234SLiam Girdwood 
9568a978234SLiam Girdwood 	for (i = 0; i < count; i++) {
9578a978234SLiam Girdwood 		ec = (struct snd_soc_tplg_enum_control *)tplg->pos;
9588a978234SLiam Girdwood 		tplg->pos += (sizeof(struct snd_soc_tplg_enum_control) +
9598a978234SLiam Girdwood 			ec->priv.size);
9608a978234SLiam Girdwood 
9618a978234SLiam Girdwood 		/* validate kcontrol */
9628a978234SLiam Girdwood 		if (strnlen(ec->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
9638a978234SLiam Girdwood 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
9648a978234SLiam Girdwood 			return -EINVAL;
9658a978234SLiam Girdwood 
9668a978234SLiam Girdwood 		se = kzalloc((sizeof(*se)), GFP_KERNEL);
9678a978234SLiam Girdwood 		if (se == NULL)
9688a978234SLiam Girdwood 			return -ENOMEM;
9698a978234SLiam Girdwood 
9708a978234SLiam Girdwood 		dev_dbg(tplg->dev, "ASoC: adding enum kcontrol %s size %d\n",
9718a978234SLiam Girdwood 			ec->hdr.name, ec->items);
9728a978234SLiam Girdwood 
9738a978234SLiam Girdwood 		memset(&kc, 0, sizeof(kc));
9748a978234SLiam Girdwood 		kc.name = ec->hdr.name;
9758a978234SLiam Girdwood 		kc.private_value = (long)se;
9768a978234SLiam Girdwood 		kc.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
9778a978234SLiam Girdwood 		kc.access = ec->hdr.access;
9788a978234SLiam Girdwood 
9798a978234SLiam Girdwood 		se->reg = tplc_chan_get_reg(tplg, ec->channel, SNDRV_CHMAP_FL);
9808a978234SLiam Girdwood 		se->shift_l = tplc_chan_get_shift(tplg, ec->channel,
9818a978234SLiam Girdwood 			SNDRV_CHMAP_FL);
9828a978234SLiam Girdwood 		se->shift_r = tplc_chan_get_shift(tplg, ec->channel,
9838a978234SLiam Girdwood 			SNDRV_CHMAP_FL);
9848a978234SLiam Girdwood 
9858a978234SLiam Girdwood 		se->items = ec->items;
9868a978234SLiam Girdwood 		se->mask = ec->mask;
9878a978234SLiam Girdwood 		se->dobj.index = tplg->index;
9888a978234SLiam Girdwood 		se->dobj.type = SND_SOC_DOBJ_ENUM;
9898a978234SLiam Girdwood 		se->dobj.ops = tplg->ops;
9908a978234SLiam Girdwood 		INIT_LIST_HEAD(&se->dobj.list);
9918a978234SLiam Girdwood 
9928a978234SLiam Girdwood 		switch (ec->hdr.ops.info) {
9938a978234SLiam Girdwood 		case SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE:
9948a978234SLiam Girdwood 		case SND_SOC_TPLG_CTL_ENUM_VALUE:
9958a978234SLiam Girdwood 			err = soc_tplg_denum_create_values(se, ec);
9968a978234SLiam Girdwood 			if (err < 0) {
9978a978234SLiam Girdwood 				dev_err(tplg->dev,
9988a978234SLiam Girdwood 					"ASoC: could not create values for %s\n",
9998a978234SLiam Girdwood 					ec->hdr.name);
10008a978234SLiam Girdwood 				kfree(se);
10018a978234SLiam Girdwood 				continue;
10028a978234SLiam Girdwood 			}
10038a978234SLiam Girdwood 			/* fall through and create texts */
10048a978234SLiam Girdwood 		case SND_SOC_TPLG_CTL_ENUM:
10058a978234SLiam Girdwood 		case SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE:
10068a978234SLiam Girdwood 		case SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT:
10078a978234SLiam Girdwood 			err = soc_tplg_denum_create_texts(se, ec);
10088a978234SLiam Girdwood 			if (err < 0) {
10098a978234SLiam Girdwood 				dev_err(tplg->dev,
10108a978234SLiam Girdwood 					"ASoC: could not create texts for %s\n",
10118a978234SLiam Girdwood 					ec->hdr.name);
10128a978234SLiam Girdwood 				kfree(se);
10138a978234SLiam Girdwood 				continue;
10148a978234SLiam Girdwood 			}
10158a978234SLiam Girdwood 			break;
10168a978234SLiam Girdwood 		default:
10178a978234SLiam Girdwood 			dev_err(tplg->dev,
10188a978234SLiam Girdwood 				"ASoC: invalid enum control type %d for %s\n",
10198a978234SLiam Girdwood 				ec->hdr.ops.info, ec->hdr.name);
10208a978234SLiam Girdwood 			kfree(se);
10218a978234SLiam Girdwood 			continue;
10228a978234SLiam Girdwood 		}
10238a978234SLiam Girdwood 
10248a978234SLiam Girdwood 		/* map io handlers */
10252b5cdb91SMengdong Lin 		err = soc_tplg_kcontrol_bind_io(&ec->hdr, &kc, tplg);
10268a978234SLiam Girdwood 		if (err) {
10278a978234SLiam Girdwood 			soc_control_err(tplg, &ec->hdr, ec->hdr.name);
10288a978234SLiam Girdwood 			kfree(se);
10298a978234SLiam Girdwood 			continue;
10308a978234SLiam Girdwood 		}
10318a978234SLiam Girdwood 
10328a978234SLiam Girdwood 		/* pass control to driver for optional further init */
10338a978234SLiam Girdwood 		err = soc_tplg_init_kcontrol(tplg, &kc,
10348a978234SLiam Girdwood 			(struct snd_soc_tplg_ctl_hdr *) ec);
10358a978234SLiam Girdwood 		if (err < 0) {
10368a978234SLiam Girdwood 			dev_err(tplg->dev, "ASoC: failed to init %s\n",
10378a978234SLiam Girdwood 				ec->hdr.name);
10388a978234SLiam Girdwood 			kfree(se);
10398a978234SLiam Girdwood 			continue;
10408a978234SLiam Girdwood 		}
10418a978234SLiam Girdwood 
10428a978234SLiam Girdwood 		/* register control here */
10438a978234SLiam Girdwood 		ret = soc_tplg_add_kcontrol(tplg,
10448a978234SLiam Girdwood 			&kc, &se->dobj.control.kcontrol);
10458a978234SLiam Girdwood 		if (ret < 0) {
10468a978234SLiam Girdwood 			dev_err(tplg->dev, "ASoC: could not add kcontrol %s\n",
10478a978234SLiam Girdwood 				ec->hdr.name);
10488a978234SLiam Girdwood 			kfree(se);
10498a978234SLiam Girdwood 			continue;
10508a978234SLiam Girdwood 		}
10518a978234SLiam Girdwood 
10528a978234SLiam Girdwood 		list_add(&se->dobj.list, &tplg->comp->dobj_list);
10538a978234SLiam Girdwood 	}
10548a978234SLiam Girdwood 
10558a978234SLiam Girdwood 	return 0;
10568a978234SLiam Girdwood }
10578a978234SLiam Girdwood 
10588a978234SLiam Girdwood static int soc_tplg_kcontrol_elems_load(struct soc_tplg *tplg,
10598a978234SLiam Girdwood 	struct snd_soc_tplg_hdr *hdr)
10608a978234SLiam Girdwood {
10618a978234SLiam Girdwood 	struct snd_soc_tplg_ctl_hdr *control_hdr;
10628a978234SLiam Girdwood 	int i;
10638a978234SLiam Girdwood 
10648a978234SLiam Girdwood 	if (tplg->pass != SOC_TPLG_PASS_MIXER) {
10658a978234SLiam Girdwood 		tplg->pos += hdr->size + hdr->payload_size;
10668a978234SLiam Girdwood 		return 0;
10678a978234SLiam Girdwood 	}
10688a978234SLiam Girdwood 
10698a978234SLiam Girdwood 	dev_dbg(tplg->dev, "ASoC: adding %d kcontrols at 0x%lx\n", hdr->count,
10708a978234SLiam Girdwood 		soc_tplg_get_offset(tplg));
10718a978234SLiam Girdwood 
10728a978234SLiam Girdwood 	for (i = 0; i < hdr->count; i++) {
10738a978234SLiam Girdwood 
10748a978234SLiam Girdwood 		control_hdr = (struct snd_soc_tplg_ctl_hdr *)tplg->pos;
10758a978234SLiam Girdwood 
107606eb49f7SMengdong Lin 		if (control_hdr->size != sizeof(*control_hdr)) {
107706eb49f7SMengdong Lin 			dev_err(tplg->dev, "ASoC: invalid control size\n");
107806eb49f7SMengdong Lin 			return -EINVAL;
107906eb49f7SMengdong Lin 		}
108006eb49f7SMengdong Lin 
10818a978234SLiam Girdwood 		switch (control_hdr->ops.info) {
10828a978234SLiam Girdwood 		case SND_SOC_TPLG_CTL_VOLSW:
10838a978234SLiam Girdwood 		case SND_SOC_TPLG_CTL_STROBE:
10848a978234SLiam Girdwood 		case SND_SOC_TPLG_CTL_VOLSW_SX:
10858a978234SLiam Girdwood 		case SND_SOC_TPLG_CTL_VOLSW_XR_SX:
10868a978234SLiam Girdwood 		case SND_SOC_TPLG_CTL_RANGE:
10878a978234SLiam Girdwood 		case SND_SOC_TPLG_DAPM_CTL_VOLSW:
10888a978234SLiam Girdwood 		case SND_SOC_TPLG_DAPM_CTL_PIN:
10898a978234SLiam Girdwood 			soc_tplg_dmixer_create(tplg, 1, hdr->payload_size);
10908a978234SLiam Girdwood 			break;
10918a978234SLiam Girdwood 		case SND_SOC_TPLG_CTL_ENUM:
10928a978234SLiam Girdwood 		case SND_SOC_TPLG_CTL_ENUM_VALUE:
10938a978234SLiam Girdwood 		case SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE:
10948a978234SLiam Girdwood 		case SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT:
10958a978234SLiam Girdwood 		case SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE:
10968a978234SLiam Girdwood 			soc_tplg_denum_create(tplg, 1, hdr->payload_size);
10978a978234SLiam Girdwood 			break;
10988a978234SLiam Girdwood 		case SND_SOC_TPLG_CTL_BYTES:
10998a978234SLiam Girdwood 			soc_tplg_dbytes_create(tplg, 1, hdr->payload_size);
11008a978234SLiam Girdwood 			break;
11018a978234SLiam Girdwood 		default:
11028a978234SLiam Girdwood 			soc_bind_err(tplg, control_hdr, i);
11038a978234SLiam Girdwood 			return -EINVAL;
11048a978234SLiam Girdwood 		}
11058a978234SLiam Girdwood 	}
11068a978234SLiam Girdwood 
11078a978234SLiam Girdwood 	return 0;
11088a978234SLiam Girdwood }
11098a978234SLiam Girdwood 
11108a978234SLiam Girdwood static int soc_tplg_dapm_graph_elems_load(struct soc_tplg *tplg,
11118a978234SLiam Girdwood 	struct snd_soc_tplg_hdr *hdr)
11128a978234SLiam Girdwood {
11138a978234SLiam Girdwood 	struct snd_soc_dapm_context *dapm = &tplg->comp->dapm;
11148a978234SLiam Girdwood 	struct snd_soc_dapm_route route;
11158a978234SLiam Girdwood 	struct snd_soc_tplg_dapm_graph_elem *elem;
11168a978234SLiam Girdwood 	int count = hdr->count, i;
11178a978234SLiam Girdwood 
11188a978234SLiam Girdwood 	if (tplg->pass != SOC_TPLG_PASS_GRAPH) {
11198a978234SLiam Girdwood 		tplg->pos += hdr->size + hdr->payload_size;
11208a978234SLiam Girdwood 		return 0;
11218a978234SLiam Girdwood 	}
11228a978234SLiam Girdwood 
11238a978234SLiam Girdwood 	if (soc_tplg_check_elem_count(tplg,
11248a978234SLiam Girdwood 		sizeof(struct snd_soc_tplg_dapm_graph_elem),
11258a978234SLiam Girdwood 		count, hdr->payload_size, "graph")) {
11268a978234SLiam Girdwood 
11278a978234SLiam Girdwood 		dev_err(tplg->dev, "ASoC: invalid count %d for DAPM routes\n",
11288a978234SLiam Girdwood 			count);
11298a978234SLiam Girdwood 		return -EINVAL;
11308a978234SLiam Girdwood 	}
11318a978234SLiam Girdwood 
11328a978234SLiam Girdwood 	dev_dbg(tplg->dev, "ASoC: adding %d DAPM routes\n", count);
11338a978234SLiam Girdwood 
11348a978234SLiam Girdwood 	for (i = 0; i < count; i++) {
11358a978234SLiam Girdwood 		elem = (struct snd_soc_tplg_dapm_graph_elem *)tplg->pos;
11368a978234SLiam Girdwood 		tplg->pos += sizeof(struct snd_soc_tplg_dapm_graph_elem);
11378a978234SLiam Girdwood 
11388a978234SLiam Girdwood 		/* validate routes */
11398a978234SLiam Girdwood 		if (strnlen(elem->source, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
11408a978234SLiam Girdwood 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
11418a978234SLiam Girdwood 			return -EINVAL;
11428a978234SLiam Girdwood 		if (strnlen(elem->sink, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
11438a978234SLiam Girdwood 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
11448a978234SLiam Girdwood 			return -EINVAL;
11458a978234SLiam Girdwood 		if (strnlen(elem->control, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
11468a978234SLiam Girdwood 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
11478a978234SLiam Girdwood 			return -EINVAL;
11488a978234SLiam Girdwood 
11498a978234SLiam Girdwood 		route.source = elem->source;
11508a978234SLiam Girdwood 		route.sink = elem->sink;
11518a978234SLiam Girdwood 		route.connected = NULL; /* set to NULL atm for tplg users */
11528a978234SLiam Girdwood 		if (strnlen(elem->control, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 0)
11538a978234SLiam Girdwood 			route.control = NULL;
11548a978234SLiam Girdwood 		else
11558a978234SLiam Girdwood 			route.control = elem->control;
11568a978234SLiam Girdwood 
11578a978234SLiam Girdwood 		/* add route, but keep going if some fail */
11588a978234SLiam Girdwood 		snd_soc_dapm_add_routes(dapm, &route, 1);
11598a978234SLiam Girdwood 	}
11608a978234SLiam Girdwood 
11618a978234SLiam Girdwood 	return 0;
11628a978234SLiam Girdwood }
11638a978234SLiam Girdwood 
11648a978234SLiam Girdwood static struct snd_kcontrol_new *soc_tplg_dapm_widget_dmixer_create(
11658a978234SLiam Girdwood 	struct soc_tplg *tplg, int num_kcontrols)
11668a978234SLiam Girdwood {
11678a978234SLiam Girdwood 	struct snd_kcontrol_new *kc;
11688a978234SLiam Girdwood 	struct soc_mixer_control *sm;
11698a978234SLiam Girdwood 	struct snd_soc_tplg_mixer_control *mc;
11708a978234SLiam Girdwood 	int i, err;
11718a978234SLiam Girdwood 
11724ca7deb1SAxel Lin 	kc = kcalloc(num_kcontrols, sizeof(*kc), GFP_KERNEL);
11738a978234SLiam Girdwood 	if (kc == NULL)
11748a978234SLiam Girdwood 		return NULL;
11758a978234SLiam Girdwood 
11768a978234SLiam Girdwood 	for (i = 0; i < num_kcontrols; i++) {
11778a978234SLiam Girdwood 		mc = (struct snd_soc_tplg_mixer_control *)tplg->pos;
11788a978234SLiam Girdwood 		sm = kzalloc(sizeof(*sm), GFP_KERNEL);
11798a978234SLiam Girdwood 		if (sm == NULL)
11808a978234SLiam Girdwood 			goto err;
11818a978234SLiam Girdwood 
11828a978234SLiam Girdwood 		tplg->pos += (sizeof(struct snd_soc_tplg_mixer_control) +
11838a978234SLiam Girdwood 			mc->priv.size);
11848a978234SLiam Girdwood 
11858a978234SLiam Girdwood 		/* validate kcontrol */
11868a978234SLiam Girdwood 		if (strnlen(mc->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
11878a978234SLiam Girdwood 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
11888a978234SLiam Girdwood 			goto err_str;
11898a978234SLiam Girdwood 
11908a978234SLiam Girdwood 		dev_dbg(tplg->dev, " adding DAPM widget mixer control %s at %d\n",
11918a978234SLiam Girdwood 			mc->hdr.name, i);
11928a978234SLiam Girdwood 
11938a978234SLiam Girdwood 		kc[i].name = mc->hdr.name;
11948a978234SLiam Girdwood 		kc[i].private_value = (long)sm;
11958a978234SLiam Girdwood 		kc[i].iface = SNDRV_CTL_ELEM_IFACE_MIXER;
11968a978234SLiam Girdwood 		kc[i].access = mc->hdr.access;
11978a978234SLiam Girdwood 
11988a978234SLiam Girdwood 		/* we only support FL/FR channel mapping atm */
11998a978234SLiam Girdwood 		sm->reg = tplc_chan_get_reg(tplg, mc->channel,
12008a978234SLiam Girdwood 			SNDRV_CHMAP_FL);
12018a978234SLiam Girdwood 		sm->rreg = tplc_chan_get_reg(tplg, mc->channel,
12028a978234SLiam Girdwood 			SNDRV_CHMAP_FR);
12038a978234SLiam Girdwood 		sm->shift = tplc_chan_get_shift(tplg, mc->channel,
12048a978234SLiam Girdwood 			SNDRV_CHMAP_FL);
12058a978234SLiam Girdwood 		sm->rshift = tplc_chan_get_shift(tplg, mc->channel,
12068a978234SLiam Girdwood 			SNDRV_CHMAP_FR);
12078a978234SLiam Girdwood 
12088a978234SLiam Girdwood 		sm->max = mc->max;
12098a978234SLiam Girdwood 		sm->min = mc->min;
12108a978234SLiam Girdwood 		sm->invert = mc->invert;
12118a978234SLiam Girdwood 		sm->platform_max = mc->platform_max;
12128a978234SLiam Girdwood 		sm->dobj.index = tplg->index;
12138a978234SLiam Girdwood 		INIT_LIST_HEAD(&sm->dobj.list);
12148a978234SLiam Girdwood 
12158a978234SLiam Girdwood 		/* map io handlers */
12162b5cdb91SMengdong Lin 		err = soc_tplg_kcontrol_bind_io(&mc->hdr, &kc[i], tplg);
12178a978234SLiam Girdwood 		if (err) {
12188a978234SLiam Girdwood 			soc_control_err(tplg, &mc->hdr, mc->hdr.name);
12198a978234SLiam Girdwood 			kfree(sm);
12208a978234SLiam Girdwood 			continue;
12218a978234SLiam Girdwood 		}
12228a978234SLiam Girdwood 
12238a978234SLiam Girdwood 		/* pass control to driver for optional further init */
12248a978234SLiam Girdwood 		err = soc_tplg_init_kcontrol(tplg, &kc[i],
12258a978234SLiam Girdwood 			(struct snd_soc_tplg_ctl_hdr *)mc);
12268a978234SLiam Girdwood 		if (err < 0) {
12278a978234SLiam Girdwood 			dev_err(tplg->dev, "ASoC: failed to init %s\n",
12288a978234SLiam Girdwood 				mc->hdr.name);
12298a978234SLiam Girdwood 			kfree(sm);
12308a978234SLiam Girdwood 			continue;
12318a978234SLiam Girdwood 		}
12328a978234SLiam Girdwood 	}
12338a978234SLiam Girdwood 	return kc;
12348a978234SLiam Girdwood 
12358a978234SLiam Girdwood err_str:
12368a978234SLiam Girdwood 	kfree(sm);
12378a978234SLiam Girdwood err:
12388a978234SLiam Girdwood 	for (--i; i >= 0; i--)
12398a978234SLiam Girdwood 		kfree((void *)kc[i].private_value);
12408a978234SLiam Girdwood 	kfree(kc);
12418a978234SLiam Girdwood 	return NULL;
12428a978234SLiam Girdwood }
12438a978234SLiam Girdwood 
12448a978234SLiam Girdwood static struct snd_kcontrol_new *soc_tplg_dapm_widget_denum_create(
12458a978234SLiam Girdwood 	struct soc_tplg *tplg)
12468a978234SLiam Girdwood {
12478a978234SLiam Girdwood 	struct snd_kcontrol_new *kc;
12488a978234SLiam Girdwood 	struct snd_soc_tplg_enum_control *ec;
12498a978234SLiam Girdwood 	struct soc_enum *se;
12508a978234SLiam Girdwood 	int i, err;
12518a978234SLiam Girdwood 
12528a978234SLiam Girdwood 	ec = (struct snd_soc_tplg_enum_control *)tplg->pos;
12538a978234SLiam Girdwood 	tplg->pos += (sizeof(struct snd_soc_tplg_enum_control) +
12548a978234SLiam Girdwood 		ec->priv.size);
12558a978234SLiam Girdwood 
12568a978234SLiam Girdwood 	/* validate kcontrol */
12578a978234SLiam Girdwood 	if (strnlen(ec->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
12588a978234SLiam Girdwood 		SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
12598a978234SLiam Girdwood 		return NULL;
12608a978234SLiam Girdwood 
12618a978234SLiam Girdwood 	kc = kzalloc(sizeof(*kc), GFP_KERNEL);
12628a978234SLiam Girdwood 	if (kc == NULL)
12638a978234SLiam Girdwood 		return NULL;
12648a978234SLiam Girdwood 
12658a978234SLiam Girdwood 	se = kzalloc(sizeof(*se), GFP_KERNEL);
12668a978234SLiam Girdwood 	if (se == NULL)
12678a978234SLiam Girdwood 		goto err;
12688a978234SLiam Girdwood 
12698a978234SLiam Girdwood 	dev_dbg(tplg->dev, " adding DAPM widget enum control %s\n",
12708a978234SLiam Girdwood 		ec->hdr.name);
12718a978234SLiam Girdwood 
12728a978234SLiam Girdwood 	kc->name = ec->hdr.name;
12738a978234SLiam Girdwood 	kc->private_value = (long)se;
12748a978234SLiam Girdwood 	kc->iface = SNDRV_CTL_ELEM_IFACE_MIXER;
12758a978234SLiam Girdwood 	kc->access = ec->hdr.access;
12768a978234SLiam Girdwood 
12778a978234SLiam Girdwood 	/* we only support FL/FR channel mapping atm */
12788a978234SLiam Girdwood 	se->reg = tplc_chan_get_reg(tplg, ec->channel, SNDRV_CHMAP_FL);
12798a978234SLiam Girdwood 	se->shift_l = tplc_chan_get_shift(tplg, ec->channel, SNDRV_CHMAP_FL);
12808a978234SLiam Girdwood 	se->shift_r = tplc_chan_get_shift(tplg, ec->channel, SNDRV_CHMAP_FR);
12818a978234SLiam Girdwood 
12828a978234SLiam Girdwood 	se->items = ec->items;
12838a978234SLiam Girdwood 	se->mask = ec->mask;
12848a978234SLiam Girdwood 	se->dobj.index = tplg->index;
12858a978234SLiam Girdwood 
12868a978234SLiam Girdwood 	switch (ec->hdr.ops.info) {
12878a978234SLiam Girdwood 	case SND_SOC_TPLG_CTL_ENUM_VALUE:
12888a978234SLiam Girdwood 	case SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE:
12898a978234SLiam Girdwood 		err = soc_tplg_denum_create_values(se, ec);
12908a978234SLiam Girdwood 		if (err < 0) {
12918a978234SLiam Girdwood 			dev_err(tplg->dev, "ASoC: could not create values for %s\n",
12928a978234SLiam Girdwood 				ec->hdr.name);
12938a978234SLiam Girdwood 			goto err_se;
12948a978234SLiam Girdwood 		}
12958a978234SLiam Girdwood 		/* fall through to create texts */
12968a978234SLiam Girdwood 	case SND_SOC_TPLG_CTL_ENUM:
12978a978234SLiam Girdwood 	case SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE:
12988a978234SLiam Girdwood 	case SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT:
12998a978234SLiam Girdwood 		err = soc_tplg_denum_create_texts(se, ec);
13008a978234SLiam Girdwood 		if (err < 0) {
13018a978234SLiam Girdwood 			dev_err(tplg->dev, "ASoC: could not create texts for %s\n",
13028a978234SLiam Girdwood 				ec->hdr.name);
13038a978234SLiam Girdwood 			goto err_se;
13048a978234SLiam Girdwood 		}
13058a978234SLiam Girdwood 		break;
13068a978234SLiam Girdwood 	default:
13078a978234SLiam Girdwood 		dev_err(tplg->dev, "ASoC: invalid enum control type %d for %s\n",
13088a978234SLiam Girdwood 			ec->hdr.ops.info, ec->hdr.name);
13098a978234SLiam Girdwood 		goto err_se;
13108a978234SLiam Girdwood 	}
13118a978234SLiam Girdwood 
13128a978234SLiam Girdwood 	/* map io handlers */
13132b5cdb91SMengdong Lin 	err = soc_tplg_kcontrol_bind_io(&ec->hdr, kc, tplg);
13148a978234SLiam Girdwood 	if (err) {
13158a978234SLiam Girdwood 		soc_control_err(tplg, &ec->hdr, ec->hdr.name);
13168a978234SLiam Girdwood 		goto err_se;
13178a978234SLiam Girdwood 	}
13188a978234SLiam Girdwood 
13198a978234SLiam Girdwood 	/* pass control to driver for optional further init */
13208a978234SLiam Girdwood 	err = soc_tplg_init_kcontrol(tplg, kc,
13218a978234SLiam Girdwood 		(struct snd_soc_tplg_ctl_hdr *)ec);
13228a978234SLiam Girdwood 	if (err < 0) {
13238a978234SLiam Girdwood 		dev_err(tplg->dev, "ASoC: failed to init %s\n",
13248a978234SLiam Girdwood 			ec->hdr.name);
13258a978234SLiam Girdwood 		goto err_se;
13268a978234SLiam Girdwood 	}
13278a978234SLiam Girdwood 
13288a978234SLiam Girdwood 	return kc;
13298a978234SLiam Girdwood 
13308a978234SLiam Girdwood err_se:
13318a978234SLiam Girdwood 	/* free values and texts */
13328a978234SLiam Girdwood 	kfree(se->dobj.control.dvalues);
13338a978234SLiam Girdwood 	for (i = 0; i < ec->items; i++)
13348a978234SLiam Girdwood 		kfree(se->dobj.control.dtexts[i]);
13358a978234SLiam Girdwood 
13368a978234SLiam Girdwood 	kfree(se);
13378a978234SLiam Girdwood err:
13388a978234SLiam Girdwood 	kfree(kc);
13398a978234SLiam Girdwood 
13408a978234SLiam Girdwood 	return NULL;
13418a978234SLiam Girdwood }
13428a978234SLiam Girdwood 
13438a978234SLiam Girdwood static struct snd_kcontrol_new *soc_tplg_dapm_widget_dbytes_create(
13448a978234SLiam Girdwood 	struct soc_tplg *tplg, int count)
13458a978234SLiam Girdwood {
13468a978234SLiam Girdwood 	struct snd_soc_tplg_bytes_control *be;
13478a978234SLiam Girdwood 	struct soc_bytes_ext  *sbe;
13488a978234SLiam Girdwood 	struct snd_kcontrol_new *kc;
13498a978234SLiam Girdwood 	int i, err;
13508a978234SLiam Girdwood 
13514ca7deb1SAxel Lin 	kc = kcalloc(count, sizeof(*kc), GFP_KERNEL);
13528a978234SLiam Girdwood 	if (!kc)
13538a978234SLiam Girdwood 		return NULL;
13548a978234SLiam Girdwood 
13558a978234SLiam Girdwood 	for (i = 0; i < count; i++) {
13568a978234SLiam Girdwood 		be = (struct snd_soc_tplg_bytes_control *)tplg->pos;
13578a978234SLiam Girdwood 
13588a978234SLiam Girdwood 		/* validate kcontrol */
13598a978234SLiam Girdwood 		if (strnlen(be->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
13608a978234SLiam Girdwood 			SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
13618a978234SLiam Girdwood 			goto err;
13628a978234SLiam Girdwood 
13638a978234SLiam Girdwood 		sbe = kzalloc(sizeof(*sbe), GFP_KERNEL);
13648a978234SLiam Girdwood 		if (sbe == NULL)
13658a978234SLiam Girdwood 			goto err;
13668a978234SLiam Girdwood 
13678a978234SLiam Girdwood 		tplg->pos += (sizeof(struct snd_soc_tplg_bytes_control) +
13688a978234SLiam Girdwood 			be->priv.size);
13698a978234SLiam Girdwood 
13708a978234SLiam Girdwood 		dev_dbg(tplg->dev,
13718a978234SLiam Girdwood 			"ASoC: adding bytes kcontrol %s with access 0x%x\n",
13728a978234SLiam Girdwood 			be->hdr.name, be->hdr.access);
13738a978234SLiam Girdwood 
13748a978234SLiam Girdwood 		kc[i].name = be->hdr.name;
13758a978234SLiam Girdwood 		kc[i].private_value = (long)sbe;
13768a978234SLiam Girdwood 		kc[i].iface = SNDRV_CTL_ELEM_IFACE_MIXER;
13778a978234SLiam Girdwood 		kc[i].access = be->hdr.access;
13788a978234SLiam Girdwood 
13798a978234SLiam Girdwood 		sbe->max = be->max;
13808a978234SLiam Girdwood 		INIT_LIST_HEAD(&sbe->dobj.list);
13818a978234SLiam Girdwood 
13828a978234SLiam Girdwood 		/* map standard io handlers and check for external handlers */
13832b5cdb91SMengdong Lin 		err = soc_tplg_kcontrol_bind_io(&be->hdr, &kc[i], tplg);
13848a978234SLiam Girdwood 		if (err) {
13858a978234SLiam Girdwood 			soc_control_err(tplg, &be->hdr, be->hdr.name);
13868a978234SLiam Girdwood 			kfree(sbe);
13878a978234SLiam Girdwood 			continue;
13888a978234SLiam Girdwood 		}
13898a978234SLiam Girdwood 
13908a978234SLiam Girdwood 		/* pass control to driver for optional further init */
13918a978234SLiam Girdwood 		err = soc_tplg_init_kcontrol(tplg, &kc[i],
13928a978234SLiam Girdwood 			(struct snd_soc_tplg_ctl_hdr *)be);
13938a978234SLiam Girdwood 		if (err < 0) {
13948a978234SLiam Girdwood 			dev_err(tplg->dev, "ASoC: failed to init %s\n",
13958a978234SLiam Girdwood 				be->hdr.name);
13968a978234SLiam Girdwood 			kfree(sbe);
13978a978234SLiam Girdwood 			continue;
13988a978234SLiam Girdwood 		}
13998a978234SLiam Girdwood 	}
14008a978234SLiam Girdwood 
14018a978234SLiam Girdwood 	return kc;
14028a978234SLiam Girdwood 
14038a978234SLiam Girdwood err:
14048a978234SLiam Girdwood 	for (--i; i >= 0; i--)
14058a978234SLiam Girdwood 		kfree((void *)kc[i].private_value);
14068a978234SLiam Girdwood 
14078a978234SLiam Girdwood 	kfree(kc);
14088a978234SLiam Girdwood 	return NULL;
14098a978234SLiam Girdwood }
14108a978234SLiam Girdwood 
14118a978234SLiam Girdwood static int soc_tplg_dapm_widget_create(struct soc_tplg *tplg,
14128a978234SLiam Girdwood 	struct snd_soc_tplg_dapm_widget *w)
14138a978234SLiam Girdwood {
14148a978234SLiam Girdwood 	struct snd_soc_dapm_context *dapm = &tplg->comp->dapm;
14158a978234SLiam Girdwood 	struct snd_soc_dapm_widget template, *widget;
14168a978234SLiam Girdwood 	struct snd_soc_tplg_ctl_hdr *control_hdr;
14178a978234SLiam Girdwood 	struct snd_soc_card *card = tplg->comp->card;
14188a978234SLiam Girdwood 	int ret = 0;
14198a978234SLiam Girdwood 
14208a978234SLiam Girdwood 	if (strnlen(w->name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
14218a978234SLiam Girdwood 		SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
14228a978234SLiam Girdwood 		return -EINVAL;
14238a978234SLiam Girdwood 	if (strnlen(w->sname, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) ==
14248a978234SLiam Girdwood 		SNDRV_CTL_ELEM_ID_NAME_MAXLEN)
14258a978234SLiam Girdwood 		return -EINVAL;
14268a978234SLiam Girdwood 
14278a978234SLiam Girdwood 	dev_dbg(tplg->dev, "ASoC: creating DAPM widget %s id %d\n",
14288a978234SLiam Girdwood 		w->name, w->id);
14298a978234SLiam Girdwood 
14308a978234SLiam Girdwood 	memset(&template, 0, sizeof(template));
14318a978234SLiam Girdwood 
14328a978234SLiam Girdwood 	/* map user to kernel widget ID */
14338a978234SLiam Girdwood 	template.id = get_widget_id(w->id);
14348a978234SLiam Girdwood 	if (template.id < 0)
14358a978234SLiam Girdwood 		return template.id;
14368a978234SLiam Girdwood 
14378a978234SLiam Girdwood 	template.name = kstrdup(w->name, GFP_KERNEL);
14388a978234SLiam Girdwood 	if (!template.name)
14398a978234SLiam Girdwood 		return -ENOMEM;
14408a978234SLiam Girdwood 	template.sname = kstrdup(w->sname, GFP_KERNEL);
14418a978234SLiam Girdwood 	if (!template.sname) {
14428a978234SLiam Girdwood 		ret = -ENOMEM;
14438a978234SLiam Girdwood 		goto err;
14448a978234SLiam Girdwood 	}
14458a978234SLiam Girdwood 	template.reg = w->reg;
14468a978234SLiam Girdwood 	template.shift = w->shift;
14478a978234SLiam Girdwood 	template.mask = w->mask;
14486dc6db79SSubhransu S. Prusty 	template.subseq = w->subseq;
14498a978234SLiam Girdwood 	template.on_val = w->invert ? 0 : 1;
14508a978234SLiam Girdwood 	template.off_val = w->invert ? 1 : 0;
14518a978234SLiam Girdwood 	template.ignore_suspend = w->ignore_suspend;
14528a978234SLiam Girdwood 	template.event_flags = w->event_flags;
14538a978234SLiam Girdwood 	template.dobj.index = tplg->index;
14548a978234SLiam Girdwood 
14558a978234SLiam Girdwood 	tplg->pos +=
14568a978234SLiam Girdwood 		(sizeof(struct snd_soc_tplg_dapm_widget) + w->priv.size);
14578a978234SLiam Girdwood 	if (w->num_kcontrols == 0) {
14588a978234SLiam Girdwood 		template.num_kcontrols = 0;
14598a978234SLiam Girdwood 		goto widget;
14608a978234SLiam Girdwood 	}
14618a978234SLiam Girdwood 
14628a978234SLiam Girdwood 	control_hdr = (struct snd_soc_tplg_ctl_hdr *)tplg->pos;
14638a978234SLiam Girdwood 	dev_dbg(tplg->dev, "ASoC: template %s has %d controls of type %x\n",
14648a978234SLiam Girdwood 		w->name, w->num_kcontrols, control_hdr->type);
14658a978234SLiam Girdwood 
14668a978234SLiam Girdwood 	switch (control_hdr->ops.info) {
14678a978234SLiam Girdwood 	case SND_SOC_TPLG_CTL_VOLSW:
14688a978234SLiam Girdwood 	case SND_SOC_TPLG_CTL_STROBE:
14698a978234SLiam Girdwood 	case SND_SOC_TPLG_CTL_VOLSW_SX:
14708a978234SLiam Girdwood 	case SND_SOC_TPLG_CTL_VOLSW_XR_SX:
14718a978234SLiam Girdwood 	case SND_SOC_TPLG_CTL_RANGE:
14728a978234SLiam Girdwood 	case SND_SOC_TPLG_DAPM_CTL_VOLSW:
14738a978234SLiam Girdwood 		template.num_kcontrols = w->num_kcontrols;
14748a978234SLiam Girdwood 		template.kcontrol_news =
14758a978234SLiam Girdwood 			soc_tplg_dapm_widget_dmixer_create(tplg,
14768a978234SLiam Girdwood 			template.num_kcontrols);
14778a978234SLiam Girdwood 		if (!template.kcontrol_news) {
14788a978234SLiam Girdwood 			ret = -ENOMEM;
14798a978234SLiam Girdwood 			goto hdr_err;
14808a978234SLiam Girdwood 		}
14818a978234SLiam Girdwood 		break;
14828a978234SLiam Girdwood 	case SND_SOC_TPLG_CTL_ENUM:
14838a978234SLiam Girdwood 	case SND_SOC_TPLG_CTL_ENUM_VALUE:
14848a978234SLiam Girdwood 	case SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE:
14858a978234SLiam Girdwood 	case SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT:
14868a978234SLiam Girdwood 	case SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE:
14878a978234SLiam Girdwood 		template.dobj.widget.kcontrol_enum = 1;
14888a978234SLiam Girdwood 		template.num_kcontrols = 1;
14898a978234SLiam Girdwood 		template.kcontrol_news =
14908a978234SLiam Girdwood 			soc_tplg_dapm_widget_denum_create(tplg);
14918a978234SLiam Girdwood 		if (!template.kcontrol_news) {
14928a978234SLiam Girdwood 			ret = -ENOMEM;
14938a978234SLiam Girdwood 			goto hdr_err;
14948a978234SLiam Girdwood 		}
14958a978234SLiam Girdwood 		break;
14968a978234SLiam Girdwood 	case SND_SOC_TPLG_CTL_BYTES:
14978a978234SLiam Girdwood 		template.num_kcontrols = w->num_kcontrols;
14988a978234SLiam Girdwood 		template.kcontrol_news =
14998a978234SLiam Girdwood 			soc_tplg_dapm_widget_dbytes_create(tplg,
15008a978234SLiam Girdwood 				template.num_kcontrols);
15018a978234SLiam Girdwood 		if (!template.kcontrol_news) {
15028a978234SLiam Girdwood 			ret = -ENOMEM;
15038a978234SLiam Girdwood 			goto hdr_err;
15048a978234SLiam Girdwood 		}
15058a978234SLiam Girdwood 		break;
15068a978234SLiam Girdwood 	default:
15078a978234SLiam Girdwood 		dev_err(tplg->dev, "ASoC: invalid widget control type %d:%d:%d\n",
15088a978234SLiam Girdwood 			control_hdr->ops.get, control_hdr->ops.put,
15098a978234SLiam Girdwood 			control_hdr->ops.info);
15108a978234SLiam Girdwood 		ret = -EINVAL;
15118a978234SLiam Girdwood 		goto hdr_err;
15128a978234SLiam Girdwood 	}
15138a978234SLiam Girdwood 
15148a978234SLiam Girdwood widget:
15158a978234SLiam Girdwood 	ret = soc_tplg_widget_load(tplg, &template, w);
15168a978234SLiam Girdwood 	if (ret < 0)
15178a978234SLiam Girdwood 		goto hdr_err;
15188a978234SLiam Girdwood 
15198a978234SLiam Girdwood 	/* card dapm mutex is held by the core if we are loading topology
15208a978234SLiam Girdwood 	 * data during sound card init. */
15218a978234SLiam Girdwood 	if (card->instantiated)
15228a978234SLiam Girdwood 		widget = snd_soc_dapm_new_control(dapm, &template);
15238a978234SLiam Girdwood 	else
15248a978234SLiam Girdwood 		widget = snd_soc_dapm_new_control_unlocked(dapm, &template);
15258a978234SLiam Girdwood 	if (widget == NULL) {
15268a978234SLiam Girdwood 		dev_err(tplg->dev, "ASoC: failed to create widget %s controls\n",
15278a978234SLiam Girdwood 			w->name);
15288ae3ea48SWei Yongjun 		ret = -ENOMEM;
15298a978234SLiam Girdwood 		goto hdr_err;
15308a978234SLiam Girdwood 	}
15318a978234SLiam Girdwood 
15328a978234SLiam Girdwood 	widget->dobj.type = SND_SOC_DOBJ_WIDGET;
15338a978234SLiam Girdwood 	widget->dobj.ops = tplg->ops;
15348a978234SLiam Girdwood 	widget->dobj.index = tplg->index;
15358ea41674SJeeja KP 	kfree(template.sname);
15368ea41674SJeeja KP 	kfree(template.name);
15378a978234SLiam Girdwood 	list_add(&widget->dobj.list, &tplg->comp->dobj_list);
15388a978234SLiam Girdwood 	return 0;
15398a978234SLiam Girdwood 
15408a978234SLiam Girdwood hdr_err:
15418a978234SLiam Girdwood 	kfree(template.sname);
15428a978234SLiam Girdwood err:
15438a978234SLiam Girdwood 	kfree(template.name);
15448a978234SLiam Girdwood 	return ret;
15458a978234SLiam Girdwood }
15468a978234SLiam Girdwood 
15478a978234SLiam Girdwood static int soc_tplg_dapm_widget_elems_load(struct soc_tplg *tplg,
15488a978234SLiam Girdwood 	struct snd_soc_tplg_hdr *hdr)
15498a978234SLiam Girdwood {
15508a978234SLiam Girdwood 	struct snd_soc_tplg_dapm_widget *widget;
15518a978234SLiam Girdwood 	int ret, count = hdr->count, i;
15528a978234SLiam Girdwood 
15538a978234SLiam Girdwood 	if (tplg->pass != SOC_TPLG_PASS_WIDGET)
15548a978234SLiam Girdwood 		return 0;
15558a978234SLiam Girdwood 
15568a978234SLiam Girdwood 	dev_dbg(tplg->dev, "ASoC: adding %d DAPM widgets\n", count);
15578a978234SLiam Girdwood 
15588a978234SLiam Girdwood 	for (i = 0; i < count; i++) {
15598a978234SLiam Girdwood 		widget = (struct snd_soc_tplg_dapm_widget *) tplg->pos;
156006eb49f7SMengdong Lin 		if (widget->size != sizeof(*widget)) {
156106eb49f7SMengdong Lin 			dev_err(tplg->dev, "ASoC: invalid widget size\n");
156206eb49f7SMengdong Lin 			return -EINVAL;
156306eb49f7SMengdong Lin 		}
156406eb49f7SMengdong Lin 
15658a978234SLiam Girdwood 		ret = soc_tplg_dapm_widget_create(tplg, widget);
15667de76b62SMengdong Lin 		if (ret < 0) {
15678a978234SLiam Girdwood 			dev_err(tplg->dev, "ASoC: failed to load widget %s\n",
15688a978234SLiam Girdwood 				widget->name);
15697de76b62SMengdong Lin 			return ret;
15707de76b62SMengdong Lin 		}
15718a978234SLiam Girdwood 	}
15728a978234SLiam Girdwood 
15738a978234SLiam Girdwood 	return 0;
15748a978234SLiam Girdwood }
15758a978234SLiam Girdwood 
15768a978234SLiam Girdwood static int soc_tplg_dapm_complete(struct soc_tplg *tplg)
15778a978234SLiam Girdwood {
15788a978234SLiam Girdwood 	struct snd_soc_card *card = tplg->comp->card;
15798a978234SLiam Girdwood 	int ret;
15808a978234SLiam Girdwood 
15818a978234SLiam Girdwood 	/* Card might not have been registered at this point.
15828a978234SLiam Girdwood 	 * If so, just return success.
15838a978234SLiam Girdwood 	*/
15848a978234SLiam Girdwood 	if (!card || !card->instantiated) {
15858a978234SLiam Girdwood 		dev_warn(tplg->dev, "ASoC: Parent card not yet available,"
15868a978234SLiam Girdwood 				"Do not add new widgets now\n");
15878a978234SLiam Girdwood 		return 0;
15888a978234SLiam Girdwood 	}
15898a978234SLiam Girdwood 
15908a978234SLiam Girdwood 	ret = snd_soc_dapm_new_widgets(card);
15918a978234SLiam Girdwood 	if (ret < 0)
15928a978234SLiam Girdwood 		dev_err(tplg->dev, "ASoC: failed to create new widgets %d\n",
15938a978234SLiam Girdwood 			ret);
15948a978234SLiam Girdwood 
15958a978234SLiam Girdwood 	return 0;
15968a978234SLiam Girdwood }
15978a978234SLiam Girdwood 
1598b6b6e4d6SMengdong Lin static void set_stream_info(struct snd_soc_pcm_stream *stream,
1599b6b6e4d6SMengdong Lin 	struct snd_soc_tplg_stream_caps *caps)
1600b6b6e4d6SMengdong Lin {
1601b6b6e4d6SMengdong Lin 	stream->stream_name = kstrdup(caps->name, GFP_KERNEL);
1602b6b6e4d6SMengdong Lin 	stream->channels_min = caps->channels_min;
1603b6b6e4d6SMengdong Lin 	stream->channels_max = caps->channels_max;
1604b6b6e4d6SMengdong Lin 	stream->rates = caps->rates;
1605b6b6e4d6SMengdong Lin 	stream->rate_min = caps->rate_min;
1606b6b6e4d6SMengdong Lin 	stream->rate_max = caps->rate_max;
1607b6b6e4d6SMengdong Lin 	stream->formats = caps->formats;
1608f918e169SMengdong Lin 	stream->sig_bits = caps->sig_bits;
1609b6b6e4d6SMengdong Lin }
1610b6b6e4d6SMengdong Lin 
16110038be9aSMengdong Lin static void set_dai_flags(struct snd_soc_dai_driver *dai_drv,
16120038be9aSMengdong Lin 			  unsigned int flag_mask, unsigned int flags)
16130038be9aSMengdong Lin {
16140038be9aSMengdong Lin 	if (flag_mask & SND_SOC_TPLG_DAI_FLGBIT_SYMMETRIC_RATES)
16150038be9aSMengdong Lin 		dai_drv->symmetric_rates =
16160038be9aSMengdong Lin 			flags & SND_SOC_TPLG_DAI_FLGBIT_SYMMETRIC_RATES ? 1 : 0;
16170038be9aSMengdong Lin 
16180038be9aSMengdong Lin 	if (flag_mask & SND_SOC_TPLG_DAI_FLGBIT_SYMMETRIC_CHANNELS)
16190038be9aSMengdong Lin 		dai_drv->symmetric_channels =
16200038be9aSMengdong Lin 			flags & SND_SOC_TPLG_DAI_FLGBIT_SYMMETRIC_CHANNELS ?
16210038be9aSMengdong Lin 			1 : 0;
16220038be9aSMengdong Lin 
16230038be9aSMengdong Lin 	if (flag_mask & SND_SOC_TPLG_DAI_FLGBIT_SYMMETRIC_SAMPLEBITS)
16240038be9aSMengdong Lin 		dai_drv->symmetric_samplebits =
16250038be9aSMengdong Lin 			flags & SND_SOC_TPLG_DAI_FLGBIT_SYMMETRIC_SAMPLEBITS ?
16260038be9aSMengdong Lin 			1 : 0;
16270038be9aSMengdong Lin }
16280038be9aSMengdong Lin 
162964527e8aSMengdong Lin static int soc_tplg_dai_create(struct soc_tplg *tplg,
163064527e8aSMengdong Lin 	struct snd_soc_tplg_pcm *pcm)
163164527e8aSMengdong Lin {
163264527e8aSMengdong Lin 	struct snd_soc_dai_driver *dai_drv;
163364527e8aSMengdong Lin 	struct snd_soc_pcm_stream *stream;
163464527e8aSMengdong Lin 	struct snd_soc_tplg_stream_caps *caps;
163564527e8aSMengdong Lin 	int ret;
163664527e8aSMengdong Lin 
163764527e8aSMengdong Lin 	dai_drv = kzalloc(sizeof(struct snd_soc_dai_driver), GFP_KERNEL);
163864527e8aSMengdong Lin 	if (dai_drv == NULL)
163964527e8aSMengdong Lin 		return -ENOMEM;
164064527e8aSMengdong Lin 
164164527e8aSMengdong Lin 	dai_drv->name = pcm->dai_name;
164264527e8aSMengdong Lin 	dai_drv->id = pcm->dai_id;
164364527e8aSMengdong Lin 
164464527e8aSMengdong Lin 	if (pcm->playback) {
164564527e8aSMengdong Lin 		stream = &dai_drv->playback;
164664527e8aSMengdong Lin 		caps = &pcm->caps[SND_SOC_TPLG_STREAM_PLAYBACK];
1647b6b6e4d6SMengdong Lin 		set_stream_info(stream, caps);
164864527e8aSMengdong Lin 	}
164964527e8aSMengdong Lin 
165064527e8aSMengdong Lin 	if (pcm->capture) {
165164527e8aSMengdong Lin 		stream = &dai_drv->capture;
165264527e8aSMengdong Lin 		caps = &pcm->caps[SND_SOC_TPLG_STREAM_CAPTURE];
1653b6b6e4d6SMengdong Lin 		set_stream_info(stream, caps);
165464527e8aSMengdong Lin 	}
165564527e8aSMengdong Lin 
165664527e8aSMengdong Lin 	/* pass control to component driver for optional further init */
165764527e8aSMengdong Lin 	ret = soc_tplg_dai_load(tplg, dai_drv);
165864527e8aSMengdong Lin 	if (ret < 0) {
165964527e8aSMengdong Lin 		dev_err(tplg->comp->dev, "ASoC: DAI loading failed\n");
166064527e8aSMengdong Lin 		kfree(dai_drv);
166164527e8aSMengdong Lin 		return ret;
166264527e8aSMengdong Lin 	}
166364527e8aSMengdong Lin 
166464527e8aSMengdong Lin 	dai_drv->dobj.index = tplg->index;
166564527e8aSMengdong Lin 	dai_drv->dobj.ops = tplg->ops;
166664527e8aSMengdong Lin 	dai_drv->dobj.type = SND_SOC_DOBJ_PCM;
166764527e8aSMengdong Lin 	list_add(&dai_drv->dobj.list, &tplg->comp->dobj_list);
166864527e8aSMengdong Lin 
166964527e8aSMengdong Lin 	/* register the DAI to the component */
167064527e8aSMengdong Lin 	return snd_soc_register_dai(tplg->comp, dai_drv);
167164527e8aSMengdong Lin }
167264527e8aSMengdong Lin 
167367d1c21eSGuneshwor Singh /* create the FE DAI link */
1674acfc7d46SMengdong Lin static int soc_tplg_link_create(struct soc_tplg *tplg,
1675acfc7d46SMengdong Lin 	struct snd_soc_tplg_pcm *pcm)
1676acfc7d46SMengdong Lin {
1677acfc7d46SMengdong Lin 	struct snd_soc_dai_link *link;
1678acfc7d46SMengdong Lin 	int ret;
1679acfc7d46SMengdong Lin 
1680acfc7d46SMengdong Lin 	link = kzalloc(sizeof(struct snd_soc_dai_link), GFP_KERNEL);
1681acfc7d46SMengdong Lin 	if (link == NULL)
1682acfc7d46SMengdong Lin 		return -ENOMEM;
1683acfc7d46SMengdong Lin 
1684acfc7d46SMengdong Lin 	link->name = pcm->pcm_name;
1685acfc7d46SMengdong Lin 	link->stream_name = pcm->pcm_name;
1686b84fff5aSMengdong Lin 	link->id = pcm->pcm_id;
1687acfc7d46SMengdong Lin 
168867d1c21eSGuneshwor Singh 	link->cpu_dai_name = pcm->dai_name;
168967d1c21eSGuneshwor Singh 	link->codec_name = "snd-soc-dummy";
169067d1c21eSGuneshwor Singh 	link->codec_dai_name = "snd-soc-dummy-dai";
169167d1c21eSGuneshwor Singh 
169267d1c21eSGuneshwor Singh 	/* enable DPCM */
169367d1c21eSGuneshwor Singh 	link->dynamic = 1;
169467d1c21eSGuneshwor Singh 	link->dpcm_playback = pcm->playback;
169567d1c21eSGuneshwor Singh 	link->dpcm_capture = pcm->capture;
169667d1c21eSGuneshwor Singh 
1697acfc7d46SMengdong Lin 	/* pass control to component driver for optional further init */
1698acfc7d46SMengdong Lin 	ret = soc_tplg_dai_link_load(tplg, link);
1699acfc7d46SMengdong Lin 	if (ret < 0) {
1700acfc7d46SMengdong Lin 		dev_err(tplg->comp->dev, "ASoC: FE link loading failed\n");
1701acfc7d46SMengdong Lin 		kfree(link);
1702acfc7d46SMengdong Lin 		return ret;
1703acfc7d46SMengdong Lin 	}
1704acfc7d46SMengdong Lin 
1705acfc7d46SMengdong Lin 	link->dobj.index = tplg->index;
1706acfc7d46SMengdong Lin 	link->dobj.ops = tplg->ops;
1707acfc7d46SMengdong Lin 	link->dobj.type = SND_SOC_DOBJ_DAI_LINK;
1708acfc7d46SMengdong Lin 	list_add(&link->dobj.list, &tplg->comp->dobj_list);
1709acfc7d46SMengdong Lin 
1710acfc7d46SMengdong Lin 	snd_soc_add_dai_link(tplg->comp->card, link);
1711acfc7d46SMengdong Lin 	return 0;
1712acfc7d46SMengdong Lin }
1713acfc7d46SMengdong Lin 
1714acfc7d46SMengdong Lin /* create a FE DAI and DAI link from the PCM object */
171564527e8aSMengdong Lin static int soc_tplg_pcm_create(struct soc_tplg *tplg,
171664527e8aSMengdong Lin 	struct snd_soc_tplg_pcm *pcm)
171764527e8aSMengdong Lin {
1718acfc7d46SMengdong Lin 	int ret;
1719acfc7d46SMengdong Lin 
1720acfc7d46SMengdong Lin 	ret = soc_tplg_dai_create(tplg, pcm);
1721acfc7d46SMengdong Lin 	if (ret < 0)
1722acfc7d46SMengdong Lin 		return ret;
1723acfc7d46SMengdong Lin 
1724acfc7d46SMengdong Lin 	return  soc_tplg_link_create(tplg, pcm);
172564527e8aSMengdong Lin }
172664527e8aSMengdong Lin 
1727*55726dc9SMengdong Lin /* copy stream caps from the old version 4 of source */
1728*55726dc9SMengdong Lin static void stream_caps_new_ver(struct snd_soc_tplg_stream_caps *dest,
1729*55726dc9SMengdong Lin 				struct snd_soc_tplg_stream_caps_v4 *src)
1730*55726dc9SMengdong Lin {
1731*55726dc9SMengdong Lin 	dest->size = sizeof(*dest);
1732*55726dc9SMengdong Lin 	memcpy(dest->name, src->name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN);
1733*55726dc9SMengdong Lin 	dest->formats = src->formats;
1734*55726dc9SMengdong Lin 	dest->rates = src->rates;
1735*55726dc9SMengdong Lin 	dest->rate_min = src->rate_min;
1736*55726dc9SMengdong Lin 	dest->rate_max = src->rate_max;
1737*55726dc9SMengdong Lin 	dest->channels_min = src->channels_min;
1738*55726dc9SMengdong Lin 	dest->channels_max = src->channels_max;
1739*55726dc9SMengdong Lin 	dest->periods_min = src->periods_min;
1740*55726dc9SMengdong Lin 	dest->periods_max = src->periods_max;
1741*55726dc9SMengdong Lin 	dest->period_size_min = src->period_size_min;
1742*55726dc9SMengdong Lin 	dest->period_size_max = src->period_size_max;
1743*55726dc9SMengdong Lin 	dest->buffer_size_min = src->buffer_size_min;
1744*55726dc9SMengdong Lin 	dest->buffer_size_max = src->buffer_size_max;
1745*55726dc9SMengdong Lin }
1746*55726dc9SMengdong Lin 
1747*55726dc9SMengdong Lin /**
1748*55726dc9SMengdong Lin  * pcm_new_ver - Create the new version of PCM from the old version.
1749*55726dc9SMengdong Lin  * @tplg: topology context
1750*55726dc9SMengdong Lin  * @src: older version of pcm as a source
1751*55726dc9SMengdong Lin  * @pcm: latest version of pcm created from the source
1752*55726dc9SMengdong Lin  *
1753*55726dc9SMengdong Lin  * Support from vesion 4. User should free the returned pcm manually.
1754*55726dc9SMengdong Lin  */
1755*55726dc9SMengdong Lin static int pcm_new_ver(struct soc_tplg *tplg,
1756*55726dc9SMengdong Lin 		       struct snd_soc_tplg_pcm *src,
1757*55726dc9SMengdong Lin 		       struct snd_soc_tplg_pcm **pcm)
1758*55726dc9SMengdong Lin {
1759*55726dc9SMengdong Lin 	struct snd_soc_tplg_pcm *dest;
1760*55726dc9SMengdong Lin 	struct snd_soc_tplg_pcm_v4 *src_v4;
1761*55726dc9SMengdong Lin 	int i;
1762*55726dc9SMengdong Lin 
1763*55726dc9SMengdong Lin 	*pcm = NULL;
1764*55726dc9SMengdong Lin 
1765*55726dc9SMengdong Lin 	if (src->size != sizeof(*src_v4)) {
1766*55726dc9SMengdong Lin 		dev_err(tplg->dev, "ASoC: invalid PCM size\n");
1767*55726dc9SMengdong Lin 		return -EINVAL;
1768*55726dc9SMengdong Lin 	}
1769*55726dc9SMengdong Lin 
1770*55726dc9SMengdong Lin 	dev_warn(tplg->dev, "ASoC: old version of PCM\n");
1771*55726dc9SMengdong Lin 	src_v4 = (struct snd_soc_tplg_pcm_v4 *)src;
1772*55726dc9SMengdong Lin 	dest = kzalloc(sizeof(*dest), GFP_KERNEL);
1773*55726dc9SMengdong Lin 	if (!dest)
1774*55726dc9SMengdong Lin 		return -ENOMEM;
1775*55726dc9SMengdong Lin 
1776*55726dc9SMengdong Lin 	dest->size = sizeof(*dest);	/* size of latest abi version */
1777*55726dc9SMengdong Lin 	memcpy(dest->pcm_name, src_v4->pcm_name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN);
1778*55726dc9SMengdong Lin 	memcpy(dest->dai_name, src_v4->dai_name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN);
1779*55726dc9SMengdong Lin 	dest->pcm_id = src_v4->pcm_id;
1780*55726dc9SMengdong Lin 	dest->dai_id = src_v4->dai_id;
1781*55726dc9SMengdong Lin 	dest->playback = src_v4->playback;
1782*55726dc9SMengdong Lin 	dest->capture = src_v4->capture;
1783*55726dc9SMengdong Lin 	dest->compress = src_v4->compress;
1784*55726dc9SMengdong Lin 	dest->num_streams = src_v4->num_streams;
1785*55726dc9SMengdong Lin 	for (i = 0; i < dest->num_streams; i++)
1786*55726dc9SMengdong Lin 		memcpy(&dest->stream[i], &src_v4->stream[i],
1787*55726dc9SMengdong Lin 		       sizeof(struct snd_soc_tplg_stream));
1788*55726dc9SMengdong Lin 
1789*55726dc9SMengdong Lin 	for (i = 0; i < 2; i++)
1790*55726dc9SMengdong Lin 		stream_caps_new_ver(&dest->caps[i], &src_v4->caps[i]);
1791*55726dc9SMengdong Lin 
1792*55726dc9SMengdong Lin 	*pcm = dest;
1793*55726dc9SMengdong Lin 	return 0;
1794*55726dc9SMengdong Lin }
1795*55726dc9SMengdong Lin 
179664527e8aSMengdong Lin static int soc_tplg_pcm_elems_load(struct soc_tplg *tplg,
17978a978234SLiam Girdwood 	struct snd_soc_tplg_hdr *hdr)
17988a978234SLiam Girdwood {
1799*55726dc9SMengdong Lin 	struct snd_soc_tplg_pcm *pcm, *_pcm;
18008a978234SLiam Girdwood 	int count = hdr->count;
1801*55726dc9SMengdong Lin 	int i, err;
1802*55726dc9SMengdong Lin 	bool abi_match;
18038a978234SLiam Girdwood 
18048a978234SLiam Girdwood 	if (tplg->pass != SOC_TPLG_PASS_PCM_DAI)
18058a978234SLiam Girdwood 		return 0;
18068a978234SLiam Girdwood 
1807*55726dc9SMengdong Lin 	/* check the element size and count */
1808*55726dc9SMengdong Lin 	pcm = (struct snd_soc_tplg_pcm *)tplg->pos;
1809*55726dc9SMengdong Lin 	if (pcm->size > sizeof(struct snd_soc_tplg_pcm)
1810*55726dc9SMengdong Lin 		|| pcm->size < sizeof(struct snd_soc_tplg_pcm_v4)) {
1811*55726dc9SMengdong Lin 		dev_err(tplg->dev, "ASoC: invalid size %d for PCM elems\n",
1812*55726dc9SMengdong Lin 			pcm->size);
1813*55726dc9SMengdong Lin 		return -EINVAL;
1814*55726dc9SMengdong Lin 	}
1815*55726dc9SMengdong Lin 
18168a978234SLiam Girdwood 	if (soc_tplg_check_elem_count(tplg,
1817*55726dc9SMengdong Lin 		pcm->size, count,
18188a978234SLiam Girdwood 		hdr->payload_size, "PCM DAI")) {
18198a978234SLiam Girdwood 		dev_err(tplg->dev, "ASoC: invalid count %d for PCM DAI elems\n",
18208a978234SLiam Girdwood 			count);
18218a978234SLiam Girdwood 		return -EINVAL;
18228a978234SLiam Girdwood 	}
18238a978234SLiam Girdwood 
182464527e8aSMengdong Lin 	for (i = 0; i < count; i++) {
1825*55726dc9SMengdong Lin 		pcm = (struct snd_soc_tplg_pcm *)tplg->pos;
1826*55726dc9SMengdong Lin 
1827*55726dc9SMengdong Lin 		/* check ABI version by size, create a new version of pcm
1828*55726dc9SMengdong Lin 		 * if abi not match.
1829*55726dc9SMengdong Lin 		 */
1830*55726dc9SMengdong Lin 		if (pcm->size == sizeof(*pcm)) {
1831*55726dc9SMengdong Lin 			abi_match = true;
1832*55726dc9SMengdong Lin 			_pcm = pcm;
1833*55726dc9SMengdong Lin 		} else {
1834*55726dc9SMengdong Lin 			abi_match = false;
1835*55726dc9SMengdong Lin 			err = pcm_new_ver(tplg, pcm, &_pcm);
183606eb49f7SMengdong Lin 		}
183706eb49f7SMengdong Lin 
1838*55726dc9SMengdong Lin 		/* create the FE DAIs and DAI links */
1839*55726dc9SMengdong Lin 		soc_tplg_pcm_create(tplg, _pcm);
1840*55726dc9SMengdong Lin 
1841*55726dc9SMengdong Lin 		if (!abi_match)
1842*55726dc9SMengdong Lin 			kfree(_pcm); /* free the duplicated one */
1843*55726dc9SMengdong Lin 
1844*55726dc9SMengdong Lin 		tplg->pos += pcm->size; /* offset by version-specific size */
184564527e8aSMengdong Lin 	}
184664527e8aSMengdong Lin 
18478a978234SLiam Girdwood 	dev_dbg(tplg->dev, "ASoC: adding %d PCM DAIs\n", count);
18488a978234SLiam Girdwood 
18498a978234SLiam Girdwood 	return 0;
18508a978234SLiam Girdwood }
18518a978234SLiam Girdwood 
18520038be9aSMengdong Lin /* *
18530038be9aSMengdong Lin  * soc_tplg_be_dai_config - Find and configure an existing BE DAI.
18540038be9aSMengdong Lin  * @tplg: topology context
18550038be9aSMengdong Lin  * @be: topology BE DAI configs.
18560038be9aSMengdong Lin  *
18570038be9aSMengdong Lin  * The BE dai should already be registered by the platform driver. The
18580038be9aSMengdong Lin  * platform driver should specify the BE DAI name and ID for matching.
18590038be9aSMengdong Lin  */
18600038be9aSMengdong Lin static int soc_tplg_be_dai_config(struct soc_tplg *tplg,
18610038be9aSMengdong Lin 				  struct snd_soc_tplg_be_dai *be)
18620038be9aSMengdong Lin {
18630038be9aSMengdong Lin 	struct snd_soc_dai_link_component dai_component = {0};
18640038be9aSMengdong Lin 	struct snd_soc_dai *dai;
18650038be9aSMengdong Lin 	struct snd_soc_dai_driver *dai_drv;
18660038be9aSMengdong Lin 	struct snd_soc_pcm_stream *stream;
18670038be9aSMengdong Lin 	struct snd_soc_tplg_stream_caps *caps;
18680038be9aSMengdong Lin 	int ret;
18690038be9aSMengdong Lin 
18700038be9aSMengdong Lin 	dai_component.dai_name = be->dai_name;
18710038be9aSMengdong Lin 	dai = snd_soc_find_dai(&dai_component);
18720038be9aSMengdong Lin 	if (!dai) {
18730038be9aSMengdong Lin 		dev_err(tplg->dev, "ASoC: BE DAI %s not registered\n",
18740038be9aSMengdong Lin 			be->dai_name);
18750038be9aSMengdong Lin 		return -EINVAL;
18760038be9aSMengdong Lin 	}
18770038be9aSMengdong Lin 
18780038be9aSMengdong Lin 	if (be->dai_id != dai->id) {
18790038be9aSMengdong Lin 		dev_err(tplg->dev, "ASoC: BE DAI %s id mismatch\n",
18800038be9aSMengdong Lin 			be->dai_name);
18810038be9aSMengdong Lin 		return -EINVAL;
18820038be9aSMengdong Lin 	}
18830038be9aSMengdong Lin 
18840038be9aSMengdong Lin 	dai_drv = dai->driver;
18850038be9aSMengdong Lin 	if (!dai_drv)
18860038be9aSMengdong Lin 		return -EINVAL;
18870038be9aSMengdong Lin 
18880038be9aSMengdong Lin 	if (be->playback) {
18890038be9aSMengdong Lin 		stream = &dai_drv->playback;
18900038be9aSMengdong Lin 		caps = &be->caps[SND_SOC_TPLG_STREAM_PLAYBACK];
18910038be9aSMengdong Lin 		set_stream_info(stream, caps);
18920038be9aSMengdong Lin 	}
18930038be9aSMengdong Lin 
18940038be9aSMengdong Lin 	if (be->capture) {
18950038be9aSMengdong Lin 		stream = &dai_drv->capture;
18960038be9aSMengdong Lin 		caps = &be->caps[SND_SOC_TPLG_STREAM_CAPTURE];
18970038be9aSMengdong Lin 		set_stream_info(stream, caps);
18980038be9aSMengdong Lin 	}
18990038be9aSMengdong Lin 
19000038be9aSMengdong Lin 	if (be->flag_mask)
19010038be9aSMengdong Lin 		set_dai_flags(dai_drv, be->flag_mask, be->flags);
19020038be9aSMengdong Lin 
19030038be9aSMengdong Lin 	/* pass control to component driver for optional further init */
19040038be9aSMengdong Lin 	ret = soc_tplg_dai_load(tplg, dai_drv);
19050038be9aSMengdong Lin 	if (ret < 0) {
19060038be9aSMengdong Lin 		dev_err(tplg->comp->dev, "ASoC: DAI loading failed\n");
19070038be9aSMengdong Lin 		return ret;
19080038be9aSMengdong Lin 	}
19090038be9aSMengdong Lin 
19100038be9aSMengdong Lin 	return 0;
19110038be9aSMengdong Lin }
19120038be9aSMengdong Lin 
19130038be9aSMengdong Lin static int soc_tplg_be_dai_elems_load(struct soc_tplg *tplg,
19140038be9aSMengdong Lin 				      struct snd_soc_tplg_hdr *hdr)
19150038be9aSMengdong Lin {
19160038be9aSMengdong Lin 	struct snd_soc_tplg_be_dai *be;
19170038be9aSMengdong Lin 	int count = hdr->count;
19180038be9aSMengdong Lin 	int i;
19190038be9aSMengdong Lin 
19200038be9aSMengdong Lin 	if (tplg->pass != SOC_TPLG_PASS_BE_DAI)
19210038be9aSMengdong Lin 		return 0;
19220038be9aSMengdong Lin 
19230038be9aSMengdong Lin 	/* config the existing BE DAIs */
19240038be9aSMengdong Lin 	for (i = 0; i < count; i++) {
19250038be9aSMengdong Lin 		be = (struct snd_soc_tplg_be_dai *)tplg->pos;
19260038be9aSMengdong Lin 		if (be->size != sizeof(*be)) {
19270038be9aSMengdong Lin 			dev_err(tplg->dev, "ASoC: invalid BE DAI size\n");
19280038be9aSMengdong Lin 			return -EINVAL;
19290038be9aSMengdong Lin 		}
19300038be9aSMengdong Lin 
19310038be9aSMengdong Lin 		soc_tplg_be_dai_config(tplg, be);
19320038be9aSMengdong Lin 		tplg->pos += (sizeof(*be) + be->priv.size);
19330038be9aSMengdong Lin 	}
19340038be9aSMengdong Lin 
19350038be9aSMengdong Lin 	dev_dbg(tplg->dev, "ASoC: Configure %d BE DAIs\n", count);
19360038be9aSMengdong Lin 	return 0;
19370038be9aSMengdong Lin }
19380038be9aSMengdong Lin 
1939583958faSMengdong Lin /**
1940583958faSMengdong Lin  * manifest_new_ver - Create a new version of manifest from the old version
1941583958faSMengdong Lin  * of source.
1942583958faSMengdong Lin  * @toplogy: topology context
1943583958faSMengdong Lin  * @src: old version of manifest as a source
1944583958faSMengdong Lin  * @manifest: latest version of manifest created from the source
1945583958faSMengdong Lin  *
1946583958faSMengdong Lin  * Support from vesion 4. Users need free the returned manifest manually.
1947583958faSMengdong Lin  */
1948583958faSMengdong Lin static int manifest_new_ver(struct soc_tplg *tplg,
1949583958faSMengdong Lin 			    struct snd_soc_tplg_manifest *src,
1950583958faSMengdong Lin 			    struct snd_soc_tplg_manifest **manifest)
1951583958faSMengdong Lin {
1952583958faSMengdong Lin 	struct snd_soc_tplg_manifest *dest;
1953583958faSMengdong Lin 	struct snd_soc_tplg_manifest_v4 *src_v4;
1954583958faSMengdong Lin 
1955583958faSMengdong Lin 	*manifest = NULL;
1956583958faSMengdong Lin 
1957583958faSMengdong Lin 	if (src->size != sizeof(*src_v4)) {
1958583958faSMengdong Lin 		dev_err(tplg->dev, "ASoC: invalid manifest size\n");
1959583958faSMengdong Lin 		return -EINVAL;
1960583958faSMengdong Lin 	}
1961583958faSMengdong Lin 
1962583958faSMengdong Lin 	dev_warn(tplg->dev, "ASoC: old version of manifest\n");
1963583958faSMengdong Lin 
1964583958faSMengdong Lin 	src_v4 = (struct snd_soc_tplg_manifest_v4 *)src;
1965583958faSMengdong Lin 	dest = kzalloc(sizeof(*dest) + src_v4->priv.size, GFP_KERNEL);
1966583958faSMengdong Lin 	if (!dest)
1967583958faSMengdong Lin 		return -ENOMEM;
1968583958faSMengdong Lin 
1969583958faSMengdong Lin 	dest->size = sizeof(*dest);	/* size of latest abi version */
1970583958faSMengdong Lin 	dest->control_elems = src_v4->control_elems;
1971583958faSMengdong Lin 	dest->widget_elems = src_v4->widget_elems;
1972583958faSMengdong Lin 	dest->graph_elems = src_v4->graph_elems;
1973583958faSMengdong Lin 	dest->pcm_elems = src_v4->pcm_elems;
1974583958faSMengdong Lin 	dest->dai_link_elems = src_v4->dai_link_elems;
1975583958faSMengdong Lin 	dest->priv.size = src_v4->priv.size;
1976583958faSMengdong Lin 	if (dest->priv.size)
1977583958faSMengdong Lin 		memcpy(dest->priv.data, src_v4->priv.data,
1978583958faSMengdong Lin 		       src_v4->priv.size);
1979583958faSMengdong Lin 
1980583958faSMengdong Lin 	*manifest = dest;
1981583958faSMengdong Lin 	return 0;
1982583958faSMengdong Lin }
19830038be9aSMengdong Lin 
19848a978234SLiam Girdwood static int soc_tplg_manifest_load(struct soc_tplg *tplg,
19858a978234SLiam Girdwood 				  struct snd_soc_tplg_hdr *hdr)
19868a978234SLiam Girdwood {
1987583958faSMengdong Lin 	struct snd_soc_tplg_manifest *manifest, *_manifest;
1988583958faSMengdong Lin 	bool abi_match;
1989583958faSMengdong Lin 	int err;
19908a978234SLiam Girdwood 
19918a978234SLiam Girdwood 	if (tplg->pass != SOC_TPLG_PASS_MANIFEST)
19928a978234SLiam Girdwood 		return 0;
19938a978234SLiam Girdwood 
19948a978234SLiam Girdwood 	manifest = (struct snd_soc_tplg_manifest *)tplg->pos;
1995583958faSMengdong Lin 
1996583958faSMengdong Lin 	/* check ABI version by size, create a new manifest if abi not match */
1997583958faSMengdong Lin 	if (manifest->size == sizeof(*manifest)) {
1998583958faSMengdong Lin 		abi_match = true;
1999583958faSMengdong Lin 		_manifest = manifest;
2000583958faSMengdong Lin 	} else {
2001583958faSMengdong Lin 		abi_match = false;
2002583958faSMengdong Lin 		err = manifest_new_ver(tplg, manifest, &_manifest);
2003583958faSMengdong Lin 		if (err < 0)
2004583958faSMengdong Lin 			return err;
200506eb49f7SMengdong Lin 	}
200606eb49f7SMengdong Lin 
2007583958faSMengdong Lin 	/* pass control to component driver for optional further init */
20088a978234SLiam Girdwood 	if (tplg->comp && tplg->ops && tplg->ops->manifest)
2009583958faSMengdong Lin 		return tplg->ops->manifest(tplg->comp, _manifest);
20108a978234SLiam Girdwood 
2011583958faSMengdong Lin 	if (!abi_match)	/* free the duplicated one */
2012583958faSMengdong Lin 		kfree(_manifest);
2013583958faSMengdong Lin 
20148a978234SLiam Girdwood 	return 0;
20158a978234SLiam Girdwood }
20168a978234SLiam Girdwood 
20178a978234SLiam Girdwood /* validate header magic, size and type */
20188a978234SLiam Girdwood static int soc_valid_header(struct soc_tplg *tplg,
20198a978234SLiam Girdwood 	struct snd_soc_tplg_hdr *hdr)
20208a978234SLiam Girdwood {
20218a978234SLiam Girdwood 	if (soc_tplg_get_hdr_offset(tplg) >= tplg->fw->size)
20228a978234SLiam Girdwood 		return 0;
20238a978234SLiam Girdwood 
202406eb49f7SMengdong Lin 	if (hdr->size != sizeof(*hdr)) {
202506eb49f7SMengdong Lin 		dev_err(tplg->dev,
202606eb49f7SMengdong Lin 			"ASoC: invalid header size for type %d at offset 0x%lx size 0x%zx.\n",
202706eb49f7SMengdong Lin 			hdr->type, soc_tplg_get_hdr_offset(tplg),
202806eb49f7SMengdong Lin 			tplg->fw->size);
202906eb49f7SMengdong Lin 		return -EINVAL;
203006eb49f7SMengdong Lin 	}
203106eb49f7SMengdong Lin 
20328a978234SLiam Girdwood 	/* big endian firmware objects not supported atm */
20338a978234SLiam Girdwood 	if (hdr->magic == cpu_to_be32(SND_SOC_TPLG_MAGIC)) {
20348a978234SLiam Girdwood 		dev_err(tplg->dev,
20358a978234SLiam Girdwood 			"ASoC: pass %d big endian not supported header got %x at offset 0x%lx size 0x%zx.\n",
20368a978234SLiam Girdwood 			tplg->pass, hdr->magic,
20378a978234SLiam Girdwood 			soc_tplg_get_hdr_offset(tplg), tplg->fw->size);
20388a978234SLiam Girdwood 		return -EINVAL;
20398a978234SLiam Girdwood 	}
20408a978234SLiam Girdwood 
20418a978234SLiam Girdwood 	if (hdr->magic != SND_SOC_TPLG_MAGIC) {
20428a978234SLiam Girdwood 		dev_err(tplg->dev,
20438a978234SLiam Girdwood 			"ASoC: pass %d does not have a valid header got %x at offset 0x%lx size 0x%zx.\n",
20448a978234SLiam Girdwood 			tplg->pass, hdr->magic,
20458a978234SLiam Girdwood 			soc_tplg_get_hdr_offset(tplg), tplg->fw->size);
20468a978234SLiam Girdwood 		return -EINVAL;
20478a978234SLiam Girdwood 	}
20488a978234SLiam Girdwood 
20498a978234SLiam Girdwood 	if (hdr->abi != SND_SOC_TPLG_ABI_VERSION) {
20508a978234SLiam Girdwood 		dev_err(tplg->dev,
20518a978234SLiam Girdwood 			"ASoC: pass %d invalid ABI version got 0x%x need 0x%x at offset 0x%lx size 0x%zx.\n",
20528a978234SLiam Girdwood 			tplg->pass, hdr->abi,
20538a978234SLiam Girdwood 			SND_SOC_TPLG_ABI_VERSION, soc_tplg_get_hdr_offset(tplg),
20548a978234SLiam Girdwood 			tplg->fw->size);
20558a978234SLiam Girdwood 		return -EINVAL;
20568a978234SLiam Girdwood 	}
20578a978234SLiam Girdwood 
20588a978234SLiam Girdwood 	if (hdr->payload_size == 0) {
20598a978234SLiam Girdwood 		dev_err(tplg->dev, "ASoC: header has 0 size at offset 0x%lx.\n",
20608a978234SLiam Girdwood 			soc_tplg_get_hdr_offset(tplg));
20618a978234SLiam Girdwood 		return -EINVAL;
20628a978234SLiam Girdwood 	}
20638a978234SLiam Girdwood 
20648a978234SLiam Girdwood 	if (tplg->pass == hdr->type)
20658a978234SLiam Girdwood 		dev_dbg(tplg->dev,
20668a978234SLiam Girdwood 			"ASoC: Got 0x%x bytes of type %d version %d vendor %d at pass %d\n",
20678a978234SLiam Girdwood 			hdr->payload_size, hdr->type, hdr->version,
20688a978234SLiam Girdwood 			hdr->vendor_type, tplg->pass);
20698a978234SLiam Girdwood 
20708a978234SLiam Girdwood 	return 1;
20718a978234SLiam Girdwood }
20728a978234SLiam Girdwood 
20738a978234SLiam Girdwood /* check header type and call appropriate handler */
20748a978234SLiam Girdwood static int soc_tplg_load_header(struct soc_tplg *tplg,
20758a978234SLiam Girdwood 	struct snd_soc_tplg_hdr *hdr)
20768a978234SLiam Girdwood {
20778a978234SLiam Girdwood 	tplg->pos = tplg->hdr_pos + sizeof(struct snd_soc_tplg_hdr);
20788a978234SLiam Girdwood 
20798a978234SLiam Girdwood 	/* check for matching ID */
20808a978234SLiam Girdwood 	if (hdr->index != tplg->req_index &&
20818a978234SLiam Girdwood 		hdr->index != SND_SOC_TPLG_INDEX_ALL)
20828a978234SLiam Girdwood 		return 0;
20838a978234SLiam Girdwood 
20848a978234SLiam Girdwood 	tplg->index = hdr->index;
20858a978234SLiam Girdwood 
20868a978234SLiam Girdwood 	switch (hdr->type) {
20878a978234SLiam Girdwood 	case SND_SOC_TPLG_TYPE_MIXER:
20888a978234SLiam Girdwood 	case SND_SOC_TPLG_TYPE_ENUM:
20898a978234SLiam Girdwood 	case SND_SOC_TPLG_TYPE_BYTES:
20908a978234SLiam Girdwood 		return soc_tplg_kcontrol_elems_load(tplg, hdr);
20918a978234SLiam Girdwood 	case SND_SOC_TPLG_TYPE_DAPM_GRAPH:
20928a978234SLiam Girdwood 		return soc_tplg_dapm_graph_elems_load(tplg, hdr);
20938a978234SLiam Girdwood 	case SND_SOC_TPLG_TYPE_DAPM_WIDGET:
20948a978234SLiam Girdwood 		return soc_tplg_dapm_widget_elems_load(tplg, hdr);
20958a978234SLiam Girdwood 	case SND_SOC_TPLG_TYPE_PCM:
209664527e8aSMengdong Lin 		return soc_tplg_pcm_elems_load(tplg, hdr);
20970038be9aSMengdong Lin 	case SND_SOC_TPLG_TYPE_BE_DAI:
20980038be9aSMengdong Lin 		return soc_tplg_be_dai_elems_load(tplg, hdr);
20998a978234SLiam Girdwood 	case SND_SOC_TPLG_TYPE_MANIFEST:
21008a978234SLiam Girdwood 		return soc_tplg_manifest_load(tplg, hdr);
21018a978234SLiam Girdwood 	default:
21028a978234SLiam Girdwood 		/* bespoke vendor data object */
21038a978234SLiam Girdwood 		return soc_tplg_vendor_load(tplg, hdr);
21048a978234SLiam Girdwood 	}
21058a978234SLiam Girdwood 
21068a978234SLiam Girdwood 	return 0;
21078a978234SLiam Girdwood }
21088a978234SLiam Girdwood 
21098a978234SLiam Girdwood /* process the topology file headers */
21108a978234SLiam Girdwood static int soc_tplg_process_headers(struct soc_tplg *tplg)
21118a978234SLiam Girdwood {
21128a978234SLiam Girdwood 	struct snd_soc_tplg_hdr *hdr;
21138a978234SLiam Girdwood 	int ret;
21148a978234SLiam Girdwood 
21158a978234SLiam Girdwood 	tplg->pass = SOC_TPLG_PASS_START;
21168a978234SLiam Girdwood 
21178a978234SLiam Girdwood 	/* process the header types from start to end */
21188a978234SLiam Girdwood 	while (tplg->pass <= SOC_TPLG_PASS_END) {
21198a978234SLiam Girdwood 
21208a978234SLiam Girdwood 		tplg->hdr_pos = tplg->fw->data;
21218a978234SLiam Girdwood 		hdr = (struct snd_soc_tplg_hdr *)tplg->hdr_pos;
21228a978234SLiam Girdwood 
21238a978234SLiam Girdwood 		while (!soc_tplg_is_eof(tplg)) {
21248a978234SLiam Girdwood 
21258a978234SLiam Girdwood 			/* make sure header is valid before loading */
21268a978234SLiam Girdwood 			ret = soc_valid_header(tplg, hdr);
21278a978234SLiam Girdwood 			if (ret < 0)
21288a978234SLiam Girdwood 				return ret;
21298a978234SLiam Girdwood 			else if (ret == 0)
21308a978234SLiam Girdwood 				break;
21318a978234SLiam Girdwood 
21328a978234SLiam Girdwood 			/* load the header object */
21338a978234SLiam Girdwood 			ret = soc_tplg_load_header(tplg, hdr);
21348a978234SLiam Girdwood 			if (ret < 0)
21358a978234SLiam Girdwood 				return ret;
21368a978234SLiam Girdwood 
21378a978234SLiam Girdwood 			/* goto next header */
21388a978234SLiam Girdwood 			tplg->hdr_pos += hdr->payload_size +
21398a978234SLiam Girdwood 				sizeof(struct snd_soc_tplg_hdr);
21408a978234SLiam Girdwood 			hdr = (struct snd_soc_tplg_hdr *)tplg->hdr_pos;
21418a978234SLiam Girdwood 		}
21428a978234SLiam Girdwood 
21438a978234SLiam Girdwood 		/* next data type pass */
21448a978234SLiam Girdwood 		tplg->pass++;
21458a978234SLiam Girdwood 	}
21468a978234SLiam Girdwood 
21478a978234SLiam Girdwood 	/* signal DAPM we are complete */
21488a978234SLiam Girdwood 	ret = soc_tplg_dapm_complete(tplg);
21498a978234SLiam Girdwood 	if (ret < 0)
21508a978234SLiam Girdwood 		dev_err(tplg->dev,
21518a978234SLiam Girdwood 			"ASoC: failed to initialise DAPM from Firmware\n");
21528a978234SLiam Girdwood 
21538a978234SLiam Girdwood 	return ret;
21548a978234SLiam Girdwood }
21558a978234SLiam Girdwood 
21568a978234SLiam Girdwood static int soc_tplg_load(struct soc_tplg *tplg)
21578a978234SLiam Girdwood {
21588a978234SLiam Girdwood 	int ret;
21598a978234SLiam Girdwood 
21608a978234SLiam Girdwood 	ret = soc_tplg_process_headers(tplg);
21618a978234SLiam Girdwood 	if (ret == 0)
21628a978234SLiam Girdwood 		soc_tplg_complete(tplg);
21638a978234SLiam Girdwood 
21648a978234SLiam Girdwood 	return ret;
21658a978234SLiam Girdwood }
21668a978234SLiam Girdwood 
21678a978234SLiam Girdwood /* load audio component topology from "firmware" file */
21688a978234SLiam Girdwood int snd_soc_tplg_component_load(struct snd_soc_component *comp,
21698a978234SLiam Girdwood 	struct snd_soc_tplg_ops *ops, const struct firmware *fw, u32 id)
21708a978234SLiam Girdwood {
21718a978234SLiam Girdwood 	struct soc_tplg tplg;
21728a978234SLiam Girdwood 
21738a978234SLiam Girdwood 	/* setup parsing context */
21748a978234SLiam Girdwood 	memset(&tplg, 0, sizeof(tplg));
21758a978234SLiam Girdwood 	tplg.fw = fw;
21768a978234SLiam Girdwood 	tplg.dev = comp->dev;
21778a978234SLiam Girdwood 	tplg.comp = comp;
21788a978234SLiam Girdwood 	tplg.ops = ops;
21798a978234SLiam Girdwood 	tplg.req_index = id;
21808a978234SLiam Girdwood 	tplg.io_ops = ops->io_ops;
21818a978234SLiam Girdwood 	tplg.io_ops_count = ops->io_ops_count;
21821a3232d2SMengdong Lin 	tplg.bytes_ext_ops = ops->bytes_ext_ops;
21831a3232d2SMengdong Lin 	tplg.bytes_ext_ops_count = ops->bytes_ext_ops_count;
21848a978234SLiam Girdwood 
21858a978234SLiam Girdwood 	return soc_tplg_load(&tplg);
21868a978234SLiam Girdwood }
21878a978234SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_tplg_component_load);
21888a978234SLiam Girdwood 
21898a978234SLiam Girdwood /* remove this dynamic widget */
21908a978234SLiam Girdwood void snd_soc_tplg_widget_remove(struct snd_soc_dapm_widget *w)
21918a978234SLiam Girdwood {
21928a978234SLiam Girdwood 	/* make sure we are a widget */
21938a978234SLiam Girdwood 	if (w->dobj.type != SND_SOC_DOBJ_WIDGET)
21948a978234SLiam Girdwood 		return;
21958a978234SLiam Girdwood 
21968a978234SLiam Girdwood 	remove_widget(w->dapm->component, &w->dobj, SOC_TPLG_PASS_WIDGET);
21978a978234SLiam Girdwood }
21988a978234SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_tplg_widget_remove);
21998a978234SLiam Girdwood 
22008a978234SLiam Girdwood /* remove all dynamic widgets from this DAPM context */
22018a978234SLiam Girdwood void snd_soc_tplg_widget_remove_all(struct snd_soc_dapm_context *dapm,
22028a978234SLiam Girdwood 	u32 index)
22038a978234SLiam Girdwood {
22048a978234SLiam Girdwood 	struct snd_soc_dapm_widget *w, *next_w;
22058a978234SLiam Girdwood 
22068a978234SLiam Girdwood 	list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) {
22078a978234SLiam Girdwood 
22088a978234SLiam Girdwood 		/* make sure we are a widget with correct context */
22098a978234SLiam Girdwood 		if (w->dobj.type != SND_SOC_DOBJ_WIDGET || w->dapm != dapm)
22108a978234SLiam Girdwood 			continue;
22118a978234SLiam Girdwood 
22128a978234SLiam Girdwood 		/* match ID */
22138a978234SLiam Girdwood 		if (w->dobj.index != index &&
22148a978234SLiam Girdwood 			w->dobj.index != SND_SOC_TPLG_INDEX_ALL)
22158a978234SLiam Girdwood 			continue;
22168a978234SLiam Girdwood 		/* check and free and dynamic widget kcontrols */
22178a978234SLiam Girdwood 		snd_soc_tplg_widget_remove(w);
2218b97e2698SLars-Peter Clausen 		snd_soc_dapm_free_widget(w);
22198a978234SLiam Girdwood 	}
2220fd589a1bSJyri Sarha 	snd_soc_dapm_reset_cache(dapm);
22218a978234SLiam Girdwood }
22228a978234SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_tplg_widget_remove_all);
22238a978234SLiam Girdwood 
22248a978234SLiam Girdwood /* remove dynamic controls from the component driver */
22258a978234SLiam Girdwood int snd_soc_tplg_component_remove(struct snd_soc_component *comp, u32 index)
22268a978234SLiam Girdwood {
22278a978234SLiam Girdwood 	struct snd_soc_dobj *dobj, *next_dobj;
22288a978234SLiam Girdwood 	int pass = SOC_TPLG_PASS_END;
22298a978234SLiam Girdwood 
22308a978234SLiam Girdwood 	/* process the header types from end to start */
22318a978234SLiam Girdwood 	while (pass >= SOC_TPLG_PASS_START) {
22328a978234SLiam Girdwood 
22338a978234SLiam Girdwood 		/* remove mixer controls */
22348a978234SLiam Girdwood 		list_for_each_entry_safe(dobj, next_dobj, &comp->dobj_list,
22358a978234SLiam Girdwood 			list) {
22368a978234SLiam Girdwood 
22378a978234SLiam Girdwood 			/* match index */
22388a978234SLiam Girdwood 			if (dobj->index != index &&
22398a978234SLiam Girdwood 				dobj->index != SND_SOC_TPLG_INDEX_ALL)
22408a978234SLiam Girdwood 				continue;
22418a978234SLiam Girdwood 
22428a978234SLiam Girdwood 			switch (dobj->type) {
22438a978234SLiam Girdwood 			case SND_SOC_DOBJ_MIXER:
22448a978234SLiam Girdwood 				remove_mixer(comp, dobj, pass);
22458a978234SLiam Girdwood 				break;
22468a978234SLiam Girdwood 			case SND_SOC_DOBJ_ENUM:
22478a978234SLiam Girdwood 				remove_enum(comp, dobj, pass);
22488a978234SLiam Girdwood 				break;
22498a978234SLiam Girdwood 			case SND_SOC_DOBJ_BYTES:
22508a978234SLiam Girdwood 				remove_bytes(comp, dobj, pass);
22518a978234SLiam Girdwood 				break;
22528a978234SLiam Girdwood 			case SND_SOC_DOBJ_WIDGET:
22538a978234SLiam Girdwood 				remove_widget(comp, dobj, pass);
22548a978234SLiam Girdwood 				break;
22558a978234SLiam Girdwood 			case SND_SOC_DOBJ_PCM:
225664527e8aSMengdong Lin 				remove_dai(comp, dobj, pass);
22578a978234SLiam Girdwood 				break;
2258acfc7d46SMengdong Lin 			case SND_SOC_DOBJ_DAI_LINK:
2259acfc7d46SMengdong Lin 				remove_link(comp, dobj, pass);
2260acfc7d46SMengdong Lin 				break;
22618a978234SLiam Girdwood 			default:
22628a978234SLiam Girdwood 				dev_err(comp->dev, "ASoC: invalid component type %d for removal\n",
22638a978234SLiam Girdwood 					dobj->type);
22648a978234SLiam Girdwood 				break;
22658a978234SLiam Girdwood 			}
22668a978234SLiam Girdwood 		}
22678a978234SLiam Girdwood 		pass--;
22688a978234SLiam Girdwood 	}
22698a978234SLiam Girdwood 
22708a978234SLiam Girdwood 	/* let caller know if FW can be freed when no objects are left */
22718a978234SLiam Girdwood 	return !list_empty(&comp->dobj_list);
22728a978234SLiam Girdwood }
22738a978234SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_tplg_component_remove);
2274