/*
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 <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"
/* verbose output detailing each object size and file position */
static void verbose(snd_tplg_t *tplg, const char *fmt, ...)
{
int offset;
va_list va;
if (!tplg->verbose)
return;
offset = lseek(tplg->out_fd, 0, SEEK_CUR);
va_start(va, fmt);
fprintf(stdout, "0x%6.6x/%6.6d -", offset, offset);
vfprintf(stdout, fmt, va);
va_end(va);
}
/* write out block header to output file */
static int write_block_header(snd_tplg_t *tplg, unsigned int type,
unsigned int vendor_type, unsigned int version, unsigned int index,
size_t payload_size, int count)
{
struct snd_soc_tplg_hdr hdr;
size_t bytes;
int offset = lseek(tplg->out_fd, 0, SEEK_CUR);
memset(&hdr, 0, sizeof(hdr));
hdr.magic = SND_SOC_TPLG_MAGIC;
hdr.abi = SND_SOC_TPLG_ABI_VERSION;
hdr.type = type;
hdr.vendor_type = vendor_type;
hdr.version = version;
hdr.payload_size = payload_size;
hdr.index = index;
hdr.size = sizeof(hdr);
hdr.count = count;
/* make sure file offset is aligned with the calculated HDR offset */
if ((unsigned int)offset != tplg->next_hdr_pos) {
SNDERR("error: New header is at offset 0x%x but file"
" offset 0x%x is %s by %d bytes\n",
tplg->next_hdr_pos, offset,
(unsigned int)offset > tplg->next_hdr_pos ? "ahead" : "behind",
abs(offset - tplg->next_hdr_pos));
exit(-EINVAL);
}
verbose(tplg, " header index %d type %d count %d size 0x%lx/%ld vendor %d "
"version %d\n", index, type, count,
(long unsigned int)payload_size, (long int)payload_size,
vendor_type, version);
tplg->next_hdr_pos += hdr.payload_size + sizeof(hdr);
bytes = write(tplg->out_fd, &hdr, sizeof(hdr));
if (bytes != sizeof(hdr)) {
SNDERR("error: can't write section header %lu\n",
(long unsigned int)bytes);
return bytes;
}
return bytes;
}
static int write_elem_block(snd_tplg_t *tplg,
struct list_head *base, int size, int tplg_type, const char *obj_name)
{
struct list_head *pos, *sub_pos, *sub_base;
struct tplg_elem *elem, *elem_next;
int ret, wsize = 0, total_size = 0, count = 0, block_size = 0;
sub_base = base;
list_for_each(pos, base) {
/* find elems with the same index to make a block */
elem = list_entry(pos, struct tplg_elem, list);
if (elem->compound_elem)
continue;
elem_next = list_entry(pos->next, struct tplg_elem, list);
block_size += elem->size;
count++;
if ((pos->next == base) || (elem_next->index != elem->index)) {
/* write header for the block */
ret = write_block_header(tplg, tplg_type, elem->vendor_type,
tplg->version, elem->index, block_size, count);
if (ret < 0) {
SNDERR("error: failed to write %s block %d\n",
obj_name, ret);
return ret;
}
/* write elems for the block */
list_for_each(sub_pos, sub_base) {
elem = list_entry(sub_pos, struct tplg_elem, list);
/* compound elems have already been copied to other elems */
if (elem->compound_elem)
continue;
if (elem->type != SND_TPLG_TYPE_DAPM_GRAPH)
verbose(tplg, " %s '%s': write %d bytes\n",
obj_name, elem->id, elem->size);
else
verbose(tplg, " %s '%s -> %s -> %s': write %d bytes\n",
obj_name, elem->route->source,
elem->route->control,
elem->route->sink, elem->size);
wsize = write(tplg->out_fd, elem->obj, elem->size);
if (wsize < 0) {
SNDERR("error: failed to write %s %d\n",
obj_name, ret);
return ret;
}
total_size += wsize;
/* get to the end of sub list */
if (sub_pos == pos)
break;
}
/* the last elem of the current sub list as the head of
next sub list*/
sub_base = pos;
count = 0;
block_size = 0;
}
}
/* make sure we have written the correct size */
if (total_size != size) {
SNDERR("error: size mismatch. Expected %d wrote %d\n",
size, total_size);
return -EIO;
}
return 0;
}
static int calc_block_size(struct list_head *base)
{
struct list_head *pos;
struct tplg_elem *elem;
int size = 0;
list_for_each(pos, base) {
elem = list_entry(pos, struct tplg_elem, list);
/* compound elems have already been copied to other elems */
if (elem->compound_elem)
continue;
size += elem->size;
}
return size;
}
static int write_block(snd_tplg_t *tplg, struct list_head *base,
int type)
{
int size;
/* calculate the block size in bytes for all elems in this list */
size = calc_block_size(base);
if (size <= 0)
return size;
verbose(tplg, " block size for type %d is %d\n", type, size);
/* write each elem for this block */
switch (type) {
case SND_TPLG_TYPE_MIXER:
return write_elem_block(tplg, base, size,
SND_SOC_TPLG_TYPE_MIXER, "mixer");
case SND_TPLG_TYPE_BYTES:
return write_elem_block(tplg, base, size,
SND_SOC_TPLG_TYPE_BYTES, "bytes");
case SND_TPLG_TYPE_ENUM:
return write_elem_block(tplg, base, size,
SND_SOC_TPLG_TYPE_ENUM, "enum");
case SND_TPLG_TYPE_DAPM_GRAPH:
return write_elem_block(tplg, base, size,
SND_SOC_TPLG_TYPE_DAPM_GRAPH, "route");
case SND_TPLG_TYPE_DAPM_WIDGET:
return write_elem_block(tplg, base, size,
SND_SOC_TPLG_TYPE_DAPM_WIDGET, "widget");
case SND_TPLG_TYPE_PCM:
return write_elem_block(tplg, base, size,
SND_SOC_TPLG_TYPE_PCM, "pcm");
case SND_TPLG_TYPE_BE:
return write_elem_block(tplg, base, size,
SND_SOC_TPLG_TYPE_BACKEND_LINK, "be");
case SND_TPLG_TYPE_CC:
return write_elem_block(tplg, base, size,
SND_SOC_TPLG_TYPE_CODEC_LINK, "cc");
case SND_TPLG_TYPE_DATA:
return write_elem_block(tplg, base, size,
SND_SOC_TPLG_TYPE_PDATA, "data");
case SND_TPLG_TYPE_DAI:
return write_elem_block(tplg, base, size,
SND_SOC_TPLG_TYPE_DAI, "dai");
default:
return -EINVAL;
}
return 0;
}
/* write the manifest including its private data */
static int write_manifest_data(snd_tplg_t *tplg)
{
int ret;
/* write the header for this block */
ret = write_block_header(tplg, SND_SOC_TPLG_TYPE_MANIFEST, 0,
tplg->version, 0,
sizeof(tplg->manifest) + tplg->manifest.priv.size, 1);
if (ret < 0) {
SNDERR("error: failed to write manifest block %d\n", ret);
return ret;
}
verbose(tplg, "manifest : write %d bytes\n", sizeof(tplg->manifest));
ret = write(tplg->out_fd, &tplg->manifest, sizeof(tplg->manifest));
if (ret < 0) {
SNDERR("error: failed to write manifest %d\n", ret);
return ret;
}
verbose(tplg, "manifest : write %d priv bytes\n", tplg->manifest.priv.size);
ret = write(tplg->out_fd, tplg->manifest_pdata, tplg->manifest.priv.size);
if (ret < 0) {
SNDERR("error: failed to write manifest priv data %d\n", ret);
return ret;
}
return 0;
}
int tplg_write_data(snd_tplg_t *tplg)
{
int ret;
/* write manifest */
ret = write_manifest_data(tplg);
if (ret < 0) {
SNDERR("failed to write manifest %d\n", ret);
return ret;
}
/* write mixer elems. */
ret = write_block(tplg, &tplg->mixer_list,
SND_TPLG_TYPE_MIXER);
if (ret < 0) {
SNDERR("failed to write control elems %d\n", ret);
return ret;
}
/* write enum control elems. */
ret = write_block(tplg, &tplg->enum_list,
SND_TPLG_TYPE_ENUM);
if (ret < 0) {
SNDERR("failed to write control elems %d\n", ret);
return ret;
}
/* write bytes extended control elems. */
ret = write_block(tplg, &tplg->bytes_ext_list,
SND_TPLG_TYPE_BYTES);
if (ret < 0) {
SNDERR("failed to write control elems %d\n", ret);
return ret;
}
/* write widget elems */
ret = write_block(tplg, &tplg->widget_list,
SND_TPLG_TYPE_DAPM_WIDGET);
if (ret < 0) {
SNDERR("failed to write widget elems %d\n", ret);
return ret;
}
/* write pcm elems */
ret = write_block(tplg, &tplg->pcm_list,
SND_TPLG_TYPE_PCM);
if (ret < 0) {
SNDERR("failed to write pcm elems %d\n", ret);
return ret;
}
/* write physical dai elems */
ret = write_block(tplg, &tplg->dai_list,
SND_TPLG_TYPE_DAI);
if (ret < 0) {
SNDERR("failed to write physical dai elems %d\n", ret);
return ret;
}
/* write be elems */
ret = write_block(tplg, &tplg->be_list,
SND_TPLG_TYPE_BE);
if (ret < 0) {
SNDERR("failed to write be elems %d\n", ret);
return ret;
}
/* write cc elems */
ret = write_block(tplg, &tplg->cc_list,
SND_TPLG_TYPE_CC);
if (ret < 0) {
SNDERR("failed to write cc elems %d\n", ret);
return ret;
}
/* write route elems */
ret = write_block(tplg, &tplg->route_list,
SND_TPLG_TYPE_DAPM_GRAPH);
if (ret < 0) {
SNDERR("failed to write graph elems %d\n", ret);
return ret;
}
/* write private data */
ret = write_block(tplg, &tplg->pdata_list,
SND_TPLG_TYPE_DATA);
if (ret < 0) {
SNDERR("failed to write private data %d\n", ret);
return ret;
}
return 0;
}