/* 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}, {"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'\n", ref->id, elem->id); tplg_dbg("\tparent size: %d + %d -> %d, priv size -> %d\n", 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("\nCheck route: sink '%s', control '%s', source '%s'\n", 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'\n", 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 = 1, old_index = -1; unsigned block = -1, 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; count++; } if (count == 0) return 0; 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, "\tset%u {\n", 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\n", 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\n", 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\n", 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\n", 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\n", 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\n", id, widget->reg); continue; } if (strcmp(id, "invert") == 0) { if (tplg_get_integer(n, &ival, 0)) return -EINVAL; widget->invert = ival; tplg_dbg("\t%s: %d\n", 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\n", 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\n", 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\n", 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\n", 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; if (wt->priv != NULL) { w = realloc(w, elem->size + wt->priv->size); if (!w) { tplg_elem_free(elem); return -ENOMEM; } elem->widget = w; elem->size += wt->priv->size; memcpy(w->priv.data, wt->priv->data, wt->priv->size); w->priv.size = wt->priv->size; } /* 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; }