nathan/CoolPi-Armbian-Rockchip-RK3588-Upstream-Linux-6.1-LTS-Kernel
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
CoolPi-Armbian-Rockchip-RK3.../sound/soc/codecs/aw882xx/aw882xx_bin_parse.c

1422 lines
40 KiB
C
Raw Blame History

// SPDX-License-Identifier: GPL-2.0
/* aw882xx_bin_parse.c
*
* Copyright (c) 2020 AWINIC Technology CO., LTD
*
* Author: Nick Li <liweilei@awinic.com.cn>
*
* This program is free software; you can redistribute it and/or modify it
* under the terms of the GNU General Public License as published by the
* Free Software Foundation; either version 2 of the License, or (at your
* option) any later version.
*/
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/i2c.h>
#include <linux/of_gpio.h>
#include <linux/delay.h>
#include <linux/device.h>
#include <linux/firmware.h>
#include <linux/slab.h>
#include <linux/version.h>
#include <linux/input.h>
#include <linux/interrupt.h>
#include <linux/debugfs.h>
#include <linux/miscdevice.h>
#include <linux/uaccess.h>
#include <linux/regmap.h>
#include <linux/timer.h>
#include <linux/workqueue.h>
#include <linux/hrtimer.h>
#include <linux/mutex.h>
#include <linux/cdev.h>
#include <linux/list.h>
#include <linux/string.h>
#include "aw882xx_bin_parse.h"
#include "aw882xx_device.h"
#include "aw882xx_data_type.h"
#include "aw882xx_log.h"
#define AWINIC_CODE_VERSION "V0.0.7-V1.0.4" /* "code version"-"excel version" */
#define DEBUG_LOG_LEVEL
#ifdef DEBUG_LOG_LEVEL
#define DBG(fmt, arg...) \
pr_debug("AWINIC_BIN %s,line= %d,"fmt, __func__, __LINE__, ##arg)
#define DBG_ERR(fmt, arg...) \
pr_err("AWINIC_BIN_ERR %s,line= %d,"fmt, __func__, __LINE__, ##arg)
#else
#define DBG(fmt, arg...) do {} while (0)
#define DBG_ERR(fmt, arg...) do {} while (0)
#endif
static char *profile_name[AW_PROFILE_MAX] = {
"Music", "Voice", "Voip", "Ringtone", "Ringtone_hs",
"Lowpower", "Bypass", "Mmi", "Fm", "Notification", "Receiver"
};
static int aw_parse_bin_header_1_0_0(struct aw_bin *bin);
/********************************************************
*
* check sum data
*
********************************************************/
static int aw_check_sum(struct aw_bin *bin, int bin_num)
{
unsigned int i = 0;
unsigned int sum_data = 0;
unsigned int check_sum = 0;
unsigned char *p_check_sum = NULL;
DBG("enter\n");
p_check_sum = &(bin->info.data[(bin->header_info[bin_num].valid_data_addr -
bin->header_info[bin_num].header_len)]);
DBG("aw_bin_parse p_check_sum = %p\n", p_check_sum);
check_sum = GET_32_DATA(*(p_check_sum + 3),
*(p_check_sum + 2),
*(p_check_sum + 1), *(p_check_sum));
for (i = 4; i < bin->header_info[bin_num].bin_data_len +
bin->header_info[bin_num].header_len; i++) {
sum_data += *(p_check_sum + i);
}
DBG("aw_bin_parse bin_num=%d, check_sum = 0x%x, sum_data = 0x%x\n",
bin_num, check_sum, sum_data);
if (sum_data != check_sum) {
p_check_sum = NULL;
DBG_ERR("aw_bin_parse check sum or check bin data len error\n");
DBG_ERR("aw_bin_parse bin_num=%d, check_sum = 0x%x, sum_data = 0x%x\n", bin_num, check_sum, sum_data);
return -EINVAL;
}
p_check_sum = NULL;
return 0;
}
static int aw_check_data_version(struct aw_bin *bin, int bin_num)
{
int i = 0;
DBG("enter\n");
for (i = DATA_VERSION_V1; i < DATA_VERSION_MAX; i++) {
if (bin->header_info[bin_num].bin_data_ver == i)
return 0;
}
DBG_ERR("aw_bin_parse Unrecognized this bin data version\n");
return -EINVAL;
}
static int aw_check_register_num_v1(struct aw_bin *bin, int bin_num)
{
unsigned int check_register_num = 0;
unsigned int parse_register_num = 0;
char *p_check_sum = NULL;
DBG("enter\n");
p_check_sum = &(bin->info.data[(bin->header_info[bin_num].valid_data_addr)]);
DBG("aw_bin_parse p_check_sum = %p\n", p_check_sum);
parse_register_num = GET_32_DATA(*(p_check_sum + 3),
*(p_check_sum + 2),
*(p_check_sum + 1), *(p_check_sum));
check_register_num = (bin->header_info[bin_num].bin_data_len - 4) /
(bin->header_info[bin_num].reg_byte_len +
bin->header_info[bin_num].data_byte_len);
DBG("aw_bin_parse bin_num=%d, parse_register_num = 0x%x, check_register_num = 0x%x\n",
bin_num, parse_register_num, check_register_num);
if (parse_register_num != check_register_num) {
p_check_sum = NULL;
DBG_ERR("aw_bin_parse register num is error\n");
DBG_ERR("aw_bin_parse bin_num=%d, parse_register_num = 0x%x, check_register_num = 0x%x\n", bin_num, parse_register_num, check_register_num);
return -EINVAL;
}
bin->header_info[bin_num].reg_num = parse_register_num;
bin->header_info[bin_num].valid_data_len =
bin->header_info[bin_num].bin_data_len - 4;
p_check_sum = NULL;
bin->header_info[bin_num].valid_data_addr =
bin->header_info[bin_num].valid_data_addr + 4;
return 0;
}
static int aw_check_dsp_reg_num_v1(struct aw_bin *bin, int bin_num)
{
unsigned int check_dsp_reg_num = 0;
unsigned int parse_dsp_reg_num = 0;
char *p_check_sum = NULL;
DBG("enter\n");
p_check_sum = &(bin->info.data[(bin->header_info[bin_num].valid_data_addr)]);
DBG("aw_bin_parse p_check_sum = %p\n", p_check_sum);
parse_dsp_reg_num = GET_32_DATA(*(p_check_sum + 7),
*(p_check_sum + 6),
*(p_check_sum + 5), *(p_check_sum + 4));
bin->header_info[bin_num].reg_data_byte_len =
GET_32_DATA(*(p_check_sum + 11), *(p_check_sum + 10),
*(p_check_sum + 9), *(p_check_sum + 8));
check_dsp_reg_num =
(bin->header_info[bin_num].bin_data_len -
12) / bin->header_info[bin_num].reg_data_byte_len;
DBG("aw_bin_parse bin_num=%d, parse_dsp_reg_num = 0x%x, check_dsp_reg_num = 0x%x\n",
bin_num, parse_dsp_reg_num, check_dsp_reg_num);
if (parse_dsp_reg_num != check_dsp_reg_num) {
p_check_sum = NULL;
DBG_ERR("aw_bin_parse dsp reg num is error\n");
DBG_ERR("aw_bin_parse bin_num=%d, parse_dsp_reg_num = 0x%x, check_dsp_reg_num = 0x%x\n", bin_num, parse_dsp_reg_num, check_dsp_reg_num);
return -EINVAL;
}
bin->header_info[bin_num].download_addr =
GET_32_DATA(*(p_check_sum + 3), *(p_check_sum + 2),
*(p_check_sum + 1), *(p_check_sum));
bin->header_info[bin_num].reg_num = parse_dsp_reg_num;
bin->header_info[bin_num].valid_data_len =
bin->header_info[bin_num].bin_data_len - 12;
p_check_sum = NULL;
bin->header_info[bin_num].valid_data_addr =
bin->header_info[bin_num].valid_data_addr + 12;
return 0;
}
static int aw_check_soc_app_num_v1(struct aw_bin *bin, int bin_num)
{
unsigned int check_soc_app_num = 0;
unsigned int parse_soc_app_num = 0;
char *p_check_sum = NULL;
DBG("enter\n");
p_check_sum =
&(bin->info.data[(bin->header_info[bin_num].valid_data_addr)]);
DBG("aw_bin_parse p_check_sum = %p\n", p_check_sum);
bin->header_info[bin_num].app_version = GET_32_DATA(*(p_check_sum + 3),
*(p_check_sum + 2),
*(p_check_sum + 1),
*(p_check_sum));
parse_soc_app_num = GET_32_DATA(*(p_check_sum + 11),
*(p_check_sum + 10),
*(p_check_sum + 9), *(p_check_sum + 8));
check_soc_app_num = bin->header_info[bin_num].bin_data_len - 12;
DBG
("aw_bin_parse bin_num=%d, parse_soc_app_num = 0x%x, check_soc_app_num = 0x%x\n",
bin_num, parse_soc_app_num, check_soc_app_num);
if (parse_soc_app_num != check_soc_app_num) {
p_check_sum = NULL;
DBG_ERR("aw_bin_parse soc app num is error\n");
DBG_ERR("aw_bin_parse bin_num=%d, parse_soc_app_num = 0x%x, check_soc_app_num = 0x%x\n", bin_num, parse_soc_app_num, check_soc_app_num);
return -EINVAL;
}
bin->header_info[bin_num].reg_num = parse_soc_app_num;
bin->header_info[bin_num].download_addr =
GET_32_DATA(*(p_check_sum + 7), *(p_check_sum + 6),
*(p_check_sum + 5), *(p_check_sum + 4));
bin->header_info[bin_num].valid_data_len =
bin->header_info[bin_num].bin_data_len - 12;
p_check_sum = NULL;
bin->header_info[bin_num].valid_data_addr =
bin->header_info[bin_num].valid_data_addr + 12;
return 0;
}
/************************
***
***bin header 1_0_0
***
************************/
static void aw_get_single_bin_header_1_0_0(struct aw_bin *bin)
{
int i = 0;
DBG("enter\n");
bin->header_info[bin->all_bin_parse_num].header_len = 60;
bin->header_info[bin->all_bin_parse_num].check_sum =
GET_32_DATA(*(bin->p_addr + 3), *(bin->p_addr + 2),
*(bin->p_addr + 1), *(bin->p_addr));
bin->header_info[bin->all_bin_parse_num].header_ver =
GET_32_DATA(*(bin->p_addr + 7), *(bin->p_addr + 6),
*(bin->p_addr + 5), *(bin->p_addr + 4));
bin->header_info[bin->all_bin_parse_num].bin_data_type =
GET_32_DATA(*(bin->p_addr + 11), *(bin->p_addr + 10),
*(bin->p_addr + 9), *(bin->p_addr + 8));
bin->header_info[bin->all_bin_parse_num].bin_data_ver =
GET_32_DATA(*(bin->p_addr + 15), *(bin->p_addr + 14),
*(bin->p_addr + 13), *(bin->p_addr + 12));
bin->header_info[bin->all_bin_parse_num].bin_data_len =
GET_32_DATA(*(bin->p_addr + 19), *(bin->p_addr + 18),
*(bin->p_addr + 17), *(bin->p_addr + 16));
bin->header_info[bin->all_bin_parse_num].ui_ver =
GET_32_DATA(*(bin->p_addr + 23), *(bin->p_addr + 22),
*(bin->p_addr + 21), *(bin->p_addr + 20));
bin->header_info[bin->all_bin_parse_num].reg_byte_len =
GET_32_DATA(*(bin->p_addr + 35), *(bin->p_addr + 34),
*(bin->p_addr + 33), *(bin->p_addr + 32));
bin->header_info[bin->all_bin_parse_num].data_byte_len =
GET_32_DATA(*(bin->p_addr + 39), *(bin->p_addr + 38),
*(bin->p_addr + 37), *(bin->p_addr + 36));
bin->header_info[bin->all_bin_parse_num].device_addr =
GET_32_DATA(*(bin->p_addr + 43), *(bin->p_addr + 42),
*(bin->p_addr + 41), *(bin->p_addr + 40));
for (i = 0; i < 8; i++) {
bin->header_info[bin->all_bin_parse_num].chip_type[i] =
*(bin->p_addr + 24 + i);
}
bin->header_info[bin->all_bin_parse_num].reg_num = 0x00000000;
bin->header_info[bin->all_bin_parse_num].reg_data_byte_len = 0x00000000;
bin->header_info[bin->all_bin_parse_num].download_addr = 0x00000000;
bin->header_info[bin->all_bin_parse_num].app_version = 0x00000000;
bin->header_info[bin->all_bin_parse_num].valid_data_len = 0x00000000;
bin->all_bin_parse_num += 1;
}
static int aw_parse_each_of_multi_bins_1_0_0(unsigned int bin_num, int bin_serial_num,
struct aw_bin *bin)
{
int ret = 0;
unsigned int bin_start_addr = 0;
unsigned int valid_data_len = 0;
DBG("aw_bin_parse enter multi bin branch -- %s\n", __func__);
if (!bin_serial_num) {
bin_start_addr = GET_32_DATA(*(bin->p_addr + 67),
*(bin->p_addr + 66),
*(bin->p_addr + 65),
*(bin->p_addr + 64));
bin->p_addr += (60 + bin_start_addr);
bin->header_info[bin->all_bin_parse_num].valid_data_addr =
bin->header_info[bin->all_bin_parse_num -
1].valid_data_addr + 4 + 8 * bin_num + 60;
} else {
valid_data_len =
bin->header_info[bin->all_bin_parse_num - 1].bin_data_len;
bin->p_addr += (60 + valid_data_len);
bin->header_info[bin->all_bin_parse_num].valid_data_addr =
bin->header_info[bin->all_bin_parse_num - 1].valid_data_addr +
bin->header_info[bin->all_bin_parse_num - 1].bin_data_len + 60;
}
ret = aw_parse_bin_header_1_0_0(bin);
return ret;
}
/* Get the number of bins in multi bins, and set a for loop, loop processing each bin data */
static int aw_get_multi_bin_header_1_0_0(struct aw_bin *bin)
{
int i = 0;
int ret = 0;
unsigned int bin_num = 0;
DBG("aw_bin_parse enter multi bin branch -- %s\n", __func__);
bin_num = GET_32_DATA(*(bin->p_addr + 63),
*(bin->p_addr + 62),
*(bin->p_addr + 61), *(bin->p_addr + 60));
if (bin->multi_bin_parse_num == 1)
bin->header_info[bin->all_bin_parse_num].valid_data_addr = 60;
aw_get_single_bin_header_1_0_0(bin);
for (i = 0; i < bin_num; i++) {
DBG("aw_bin_parse enter multi bin for is %d\n", i);
ret = aw_parse_each_of_multi_bins_1_0_0(bin_num, i, bin);
if (ret < 0)
return ret;
}
return 0;
}
/********************************************************
*
* If the bin framework header version is 1.0.0,
determine the data type of bin, and then perform different processing
according to the data type
If it is a single bin data type, write the data directly into the structure array
If it is a multi-bin data type, first obtain the number of bins,
and then recursively call the bin frame header processing function
according to the bin number to process the frame header information of each bin separately
*
********************************************************/
static int aw_parse_bin_header_1_0_0(struct aw_bin *bin)
{
int ret = 0;
unsigned int bin_data_type;
DBG("enter\n");
bin_data_type = GET_32_DATA(*(bin->p_addr + 11),
*(bin->p_addr + 10),
*(bin->p_addr + 9), *(bin->p_addr + 8));
DBG("aw_bin_parse bin_data_type 0x%x\n", bin_data_type);
switch (bin_data_type) {
case DATA_TYPE_REGISTER:
case DATA_TYPE_DSP_REG:
case DATA_TYPE_SOC_APP:
/* Divided into two processing methods,
* one is single bin processing,
* and the other is single bin processing in multi bin
*/
DBG("aw_bin_parse enter single bin branch\n");
bin->single_bin_parse_num += 1;
DBG("%s bin->single_bin_parse_num is %d\n", __func__,
bin->single_bin_parse_num);
if (!bin->multi_bin_parse_num)
bin->header_info[bin->all_bin_parse_num].valid_data_addr = 60;
aw_get_single_bin_header_1_0_0(bin);
break;
case DATA_TYPE_MULTI_BINS:
/* Get the number of times to enter multi bins */
DBG("aw_bin_parse enter multi bin branch\n");
bin->multi_bin_parse_num += 1;
DBG("%s bin->multi_bin_parse_num is %d\n", __func__,
bin->multi_bin_parse_num);
ret = aw_get_multi_bin_header_1_0_0(bin);
if (ret < 0)
return ret;
break;
default:
DBG_ERR("aw_bin_parse Unrecognized this bin data type\n");
return -EINVAL;
}
return 0;
}
/* get the bin's header version */
static int aw_check_bin_header_version(struct aw_bin *bin)
{
int ret = 0;
unsigned int header_version = 0;
header_version = GET_32_DATA(*(bin->p_addr + 7),
*(bin->p_addr + 6),
*(bin->p_addr + 5), *(bin->p_addr + 4));
DBG("aw_bin_parse header_version 0x%x\n", header_version);
/* Write data to the corresponding structure array
* according to different formats of the bin frame header version
*/
switch (header_version) {
case HEADER_VERSION_1_0_0:
ret = aw_parse_bin_header_1_0_0(bin);
return ret;
default:
DBG_ERR("aw_bin_parse Unrecognized this bin header version\n");
return -EINVAL;
}
}
static int aw_parsing_bin_file(struct aw_bin *bin)
{
int i = 0;
int ret = 0;
DBG("aw_bin_parse code version:%s\n", AWINIC_CODE_VERSION);
if (!bin) {
DBG_ERR("aw_bin_parse bin is NULL\n");
return -EINVAL;
}
bin->p_addr = bin->info.data;
bin->all_bin_parse_num = 0;
bin->multi_bin_parse_num = 0;
bin->single_bin_parse_num = 0;
/* filling bins header info */
ret = aw_check_bin_header_version(bin);
if (ret < 0) {
DBG_ERR("aw_bin_parse check bin header version error\n");
return ret;
}
bin->p_addr = NULL;
/* check bin header info */
for (i = 0; i < bin->all_bin_parse_num; i++) {
/* check sum */
ret = aw_check_sum(bin, i);
if (ret < 0) {
DBG_ERR("aw_bin_parse check sum data error\n");
return ret;
}
/* check bin data version */
ret = aw_check_data_version(bin, i);
if (ret < 0) {
DBG_ERR("aw_bin_parse check data version error\n");
return ret;
}
/* check valid data */
if (bin->header_info[i].bin_data_ver == DATA_VERSION_V1) {
/* check register num */
if (bin->header_info[i].bin_data_type ==
DATA_TYPE_REGISTER) {
ret = aw_check_register_num_v1(bin, i);
if (ret < 0) {
DBG_ERR("aw_bin_parse check register num error\n");
return ret;
}
/* check dsp reg num */
} else if (bin->header_info[i].bin_data_type ==
DATA_TYPE_DSP_REG) {
ret = aw_check_dsp_reg_num_v1(bin, i);
if (ret < 0) {
DBG_ERR("aw_bin_parse check dsp reg num error\n");
return ret;
}
/* check soc app num */
} else if (bin->header_info[i].bin_data_type ==
DATA_TYPE_SOC_APP) {
ret = aw_check_soc_app_num_v1(bin, i);
if (ret < 0) {
DBG_ERR
("aw_bin_parse check soc app num error\n");
return ret;
}
} else {
bin->header_info[i].valid_data_len =
bin->header_info[i].bin_data_len;
}
}
}
DBG("aw_bin_parse parsing success\n");
return 0;
}
/*********************************awinic audio acf*************************************/
static uint8_t aw_dev_parse_crc8_check(unsigned char *data, uint32_t data_size)
{
uint8_t crc_value = 0x00;
uint8_t pdatabuf = 0;
int i;
while (data_size--) {
pdatabuf = *data++;
for (i = 0; i < 8; i++) {
/*if the lowest bit is 1*/
if ((crc_value ^ (pdatabuf)) & 0x01) {
/*Xor multinomial*/
crc_value ^= 0x18;
crc_value >>= 1;
crc_value |= 0x80;
} else {
crc_value >>= 1;
}
pdatabuf >>= 1;
}
}
return crc_value;
}
static int aw_dev_parse_check_acf_by_hdr(struct aw_container *aw_cfg)
{
struct aw_cfg_hdr *cfg_hdr = NULL;
struct aw_cfg_dde *cfg_dde = NULL;
unsigned int end_data_offset = 0;
unsigned int act_data = 0;
unsigned int hdr_ddt_len = 0;
uint8_t act_crc8 = 0;
int i;
cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
/*check file type id is awinic acf file*/
if (cfg_hdr->a_id != ACF_FILE_ID) {
aw_pr_err("not acf type file");
return -EINVAL;
}
hdr_ddt_len = cfg_hdr->a_hdr_offset + cfg_hdr->a_ddt_size;
if (hdr_ddt_len > aw_cfg->len) {
aw_pr_err("hdrlen with ddt_len [%d] overflow file size[%d]",
cfg_hdr->a_hdr_offset, aw_cfg->len);
return -EINVAL;
}
/*check data size*/
cfg_dde = (struct aw_cfg_dde *)((char *)aw_cfg->data + cfg_hdr->a_hdr_offset);
act_data += hdr_ddt_len;
for (i = 0; i < cfg_hdr->a_ddt_num; i++)
act_data += cfg_dde[i].data_size;
if (act_data != aw_cfg->len) {
aw_pr_err("act_data[%d] not equal to file size[%d]!",
act_data, aw_cfg->len);
return -EINVAL;
}
for (i = 0; i < cfg_hdr->a_ddt_num; i++) {
/* data check */
end_data_offset = cfg_dde[i].data_offset + cfg_dde[i].data_size;
if (end_data_offset > aw_cfg->len) {
aw_pr_err("a_ddt_num[%d] end_data_offset[%d] overflow file size[%d]",
i, end_data_offset, aw_cfg->len);
return -EINVAL;
}
/* crc check */
act_crc8 = aw_dev_parse_crc8_check(aw_cfg->data + cfg_dde[i].data_offset, cfg_dde[i].data_size);
if (act_crc8 != cfg_dde[i].data_crc) {
aw_pr_err("a_ddt_num[%d] crc8 check failed, act_crc8:0x%x != data_crc 0x%x",
i, (uint32_t)act_crc8, cfg_dde[i].data_crc);
return -EINVAL;
}
}
aw_pr_info("project name [%s]", cfg_hdr->a_project);
aw_pr_info("custom name [%s]", cfg_hdr->a_custom);
aw_pr_info("version name [%d.%d.%d.%d]", cfg_hdr->a_version[3], cfg_hdr->a_version[2],
cfg_hdr->a_version[1], cfg_hdr->a_version[0]);
aw_pr_info("author id %d", cfg_hdr->a_author_id);
return 0;
}
static int aw_dev_parse_check_acf_by_hdr_v_1_0_0_0(struct aw_container *aw_cfg)
{
struct aw_cfg_hdr *cfg_hdr = NULL;
struct aw_cfg_dde_v_1_0_0_0 *cfg_dde = NULL;
unsigned int end_data_offset = 0;
unsigned int act_data = 0;
unsigned int hdr_ddt_len = 0;
uint8_t act_crc8 = 0;
int i;
cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
/*check file type id is awinic acf file*/
if (cfg_hdr->a_id != ACF_FILE_ID) {
aw_pr_err("not acf type file");
return -EINVAL;
}
hdr_ddt_len = cfg_hdr->a_hdr_offset + cfg_hdr->a_ddt_size;
if (hdr_ddt_len > aw_cfg->len) {
aw_pr_err("hdrlen with ddt_len [%d] overflow file size[%d]",
cfg_hdr->a_hdr_offset, aw_cfg->len);
return -EINVAL;
}
/*check data size*/
cfg_dde = (struct aw_cfg_dde_v_1_0_0_0 *)((char *)aw_cfg->data + cfg_hdr->a_hdr_offset);
act_data += hdr_ddt_len;
for (i = 0; i < cfg_hdr->a_ddt_num; i++)
act_data += cfg_dde[i].data_size;
if (act_data != aw_cfg->len) {
aw_pr_err("act_data[%d] not equal to file size[%d]!",
act_data, aw_cfg->len);
return -EINVAL;
}
for (i = 0; i < cfg_hdr->a_ddt_num; i++) {
/* data check */
end_data_offset = cfg_dde[i].data_offset + cfg_dde[i].data_size;
if (end_data_offset > aw_cfg->len) {
aw_pr_err("a_ddt_num[%d] end_data_offset[%d] overflow file size[%d]",
i, end_data_offset, aw_cfg->len);
return -EINVAL;
}
/* crc check */
act_crc8 = aw_dev_parse_crc8_check(aw_cfg->data + cfg_dde[i].data_offset, cfg_dde[i].data_size);
if (act_crc8 != cfg_dde[i].data_crc) {
aw_pr_err("a_ddt_num[%d] crc8 check failed, act_crc8:0x%x != data_crc 0x%x",
i, (uint32_t)act_crc8, cfg_dde[i].data_crc);
return -EINVAL;
}
}
aw_pr_info("project name [%s]", cfg_hdr->a_project);
aw_pr_info("custom name [%s]", cfg_hdr->a_custom);
aw_pr_info("version name [%d.%d.%d.%d]", cfg_hdr->a_version[3], cfg_hdr->a_version[2],
cfg_hdr->a_version[1], cfg_hdr->a_version[0]);
aw_pr_info("author id %d", cfg_hdr->a_author_id);
return 0;
}
int aw882xx_dev_parse_check_acf(struct aw_container *aw_cfg)
{
struct aw_cfg_hdr *cfg_hdr = NULL;
if (aw_cfg == NULL) {
aw_pr_err("aw_prof is NULL");
return -ENOMEM;
}
if (aw_cfg->len < sizeof(struct aw_cfg_hdr)) {
aw_pr_err("cfg hdr size[%d] overflow file size[%d]",
aw_cfg->len, (int)sizeof(struct aw_cfg_hdr));
return -EINVAL;
}
cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
switch (cfg_hdr->a_hdr_version) {
case AW_CFG_HDR_VER_0_0_0_1:
return aw_dev_parse_check_acf_by_hdr(aw_cfg);
case AW_CFG_HDR_VER_1_0_0_0:
return aw_dev_parse_check_acf_by_hdr_v_1_0_0_0(aw_cfg);
default:
aw_pr_err("unsupported hdr_version [0x%x]", cfg_hdr->a_hdr_version);
return -EINVAL;
}
return 0;
}
static int aw_dev_parse_raw_reg(struct aw_device *aw_dev,
uint8_t *data, uint32_t data_len, struct aw_prof_desc *prof_desc)
{
aw_dev_info(aw_dev->dev, "data_size:%d enter", data_len);
if (data_len % 4) {
aw_dev_err(aw_dev->dev, "bin data len get error!");
return -EINVAL;
}
prof_desc->sec_desc[AW_PROFILE_DATA_TYPE_REG].data = data;
prof_desc->sec_desc[AW_PROFILE_DATA_TYPE_REG].len = data_len;
prof_desc->prof_st = AW_PROFILE_OK;
return 0;
}
static int aw_dev_parse_raw_dsp(struct aw_device *aw_dev,
uint8_t *data, uint32_t data_len, struct aw_prof_desc *prof_desc)
{
aw_dev_info(aw_dev->dev, "data_size:%d enter", data_len);
prof_desc->sec_desc[AW_PROFILE_DATA_TYPE_DSP].data = data;
prof_desc->sec_desc[AW_PROFILE_DATA_TYPE_DSP].len = data_len;
return 0;
}
static int aw_dev_parse_reg_bin_with_hdr(struct aw_device *aw_dev,
uint8_t *data, uint32_t data_len, struct aw_prof_desc *prof_desc)
{
struct aw_bin *aw_bin = NULL;
int ret;
aw_dev_info(aw_dev->dev, "data_size:%d enter", data_len);
aw_bin = kzalloc(data_len + sizeof(struct aw_bin), GFP_KERNEL);
if (aw_bin == NULL)
return -ENOMEM;
aw_bin->info.len = data_len;
memcpy(aw_bin->info.data, data, data_len);
ret = aw_parsing_bin_file(aw_bin);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "parse bin failed");
goto parse_bin_failed;
}
if ((aw_bin->all_bin_parse_num != 1) ||
(aw_bin->header_info[0].bin_data_type != DATA_TYPE_REGISTER)) {
aw_dev_err(aw_dev->dev, "bin num or type error");
goto parse_bin_failed;
}
if (aw_bin->header_info[0].valid_data_len % 4) {
aw_dev_err(aw_dev->dev, "bin data len get error!");
return -EINVAL;
}
prof_desc->sec_desc[AW_PROFILE_DATA_TYPE_REG].data =
data + aw_bin->header_info[0].valid_data_addr;
prof_desc->sec_desc[AW_PROFILE_DATA_TYPE_REG].len =
aw_bin->header_info[0].valid_data_len;
prof_desc->prof_st = AW_PROFILE_OK;
kfree(aw_bin);
aw_bin = NULL;
return 0;
parse_bin_failed:
kfree(aw_bin);
aw_bin = NULL;
return ret;
}
static int aw_dev_parse_data_by_sec_type(struct aw_device *aw_dev, struct aw_cfg_hdr *cfg_hdr,
struct aw_cfg_dde *prof_hdr, struct aw_prof_desc *scene_prof_desc)
{
switch (prof_hdr->data_type) {
case ACF_SEC_TYPE_REG:
return aw_dev_parse_raw_reg(aw_dev,
(uint8_t *)cfg_hdr + prof_hdr->data_offset,
prof_hdr->data_size,
scene_prof_desc);
case ACF_SEC_TYPE_HDR_REG:
return aw_dev_parse_reg_bin_with_hdr(aw_dev,
(uint8_t *)cfg_hdr + prof_hdr->data_offset,
prof_hdr->data_size,
scene_prof_desc);
case ACF_SEC_TYPE_MONITOR:
return aw882xx_monitor_parse_fw(&aw_dev->monitor_desc,
(uint8_t *)cfg_hdr + prof_hdr->data_offset,
prof_hdr->data_size);
}
return 0;
}
static int aw_dev_parse_dev_type(struct aw_device *aw_dev,
struct aw_cfg_hdr *prof_hdr, struct aw_all_prof_info *all_prof_info)
{
int i = 0;
int ret;
int sec_num = 0;
struct aw_cfg_dde *cfg_dde =
(struct aw_cfg_dde *)((char *)prof_hdr + prof_hdr->a_hdr_offset);
aw_dev_info(aw_dev->dev, "enter");
for (i = 0; i < prof_hdr->a_ddt_num; i++) {
if ((aw_dev->i2c->adapter->nr == cfg_dde[i].dev_bus) &&
(aw_dev->i2c->addr == cfg_dde[i].dev_addr) &&
(cfg_dde[i].type == AW_DEV_TYPE_ID)) {
if (cfg_dde[i].data_type != ACF_SEC_TYPE_MONITOR) {
ret = aw_dev_parse_data_by_sec_type(aw_dev, prof_hdr, &cfg_dde[i],
&all_prof_info->prof_desc[cfg_dde[i].dev_profile]);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "parse dev driver bin data failed");
return ret;
}
sec_num++;
} else {
ret = aw_dev_parse_data_by_sec_type(aw_dev, prof_hdr, &cfg_dde[i], NULL);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "parse monitor bin data failed");
return ret;
}
sec_num++;
}
}
}
if (sec_num == 0) {
aw_dev_info(aw_dev->dev, "get dev type num is %d, please use default", sec_num);
return AW_DEV_TYPE_NONE;
}
return AW_DEV_TYPE_OK;
}
static int aw_dev_parse_dev_default_type(struct aw_device *aw_dev,
struct aw_cfg_hdr *prof_hdr, struct aw_all_prof_info *all_prof_info)
{
int i = 0;
int ret;
int sec_num = 0;
struct aw_cfg_dde *cfg_dde =
(struct aw_cfg_dde *)((char *)prof_hdr + prof_hdr->a_hdr_offset);
aw_dev_info(aw_dev->dev, "enter");
for (i = 0; i < prof_hdr->a_ddt_num; i++) {
if ((aw_dev->channel == cfg_dde[i].dev_index) &&
(cfg_dde[i].type == AW_DEV_DEFAULT_TYPE_ID)) {
if (cfg_dde[i].data_type != ACF_SEC_TYPE_MONITOR) {
ret = aw_dev_parse_data_by_sec_type(aw_dev, prof_hdr, &cfg_dde[i],
&all_prof_info->prof_desc[cfg_dde[i].dev_profile]);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "parse dev driver bin data failed");
return ret;
}
} else {
ret = aw_dev_parse_data_by_sec_type(aw_dev, prof_hdr, &cfg_dde[i], NULL);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "parse monitor bin data failed");
return ret;
}
}
sec_num++;
}
}
if (sec_num == 0) {
aw_dev_err(aw_dev->dev, "get dev default type failed, get num[%d]", sec_num);
return -EINVAL;
}
return 0;
}
static int aw_dev_parse_skt_type(struct aw_device *aw_dev,
struct aw_cfg_hdr *prof_hdr, struct aw_all_prof_info *all_prof_info)
{
int i = 0;
int ret;
int sec_num = 0;
struct aw_cfg_dde *cfg_dde =
(struct aw_cfg_dde *)((char *)prof_hdr + prof_hdr->a_hdr_offset);
aw_dev_info(aw_dev->dev, "enter");
for (i = 0; i < prof_hdr->a_ddt_num; i++) {
if ((aw_dev->channel == cfg_dde[i].dev_index) &&
(cfg_dde[i].type == AW_SKT_TYPE_ID)) {
if (cfg_dde[i].data_type == ACF_SEC_TYPE_DSP) {
ret = aw_dev_parse_raw_dsp(aw_dev,
(uint8_t *)prof_hdr + cfg_dde[i].data_offset,
cfg_dde[i].data_size,
&all_prof_info->prof_desc[cfg_dde[i].dev_profile]);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "parse dsp bin data failed");
return ret;
}
sec_num++;
}
}
}
aw_dev_info(aw_dev->dev, "get dsp data prof cnt is %d ", sec_num);
return 0;
}
static int aw_dev_parse_get_vaild_prof(struct aw_device *aw_dev,
struct aw_all_prof_info all_prof_info)
{
int i;
int num = 0;
struct aw_prof_desc *prof_desc = all_prof_info.prof_desc;
struct aw_prof_info *prof_info = &aw_dev->prof_info;
for (i = 0; i < AW_PROFILE_MAX; i++) {
if (prof_desc[i].prof_st == AW_PROFILE_OK)
aw_dev->prof_info.count++;
}
aw_dev_info(aw_dev->dev, "get vaild profile:%d", aw_dev->prof_info.count);
if (!aw_dev->prof_info.count) {
aw_dev_err(aw_dev->dev, "no profile data");
return -EPERM;
}
prof_info->prof_desc = kzalloc(prof_info->count * sizeof(struct aw_prof_desc), GFP_KERNEL);
if (prof_info->prof_desc == NULL)
return -ENOMEM;
for (i = 0; i < AW_PROFILE_MAX; i++) {
if (prof_desc[i].prof_st == AW_PROFILE_OK) {
if (num >= prof_info->count) {
aw_dev_err(aw_dev->dev, "get scene num[%d] overflow count[%d]",
num, prof_info->count);
return -ENOMEM;
}
prof_info->prof_desc[num] = prof_desc[i];
prof_info->prof_desc[num].id = i;
num++;
}
}
return 0;
}
static int aw_dev_parse_acf_by_hdr(struct aw_device *aw_dev,
struct aw_cfg_hdr *prof_hdr)
{
int ret;
struct aw_all_prof_info all_prof_info;
memset(&all_prof_info, 0, sizeof(struct aw_all_prof_info));
ret = aw_dev_parse_dev_type(aw_dev, prof_hdr, &all_prof_info);
if (ret < 0) {
return ret;
} else if (ret == AW_DEV_TYPE_NONE) {
aw_dev_info(aw_dev->dev, "get dev type num is0, parse default dev type");
ret = aw_dev_parse_dev_default_type(aw_dev, prof_hdr, &all_prof_info);
if (ret < 0)
return ret;
}
ret = aw_dev_parse_skt_type(aw_dev, prof_hdr, &all_prof_info);
if (ret < 0)
return ret;
ret = aw_dev_parse_get_vaild_prof(aw_dev, all_prof_info);
if (ret < 0)
return ret;
aw_dev->prof_info.prof_name_list = profile_name;
return 0;
}
/******************************************bin format V1.0.0.0********************************************/
static int aw_dev_parse_get_scene_count_v1_0_0_0(struct aw_device *aw_dev,
struct aw_container *aw_cfg, uint32_t *count, int *is_default)
{
struct aw_cfg_hdr *cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
struct aw_cfg_dde_v_1_0_0_0 *cfg_dde =
(struct aw_cfg_dde_v_1_0_0_0 *)(aw_cfg->data + cfg_hdr->a_hdr_offset);
int i = 0;
for (i = 0; i < cfg_hdr->a_ddt_num; ++i) {
if (((cfg_dde[i].data_type == ACF_SEC_TYPE_REG) ||
(cfg_dde[i].data_type == ACF_SEC_TYPE_HDR_REG)) &&
(cfg_dde[i].type == AW_DEV_TYPE_ID) &&
((aw_dev->i2c->adapter->nr == cfg_dde[i].dev_bus) &&
(aw_dev->i2c->addr == cfg_dde[i].dev_addr)) &&
(aw_dev->chip_id == cfg_dde[i].chip_id)) {
(*count)++;
(*is_default) = 0;
}
}
if ((*count) == 0) {
for (i = 0; i < cfg_hdr->a_ddt_num; ++i) {
if (((cfg_dde[i].data_type == ACF_SEC_TYPE_REG) ||
(cfg_dde[i].data_type == ACF_SEC_TYPE_HDR_REG)) &&
(cfg_dde[i].type == AW_DEV_DEFAULT_TYPE_ID) &&
(aw_dev->channel == cfg_dde[i].dev_index) &&
(aw_dev->chip_id == cfg_dde[i].chip_id)) {
(*count)++;
(*is_default) = 1;
}
}
}
if ((*count) == 0) {
aw_dev_err(aw_dev->dev, "can't find scene");
return -EINVAL;
}
aw_dev_info(aw_dev->dev, "scene count is %d", (*count));
return 0;
}
static int aw_dev_parse_create_prof_name_list_v_1_0_0_0(struct aw_device *aw_dev)
{
struct aw_prof_info *prof_info = &aw_dev->prof_info;
struct aw_prof_desc *prof_desc = prof_info->prof_desc;
int i;
if (prof_desc == NULL) {
aw_dev_err(aw_dev->dev, "prof_desc is NULL");
return -EINVAL;
}
prof_info->prof_name_list = devm_kzalloc(aw_dev->dev,
prof_info->count * PROFILE_STR_MAX,
GFP_KERNEL);
if (prof_info->prof_name_list == NULL) {
aw_dev_err(aw_dev->dev, "prof_name_list devm_kzalloc failed");
return -ENOMEM;
}
for (i = 0; i < prof_info->count; i++) {
prof_desc[i].id = i;
prof_info->prof_name_list[i] = prof_desc[i].prf_str;
aw_dev_info(aw_dev->dev, "prof name is %s", prof_info->prof_name_list[i]);
}
return 0;
}
static int aw_dev_parse_drv_type_v_1_0_0_0(struct aw_device *aw_dev,
struct aw_cfg_hdr *prof_hdr, struct aw_cfg_dde_v_1_0_0_0 *cfg_dde, int *cur_scene_id)
{
int ret = -1;
struct aw_prof_info *prof_info = &aw_dev->prof_info;
switch (cfg_dde->data_type) {
case ACF_SEC_TYPE_REG:
ret = aw_dev_parse_raw_reg(aw_dev,
(uint8_t *)prof_hdr + cfg_dde->data_offset,
cfg_dde->data_size, &prof_info->prof_desc[*cur_scene_id]);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "parse reg bin failed");
return ret;
}
prof_info->prof_desc[*cur_scene_id].prf_str = cfg_dde->dev_profile_str;
prof_info->prof_desc[*cur_scene_id].id = cfg_dde->dev_profile;
(*cur_scene_id)++;
break;
case ACF_SEC_TYPE_HDR_REG:
ret = aw_dev_parse_reg_bin_with_hdr(aw_dev,
(uint8_t *)prof_hdr + cfg_dde->data_offset,
cfg_dde->data_size, &prof_info->prof_desc[*cur_scene_id]);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "parse reg bin with hdr failed");
return ret;
}
prof_info->prof_desc[*cur_scene_id].prf_str = cfg_dde->dev_profile_str;
prof_info->prof_desc[*cur_scene_id].id = cfg_dde->dev_profile;
(*cur_scene_id)++;
break;
case ACF_SEC_TYPE_MONITOR:
ret = aw882xx_monitor_parse_fw(&aw_dev->monitor_desc,
(uint8_t *)prof_hdr + cfg_dde->data_offset,
cfg_dde->data_size);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "parse monitor bin failed");
return ret;
}
break;
default:
aw_dev_err(aw_dev->dev, "unsupport bin type!");
return -EINVAL;
}
return ret;
}
static int aw_dev_parse_dev_type_v_1_0_0_0(struct aw_device *aw_dev,
struct aw_cfg_hdr *prof_hdr)
{
int i = 0;
int ret = -1;
int cur_scene_id = 0;
struct aw_cfg_dde_v_1_0_0_0 *cfg_dde =
(struct aw_cfg_dde_v_1_0_0_0 *)((char *)prof_hdr + prof_hdr->a_hdr_offset);
aw_dev_info(aw_dev->dev, "enter");
for (i = 0; i < prof_hdr->a_ddt_num; i++) {
if ((cfg_dde[i].type == AW_DEV_TYPE_ID) &&
(aw_dev->i2c->adapter->nr == cfg_dde[i].dev_bus) &&
(aw_dev->i2c->addr == cfg_dde[i].dev_addr) &&
(aw_dev->chip_id == cfg_dde[i].chip_id)) {
ret = aw_dev_parse_drv_type_v_1_0_0_0(aw_dev,
prof_hdr, &cfg_dde[i], &cur_scene_id);
if (ret < 0)
return ret;
}
}
if (cur_scene_id == 0) {
aw_dev_info(aw_dev->dev, "get dev type num is %d", cur_scene_id);
return -EINVAL;
}
return 0;
}
static int aw_dev_parse_dev_default_type_v_1_0_0_0(struct aw_device *aw_dev,
struct aw_cfg_hdr *prof_hdr)
{
int i = 0;
int ret;
int cur_scene_id = 0;
struct aw_cfg_dde_v_1_0_0_0 *cfg_dde =
(struct aw_cfg_dde_v_1_0_0_0 *)((char *)prof_hdr + prof_hdr->a_hdr_offset);
aw_dev_info(aw_dev->dev, "enter");
for (i = 0; i < prof_hdr->a_ddt_num; i++) {
if ((cfg_dde[i].type == AW_DEV_DEFAULT_TYPE_ID) &&
(aw_dev->channel == cfg_dde[i].dev_index) &&
(aw_dev->chip_id == cfg_dde[i].chip_id)) {
ret = aw_dev_parse_drv_type_v_1_0_0_0(aw_dev,
prof_hdr, &cfg_dde[i], &cur_scene_id);
if (ret < 0)
return ret;
}
}
if (cur_scene_id == 0) {
aw_dev_err(aw_dev->dev, "get dev default type failed, get num[%d]", cur_scene_id);
return -EINVAL;
}
return 0;
}
static int aw_dev_parse_get_scene_id_v_1_0_0_0(struct aw_device *aw_dev, char *scene_str, int *scene_id)
{
struct aw_prof_info *prof_info = &aw_dev->prof_info;
int i;
if (scene_str == NULL) {
aw_dev_err(aw_dev->dev, "scene_str is NULL");
return -EINVAL;
}
for (i = 0; i < prof_info->count; i++) {
if (prof_info->prof_desc[i].prf_str == NULL) {
aw_dev_err(aw_dev->dev, "porfile name is NULL");
return -EINVAL;
}
if (!strcmp(prof_info->prof_desc[i].prf_str, scene_str)) {
*scene_id = i;
return 0;
}
}
aw_dev_err(aw_dev->dev, "not found scene:%s", scene_str);
return -EINVAL;
}
static int aw_dev_parse_skt_type_v_1_0_0_0(struct aw_device *aw_dev,
struct aw_cfg_hdr *prof_hdr)
{
int i = 0;
int ret;
int scene_id = 0;
struct aw_prof_info *prof_info = &aw_dev->prof_info;
struct aw_cfg_dde_v_1_0_0_0 *cfg_dde =
(struct aw_cfg_dde_v_1_0_0_0 *)((char *)prof_hdr + prof_hdr->a_hdr_offset);
aw_dev_info(aw_dev->dev, "enter");
for (i = 0; i < prof_hdr->a_ddt_num; i++) {
if ((cfg_dde[i].type == AW_SKT_TYPE_ID) &&
(cfg_dde[i].data_type == ACF_SEC_TYPE_DSP) &&
(aw_dev->channel == cfg_dde[i].dev_index) &&
(aw_dev->chip_id == cfg_dde[i].chip_id)) {
ret = aw_dev_parse_get_scene_id_v_1_0_0_0(aw_dev, cfg_dde[i].dev_profile_str, &scene_id);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "get scene id failed");
return ret;
}
ret = aw_dev_parse_raw_dsp(aw_dev,
(uint8_t *)prof_hdr + cfg_dde[i].data_offset,
cfg_dde[i].data_size, &prof_info->prof_desc[scene_id]);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "parse dsp bin data failed");
return ret;
}
}
}
return 0;
}
static int aw_dev_parse_by_hdr_v_1_0_0_0(struct aw_device *aw_dev,
struct aw_cfg_hdr *cfg_hdr, int is_default)
{
int ret;
if (is_default) {
ret = aw_dev_parse_dev_default_type_v_1_0_0_0(aw_dev, cfg_hdr);
if (ret < 0)
return ret;
} else {
ret = aw_dev_parse_dev_type_v_1_0_0_0(aw_dev, cfg_hdr);
if (ret < 0)
return ret;
}
ret = aw_dev_parse_skt_type_v_1_0_0_0(aw_dev, cfg_hdr);
if (ret < 0)
return ret;
return 0;
}
static int aw_dev_parse_acf_by_hdr_v_1_0_0_0(struct aw_device *aw_dev, struct aw_container *aw_cfg)
{
struct aw_prof_info *prof_info = &aw_dev->prof_info;
struct aw_cfg_hdr *cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
int ret;
int is_default = 0;
ret = aw_dev_parse_get_scene_count_v1_0_0_0(aw_dev, aw_cfg, &prof_info->count, &is_default);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "get scene count failed");
return ret;
}
prof_info->prof_desc = devm_kzalloc(aw_dev->dev,
prof_info->count * sizeof(struct aw_prof_desc),
GFP_KERNEL);
if (prof_info->prof_desc == NULL) {
aw_dev_err(aw_dev->dev, "prof_desc devm_kzalloc failed");
return -ENOMEM;
}
ret = aw_dev_parse_by_hdr_v_1_0_0_0(aw_dev, cfg_hdr, is_default);
if (ret < 0) {
aw_dev_err(aw_dev->dev, " failed");
return ret;
}
ret = aw_dev_parse_create_prof_name_list_v_1_0_0_0(aw_dev);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "create prof name list failed");
return ret;
}
return 0;
}
int aw882xx_dev_parse_acf(struct aw_device *aw_dev, struct aw_container *aw_cfg)
{
struct aw_cfg_hdr *cfg_hdr = NULL;
int ret;
aw_dev_info(aw_dev->dev, "enter");
cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
switch (cfg_hdr->a_hdr_version) {
case AW_CFG_HDR_VER_0_0_0_1:
ret = aw_dev_parse_acf_by_hdr(aw_dev, cfg_hdr);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "hdr_cersion[0x%x] parse failed",
cfg_hdr->a_hdr_version);
return ret;
}
break;
case AW_CFG_HDR_VER_1_0_0_0:
ret = aw_dev_parse_acf_by_hdr_v_1_0_0_0(aw_dev, aw_cfg);
if (ret < 0) {
aw_dev_err(aw_dev->dev, "hdr_cersion[0x%x] parse failed",
cfg_hdr->a_hdr_version);
return ret;
}
break;
default:
aw_pr_err("unsupported hdr_version [0x%x]", cfg_hdr->a_hdr_version);
return -EINVAL;
}
aw_dev_info(aw_dev->dev, "parse cfg success");
return 0;
}
char *aw882xx_dev_get_prof_name(struct aw_device *aw_dev, int index)
{
struct aw_prof_desc *prof_desc = NULL;
struct aw_prof_info *prof_info = &aw_dev->prof_info;
if (index < 0) {
aw_dev_err(aw_dev->dev, "index[%d] error", index);
return NULL;
}
if (index >= prof_info->count) {
aw_dev_err(aw_dev->dev, "index[%d] overflow count[%d]",
index, aw_dev->prof_info.count);
return NULL;
}
prof_desc = &prof_info->prof_desc[index];
return prof_info->prof_name_list[prof_desc->id];
}
int aw88xx_dev_get_profile_name(struct aw_device *aw_dev, char *name, int index)
{
int dev_profile_id = 0;
int ret = 0;
struct aw_prof_info *prof_info = &aw_dev->prof_info;
if (index < 0) {
aw_dev_err(aw_dev->dev, "index[%d] error", index);
return -EINVAL;
}
if (index > prof_info->count) {
aw_dev_err(aw_dev->dev, "index[%d] overflow dev prof num[%d]",
index, prof_info->count);
return -EINVAL;
}
dev_profile_id = prof_info->prof_desc[index].id;
ret = strscpy(name, prof_info->prof_name_list[dev_profile_id],
strlen(prof_info->prof_name_list[dev_profile_id]) + 1);
if (ret < 0)
return ret;
return 0;
}
struct aw_sec_data_desc *aw882xx_dev_get_prof_data(struct aw_device *aw_dev, int index, int data_type)
{
struct aw_sec_data_desc *sec_data = NULL;
struct aw_prof_desc *prof_desc = NULL;
struct aw_prof_info *prof_info = &aw_dev->prof_info;
if (index >= prof_info->count) {
aw_dev_err(aw_dev->dev, "index[%d] overflow count[%d]",
index, prof_info->count);
return NULL;
}
prof_desc = &aw_dev->prof_info.prof_desc[index];
if (data_type >= AW_PROFILE_DATA_TYPE_MAX) {
aw_dev_err(aw_dev->dev, "unsupport data type id [%d]", data_type);
return NULL;
}
sec_data = &prof_desc->sec_desc[data_type];
aw_dev_dbg(aw_dev->dev, "get prof[%s] data len[%d]",
prof_info->prof_name_list[prof_desc->id], sec_data->len);
return sec_data;
}
int aw882xx_dev_set_profile_index(struct aw_device *aw_dev, int index)
{
struct aw_prof_info *prof_info = &aw_dev->prof_info;
struct mutex *ext_dsp_prof_wr_lock = NULL;
char *ext_dsp_prof_write = NULL;
if (index >= prof_info->count || index < 0)
return -EINVAL;
aw_dev->set_prof = index;
aw_dev_info(aw_dev->dev, "set prof[%s]",
prof_info->prof_name_list[prof_info->prof_desc[index].id]);
ext_dsp_prof_wr_lock = aw882xx_dev_get_ext_dsp_prof_wr_lock();
ext_dsp_prof_write = aw882xx_dev_get_ext_dsp_prof_write();
mutex_lock(ext_dsp_prof_wr_lock);
*ext_dsp_prof_write = AW_EXT_DSP_WRITE_NONE;
mutex_unlock(ext_dsp_prof_wr_lock);
return 0;
}
int aw882xx_dev_get_profile_count(struct aw_device *aw_dev)
{
if (aw_dev == NULL) {
aw_pr_err("aw_dev is NULL");
return -ENOMEM;
}
return aw_dev->prof_info.count;
}
int aw882xx_dev_check_profile_index(struct aw_device *aw_dev, int index)
{
if ((index >= aw_dev->prof_info.count) || (index < 0))
return -EINVAL;
else
return 0;
}
int aw882xx_dev_get_profile_index(struct aw_device *aw_dev)
{
return aw_dev->set_prof;
}
Reference in New Issue View Git Blame Copy Permalink