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