/* Copyright(c) 2014-2015 Intel Corporation All rights reserved. This library is free software; you can redistribute it and/or modify it under the terms of the GNU Lesser General Public License as published by the Free Software Foundation; either version 2.1 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General Public License for more details. Authors: Mengdong Lin Yao Jin Liam Girdwood */ #include "list.h" #include "tplg_local.h" /* mapping of widget text names to types */ static const struct map_elem widget_map[] = { {"input", SND_SOC_TPLG_DAPM_INPUT}, {"output", SND_SOC_TPLG_DAPM_OUTPUT}, {"mux", SND_SOC_TPLG_DAPM_MUX}, {"mixer", SND_SOC_TPLG_DAPM_MIXER}, {"pga", SND_SOC_TPLG_DAPM_PGA}, {"out_drv", SND_SOC_TPLG_DAPM_OUT_DRV}, {"adc", SND_SOC_TPLG_DAPM_ADC}, {"dac", SND_SOC_TPLG_DAPM_DAC}, {"switch", SND_SOC_TPLG_DAPM_SWITCH}, {"pre", SND_SOC_TPLG_DAPM_PRE}, {"post", SND_SOC_TPLG_DAPM_POST}, {"aif_in", SND_SOC_TPLG_DAPM_AIF_IN}, {"aif_out", SND_SOC_TPLG_DAPM_AIF_OUT}, {"dai_in", SND_SOC_TPLG_DAPM_DAI_IN}, {"dai_out", SND_SOC_TPLG_DAPM_DAI_OUT}, {"dai_link", SND_SOC_TPLG_DAPM_DAI_LINK}, {"buffer", SND_SOC_TPLG_DAPM_BUFFER}, {"scheduler", SND_SOC_TPLG_DAPM_SCHEDULER}, {"effect", SND_SOC_TPLG_DAPM_EFFECT}, {"siggen", SND_SOC_TPLG_DAPM_SIGGEN}, {"src", SND_SOC_TPLG_DAPM_SRC}, {"asrc", SND_SOC_TPLG_DAPM_ASRC}, {"encoder", SND_SOC_TPLG_DAPM_ENCODER}, {"decoder", SND_SOC_TPLG_DAPM_DECODER}, }; static int lookup_widget(const char *w) { unsigned int i; for (i = 0; i < ARRAY_SIZE(widget_map); i++) { if (strcmp(widget_map[i].name, w) == 0) return widget_map[i].id; } return -EINVAL; } static const char *get_widget_name(unsigned int type) { unsigned int i; for (i = 0; i < ARRAY_SIZE(widget_map); i++) { if ((unsigned int)widget_map[i].id == type) return widget_map[i].name; } return NULL; } /* move referenced controls to the widget */ static int copy_dapm_control(struct tplg_elem *elem, struct tplg_elem *ref) { struct snd_soc_tplg_dapm_widget *widget = elem->widget; tplg_dbg("Control '%s' used by '%s'", ref->id, elem->id); tplg_dbg("\tparent size: %d + %d -> %d, priv size -> %d", elem->size, ref->size, elem->size + ref->size, widget->priv.size); widget = realloc(widget, elem->size + ref->size); if (!widget) return -ENOMEM; elem->widget = widget; /* append the control to the end of the widget */ memcpy((void*)widget + elem->size, ref->obj, ref->size); elem->size += ref->size; widget->num_kcontrols++; ref->compound_elem = 1; return 0; } /* check referenced controls for a widget */ static int tplg_build_widget(snd_tplg_t *tplg, struct tplg_elem *elem) { struct tplg_ref *ref; struct list_head *base, *pos; int err = 0; base = &elem->ref_list; /* A widget's private data sits before the embedded controls. * So merge the private data blocks at first */ list_for_each(pos, base) { ref = list_entry(pos, struct tplg_ref, list); if (ref->type != SND_TPLG_TYPE_DATA) continue; err = tplg_copy_data(tplg, elem, ref); if (err < 0) return err; } /* Merge the embedded controls */ list_for_each(pos, base) { ref = list_entry(pos, struct tplg_ref, list); switch (ref->type) { case SND_TPLG_TYPE_MIXER: if (!ref->elem) ref->elem = tplg_elem_lookup(&tplg->mixer_list, ref->id, SND_TPLG_TYPE_MIXER, elem->index); if (ref->elem) err = copy_dapm_control(elem, ref->elem); break; case SND_TPLG_TYPE_ENUM: if (!ref->elem) ref->elem = tplg_elem_lookup(&tplg->enum_list, ref->id, SND_TPLG_TYPE_ENUM, elem->index); if (ref->elem) err = copy_dapm_control(elem, ref->elem); break; case SND_TPLG_TYPE_BYTES: if (!ref->elem) ref->elem = tplg_elem_lookup(&tplg->bytes_ext_list, ref->id, SND_TPLG_TYPE_BYTES, elem->index); if (ref->elem) err = copy_dapm_control(elem, ref->elem); break; default: break; } if (!ref->elem) { SNDERR("cannot find '%s' referenced by widget '%s'", ref->id, elem->id); return -EINVAL; } if (err < 0) return err; } return 0; } int tplg_build_widgets(snd_tplg_t *tplg) { struct list_head *base, *pos; struct tplg_elem *elem; int err; base = &tplg->widget_list; list_for_each(pos, base) { elem = list_entry(pos, struct tplg_elem, list); if (!elem->widget || elem->type != SND_TPLG_TYPE_DAPM_WIDGET) { SNDERR("invalid widget '%s'", elem->id); return -EINVAL; } err = tplg_build_widget(tplg, elem); if (err < 0) return err; /* add widget to manifest */ tplg->manifest.widget_elems++; } return 0; } int tplg_build_routes(snd_tplg_t *tplg) { struct list_head *base, *pos; struct tplg_elem *elem; struct snd_soc_tplg_dapm_graph_elem *route; base = &tplg->route_list; list_for_each(pos, base) { elem = list_entry(pos, struct tplg_elem, list); if (!elem->route || elem->type != SND_TPLG_TYPE_DAPM_GRAPH) { SNDERR("invalid route '%s'", elem->id); return -EINVAL; } route = elem->route; tplg_dbg("Check route: sink '%s', control '%s', source '%s'", route->sink, route->control, route->source); /* validate sink */ if (strlen(route->sink) <= 0) { SNDERR("no sink"); return -EINVAL; } if (!tplg_elem_lookup(&tplg->widget_list, route->sink, SND_TPLG_TYPE_DAPM_WIDGET, SND_TPLG_INDEX_ALL)) { SNDERR("undefined sink widget/stream '%s'", route->sink); } /* validate control name */ if (strlen(route->control)) { if (!tplg_elem_lookup(&tplg->mixer_list, route->control, SND_TPLG_TYPE_MIXER, elem->index) && !tplg_elem_lookup(&tplg->enum_list, route->control, SND_TPLG_TYPE_ENUM, elem->index)) { SNDERR("undefined mixer/enum control '%s'", route->control); } } /* validate source */ if (strlen(route->source) <= 0) { SNDERR("no source"); return -EINVAL; } if (!tplg_elem_lookup(&tplg->widget_list, route->source, SND_TPLG_TYPE_DAPM_WIDGET, SND_TPLG_INDEX_ALL)) { SNDERR("undefined source widget/stream '%s'", route->source); } /* add graph to manifest */ tplg->manifest.graph_elems++; } return 0; } struct tplg_elem *tplg_elem_new_route(snd_tplg_t *tplg, int index) { struct tplg_elem *elem; struct snd_soc_tplg_dapm_graph_elem *line; elem = tplg_elem_new(); if (!elem) return NULL; elem->index = index; if (tplg->dapm_sort) tplg_elem_insert(elem, &tplg->route_list); else list_add_tail(&elem->list, &tplg->route_list); strcpy(elem->id, "line"); elem->type = SND_TPLG_TYPE_DAPM_GRAPH; elem->size = sizeof(*line); line = calloc(1, sizeof(*line)); if (!line) { tplg_elem_free(elem); return NULL; } elem->route = line; return elem; } #define LINE_SIZE 1024 /* line is defined as '"sink, control, source"' */ static int tplg_parse_line(const char *text, struct snd_soc_tplg_dapm_graph_elem *line) { char buf[LINE_SIZE]; unsigned int len, i; const char *source = NULL, *sink = NULL, *control = NULL; snd_strlcpy(buf, text, LINE_SIZE); len = strlen(buf); if (len <= 2) { SNDERR("invalid route \"%s\"", buf); return -EINVAL; } /* find first , */ for (i = 1; i < len; i++) { if (buf[i] == ',') goto second; } SNDERR("invalid route \"%s\"", buf); return -EINVAL; second: /* find second , */ sink = buf; control = &buf[i + 2]; buf[i] = 0; for (; i < len; i++) { if (buf[i] == ',') goto done; } SNDERR("invalid route \"%s\"", buf); return -EINVAL; done: buf[i] = 0; source = &buf[i + 2]; strcpy(line->source, source); strcpy(line->control, control); strcpy(line->sink, sink); return 0; } static int tplg_parse_routes(snd_tplg_t *tplg, snd_config_t *cfg, int index) { snd_config_iterator_t i, next; snd_config_t *n; struct tplg_elem *elem; struct snd_soc_tplg_dapm_graph_elem *line; int err; snd_config_for_each(i, next, cfg) { const char *val; n = snd_config_iterator_entry(i); if (snd_config_get_string(n, &val) < 0) continue; elem = tplg_elem_new_route(tplg, index); if (!elem) return -ENOMEM; line = elem->route; err = tplg_parse_line(val, line); if (err < 0) return err; tplg_dbg("route: sink '%s', control '%s', source '%s'", line->sink, line->control, line->source); } return 0; } int tplg_parse_dapm_graph(snd_tplg_t *tplg, snd_config_t *cfg, void *private ATTRIBUTE_UNUSED) { snd_config_iterator_t i, next; snd_config_t *n; int err; const char *graph_id; int index = -1; if (snd_config_get_type(cfg) != SND_CONFIG_TYPE_COMPOUND) { SNDERR("compound is expected for dapm graph definition"); return -EINVAL; } snd_config_get_id(cfg, &graph_id); snd_config_for_each(i, next, cfg) { const char *id; n = snd_config_iterator_entry(i); if (snd_config_get_id(n, &id) < 0) { continue; } if (strcmp(id, "index") == 0) { if (tplg_get_integer(n, &index, 0)) return -EINVAL; if (index < 0) return -EINVAL; } if (strcmp(id, "lines") == 0) { if (index < 0) { SNDERR("failed to parse dapm graph %s, missing index", graph_id); return -EINVAL; } err = tplg_parse_routes(tplg, n, index); if (err < 0) { SNDERR("failed to parse dapm graph %s", graph_id); return err; } continue; } } return 0; } /* save DAPM graph */ int tplg_save_dapm_graph(snd_tplg_t *tplg, int index, char **dst, const char *pfx) { struct snd_soc_tplg_dapm_graph_elem *route; struct list_head *pos; struct tplg_elem *elem; int err, first, old_index; unsigned block, count; const char *fmt; old_index = -1; block = 0; count = 0; list_for_each(pos, &tplg->route_list) { elem = list_entry(pos, struct tplg_elem, list); if (!elem->route || elem->type != SND_TPLG_TYPE_DAPM_GRAPH) continue; if (index >= 0 && elem->index != index) continue; if (old_index != elem->index) { block++; old_index = elem->index; } count++; } if (count == 0) return 0; if (block < 10) { fmt = "\tset%u {\n"; } else if (block < 100) { fmt = "\tset%02u {\n"; } else if (block < 1000) { fmt = "\tset%03u {\n"; } else { return -EINVAL; } old_index = -1; block = -1; first = 1; err = tplg_save_printf(dst, pfx, "SectionGraph {\n"); list_for_each(pos, &tplg->route_list) { elem = list_entry(pos, struct tplg_elem, list); if (!elem->route || elem->type != SND_TPLG_TYPE_DAPM_GRAPH) continue; if (index >= 0 && elem->index != index) continue; if (old_index != elem->index) { if (old_index >= 0) { err = tplg_save_printf(dst, pfx, "\t\t]\n"); if (err < 0) return err; err = tplg_save_printf(dst, pfx, "\t}\n"); if (err < 0) return err; } old_index = elem->index; block++; first = 1; err = tplg_save_printf(dst, pfx, fmt, block); if (err >= 0) err = tplg_save_printf(dst, pfx, "\t\tindex %u\n", elem->index); if (err < 0) return err; } if (first) { first = 0; err = tplg_save_printf(dst, pfx, "\t\tlines [\n", elem->index); if (err < 0) return err; } route = elem->route; err = tplg_save_printf(dst, pfx, "\t\t\t'%s, %s, %s'\n", route->sink, route->control, route->source); if (err < 0) return err; } if (!first) { if (err >= 0) err = tplg_save_printf(dst, pfx, "\t\t]\n"); if (err >= 0) err = tplg_save_printf(dst, pfx, "\t}\n"); } if (err >= 0) err = tplg_save_printf(dst, pfx, "}\n"); return err; } /* DAPM Widget */ int tplg_parse_dapm_widget(snd_tplg_t *tplg, snd_config_t *cfg, void *private ATTRIBUTE_UNUSED) { struct snd_soc_tplg_dapm_widget *widget; struct tplg_elem *elem; snd_config_iterator_t i, next; snd_config_t *n; const char *id, *val = NULL; int widget_type, err, ival; elem = tplg_elem_new_common(tplg, cfg, NULL, SND_TPLG_TYPE_DAPM_WIDGET); if (!elem) return -ENOMEM; tplg_dbg(" Widget: %s", elem->id); widget = elem->widget; snd_strlcpy(widget->name, elem->id, SNDRV_CTL_ELEM_ID_NAME_MAXLEN); widget->size = elem->size; snd_config_for_each(i, next, cfg) { n = snd_config_iterator_entry(i); if (snd_config_get_id(n, &id) < 0) continue; /* skip comments */ if (strcmp(id, "comment") == 0) continue; if (id[0] == '#') continue; if (strcmp(id, "type") == 0) { if (snd_config_get_string(n, &val) < 0) return -EINVAL; widget_type = lookup_widget(val); if (widget_type < 0){ SNDERR("widget '%s': Unsupported widget type %s", elem->id, val); return -EINVAL; } widget->id = widget_type; tplg_dbg("\t%s: %s", id, val); continue; } if (strcmp(id, "stream_name") == 0) { if (snd_config_get_string(n, &val) < 0) return -EINVAL; snd_strlcpy(widget->sname, val, SNDRV_CTL_ELEM_ID_NAME_MAXLEN); tplg_dbg("\t%s: %s", id, val); continue; } if (strcmp(id, "no_pm") == 0) { ival = snd_config_get_bool(n); if (ival < 0) return -EINVAL; widget->reg = ival ? -1 : 0; tplg_dbg("\t%s: %s", id, val); continue; } if (strcmp(id, "shift") == 0) { if (tplg_get_integer(n, &ival, 0)) return -EINVAL; widget->shift = ival; tplg_dbg("\t%s: %d", id, widget->shift); continue; } if (strcmp(id, "reg") == 0) { if (tplg_get_integer(n, &ival, 0)) return -EINVAL; widget->reg = ival; tplg_dbg("\t%s: %d", id, widget->reg); continue; } if (strcmp(id, "invert") == 0) { ival = snd_config_get_bool(n); if (ival < 0) return -EINVAL; widget->invert = ival; tplg_dbg("\t%s: %d", id, widget->invert); continue; } if (strcmp(id, "subseq") == 0) { if (tplg_get_integer(n, &ival, 0)) return -EINVAL; widget->subseq = ival; tplg_dbg("\t%s: %d", id, widget->subseq); continue; } if (strcmp(id, "event_type") == 0) { if (tplg_get_integer(n, &ival, 0)) return -EINVAL; widget->event_type = ival; tplg_dbg("\t%s: %d", id, widget->event_type); continue; } if (strcmp(id, "event_flags") == 0) { if (tplg_get_integer(n, &ival, 0)) return -EINVAL; widget->event_flags = ival; tplg_dbg("\t%s: %d", id, widget->event_flags); continue; } if (strcmp(id, "enum") == 0) { err = tplg_parse_refs(n, elem, SND_TPLG_TYPE_ENUM); if (err < 0) return err; continue; } if (strcmp(id, "mixer") == 0) { err = tplg_parse_refs(n, elem, SND_TPLG_TYPE_MIXER); if (err < 0) return err; continue; } if (strcmp(id, "bytes") == 0) { err = tplg_parse_refs(n, elem, SND_TPLG_TYPE_BYTES); if (err < 0) return err; continue; } if (strcmp(id, "data") == 0) { err = tplg_parse_refs(n, elem, SND_TPLG_TYPE_DATA); if (err < 0) return err; continue; } } return 0; } /* save DAPM widget */ int tplg_save_dapm_widget(snd_tplg_t *tplg ATTRIBUTE_UNUSED, struct tplg_elem *elem, char **dst, const char *pfx) { struct snd_soc_tplg_dapm_widget *widget = elem->widget; const char *s; char pfx2[16]; int err; err = tplg_save_printf(dst, NULL, "'%s' {\n", elem->id); if (err >= 0 && elem->index) err = tplg_save_printf(dst, pfx, "\tindex %u\n", elem->index); if (err >= 0) { s = get_widget_name(widget->id); if (s) err = tplg_save_printf(dst, pfx, "\ttype %s\n", s); else err = tplg_save_printf(dst, pfx, "\ttype %u\n", widget->id); } if (err >= 0 && widget->sname[0]) err = tplg_save_printf(dst, pfx, "\tstream_name '%s'\n", widget->sname); if (err >= 0 && widget->reg) err = tplg_save_printf(dst, pfx, "\tno_pm 1\n"); if (err >= 0 && widget->shift) err = tplg_save_printf(dst, pfx, "\tshift %u\n", widget->shift); if (err >= 0 && widget->invert) err = tplg_save_printf(dst, pfx, "\tinvert %u\n", widget->invert); if (err >= 0 && widget->subseq) err = tplg_save_printf(dst, pfx, "\tsubseq %u\n", widget->subseq); if (err >= 0 && widget->event_type) err = tplg_save_printf(dst, pfx, "\tevent_type %u\n", widget->event_type); if (err >= 0 && widget->event_flags) err = tplg_save_printf(dst, pfx, "\tevent_flags %u\n", widget->event_flags); snprintf(pfx2, sizeof(pfx2), "%s\t", pfx ?: ""); if (err >= 0) err = tplg_save_refs(tplg, elem, SND_TPLG_TYPE_ENUM, "enum", dst, pfx2); if (err >= 0) err = tplg_save_refs(tplg, elem, SND_TPLG_TYPE_MIXER, "mixer", dst, pfx2); if (err >= 0) err = tplg_save_refs(tplg, elem, SND_TPLG_TYPE_BYTES, "bytes", dst, pfx2); if (err >= 0) err = tplg_save_refs(tplg, elem, SND_TPLG_TYPE_DATA, "data", dst, pfx2); if (err >= 0) err = tplg_save_printf(dst, pfx, "}\n"); return err; } int tplg_add_route(snd_tplg_t *tplg, struct snd_tplg_graph_elem *t, int index) { struct tplg_elem *elem; struct snd_soc_tplg_dapm_graph_elem *line; if (!t->src || !t->sink) return -EINVAL; elem = tplg_elem_new_route(tplg, index); if (!elem) return -ENOMEM; line = elem->route; snd_strlcpy(line->source, t->src, SNDRV_CTL_ELEM_ID_NAME_MAXLEN); if (t->ctl) snd_strlcpy(line->control, t->ctl, SNDRV_CTL_ELEM_ID_NAME_MAXLEN); snd_strlcpy(line->sink, t->sink, SNDRV_CTL_ELEM_ID_NAME_MAXLEN); return 0; } int tplg_add_graph_object(snd_tplg_t *tplg, snd_tplg_obj_template_t *t) { struct snd_tplg_graph_template *gt = t->graph; int i, ret; for (i = 0; i < gt->count; i++) { ret = tplg_add_route(tplg, gt->elem + i, t->index); if (ret < 0) return ret; } return 0; } int tplg_add_widget_object(snd_tplg_t *tplg, snd_tplg_obj_template_t *t) { struct snd_tplg_widget_template *wt = t->widget; struct snd_soc_tplg_dapm_widget *w; struct tplg_elem *elem; int i, ret = 0; tplg_dbg("Widget: %s", wt->name); elem = tplg_elem_new_common(tplg, NULL, wt->name, SND_TPLG_TYPE_DAPM_WIDGET); if (!elem) return -ENOMEM; /* init new widget */ w = elem->widget; w->size = elem->size; w->id = wt->id; snd_strlcpy(w->name, wt->name, SNDRV_CTL_ELEM_ID_NAME_MAXLEN); if (wt->sname) snd_strlcpy(w->sname, wt->sname, SNDRV_CTL_ELEM_ID_NAME_MAXLEN); w->reg = wt->reg; w->shift = wt->shift; w->mask = wt->mask; w->subseq = wt->subseq; w->invert = wt->invert; w->ignore_suspend = wt->ignore_suspend; w->event_flags = wt->event_flags; w->event_type = wt->event_type; /* add private data */ if (wt->priv != NULL && wt->priv->size > 0) { ret = tplg_add_data(tplg, elem, wt->priv, sizeof(*wt->priv) + wt->priv->size); if (ret < 0) { tplg_elem_free(elem); return ret; } } /* add controls to the widget's reference list */ for (i = 0 ; i < wt->num_ctls; i++) { struct snd_tplg_ctl_template *ct = wt->ctl[i]; struct tplg_elem *elem_ctl; struct snd_tplg_mixer_template *mt; struct snd_tplg_bytes_template *bt; struct snd_tplg_enum_template *et; if (!ct) { tplg_elem_free(elem); return -EINVAL; } switch (ct->type) { case SND_SOC_TPLG_TYPE_MIXER: mt = container_of(ct, struct snd_tplg_mixer_template, hdr); ret = tplg_add_mixer(tplg, mt, &elem_ctl); break; case SND_SOC_TPLG_TYPE_BYTES: bt = container_of(ct, struct snd_tplg_bytes_template, hdr); ret = tplg_add_bytes(tplg, bt, &elem_ctl); break; case SND_SOC_TPLG_TYPE_ENUM: et = container_of(ct, struct snd_tplg_enum_template, hdr); ret = tplg_add_enum(tplg, et, &elem_ctl); break; default: SNDERR("widget %s: invalid type %d for ctl %d", wt->name, ct->type, i); break; } if (ret < 0) { tplg_elem_free(elem); return ret; } ret = tplg_ref_add_elem(elem, elem_ctl); if (ret < 0) { tplg_elem_free(elem); return ret; } } return 0; } /* decode dapm widget from the binary input */ int tplg_decode_dapm_widget(snd_tplg_t *tplg, size_t pos, struct snd_soc_tplg_hdr *hdr, void *bin, size_t size) { struct list_head heap; struct snd_soc_tplg_dapm_widget *w; snd_tplg_obj_template_t t; struct snd_tplg_widget_template *wt; struct snd_tplg_mixer_template *mt; struct snd_tplg_enum_template *et; struct snd_tplg_bytes_template *bt; struct snd_soc_tplg_ctl_hdr *chdr; struct snd_soc_tplg_mixer_control *mc; struct snd_soc_tplg_enum_control *ec; struct snd_soc_tplg_bytes_control *bc; size_t size2; unsigned int index; int err; err = tplg_decode_template(tplg, pos, hdr, &t); if (err < 0) return err; next: INIT_LIST_HEAD(&heap); w = bin; if (size < sizeof(*w)) { SNDERR("dapm widget: small size %d", size); return -EINVAL; } if (sizeof(*w) != w->size) { SNDERR("dapm widget: unknown element size %d (expected %zd)", w->size, sizeof(*w)); return -EINVAL; } if (w->num_kcontrols > 16) { SNDERR("dapm widget: too many kcontrols %d", w->num_kcontrols); return -EINVAL; } tplg_log(tplg, 'D', pos, "dapm widget: size %d private size %d kcontrols %d", w->size, w->priv.size, w->num_kcontrols); wt = tplg_calloc(&heap, sizeof(*wt) + sizeof(void *) * w->num_kcontrols); if (wt == NULL) return -ENOMEM; wt->id = w->id; wt->name = w->name; wt->sname = w->sname; wt->reg = w->reg; wt->shift = w->shift; wt->mask = w->mask; wt->subseq = w->subseq; wt->invert = w->invert; wt->ignore_suspend = w->ignore_suspend; wt->event_flags = w->event_flags; wt->event_type = w->event_type; tplg_log(tplg, 'D', pos, "dapm widget: name '%s' sname '%s'", wt->name, wt->sname); if (sizeof(*w) + w->priv.size > size) { SNDERR("dapm widget: wrong private data size %d", w->priv.size); return -EINVAL; } tplg_log(tplg, 'D', pos + offsetof(struct snd_soc_tplg_dapm_widget, priv), "dapm widget: private start"); wt->priv = &w->priv; bin += sizeof(*w) + w->priv.size; size -= sizeof(*w) + w->priv.size; pos += sizeof(*w) + w->priv.size; for (index = 0; index < w->num_kcontrols; index++) { chdr = bin; switch (chdr->type) { case SND_SOC_TPLG_TYPE_MIXER: mt = tplg_calloc(&heap, sizeof(*mt)); if (mt == NULL) { err = -ENOMEM; goto retval; } wt->ctl[index] = (void *)mt; wt->num_ctls++; mc = bin; size2 = mc->size + mc->priv.size; tplg_log(tplg, 'D', pos, "kcontrol mixer size %zd", size2); if (size2 > size) { SNDERR("dapm widget: small mixer size %d", size2); err = -EINVAL; goto retval; } err = tplg_decode_control_mixer1(tplg, &heap, mt, pos, bin, size2); break; case SND_SOC_TPLG_TYPE_ENUM: et = tplg_calloc(&heap, sizeof(*mt)); if (et == NULL) { err = -ENOMEM; goto retval; } wt->ctl[index] = (void *)et; wt->num_ctls++; ec = bin; size2 = ec->size + ec->priv.size; tplg_log(tplg, 'D', pos, "kcontrol enum size %zd", size2); if (size2 > size) { SNDERR("dapm widget: small enum size %d", size2); err = -EINVAL; goto retval; } err = tplg_decode_control_enum1(tplg, &heap, et, pos, bin, size2); break; case SND_SOC_TPLG_TYPE_BYTES: bt = tplg_calloc(&heap, sizeof(*bt)); if (bt == NULL) { err = -ENOMEM; goto retval; } wt->ctl[index] = (void *)bt; wt->num_ctls++; bc = bin; size2 = bc->size + bc->priv.size; tplg_log(tplg, 'D', pos, "kcontrol bytes size %zd", size2); if (size2 > size) { SNDERR("dapm widget: small bytes size %d", size2); err = -EINVAL; goto retval; } err = tplg_decode_control_bytes1(tplg, bt, pos, bin, size2); break; default: SNDERR("dapm widget: wrong control type %d", chdr->type); err = -EINVAL; goto retval; } if (err < 0) goto retval; bin += size2; size -= size2; pos += size2; } t.widget = wt; err = snd_tplg_add_object(tplg, &t); tplg_free(&heap); if (err < 0) return err; if (size > 0) goto next; return 0; retval: tplg_free(&heap); return err; } /* decode dapm link from the binary input */ int tplg_decode_dapm_graph(snd_tplg_t *tplg, size_t pos, struct snd_soc_tplg_hdr *hdr, void *bin, size_t size) { struct snd_soc_tplg_dapm_graph_elem *g; snd_tplg_obj_template_t t; struct snd_tplg_graph_template *gt; struct snd_tplg_graph_elem *ge; size_t asize; int err; err = tplg_decode_template(tplg, pos, hdr, &t); if (err < 0) return err; asize = sizeof(*gt) + (size / sizeof(*g)) * sizeof(*ge); gt = alloca(asize); memset(gt, 0, asize); for (ge = gt->elem; size > 0; ge++) { g = bin; if (size < sizeof(*g)) { SNDERR("dapm graph: small size %d", size); return -EINVAL; } ge->src = g->source; ge->ctl = g->control; ge->sink = g->sink; gt->count++; tplg_log(tplg, 'D', pos, "dapm graph: src='%s' ctl='%s' sink='%s'", ge->src, ge->ctl, ge->sink); bin += sizeof(*g); size -= sizeof(*g); pos += sizeof(*g); } t.graph = gt; return snd_tplg_add_object(tplg, &t); }