sof/tools/tplg_parser/tplg_parser.c

977 lines
25 KiB
C

// SPDX-License-Identifier: BSD-3-Clause
//
// Copyright(c) 2019 Intel Corporation. All rights reserved.
//
// Author: Ranjani Sridharan <ranjani.sridharan@linux.intel.com>
/* Topology parser */
#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <stddef.h>
#include <errno.h>
#include <unistd.h>
#include <string.h>
#include <ipc/topology.h>
#include <ipc/stream.h>
#include <ipc/dai.h>
#include <sof/common.h>
#include <tplg_parser/topology.h>
/* read vendor tuples array from topology */
int tplg_read_array(struct snd_soc_tplg_vendor_array *array, FILE *file)
{
struct snd_soc_tplg_vendor_uuid_elem uuid;
struct snd_soc_tplg_vendor_string_elem string;
struct snd_soc_tplg_vendor_value_elem value;
int j, ret = 0;
size_t size;
switch (array->type) {
case SND_SOC_TPLG_TUPLE_TYPE_UUID:
/* copy uuid elems into array */
for (j = 0; j < array->num_elems; j++) {
size = sizeof(struct snd_soc_tplg_vendor_uuid_elem);
ret = fread(&uuid, size, 1, file);
if (ret != 1)
return -EINVAL;
memcpy(&array->uuid[j], &uuid, size);
}
break;
case SND_SOC_TPLG_TUPLE_TYPE_STRING:
/* copy string elems into array */
for (j = 0; j < array->num_elems; j++) {
size = sizeof(struct snd_soc_tplg_vendor_string_elem);
ret = fread(&string, size, 1, file);
if (ret != 1)
return -EINVAL;
memcpy(&array->string[j], &string, size);
}
break;
case SND_SOC_TPLG_TUPLE_TYPE_BOOL:
case SND_SOC_TPLG_TUPLE_TYPE_BYTE:
case SND_SOC_TPLG_TUPLE_TYPE_WORD:
case SND_SOC_TPLG_TUPLE_TYPE_SHORT:
/* copy value elems into array */
for (j = 0; j < array->num_elems; j++) {
size = sizeof(struct snd_soc_tplg_vendor_value_elem);
ret = fread(&value, size, 1, file);
if (ret != 1)
return -EINVAL;
memcpy(&array->value[j], &value, size);
}
break;
default:
fprintf(stderr, "error: unknown token type %d\n", array->type);
return -EINVAL;
}
return 0;
}
/* load buffer DAPM widget */
int tplg_load_buffer(int comp_id, int pipeline_id, int size,
struct sof_ipc_buffer *buffer, FILE *file)
{
struct snd_soc_tplg_vendor_array *array;
int ret = 0;
/* configure buffer */
buffer->comp.id = comp_id;
buffer->comp.pipeline_id = pipeline_id;
buffer->comp.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_BUFFER_NEW;
buffer->comp.type = SOF_COMP_BUFFER;
buffer->comp.hdr.size = sizeof(struct sof_ipc_buffer);
/* allocate memory for vendor tuple array */
array = (struct snd_soc_tplg_vendor_array *)malloc(size);
if (!array) {
fprintf(stderr, "error: malloc fail during load_buffer\n");
free(array);
return -EINVAL;
}
ret = fread(array, sizeof(struct snd_soc_tplg_vendor_array), 1, file);
if (ret != 1) {
fprintf(stderr, "error: fread fail during load_buffer\n");
free(array);
return -EINVAL;
}
tplg_read_array(array, file);
/* parse buffer tokens */
ret = sof_parse_tokens(buffer, buffer_tokens,
ARRAY_SIZE(buffer_tokens), array, size);
free(array);
return 0;
}
int tplg_load_pcm(int comp_id, int pipeline_id, int size, int dir,
struct sof_ipc_comp_host *host, FILE *file)
{
struct snd_soc_tplg_vendor_array *array = NULL;
size_t total_array_size = 0, read_size;
int ret = 0;
/* configure host comp IPC message */
host->comp.hdr.size = sizeof(*host);
host->comp.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_COMP_NEW;
host->comp.id = comp_id;
host->comp.type = SOF_COMP_HOST;
host->comp.pipeline_id = pipeline_id;
host->direction = dir;
host->config.hdr.size = sizeof(host->config);
/* allocate memory for vendor tuple array */
array = (struct snd_soc_tplg_vendor_array *)malloc(size);
if (!array) {
fprintf(stderr, "error: mem alloc\n");
return -EINVAL;
}
/* read vendor tokens */
while (total_array_size < size) {
read_size = sizeof(struct snd_soc_tplg_vendor_array);
ret = fread(array, read_size, 1, file);
if (ret != 1)
return -EINVAL;
tplg_read_array(array, file);
/* parse comp tokens */
ret = sof_parse_tokens(&host->config, comp_tokens,
ARRAY_SIZE(comp_tokens), array,
array->size);
if (ret != 0) {
fprintf(stderr, "error: parse comp tokens %d\n",
size);
free(array);
return -EINVAL;
}
/* parse pcm tokens */
ret = sof_parse_tokens(host, pcm_tokens,
ARRAY_SIZE(comp_tokens), array,
array->size);
if (ret != 0) {
fprintf(stderr, "error: parse pcm tokens %d\n", size);
free(array);
return -EINVAL;
}
total_array_size += array->size;
}
free(array);
return 0;
}
/* load dai component */
int tplg_load_dai(int comp_id, int pipeline_id, int size,
struct sof_ipc_comp_dai *comp_dai, FILE *file)
{
struct snd_soc_tplg_vendor_array *array;
size_t total_array_size = 0, read_size;
int ret;
/* configure comp_dai */
comp_dai->comp.hdr.size = sizeof(*comp_dai);
comp_dai->comp.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_COMP_NEW;
comp_dai->comp.id = comp_id;
comp_dai->comp.type = SOF_COMP_DAI;
comp_dai->comp.pipeline_id = pipeline_id;
comp_dai->config.hdr.size = sizeof(comp_dai->config);
/* allocate memory for vendor tuple array */
array = (struct snd_soc_tplg_vendor_array *)malloc(size);
if (!array) {
fprintf(stderr, "error: mem alloc\n");
return -EINVAL;
}
/* read vendor tokens */
while (total_array_size < size) {
read_size = sizeof(struct snd_soc_tplg_vendor_array);
ret = fread(array, read_size, 1, file);
if (ret != 1) {
free(array);
return -EINVAL;
}
tplg_read_array(array, file);
ret = sof_parse_tokens(comp_dai, dai_tokens,
ARRAY_SIZE(dai_tokens), array,
array->size);
if (ret != 0) {
fprintf(stderr, "error: parse dai tokens failed %d\n",
size);
free(array);
return -EINVAL;
}
/* parse comp tokens */
ret = sof_parse_tokens(&comp_dai->config, comp_tokens,
ARRAY_SIZE(comp_tokens), array,
array->size);
if (ret != 0) {
fprintf(stderr, "error: parse filewrite tokens %d\n",
size);
free(array);
return -EINVAL;
}
total_array_size += array->size;
}
free(array);
return 0;
}
/* load pda dapm widget */
int tplg_load_pga(int comp_id, int pipeline_id, int size,
struct sof_ipc_comp_volume *volume, FILE *file)
{
struct snd_soc_tplg_vendor_array *array = NULL;
size_t total_array_size = 0, read_size;
int ret = 0;
/* allocate memory for vendor tuple array */
array = (struct snd_soc_tplg_vendor_array *)malloc(size);
if (!array) {
fprintf(stderr, "error: mem alloc\n");
return -EINVAL;
}
/* read vendor tokens */
while (total_array_size < size) {
read_size = sizeof(struct snd_soc_tplg_vendor_array);
ret = fread(array, read_size, 1, file);
if (ret != 1) {
free(array);
return -EINVAL;
}
tplg_read_array(array, file);
/* parse volume tokens */
ret = sof_parse_tokens(&volume->config, comp_tokens,
ARRAY_SIZE(comp_tokens), array,
array->size);
if (ret != 0) {
fprintf(stderr, "error: parse pga tokens %d\n", size);
free(array);
return -EINVAL;
}
total_array_size += array->size;
}
/* configure volume */
volume->comp.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_COMP_NEW;
volume->comp.id = comp_id;
volume->comp.hdr.size = sizeof(struct sof_ipc_comp_volume);
volume->comp.type = SOF_COMP_VOLUME;
volume->comp.pipeline_id = pipeline_id;
volume->config.hdr.size = sizeof(struct sof_ipc_comp_config);
free(array);
return 0;
}
/* load scheduler dapm widget */
int tplg_load_pipeline(int comp_id, int pipeline_id, int size,
struct sof_ipc_pipe_new *pipeline, FILE *file)
{
struct snd_soc_tplg_vendor_array *array = NULL;
size_t total_array_size = 0, read_size;
int ret = 0;
/* configure pipeline */
pipeline->comp_id = comp_id;
pipeline->pipeline_id = pipeline_id;
pipeline->hdr.size = sizeof(*pipeline);
pipeline->hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_PIPE_NEW;
pipeline->comp_id = comp_id;
pipeline->pipeline_id = pipeline_id;
/* allocate memory for vendor tuple array */
array = (struct snd_soc_tplg_vendor_array *)malloc(size);
if (!array) {
fprintf(stderr, "error: mem alloc\n");
return -EINVAL;
}
/* read vendor arrays */
while (total_array_size < size) {
read_size = sizeof(struct snd_soc_tplg_vendor_array);
ret = fread(array, read_size, 1, file);
if (ret != 1) {
free(array);
return -EINVAL;
}
ret = tplg_read_array(array, file);
if (ret < 0) {
free(array);
return -EINVAL;
}
/* parse scheduler tokens */
ret = sof_parse_tokens(pipeline, sched_tokens,
ARRAY_SIZE(sched_tokens), array,
array->size);
if (ret != 0) {
fprintf(stderr, "error: parse pipeline tokens %d\n",
size);
free(array);
return -EINVAL;
}
total_array_size += array->size;
/* read next array */
array = (void *)array + array->size;
}
array = (void *)array - size;
free(array);
return 0;
}
/* load dapm widget kcontrols
* we don't use controls in the testbench or the fuzzer atm.
* so just skip to the next dapm widget
*/
int tplg_load_controls(int num_kcontrols, FILE *file)
{
struct snd_soc_tplg_ctl_hdr *ctl_hdr;
struct snd_soc_tplg_mixer_control *mixer_ctl;
struct snd_soc_tplg_enum_control *enum_ctl;
struct snd_soc_tplg_bytes_control *bytes_ctl;
size_t read_size, size;
int j, ret = 0;
/* allocate memory */
size = sizeof(struct snd_soc_tplg_ctl_hdr);
ctl_hdr = (struct snd_soc_tplg_ctl_hdr *)malloc(size);
if (!ctl_hdr) {
fprintf(stderr, "error: mem alloc\n");
return -EINVAL;
}
size = sizeof(struct snd_soc_tplg_mixer_control);
mixer_ctl = (struct snd_soc_tplg_mixer_control *)malloc(size);
if (!mixer_ctl) {
fprintf(stderr, "error: mem alloc\n");
free(ctl_hdr);
return -EINVAL;
}
size = sizeof(struct snd_soc_tplg_enum_control);
enum_ctl = (struct snd_soc_tplg_enum_control *)malloc(size);
if (!enum_ctl) {
fprintf(stderr, "error: mem alloc\n");
free(ctl_hdr);
free(mixer_ctl);
return -EINVAL;
}
size = sizeof(struct snd_soc_tplg_bytes_control);
bytes_ctl = (struct snd_soc_tplg_bytes_control *)malloc(size);
if (!bytes_ctl) {
fprintf(stderr, "error: mem alloc\n");
free(ctl_hdr);
free(mixer_ctl);
free(enum_ctl);
return -EINVAL;
}
for (j = 0; j < num_kcontrols; j++) {
/* read control header */
read_size = sizeof(struct snd_soc_tplg_ctl_hdr);
ret = fread(ctl_hdr, read_size, 1, file);
if (ret != 1) {
ret = -EINVAL;
goto err;
}
/* load control based on type */
switch (ctl_hdr->ops.info) {
case SND_SOC_TPLG_CTL_VOLSW:
case SND_SOC_TPLG_CTL_STROBE:
case SND_SOC_TPLG_CTL_VOLSW_SX:
case SND_SOC_TPLG_CTL_VOLSW_XR_SX:
case SND_SOC_TPLG_CTL_RANGE:
case SND_SOC_TPLG_DAPM_CTL_VOLSW:
/* load mixer type control */
read_size = sizeof(struct snd_soc_tplg_ctl_hdr);
fseek(file, read_size * -1, SEEK_CUR);
read_size = sizeof(struct snd_soc_tplg_mixer_control);
ret = fread(mixer_ctl, read_size, 1, file);
if (ret != 1) {
ret = -EINVAL;
goto err;
}
/* skip mixer private data */
fseek(file, mixer_ctl->priv.size, SEEK_CUR);
break;
case SND_SOC_TPLG_CTL_ENUM:
case SND_SOC_TPLG_CTL_ENUM_VALUE:
case SND_SOC_TPLG_DAPM_CTL_ENUM_DOUBLE:
case SND_SOC_TPLG_DAPM_CTL_ENUM_VIRT:
case SND_SOC_TPLG_DAPM_CTL_ENUM_VALUE:
/* load enum type control */
read_size = sizeof(struct snd_soc_tplg_ctl_hdr);
fseek(file, read_size * -1, SEEK_CUR);
read_size = sizeof(struct snd_soc_tplg_enum_control);
ret = fread(enum_ctl, read_size, 1, file);
if (ret != 1) {
ret = -EINVAL;
goto err;
}
/* skip enum private data */
fseek(file, enum_ctl->priv.size, SEEK_CUR);
break;
case SND_SOC_TPLG_CTL_BYTES:
/* load bytes type controls */
read_size = sizeof(struct snd_soc_tplg_ctl_hdr);
fseek(file, read_size * -1, SEEK_CUR);
read_size = sizeof(struct snd_soc_tplg_bytes_control);
ret = fread(bytes_ctl, read_size, 1, file);
if (ret != 1) {
ret = -EINVAL;
goto err;
}
/* skip bytes private data */
fseek(file, bytes_ctl->priv.size, SEEK_CUR);
break;
default:
printf("info: control type not supported\n");
return -EINVAL;
}
}
err:
/* free all data */
free(mixer_ctl);
free(enum_ctl);
free(bytes_ctl);
free(ctl_hdr);
return ret;
}
/* load src dapm widget */
int tplg_load_src(int comp_id, int pipeline_id, int size,
struct sof_ipc_comp_src *src, FILE *file)
{
struct snd_soc_tplg_vendor_array *array = NULL;
size_t total_array_size = 0, read_size;
int ret = 0;
/* allocate memory for vendor tuple array */
array = (struct snd_soc_tplg_vendor_array *)malloc(size);
if (!array) {
fprintf(stderr, "error: mem alloc for src vendor array\n");
return -EINVAL;
}
/* read vendor tokens */
while (total_array_size < size) {
read_size = sizeof(struct snd_soc_tplg_vendor_array);
ret = fread(array, read_size, 1, file);
if (ret != 1) {
free(array);
return -EINVAL;
}
tplg_read_array(array, file);
/* parse comp tokens */
ret = sof_parse_tokens(&src->config, comp_tokens,
ARRAY_SIZE(comp_tokens), array,
array->size);
if (ret != 0) {
fprintf(stderr, "error: parse src comp_tokens %d\n",
size);
free(array);
return -EINVAL;
}
/* parse src tokens */
ret = sof_parse_tokens(src, src_tokens,
ARRAY_SIZE(src_tokens), array,
array->size);
if (ret != 0) {
fprintf(stderr, "error: parse src tokens %d\n", size);
free(array);
return -EINVAL;
}
total_array_size += array->size;
/* read next array */
array = (void *)array + array->size;
}
array = (void *)array - size;
/* configure src */
src->comp.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_COMP_NEW;
src->comp.id = comp_id;
src->comp.hdr.size = sizeof(struct sof_ipc_comp_src);
src->comp.type = SOF_COMP_SRC;
src->comp.pipeline_id = pipeline_id;
src->config.hdr.size = sizeof(struct sof_ipc_comp_config);
free(array);
return 0;
}
/* load mixer dapm widget */
int tplg_load_mixer(int comp_id, int pipeline_id, int size,
struct sof_ipc_comp_mixer *mixer, FILE *file)
{
struct snd_soc_tplg_vendor_array *array = NULL;
size_t total_array_size = 0, read_size;
int ret = 0;
/* allocate memory for vendor tuple array */
array = (struct snd_soc_tplg_vendor_array *)malloc(size);
if (!array) {
fprintf(stderr, "error: mem alloc for src vendor array\n");
return -EINVAL;
}
/* read vendor tokens */
while (total_array_size < size) {
read_size = sizeof(struct snd_soc_tplg_vendor_array);
ret = fread(array, read_size, 1, file);
if (ret != 1) {
free(array);
return -EINVAL;
}
tplg_read_array(array, file);
/* parse comp tokens */
ret = sof_parse_tokens(&mixer->config, comp_tokens,
ARRAY_SIZE(comp_tokens), array,
array->size);
if (ret != 0) {
fprintf(stderr, "error: parse src comp_tokens %d\n",
size);
free(array);
return -EINVAL;
}
total_array_size += array->size;
/* read next array */
array = (void *)array + array->size;
}
/* point to the start of array so it gets freed properly */
array = (void *)array - size;
/* configure src */
mixer->comp.hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_COMP_NEW;
mixer->comp.id = comp_id;
mixer->comp.hdr.size = sizeof(struct sof_ipc_comp_src);
mixer->comp.type = SOF_COMP_MIXER;
mixer->comp.pipeline_id = pipeline_id;
mixer->config.hdr.size = sizeof(struct sof_ipc_comp_config);
free(array);
return 0;
}
/* load pipeline graph DAPM widget*/
int tplg_load_graph(int num_comps, int pipeline_id,
struct comp_info *temp_comp_list, char *pipeline_string,
struct sof_ipc_pipe_comp_connect *connection, FILE *file,
int route_num, int count)
{
struct snd_soc_tplg_dapm_graph_elem *graph_elem;
char *source, *sink;
int j, ret = 0;
size_t size;
/* configure route */
connection->hdr.size = sizeof(*connection);
connection->hdr.cmd = SOF_IPC_GLB_TPLG_MSG | SOF_IPC_TPLG_COMP_CONNECT;
/* allocate memory for graph elem */
size = sizeof(struct snd_soc_tplg_dapm_graph_elem);
graph_elem = (struct snd_soc_tplg_dapm_graph_elem *)malloc(size);
if (!graph_elem) {
fprintf(stderr, "error: mem alloc\n");
return -EINVAL;
}
/* set up component connections */
connection->source_id = -1;
connection->sink_id = -1;
size = sizeof(struct snd_soc_tplg_dapm_graph_elem);
ret = fread(graph_elem, size, 1, file);
if (ret != 1) {
free(graph_elem);
return -EINVAL;
}
/* look up component id from the component list */
for (j = 0; j < num_comps; j++) {
if (strcmp(temp_comp_list[j].name,
graph_elem->source) == 0) {
connection->source_id = temp_comp_list[j].id;
source = graph_elem->source;
}
if (strcmp(temp_comp_list[j].name,
graph_elem->sink) == 0) {
connection->sink_id = temp_comp_list[j].id;
sink = graph_elem->sink;
}
}
if (connection->source_id == -1 || connection->sink_id == -1) {
free(graph_elem);
return -EINVAL;
}
printf("loading route %s -> %s\n", source, sink);
strcat(pipeline_string, graph_elem->source);
strcat(pipeline_string, "->");
if (route_num == (count - 1))
strcat(pipeline_string, graph_elem->sink);
free(graph_elem);
return 0;
}
/* load dapm widget */
int load_widget(void *dev, int dev_type, struct comp_info *temp_comp_list,
int comp_id, int comp_index, int pipeline_id,
void *tp, int *fr_id, int *fw_id, int *sched_id, FILE *file)
{
struct snd_soc_tplg_dapm_widget *widget;
size_t read_size, size;
int ret = 0;
/* allocate memory for widget */
size = sizeof(struct snd_soc_tplg_dapm_widget);
widget = (struct snd_soc_tplg_dapm_widget *)malloc(size);
if (!widget) {
fprintf(stderr, "error: mem alloc\n");
return -EINVAL;
}
/* read widget data */
read_size = sizeof(struct snd_soc_tplg_dapm_widget);
ret = fread(widget, read_size, 1, file);
if (ret != 1)
return -EINVAL;
/*
* create a list with all widget info
* containing mapping between component names and ids
* which will be used for setting up component connections
*/
temp_comp_list[comp_index].id = comp_id;
temp_comp_list[comp_index].name = strdup(widget->name);
temp_comp_list[comp_index].type = widget->id;
temp_comp_list[comp_index].pipeline_id = pipeline_id;
printf("debug: loading widget %s id %d\n",
temp_comp_list[comp_index].name,
temp_comp_list[comp_index].id);
/* register comp driver */
register_comp(temp_comp_list[comp_index].type);
/* load widget based on type */
switch (temp_comp_list[comp_index].type) {
/* load pga widget */
case(SND_SOC_TPLG_DAPM_PGA):
if (load_pga(dev, temp_comp_list[comp_index].id,
pipeline_id, widget->priv.size) < 0) {
fprintf(stderr, "error: load pga\n");
return -EINVAL;
}
break;
case(SND_SOC_TPLG_DAPM_AIF_IN):
if (load_aif_in_out(dev, temp_comp_list[comp_index].id,
pipeline_id, widget->priv.size,
fr_id, sched_id, tp,
SOF_IPC_STREAM_PLAYBACK) < 0) {
fprintf(stderr, "error: load AIF IN failed\n");
return -EINVAL;
}
break;
case(SND_SOC_TPLG_DAPM_AIF_OUT):
if (load_aif_in_out(dev, temp_comp_list[comp_index].id,
pipeline_id, widget->priv.size,
fr_id, sched_id, tp,
SOF_IPC_STREAM_CAPTURE) < 0) {
fprintf(stderr, "error: load AIF OUT failed\n");
return -EINVAL;
}
break;
case(SND_SOC_TPLG_DAPM_DAI_IN):
case(SND_SOC_TPLG_DAPM_DAI_OUT):
if (load_dai_in_out(dev, temp_comp_list[comp_index].id,
pipeline_id, widget->priv.size,
fw_id, tp) < 0) {
fprintf(stderr, "error: load filewrite\n");
return -EINVAL;
}
break;
case(SND_SOC_TPLG_DAPM_BUFFER):
if (load_buffer(dev, temp_comp_list[comp_index].id,
pipeline_id, widget->priv.size) < 0) {
fprintf(stderr, "error: load buffer\n");
return -EINVAL;
}
break;
case(SND_SOC_TPLG_DAPM_SCHEDULER):
/* find comp id for scheduling comp */
if (dev_type == FUZZER_DEV)
*sched_id = find_widget(temp_comp_list, comp_id,
widget->sname);
if (load_pipeline(dev, temp_comp_list[comp_index].id,
pipeline_id, widget->priv.size,
sched_id) < 0) {
fprintf(stderr, "error: load pipeline\n");
return -EINVAL;
}
break;
case(SND_SOC_TPLG_DAPM_SRC):
if (load_src(dev, temp_comp_list[comp_index].id,
pipeline_id, widget->priv.size, tp) < 0) {
fprintf(stderr, "error: load src\n");
return -EINVAL;
}
break;
case(SND_SOC_TPLG_DAPM_MIXER):
if (load_mixer(dev, temp_comp_list[comp_index].id,
pipeline_id, widget->priv.size) < 0) {
fprintf(stderr, "error: load mixer\n");
return -EINVAL;
}
break;
/* unsupported widgets */
default:
fseek(file, widget->priv.size, SEEK_CUR);
printf("info: Widget type not supported %d\n",
widget->id);
break;
}
/* load widget kcontrols */
if (widget->num_kcontrols > 0)
if (tplg_load_controls(widget->num_kcontrols, file) < 0) {
fprintf(stderr, "error: loading controls\n");
return -EINVAL;
}
free(widget);
return 0;
}
/* parse vendor tokens in topology */
int sof_parse_tokens(void *object, const struct sof_topology_token *tokens,
int count, struct snd_soc_tplg_vendor_array *array,
int priv_size)
{
int asize;
while (priv_size > 0) {
asize = array->size;
/* validate asize */
if (asize < 0) { /* FIXME: A zero-size array makes no sense */
fprintf(stderr, "error: invalid array size 0x%x\n",
asize);
return -EINVAL;
}
/* make sure there is enough data before parsing */
priv_size -= asize;
if (priv_size < 0) {
fprintf(stderr, "error: invalid array size 0x%x\n",
asize);
return -EINVAL;
}
/* call correct parser depending on type */
switch (array->type) {
case SND_SOC_TPLG_TUPLE_TYPE_UUID:
sof_parse_uuid_tokens(object, tokens, count,
array);
break;
case SND_SOC_TPLG_TUPLE_TYPE_STRING:
sof_parse_string_tokens(object, tokens, count,
array);
break;
case SND_SOC_TPLG_TUPLE_TYPE_BOOL:
case SND_SOC_TPLG_TUPLE_TYPE_BYTE:
case SND_SOC_TPLG_TUPLE_TYPE_WORD:
case SND_SOC_TPLG_TUPLE_TYPE_SHORT:
sof_parse_word_tokens(object, tokens, count,
array);
break;
default:
fprintf(stderr, "error: unknown token type %d\n",
array->type);
return -EINVAL;
}
}
return 0;
}
/* parse word tokens */
void sof_parse_word_tokens(void *object,
const struct sof_topology_token *tokens,
int count,
struct snd_soc_tplg_vendor_array *array)
{
struct snd_soc_tplg_vendor_value_elem *elem;
int i, j;
/* parse element by element */
for (i = 0; i < array->num_elems; i++) {
elem = &array->value[i];
/* search for token */
for (j = 0; j < count; j++) {
/* match token type */
if (tokens[j].type != SND_SOC_TPLG_TUPLE_TYPE_WORD)
continue;
/* match token id */
if (tokens[j].token != elem->token)
continue;
/* matched - now load token */
tokens[j].get_token(elem, object, tokens[j].offset,
tokens[j].size);
}
}
}
/* parse uuid tokens */
void sof_parse_uuid_tokens(void *object,
const struct sof_topology_token *tokens,
int count,
struct snd_soc_tplg_vendor_array *array)
{
struct snd_soc_tplg_vendor_uuid_elem *elem;
int i, j;
/* parse element by element */
for (i = 0; i < array->num_elems; i++) {
elem = &array->uuid[i];
/* search for token */
for (j = 0; j < count; j++) {
/* match token type */
if (tokens[j].type != SND_SOC_TPLG_TUPLE_TYPE_UUID)
continue;
/* match token id */
if (tokens[j].token != elem->token)
continue;
/* matched - now load token */
tokens[j].get_token(elem, object, tokens[j].offset,
tokens[j].size);
}
}
}
/* parse string tokens */
void sof_parse_string_tokens(void *object,
const struct sof_topology_token *tokens,
int count,
struct snd_soc_tplg_vendor_array *array)
{
struct snd_soc_tplg_vendor_string_elem *elem;
int i, j;
/* parse element by element */
for (i = 0; i < array->num_elems; i++) {
elem = &array->string[i];
/* search for token */
for (j = 0; j < count; j++) {
/* match token type */
if (tokens[j].type != SND_SOC_TPLG_TUPLE_TYPE_STRING)
continue;
/* match token id */
if (tokens[j].token != elem->token)
continue;
/* matched - now load token */
tokens[j].get_token(elem, object, tokens[j].offset,
tokens[j].size);
}
}
}
enum sof_ipc_frame find_format(const char *name)
{
int i;
for (i = 0; i < ARRAY_SIZE(sof_frames); i++) {
if (strcmp(name, sof_frames[i].name) == 0)
return sof_frames[i].frame;
}
/* use s32le if nothing is specified */
return SOF_IPC_FRAME_S32_LE;
}
/* helper functions to get tokens */
int get_token_uint32_t(void *elem, void *object, uint32_t offset,
uint32_t size)
{
struct snd_soc_tplg_vendor_value_elem *velem = elem;
uint32_t *val = object + offset;
*val = velem->value;
return 0;
}
int get_token_comp_format(void *elem, void *object, uint32_t offset,
uint32_t size)
{
struct snd_soc_tplg_vendor_string_elem *velem = elem;
uint32_t *val = object + offset;
*val = find_format(velem->string);
return 0;
}
int get_token_dai_type(void *elem, void *object, uint32_t offset, uint32_t size)
{
struct snd_soc_tplg_vendor_string_elem *velem = elem;
uint32_t *val = (uint32_t *)((uint8_t *)object + offset);
*val = find_dai(velem->string);
return 0;
}