|
|
|
@@ -1107,9 +1107,16 @@ struct cs_dsp_coeff_parsed_coeff {
|
|
|
|
|
int len;
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
static int cs_dsp_coeff_parse_string(int bytes, const u8 **pos, const u8 **str)
|
|
|
|
|
static int cs_dsp_coeff_parse_string(int bytes, const u8 **pos, unsigned int avail,
|
|
|
|
|
const u8 **str)
|
|
|
|
|
{
|
|
|
|
|
int length;
|
|
|
|
|
int length, total_field_len;
|
|
|
|
|
|
|
|
|
|
/* String fields are at least one __le32 */
|
|
|
|
|
if (sizeof(__le32) > avail) {
|
|
|
|
|
*pos = NULL;
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
switch (bytes) {
|
|
|
|
|
case 1:
|
|
|
|
@@ -1122,10 +1129,16 @@ static int cs_dsp_coeff_parse_string(int bytes, const u8 **pos, const u8 **str)
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
total_field_len = ((length + bytes) + 3) & ~0x03;
|
|
|
|
|
if ((unsigned int)total_field_len > avail) {
|
|
|
|
|
*pos = NULL;
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (str)
|
|
|
|
|
*str = *pos + bytes;
|
|
|
|
|
|
|
|
|
|
*pos += ((length + bytes) + 3) & ~0x03;
|
|
|
|
|
*pos += total_field_len;
|
|
|
|
|
|
|
|
|
|
return length;
|
|
|
|
|
}
|
|
|
|
@@ -1150,71 +1163,134 @@ static int cs_dsp_coeff_parse_int(int bytes, const u8 **pos)
|
|
|
|
|
return val;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static inline void cs_dsp_coeff_parse_alg(struct cs_dsp *dsp, const u8 **data,
|
|
|
|
|
struct cs_dsp_coeff_parsed_alg *blk)
|
|
|
|
|
static int cs_dsp_coeff_parse_alg(struct cs_dsp *dsp,
|
|
|
|
|
const struct wmfw_region *region,
|
|
|
|
|
struct cs_dsp_coeff_parsed_alg *blk)
|
|
|
|
|
{
|
|
|
|
|
const struct wmfw_adsp_alg_data *raw;
|
|
|
|
|
unsigned int data_len = le32_to_cpu(region->len);
|
|
|
|
|
unsigned int pos;
|
|
|
|
|
const u8 *tmp;
|
|
|
|
|
|
|
|
|
|
raw = (const struct wmfw_adsp_alg_data *)region->data;
|
|
|
|
|
|
|
|
|
|
switch (dsp->fw_ver) {
|
|
|
|
|
case 0:
|
|
|
|
|
case 1:
|
|
|
|
|
raw = (const struct wmfw_adsp_alg_data *)*data;
|
|
|
|
|
*data = raw->data;
|
|
|
|
|
if (sizeof(*raw) > data_len)
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
blk->id = le32_to_cpu(raw->id);
|
|
|
|
|
blk->name = raw->name;
|
|
|
|
|
blk->name_len = strlen(raw->name);
|
|
|
|
|
blk->name_len = strnlen(raw->name, ARRAY_SIZE(raw->name));
|
|
|
|
|
blk->ncoeff = le32_to_cpu(raw->ncoeff);
|
|
|
|
|
|
|
|
|
|
pos = sizeof(*raw);
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
blk->id = cs_dsp_coeff_parse_int(sizeof(raw->id), data);
|
|
|
|
|
blk->name_len = cs_dsp_coeff_parse_string(sizeof(u8), data,
|
|
|
|
|
if (sizeof(raw->id) > data_len)
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
tmp = region->data;
|
|
|
|
|
blk->id = cs_dsp_coeff_parse_int(sizeof(raw->id), &tmp);
|
|
|
|
|
pos = tmp - region->data;
|
|
|
|
|
|
|
|
|
|
tmp = ®ion->data[pos];
|
|
|
|
|
blk->name_len = cs_dsp_coeff_parse_string(sizeof(u8), &tmp, data_len - pos,
|
|
|
|
|
&blk->name);
|
|
|
|
|
cs_dsp_coeff_parse_string(sizeof(u16), data, NULL);
|
|
|
|
|
blk->ncoeff = cs_dsp_coeff_parse_int(sizeof(raw->ncoeff), data);
|
|
|
|
|
if (!tmp)
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
pos = tmp - region->data;
|
|
|
|
|
cs_dsp_coeff_parse_string(sizeof(u16), &tmp, data_len - pos, NULL);
|
|
|
|
|
if (!tmp)
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
pos = tmp - region->data;
|
|
|
|
|
if (sizeof(raw->ncoeff) > (data_len - pos))
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
blk->ncoeff = cs_dsp_coeff_parse_int(sizeof(raw->ncoeff), &tmp);
|
|
|
|
|
pos += sizeof(raw->ncoeff);
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if ((int)blk->ncoeff < 0)
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
cs_dsp_dbg(dsp, "Algorithm ID: %#x\n", blk->id);
|
|
|
|
|
cs_dsp_dbg(dsp, "Algorithm name: %.*s\n", blk->name_len, blk->name);
|
|
|
|
|
cs_dsp_dbg(dsp, "# of coefficient descriptors: %#x\n", blk->ncoeff);
|
|
|
|
|
|
|
|
|
|
return pos;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static inline void cs_dsp_coeff_parse_coeff(struct cs_dsp *dsp, const u8 **data,
|
|
|
|
|
struct cs_dsp_coeff_parsed_coeff *blk)
|
|
|
|
|
static int cs_dsp_coeff_parse_coeff(struct cs_dsp *dsp,
|
|
|
|
|
const struct wmfw_region *region,
|
|
|
|
|
unsigned int pos,
|
|
|
|
|
struct cs_dsp_coeff_parsed_coeff *blk)
|
|
|
|
|
{
|
|
|
|
|
const struct wmfw_adsp_coeff_data *raw;
|
|
|
|
|
unsigned int data_len = le32_to_cpu(region->len);
|
|
|
|
|
unsigned int blk_len, blk_end_pos;
|
|
|
|
|
const u8 *tmp;
|
|
|
|
|
int length;
|
|
|
|
|
|
|
|
|
|
raw = (const struct wmfw_adsp_coeff_data *)®ion->data[pos];
|
|
|
|
|
if (sizeof(raw->hdr) > (data_len - pos))
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
blk_len = le32_to_cpu(raw->hdr.size);
|
|
|
|
|
if (blk_len > S32_MAX)
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
if (blk_len > (data_len - pos - sizeof(raw->hdr)))
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
blk_end_pos = pos + sizeof(raw->hdr) + blk_len;
|
|
|
|
|
|
|
|
|
|
blk->offset = le16_to_cpu(raw->hdr.offset);
|
|
|
|
|
blk->mem_type = le16_to_cpu(raw->hdr.type);
|
|
|
|
|
|
|
|
|
|
switch (dsp->fw_ver) {
|
|
|
|
|
case 0:
|
|
|
|
|
case 1:
|
|
|
|
|
raw = (const struct wmfw_adsp_coeff_data *)*data;
|
|
|
|
|
*data = *data + sizeof(raw->hdr) + le32_to_cpu(raw->hdr.size);
|
|
|
|
|
if (sizeof(*raw) > (data_len - pos))
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
blk->offset = le16_to_cpu(raw->hdr.offset);
|
|
|
|
|
blk->mem_type = le16_to_cpu(raw->hdr.type);
|
|
|
|
|
blk->name = raw->name;
|
|
|
|
|
blk->name_len = strlen(raw->name);
|
|
|
|
|
blk->name_len = strnlen(raw->name, ARRAY_SIZE(raw->name));
|
|
|
|
|
blk->ctl_type = le16_to_cpu(raw->ctl_type);
|
|
|
|
|
blk->flags = le16_to_cpu(raw->flags);
|
|
|
|
|
blk->len = le32_to_cpu(raw->len);
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
tmp = *data;
|
|
|
|
|
blk->offset = cs_dsp_coeff_parse_int(sizeof(raw->hdr.offset), &tmp);
|
|
|
|
|
blk->mem_type = cs_dsp_coeff_parse_int(sizeof(raw->hdr.type), &tmp);
|
|
|
|
|
length = cs_dsp_coeff_parse_int(sizeof(raw->hdr.size), &tmp);
|
|
|
|
|
blk->name_len = cs_dsp_coeff_parse_string(sizeof(u8), &tmp,
|
|
|
|
|
pos += sizeof(raw->hdr);
|
|
|
|
|
tmp = ®ion->data[pos];
|
|
|
|
|
blk->name_len = cs_dsp_coeff_parse_string(sizeof(u8), &tmp, data_len - pos,
|
|
|
|
|
&blk->name);
|
|
|
|
|
cs_dsp_coeff_parse_string(sizeof(u8), &tmp, NULL);
|
|
|
|
|
cs_dsp_coeff_parse_string(sizeof(u16), &tmp, NULL);
|
|
|
|
|
blk->ctl_type = cs_dsp_coeff_parse_int(sizeof(raw->ctl_type), &tmp);
|
|
|
|
|
blk->flags = cs_dsp_coeff_parse_int(sizeof(raw->flags), &tmp);
|
|
|
|
|
blk->len = cs_dsp_coeff_parse_int(sizeof(raw->len), &tmp);
|
|
|
|
|
if (!tmp)
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
*data = *data + sizeof(raw->hdr) + length;
|
|
|
|
|
pos = tmp - region->data;
|
|
|
|
|
cs_dsp_coeff_parse_string(sizeof(u8), &tmp, data_len - pos, NULL);
|
|
|
|
|
if (!tmp)
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
pos = tmp - region->data;
|
|
|
|
|
cs_dsp_coeff_parse_string(sizeof(u16), &tmp, data_len - pos, NULL);
|
|
|
|
|
if (!tmp)
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
pos = tmp - region->data;
|
|
|
|
|
if (sizeof(raw->ctl_type) + sizeof(raw->flags) + sizeof(raw->len) >
|
|
|
|
|
(data_len - pos))
|
|
|
|
|
return -EOVERFLOW;
|
|
|
|
|
|
|
|
|
|
blk->ctl_type = cs_dsp_coeff_parse_int(sizeof(raw->ctl_type), &tmp);
|
|
|
|
|
pos += sizeof(raw->ctl_type);
|
|
|
|
|
blk->flags = cs_dsp_coeff_parse_int(sizeof(raw->flags), &tmp);
|
|
|
|
|
pos += sizeof(raw->flags);
|
|
|
|
|
blk->len = cs_dsp_coeff_parse_int(sizeof(raw->len), &tmp);
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
@@ -1224,6 +1300,8 @@ static inline void cs_dsp_coeff_parse_coeff(struct cs_dsp *dsp, const u8 **data,
|
|
|
|
|
cs_dsp_dbg(dsp, "\tCoefficient flags: %#x\n", blk->flags);
|
|
|
|
|
cs_dsp_dbg(dsp, "\tALSA control type: %#x\n", blk->ctl_type);
|
|
|
|
|
cs_dsp_dbg(dsp, "\tALSA control len: %#x\n", blk->len);
|
|
|
|
|
|
|
|
|
|
return blk_end_pos;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int cs_dsp_check_coeff_flags(struct cs_dsp *dsp,
|
|
|
|
@@ -1247,12 +1325,16 @@ static int cs_dsp_parse_coeff(struct cs_dsp *dsp,
|
|
|
|
|
struct cs_dsp_alg_region alg_region = {};
|
|
|
|
|
struct cs_dsp_coeff_parsed_alg alg_blk;
|
|
|
|
|
struct cs_dsp_coeff_parsed_coeff coeff_blk;
|
|
|
|
|
const u8 *data = region->data;
|
|
|
|
|
int i, ret;
|
|
|
|
|
int i, pos, ret;
|
|
|
|
|
|
|
|
|
|
pos = cs_dsp_coeff_parse_alg(dsp, region, &alg_blk);
|
|
|
|
|
if (pos < 0)
|
|
|
|
|
return pos;
|
|
|
|
|
|
|
|
|
|
cs_dsp_coeff_parse_alg(dsp, &data, &alg_blk);
|
|
|
|
|
for (i = 0; i < alg_blk.ncoeff; i++) {
|
|
|
|
|
cs_dsp_coeff_parse_coeff(dsp, &data, &coeff_blk);
|
|
|
|
|
pos = cs_dsp_coeff_parse_coeff(dsp, region, pos, &coeff_blk);
|
|
|
|
|
if (pos < 0)
|
|
|
|
|
return pos;
|
|
|
|
|
|
|
|
|
|
switch (coeff_blk.ctl_type) {
|
|
|
|
|
case WMFW_CTL_TYPE_BYTES:
|
|
|
|
@@ -1321,6 +1403,10 @@ static unsigned int cs_dsp_adsp1_parse_sizes(struct cs_dsp *dsp,
|
|
|
|
|
const struct wmfw_adsp1_sizes *adsp1_sizes;
|
|
|
|
|
|
|
|
|
|
adsp1_sizes = (void *)&firmware->data[pos];
|
|
|
|
|
if (sizeof(*adsp1_sizes) > firmware->size - pos) {
|
|
|
|
|
cs_dsp_err(dsp, "%s: file truncated\n", file);
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
cs_dsp_dbg(dsp, "%s: %d DM, %d PM, %d ZM\n", file,
|
|
|
|
|
le32_to_cpu(adsp1_sizes->dm), le32_to_cpu(adsp1_sizes->pm),
|
|
|
|
@@ -1337,6 +1423,10 @@ static unsigned int cs_dsp_adsp2_parse_sizes(struct cs_dsp *dsp,
|
|
|
|
|
const struct wmfw_adsp2_sizes *adsp2_sizes;
|
|
|
|
|
|
|
|
|
|
adsp2_sizes = (void *)&firmware->data[pos];
|
|
|
|
|
if (sizeof(*adsp2_sizes) > firmware->size - pos) {
|
|
|
|
|
cs_dsp_err(dsp, "%s: file truncated\n", file);
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
cs_dsp_dbg(dsp, "%s: %d XM, %d YM %d PM, %d ZM\n", file,
|
|
|
|
|
le32_to_cpu(adsp2_sizes->xm), le32_to_cpu(adsp2_sizes->ym),
|
|
|
|
@@ -1376,7 +1466,6 @@ static int cs_dsp_load(struct cs_dsp *dsp, const struct firmware *firmware,
|
|
|
|
|
struct regmap *regmap = dsp->regmap;
|
|
|
|
|
unsigned int pos = 0;
|
|
|
|
|
const struct wmfw_header *header;
|
|
|
|
|
const struct wmfw_adsp1_sizes *adsp1_sizes;
|
|
|
|
|
const struct wmfw_footer *footer;
|
|
|
|
|
const struct wmfw_region *region;
|
|
|
|
|
const struct cs_dsp_region *mem;
|
|
|
|
@@ -1392,10 +1481,8 @@ static int cs_dsp_load(struct cs_dsp *dsp, const struct firmware *firmware,
|
|
|
|
|
|
|
|
|
|
ret = -EINVAL;
|
|
|
|
|
|
|
|
|
|
pos = sizeof(*header) + sizeof(*adsp1_sizes) + sizeof(*footer);
|
|
|
|
|
if (pos >= firmware->size) {
|
|
|
|
|
cs_dsp_err(dsp, "%s: file too short, %zu bytes\n",
|
|
|
|
|
file, firmware->size);
|
|
|
|
|
if (sizeof(*header) >= firmware->size) {
|
|
|
|
|
ret = -EOVERFLOW;
|
|
|
|
|
goto out_fw;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
@@ -1423,22 +1510,36 @@ static int cs_dsp_load(struct cs_dsp *dsp, const struct firmware *firmware,
|
|
|
|
|
|
|
|
|
|
pos = sizeof(*header);
|
|
|
|
|
pos = dsp->ops->parse_sizes(dsp, file, pos, firmware);
|
|
|
|
|
if ((pos == 0) || (sizeof(*footer) > firmware->size - pos)) {
|
|
|
|
|
ret = -EOVERFLOW;
|
|
|
|
|
goto out_fw;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
footer = (void *)&firmware->data[pos];
|
|
|
|
|
pos += sizeof(*footer);
|
|
|
|
|
|
|
|
|
|
if (le32_to_cpu(header->len) != pos) {
|
|
|
|
|
cs_dsp_err(dsp, "%s: unexpected header length %d\n",
|
|
|
|
|
file, le32_to_cpu(header->len));
|
|
|
|
|
ret = -EOVERFLOW;
|
|
|
|
|
goto out_fw;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
cs_dsp_dbg(dsp, "%s: timestamp %llu\n", file,
|
|
|
|
|
le64_to_cpu(footer->timestamp));
|
|
|
|
|
|
|
|
|
|
while (pos < firmware->size &&
|
|
|
|
|
sizeof(*region) < firmware->size - pos) {
|
|
|
|
|
while (pos < firmware->size) {
|
|
|
|
|
/* Is there enough data for a complete block header? */
|
|
|
|
|
if (sizeof(*region) > firmware->size - pos) {
|
|
|
|
|
ret = -EOVERFLOW;
|
|
|
|
|
goto out_fw;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
region = (void *)&(firmware->data[pos]);
|
|
|
|
|
|
|
|
|
|
if (le32_to_cpu(region->len) > firmware->size - pos - sizeof(*region)) {
|
|
|
|
|
ret = -EOVERFLOW;
|
|
|
|
|
goto out_fw;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
region_name = "Unknown";
|
|
|
|
|
reg = 0;
|
|
|
|
|
text = NULL;
|
|
|
|
@@ -1495,16 +1596,6 @@ static int cs_dsp_load(struct cs_dsp *dsp, const struct firmware *firmware,
|
|
|
|
|
regions, le32_to_cpu(region->len), offset,
|
|
|
|
|
region_name);
|
|
|
|
|
|
|
|
|
|
if (le32_to_cpu(region->len) >
|
|
|
|
|
firmware->size - pos - sizeof(*region)) {
|
|
|
|
|
cs_dsp_err(dsp,
|
|
|
|
|
"%s.%d: %s region len %d bytes exceeds file length %zu\n",
|
|
|
|
|
file, regions, region_name,
|
|
|
|
|
le32_to_cpu(region->len), firmware->size);
|
|
|
|
|
ret = -EINVAL;
|
|
|
|
|
goto out_fw;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (text) {
|
|
|
|
|
memcpy(text, region->data, le32_to_cpu(region->len));
|
|
|
|
|
cs_dsp_info(dsp, "%s: %s\n", file, text);
|
|
|
|
@@ -1555,6 +1646,9 @@ out_fw:
|
|
|
|
|
cs_dsp_buf_free(&buf_list);
|
|
|
|
|
kfree(text);
|
|
|
|
|
|
|
|
|
|
if (ret == -EOVERFLOW)
|
|
|
|
|
cs_dsp_err(dsp, "%s: file content overflows file data\n", file);
|
|
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
@@ -2122,10 +2216,20 @@ static int cs_dsp_load_coeff(struct cs_dsp *dsp, const struct firmware *firmware
|
|
|
|
|
pos = le32_to_cpu(hdr->len);
|
|
|
|
|
|
|
|
|
|
blocks = 0;
|
|
|
|
|
while (pos < firmware->size &&
|
|
|
|
|
sizeof(*blk) < firmware->size - pos) {
|
|
|
|
|
while (pos < firmware->size) {
|
|
|
|
|
/* Is there enough data for a complete block header? */
|
|
|
|
|
if (sizeof(*blk) > firmware->size - pos) {
|
|
|
|
|
ret = -EOVERFLOW;
|
|
|
|
|
goto out_fw;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
blk = (void *)(&firmware->data[pos]);
|
|
|
|
|
|
|
|
|
|
if (le32_to_cpu(blk->len) > firmware->size - pos - sizeof(*blk)) {
|
|
|
|
|
ret = -EOVERFLOW;
|
|
|
|
|
goto out_fw;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
type = le16_to_cpu(blk->type);
|
|
|
|
|
offset = le16_to_cpu(blk->offset);
|
|
|
|
|
version = le32_to_cpu(blk->ver) >> 8;
|
|
|
|
@@ -2222,17 +2326,6 @@ static int cs_dsp_load_coeff(struct cs_dsp *dsp, const struct firmware *firmware
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (reg) {
|
|
|
|
|
if (le32_to_cpu(blk->len) >
|
|
|
|
|
firmware->size - pos - sizeof(*blk)) {
|
|
|
|
|
cs_dsp_err(dsp,
|
|
|
|
|
"%s.%d: %s region len %d bytes exceeds file length %zu\n",
|
|
|
|
|
file, blocks, region_name,
|
|
|
|
|
le32_to_cpu(blk->len),
|
|
|
|
|
firmware->size);
|
|
|
|
|
ret = -EINVAL;
|
|
|
|
|
goto out_fw;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
buf = cs_dsp_buf_alloc(blk->data,
|
|
|
|
|
le32_to_cpu(blk->len),
|
|
|
|
|
&buf_list);
|
|
|
|
@@ -2272,6 +2365,10 @@ out_fw:
|
|
|
|
|
regmap_async_complete(regmap);
|
|
|
|
|
cs_dsp_buf_free(&buf_list);
|
|
|
|
|
kfree(text);
|
|
|
|
|
|
|
|
|
|
if (ret == -EOVERFLOW)
|
|
|
|
|
cs_dsp_err(dsp, "%s: file content overflows file data\n", file);
|
|
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|