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> 36*28a87eebSMengdong 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 488a978234SLiam Girdwood #define SOC_TPLG_PASS_GRAPH 4 498a978234SLiam Girdwood #define SOC_TPLG_PASS_PINS 5 508a978234SLiam Girdwood #define SOC_TPLG_PASS_PCM_DAI 6 518a978234SLiam Girdwood 528a978234SLiam Girdwood #define SOC_TPLG_PASS_START SOC_TPLG_PASS_MANIFEST 538a978234SLiam Girdwood #define SOC_TPLG_PASS_END SOC_TPLG_PASS_PCM_DAI 548a978234SLiam Girdwood 558a978234SLiam Girdwood struct soc_tplg { 568a978234SLiam Girdwood const struct firmware *fw; 578a978234SLiam Girdwood 588a978234SLiam Girdwood /* runtime FW parsing */ 598a978234SLiam Girdwood const u8 *pos; /* read postion */ 608a978234SLiam Girdwood const u8 *hdr_pos; /* header position */ 618a978234SLiam Girdwood unsigned int pass; /* pass number */ 628a978234SLiam Girdwood 638a978234SLiam Girdwood /* component caller */ 648a978234SLiam Girdwood struct device *dev; 658a978234SLiam Girdwood struct snd_soc_component *comp; 668a978234SLiam Girdwood u32 index; /* current block index */ 678a978234SLiam Girdwood u32 req_index; /* required index, only loaded/free matching blocks */ 688a978234SLiam Girdwood 698a978234SLiam Girdwood /* kcontrol operations */ 708a978234SLiam Girdwood const struct snd_soc_tplg_kcontrol_ops *io_ops; 718a978234SLiam Girdwood int io_ops_count; 728a978234SLiam Girdwood 738a978234SLiam Girdwood /* optional fw loading callbacks to component drivers */ 748a978234SLiam Girdwood struct snd_soc_tplg_ops *ops; 758a978234SLiam Girdwood }; 768a978234SLiam Girdwood 778a978234SLiam Girdwood static int soc_tplg_process_headers(struct soc_tplg *tplg); 788a978234SLiam Girdwood static void soc_tplg_complete(struct soc_tplg *tplg); 798a978234SLiam Girdwood struct snd_soc_dapm_widget * 808a978234SLiam Girdwood snd_soc_dapm_new_control_unlocked(struct snd_soc_dapm_context *dapm, 818a978234SLiam Girdwood const struct snd_soc_dapm_widget *widget); 828a978234SLiam Girdwood struct snd_soc_dapm_widget * 838a978234SLiam Girdwood snd_soc_dapm_new_control(struct snd_soc_dapm_context *dapm, 848a978234SLiam Girdwood const struct snd_soc_dapm_widget *widget); 858a978234SLiam Girdwood 868a978234SLiam Girdwood /* check we dont overflow the data for this control chunk */ 878a978234SLiam Girdwood static int soc_tplg_check_elem_count(struct soc_tplg *tplg, size_t elem_size, 888a978234SLiam Girdwood unsigned int count, size_t bytes, const char *elem_type) 898a978234SLiam Girdwood { 908a978234SLiam Girdwood const u8 *end = tplg->pos + elem_size * count; 918a978234SLiam Girdwood 928a978234SLiam Girdwood if (end > tplg->fw->data + tplg->fw->size) { 938a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: %s overflow end of data\n", 948a978234SLiam Girdwood elem_type); 958a978234SLiam Girdwood return -EINVAL; 968a978234SLiam Girdwood } 978a978234SLiam Girdwood 988a978234SLiam Girdwood /* check there is enough room in chunk for control. 998a978234SLiam Girdwood extra bytes at the end of control are for vendor data here */ 1008a978234SLiam Girdwood if (elem_size * count > bytes) { 1018a978234SLiam Girdwood dev_err(tplg->dev, 1028a978234SLiam Girdwood "ASoC: %s count %d of size %zu is bigger than chunk %zu\n", 1038a978234SLiam Girdwood elem_type, count, elem_size, bytes); 1048a978234SLiam Girdwood return -EINVAL; 1058a978234SLiam Girdwood } 1068a978234SLiam Girdwood 1078a978234SLiam Girdwood return 0; 1088a978234SLiam Girdwood } 1098a978234SLiam Girdwood 1108a978234SLiam Girdwood static inline int soc_tplg_is_eof(struct soc_tplg *tplg) 1118a978234SLiam Girdwood { 1128a978234SLiam Girdwood const u8 *end = tplg->hdr_pos; 1138a978234SLiam Girdwood 1148a978234SLiam Girdwood if (end >= tplg->fw->data + tplg->fw->size) 1158a978234SLiam Girdwood return 1; 1168a978234SLiam Girdwood return 0; 1178a978234SLiam Girdwood } 1188a978234SLiam Girdwood 1198a978234SLiam Girdwood static inline unsigned long soc_tplg_get_hdr_offset(struct soc_tplg *tplg) 1208a978234SLiam Girdwood { 1218a978234SLiam Girdwood return (unsigned long)(tplg->hdr_pos - tplg->fw->data); 1228a978234SLiam Girdwood } 1238a978234SLiam Girdwood 1248a978234SLiam Girdwood static inline unsigned long soc_tplg_get_offset(struct soc_tplg *tplg) 1258a978234SLiam Girdwood { 1268a978234SLiam Girdwood return (unsigned long)(tplg->pos - tplg->fw->data); 1278a978234SLiam Girdwood } 1288a978234SLiam Girdwood 1298a978234SLiam Girdwood /* mapping of Kcontrol types and associated operations. */ 1308a978234SLiam Girdwood static const struct snd_soc_tplg_kcontrol_ops io_ops[] = { 1318a978234SLiam Girdwood {SND_SOC_TPLG_CTL_VOLSW, snd_soc_get_volsw, 1328a978234SLiam Girdwood snd_soc_put_volsw, snd_soc_info_volsw}, 1338a978234SLiam Girdwood {SND_SOC_TPLG_CTL_VOLSW_SX, snd_soc_get_volsw_sx, 1348a978234SLiam Girdwood snd_soc_put_volsw_sx, NULL}, 1358a978234SLiam Girdwood {SND_SOC_TPLG_CTL_ENUM, snd_soc_get_enum_double, 1368a978234SLiam Girdwood snd_soc_put_enum_double, snd_soc_info_enum_double}, 1378a978234SLiam Girdwood {SND_SOC_TPLG_CTL_ENUM_VALUE, snd_soc_get_enum_double, 1388a978234SLiam Girdwood snd_soc_put_enum_double, NULL}, 1398a978234SLiam Girdwood {SND_SOC_TPLG_CTL_BYTES, snd_soc_bytes_get, 1408a978234SLiam Girdwood snd_soc_bytes_put, snd_soc_bytes_info}, 1418a978234SLiam Girdwood {SND_SOC_TPLG_CTL_RANGE, snd_soc_get_volsw_range, 1428a978234SLiam Girdwood snd_soc_put_volsw_range, snd_soc_info_volsw_range}, 1438a978234SLiam Girdwood {SND_SOC_TPLG_CTL_VOLSW_XR_SX, snd_soc_get_xr_sx, 1448a978234SLiam Girdwood snd_soc_put_xr_sx, snd_soc_info_xr_sx}, 1458a978234SLiam Girdwood {SND_SOC_TPLG_CTL_STROBE, snd_soc_get_strobe, 1468a978234SLiam Girdwood snd_soc_put_strobe, NULL}, 1478a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_CTL_VOLSW, snd_soc_dapm_get_volsw, 1482c57d478SJeeja KP snd_soc_dapm_put_volsw, snd_soc_info_volsw}, 1498a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE, snd_soc_dapm_get_enum_double, 1508a978234SLiam Girdwood snd_soc_dapm_put_enum_double, snd_soc_info_enum_double}, 1518a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT, snd_soc_dapm_get_enum_double, 1528a978234SLiam Girdwood snd_soc_dapm_put_enum_double, NULL}, 1538a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE, snd_soc_dapm_get_enum_double, 1548a978234SLiam Girdwood snd_soc_dapm_put_enum_double, NULL}, 1558a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_CTL_PIN, snd_soc_dapm_get_pin_switch, 1568a978234SLiam Girdwood snd_soc_dapm_put_pin_switch, snd_soc_dapm_info_pin_switch}, 1578a978234SLiam Girdwood }; 1588a978234SLiam Girdwood 1598a978234SLiam Girdwood struct soc_tplg_map { 1608a978234SLiam Girdwood int uid; 1618a978234SLiam Girdwood int kid; 1628a978234SLiam Girdwood }; 1638a978234SLiam Girdwood 1648a978234SLiam Girdwood /* mapping of widget types from UAPI IDs to kernel IDs */ 1658a978234SLiam Girdwood static const struct soc_tplg_map dapm_map[] = { 1668a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_INPUT, snd_soc_dapm_input}, 1678a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_OUTPUT, snd_soc_dapm_output}, 1688a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_MUX, snd_soc_dapm_mux}, 1698a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_MIXER, snd_soc_dapm_mixer}, 1708a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_PGA, snd_soc_dapm_pga}, 1718a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_OUT_DRV, snd_soc_dapm_out_drv}, 1728a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_ADC, snd_soc_dapm_adc}, 1738a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_DAC, snd_soc_dapm_dac}, 1748a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_SWITCH, snd_soc_dapm_switch}, 1758a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_PRE, snd_soc_dapm_pre}, 1768a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_POST, snd_soc_dapm_post}, 1778a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_AIF_IN, snd_soc_dapm_aif_in}, 1788a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_AIF_OUT, snd_soc_dapm_aif_out}, 1798a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_DAI_IN, snd_soc_dapm_dai_in}, 1808a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_DAI_OUT, snd_soc_dapm_dai_out}, 1818a978234SLiam Girdwood {SND_SOC_TPLG_DAPM_DAI_LINK, snd_soc_dapm_dai_link}, 1828a978234SLiam Girdwood }; 1838a978234SLiam Girdwood 1848a978234SLiam Girdwood static int tplc_chan_get_reg(struct soc_tplg *tplg, 1858a978234SLiam Girdwood struct snd_soc_tplg_channel *chan, int map) 1868a978234SLiam Girdwood { 1878a978234SLiam Girdwood int i; 1888a978234SLiam Girdwood 1898a978234SLiam Girdwood for (i = 0; i < SND_SOC_TPLG_MAX_CHAN; i++) { 1908a978234SLiam Girdwood if (chan[i].id == map) 1918a978234SLiam Girdwood return chan[i].reg; 1928a978234SLiam Girdwood } 1938a978234SLiam Girdwood 1948a978234SLiam Girdwood return -EINVAL; 1958a978234SLiam Girdwood } 1968a978234SLiam Girdwood 1978a978234SLiam Girdwood static int tplc_chan_get_shift(struct soc_tplg *tplg, 1988a978234SLiam Girdwood struct snd_soc_tplg_channel *chan, int map) 1998a978234SLiam Girdwood { 2008a978234SLiam Girdwood int i; 2018a978234SLiam Girdwood 2028a978234SLiam Girdwood for (i = 0; i < SND_SOC_TPLG_MAX_CHAN; i++) { 2038a978234SLiam Girdwood if (chan[i].id == map) 2048a978234SLiam Girdwood return chan[i].shift; 2058a978234SLiam Girdwood } 2068a978234SLiam Girdwood 2078a978234SLiam Girdwood return -EINVAL; 2088a978234SLiam Girdwood } 2098a978234SLiam Girdwood 2108a978234SLiam Girdwood static int get_widget_id(int tplg_type) 2118a978234SLiam Girdwood { 2128a978234SLiam Girdwood int i; 2138a978234SLiam Girdwood 2148a978234SLiam Girdwood for (i = 0; i < ARRAY_SIZE(dapm_map); i++) { 2158a978234SLiam Girdwood if (tplg_type == dapm_map[i].uid) 2168a978234SLiam Girdwood return dapm_map[i].kid; 2178a978234SLiam Girdwood } 2188a978234SLiam Girdwood 2198a978234SLiam Girdwood return -EINVAL; 2208a978234SLiam Girdwood } 2218a978234SLiam Girdwood 2228a978234SLiam Girdwood static enum snd_soc_dobj_type get_dobj_mixer_type( 2238a978234SLiam Girdwood struct snd_soc_tplg_ctl_hdr *control_hdr) 2248a978234SLiam Girdwood { 2258a978234SLiam Girdwood if (control_hdr == NULL) 2268a978234SLiam Girdwood return SND_SOC_DOBJ_NONE; 2278a978234SLiam Girdwood 2288a978234SLiam Girdwood switch (control_hdr->ops.info) { 2298a978234SLiam Girdwood case SND_SOC_TPLG_CTL_VOLSW: 2308a978234SLiam Girdwood case SND_SOC_TPLG_CTL_VOLSW_SX: 2318a978234SLiam Girdwood case SND_SOC_TPLG_CTL_VOLSW_XR_SX: 2328a978234SLiam Girdwood case SND_SOC_TPLG_CTL_RANGE: 2338a978234SLiam Girdwood case SND_SOC_TPLG_CTL_STROBE: 2348a978234SLiam Girdwood return SND_SOC_DOBJ_MIXER; 2358a978234SLiam Girdwood case SND_SOC_TPLG_CTL_ENUM: 2368a978234SLiam Girdwood case SND_SOC_TPLG_CTL_ENUM_VALUE: 2378a978234SLiam Girdwood return SND_SOC_DOBJ_ENUM; 2388a978234SLiam Girdwood case SND_SOC_TPLG_CTL_BYTES: 2398a978234SLiam Girdwood return SND_SOC_DOBJ_BYTES; 2408a978234SLiam Girdwood default: 2418a978234SLiam Girdwood return SND_SOC_DOBJ_NONE; 2428a978234SLiam Girdwood } 2438a978234SLiam Girdwood } 2448a978234SLiam Girdwood 2458a978234SLiam Girdwood static enum snd_soc_dobj_type get_dobj_type(struct snd_soc_tplg_hdr *hdr, 2468a978234SLiam Girdwood struct snd_soc_tplg_ctl_hdr *control_hdr) 2478a978234SLiam Girdwood { 2488a978234SLiam Girdwood switch (hdr->type) { 2498a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_MIXER: 2508a978234SLiam Girdwood return get_dobj_mixer_type(control_hdr); 2518a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_DAPM_GRAPH: 2528a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_MANIFEST: 2538a978234SLiam Girdwood return SND_SOC_DOBJ_NONE; 2548a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_DAPM_WIDGET: 2558a978234SLiam Girdwood return SND_SOC_DOBJ_WIDGET; 2568a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_DAI_LINK: 2578a978234SLiam Girdwood return SND_SOC_DOBJ_DAI_LINK; 2588a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_PCM: 2598a978234SLiam Girdwood return SND_SOC_DOBJ_PCM; 2608a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_CODEC_LINK: 2618a978234SLiam Girdwood return SND_SOC_DOBJ_CODEC_LINK; 2628a978234SLiam Girdwood default: 2638a978234SLiam Girdwood return SND_SOC_DOBJ_NONE; 2648a978234SLiam Girdwood } 2658a978234SLiam Girdwood } 2668a978234SLiam Girdwood 2678a978234SLiam Girdwood static inline void soc_bind_err(struct soc_tplg *tplg, 2688a978234SLiam Girdwood struct snd_soc_tplg_ctl_hdr *hdr, int index) 2698a978234SLiam Girdwood { 2708a978234SLiam Girdwood dev_err(tplg->dev, 2718a978234SLiam Girdwood "ASoC: invalid control type (g,p,i) %d:%d:%d index %d at 0x%lx\n", 2728a978234SLiam Girdwood hdr->ops.get, hdr->ops.put, hdr->ops.info, index, 2738a978234SLiam Girdwood soc_tplg_get_offset(tplg)); 2748a978234SLiam Girdwood } 2758a978234SLiam Girdwood 2768a978234SLiam Girdwood static inline void soc_control_err(struct soc_tplg *tplg, 2778a978234SLiam Girdwood struct snd_soc_tplg_ctl_hdr *hdr, const char *name) 2788a978234SLiam Girdwood { 2798a978234SLiam Girdwood dev_err(tplg->dev, 2808a978234SLiam Girdwood "ASoC: no complete mixer IO handler for %s type (g,p,i) %d:%d:%d at 0x%lx\n", 2818a978234SLiam Girdwood name, hdr->ops.get, hdr->ops.put, hdr->ops.info, 2828a978234SLiam Girdwood soc_tplg_get_offset(tplg)); 2838a978234SLiam Girdwood } 2848a978234SLiam Girdwood 2858a978234SLiam Girdwood /* pass vendor data to component driver for processing */ 2868a978234SLiam Girdwood static int soc_tplg_vendor_load_(struct soc_tplg *tplg, 2878a978234SLiam Girdwood struct snd_soc_tplg_hdr *hdr) 2888a978234SLiam Girdwood { 2898a978234SLiam Girdwood int ret = 0; 2908a978234SLiam Girdwood 2918a978234SLiam Girdwood if (tplg->comp && tplg->ops && tplg->ops->vendor_load) 2928a978234SLiam Girdwood ret = tplg->ops->vendor_load(tplg->comp, hdr); 2938a978234SLiam Girdwood else { 2948a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: no vendor load callback for ID %d\n", 2958a978234SLiam Girdwood hdr->vendor_type); 2968a978234SLiam Girdwood return -EINVAL; 2978a978234SLiam Girdwood } 2988a978234SLiam Girdwood 2998a978234SLiam Girdwood if (ret < 0) 3008a978234SLiam Girdwood dev_err(tplg->dev, 3018a978234SLiam Girdwood "ASoC: vendor load failed at hdr offset %ld/0x%lx for type %d:%d\n", 3028a978234SLiam Girdwood soc_tplg_get_hdr_offset(tplg), 3038a978234SLiam Girdwood soc_tplg_get_hdr_offset(tplg), 3048a978234SLiam Girdwood hdr->type, hdr->vendor_type); 3058a978234SLiam Girdwood return ret; 3068a978234SLiam Girdwood } 3078a978234SLiam Girdwood 3088a978234SLiam Girdwood /* pass vendor data to component driver for processing */ 3098a978234SLiam Girdwood static int soc_tplg_vendor_load(struct soc_tplg *tplg, 3108a978234SLiam Girdwood struct snd_soc_tplg_hdr *hdr) 3118a978234SLiam Girdwood { 3128a978234SLiam Girdwood if (tplg->pass != SOC_TPLG_PASS_VENDOR) 3138a978234SLiam Girdwood return 0; 3148a978234SLiam Girdwood 3158a978234SLiam Girdwood return soc_tplg_vendor_load_(tplg, hdr); 3168a978234SLiam Girdwood } 3178a978234SLiam Girdwood 3188a978234SLiam Girdwood /* optionally pass new dynamic widget to component driver. This is mainly for 3198a978234SLiam Girdwood * external widgets where we can assign private data/ops */ 3208a978234SLiam Girdwood static int soc_tplg_widget_load(struct soc_tplg *tplg, 3218a978234SLiam Girdwood struct snd_soc_dapm_widget *w, struct snd_soc_tplg_dapm_widget *tplg_w) 3228a978234SLiam Girdwood { 3238a978234SLiam Girdwood if (tplg->comp && tplg->ops && tplg->ops->widget_load) 3248a978234SLiam Girdwood return tplg->ops->widget_load(tplg->comp, w, tplg_w); 3258a978234SLiam Girdwood 3268a978234SLiam Girdwood return 0; 3278a978234SLiam Girdwood } 3288a978234SLiam Girdwood 3298a978234SLiam Girdwood /* pass dynamic FEs configurations to component driver */ 3308a978234SLiam Girdwood static int soc_tplg_pcm_dai_load(struct soc_tplg *tplg, 3318a978234SLiam Girdwood struct snd_soc_tplg_pcm_dai *pcm_dai, int num_pcm_dai) 3328a978234SLiam Girdwood { 3338a978234SLiam Girdwood if (tplg->comp && tplg->ops && tplg->ops->pcm_dai_load) 3348a978234SLiam Girdwood return tplg->ops->pcm_dai_load(tplg->comp, pcm_dai, num_pcm_dai); 3358a978234SLiam Girdwood 3368a978234SLiam Girdwood return 0; 3378a978234SLiam Girdwood } 3388a978234SLiam Girdwood 3398a978234SLiam Girdwood /* tell the component driver that all firmware has been loaded in this request */ 3408a978234SLiam Girdwood static void soc_tplg_complete(struct soc_tplg *tplg) 3418a978234SLiam Girdwood { 3428a978234SLiam Girdwood if (tplg->comp && tplg->ops && tplg->ops->complete) 3438a978234SLiam Girdwood tplg->ops->complete(tplg->comp); 3448a978234SLiam Girdwood } 3458a978234SLiam Girdwood 3468a978234SLiam Girdwood /* add a dynamic kcontrol */ 3478a978234SLiam Girdwood static int soc_tplg_add_dcontrol(struct snd_card *card, struct device *dev, 3488a978234SLiam Girdwood const struct snd_kcontrol_new *control_new, const char *prefix, 3498a978234SLiam Girdwood void *data, struct snd_kcontrol **kcontrol) 3508a978234SLiam Girdwood { 3518a978234SLiam Girdwood int err; 3528a978234SLiam Girdwood 3538a978234SLiam Girdwood *kcontrol = snd_soc_cnew(control_new, data, control_new->name, prefix); 3548a978234SLiam Girdwood if (*kcontrol == NULL) { 3558a978234SLiam Girdwood dev_err(dev, "ASoC: Failed to create new kcontrol %s\n", 3568a978234SLiam Girdwood control_new->name); 3578a978234SLiam Girdwood return -ENOMEM; 3588a978234SLiam Girdwood } 3598a978234SLiam Girdwood 3608a978234SLiam Girdwood err = snd_ctl_add(card, *kcontrol); 3618a978234SLiam Girdwood if (err < 0) { 3628a978234SLiam Girdwood dev_err(dev, "ASoC: Failed to add %s: %d\n", 3638a978234SLiam Girdwood control_new->name, err); 3648a978234SLiam Girdwood return err; 3658a978234SLiam Girdwood } 3668a978234SLiam Girdwood 3678a978234SLiam Girdwood return 0; 3688a978234SLiam Girdwood } 3698a978234SLiam Girdwood 3708a978234SLiam Girdwood /* add a dynamic kcontrol for component driver */ 3718a978234SLiam Girdwood static int soc_tplg_add_kcontrol(struct soc_tplg *tplg, 3728a978234SLiam Girdwood struct snd_kcontrol_new *k, struct snd_kcontrol **kcontrol) 3738a978234SLiam Girdwood { 3748a978234SLiam Girdwood struct snd_soc_component *comp = tplg->comp; 3758a978234SLiam Girdwood 3768a978234SLiam Girdwood return soc_tplg_add_dcontrol(comp->card->snd_card, 3778a978234SLiam Girdwood comp->dev, k, NULL, comp, kcontrol); 3788a978234SLiam Girdwood } 3798a978234SLiam Girdwood 3808a978234SLiam Girdwood /* remove a mixer kcontrol */ 3818a978234SLiam Girdwood static void remove_mixer(struct snd_soc_component *comp, 3828a978234SLiam Girdwood struct snd_soc_dobj *dobj, int pass) 3838a978234SLiam Girdwood { 3848a978234SLiam Girdwood struct snd_card *card = comp->card->snd_card; 3858a978234SLiam Girdwood struct soc_mixer_control *sm = 3868a978234SLiam Girdwood container_of(dobj, struct soc_mixer_control, dobj); 3878a978234SLiam Girdwood const unsigned int *p = NULL; 3888a978234SLiam Girdwood 3898a978234SLiam Girdwood if (pass != SOC_TPLG_PASS_MIXER) 3908a978234SLiam Girdwood return; 3918a978234SLiam Girdwood 3928a978234SLiam Girdwood if (dobj->ops && dobj->ops->control_unload) 3938a978234SLiam Girdwood dobj->ops->control_unload(comp, dobj); 3948a978234SLiam Girdwood 3958a978234SLiam Girdwood if (sm->dobj.control.kcontrol->tlv.p) 3968a978234SLiam Girdwood p = sm->dobj.control.kcontrol->tlv.p; 3978a978234SLiam Girdwood snd_ctl_remove(card, sm->dobj.control.kcontrol); 3988a978234SLiam Girdwood list_del(&sm->dobj.list); 3998a978234SLiam Girdwood kfree(sm); 4008a978234SLiam Girdwood kfree(p); 4018a978234SLiam Girdwood } 4028a978234SLiam Girdwood 4038a978234SLiam Girdwood /* remove an enum kcontrol */ 4048a978234SLiam Girdwood static void remove_enum(struct snd_soc_component *comp, 4058a978234SLiam Girdwood struct snd_soc_dobj *dobj, int pass) 4068a978234SLiam Girdwood { 4078a978234SLiam Girdwood struct snd_card *card = comp->card->snd_card; 4088a978234SLiam Girdwood struct soc_enum *se = container_of(dobj, struct soc_enum, dobj); 4098a978234SLiam Girdwood int i; 4108a978234SLiam Girdwood 4118a978234SLiam Girdwood if (pass != SOC_TPLG_PASS_MIXER) 4128a978234SLiam Girdwood return; 4138a978234SLiam Girdwood 4148a978234SLiam Girdwood if (dobj->ops && dobj->ops->control_unload) 4158a978234SLiam Girdwood dobj->ops->control_unload(comp, dobj); 4168a978234SLiam Girdwood 4178a978234SLiam Girdwood snd_ctl_remove(card, se->dobj.control.kcontrol); 4188a978234SLiam Girdwood list_del(&se->dobj.list); 4198a978234SLiam Girdwood 4208a978234SLiam Girdwood kfree(se->dobj.control.dvalues); 4218a978234SLiam Girdwood for (i = 0; i < se->items; i++) 4228a978234SLiam Girdwood kfree(se->dobj.control.dtexts[i]); 4238a978234SLiam Girdwood kfree(se); 4248a978234SLiam Girdwood } 4258a978234SLiam Girdwood 4268a978234SLiam Girdwood /* remove a byte kcontrol */ 4278a978234SLiam Girdwood static void remove_bytes(struct snd_soc_component *comp, 4288a978234SLiam Girdwood struct snd_soc_dobj *dobj, int pass) 4298a978234SLiam Girdwood { 4308a978234SLiam Girdwood struct snd_card *card = comp->card->snd_card; 4318a978234SLiam Girdwood struct soc_bytes_ext *sb = 4328a978234SLiam Girdwood container_of(dobj, struct soc_bytes_ext, dobj); 4338a978234SLiam Girdwood 4348a978234SLiam Girdwood if (pass != SOC_TPLG_PASS_MIXER) 4358a978234SLiam Girdwood return; 4368a978234SLiam Girdwood 4378a978234SLiam Girdwood if (dobj->ops && dobj->ops->control_unload) 4388a978234SLiam Girdwood dobj->ops->control_unload(comp, dobj); 4398a978234SLiam Girdwood 4408a978234SLiam Girdwood snd_ctl_remove(card, sb->dobj.control.kcontrol); 4418a978234SLiam Girdwood list_del(&sb->dobj.list); 4428a978234SLiam Girdwood kfree(sb); 4438a978234SLiam Girdwood } 4448a978234SLiam Girdwood 4458a978234SLiam Girdwood /* remove a widget and it's kcontrols - routes must be removed first */ 4468a978234SLiam Girdwood static void remove_widget(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 snd_soc_dapm_widget *w = 4518a978234SLiam Girdwood container_of(dobj, struct snd_soc_dapm_widget, dobj); 4528a978234SLiam Girdwood int i; 4538a978234SLiam Girdwood 4548a978234SLiam Girdwood if (pass != SOC_TPLG_PASS_WIDGET) 4558a978234SLiam Girdwood return; 4568a978234SLiam Girdwood 4578a978234SLiam Girdwood if (dobj->ops && dobj->ops->widget_unload) 4588a978234SLiam Girdwood dobj->ops->widget_unload(comp, dobj); 4598a978234SLiam Girdwood 4608a978234SLiam Girdwood /* 4618a978234SLiam Girdwood * Dynamic Widgets either have 1 enum kcontrol or 1..N mixers. 4628a978234SLiam Girdwood * The enum may either have an array of values or strings. 4638a978234SLiam Girdwood */ 4648a978234SLiam Girdwood if (dobj->widget.kcontrol_enum) { 4658a978234SLiam Girdwood /* enumerated widget mixer */ 4668a978234SLiam Girdwood struct soc_enum *se = 4678a978234SLiam Girdwood (struct soc_enum *)w->kcontrols[0]->private_value; 4688a978234SLiam Girdwood 4698a978234SLiam Girdwood snd_ctl_remove(card, w->kcontrols[0]); 4708a978234SLiam Girdwood 4718a978234SLiam Girdwood kfree(se->dobj.control.dvalues); 4728a978234SLiam Girdwood for (i = 0; i < se->items; i++) 4738a978234SLiam Girdwood kfree(se->dobj.control.dtexts[i]); 4748a978234SLiam Girdwood 4758a978234SLiam Girdwood kfree(se); 4768a978234SLiam Girdwood kfree(w->kcontrol_news); 4778a978234SLiam Girdwood } else { 4788a978234SLiam Girdwood /* non enumerated widget mixer */ 4798a978234SLiam Girdwood for (i = 0; i < w->num_kcontrols; i++) { 4808a978234SLiam Girdwood struct snd_kcontrol *kcontrol = w->kcontrols[i]; 4818a978234SLiam Girdwood struct soc_mixer_control *sm = 4828a978234SLiam Girdwood (struct soc_mixer_control *) kcontrol->private_value; 4838a978234SLiam Girdwood 4848a978234SLiam Girdwood kfree(w->kcontrols[i]->tlv.p); 4858a978234SLiam Girdwood 4868a978234SLiam Girdwood snd_ctl_remove(card, w->kcontrols[i]); 4878a978234SLiam Girdwood kfree(sm); 4888a978234SLiam Girdwood } 4898a978234SLiam Girdwood kfree(w->kcontrol_news); 4908a978234SLiam Girdwood } 4918a978234SLiam Girdwood /* widget w is freed by soc-dapm.c */ 4928a978234SLiam Girdwood } 4938a978234SLiam Girdwood 4948a978234SLiam Girdwood /* remove PCM DAI configurations */ 4958a978234SLiam Girdwood static void remove_pcm_dai(struct snd_soc_component *comp, 4968a978234SLiam Girdwood struct snd_soc_dobj *dobj, int pass) 4978a978234SLiam Girdwood { 4988a978234SLiam Girdwood if (pass != SOC_TPLG_PASS_PCM_DAI) 4998a978234SLiam Girdwood return; 5008a978234SLiam Girdwood 5018a978234SLiam Girdwood if (dobj->ops && dobj->ops->pcm_dai_unload) 5028a978234SLiam Girdwood dobj->ops->pcm_dai_unload(comp, dobj); 5038a978234SLiam Girdwood 5048a978234SLiam Girdwood list_del(&dobj->list); 5058a978234SLiam Girdwood kfree(dobj); 5068a978234SLiam Girdwood } 5078a978234SLiam Girdwood 5088a978234SLiam Girdwood /* bind a kcontrol to it's IO handlers */ 5098a978234SLiam Girdwood static int soc_tplg_kcontrol_bind_io(struct snd_soc_tplg_ctl_hdr *hdr, 5108a978234SLiam Girdwood struct snd_kcontrol_new *k, 5118a978234SLiam Girdwood const struct snd_soc_tplg_kcontrol_ops *ops, int num_ops, 5128a978234SLiam Girdwood const struct snd_soc_tplg_kcontrol_ops *bops, int num_bops) 5138a978234SLiam Girdwood { 5148a978234SLiam Girdwood int i; 5158a978234SLiam Girdwood 5168a978234SLiam Girdwood /* try and map standard kcontrols handler first */ 5178a978234SLiam Girdwood for (i = 0; i < num_ops; i++) { 5188a978234SLiam Girdwood 5198a978234SLiam Girdwood if (ops[i].id == hdr->ops.put) 5208a978234SLiam Girdwood k->put = ops[i].put; 5218a978234SLiam Girdwood if (ops[i].id == hdr->ops.get) 5228a978234SLiam Girdwood k->get = ops[i].get; 5238a978234SLiam Girdwood if (ops[i].id == hdr->ops.info) 5248a978234SLiam Girdwood k->info = ops[i].info; 5258a978234SLiam Girdwood } 5268a978234SLiam Girdwood 5278a978234SLiam Girdwood /* standard handlers found ? */ 5288a978234SLiam Girdwood if (k->put && k->get && k->info) 5298a978234SLiam Girdwood return 0; 5308a978234SLiam Girdwood 5318a978234SLiam Girdwood /* none found so try bespoke handlers */ 5328a978234SLiam Girdwood for (i = 0; i < num_bops; i++) { 5338a978234SLiam Girdwood 5348a978234SLiam Girdwood if (k->put == NULL && bops[i].id == hdr->ops.put) 5358a978234SLiam Girdwood k->put = bops[i].put; 5368a978234SLiam Girdwood if (k->get == NULL && bops[i].id == hdr->ops.get) 5378a978234SLiam Girdwood k->get = bops[i].get; 53854068983SMengdong Lin if (k->info == NULL && bops[i].id == hdr->ops.info) 5398a978234SLiam Girdwood k->info = bops[i].info; 5408a978234SLiam Girdwood } 5418a978234SLiam Girdwood 5428a978234SLiam Girdwood /* bespoke handlers found ? */ 5438a978234SLiam Girdwood if (k->put && k->get && k->info) 5448a978234SLiam Girdwood return 0; 5458a978234SLiam Girdwood 5468a978234SLiam Girdwood /* nothing to bind */ 5478a978234SLiam Girdwood return -EINVAL; 5488a978234SLiam Girdwood } 5498a978234SLiam Girdwood 5508a978234SLiam Girdwood /* bind a widgets to it's evnt handlers */ 5518a978234SLiam Girdwood int snd_soc_tplg_widget_bind_event(struct snd_soc_dapm_widget *w, 5528a978234SLiam Girdwood const struct snd_soc_tplg_widget_events *events, 5538a978234SLiam Girdwood int num_events, u16 event_type) 5548a978234SLiam Girdwood { 5558a978234SLiam Girdwood int i; 5568a978234SLiam Girdwood 5578a978234SLiam Girdwood w->event = NULL; 5588a978234SLiam Girdwood 5598a978234SLiam Girdwood for (i = 0; i < num_events; i++) { 5608a978234SLiam Girdwood if (event_type == events[i].type) { 5618a978234SLiam Girdwood 5628a978234SLiam Girdwood /* found - so assign event */ 5638a978234SLiam Girdwood w->event = events[i].event_handler; 5648a978234SLiam Girdwood return 0; 5658a978234SLiam Girdwood } 5668a978234SLiam Girdwood } 5678a978234SLiam Girdwood 5688a978234SLiam Girdwood /* not found */ 5698a978234SLiam Girdwood return -EINVAL; 5708a978234SLiam Girdwood } 5718a978234SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_tplg_widget_bind_event); 5728a978234SLiam Girdwood 5738a978234SLiam Girdwood /* optionally pass new dynamic kcontrol to component driver. */ 5748a978234SLiam Girdwood static int soc_tplg_init_kcontrol(struct soc_tplg *tplg, 5758a978234SLiam Girdwood struct snd_kcontrol_new *k, struct snd_soc_tplg_ctl_hdr *hdr) 5768a978234SLiam Girdwood { 5778a978234SLiam Girdwood if (tplg->comp && tplg->ops && tplg->ops->control_load) 5788a978234SLiam Girdwood return tplg->ops->control_load(tplg->comp, k, hdr); 5798a978234SLiam Girdwood 5808a978234SLiam Girdwood return 0; 5818a978234SLiam Girdwood } 5828a978234SLiam Girdwood 583*28a87eebSMengdong Lin 584*28a87eebSMengdong Lin static int soc_tplg_create_tlv_db_scale(struct soc_tplg *tplg, 585*28a87eebSMengdong Lin struct snd_kcontrol_new *kc, struct snd_soc_tplg_tlv_dbscale *scale) 5868a978234SLiam Girdwood { 587*28a87eebSMengdong Lin unsigned int item_len = 2 * sizeof(unsigned int); 588*28a87eebSMengdong Lin unsigned int *p; 5898a978234SLiam Girdwood 590*28a87eebSMengdong Lin p = kzalloc(item_len + 2 * sizeof(unsigned int), GFP_KERNEL); 591*28a87eebSMengdong Lin if (!p) 5928a978234SLiam Girdwood return -ENOMEM; 5938a978234SLiam Girdwood 594*28a87eebSMengdong Lin p[0] = SNDRV_CTL_TLVT_DB_SCALE; 595*28a87eebSMengdong Lin p[1] = item_len; 596*28a87eebSMengdong Lin p[2] = scale->min; 597*28a87eebSMengdong Lin p[3] = (scale->step & TLV_DB_SCALE_MASK) 598*28a87eebSMengdong Lin | (scale->mute ? TLV_DB_SCALE_MUTE : 0); 5998a978234SLiam Girdwood 600*28a87eebSMengdong Lin kc->tlv.p = (void *)p; 601*28a87eebSMengdong Lin return 0; 602*28a87eebSMengdong Lin } 603*28a87eebSMengdong Lin 604*28a87eebSMengdong Lin static int soc_tplg_create_tlv(struct soc_tplg *tplg, 605*28a87eebSMengdong Lin struct snd_kcontrol_new *kc, struct snd_soc_tplg_ctl_hdr *tc) 606*28a87eebSMengdong Lin { 607*28a87eebSMengdong Lin struct snd_soc_tplg_ctl_tlv *tplg_tlv; 608*28a87eebSMengdong Lin 609*28a87eebSMengdong Lin if (!(tc->access & SNDRV_CTL_ELEM_ACCESS_TLV_READWRITE)) 610*28a87eebSMengdong Lin return 0; 611*28a87eebSMengdong Lin 612*28a87eebSMengdong Lin if (tc->access & SNDRV_CTL_ELEM_ACCESS_TLV_CALLBACK) { 613*28a87eebSMengdong Lin kc->tlv.c = snd_soc_bytes_tlv_callback; 614*28a87eebSMengdong Lin } else { 615*28a87eebSMengdong Lin tplg_tlv = &tc->tlv; 616*28a87eebSMengdong Lin switch (tplg_tlv->type) { 617*28a87eebSMengdong Lin case SNDRV_CTL_TLVT_DB_SCALE: 618*28a87eebSMengdong Lin return soc_tplg_create_tlv_db_scale(tplg, kc, 619*28a87eebSMengdong Lin &tplg_tlv->scale); 620*28a87eebSMengdong Lin 621*28a87eebSMengdong Lin /* TODO: add support for other TLV types */ 622*28a87eebSMengdong Lin default: 623*28a87eebSMengdong Lin dev_dbg(tplg->dev, "Unsupported TLV type %d\n", 624*28a87eebSMengdong Lin tplg_tlv->type); 625*28a87eebSMengdong Lin return -EINVAL; 626*28a87eebSMengdong Lin } 627*28a87eebSMengdong Lin } 6288a978234SLiam Girdwood 6298a978234SLiam Girdwood return 0; 6308a978234SLiam Girdwood } 6318a978234SLiam Girdwood 6328a978234SLiam Girdwood static inline void soc_tplg_free_tlv(struct soc_tplg *tplg, 6338a978234SLiam Girdwood struct snd_kcontrol_new *kc) 6348a978234SLiam Girdwood { 6358a978234SLiam Girdwood kfree(kc->tlv.p); 6368a978234SLiam Girdwood } 6378a978234SLiam Girdwood 6388a978234SLiam Girdwood static int soc_tplg_dbytes_create(struct soc_tplg *tplg, unsigned int count, 6398a978234SLiam Girdwood size_t size) 6408a978234SLiam Girdwood { 6418a978234SLiam Girdwood struct snd_soc_tplg_bytes_control *be; 6428a978234SLiam Girdwood struct soc_bytes_ext *sbe; 6438a978234SLiam Girdwood struct snd_kcontrol_new kc; 6448a978234SLiam Girdwood int i, err; 6458a978234SLiam Girdwood 6468a978234SLiam Girdwood if (soc_tplg_check_elem_count(tplg, 6478a978234SLiam Girdwood sizeof(struct snd_soc_tplg_bytes_control), count, 6488a978234SLiam Girdwood size, "mixer bytes")) { 6498a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: Invalid count %d for byte control\n", 6508a978234SLiam Girdwood count); 6518a978234SLiam Girdwood return -EINVAL; 6528a978234SLiam Girdwood } 6538a978234SLiam Girdwood 6548a978234SLiam Girdwood for (i = 0; i < count; i++) { 6558a978234SLiam Girdwood be = (struct snd_soc_tplg_bytes_control *)tplg->pos; 6568a978234SLiam Girdwood 6578a978234SLiam Girdwood /* validate kcontrol */ 6588a978234SLiam Girdwood if (strnlen(be->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 6598a978234SLiam Girdwood SNDRV_CTL_ELEM_ID_NAME_MAXLEN) 6608a978234SLiam Girdwood return -EINVAL; 6618a978234SLiam Girdwood 6628a978234SLiam Girdwood sbe = kzalloc(sizeof(*sbe), GFP_KERNEL); 6638a978234SLiam Girdwood if (sbe == NULL) 6648a978234SLiam Girdwood return -ENOMEM; 6658a978234SLiam Girdwood 6668a978234SLiam Girdwood tplg->pos += (sizeof(struct snd_soc_tplg_bytes_control) + 6678a978234SLiam Girdwood be->priv.size); 6688a978234SLiam Girdwood 6698a978234SLiam Girdwood dev_dbg(tplg->dev, 6708a978234SLiam Girdwood "ASoC: adding bytes kcontrol %s with access 0x%x\n", 6718a978234SLiam Girdwood be->hdr.name, be->hdr.access); 6728a978234SLiam Girdwood 6738a978234SLiam Girdwood memset(&kc, 0, sizeof(kc)); 6748a978234SLiam Girdwood kc.name = be->hdr.name; 6758a978234SLiam Girdwood kc.private_value = (long)sbe; 6768a978234SLiam Girdwood kc.iface = SNDRV_CTL_ELEM_IFACE_MIXER; 6778a978234SLiam Girdwood kc.access = be->hdr.access; 6788a978234SLiam Girdwood 6798a978234SLiam Girdwood sbe->max = be->max; 6808a978234SLiam Girdwood sbe->dobj.type = SND_SOC_DOBJ_BYTES; 6818a978234SLiam Girdwood sbe->dobj.ops = tplg->ops; 6828a978234SLiam Girdwood INIT_LIST_HEAD(&sbe->dobj.list); 6838a978234SLiam Girdwood 6848a978234SLiam Girdwood /* map io handlers */ 6858a978234SLiam Girdwood err = soc_tplg_kcontrol_bind_io(&be->hdr, &kc, io_ops, 6868a978234SLiam Girdwood ARRAY_SIZE(io_ops), tplg->io_ops, tplg->io_ops_count); 6878a978234SLiam Girdwood if (err) { 6888a978234SLiam Girdwood soc_control_err(tplg, &be->hdr, be->hdr.name); 6898a978234SLiam Girdwood kfree(sbe); 6908a978234SLiam Girdwood continue; 6918a978234SLiam Girdwood } 6928a978234SLiam Girdwood 6938a978234SLiam Girdwood /* pass control to driver for optional further init */ 6948a978234SLiam Girdwood err = soc_tplg_init_kcontrol(tplg, &kc, 6958a978234SLiam Girdwood (struct snd_soc_tplg_ctl_hdr *)be); 6968a978234SLiam Girdwood if (err < 0) { 6978a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: failed to init %s\n", 6988a978234SLiam Girdwood be->hdr.name); 6998a978234SLiam Girdwood kfree(sbe); 7008a978234SLiam Girdwood continue; 7018a978234SLiam Girdwood } 7028a978234SLiam Girdwood 7038a978234SLiam Girdwood /* register control here */ 7048a978234SLiam Girdwood err = soc_tplg_add_kcontrol(tplg, &kc, 7058a978234SLiam Girdwood &sbe->dobj.control.kcontrol); 7068a978234SLiam Girdwood if (err < 0) { 7078a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: failed to add %s\n", 7088a978234SLiam Girdwood be->hdr.name); 7098a978234SLiam Girdwood kfree(sbe); 7108a978234SLiam Girdwood continue; 7118a978234SLiam Girdwood } 7128a978234SLiam Girdwood 7138a978234SLiam Girdwood list_add(&sbe->dobj.list, &tplg->comp->dobj_list); 7148a978234SLiam Girdwood } 7158a978234SLiam Girdwood return 0; 7168a978234SLiam Girdwood 7178a978234SLiam Girdwood } 7188a978234SLiam Girdwood 7198a978234SLiam Girdwood static int soc_tplg_dmixer_create(struct soc_tplg *tplg, unsigned int count, 7208a978234SLiam Girdwood size_t size) 7218a978234SLiam Girdwood { 7228a978234SLiam Girdwood struct snd_soc_tplg_mixer_control *mc; 7238a978234SLiam Girdwood struct soc_mixer_control *sm; 7248a978234SLiam Girdwood struct snd_kcontrol_new kc; 7258a978234SLiam Girdwood int i, err; 7268a978234SLiam Girdwood 7278a978234SLiam Girdwood if (soc_tplg_check_elem_count(tplg, 7288a978234SLiam Girdwood sizeof(struct snd_soc_tplg_mixer_control), 7298a978234SLiam Girdwood count, size, "mixers")) { 7308a978234SLiam Girdwood 7318a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: invalid count %d for controls\n", 7328a978234SLiam Girdwood count); 7338a978234SLiam Girdwood return -EINVAL; 7348a978234SLiam Girdwood } 7358a978234SLiam Girdwood 7368a978234SLiam Girdwood for (i = 0; i < count; i++) { 7378a978234SLiam Girdwood mc = (struct snd_soc_tplg_mixer_control *)tplg->pos; 7388a978234SLiam Girdwood 7398a978234SLiam Girdwood /* validate kcontrol */ 7408a978234SLiam Girdwood if (strnlen(mc->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 7418a978234SLiam Girdwood SNDRV_CTL_ELEM_ID_NAME_MAXLEN) 7428a978234SLiam Girdwood return -EINVAL; 7438a978234SLiam Girdwood 7448a978234SLiam Girdwood sm = kzalloc(sizeof(*sm), GFP_KERNEL); 7458a978234SLiam Girdwood if (sm == NULL) 7468a978234SLiam Girdwood return -ENOMEM; 7478a978234SLiam Girdwood tplg->pos += (sizeof(struct snd_soc_tplg_mixer_control) + 7488a978234SLiam Girdwood mc->priv.size); 7498a978234SLiam Girdwood 7508a978234SLiam Girdwood dev_dbg(tplg->dev, 7518a978234SLiam Girdwood "ASoC: adding mixer kcontrol %s with access 0x%x\n", 7528a978234SLiam Girdwood mc->hdr.name, mc->hdr.access); 7538a978234SLiam Girdwood 7548a978234SLiam Girdwood memset(&kc, 0, sizeof(kc)); 7558a978234SLiam Girdwood kc.name = mc->hdr.name; 7568a978234SLiam Girdwood kc.private_value = (long)sm; 7578a978234SLiam Girdwood kc.iface = SNDRV_CTL_ELEM_IFACE_MIXER; 7588a978234SLiam Girdwood kc.access = mc->hdr.access; 7598a978234SLiam Girdwood 7608a978234SLiam Girdwood /* we only support FL/FR channel mapping atm */ 7618a978234SLiam Girdwood sm->reg = tplc_chan_get_reg(tplg, mc->channel, 7628a978234SLiam Girdwood SNDRV_CHMAP_FL); 7638a978234SLiam Girdwood sm->rreg = tplc_chan_get_reg(tplg, mc->channel, 7648a978234SLiam Girdwood SNDRV_CHMAP_FR); 7658a978234SLiam Girdwood sm->shift = tplc_chan_get_shift(tplg, mc->channel, 7668a978234SLiam Girdwood SNDRV_CHMAP_FL); 7678a978234SLiam Girdwood sm->rshift = tplc_chan_get_shift(tplg, mc->channel, 7688a978234SLiam Girdwood SNDRV_CHMAP_FR); 7698a978234SLiam Girdwood 7708a978234SLiam Girdwood sm->max = mc->max; 7718a978234SLiam Girdwood sm->min = mc->min; 7728a978234SLiam Girdwood sm->invert = mc->invert; 7738a978234SLiam Girdwood sm->platform_max = mc->platform_max; 7748a978234SLiam Girdwood sm->dobj.index = tplg->index; 7758a978234SLiam Girdwood sm->dobj.ops = tplg->ops; 7768a978234SLiam Girdwood sm->dobj.type = SND_SOC_DOBJ_MIXER; 7778a978234SLiam Girdwood INIT_LIST_HEAD(&sm->dobj.list); 7788a978234SLiam Girdwood 7798a978234SLiam Girdwood /* map io handlers */ 7808a978234SLiam Girdwood err = soc_tplg_kcontrol_bind_io(&mc->hdr, &kc, io_ops, 7818a978234SLiam Girdwood ARRAY_SIZE(io_ops), tplg->io_ops, tplg->io_ops_count); 7828a978234SLiam Girdwood if (err) { 7838a978234SLiam Girdwood soc_control_err(tplg, &mc->hdr, mc->hdr.name); 7848a978234SLiam Girdwood kfree(sm); 7858a978234SLiam Girdwood continue; 7868a978234SLiam Girdwood } 7878a978234SLiam Girdwood 7888a978234SLiam Girdwood /* pass control to driver for optional further init */ 7898a978234SLiam Girdwood err = soc_tplg_init_kcontrol(tplg, &kc, 7908a978234SLiam Girdwood (struct snd_soc_tplg_ctl_hdr *) mc); 7918a978234SLiam Girdwood if (err < 0) { 7928a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: failed to init %s\n", 7938a978234SLiam Girdwood mc->hdr.name); 7948a978234SLiam Girdwood kfree(sm); 7958a978234SLiam Girdwood continue; 7968a978234SLiam Girdwood } 7978a978234SLiam Girdwood 7988a978234SLiam Girdwood /* create any TLV data */ 799*28a87eebSMengdong Lin soc_tplg_create_tlv(tplg, &kc, &mc->hdr); 8008a978234SLiam Girdwood 8018a978234SLiam Girdwood /* register control here */ 8028a978234SLiam Girdwood err = soc_tplg_add_kcontrol(tplg, &kc, 8038a978234SLiam Girdwood &sm->dobj.control.kcontrol); 8048a978234SLiam Girdwood if (err < 0) { 8058a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: failed to add %s\n", 8068a978234SLiam Girdwood mc->hdr.name); 8078a978234SLiam Girdwood soc_tplg_free_tlv(tplg, &kc); 8088a978234SLiam Girdwood kfree(sm); 8098a978234SLiam Girdwood continue; 8108a978234SLiam Girdwood } 8118a978234SLiam Girdwood 8128a978234SLiam Girdwood list_add(&sm->dobj.list, &tplg->comp->dobj_list); 8138a978234SLiam Girdwood } 8148a978234SLiam Girdwood 8158a978234SLiam Girdwood return 0; 8168a978234SLiam Girdwood } 8178a978234SLiam Girdwood 8188a978234SLiam Girdwood static int soc_tplg_denum_create_texts(struct soc_enum *se, 8198a978234SLiam Girdwood struct snd_soc_tplg_enum_control *ec) 8208a978234SLiam Girdwood { 8218a978234SLiam Girdwood int i, ret; 8228a978234SLiam Girdwood 8238a978234SLiam Girdwood se->dobj.control.dtexts = 8248a978234SLiam Girdwood kzalloc(sizeof(char *) * ec->items, GFP_KERNEL); 8258a978234SLiam Girdwood if (se->dobj.control.dtexts == NULL) 8268a978234SLiam Girdwood return -ENOMEM; 8278a978234SLiam Girdwood 8288a978234SLiam Girdwood for (i = 0; i < ec->items; i++) { 8298a978234SLiam Girdwood 8308a978234SLiam Girdwood if (strnlen(ec->texts[i], SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 8318a978234SLiam Girdwood SNDRV_CTL_ELEM_ID_NAME_MAXLEN) { 8328a978234SLiam Girdwood ret = -EINVAL; 8338a978234SLiam Girdwood goto err; 8348a978234SLiam Girdwood } 8358a978234SLiam Girdwood 8368a978234SLiam Girdwood se->dobj.control.dtexts[i] = kstrdup(ec->texts[i], GFP_KERNEL); 8378a978234SLiam Girdwood if (!se->dobj.control.dtexts[i]) { 8388a978234SLiam Girdwood ret = -ENOMEM; 8398a978234SLiam Girdwood goto err; 8408a978234SLiam Girdwood } 8418a978234SLiam Girdwood } 8428a978234SLiam Girdwood 8438a978234SLiam Girdwood return 0; 8448a978234SLiam Girdwood 8458a978234SLiam Girdwood err: 8468a978234SLiam Girdwood for (--i; i >= 0; i--) 8478a978234SLiam Girdwood kfree(se->dobj.control.dtexts[i]); 8488a978234SLiam Girdwood kfree(se->dobj.control.dtexts); 8498a978234SLiam Girdwood return ret; 8508a978234SLiam Girdwood } 8518a978234SLiam Girdwood 8528a978234SLiam Girdwood static int soc_tplg_denum_create_values(struct soc_enum *se, 8538a978234SLiam Girdwood struct snd_soc_tplg_enum_control *ec) 8548a978234SLiam Girdwood { 8558a978234SLiam Girdwood if (ec->items > sizeof(*ec->values)) 8568a978234SLiam Girdwood return -EINVAL; 8578a978234SLiam Girdwood 8588a978234SLiam Girdwood se->dobj.control.dvalues = 8598a978234SLiam Girdwood kmalloc(ec->items * sizeof(u32), GFP_KERNEL); 8608a978234SLiam Girdwood if (!se->dobj.control.dvalues) 8618a978234SLiam Girdwood return -ENOMEM; 8628a978234SLiam Girdwood 8638a978234SLiam Girdwood memcpy(se->dobj.control.dvalues, ec->values, ec->items * sizeof(u32)); 8648a978234SLiam Girdwood return 0; 8658a978234SLiam Girdwood } 8668a978234SLiam Girdwood 8678a978234SLiam Girdwood static int soc_tplg_denum_create(struct soc_tplg *tplg, unsigned int count, 8688a978234SLiam Girdwood size_t size) 8698a978234SLiam Girdwood { 8708a978234SLiam Girdwood struct snd_soc_tplg_enum_control *ec; 8718a978234SLiam Girdwood struct soc_enum *se; 8728a978234SLiam Girdwood struct snd_kcontrol_new kc; 8738a978234SLiam Girdwood int i, ret, err; 8748a978234SLiam Girdwood 8758a978234SLiam Girdwood if (soc_tplg_check_elem_count(tplg, 8768a978234SLiam Girdwood sizeof(struct snd_soc_tplg_enum_control), 8778a978234SLiam Girdwood count, size, "enums")) { 8788a978234SLiam Girdwood 8798a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: invalid count %d for enum controls\n", 8808a978234SLiam Girdwood count); 8818a978234SLiam Girdwood return -EINVAL; 8828a978234SLiam Girdwood } 8838a978234SLiam Girdwood 8848a978234SLiam Girdwood for (i = 0; i < count; i++) { 8858a978234SLiam Girdwood ec = (struct snd_soc_tplg_enum_control *)tplg->pos; 8868a978234SLiam Girdwood tplg->pos += (sizeof(struct snd_soc_tplg_enum_control) + 8878a978234SLiam Girdwood ec->priv.size); 8888a978234SLiam Girdwood 8898a978234SLiam Girdwood /* validate kcontrol */ 8908a978234SLiam Girdwood if (strnlen(ec->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 8918a978234SLiam Girdwood SNDRV_CTL_ELEM_ID_NAME_MAXLEN) 8928a978234SLiam Girdwood return -EINVAL; 8938a978234SLiam Girdwood 8948a978234SLiam Girdwood se = kzalloc((sizeof(*se)), GFP_KERNEL); 8958a978234SLiam Girdwood if (se == NULL) 8968a978234SLiam Girdwood return -ENOMEM; 8978a978234SLiam Girdwood 8988a978234SLiam Girdwood dev_dbg(tplg->dev, "ASoC: adding enum kcontrol %s size %d\n", 8998a978234SLiam Girdwood ec->hdr.name, ec->items); 9008a978234SLiam Girdwood 9018a978234SLiam Girdwood memset(&kc, 0, sizeof(kc)); 9028a978234SLiam Girdwood kc.name = ec->hdr.name; 9038a978234SLiam Girdwood kc.private_value = (long)se; 9048a978234SLiam Girdwood kc.iface = SNDRV_CTL_ELEM_IFACE_MIXER; 9058a978234SLiam Girdwood kc.access = ec->hdr.access; 9068a978234SLiam Girdwood 9078a978234SLiam Girdwood se->reg = tplc_chan_get_reg(tplg, ec->channel, SNDRV_CHMAP_FL); 9088a978234SLiam Girdwood se->shift_l = tplc_chan_get_shift(tplg, ec->channel, 9098a978234SLiam Girdwood SNDRV_CHMAP_FL); 9108a978234SLiam Girdwood se->shift_r = tplc_chan_get_shift(tplg, ec->channel, 9118a978234SLiam Girdwood SNDRV_CHMAP_FL); 9128a978234SLiam Girdwood 9138a978234SLiam Girdwood se->items = ec->items; 9148a978234SLiam Girdwood se->mask = ec->mask; 9158a978234SLiam Girdwood se->dobj.index = tplg->index; 9168a978234SLiam Girdwood se->dobj.type = SND_SOC_DOBJ_ENUM; 9178a978234SLiam Girdwood se->dobj.ops = tplg->ops; 9188a978234SLiam Girdwood INIT_LIST_HEAD(&se->dobj.list); 9198a978234SLiam Girdwood 9208a978234SLiam Girdwood switch (ec->hdr.ops.info) { 9218a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE: 9228a978234SLiam Girdwood case SND_SOC_TPLG_CTL_ENUM_VALUE: 9238a978234SLiam Girdwood err = soc_tplg_denum_create_values(se, ec); 9248a978234SLiam Girdwood if (err < 0) { 9258a978234SLiam Girdwood dev_err(tplg->dev, 9268a978234SLiam Girdwood "ASoC: could not create values for %s\n", 9278a978234SLiam Girdwood ec->hdr.name); 9288a978234SLiam Girdwood kfree(se); 9298a978234SLiam Girdwood continue; 9308a978234SLiam Girdwood } 9318a978234SLiam Girdwood /* fall through and create texts */ 9328a978234SLiam Girdwood case SND_SOC_TPLG_CTL_ENUM: 9338a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE: 9348a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT: 9358a978234SLiam Girdwood err = soc_tplg_denum_create_texts(se, ec); 9368a978234SLiam Girdwood if (err < 0) { 9378a978234SLiam Girdwood dev_err(tplg->dev, 9388a978234SLiam Girdwood "ASoC: could not create texts for %s\n", 9398a978234SLiam Girdwood ec->hdr.name); 9408a978234SLiam Girdwood kfree(se); 9418a978234SLiam Girdwood continue; 9428a978234SLiam Girdwood } 9438a978234SLiam Girdwood break; 9448a978234SLiam Girdwood default: 9458a978234SLiam Girdwood dev_err(tplg->dev, 9468a978234SLiam Girdwood "ASoC: invalid enum control type %d for %s\n", 9478a978234SLiam Girdwood ec->hdr.ops.info, ec->hdr.name); 9488a978234SLiam Girdwood kfree(se); 9498a978234SLiam Girdwood continue; 9508a978234SLiam Girdwood } 9518a978234SLiam Girdwood 9528a978234SLiam Girdwood /* map io handlers */ 9538a978234SLiam Girdwood err = soc_tplg_kcontrol_bind_io(&ec->hdr, &kc, io_ops, 9548a978234SLiam Girdwood ARRAY_SIZE(io_ops), tplg->io_ops, tplg->io_ops_count); 9558a978234SLiam Girdwood if (err) { 9568a978234SLiam Girdwood soc_control_err(tplg, &ec->hdr, ec->hdr.name); 9578a978234SLiam Girdwood kfree(se); 9588a978234SLiam Girdwood continue; 9598a978234SLiam Girdwood } 9608a978234SLiam Girdwood 9618a978234SLiam Girdwood /* pass control to driver for optional further init */ 9628a978234SLiam Girdwood err = soc_tplg_init_kcontrol(tplg, &kc, 9638a978234SLiam Girdwood (struct snd_soc_tplg_ctl_hdr *) ec); 9648a978234SLiam Girdwood if (err < 0) { 9658a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: failed to init %s\n", 9668a978234SLiam Girdwood ec->hdr.name); 9678a978234SLiam Girdwood kfree(se); 9688a978234SLiam Girdwood continue; 9698a978234SLiam Girdwood } 9708a978234SLiam Girdwood 9718a978234SLiam Girdwood /* register control here */ 9728a978234SLiam Girdwood ret = soc_tplg_add_kcontrol(tplg, 9738a978234SLiam Girdwood &kc, &se->dobj.control.kcontrol); 9748a978234SLiam Girdwood if (ret < 0) { 9758a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: could not add kcontrol %s\n", 9768a978234SLiam Girdwood ec->hdr.name); 9778a978234SLiam Girdwood kfree(se); 9788a978234SLiam Girdwood continue; 9798a978234SLiam Girdwood } 9808a978234SLiam Girdwood 9818a978234SLiam Girdwood list_add(&se->dobj.list, &tplg->comp->dobj_list); 9828a978234SLiam Girdwood } 9838a978234SLiam Girdwood 9848a978234SLiam Girdwood return 0; 9858a978234SLiam Girdwood } 9868a978234SLiam Girdwood 9878a978234SLiam Girdwood static int soc_tplg_kcontrol_elems_load(struct soc_tplg *tplg, 9888a978234SLiam Girdwood struct snd_soc_tplg_hdr *hdr) 9898a978234SLiam Girdwood { 9908a978234SLiam Girdwood struct snd_soc_tplg_ctl_hdr *control_hdr; 9918a978234SLiam Girdwood int i; 9928a978234SLiam Girdwood 9938a978234SLiam Girdwood if (tplg->pass != SOC_TPLG_PASS_MIXER) { 9948a978234SLiam Girdwood tplg->pos += hdr->size + hdr->payload_size; 9958a978234SLiam Girdwood return 0; 9968a978234SLiam Girdwood } 9978a978234SLiam Girdwood 9988a978234SLiam Girdwood dev_dbg(tplg->dev, "ASoC: adding %d kcontrols at 0x%lx\n", hdr->count, 9998a978234SLiam Girdwood soc_tplg_get_offset(tplg)); 10008a978234SLiam Girdwood 10018a978234SLiam Girdwood for (i = 0; i < hdr->count; i++) { 10028a978234SLiam Girdwood 10038a978234SLiam Girdwood control_hdr = (struct snd_soc_tplg_ctl_hdr *)tplg->pos; 10048a978234SLiam Girdwood 10058a978234SLiam Girdwood switch (control_hdr->ops.info) { 10068a978234SLiam Girdwood case SND_SOC_TPLG_CTL_VOLSW: 10078a978234SLiam Girdwood case SND_SOC_TPLG_CTL_STROBE: 10088a978234SLiam Girdwood case SND_SOC_TPLG_CTL_VOLSW_SX: 10098a978234SLiam Girdwood case SND_SOC_TPLG_CTL_VOLSW_XR_SX: 10108a978234SLiam Girdwood case SND_SOC_TPLG_CTL_RANGE: 10118a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_VOLSW: 10128a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_PIN: 10138a978234SLiam Girdwood soc_tplg_dmixer_create(tplg, 1, hdr->payload_size); 10148a978234SLiam Girdwood break; 10158a978234SLiam Girdwood case SND_SOC_TPLG_CTL_ENUM: 10168a978234SLiam Girdwood case SND_SOC_TPLG_CTL_ENUM_VALUE: 10178a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE: 10188a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT: 10198a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE: 10208a978234SLiam Girdwood soc_tplg_denum_create(tplg, 1, hdr->payload_size); 10218a978234SLiam Girdwood break; 10228a978234SLiam Girdwood case SND_SOC_TPLG_CTL_BYTES: 10238a978234SLiam Girdwood soc_tplg_dbytes_create(tplg, 1, hdr->payload_size); 10248a978234SLiam Girdwood break; 10258a978234SLiam Girdwood default: 10268a978234SLiam Girdwood soc_bind_err(tplg, control_hdr, i); 10278a978234SLiam Girdwood return -EINVAL; 10288a978234SLiam Girdwood } 10298a978234SLiam Girdwood } 10308a978234SLiam Girdwood 10318a978234SLiam Girdwood return 0; 10328a978234SLiam Girdwood } 10338a978234SLiam Girdwood 10348a978234SLiam Girdwood static int soc_tplg_dapm_graph_elems_load(struct soc_tplg *tplg, 10358a978234SLiam Girdwood struct snd_soc_tplg_hdr *hdr) 10368a978234SLiam Girdwood { 10378a978234SLiam Girdwood struct snd_soc_dapm_context *dapm = &tplg->comp->dapm; 10388a978234SLiam Girdwood struct snd_soc_dapm_route route; 10398a978234SLiam Girdwood struct snd_soc_tplg_dapm_graph_elem *elem; 10408a978234SLiam Girdwood int count = hdr->count, i; 10418a978234SLiam Girdwood 10428a978234SLiam Girdwood if (tplg->pass != SOC_TPLG_PASS_GRAPH) { 10438a978234SLiam Girdwood tplg->pos += hdr->size + hdr->payload_size; 10448a978234SLiam Girdwood return 0; 10458a978234SLiam Girdwood } 10468a978234SLiam Girdwood 10478a978234SLiam Girdwood if (soc_tplg_check_elem_count(tplg, 10488a978234SLiam Girdwood sizeof(struct snd_soc_tplg_dapm_graph_elem), 10498a978234SLiam Girdwood count, hdr->payload_size, "graph")) { 10508a978234SLiam Girdwood 10518a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: invalid count %d for DAPM routes\n", 10528a978234SLiam Girdwood count); 10538a978234SLiam Girdwood return -EINVAL; 10548a978234SLiam Girdwood } 10558a978234SLiam Girdwood 10568a978234SLiam Girdwood dev_dbg(tplg->dev, "ASoC: adding %d DAPM routes\n", count); 10578a978234SLiam Girdwood 10588a978234SLiam Girdwood for (i = 0; i < count; i++) { 10598a978234SLiam Girdwood elem = (struct snd_soc_tplg_dapm_graph_elem *)tplg->pos; 10608a978234SLiam Girdwood tplg->pos += sizeof(struct snd_soc_tplg_dapm_graph_elem); 10618a978234SLiam Girdwood 10628a978234SLiam Girdwood /* validate routes */ 10638a978234SLiam Girdwood if (strnlen(elem->source, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 10648a978234SLiam Girdwood SNDRV_CTL_ELEM_ID_NAME_MAXLEN) 10658a978234SLiam Girdwood return -EINVAL; 10668a978234SLiam Girdwood if (strnlen(elem->sink, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 10678a978234SLiam Girdwood SNDRV_CTL_ELEM_ID_NAME_MAXLEN) 10688a978234SLiam Girdwood return -EINVAL; 10698a978234SLiam Girdwood if (strnlen(elem->control, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 10708a978234SLiam Girdwood SNDRV_CTL_ELEM_ID_NAME_MAXLEN) 10718a978234SLiam Girdwood return -EINVAL; 10728a978234SLiam Girdwood 10738a978234SLiam Girdwood route.source = elem->source; 10748a978234SLiam Girdwood route.sink = elem->sink; 10758a978234SLiam Girdwood route.connected = NULL; /* set to NULL atm for tplg users */ 10768a978234SLiam Girdwood if (strnlen(elem->control, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 0) 10778a978234SLiam Girdwood route.control = NULL; 10788a978234SLiam Girdwood else 10798a978234SLiam Girdwood route.control = elem->control; 10808a978234SLiam Girdwood 10818a978234SLiam Girdwood /* add route, but keep going if some fail */ 10828a978234SLiam Girdwood snd_soc_dapm_add_routes(dapm, &route, 1); 10838a978234SLiam Girdwood } 10848a978234SLiam Girdwood 10858a978234SLiam Girdwood return 0; 10868a978234SLiam Girdwood } 10878a978234SLiam Girdwood 10888a978234SLiam Girdwood static struct snd_kcontrol_new *soc_tplg_dapm_widget_dmixer_create( 10898a978234SLiam Girdwood struct soc_tplg *tplg, int num_kcontrols) 10908a978234SLiam Girdwood { 10918a978234SLiam Girdwood struct snd_kcontrol_new *kc; 10928a978234SLiam Girdwood struct soc_mixer_control *sm; 10938a978234SLiam Girdwood struct snd_soc_tplg_mixer_control *mc; 10948a978234SLiam Girdwood int i, err; 10958a978234SLiam Girdwood 10968a978234SLiam Girdwood kc = kzalloc(sizeof(*kc) * num_kcontrols, GFP_KERNEL); 10978a978234SLiam Girdwood if (kc == NULL) 10988a978234SLiam Girdwood return NULL; 10998a978234SLiam Girdwood 11008a978234SLiam Girdwood for (i = 0; i < num_kcontrols; i++) { 11018a978234SLiam Girdwood mc = (struct snd_soc_tplg_mixer_control *)tplg->pos; 11028a978234SLiam Girdwood sm = kzalloc(sizeof(*sm), GFP_KERNEL); 11038a978234SLiam Girdwood if (sm == NULL) 11048a978234SLiam Girdwood goto err; 11058a978234SLiam Girdwood 11068a978234SLiam Girdwood tplg->pos += (sizeof(struct snd_soc_tplg_mixer_control) + 11078a978234SLiam Girdwood mc->priv.size); 11088a978234SLiam Girdwood 11098a978234SLiam Girdwood /* validate kcontrol */ 11108a978234SLiam Girdwood if (strnlen(mc->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 11118a978234SLiam Girdwood SNDRV_CTL_ELEM_ID_NAME_MAXLEN) 11128a978234SLiam Girdwood goto err_str; 11138a978234SLiam Girdwood 11148a978234SLiam Girdwood dev_dbg(tplg->dev, " adding DAPM widget mixer control %s at %d\n", 11158a978234SLiam Girdwood mc->hdr.name, i); 11168a978234SLiam Girdwood 11178a978234SLiam Girdwood kc[i].name = mc->hdr.name; 11188a978234SLiam Girdwood kc[i].private_value = (long)sm; 11198a978234SLiam Girdwood kc[i].iface = SNDRV_CTL_ELEM_IFACE_MIXER; 11208a978234SLiam Girdwood kc[i].access = mc->hdr.access; 11218a978234SLiam Girdwood 11228a978234SLiam Girdwood /* we only support FL/FR channel mapping atm */ 11238a978234SLiam Girdwood sm->reg = tplc_chan_get_reg(tplg, mc->channel, 11248a978234SLiam Girdwood SNDRV_CHMAP_FL); 11258a978234SLiam Girdwood sm->rreg = tplc_chan_get_reg(tplg, mc->channel, 11268a978234SLiam Girdwood SNDRV_CHMAP_FR); 11278a978234SLiam Girdwood sm->shift = tplc_chan_get_shift(tplg, mc->channel, 11288a978234SLiam Girdwood SNDRV_CHMAP_FL); 11298a978234SLiam Girdwood sm->rshift = tplc_chan_get_shift(tplg, mc->channel, 11308a978234SLiam Girdwood SNDRV_CHMAP_FR); 11318a978234SLiam Girdwood 11328a978234SLiam Girdwood sm->max = mc->max; 11338a978234SLiam Girdwood sm->min = mc->min; 11348a978234SLiam Girdwood sm->invert = mc->invert; 11358a978234SLiam Girdwood sm->platform_max = mc->platform_max; 11368a978234SLiam Girdwood sm->dobj.index = tplg->index; 11378a978234SLiam Girdwood INIT_LIST_HEAD(&sm->dobj.list); 11388a978234SLiam Girdwood 11398a978234SLiam Girdwood /* map io handlers */ 11408a978234SLiam Girdwood err = soc_tplg_kcontrol_bind_io(&mc->hdr, &kc[i], io_ops, 11418a978234SLiam Girdwood ARRAY_SIZE(io_ops), tplg->io_ops, tplg->io_ops_count); 11428a978234SLiam Girdwood if (err) { 11438a978234SLiam Girdwood soc_control_err(tplg, &mc->hdr, mc->hdr.name); 11448a978234SLiam Girdwood kfree(sm); 11458a978234SLiam Girdwood continue; 11468a978234SLiam Girdwood } 11478a978234SLiam Girdwood 11488a978234SLiam Girdwood /* pass control to driver for optional further init */ 11498a978234SLiam Girdwood err = soc_tplg_init_kcontrol(tplg, &kc[i], 11508a978234SLiam Girdwood (struct snd_soc_tplg_ctl_hdr *)mc); 11518a978234SLiam Girdwood if (err < 0) { 11528a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: failed to init %s\n", 11538a978234SLiam Girdwood mc->hdr.name); 11548a978234SLiam Girdwood kfree(sm); 11558a978234SLiam Girdwood continue; 11568a978234SLiam Girdwood } 11578a978234SLiam Girdwood } 11588a978234SLiam Girdwood return kc; 11598a978234SLiam Girdwood 11608a978234SLiam Girdwood err_str: 11618a978234SLiam Girdwood kfree(sm); 11628a978234SLiam Girdwood err: 11638a978234SLiam Girdwood for (--i; i >= 0; i--) 11648a978234SLiam Girdwood kfree((void *)kc[i].private_value); 11658a978234SLiam Girdwood kfree(kc); 11668a978234SLiam Girdwood return NULL; 11678a978234SLiam Girdwood } 11688a978234SLiam Girdwood 11698a978234SLiam Girdwood static struct snd_kcontrol_new *soc_tplg_dapm_widget_denum_create( 11708a978234SLiam Girdwood struct soc_tplg *tplg) 11718a978234SLiam Girdwood { 11728a978234SLiam Girdwood struct snd_kcontrol_new *kc; 11738a978234SLiam Girdwood struct snd_soc_tplg_enum_control *ec; 11748a978234SLiam Girdwood struct soc_enum *se; 11758a978234SLiam Girdwood int i, err; 11768a978234SLiam Girdwood 11778a978234SLiam Girdwood ec = (struct snd_soc_tplg_enum_control *)tplg->pos; 11788a978234SLiam Girdwood tplg->pos += (sizeof(struct snd_soc_tplg_enum_control) + 11798a978234SLiam Girdwood ec->priv.size); 11808a978234SLiam Girdwood 11818a978234SLiam Girdwood /* validate kcontrol */ 11828a978234SLiam Girdwood if (strnlen(ec->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 11838a978234SLiam Girdwood SNDRV_CTL_ELEM_ID_NAME_MAXLEN) 11848a978234SLiam Girdwood return NULL; 11858a978234SLiam Girdwood 11868a978234SLiam Girdwood kc = kzalloc(sizeof(*kc), GFP_KERNEL); 11878a978234SLiam Girdwood if (kc == NULL) 11888a978234SLiam Girdwood return NULL; 11898a978234SLiam Girdwood 11908a978234SLiam Girdwood se = kzalloc(sizeof(*se), GFP_KERNEL); 11918a978234SLiam Girdwood if (se == NULL) 11928a978234SLiam Girdwood goto err; 11938a978234SLiam Girdwood 11948a978234SLiam Girdwood dev_dbg(tplg->dev, " adding DAPM widget enum control %s\n", 11958a978234SLiam Girdwood ec->hdr.name); 11968a978234SLiam Girdwood 11978a978234SLiam Girdwood kc->name = ec->hdr.name; 11988a978234SLiam Girdwood kc->private_value = (long)se; 11998a978234SLiam Girdwood kc->iface = SNDRV_CTL_ELEM_IFACE_MIXER; 12008a978234SLiam Girdwood kc->access = ec->hdr.access; 12018a978234SLiam Girdwood 12028a978234SLiam Girdwood /* we only support FL/FR channel mapping atm */ 12038a978234SLiam Girdwood se->reg = tplc_chan_get_reg(tplg, ec->channel, SNDRV_CHMAP_FL); 12048a978234SLiam Girdwood se->shift_l = tplc_chan_get_shift(tplg, ec->channel, SNDRV_CHMAP_FL); 12058a978234SLiam Girdwood se->shift_r = tplc_chan_get_shift(tplg, ec->channel, SNDRV_CHMAP_FR); 12068a978234SLiam Girdwood 12078a978234SLiam Girdwood se->items = ec->items; 12088a978234SLiam Girdwood se->mask = ec->mask; 12098a978234SLiam Girdwood se->dobj.index = tplg->index; 12108a978234SLiam Girdwood 12118a978234SLiam Girdwood switch (ec->hdr.ops.info) { 12128a978234SLiam Girdwood case SND_SOC_TPLG_CTL_ENUM_VALUE: 12138a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE: 12148a978234SLiam Girdwood err = soc_tplg_denum_create_values(se, ec); 12158a978234SLiam Girdwood if (err < 0) { 12168a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: could not create values for %s\n", 12178a978234SLiam Girdwood ec->hdr.name); 12188a978234SLiam Girdwood goto err_se; 12198a978234SLiam Girdwood } 12208a978234SLiam Girdwood /* fall through to create texts */ 12218a978234SLiam Girdwood case SND_SOC_TPLG_CTL_ENUM: 12228a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE: 12238a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT: 12248a978234SLiam Girdwood err = soc_tplg_denum_create_texts(se, ec); 12258a978234SLiam Girdwood if (err < 0) { 12268a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: could not create texts for %s\n", 12278a978234SLiam Girdwood ec->hdr.name); 12288a978234SLiam Girdwood goto err_se; 12298a978234SLiam Girdwood } 12308a978234SLiam Girdwood break; 12318a978234SLiam Girdwood default: 12328a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: invalid enum control type %d for %s\n", 12338a978234SLiam Girdwood ec->hdr.ops.info, ec->hdr.name); 12348a978234SLiam Girdwood goto err_se; 12358a978234SLiam Girdwood } 12368a978234SLiam Girdwood 12378a978234SLiam Girdwood /* map io handlers */ 12388a978234SLiam Girdwood err = soc_tplg_kcontrol_bind_io(&ec->hdr, kc, io_ops, 12398a978234SLiam Girdwood ARRAY_SIZE(io_ops), tplg->io_ops, tplg->io_ops_count); 12408a978234SLiam Girdwood if (err) { 12418a978234SLiam Girdwood soc_control_err(tplg, &ec->hdr, ec->hdr.name); 12428a978234SLiam Girdwood goto err_se; 12438a978234SLiam Girdwood } 12448a978234SLiam Girdwood 12458a978234SLiam Girdwood /* pass control to driver for optional further init */ 12468a978234SLiam Girdwood err = soc_tplg_init_kcontrol(tplg, kc, 12478a978234SLiam Girdwood (struct snd_soc_tplg_ctl_hdr *)ec); 12488a978234SLiam Girdwood if (err < 0) { 12498a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: failed to init %s\n", 12508a978234SLiam Girdwood ec->hdr.name); 12518a978234SLiam Girdwood goto err_se; 12528a978234SLiam Girdwood } 12538a978234SLiam Girdwood 12548a978234SLiam Girdwood return kc; 12558a978234SLiam Girdwood 12568a978234SLiam Girdwood err_se: 12578a978234SLiam Girdwood /* free values and texts */ 12588a978234SLiam Girdwood kfree(se->dobj.control.dvalues); 12598a978234SLiam Girdwood for (i = 0; i < ec->items; i++) 12608a978234SLiam Girdwood kfree(se->dobj.control.dtexts[i]); 12618a978234SLiam Girdwood 12628a978234SLiam Girdwood kfree(se); 12638a978234SLiam Girdwood err: 12648a978234SLiam Girdwood kfree(kc); 12658a978234SLiam Girdwood 12668a978234SLiam Girdwood return NULL; 12678a978234SLiam Girdwood } 12688a978234SLiam Girdwood 12698a978234SLiam Girdwood static struct snd_kcontrol_new *soc_tplg_dapm_widget_dbytes_create( 12708a978234SLiam Girdwood struct soc_tplg *tplg, int count) 12718a978234SLiam Girdwood { 12728a978234SLiam Girdwood struct snd_soc_tplg_bytes_control *be; 12738a978234SLiam Girdwood struct soc_bytes_ext *sbe; 12748a978234SLiam Girdwood struct snd_kcontrol_new *kc; 12758a978234SLiam Girdwood int i, err; 12768a978234SLiam Girdwood 12778a978234SLiam Girdwood kc = kzalloc(sizeof(*kc) * count, GFP_KERNEL); 12788a978234SLiam Girdwood if (!kc) 12798a978234SLiam Girdwood return NULL; 12808a978234SLiam Girdwood 12818a978234SLiam Girdwood for (i = 0; i < count; i++) { 12828a978234SLiam Girdwood be = (struct snd_soc_tplg_bytes_control *)tplg->pos; 12838a978234SLiam Girdwood 12848a978234SLiam Girdwood /* validate kcontrol */ 12858a978234SLiam Girdwood if (strnlen(be->hdr.name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 12868a978234SLiam Girdwood SNDRV_CTL_ELEM_ID_NAME_MAXLEN) 12878a978234SLiam Girdwood goto err; 12888a978234SLiam Girdwood 12898a978234SLiam Girdwood sbe = kzalloc(sizeof(*sbe), GFP_KERNEL); 12908a978234SLiam Girdwood if (sbe == NULL) 12918a978234SLiam Girdwood goto err; 12928a978234SLiam Girdwood 12938a978234SLiam Girdwood tplg->pos += (sizeof(struct snd_soc_tplg_bytes_control) + 12948a978234SLiam Girdwood be->priv.size); 12958a978234SLiam Girdwood 12968a978234SLiam Girdwood dev_dbg(tplg->dev, 12978a978234SLiam Girdwood "ASoC: adding bytes kcontrol %s with access 0x%x\n", 12988a978234SLiam Girdwood be->hdr.name, be->hdr.access); 12998a978234SLiam Girdwood 13008a978234SLiam Girdwood memset(kc, 0, sizeof(*kc)); 13018a978234SLiam Girdwood kc[i].name = be->hdr.name; 13028a978234SLiam Girdwood kc[i].private_value = (long)sbe; 13038a978234SLiam Girdwood kc[i].iface = SNDRV_CTL_ELEM_IFACE_MIXER; 13048a978234SLiam Girdwood kc[i].access = be->hdr.access; 13058a978234SLiam Girdwood 13068a978234SLiam Girdwood sbe->max = be->max; 13078a978234SLiam Girdwood INIT_LIST_HEAD(&sbe->dobj.list); 13088a978234SLiam Girdwood 13098a978234SLiam Girdwood /* map standard io handlers and check for external handlers */ 13108a978234SLiam Girdwood err = soc_tplg_kcontrol_bind_io(&be->hdr, &kc[i], io_ops, 13118a978234SLiam Girdwood ARRAY_SIZE(io_ops), tplg->io_ops, 13128a978234SLiam Girdwood tplg->io_ops_count); 13138a978234SLiam Girdwood if (err) { 13148a978234SLiam Girdwood soc_control_err(tplg, &be->hdr, be->hdr.name); 13158a978234SLiam Girdwood kfree(sbe); 13168a978234SLiam Girdwood continue; 13178a978234SLiam Girdwood } 13188a978234SLiam Girdwood 13198a978234SLiam Girdwood /* pass control to driver for optional further init */ 13208a978234SLiam Girdwood err = soc_tplg_init_kcontrol(tplg, &kc[i], 13218a978234SLiam Girdwood (struct snd_soc_tplg_ctl_hdr *)be); 13228a978234SLiam Girdwood if (err < 0) { 13238a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: failed to init %s\n", 13248a978234SLiam Girdwood be->hdr.name); 13258a978234SLiam Girdwood kfree(sbe); 13268a978234SLiam Girdwood continue; 13278a978234SLiam Girdwood } 13288a978234SLiam Girdwood } 13298a978234SLiam Girdwood 13308a978234SLiam Girdwood return kc; 13318a978234SLiam Girdwood 13328a978234SLiam Girdwood err: 13338a978234SLiam Girdwood for (--i; i >= 0; i--) 13348a978234SLiam Girdwood kfree((void *)kc[i].private_value); 13358a978234SLiam Girdwood 13368a978234SLiam Girdwood kfree(kc); 13378a978234SLiam Girdwood return NULL; 13388a978234SLiam Girdwood } 13398a978234SLiam Girdwood 13408a978234SLiam Girdwood static int soc_tplg_dapm_widget_create(struct soc_tplg *tplg, 13418a978234SLiam Girdwood struct snd_soc_tplg_dapm_widget *w) 13428a978234SLiam Girdwood { 13438a978234SLiam Girdwood struct snd_soc_dapm_context *dapm = &tplg->comp->dapm; 13448a978234SLiam Girdwood struct snd_soc_dapm_widget template, *widget; 13458a978234SLiam Girdwood struct snd_soc_tplg_ctl_hdr *control_hdr; 13468a978234SLiam Girdwood struct snd_soc_card *card = tplg->comp->card; 13478a978234SLiam Girdwood int ret = 0; 13488a978234SLiam Girdwood 13498a978234SLiam Girdwood if (strnlen(w->name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 13508a978234SLiam Girdwood SNDRV_CTL_ELEM_ID_NAME_MAXLEN) 13518a978234SLiam Girdwood return -EINVAL; 13528a978234SLiam Girdwood if (strnlen(w->sname, SNDRV_CTL_ELEM_ID_NAME_MAXLEN) == 13538a978234SLiam Girdwood SNDRV_CTL_ELEM_ID_NAME_MAXLEN) 13548a978234SLiam Girdwood return -EINVAL; 13558a978234SLiam Girdwood 13568a978234SLiam Girdwood dev_dbg(tplg->dev, "ASoC: creating DAPM widget %s id %d\n", 13578a978234SLiam Girdwood w->name, w->id); 13588a978234SLiam Girdwood 13598a978234SLiam Girdwood memset(&template, 0, sizeof(template)); 13608a978234SLiam Girdwood 13618a978234SLiam Girdwood /* map user to kernel widget ID */ 13628a978234SLiam Girdwood template.id = get_widget_id(w->id); 13638a978234SLiam Girdwood if (template.id < 0) 13648a978234SLiam Girdwood return template.id; 13658a978234SLiam Girdwood 13668a978234SLiam Girdwood template.name = kstrdup(w->name, GFP_KERNEL); 13678a978234SLiam Girdwood if (!template.name) 13688a978234SLiam Girdwood return -ENOMEM; 13698a978234SLiam Girdwood template.sname = kstrdup(w->sname, GFP_KERNEL); 13708a978234SLiam Girdwood if (!template.sname) { 13718a978234SLiam Girdwood ret = -ENOMEM; 13728a978234SLiam Girdwood goto err; 13738a978234SLiam Girdwood } 13748a978234SLiam Girdwood template.reg = w->reg; 13758a978234SLiam Girdwood template.shift = w->shift; 13768a978234SLiam Girdwood template.mask = w->mask; 13776dc6db79SSubhransu S. Prusty template.subseq = w->subseq; 13788a978234SLiam Girdwood template.on_val = w->invert ? 0 : 1; 13798a978234SLiam Girdwood template.off_val = w->invert ? 1 : 0; 13808a978234SLiam Girdwood template.ignore_suspend = w->ignore_suspend; 13818a978234SLiam Girdwood template.event_flags = w->event_flags; 13828a978234SLiam Girdwood template.dobj.index = tplg->index; 13838a978234SLiam Girdwood 13848a978234SLiam Girdwood tplg->pos += 13858a978234SLiam Girdwood (sizeof(struct snd_soc_tplg_dapm_widget) + w->priv.size); 13868a978234SLiam Girdwood if (w->num_kcontrols == 0) { 13878a978234SLiam Girdwood template.num_kcontrols = 0; 13888a978234SLiam Girdwood goto widget; 13898a978234SLiam Girdwood } 13908a978234SLiam Girdwood 13918a978234SLiam Girdwood control_hdr = (struct snd_soc_tplg_ctl_hdr *)tplg->pos; 13928a978234SLiam Girdwood dev_dbg(tplg->dev, "ASoC: template %s has %d controls of type %x\n", 13938a978234SLiam Girdwood w->name, w->num_kcontrols, control_hdr->type); 13948a978234SLiam Girdwood 13958a978234SLiam Girdwood switch (control_hdr->ops.info) { 13968a978234SLiam Girdwood case SND_SOC_TPLG_CTL_VOLSW: 13978a978234SLiam Girdwood case SND_SOC_TPLG_CTL_STROBE: 13988a978234SLiam Girdwood case SND_SOC_TPLG_CTL_VOLSW_SX: 13998a978234SLiam Girdwood case SND_SOC_TPLG_CTL_VOLSW_XR_SX: 14008a978234SLiam Girdwood case SND_SOC_TPLG_CTL_RANGE: 14018a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_VOLSW: 14028a978234SLiam Girdwood template.num_kcontrols = w->num_kcontrols; 14038a978234SLiam Girdwood template.kcontrol_news = 14048a978234SLiam Girdwood soc_tplg_dapm_widget_dmixer_create(tplg, 14058a978234SLiam Girdwood template.num_kcontrols); 14068a978234SLiam Girdwood if (!template.kcontrol_news) { 14078a978234SLiam Girdwood ret = -ENOMEM; 14088a978234SLiam Girdwood goto hdr_err; 14098a978234SLiam Girdwood } 14108a978234SLiam Girdwood break; 14118a978234SLiam Girdwood case SND_SOC_TPLG_CTL_ENUM: 14128a978234SLiam Girdwood case SND_SOC_TPLG_CTL_ENUM_VALUE: 14138a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE: 14148a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT: 14158a978234SLiam Girdwood case SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE: 14168a978234SLiam Girdwood template.dobj.widget.kcontrol_enum = 1; 14178a978234SLiam Girdwood template.num_kcontrols = 1; 14188a978234SLiam Girdwood template.kcontrol_news = 14198a978234SLiam Girdwood soc_tplg_dapm_widget_denum_create(tplg); 14208a978234SLiam Girdwood if (!template.kcontrol_news) { 14218a978234SLiam Girdwood ret = -ENOMEM; 14228a978234SLiam Girdwood goto hdr_err; 14238a978234SLiam Girdwood } 14248a978234SLiam Girdwood break; 14258a978234SLiam Girdwood case SND_SOC_TPLG_CTL_BYTES: 14268a978234SLiam Girdwood template.num_kcontrols = w->num_kcontrols; 14278a978234SLiam Girdwood template.kcontrol_news = 14288a978234SLiam Girdwood soc_tplg_dapm_widget_dbytes_create(tplg, 14298a978234SLiam Girdwood template.num_kcontrols); 14308a978234SLiam Girdwood if (!template.kcontrol_news) { 14318a978234SLiam Girdwood ret = -ENOMEM; 14328a978234SLiam Girdwood goto hdr_err; 14338a978234SLiam Girdwood } 14348a978234SLiam Girdwood break; 14358a978234SLiam Girdwood default: 14368a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: invalid widget control type %d:%d:%d\n", 14378a978234SLiam Girdwood control_hdr->ops.get, control_hdr->ops.put, 14388a978234SLiam Girdwood control_hdr->ops.info); 14398a978234SLiam Girdwood ret = -EINVAL; 14408a978234SLiam Girdwood goto hdr_err; 14418a978234SLiam Girdwood } 14428a978234SLiam Girdwood 14438a978234SLiam Girdwood widget: 14448a978234SLiam Girdwood ret = soc_tplg_widget_load(tplg, &template, w); 14458a978234SLiam Girdwood if (ret < 0) 14468a978234SLiam Girdwood goto hdr_err; 14478a978234SLiam Girdwood 14488a978234SLiam Girdwood /* card dapm mutex is held by the core if we are loading topology 14498a978234SLiam Girdwood * data during sound card init. */ 14508a978234SLiam Girdwood if (card->instantiated) 14518a978234SLiam Girdwood widget = snd_soc_dapm_new_control(dapm, &template); 14528a978234SLiam Girdwood else 14538a978234SLiam Girdwood widget = snd_soc_dapm_new_control_unlocked(dapm, &template); 14548a978234SLiam Girdwood if (widget == NULL) { 14558a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: failed to create widget %s controls\n", 14568a978234SLiam Girdwood w->name); 14578a978234SLiam Girdwood goto hdr_err; 14588a978234SLiam Girdwood } 14598a978234SLiam Girdwood 14608a978234SLiam Girdwood widget->dobj.type = SND_SOC_DOBJ_WIDGET; 14618a978234SLiam Girdwood widget->dobj.ops = tplg->ops; 14628a978234SLiam Girdwood widget->dobj.index = tplg->index; 14638a978234SLiam Girdwood list_add(&widget->dobj.list, &tplg->comp->dobj_list); 14648a978234SLiam Girdwood return 0; 14658a978234SLiam Girdwood 14668a978234SLiam Girdwood hdr_err: 14678a978234SLiam Girdwood kfree(template.sname); 14688a978234SLiam Girdwood err: 14698a978234SLiam Girdwood kfree(template.name); 14708a978234SLiam Girdwood return ret; 14718a978234SLiam Girdwood } 14728a978234SLiam Girdwood 14738a978234SLiam Girdwood static int soc_tplg_dapm_widget_elems_load(struct soc_tplg *tplg, 14748a978234SLiam Girdwood struct snd_soc_tplg_hdr *hdr) 14758a978234SLiam Girdwood { 14768a978234SLiam Girdwood struct snd_soc_tplg_dapm_widget *widget; 14778a978234SLiam Girdwood int ret, count = hdr->count, i; 14788a978234SLiam Girdwood 14798a978234SLiam Girdwood if (tplg->pass != SOC_TPLG_PASS_WIDGET) 14808a978234SLiam Girdwood return 0; 14818a978234SLiam Girdwood 14828a978234SLiam Girdwood dev_dbg(tplg->dev, "ASoC: adding %d DAPM widgets\n", count); 14838a978234SLiam Girdwood 14848a978234SLiam Girdwood for (i = 0; i < count; i++) { 14858a978234SLiam Girdwood widget = (struct snd_soc_tplg_dapm_widget *) tplg->pos; 14868a978234SLiam Girdwood ret = soc_tplg_dapm_widget_create(tplg, widget); 14878a978234SLiam Girdwood if (ret < 0) 14888a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: failed to load widget %s\n", 14898a978234SLiam Girdwood widget->name); 14908a978234SLiam Girdwood } 14918a978234SLiam Girdwood 14928a978234SLiam Girdwood return 0; 14938a978234SLiam Girdwood } 14948a978234SLiam Girdwood 14958a978234SLiam Girdwood static int soc_tplg_dapm_complete(struct soc_tplg *tplg) 14968a978234SLiam Girdwood { 14978a978234SLiam Girdwood struct snd_soc_card *card = tplg->comp->card; 14988a978234SLiam Girdwood int ret; 14998a978234SLiam Girdwood 15008a978234SLiam Girdwood /* Card might not have been registered at this point. 15018a978234SLiam Girdwood * If so, just return success. 15028a978234SLiam Girdwood */ 15038a978234SLiam Girdwood if (!card || !card->instantiated) { 15048a978234SLiam Girdwood dev_warn(tplg->dev, "ASoC: Parent card not yet available," 15058a978234SLiam Girdwood "Do not add new widgets now\n"); 15068a978234SLiam Girdwood return 0; 15078a978234SLiam Girdwood } 15088a978234SLiam Girdwood 15098a978234SLiam Girdwood ret = snd_soc_dapm_new_widgets(card); 15108a978234SLiam Girdwood if (ret < 0) 15118a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: failed to create new widgets %d\n", 15128a978234SLiam Girdwood ret); 15138a978234SLiam Girdwood 15148a978234SLiam Girdwood return 0; 15158a978234SLiam Girdwood } 15168a978234SLiam Girdwood 15178a978234SLiam Girdwood static int soc_tplg_pcm_dai_elems_load(struct soc_tplg *tplg, 15188a978234SLiam Girdwood struct snd_soc_tplg_hdr *hdr) 15198a978234SLiam Girdwood { 15208a978234SLiam Girdwood struct snd_soc_tplg_pcm_dai *pcm_dai; 15218a978234SLiam Girdwood struct snd_soc_dobj *dobj; 15228a978234SLiam Girdwood int count = hdr->count; 15238a978234SLiam Girdwood int ret; 15248a978234SLiam Girdwood 15258a978234SLiam Girdwood if (tplg->pass != SOC_TPLG_PASS_PCM_DAI) 15268a978234SLiam Girdwood return 0; 15278a978234SLiam Girdwood 15288a978234SLiam Girdwood pcm_dai = (struct snd_soc_tplg_pcm_dai *)tplg->pos; 15298a978234SLiam Girdwood 15308a978234SLiam Girdwood if (soc_tplg_check_elem_count(tplg, 15318a978234SLiam Girdwood sizeof(struct snd_soc_tplg_pcm_dai), count, 15328a978234SLiam Girdwood hdr->payload_size, "PCM DAI")) { 15338a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: invalid count %d for PCM DAI elems\n", 15348a978234SLiam Girdwood count); 15358a978234SLiam Girdwood return -EINVAL; 15368a978234SLiam Girdwood } 15378a978234SLiam Girdwood 15388a978234SLiam Girdwood dev_dbg(tplg->dev, "ASoC: adding %d PCM DAIs\n", count); 15398a978234SLiam Girdwood tplg->pos += sizeof(struct snd_soc_tplg_pcm_dai) * count; 15408a978234SLiam Girdwood 15418a978234SLiam Girdwood dobj = kzalloc(sizeof(struct snd_soc_dobj), GFP_KERNEL); 15428a978234SLiam Girdwood if (dobj == NULL) 15438a978234SLiam Girdwood return -ENOMEM; 15448a978234SLiam Girdwood 15458a978234SLiam Girdwood /* Call the platform driver call back to register the dais */ 15468a978234SLiam Girdwood ret = soc_tplg_pcm_dai_load(tplg, pcm_dai, count); 15478a978234SLiam Girdwood if (ret < 0) { 15488a978234SLiam Girdwood dev_err(tplg->comp->dev, "ASoC: PCM DAI loading failed\n"); 15498a978234SLiam Girdwood goto err; 15508a978234SLiam Girdwood } 15518a978234SLiam Girdwood 15528a978234SLiam Girdwood dobj->type = get_dobj_type(hdr, NULL); 15538a978234SLiam Girdwood dobj->pcm_dai.count = count; 15548a978234SLiam Girdwood dobj->pcm_dai.pd = pcm_dai; 15558a978234SLiam Girdwood dobj->ops = tplg->ops; 15568a978234SLiam Girdwood dobj->index = tplg->index; 15578a978234SLiam Girdwood list_add(&dobj->list, &tplg->comp->dobj_list); 15588a978234SLiam Girdwood return 0; 15598a978234SLiam Girdwood 15608a978234SLiam Girdwood err: 15618a978234SLiam Girdwood kfree(dobj); 15628a978234SLiam Girdwood return ret; 15638a978234SLiam Girdwood } 15648a978234SLiam Girdwood 15658a978234SLiam Girdwood static int soc_tplg_manifest_load(struct soc_tplg *tplg, 15668a978234SLiam Girdwood struct snd_soc_tplg_hdr *hdr) 15678a978234SLiam Girdwood { 15688a978234SLiam Girdwood struct snd_soc_tplg_manifest *manifest; 15698a978234SLiam Girdwood 15708a978234SLiam Girdwood if (tplg->pass != SOC_TPLG_PASS_MANIFEST) 15718a978234SLiam Girdwood return 0; 15728a978234SLiam Girdwood 15738a978234SLiam Girdwood manifest = (struct snd_soc_tplg_manifest *)tplg->pos; 15748a978234SLiam Girdwood tplg->pos += sizeof(struct snd_soc_tplg_manifest); 15758a978234SLiam Girdwood 15768a978234SLiam Girdwood if (tplg->comp && tplg->ops && tplg->ops->manifest) 15778a978234SLiam Girdwood return tplg->ops->manifest(tplg->comp, manifest); 15788a978234SLiam Girdwood 15798a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: Firmware manifest not supported\n"); 15808a978234SLiam Girdwood return 0; 15818a978234SLiam Girdwood } 15828a978234SLiam Girdwood 15838a978234SLiam Girdwood /* validate header magic, size and type */ 15848a978234SLiam Girdwood static int soc_valid_header(struct soc_tplg *tplg, 15858a978234SLiam Girdwood struct snd_soc_tplg_hdr *hdr) 15868a978234SLiam Girdwood { 15878a978234SLiam Girdwood if (soc_tplg_get_hdr_offset(tplg) >= tplg->fw->size) 15888a978234SLiam Girdwood return 0; 15898a978234SLiam Girdwood 15908a978234SLiam Girdwood /* big endian firmware objects not supported atm */ 15918a978234SLiam Girdwood if (hdr->magic == cpu_to_be32(SND_SOC_TPLG_MAGIC)) { 15928a978234SLiam Girdwood dev_err(tplg->dev, 15938a978234SLiam Girdwood "ASoC: pass %d big endian not supported header got %x at offset 0x%lx size 0x%zx.\n", 15948a978234SLiam Girdwood tplg->pass, hdr->magic, 15958a978234SLiam Girdwood soc_tplg_get_hdr_offset(tplg), tplg->fw->size); 15968a978234SLiam Girdwood return -EINVAL; 15978a978234SLiam Girdwood } 15988a978234SLiam Girdwood 15998a978234SLiam Girdwood if (hdr->magic != SND_SOC_TPLG_MAGIC) { 16008a978234SLiam Girdwood dev_err(tplg->dev, 16018a978234SLiam Girdwood "ASoC: pass %d does not have a valid header got %x at offset 0x%lx size 0x%zx.\n", 16028a978234SLiam Girdwood tplg->pass, hdr->magic, 16038a978234SLiam Girdwood soc_tplg_get_hdr_offset(tplg), tplg->fw->size); 16048a978234SLiam Girdwood return -EINVAL; 16058a978234SLiam Girdwood } 16068a978234SLiam Girdwood 16078a978234SLiam Girdwood if (hdr->abi != SND_SOC_TPLG_ABI_VERSION) { 16088a978234SLiam Girdwood dev_err(tplg->dev, 16098a978234SLiam Girdwood "ASoC: pass %d invalid ABI version got 0x%x need 0x%x at offset 0x%lx size 0x%zx.\n", 16108a978234SLiam Girdwood tplg->pass, hdr->abi, 16118a978234SLiam Girdwood SND_SOC_TPLG_ABI_VERSION, soc_tplg_get_hdr_offset(tplg), 16128a978234SLiam Girdwood tplg->fw->size); 16138a978234SLiam Girdwood return -EINVAL; 16148a978234SLiam Girdwood } 16158a978234SLiam Girdwood 16168a978234SLiam Girdwood if (hdr->payload_size == 0) { 16178a978234SLiam Girdwood dev_err(tplg->dev, "ASoC: header has 0 size at offset 0x%lx.\n", 16188a978234SLiam Girdwood soc_tplg_get_hdr_offset(tplg)); 16198a978234SLiam Girdwood return -EINVAL; 16208a978234SLiam Girdwood } 16218a978234SLiam Girdwood 16228a978234SLiam Girdwood if (tplg->pass == hdr->type) 16238a978234SLiam Girdwood dev_dbg(tplg->dev, 16248a978234SLiam Girdwood "ASoC: Got 0x%x bytes of type %d version %d vendor %d at pass %d\n", 16258a978234SLiam Girdwood hdr->payload_size, hdr->type, hdr->version, 16268a978234SLiam Girdwood hdr->vendor_type, tplg->pass); 16278a978234SLiam Girdwood 16288a978234SLiam Girdwood return 1; 16298a978234SLiam Girdwood } 16308a978234SLiam Girdwood 16318a978234SLiam Girdwood /* check header type and call appropriate handler */ 16328a978234SLiam Girdwood static int soc_tplg_load_header(struct soc_tplg *tplg, 16338a978234SLiam Girdwood struct snd_soc_tplg_hdr *hdr) 16348a978234SLiam Girdwood { 16358a978234SLiam Girdwood tplg->pos = tplg->hdr_pos + sizeof(struct snd_soc_tplg_hdr); 16368a978234SLiam Girdwood 16378a978234SLiam Girdwood /* check for matching ID */ 16388a978234SLiam Girdwood if (hdr->index != tplg->req_index && 16398a978234SLiam Girdwood hdr->index != SND_SOC_TPLG_INDEX_ALL) 16408a978234SLiam Girdwood return 0; 16418a978234SLiam Girdwood 16428a978234SLiam Girdwood tplg->index = hdr->index; 16438a978234SLiam Girdwood 16448a978234SLiam Girdwood switch (hdr->type) { 16458a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_MIXER: 16468a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_ENUM: 16478a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_BYTES: 16488a978234SLiam Girdwood return soc_tplg_kcontrol_elems_load(tplg, hdr); 16498a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_DAPM_GRAPH: 16508a978234SLiam Girdwood return soc_tplg_dapm_graph_elems_load(tplg, hdr); 16518a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_DAPM_WIDGET: 16528a978234SLiam Girdwood return soc_tplg_dapm_widget_elems_load(tplg, hdr); 16538a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_PCM: 16548a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_DAI_LINK: 16558a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_CODEC_LINK: 16568a978234SLiam Girdwood return soc_tplg_pcm_dai_elems_load(tplg, hdr); 16578a978234SLiam Girdwood case SND_SOC_TPLG_TYPE_MANIFEST: 16588a978234SLiam Girdwood return soc_tplg_manifest_load(tplg, hdr); 16598a978234SLiam Girdwood default: 16608a978234SLiam Girdwood /* bespoke vendor data object */ 16618a978234SLiam Girdwood return soc_tplg_vendor_load(tplg, hdr); 16628a978234SLiam Girdwood } 16638a978234SLiam Girdwood 16648a978234SLiam Girdwood return 0; 16658a978234SLiam Girdwood } 16668a978234SLiam Girdwood 16678a978234SLiam Girdwood /* process the topology file headers */ 16688a978234SLiam Girdwood static int soc_tplg_process_headers(struct soc_tplg *tplg) 16698a978234SLiam Girdwood { 16708a978234SLiam Girdwood struct snd_soc_tplg_hdr *hdr; 16718a978234SLiam Girdwood int ret; 16728a978234SLiam Girdwood 16738a978234SLiam Girdwood tplg->pass = SOC_TPLG_PASS_START; 16748a978234SLiam Girdwood 16758a978234SLiam Girdwood /* process the header types from start to end */ 16768a978234SLiam Girdwood while (tplg->pass <= SOC_TPLG_PASS_END) { 16778a978234SLiam Girdwood 16788a978234SLiam Girdwood tplg->hdr_pos = tplg->fw->data; 16798a978234SLiam Girdwood hdr = (struct snd_soc_tplg_hdr *)tplg->hdr_pos; 16808a978234SLiam Girdwood 16818a978234SLiam Girdwood while (!soc_tplg_is_eof(tplg)) { 16828a978234SLiam Girdwood 16838a978234SLiam Girdwood /* make sure header is valid before loading */ 16848a978234SLiam Girdwood ret = soc_valid_header(tplg, hdr); 16858a978234SLiam Girdwood if (ret < 0) 16868a978234SLiam Girdwood return ret; 16878a978234SLiam Girdwood else if (ret == 0) 16888a978234SLiam Girdwood break; 16898a978234SLiam Girdwood 16908a978234SLiam Girdwood /* load the header object */ 16918a978234SLiam Girdwood ret = soc_tplg_load_header(tplg, hdr); 16928a978234SLiam Girdwood if (ret < 0) 16938a978234SLiam Girdwood return ret; 16948a978234SLiam Girdwood 16958a978234SLiam Girdwood /* goto next header */ 16968a978234SLiam Girdwood tplg->hdr_pos += hdr->payload_size + 16978a978234SLiam Girdwood sizeof(struct snd_soc_tplg_hdr); 16988a978234SLiam Girdwood hdr = (struct snd_soc_tplg_hdr *)tplg->hdr_pos; 16998a978234SLiam Girdwood } 17008a978234SLiam Girdwood 17018a978234SLiam Girdwood /* next data type pass */ 17028a978234SLiam Girdwood tplg->pass++; 17038a978234SLiam Girdwood } 17048a978234SLiam Girdwood 17058a978234SLiam Girdwood /* signal DAPM we are complete */ 17068a978234SLiam Girdwood ret = soc_tplg_dapm_complete(tplg); 17078a978234SLiam Girdwood if (ret < 0) 17088a978234SLiam Girdwood dev_err(tplg->dev, 17098a978234SLiam Girdwood "ASoC: failed to initialise DAPM from Firmware\n"); 17108a978234SLiam Girdwood 17118a978234SLiam Girdwood return ret; 17128a978234SLiam Girdwood } 17138a978234SLiam Girdwood 17148a978234SLiam Girdwood static int soc_tplg_load(struct soc_tplg *tplg) 17158a978234SLiam Girdwood { 17168a978234SLiam Girdwood int ret; 17178a978234SLiam Girdwood 17188a978234SLiam Girdwood ret = soc_tplg_process_headers(tplg); 17198a978234SLiam Girdwood if (ret == 0) 17208a978234SLiam Girdwood soc_tplg_complete(tplg); 17218a978234SLiam Girdwood 17228a978234SLiam Girdwood return ret; 17238a978234SLiam Girdwood } 17248a978234SLiam Girdwood 17258a978234SLiam Girdwood /* load audio component topology from "firmware" file */ 17268a978234SLiam Girdwood int snd_soc_tplg_component_load(struct snd_soc_component *comp, 17278a978234SLiam Girdwood struct snd_soc_tplg_ops *ops, const struct firmware *fw, u32 id) 17288a978234SLiam Girdwood { 17298a978234SLiam Girdwood struct soc_tplg tplg; 17308a978234SLiam Girdwood 17318a978234SLiam Girdwood /* setup parsing context */ 17328a978234SLiam Girdwood memset(&tplg, 0, sizeof(tplg)); 17338a978234SLiam Girdwood tplg.fw = fw; 17348a978234SLiam Girdwood tplg.dev = comp->dev; 17358a978234SLiam Girdwood tplg.comp = comp; 17368a978234SLiam Girdwood tplg.ops = ops; 17378a978234SLiam Girdwood tplg.req_index = id; 17388a978234SLiam Girdwood tplg.io_ops = ops->io_ops; 17398a978234SLiam Girdwood tplg.io_ops_count = ops->io_ops_count; 17408a978234SLiam Girdwood 17418a978234SLiam Girdwood return soc_tplg_load(&tplg); 17428a978234SLiam Girdwood } 17438a978234SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_tplg_component_load); 17448a978234SLiam Girdwood 17458a978234SLiam Girdwood /* remove this dynamic widget */ 17468a978234SLiam Girdwood void snd_soc_tplg_widget_remove(struct snd_soc_dapm_widget *w) 17478a978234SLiam Girdwood { 17488a978234SLiam Girdwood /* make sure we are a widget */ 17498a978234SLiam Girdwood if (w->dobj.type != SND_SOC_DOBJ_WIDGET) 17508a978234SLiam Girdwood return; 17518a978234SLiam Girdwood 17528a978234SLiam Girdwood remove_widget(w->dapm->component, &w->dobj, SOC_TPLG_PASS_WIDGET); 17538a978234SLiam Girdwood } 17548a978234SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_tplg_widget_remove); 17558a978234SLiam Girdwood 17568a978234SLiam Girdwood /* remove all dynamic widgets from this DAPM context */ 17578a978234SLiam Girdwood void snd_soc_tplg_widget_remove_all(struct snd_soc_dapm_context *dapm, 17588a978234SLiam Girdwood u32 index) 17598a978234SLiam Girdwood { 17608a978234SLiam Girdwood struct snd_soc_dapm_widget *w, *next_w; 17618a978234SLiam Girdwood struct snd_soc_dapm_path *p, *next_p; 17628a978234SLiam Girdwood 17638a978234SLiam Girdwood list_for_each_entry_safe(w, next_w, &dapm->card->widgets, list) { 17648a978234SLiam Girdwood 17658a978234SLiam Girdwood /* make sure we are a widget with correct context */ 17668a978234SLiam Girdwood if (w->dobj.type != SND_SOC_DOBJ_WIDGET || w->dapm != dapm) 17678a978234SLiam Girdwood continue; 17688a978234SLiam Girdwood 17698a978234SLiam Girdwood /* match ID */ 17708a978234SLiam Girdwood if (w->dobj.index != index && 17718a978234SLiam Girdwood w->dobj.index != SND_SOC_TPLG_INDEX_ALL) 17728a978234SLiam Girdwood continue; 17738a978234SLiam Girdwood 17748a978234SLiam Girdwood list_del(&w->list); 17758a978234SLiam Girdwood 17768a978234SLiam Girdwood /* 17778a978234SLiam Girdwood * remove source and sink paths associated to this widget. 17788a978234SLiam Girdwood * While removing the path, remove reference to it from both 17798a978234SLiam Girdwood * source and sink widgets so that path is removed only once. 17808a978234SLiam Girdwood */ 17818a978234SLiam Girdwood list_for_each_entry_safe(p, next_p, &w->sources, list_sink) { 17828a978234SLiam Girdwood list_del(&p->list_sink); 17838a978234SLiam Girdwood list_del(&p->list_source); 17848a978234SLiam Girdwood list_del(&p->list); 17858a978234SLiam Girdwood kfree(p); 17868a978234SLiam Girdwood } 17878a978234SLiam Girdwood list_for_each_entry_safe(p, next_p, &w->sinks, list_source) { 17888a978234SLiam Girdwood list_del(&p->list_sink); 17898a978234SLiam Girdwood list_del(&p->list_source); 17908a978234SLiam Girdwood list_del(&p->list); 17918a978234SLiam Girdwood kfree(p); 17928a978234SLiam Girdwood } 17938a978234SLiam Girdwood /* check and free and dynamic widget kcontrols */ 17948a978234SLiam Girdwood snd_soc_tplg_widget_remove(w); 17958a978234SLiam Girdwood kfree(w->kcontrols); 17968a978234SLiam Girdwood kfree(w->name); 17978a978234SLiam Girdwood kfree(w); 17988a978234SLiam Girdwood } 17998a978234SLiam Girdwood } 18008a978234SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_tplg_widget_remove_all); 18018a978234SLiam Girdwood 18028a978234SLiam Girdwood /* remove dynamic controls from the component driver */ 18038a978234SLiam Girdwood int snd_soc_tplg_component_remove(struct snd_soc_component *comp, u32 index) 18048a978234SLiam Girdwood { 18058a978234SLiam Girdwood struct snd_soc_dobj *dobj, *next_dobj; 18068a978234SLiam Girdwood int pass = SOC_TPLG_PASS_END; 18078a978234SLiam Girdwood 18088a978234SLiam Girdwood /* process the header types from end to start */ 18098a978234SLiam Girdwood while (pass >= SOC_TPLG_PASS_START) { 18108a978234SLiam Girdwood 18118a978234SLiam Girdwood /* remove mixer controls */ 18128a978234SLiam Girdwood list_for_each_entry_safe(dobj, next_dobj, &comp->dobj_list, 18138a978234SLiam Girdwood list) { 18148a978234SLiam Girdwood 18158a978234SLiam Girdwood /* match index */ 18168a978234SLiam Girdwood if (dobj->index != index && 18178a978234SLiam Girdwood dobj->index != SND_SOC_TPLG_INDEX_ALL) 18188a978234SLiam Girdwood continue; 18198a978234SLiam Girdwood 18208a978234SLiam Girdwood switch (dobj->type) { 18218a978234SLiam Girdwood case SND_SOC_DOBJ_MIXER: 18228a978234SLiam Girdwood remove_mixer(comp, dobj, pass); 18238a978234SLiam Girdwood break; 18248a978234SLiam Girdwood case SND_SOC_DOBJ_ENUM: 18258a978234SLiam Girdwood remove_enum(comp, dobj, pass); 18268a978234SLiam Girdwood break; 18278a978234SLiam Girdwood case SND_SOC_DOBJ_BYTES: 18288a978234SLiam Girdwood remove_bytes(comp, dobj, pass); 18298a978234SLiam Girdwood break; 18308a978234SLiam Girdwood case SND_SOC_DOBJ_WIDGET: 18318a978234SLiam Girdwood remove_widget(comp, dobj, pass); 18328a978234SLiam Girdwood break; 18338a978234SLiam Girdwood case SND_SOC_DOBJ_PCM: 18348a978234SLiam Girdwood case SND_SOC_DOBJ_DAI_LINK: 18358a978234SLiam Girdwood case SND_SOC_DOBJ_CODEC_LINK: 18368a978234SLiam Girdwood remove_pcm_dai(comp, dobj, pass); 18378a978234SLiam Girdwood break; 18388a978234SLiam Girdwood default: 18398a978234SLiam Girdwood dev_err(comp->dev, "ASoC: invalid component type %d for removal\n", 18408a978234SLiam Girdwood dobj->type); 18418a978234SLiam Girdwood break; 18428a978234SLiam Girdwood } 18438a978234SLiam Girdwood } 18448a978234SLiam Girdwood pass--; 18458a978234SLiam Girdwood } 18468a978234SLiam Girdwood 18478a978234SLiam Girdwood /* let caller know if FW can be freed when no objects are left */ 18488a978234SLiam Girdwood return !list_empty(&comp->dobj_list); 18498a978234SLiam Girdwood } 18508a978234SLiam Girdwood EXPORT_SYMBOL_GPL(snd_soc_tplg_component_remove); 1851