mirror of
https://github.com/alsa-project/alsa-lib.git
synced 2025-11-03 09:01:52 -05:00
topology: Add private data parser
Parse private data and store for attachment to other objects. Data can come file or be locally defined as bytes, shorts or words. Signed-off-by: Liam Girdwood <liam.r.girdwood@linux.intel.com> Signed-off-by: Takashi Iwai <tiwai@suse.de>
This commit is contained in:
Liam Girdwood
Takashi Iwai
parent
353f1eddb6
commit
5b379da2a0
1 changed files with 396 additions and 0 deletions
396
src/topology/data.c
Normal file
396
src/topology/data.c
Normal file
|
|
@ -0,0 +1,396 @@
|
|||
/*
|
||||
Copyright(c) 2014-2015 Intel Corporation
|
||||
All rights reserved.
|
||||
|
||||
This program is free software; you can redistribute it and/or modify
|
||||
it under the terms of version 2 of the GNU General Public License as
|
||||
published by the Free Software Foundation.
|
||||
|
||||
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
|
||||
General Public License for more details.
|
||||
|
||||
Authors: Mengdong Lin <mengdong.lin@intel.com>
|
||||
Yao Jin <yao.jin@intel.com>
|
||||
Liam Girdwood <liam.r.girdwood@linux.intel.com>
|
||||
*/
|
||||
|
||||
#include "list.h"
|
||||
#include "tplg_local.h"
|
||||
|
||||
/* Get Private data from a file. */
|
||||
static int tplg_parse_data_file(snd_config_t *cfg, struct tplg_elem *elem)
|
||||
{
|
||||
struct snd_soc_tplg_private *priv = NULL;
|
||||
const char *value = NULL;
|
||||
char filename[MAX_FILE];
|
||||
char *env = getenv(ALSA_CONFIG_TPLG_VAR);
|
||||
FILE *fp;
|
||||
size_t size, bytes_read;
|
||||
int ret = 0;
|
||||
|
||||
tplg_dbg("data DataFile: %s\n", elem->id);
|
||||
|
||||
if (snd_config_get_string(cfg, &value) < 0)
|
||||
return -EINVAL;
|
||||
|
||||
/* prepend alsa config directory to path */
|
||||
snprintf(filename, sizeof(filename), "%s/%s",
|
||||
env ? env : ALSA_TPLG_DIR, value);
|
||||
|
||||
fp = fopen(filename, "r");
|
||||
if (fp == NULL) {
|
||||
SNDERR("error: invalid data file path '%s'\n",
|
||||
filename);
|
||||
ret = -errno;
|
||||
goto err;
|
||||
}
|
||||
|
||||
fseek(fp, 0L, SEEK_END);
|
||||
size = ftell(fp);
|
||||
fseek(fp, 0L, SEEK_SET);
|
||||
if (size <= 0) {
|
||||
SNDERR("error: invalid data file size %zu\n", size);
|
||||
ret = -EINVAL;
|
||||
goto err;
|
||||
}
|
||||
if (size > TPLG_MAX_PRIV_SIZE) {
|
||||
SNDERR("error: data file too big %zu\n", size);
|
||||
ret = -EINVAL;
|
||||
goto err;
|
||||
}
|
||||
|
||||
priv = calloc(1, sizeof(*priv) + size);
|
||||
if (!priv) {
|
||||
ret = -ENOMEM;
|
||||
goto err;
|
||||
}
|
||||
|
||||
bytes_read = fread(&priv->data, 1, size, fp);
|
||||
if (bytes_read != size) {
|
||||
ret = -errno;
|
||||
goto err;
|
||||
}
|
||||
|
||||
elem->data = priv;
|
||||
priv->size = size;
|
||||
elem->size = sizeof(*priv) + size;
|
||||
return 0;
|
||||
|
||||
err:
|
||||
if (priv)
|
||||
free(priv);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void dump_priv_data(struct tplg_elem *elem)
|
||||
{
|
||||
struct snd_soc_tplg_private *priv = elem->data;
|
||||
unsigned char *p = (unsigned char *)priv->data;
|
||||
unsigned int i, j = 0;
|
||||
|
||||
tplg_dbg(" elem size = %d, priv data size = %d\n",
|
||||
elem->size, priv->size);
|
||||
|
||||
for (i = 0; i < priv->size; i++) {
|
||||
if (j++ % 8 == 0)
|
||||
tplg_dbg("\n");
|
||||
|
||||
tplg_dbg(" 0x%x", *p++);
|
||||
}
|
||||
|
||||
tplg_dbg("\n\n");
|
||||
}
|
||||
|
||||
/* get number of hex value elements in CSV list */
|
||||
static int get_hex_num(const char *str)
|
||||
{
|
||||
int commas = 0, values = 0, len = strlen(str);
|
||||
const char *end = str + len;
|
||||
|
||||
/* we expect "0x0, 0x0, 0x0" */
|
||||
while (str < end) {
|
||||
|
||||
/* skip white space */
|
||||
if (isspace(*str)) {
|
||||
str++;
|
||||
continue;
|
||||
}
|
||||
|
||||
/* find delimeters */
|
||||
if (*str == ',') {
|
||||
commas++;
|
||||
str++;
|
||||
continue;
|
||||
}
|
||||
|
||||
/* find 0x[0-9] values */
|
||||
if (*str == '0' && str + 2 <= end) {
|
||||
if (str[1] == 'x' && str[2] >= '0' && str[2] <= 'f') {
|
||||
values++;
|
||||
str += 3;
|
||||
} else {
|
||||
str++;
|
||||
}
|
||||
}
|
||||
|
||||
str++;
|
||||
}
|
||||
|
||||
/* there should always be one less comma than value */
|
||||
if (values -1 != commas)
|
||||
return -EINVAL;
|
||||
|
||||
return values;
|
||||
}
|
||||
|
||||
static int write_hex(char *buf, char *str, int width)
|
||||
{
|
||||
long val;
|
||||
void *p = &val;
|
||||
|
||||
errno = 0;
|
||||
val = strtol(str, NULL, 16);
|
||||
|
||||
if ((errno == ERANGE && (val == LONG_MAX || val == LONG_MIN))
|
||||
|| (errno != 0 && val == 0)) {
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
switch (width) {
|
||||
case 1:
|
||||
*(unsigned char *)buf = *(unsigned char *)p;
|
||||
break;
|
||||
case 2:
|
||||
*(unsigned short *)buf = *(unsigned short *)p;
|
||||
break;
|
||||
case 4:
|
||||
*(unsigned int *)buf = *(unsigned int *)p;
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int copy_data_hex(char *data, int off, const char *str, int width)
|
||||
{
|
||||
char *tmp, *s = NULL, *p = data;
|
||||
int ret;
|
||||
|
||||
tmp = strdup(str);
|
||||
if (tmp == NULL)
|
||||
return -ENOMEM;
|
||||
|
||||
p += off;
|
||||
s = strtok(tmp, ",");
|
||||
|
||||
while (s != NULL) {
|
||||
ret = write_hex(p, s, width);
|
||||
if (ret < 0) {
|
||||
free(tmp);
|
||||
return ret;
|
||||
}
|
||||
|
||||
s = strtok(NULL, ",");
|
||||
p += width;
|
||||
}
|
||||
|
||||
free(tmp);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int tplg_parse_data_hex(snd_config_t *cfg, struct tplg_elem *elem,
|
||||
int width)
|
||||
{
|
||||
struct snd_soc_tplg_private *priv;
|
||||
const char *value = NULL;
|
||||
int size, esize, off, num;
|
||||
int ret;
|
||||
|
||||
tplg_dbg(" data: %s\n", elem->id);
|
||||
|
||||
if (snd_config_get_string(cfg, &value) < 0)
|
||||
return -EINVAL;
|
||||
|
||||
num = get_hex_num(value);
|
||||
if (num <= 0) {
|
||||
SNDERR("error: malformed hex variable list %s\n", value);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
size = num * width;
|
||||
priv = elem->data;
|
||||
|
||||
if (esize > TPLG_MAX_PRIV_SIZE) {
|
||||
SNDERR("error: data too big %d\n", esize);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (priv != NULL) {
|
||||
off = priv->size;
|
||||
esize = elem->size + size;
|
||||
priv = realloc(priv, esize);
|
||||
} else {
|
||||
off = 0;
|
||||
esize = sizeof(*priv) + size;
|
||||
priv = calloc(1, esize);
|
||||
}
|
||||
|
||||
if (!priv)
|
||||
return -ENOMEM;
|
||||
|
||||
elem->data = priv;
|
||||
priv->size += size;
|
||||
elem->size = esize;
|
||||
|
||||
ret = copy_data_hex(priv->data, off, value, width);
|
||||
|
||||
dump_priv_data(elem);
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
/* Parse Private data.
|
||||
*
|
||||
* Object private data can either be from file or defined as bytes, shorts,
|
||||
* words.
|
||||
*/
|
||||
int tplg_parse_data(snd_tplg_t *tplg, snd_config_t *cfg,
|
||||
void *private ATTRIBUTE_UNUSED)
|
||||
{
|
||||
snd_config_iterator_t i, next;
|
||||
snd_config_t *n;
|
||||
const char *id, *val = NULL;
|
||||
int err = 0;
|
||||
struct tplg_elem *elem;
|
||||
|
||||
elem = tplg_elem_new_common(tplg, cfg, OBJECT_TYPE_DATA);
|
||||
if (!elem)
|
||||
return -ENOMEM;
|
||||
|
||||
snd_config_for_each(i, next, cfg) {
|
||||
|
||||
n = snd_config_iterator_entry(i);
|
||||
if (snd_config_get_id(n, &id) < 0) {
|
||||
continue;
|
||||
}
|
||||
|
||||
if (strcmp(id, "file") == 0) {
|
||||
err = tplg_parse_data_file(n, elem);
|
||||
if (err < 0) {
|
||||
SNDERR("error: failed to parse data file\n");
|
||||
return err;
|
||||
}
|
||||
continue;
|
||||
}
|
||||
|
||||
if (strcmp(id, "bytes") == 0) {
|
||||
err = tplg_parse_data_hex(n, elem, 1);
|
||||
if (err < 0) {
|
||||
SNDERR("error: failed to parse data bytes\n");
|
||||
return err;
|
||||
}
|
||||
continue;
|
||||
}
|
||||
|
||||
if (strcmp(id, "shorts") == 0) {
|
||||
err = tplg_parse_data_hex(n, elem, 2);
|
||||
if (err < 0) {
|
||||
SNDERR("error: failed to parse data shorts\n");
|
||||
return err;
|
||||
}
|
||||
continue;
|
||||
}
|
||||
|
||||
if (strcmp(id, "words") == 0) {
|
||||
err = tplg_parse_data_hex(n, elem, 4);
|
||||
if (err < 0) {
|
||||
SNDERR("error: failed to parse data words\n");
|
||||
return err;
|
||||
}
|
||||
continue;
|
||||
}
|
||||
|
||||
if (strcmp(id, "index") == 0) {
|
||||
if (snd_config_get_string(n, &val) < 0)
|
||||
return -EINVAL;
|
||||
|
||||
elem->index = atoi(val);
|
||||
tplg_dbg("\t%s: %d\n", id, elem->index);
|
||||
continue;
|
||||
}
|
||||
|
||||
if (strcmp(id, "type") == 0) {
|
||||
if (snd_config_get_string(n, &val) < 0)
|
||||
return -EINVAL;
|
||||
|
||||
elem->vendor_type = atoi(val);
|
||||
tplg_dbg("\t%s: %d\n", id, elem->index);
|
||||
continue;
|
||||
}
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/* copy private data into the bytes extended control */
|
||||
int tplg_copy_data(struct tplg_elem *elem, struct tplg_elem *ref)
|
||||
{
|
||||
struct snd_soc_tplg_private *priv;
|
||||
int priv_data_size;
|
||||
|
||||
if (!ref)
|
||||
return -EINVAL;
|
||||
|
||||
tplg_dbg("Data '%s' used by '%s'\n", ref->id, elem->id);
|
||||
priv_data_size = ref->data->size;
|
||||
|
||||
switch (elem->type) {
|
||||
case OBJECT_TYPE_MIXER:
|
||||
elem->mixer_ctrl = realloc(elem->mixer_ctrl,
|
||||
elem->size + priv_data_size);
|
||||
if (!elem->mixer_ctrl)
|
||||
return -ENOMEM;
|
||||
priv = &elem->mixer_ctrl->priv;
|
||||
break;
|
||||
|
||||
case OBJECT_TYPE_ENUM:
|
||||
elem->enum_ctrl = realloc(elem->enum_ctrl,
|
||||
elem->size + priv_data_size);
|
||||
if (!elem->enum_ctrl)
|
||||
return -ENOMEM;
|
||||
priv = &elem->enum_ctrl->priv;
|
||||
break;
|
||||
|
||||
case OBJECT_TYPE_BYTES:
|
||||
elem->bytes_ext = realloc(elem->bytes_ext,
|
||||
elem->size + priv_data_size);
|
||||
if (!elem->bytes_ext)
|
||||
return -ENOMEM;
|
||||
priv = &elem->bytes_ext->priv;
|
||||
break;
|
||||
|
||||
|
||||
case OBJECT_TYPE_DAPM_WIDGET:
|
||||
elem->widget = realloc(elem->widget,
|
||||
elem->size + priv_data_size);
|
||||
if (!elem->widget)
|
||||
return -ENOMEM;
|
||||
priv = &elem->widget->priv;
|
||||
break;
|
||||
|
||||
default:
|
||||
SNDERR("elem '%s': type %d private data not supported \n",
|
||||
elem->id, elem->type);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
elem->size += priv_data_size;
|
||||
priv->size = priv_data_size;
|
||||
ref->compound_elem = 1;
|
||||
memcpy(priv->data, ref->data->data, priv_data_size);
|
||||
return 0;
|
||||
}
|
||||
Loading…
Add table
Add a link
Reference in a new issue