14345865bSWeidong Wang // SPDX-License-Identifier: GPL-2.0-only
24345865bSWeidong Wang //
34345865bSWeidong Wang // aw88395_lib.c  -- ACF bin parsing and check library file for aw88395
44345865bSWeidong Wang //
54345865bSWeidong Wang // Copyright (c) 2022-2023 AWINIC Technology CO., LTD
64345865bSWeidong Wang //
74345865bSWeidong Wang // Author: Bruce zhao <zhaolei@awinic.com>
84345865bSWeidong Wang //
94345865bSWeidong Wang 
104345865bSWeidong Wang #include <linux/crc8.h>
114345865bSWeidong Wang #include <linux/i2c.h>
124345865bSWeidong Wang #include "aw88395_lib.h"
134345865bSWeidong Wang #include "aw88395_device.h"
147f4ec778SWeidong Wang #include "aw88395_reg.h"
154345865bSWeidong Wang 
164345865bSWeidong Wang #define AW88395_CRC8_POLYNOMIAL 0x8C
174345865bSWeidong Wang DECLARE_CRC8_TABLE(aw_crc8_table);
184345865bSWeidong Wang 
194345865bSWeidong Wang static char *profile_name[AW88395_PROFILE_MAX] = {
204345865bSWeidong Wang 	"Music", "Voice", "Voip", "Ringtone",
214345865bSWeidong Wang 	"Ringtone_hs", "Lowpower", "Bypass",
224345865bSWeidong Wang 	"Mmi", "Fm", "Notification", "Receiver"
234345865bSWeidong Wang };
244345865bSWeidong Wang 
254345865bSWeidong Wang static int aw_parse_bin_header(struct aw_device *aw_dev, struct aw_bin *bin);
264345865bSWeidong Wang 
aw_check_sum(struct aw_device * aw_dev,struct aw_bin * bin,int bin_num)274345865bSWeidong Wang static int aw_check_sum(struct aw_device *aw_dev, struct aw_bin *bin, int bin_num)
284345865bSWeidong Wang {
294345865bSWeidong Wang 	unsigned char *p_check_sum;
304345865bSWeidong Wang 	unsigned int sum_data = 0;
314345865bSWeidong Wang 	unsigned int check_sum;
324345865bSWeidong Wang 	unsigned int i, len;
334345865bSWeidong Wang 
344345865bSWeidong Wang 	p_check_sum = &(bin->info.data[(bin->header_info[bin_num].valid_data_addr -
354345865bSWeidong Wang 						bin->header_info[bin_num].header_len)]);
364345865bSWeidong Wang 	len = bin->header_info[bin_num].bin_data_len + bin->header_info[bin_num].header_len;
374345865bSWeidong Wang 	check_sum = le32_to_cpup((void *)p_check_sum);
384345865bSWeidong Wang 
394345865bSWeidong Wang 	for (i = 4; i < len; i++)
404345865bSWeidong Wang 		sum_data += *(p_check_sum + i);
414345865bSWeidong Wang 
424345865bSWeidong Wang 	dev_dbg(aw_dev->dev, "%s -- check_sum = %p, check_sum = 0x%x, sum_data = 0x%x",
434345865bSWeidong Wang 					__func__, p_check_sum, check_sum, sum_data);
444345865bSWeidong Wang 	if (sum_data != check_sum) {
454345865bSWeidong Wang 		dev_err(aw_dev->dev, "%s. CheckSum Fail.bin_num=%d, CheckSum:0x%x, SumData:0x%x",
464345865bSWeidong Wang 				__func__, bin_num, check_sum, sum_data);
474345865bSWeidong Wang 		return -EINVAL;
484345865bSWeidong Wang 	}
494345865bSWeidong Wang 
504345865bSWeidong Wang 	return 0;
514345865bSWeidong Wang }
524345865bSWeidong Wang 
aw_check_data_version(struct aw_device * aw_dev,struct aw_bin * bin,int bin_num)534345865bSWeidong Wang static int aw_check_data_version(struct aw_device *aw_dev, struct aw_bin *bin, int bin_num)
544345865bSWeidong Wang {
554345865bSWeidong Wang 	if (bin->header_info[bin_num].bin_data_ver < DATA_VERSION_V1 ||
564345865bSWeidong Wang 		bin->header_info[bin_num].bin_data_ver > DATA_VERSION_MAX) {
574345865bSWeidong Wang 		dev_err(aw_dev->dev, "aw_bin_parse Unrecognized this bin data version\n");
584345865bSWeidong Wang 		return -EINVAL;
594345865bSWeidong Wang 	}
604345865bSWeidong Wang 
614345865bSWeidong Wang 	return 0;
624345865bSWeidong Wang }
634345865bSWeidong Wang 
aw_check_register_num(struct aw_device * aw_dev,struct aw_bin * bin,int bin_num)644345865bSWeidong Wang static int aw_check_register_num(struct aw_device *aw_dev, struct aw_bin *bin, int bin_num)
654345865bSWeidong Wang {
664345865bSWeidong Wang 	struct bin_header_info temp_info = bin->header_info[bin_num];
674345865bSWeidong Wang 	unsigned int check_register_num, parse_register_num;
684345865bSWeidong Wang 	unsigned char *p_check_sum;
694345865bSWeidong Wang 
704345865bSWeidong Wang 	p_check_sum = &(bin->info.data[(temp_info.valid_data_addr)]);
714345865bSWeidong Wang 
724345865bSWeidong Wang 	parse_register_num = le32_to_cpup((void *)p_check_sum);
734345865bSWeidong Wang 	check_register_num = (bin->header_info[bin_num].bin_data_len - CHECK_REGISTER_NUM_OFFSET) /
744345865bSWeidong Wang 				(bin->header_info[bin_num].reg_byte_len +
754345865bSWeidong Wang 				bin->header_info[bin_num].data_byte_len);
764345865bSWeidong Wang 	dev_dbg(aw_dev->dev, "%s,parse_register_num = 0x%x,check_register_num = 0x%x\n",
774345865bSWeidong Wang 				__func__, parse_register_num, check_register_num);
784345865bSWeidong Wang 	if (parse_register_num != check_register_num) {
794345865bSWeidong Wang 		dev_err(aw_dev->dev, "%s parse_register_num = 0x%x,check_register_num = 0x%x\n",
804345865bSWeidong Wang 				__func__, parse_register_num, check_register_num);
814345865bSWeidong Wang 		return -EINVAL;
824345865bSWeidong Wang 	}
834345865bSWeidong Wang 
844345865bSWeidong Wang 	bin->header_info[bin_num].reg_num = parse_register_num;
854345865bSWeidong Wang 	bin->header_info[bin_num].valid_data_len = temp_info.bin_data_len - VALID_DATA_LEN;
864345865bSWeidong Wang 	bin->header_info[bin_num].valid_data_addr = temp_info.valid_data_addr + VALID_DATA_ADDR;
874345865bSWeidong Wang 
884345865bSWeidong Wang 	return 0;
894345865bSWeidong Wang }
904345865bSWeidong Wang 
aw_check_dsp_reg_num(struct aw_device * aw_dev,struct aw_bin * bin,int bin_num)914345865bSWeidong Wang static int aw_check_dsp_reg_num(struct aw_device *aw_dev, struct aw_bin *bin, int bin_num)
924345865bSWeidong Wang {
934345865bSWeidong Wang 	struct bin_header_info temp_info = bin->header_info[bin_num];
944345865bSWeidong Wang 	unsigned int check_dsp_reg_num, parse_dsp_reg_num;
954345865bSWeidong Wang 	unsigned char *p_check_sum;
964345865bSWeidong Wang 
974345865bSWeidong Wang 	p_check_sum = &(bin->info.data[(temp_info.valid_data_addr)]);
984345865bSWeidong Wang 
994345865bSWeidong Wang 	parse_dsp_reg_num = le32_to_cpup((void *)(p_check_sum + PARSE_DSP_REG_NUM));
1004345865bSWeidong Wang 	bin->header_info[bin_num].reg_data_byte_len =
1014345865bSWeidong Wang 			le32_to_cpup((void *)(p_check_sum + REG_DATA_BYTP_LEN));
1024345865bSWeidong Wang 	check_dsp_reg_num = (bin->header_info[bin_num].bin_data_len - CHECK_DSP_REG_NUM) /
1034345865bSWeidong Wang 				bin->header_info[bin_num].reg_data_byte_len;
1044345865bSWeidong Wang 	dev_dbg(aw_dev->dev, "%s bin_num = %d, parse_dsp_reg_num = 0x%x, check_dsp_reg_num = 0x%x",
1054345865bSWeidong Wang 					__func__, bin_num, check_dsp_reg_num, check_dsp_reg_num);
1064345865bSWeidong Wang 	if (parse_dsp_reg_num != check_dsp_reg_num) {
1074345865bSWeidong Wang 		dev_err(aw_dev->dev, "aw_bin_parse check dsp reg num error\n");
1084345865bSWeidong Wang 		dev_err(aw_dev->dev, "%s parse_dsp_reg_num = 0x%x, check_dsp_reg_num = 0x%x",
1094345865bSWeidong Wang 					__func__, check_dsp_reg_num, check_dsp_reg_num);
1104345865bSWeidong Wang 		return -EINVAL;
1114345865bSWeidong Wang 	}
1124345865bSWeidong Wang 
1134345865bSWeidong Wang 	bin->header_info[bin_num].download_addr = le32_to_cpup((void *)p_check_sum);
1144345865bSWeidong Wang 	bin->header_info[bin_num].reg_num = parse_dsp_reg_num;
1154345865bSWeidong Wang 	bin->header_info[bin_num].valid_data_len = temp_info.bin_data_len - DSP_VALID_DATA_LEN;
1164345865bSWeidong Wang 	bin->header_info[bin_num].valid_data_addr = temp_info.valid_data_addr +
1174345865bSWeidong Wang 								DSP_VALID_DATA_ADDR;
1184345865bSWeidong Wang 
1194345865bSWeidong Wang 	return 0;
1204345865bSWeidong Wang }
1214345865bSWeidong Wang 
aw_check_soc_app_num(struct aw_device * aw_dev,struct aw_bin * bin,int bin_num)1224345865bSWeidong Wang static int aw_check_soc_app_num(struct aw_device *aw_dev, struct aw_bin *bin, int bin_num)
1234345865bSWeidong Wang {
1244345865bSWeidong Wang 	struct bin_header_info temp_info = bin->header_info[bin_num];
1254345865bSWeidong Wang 	unsigned int check_soc_app_num, parse_soc_app_num;
1264345865bSWeidong Wang 	unsigned char *p_check_sum;
1274345865bSWeidong Wang 
1284345865bSWeidong Wang 	p_check_sum = &(bin->info.data[(temp_info.valid_data_addr)]);
1294345865bSWeidong Wang 
1304345865bSWeidong Wang 	bin->header_info[bin_num].app_version = le32_to_cpup((void *)p_check_sum);
1314345865bSWeidong Wang 	parse_soc_app_num = le32_to_cpup((void *)(p_check_sum + PARSE_SOC_APP_NUM));
1324345865bSWeidong Wang 	check_soc_app_num = bin->header_info[bin_num].bin_data_len - CHECK_SOC_APP_NUM;
1334345865bSWeidong Wang 	dev_dbg(aw_dev->dev, "%s bin_num = %d, parse_soc_app_num=0x%x, check_soc_app_num = 0x%x\n",
1344345865bSWeidong Wang 					__func__, bin_num, parse_soc_app_num, check_soc_app_num);
1354345865bSWeidong Wang 	if (parse_soc_app_num != check_soc_app_num) {
1364345865bSWeidong Wang 		dev_err(aw_dev->dev, "%s parse_soc_app_num=0x%x, check_soc_app_num = 0x%x\n",
1374345865bSWeidong Wang 					__func__, parse_soc_app_num, check_soc_app_num);
1384345865bSWeidong Wang 		return -EINVAL;
1394345865bSWeidong Wang 	}
1404345865bSWeidong Wang 
1414345865bSWeidong Wang 	bin->header_info[bin_num].reg_num = parse_soc_app_num;
1424345865bSWeidong Wang 	bin->header_info[bin_num].download_addr = le32_to_cpup((void *)(p_check_sum +
1434345865bSWeidong Wang 								APP_DOWNLOAD_ADDR));
1444345865bSWeidong Wang 	bin->header_info[bin_num].valid_data_len = temp_info.bin_data_len - APP_VALID_DATA_LEN;
1454345865bSWeidong Wang 	bin->header_info[bin_num].valid_data_addr = temp_info.valid_data_addr +
1464345865bSWeidong Wang 								APP_VALID_DATA_ADDR;
1474345865bSWeidong Wang 
1484345865bSWeidong Wang 	return 0;
1494345865bSWeidong Wang }
1504345865bSWeidong Wang 
aw_get_single_bin_header(struct aw_bin * bin)1514345865bSWeidong Wang static void aw_get_single_bin_header(struct aw_bin *bin)
1524345865bSWeidong Wang {
1534345865bSWeidong Wang 	memcpy((void *)&bin->header_info[bin->all_bin_parse_num], bin->p_addr, DATA_LEN);
1544345865bSWeidong Wang 
1554345865bSWeidong Wang 	bin->header_info[bin->all_bin_parse_num].header_len = HEADER_LEN;
1564345865bSWeidong Wang 	bin->all_bin_parse_num += 1;
1574345865bSWeidong Wang }
1584345865bSWeidong Wang 
aw_parse_one_of_multi_bins(struct aw_device * aw_dev,unsigned int bin_num,int bin_serial_num,struct aw_bin * bin)1594345865bSWeidong Wang static int aw_parse_one_of_multi_bins(struct aw_device *aw_dev, unsigned int bin_num,
1604345865bSWeidong Wang 					int bin_serial_num, struct aw_bin *bin)
1614345865bSWeidong Wang {
1624345865bSWeidong Wang 	struct bin_header_info aw_bin_header_info;
1634345865bSWeidong Wang 	unsigned int bin_start_addr;
1644345865bSWeidong Wang 	unsigned int valid_data_len;
1654345865bSWeidong Wang 
1664345865bSWeidong Wang 	if (bin->info.len < sizeof(struct bin_header_info)) {
1674345865bSWeidong Wang 		dev_err(aw_dev->dev, "bin_header_info size[%d] overflow file size[%d]\n",
1684345865bSWeidong Wang 				(int)sizeof(struct bin_header_info), bin->info.len);
1694345865bSWeidong Wang 		return -EINVAL;
1704345865bSWeidong Wang 	}
1714345865bSWeidong Wang 
1724345865bSWeidong Wang 	aw_bin_header_info = bin->header_info[bin->all_bin_parse_num - 1];
1734345865bSWeidong Wang 	if (!bin_serial_num) {
1744345865bSWeidong Wang 		bin_start_addr = le32_to_cpup((void *)(bin->p_addr + START_ADDR_OFFSET));
1754345865bSWeidong Wang 		bin->p_addr += (HEADER_LEN + bin_start_addr);
1764345865bSWeidong Wang 		bin->header_info[bin->all_bin_parse_num].valid_data_addr =
1774345865bSWeidong Wang 			aw_bin_header_info.valid_data_addr + VALID_DATA_ADDR + 8 * bin_num +
1784345865bSWeidong Wang 			VALID_DATA_ADDR_OFFSET;
1794345865bSWeidong Wang 	} else {
1804345865bSWeidong Wang 		valid_data_len = aw_bin_header_info.bin_data_len;
1814345865bSWeidong Wang 		bin->p_addr += (HDADER_LEN + valid_data_len);
1824345865bSWeidong Wang 		bin->header_info[bin->all_bin_parse_num].valid_data_addr =
1834345865bSWeidong Wang 		    aw_bin_header_info.valid_data_addr + aw_bin_header_info.bin_data_len +
1844345865bSWeidong Wang 		    VALID_DATA_ADDR_OFFSET;
1854345865bSWeidong Wang 	}
1864345865bSWeidong Wang 
1874345865bSWeidong Wang 	return aw_parse_bin_header(aw_dev, bin);
1884345865bSWeidong Wang }
1894345865bSWeidong Wang 
aw_get_multi_bin_header(struct aw_device * aw_dev,struct aw_bin * bin)1904345865bSWeidong Wang static int aw_get_multi_bin_header(struct aw_device *aw_dev, struct aw_bin *bin)
1914345865bSWeidong Wang {
1924345865bSWeidong Wang 	unsigned int bin_num, i;
1934345865bSWeidong Wang 	int ret;
1944345865bSWeidong Wang 
1954345865bSWeidong Wang 	bin_num = le32_to_cpup((void *)(bin->p_addr + VALID_DATA_ADDR_OFFSET));
1964345865bSWeidong Wang 	if (bin->multi_bin_parse_num == 1)
1974345865bSWeidong Wang 		bin->header_info[bin->all_bin_parse_num].valid_data_addr =
1984345865bSWeidong Wang 							VALID_DATA_ADDR_OFFSET;
1994345865bSWeidong Wang 
2004345865bSWeidong Wang 	aw_get_single_bin_header(bin);
2014345865bSWeidong Wang 
2024345865bSWeidong Wang 	for (i = 0; i < bin_num; i++) {
2034345865bSWeidong Wang 		dev_dbg(aw_dev->dev, "aw_bin_parse enter multi bin for is %d\n", i);
2044345865bSWeidong Wang 		ret = aw_parse_one_of_multi_bins(aw_dev, bin_num, i, bin);
2054345865bSWeidong Wang 		if (ret < 0)
2064345865bSWeidong Wang 			return ret;
2074345865bSWeidong Wang 	}
2084345865bSWeidong Wang 
2094345865bSWeidong Wang 	return 0;
2104345865bSWeidong Wang }
2114345865bSWeidong Wang 
aw_parse_bin_header(struct aw_device * aw_dev,struct aw_bin * bin)2124345865bSWeidong Wang static int aw_parse_bin_header(struct aw_device *aw_dev, struct aw_bin *bin)
2134345865bSWeidong Wang {
2144345865bSWeidong Wang 	unsigned int bin_data_type;
2154345865bSWeidong Wang 
2164345865bSWeidong Wang 	if (bin->info.len < sizeof(struct bin_header_info)) {
2174345865bSWeidong Wang 		dev_err(aw_dev->dev, "bin_header_info size[%d] overflow file size[%d]\n",
2184345865bSWeidong Wang 				(int)sizeof(struct bin_header_info), bin->info.len);
2194345865bSWeidong Wang 		return -EINVAL;
2204345865bSWeidong Wang 	}
2214345865bSWeidong Wang 
2224345865bSWeidong Wang 	bin_data_type = le32_to_cpup((void *)(bin->p_addr + BIN_DATA_TYPE_OFFSET));
2234345865bSWeidong Wang 	dev_dbg(aw_dev->dev, "aw_bin_parse bin_data_type 0x%x\n", bin_data_type);
2244345865bSWeidong Wang 	switch (bin_data_type) {
2254345865bSWeidong Wang 	case DATA_TYPE_REGISTER:
2264345865bSWeidong Wang 	case DATA_TYPE_DSP_REG:
2274345865bSWeidong Wang 	case DATA_TYPE_SOC_APP:
2284345865bSWeidong Wang 		bin->single_bin_parse_num += 1;
2294345865bSWeidong Wang 		dev_dbg(aw_dev->dev, "%s bin->single_bin_parse_num is %d\n", __func__,
2304345865bSWeidong Wang 						bin->single_bin_parse_num);
2314345865bSWeidong Wang 		if (!bin->multi_bin_parse_num)
2324345865bSWeidong Wang 			bin->header_info[bin->all_bin_parse_num].valid_data_addr =
2334345865bSWeidong Wang 								VALID_DATA_ADDR_OFFSET;
2344345865bSWeidong Wang 		aw_get_single_bin_header(bin);
2354345865bSWeidong Wang 		return 0;
2364345865bSWeidong Wang 	case DATA_TYPE_MULTI_BINS:
2374345865bSWeidong Wang 		bin->multi_bin_parse_num += 1;
2384345865bSWeidong Wang 		dev_dbg(aw_dev->dev, "%s bin->multi_bin_parse_num is %d\n", __func__,
2394345865bSWeidong Wang 						bin->multi_bin_parse_num);
2404345865bSWeidong Wang 		return aw_get_multi_bin_header(aw_dev, bin);
2414345865bSWeidong Wang 	default:
2424345865bSWeidong Wang 		dev_dbg(aw_dev->dev, "%s There is no corresponding type\n", __func__);
2434345865bSWeidong Wang 		return 0;
2444345865bSWeidong Wang 	}
2454345865bSWeidong Wang }
2464345865bSWeidong Wang 
aw_check_bin_header_version(struct aw_device * aw_dev,struct aw_bin * bin)2474345865bSWeidong Wang static int aw_check_bin_header_version(struct aw_device *aw_dev, struct aw_bin *bin)
2484345865bSWeidong Wang {
2494345865bSWeidong Wang 	unsigned int header_version;
2504345865bSWeidong Wang 
2514345865bSWeidong Wang 	header_version = le32_to_cpup((void *)(bin->p_addr + HEADER_VERSION_OFFSET));
2524345865bSWeidong Wang 	dev_dbg(aw_dev->dev, "aw_bin_parse header_version 0x%x\n", header_version);
2534345865bSWeidong Wang 
2544345865bSWeidong Wang 	switch (header_version) {
2554345865bSWeidong Wang 	case HEADER_VERSION_V1:
2564345865bSWeidong Wang 		return aw_parse_bin_header(aw_dev, bin);
2574345865bSWeidong Wang 	default:
2584345865bSWeidong Wang 		dev_err(aw_dev->dev, "aw_bin_parse Unrecognized this bin header version\n");
2594345865bSWeidong Wang 		return -EINVAL;
2604345865bSWeidong Wang 	}
2614345865bSWeidong Wang }
2624345865bSWeidong Wang 
aw_parsing_bin_file(struct aw_device * aw_dev,struct aw_bin * bin)2634345865bSWeidong Wang static int aw_parsing_bin_file(struct aw_device *aw_dev, struct aw_bin *bin)
2644345865bSWeidong Wang {
2654345865bSWeidong Wang 	int ret = -EINVAL;
2664345865bSWeidong Wang 	int i;
2674345865bSWeidong Wang 
2684345865bSWeidong Wang 	if (!bin) {
2694345865bSWeidong Wang 		dev_err(aw_dev->dev, "aw_bin_parse bin is NULL\n");
2704345865bSWeidong Wang 		return ret;
2714345865bSWeidong Wang 	}
2724345865bSWeidong Wang 	bin->p_addr = bin->info.data;
2734345865bSWeidong Wang 	bin->all_bin_parse_num = 0;
2744345865bSWeidong Wang 	bin->multi_bin_parse_num = 0;
2754345865bSWeidong Wang 	bin->single_bin_parse_num = 0;
2764345865bSWeidong Wang 
2774345865bSWeidong Wang 	ret = aw_check_bin_header_version(aw_dev, bin);
2784345865bSWeidong Wang 	if (ret < 0) {
2794345865bSWeidong Wang 		dev_err(aw_dev->dev, "aw_bin_parse check bin header version error\n");
2804345865bSWeidong Wang 		return ret;
2814345865bSWeidong Wang 	}
2824345865bSWeidong Wang 
2834345865bSWeidong Wang 	for (i = 0; i < bin->all_bin_parse_num; i++) {
2844345865bSWeidong Wang 		ret = aw_check_sum(aw_dev, bin, i);
2854345865bSWeidong Wang 		if (ret < 0) {
2864345865bSWeidong Wang 			dev_err(aw_dev->dev, "aw_bin_parse check sum data error\n");
2874345865bSWeidong Wang 			return ret;
2884345865bSWeidong Wang 		}
2894345865bSWeidong Wang 		ret = aw_check_data_version(aw_dev, bin, i);
2904345865bSWeidong Wang 		if (ret < 0) {
2914345865bSWeidong Wang 			dev_err(aw_dev->dev, "aw_bin_parse check data version error\n");
2924345865bSWeidong Wang 			return ret;
2934345865bSWeidong Wang 		}
2944345865bSWeidong Wang 		if (bin->header_info[i].bin_data_ver == DATA_VERSION_V1) {
2954345865bSWeidong Wang 			switch (bin->header_info[i].bin_data_type) {
2964345865bSWeidong Wang 			case DATA_TYPE_REGISTER:
2974345865bSWeidong Wang 				ret = aw_check_register_num(aw_dev, bin, i);
2984345865bSWeidong Wang 				break;
2994345865bSWeidong Wang 			case DATA_TYPE_DSP_REG:
3004345865bSWeidong Wang 				ret = aw_check_dsp_reg_num(aw_dev, bin, i);
3014345865bSWeidong Wang 				break;
3024345865bSWeidong Wang 			case DATA_TYPE_SOC_APP:
3034345865bSWeidong Wang 				ret = aw_check_soc_app_num(aw_dev, bin, i);
3044345865bSWeidong Wang 				break;
3054345865bSWeidong Wang 			default:
3064345865bSWeidong Wang 				bin->header_info[i].valid_data_len =
3074345865bSWeidong Wang 						bin->header_info[i].bin_data_len;
3084345865bSWeidong Wang 				ret = 0;
3094345865bSWeidong Wang 				break;
3104345865bSWeidong Wang 			}
3114345865bSWeidong Wang 			if (ret < 0)
3124345865bSWeidong Wang 				return ret;
3134345865bSWeidong Wang 		}
3144345865bSWeidong Wang 	}
3154345865bSWeidong Wang 
3164345865bSWeidong Wang 	return 0;
3174345865bSWeidong Wang }
3184345865bSWeidong Wang 
aw_dev_parse_raw_reg(unsigned char * data,unsigned int data_len,struct aw_prof_desc * prof_desc)3194345865bSWeidong Wang static int aw_dev_parse_raw_reg(unsigned char *data, unsigned int data_len,
3204345865bSWeidong Wang 		struct aw_prof_desc *prof_desc)
3214345865bSWeidong Wang {
3224345865bSWeidong Wang 	prof_desc->sec_desc[AW88395_DATA_TYPE_REG].data = data;
3234345865bSWeidong Wang 	prof_desc->sec_desc[AW88395_DATA_TYPE_REG].len = data_len;
3244345865bSWeidong Wang 
3254345865bSWeidong Wang 	prof_desc->prof_st = AW88395_PROFILE_OK;
3264345865bSWeidong Wang 
3274345865bSWeidong Wang 	return 0;
3284345865bSWeidong Wang }
3294345865bSWeidong Wang 
aw_dev_parse_raw_dsp_cfg(unsigned char * data,unsigned int data_len,struct aw_prof_desc * prof_desc)3304345865bSWeidong Wang static int aw_dev_parse_raw_dsp_cfg(unsigned char *data, unsigned int data_len,
3314345865bSWeidong Wang 		struct aw_prof_desc *prof_desc)
3324345865bSWeidong Wang {
3334345865bSWeidong Wang 	if (data_len & 0x01)
3344345865bSWeidong Wang 		return -EINVAL;
3354345865bSWeidong Wang 
3364345865bSWeidong Wang 	swab16_array((u16 *)data, data_len >> 1);
3374345865bSWeidong Wang 
3384345865bSWeidong Wang 	prof_desc->sec_desc[AW88395_DATA_TYPE_DSP_CFG].data = data;
3394345865bSWeidong Wang 	prof_desc->sec_desc[AW88395_DATA_TYPE_DSP_CFG].len = data_len;
3404345865bSWeidong Wang 
3414345865bSWeidong Wang 	prof_desc->prof_st = AW88395_PROFILE_OK;
3424345865bSWeidong Wang 
3434345865bSWeidong Wang 	return 0;
3444345865bSWeidong Wang }
3454345865bSWeidong Wang 
aw_dev_parse_raw_dsp_fw(unsigned char * data,unsigned int data_len,struct aw_prof_desc * prof_desc)3464345865bSWeidong Wang static int aw_dev_parse_raw_dsp_fw(unsigned char *data,	unsigned int data_len,
3474345865bSWeidong Wang 		struct aw_prof_desc *prof_desc)
3484345865bSWeidong Wang {
3494345865bSWeidong Wang 	if (data_len & 0x01)
3504345865bSWeidong Wang 		return -EINVAL;
3514345865bSWeidong Wang 
3524345865bSWeidong Wang 	swab16_array((u16 *)data, data_len >> 1);
3534345865bSWeidong Wang 
3544345865bSWeidong Wang 	prof_desc->sec_desc[AW88395_DATA_TYPE_DSP_FW].data = data;
3554345865bSWeidong Wang 	prof_desc->sec_desc[AW88395_DATA_TYPE_DSP_FW].len = data_len;
3564345865bSWeidong Wang 
3574345865bSWeidong Wang 	prof_desc->prof_st = AW88395_PROFILE_OK;
3584345865bSWeidong Wang 
3594345865bSWeidong Wang 	return 0;
3604345865bSWeidong Wang }
3614345865bSWeidong Wang 
aw_dev_prof_parse_multi_bin(struct aw_device * aw_dev,unsigned char * data,unsigned int data_len,struct aw_prof_desc * prof_desc)3624345865bSWeidong Wang static int aw_dev_prof_parse_multi_bin(struct aw_device *aw_dev, unsigned char *data,
3634345865bSWeidong Wang 				unsigned int data_len, struct aw_prof_desc *prof_desc)
3644345865bSWeidong Wang {
3654345865bSWeidong Wang 	struct aw_bin *aw_bin;
3664345865bSWeidong Wang 	int ret;
3674345865bSWeidong Wang 	int i;
3684345865bSWeidong Wang 
3694345865bSWeidong Wang 	aw_bin = devm_kzalloc(aw_dev->dev, data_len + sizeof(struct aw_bin), GFP_KERNEL);
3704345865bSWeidong Wang 	if (!aw_bin)
3714345865bSWeidong Wang 		return -ENOMEM;
3724345865bSWeidong Wang 
3734345865bSWeidong Wang 	aw_bin->info.len = data_len;
3744345865bSWeidong Wang 	memcpy(aw_bin->info.data, data, data_len);
3754345865bSWeidong Wang 
3764345865bSWeidong Wang 	ret = aw_parsing_bin_file(aw_dev, aw_bin);
3774345865bSWeidong Wang 	if (ret < 0) {
3784345865bSWeidong Wang 		dev_err(aw_dev->dev, "parse bin failed");
3794345865bSWeidong Wang 		goto parse_bin_failed;
3804345865bSWeidong Wang 	}
3814345865bSWeidong Wang 
3824345865bSWeidong Wang 	for (i = 0; i < aw_bin->all_bin_parse_num; i++) {
3834345865bSWeidong Wang 		switch (aw_bin->header_info[i].bin_data_type) {
3844345865bSWeidong Wang 		case DATA_TYPE_REGISTER:
3854345865bSWeidong Wang 			prof_desc->sec_desc[AW88395_DATA_TYPE_REG].len =
3864345865bSWeidong Wang 					aw_bin->header_info[i].valid_data_len;
3874345865bSWeidong Wang 			prof_desc->sec_desc[AW88395_DATA_TYPE_REG].data =
3884345865bSWeidong Wang 					data + aw_bin->header_info[i].valid_data_addr;
3894345865bSWeidong Wang 			break;
3904345865bSWeidong Wang 		case DATA_TYPE_DSP_REG:
3914345865bSWeidong Wang 			if (aw_bin->header_info[i].valid_data_len & 0x01) {
3924345865bSWeidong Wang 				ret = -EINVAL;
3934345865bSWeidong Wang 				goto parse_bin_failed;
3944345865bSWeidong Wang 			}
3954345865bSWeidong Wang 
3964345865bSWeidong Wang 			swab16_array((u16 *)(data + aw_bin->header_info[i].valid_data_addr),
3974345865bSWeidong Wang 					aw_bin->header_info[i].valid_data_len >> 1);
3984345865bSWeidong Wang 
3994345865bSWeidong Wang 			prof_desc->sec_desc[AW88395_DATA_TYPE_DSP_CFG].len =
4004345865bSWeidong Wang 					aw_bin->header_info[i].valid_data_len;
4014345865bSWeidong Wang 			prof_desc->sec_desc[AW88395_DATA_TYPE_DSP_CFG].data =
4024345865bSWeidong Wang 					data + aw_bin->header_info[i].valid_data_addr;
4034345865bSWeidong Wang 			break;
4044345865bSWeidong Wang 		case DATA_TYPE_DSP_FW:
4054345865bSWeidong Wang 		case DATA_TYPE_SOC_APP:
4064345865bSWeidong Wang 			if (aw_bin->header_info[i].valid_data_len & 0x01) {
4074345865bSWeidong Wang 				ret = -EINVAL;
4084345865bSWeidong Wang 				goto parse_bin_failed;
4094345865bSWeidong Wang 			}
4104345865bSWeidong Wang 
4114345865bSWeidong Wang 			swab16_array((u16 *)(data + aw_bin->header_info[i].valid_data_addr),
4124345865bSWeidong Wang 					aw_bin->header_info[i].valid_data_len >> 1);
4134345865bSWeidong Wang 
4144345865bSWeidong Wang 			prof_desc->fw_ver = aw_bin->header_info[i].app_version;
4154345865bSWeidong Wang 			prof_desc->sec_desc[AW88395_DATA_TYPE_DSP_FW].len =
4164345865bSWeidong Wang 					aw_bin->header_info[i].valid_data_len;
4174345865bSWeidong Wang 			prof_desc->sec_desc[AW88395_DATA_TYPE_DSP_FW].data =
4184345865bSWeidong Wang 					data + aw_bin->header_info[i].valid_data_addr;
4194345865bSWeidong Wang 			break;
4204345865bSWeidong Wang 		default:
4214345865bSWeidong Wang 			dev_dbg(aw_dev->dev, "bin_data_type not found");
4224345865bSWeidong Wang 			break;
4234345865bSWeidong Wang 		}
4244345865bSWeidong Wang 	}
4254345865bSWeidong Wang 	prof_desc->prof_st = AW88395_PROFILE_OK;
4264345865bSWeidong Wang 	ret =  0;
4274345865bSWeidong Wang 
4284345865bSWeidong Wang parse_bin_failed:
4294345865bSWeidong Wang 	devm_kfree(aw_dev->dev, aw_bin);
4304345865bSWeidong Wang 	return ret;
4314345865bSWeidong Wang }
4324345865bSWeidong Wang 
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)4337f4ec778SWeidong Wang static int aw_dev_parse_reg_bin_with_hdr(struct aw_device *aw_dev,
4347f4ec778SWeidong Wang 			uint8_t *data, uint32_t data_len, struct aw_prof_desc *prof_desc)
4357f4ec778SWeidong Wang {
4367f4ec778SWeidong Wang 	struct aw_bin *aw_bin;
4377f4ec778SWeidong Wang 	int ret;
4387f4ec778SWeidong Wang 
4397f4ec778SWeidong Wang 	aw_bin = devm_kzalloc(aw_dev->dev, data_len + sizeof(*aw_bin), GFP_KERNEL);
4407f4ec778SWeidong Wang 	if (!aw_bin)
4417f4ec778SWeidong Wang 		return -ENOMEM;
4427f4ec778SWeidong Wang 
4437f4ec778SWeidong Wang 	aw_bin->info.len = data_len;
4447f4ec778SWeidong Wang 	memcpy(aw_bin->info.data, data, data_len);
4457f4ec778SWeidong Wang 
4467f4ec778SWeidong Wang 	ret = aw_parsing_bin_file(aw_dev, aw_bin);
4477f4ec778SWeidong Wang 	if (ret < 0) {
4487f4ec778SWeidong Wang 		dev_err(aw_dev->dev, "parse bin failed");
4497f4ec778SWeidong Wang 		goto parse_bin_failed;
4507f4ec778SWeidong Wang 	}
4517f4ec778SWeidong Wang 
4527f4ec778SWeidong Wang 	if ((aw_bin->all_bin_parse_num != 1) ||
4537f4ec778SWeidong Wang 		(aw_bin->header_info[0].bin_data_type != DATA_TYPE_REGISTER)) {
4547f4ec778SWeidong Wang 		dev_err(aw_dev->dev, "bin num or type error");
455*cf0ba445SDan Carpenter 		ret = -EINVAL;
4567f4ec778SWeidong Wang 		goto parse_bin_failed;
4577f4ec778SWeidong Wang 	}
4587f4ec778SWeidong Wang 
4597f4ec778SWeidong Wang 	if (aw_bin->header_info[0].valid_data_len % 4) {
4607f4ec778SWeidong Wang 		dev_err(aw_dev->dev, "bin data len get error!");
461*cf0ba445SDan Carpenter 		ret = -EINVAL;
4627f4ec778SWeidong Wang 		goto parse_bin_failed;
4637f4ec778SWeidong Wang 	}
4647f4ec778SWeidong Wang 
4657f4ec778SWeidong Wang 	prof_desc->sec_desc[AW88395_DATA_TYPE_REG].data =
4667f4ec778SWeidong Wang 				data + aw_bin->header_info[0].valid_data_addr;
4677f4ec778SWeidong Wang 	prof_desc->sec_desc[AW88395_DATA_TYPE_REG].len =
4687f4ec778SWeidong Wang 				aw_bin->header_info[0].valid_data_len;
4697f4ec778SWeidong Wang 	prof_desc->prof_st = AW88395_PROFILE_OK;
4707f4ec778SWeidong Wang 
4717f4ec778SWeidong Wang 	devm_kfree(aw_dev->dev, aw_bin);
4727f4ec778SWeidong Wang 	aw_bin = NULL;
4737f4ec778SWeidong Wang 
4747f4ec778SWeidong Wang 	return 0;
4757f4ec778SWeidong Wang 
4767f4ec778SWeidong Wang parse_bin_failed:
4777f4ec778SWeidong Wang 	devm_kfree(aw_dev->dev, aw_bin);
4787f4ec778SWeidong Wang 	aw_bin = NULL;
4797f4ec778SWeidong Wang 	return ret;
4807f4ec778SWeidong Wang }
4817f4ec778SWeidong Wang 
aw_dev_parse_data_by_sec_type(struct aw_device * aw_dev,struct aw_cfg_hdr * cfg_hdr,struct aw_cfg_dde * cfg_dde,struct aw_prof_desc * scene_prof_desc)4824345865bSWeidong Wang static int aw_dev_parse_data_by_sec_type(struct aw_device *aw_dev, struct aw_cfg_hdr *cfg_hdr,
4834345865bSWeidong Wang 			struct aw_cfg_dde *cfg_dde, struct aw_prof_desc *scene_prof_desc)
4844345865bSWeidong Wang {
4854345865bSWeidong Wang 	switch (cfg_dde->data_type) {
4864345865bSWeidong Wang 	case ACF_SEC_TYPE_REG:
4874345865bSWeidong Wang 		return aw_dev_parse_raw_reg((u8 *)cfg_hdr + cfg_dde->data_offset,
4884345865bSWeidong Wang 				cfg_dde->data_size, scene_prof_desc);
4894345865bSWeidong Wang 	case ACF_SEC_TYPE_DSP_CFG:
4904345865bSWeidong Wang 		return aw_dev_parse_raw_dsp_cfg((u8 *)cfg_hdr + cfg_dde->data_offset,
4914345865bSWeidong Wang 				cfg_dde->data_size, scene_prof_desc);
4924345865bSWeidong Wang 	case ACF_SEC_TYPE_DSP_FW:
4934345865bSWeidong Wang 		return aw_dev_parse_raw_dsp_fw(
4944345865bSWeidong Wang 				(u8 *)cfg_hdr + cfg_dde->data_offset,
4954345865bSWeidong Wang 				cfg_dde->data_size, scene_prof_desc);
4964345865bSWeidong Wang 	case ACF_SEC_TYPE_MULTIPLE_BIN:
4974345865bSWeidong Wang 		return aw_dev_prof_parse_multi_bin(
4984345865bSWeidong Wang 				aw_dev, (u8 *)cfg_hdr + cfg_dde->data_offset,
4994345865bSWeidong Wang 				cfg_dde->data_size, scene_prof_desc);
5007f4ec778SWeidong Wang 	case ACF_SEC_TYPE_HDR_REG:
5017f4ec778SWeidong Wang 		return aw_dev_parse_reg_bin_with_hdr(aw_dev, (u8 *)cfg_hdr + cfg_dde->data_offset,
5027f4ec778SWeidong Wang 				cfg_dde->data_size, scene_prof_desc);
5034345865bSWeidong Wang 	default:
5044345865bSWeidong Wang 		dev_err(aw_dev->dev, "%s cfg_dde->data_type = %d\n", __func__, cfg_dde->data_type);
5054345865bSWeidong Wang 		break;
5064345865bSWeidong Wang 	}
5074345865bSWeidong Wang 
5084345865bSWeidong Wang 	return 0;
5094345865bSWeidong Wang }
5104345865bSWeidong Wang 
aw_dev_parse_dev_type(struct aw_device * aw_dev,struct aw_cfg_hdr * prof_hdr,struct aw_all_prof_info * all_prof_info)5114345865bSWeidong Wang static int aw_dev_parse_dev_type(struct aw_device *aw_dev,
5124345865bSWeidong Wang 		struct aw_cfg_hdr *prof_hdr, struct aw_all_prof_info *all_prof_info)
5134345865bSWeidong Wang {
5144345865bSWeidong Wang 	struct aw_cfg_dde *cfg_dde =
5154345865bSWeidong Wang 		(struct aw_cfg_dde *)((char *)prof_hdr + prof_hdr->hdr_offset);
5164345865bSWeidong Wang 	int sec_num = 0;
5174345865bSWeidong Wang 	int ret, i;
5184345865bSWeidong Wang 
5194345865bSWeidong Wang 	for (i = 0; i < prof_hdr->ddt_num; i++) {
5204345865bSWeidong Wang 		if ((aw_dev->i2c->adapter->nr == cfg_dde[i].dev_bus) &&
5214345865bSWeidong Wang 		    (aw_dev->i2c->addr == cfg_dde[i].dev_addr) &&
5224345865bSWeidong Wang 		    (cfg_dde[i].type == AW88395_DEV_TYPE_ID) &&
5234345865bSWeidong Wang 		    (cfg_dde[i].data_type != ACF_SEC_TYPE_MONITOR)) {
5244345865bSWeidong Wang 			if (cfg_dde[i].dev_profile >= AW88395_PROFILE_MAX) {
5254345865bSWeidong Wang 				dev_err(aw_dev->dev, "dev_profile [%d] overflow",
5264345865bSWeidong Wang 							cfg_dde[i].dev_profile);
5274345865bSWeidong Wang 				return -EINVAL;
5284345865bSWeidong Wang 			}
5294345865bSWeidong Wang 
5304345865bSWeidong Wang 			ret = aw_dev_parse_data_by_sec_type(aw_dev, prof_hdr, &cfg_dde[i],
5314345865bSWeidong Wang 					&all_prof_info->prof_desc[cfg_dde[i].dev_profile]);
5324345865bSWeidong Wang 			if (ret < 0) {
5334345865bSWeidong Wang 				dev_err(aw_dev->dev, "parse failed");
5344345865bSWeidong Wang 				return ret;
5354345865bSWeidong Wang 			}
5364345865bSWeidong Wang 			sec_num++;
5374345865bSWeidong Wang 		}
5384345865bSWeidong Wang 	}
5394345865bSWeidong Wang 
5404345865bSWeidong Wang 	if (sec_num == 0) {
5414345865bSWeidong Wang 		dev_dbg(aw_dev->dev, "get dev type num is %d, please use default", sec_num);
5424345865bSWeidong Wang 		return AW88395_DEV_TYPE_NONE;
5434345865bSWeidong Wang 	}
5444345865bSWeidong Wang 
5454345865bSWeidong Wang 	return AW88395_DEV_TYPE_OK;
5464345865bSWeidong Wang }
5474345865bSWeidong Wang 
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)5484345865bSWeidong Wang static int aw_dev_parse_dev_default_type(struct aw_device *aw_dev,
5494345865bSWeidong Wang 		struct aw_cfg_hdr *prof_hdr, struct aw_all_prof_info *all_prof_info)
5504345865bSWeidong Wang {
5514345865bSWeidong Wang 	struct aw_cfg_dde *cfg_dde =
5524345865bSWeidong Wang 		(struct aw_cfg_dde *)((char *)prof_hdr + prof_hdr->hdr_offset);
5534345865bSWeidong Wang 	int sec_num = 0;
5544345865bSWeidong Wang 	int ret, i;
5554345865bSWeidong Wang 
5564345865bSWeidong Wang 	for (i = 0; i < prof_hdr->ddt_num; i++) {
5574345865bSWeidong Wang 		if ((aw_dev->channel == cfg_dde[i].dev_index) &&
5584345865bSWeidong Wang 		    (cfg_dde[i].type == AW88395_DEV_DEFAULT_TYPE_ID) &&
5594345865bSWeidong Wang 		    (cfg_dde[i].data_type != ACF_SEC_TYPE_MONITOR)) {
5604345865bSWeidong Wang 			if (cfg_dde[i].dev_profile >= AW88395_PROFILE_MAX) {
5614345865bSWeidong Wang 				dev_err(aw_dev->dev, "dev_profile [%d] overflow",
5624345865bSWeidong Wang 					cfg_dde[i].dev_profile);
5634345865bSWeidong Wang 				return -EINVAL;
5644345865bSWeidong Wang 			}
5654345865bSWeidong Wang 			ret = aw_dev_parse_data_by_sec_type(aw_dev, prof_hdr, &cfg_dde[i],
5664345865bSWeidong Wang 					&all_prof_info->prof_desc[cfg_dde[i].dev_profile]);
5674345865bSWeidong Wang 			if (ret < 0) {
5684345865bSWeidong Wang 				dev_err(aw_dev->dev, "parse failed");
5694345865bSWeidong Wang 				return ret;
5704345865bSWeidong Wang 			}
5714345865bSWeidong Wang 			sec_num++;
5724345865bSWeidong Wang 		}
5734345865bSWeidong Wang 	}
5744345865bSWeidong Wang 
5754345865bSWeidong Wang 	if (sec_num == 0) {
5764345865bSWeidong Wang 		dev_err(aw_dev->dev, "get dev default type failed, get num[%d]", sec_num);
5774345865bSWeidong Wang 		return -EINVAL;
5784345865bSWeidong Wang 	}
5794345865bSWeidong Wang 
5804345865bSWeidong Wang 	return 0;
5814345865bSWeidong Wang }
5824345865bSWeidong Wang 
aw88261_dev_cfg_get_valid_prof(struct aw_device * aw_dev,struct aw_all_prof_info all_prof_info)5837f4ec778SWeidong Wang static int aw88261_dev_cfg_get_valid_prof(struct aw_device *aw_dev,
5847f4ec778SWeidong Wang 				struct aw_all_prof_info all_prof_info)
5857f4ec778SWeidong Wang {
5867f4ec778SWeidong Wang 	struct aw_prof_desc *prof_desc = all_prof_info.prof_desc;
5877f4ec778SWeidong Wang 	struct aw_prof_info *prof_info = &aw_dev->prof_info;
5887f4ec778SWeidong Wang 	int num = 0;
5897f4ec778SWeidong Wang 	int i;
5907f4ec778SWeidong Wang 
5917f4ec778SWeidong Wang 	for (i = 0; i < AW88395_PROFILE_MAX; i++) {
5927f4ec778SWeidong Wang 		if (prof_desc[i].prof_st == AW88395_PROFILE_OK)
5937f4ec778SWeidong Wang 			prof_info->count++;
5947f4ec778SWeidong Wang 	}
5957f4ec778SWeidong Wang 
5967f4ec778SWeidong Wang 	dev_dbg(aw_dev->dev, "get valid profile:%d", aw_dev->prof_info.count);
5977f4ec778SWeidong Wang 
5987f4ec778SWeidong Wang 	if (!prof_info->count) {
5997f4ec778SWeidong Wang 		dev_err(aw_dev->dev, "no profile data");
6007f4ec778SWeidong Wang 		return -EPERM;
6017f4ec778SWeidong Wang 	}
6027f4ec778SWeidong Wang 
6037f4ec778SWeidong Wang 	prof_info->prof_desc = devm_kcalloc(aw_dev->dev,
6047f4ec778SWeidong Wang 					prof_info->count, sizeof(struct aw_prof_desc),
6057f4ec778SWeidong Wang 					GFP_KERNEL);
6067f4ec778SWeidong Wang 	if (!prof_info->prof_desc)
6077f4ec778SWeidong Wang 		return -ENOMEM;
6087f4ec778SWeidong Wang 
6097f4ec778SWeidong Wang 	for (i = 0; i < AW88395_PROFILE_MAX; i++) {
6107f4ec778SWeidong Wang 		if (prof_desc[i].prof_st == AW88395_PROFILE_OK) {
6117f4ec778SWeidong Wang 			if (num >= prof_info->count) {
6127f4ec778SWeidong Wang 				dev_err(aw_dev->dev, "overflow count[%d]",
6137f4ec778SWeidong Wang 						prof_info->count);
6147f4ec778SWeidong Wang 				return -EINVAL;
6157f4ec778SWeidong Wang 			}
6167f4ec778SWeidong Wang 			prof_info->prof_desc[num] = prof_desc[i];
6177f4ec778SWeidong Wang 			prof_info->prof_desc[num].id = i;
6187f4ec778SWeidong Wang 			num++;
6197f4ec778SWeidong Wang 		}
6207f4ec778SWeidong Wang 	}
6217f4ec778SWeidong Wang 
6227f4ec778SWeidong Wang 	return 0;
6237f4ec778SWeidong Wang }
6247f4ec778SWeidong Wang 
aw88395_dev_cfg_get_valid_prof(struct aw_device * aw_dev,struct aw_all_prof_info all_prof_info)6257f4ec778SWeidong Wang static int aw88395_dev_cfg_get_valid_prof(struct aw_device *aw_dev,
6264345865bSWeidong Wang 				struct aw_all_prof_info all_prof_info)
6274345865bSWeidong Wang {
6284345865bSWeidong Wang 	struct aw_prof_desc *prof_desc = all_prof_info.prof_desc;
6294345865bSWeidong Wang 	struct aw_prof_info *prof_info = &aw_dev->prof_info;
6304345865bSWeidong Wang 	struct aw_sec_data_desc *sec_desc;
6314345865bSWeidong Wang 	int num = 0;
6324345865bSWeidong Wang 	int i;
6334345865bSWeidong Wang 
6344345865bSWeidong Wang 	for (i = 0; i < AW88395_PROFILE_MAX; i++) {
6354345865bSWeidong Wang 		if (prof_desc[i].prof_st == AW88395_PROFILE_OK) {
6364345865bSWeidong Wang 			sec_desc = prof_desc[i].sec_desc;
6374345865bSWeidong Wang 			if ((sec_desc[AW88395_DATA_TYPE_REG].data != NULL) &&
6384345865bSWeidong Wang 			    (sec_desc[AW88395_DATA_TYPE_REG].len != 0) &&
6394345865bSWeidong Wang 			    (sec_desc[AW88395_DATA_TYPE_DSP_CFG].data != NULL) &&
6404345865bSWeidong Wang 			    (sec_desc[AW88395_DATA_TYPE_DSP_CFG].len != 0) &&
6414345865bSWeidong Wang 			    (sec_desc[AW88395_DATA_TYPE_DSP_FW].data != NULL) &&
6424345865bSWeidong Wang 			    (sec_desc[AW88395_DATA_TYPE_DSP_FW].len != 0))
6434345865bSWeidong Wang 				prof_info->count++;
6444345865bSWeidong Wang 		}
6454345865bSWeidong Wang 	}
6464345865bSWeidong Wang 
6474345865bSWeidong Wang 	dev_dbg(aw_dev->dev, "get valid profile:%d", aw_dev->prof_info.count);
6484345865bSWeidong Wang 
6494345865bSWeidong Wang 	if (!prof_info->count) {
6504345865bSWeidong Wang 		dev_err(aw_dev->dev, "no profile data");
6514345865bSWeidong Wang 		return -EPERM;
6524345865bSWeidong Wang 	}
6534345865bSWeidong Wang 
6544345865bSWeidong Wang 	prof_info->prof_desc = devm_kcalloc(aw_dev->dev,
6554345865bSWeidong Wang 					prof_info->count, sizeof(struct aw_prof_desc),
6564345865bSWeidong Wang 					GFP_KERNEL);
6574345865bSWeidong Wang 	if (!prof_info->prof_desc)
6584345865bSWeidong Wang 		return -ENOMEM;
6594345865bSWeidong Wang 
6604345865bSWeidong Wang 	for (i = 0; i < AW88395_PROFILE_MAX; i++) {
6614345865bSWeidong Wang 		if (prof_desc[i].prof_st == AW88395_PROFILE_OK) {
6624345865bSWeidong Wang 			sec_desc = prof_desc[i].sec_desc;
6634345865bSWeidong Wang 			if ((sec_desc[AW88395_DATA_TYPE_REG].data != NULL) &&
6644345865bSWeidong Wang 			    (sec_desc[AW88395_DATA_TYPE_REG].len != 0) &&
6654345865bSWeidong Wang 			    (sec_desc[AW88395_DATA_TYPE_DSP_CFG].data != NULL) &&
6664345865bSWeidong Wang 			    (sec_desc[AW88395_DATA_TYPE_DSP_CFG].len != 0) &&
6674345865bSWeidong Wang 			    (sec_desc[AW88395_DATA_TYPE_DSP_FW].data != NULL) &&
6684345865bSWeidong Wang 			    (sec_desc[AW88395_DATA_TYPE_DSP_FW].len != 0)) {
6694345865bSWeidong Wang 				if (num >= prof_info->count) {
6704345865bSWeidong Wang 					dev_err(aw_dev->dev, "overflow count[%d]",
6714345865bSWeidong Wang 							prof_info->count);
6724345865bSWeidong Wang 					return -EINVAL;
6734345865bSWeidong Wang 				}
6744345865bSWeidong Wang 				prof_info->prof_desc[num] = prof_desc[i];
6754345865bSWeidong Wang 				prof_info->prof_desc[num].id = i;
6764345865bSWeidong Wang 				num++;
6774345865bSWeidong Wang 			}
6784345865bSWeidong Wang 		}
6794345865bSWeidong Wang 	}
6804345865bSWeidong Wang 
6814345865bSWeidong Wang 	return 0;
6824345865bSWeidong Wang }
6834345865bSWeidong Wang 
aw_dev_load_cfg_by_hdr(struct aw_device * aw_dev,struct aw_cfg_hdr * prof_hdr)6844345865bSWeidong Wang static int aw_dev_load_cfg_by_hdr(struct aw_device *aw_dev,
6854345865bSWeidong Wang 		struct aw_cfg_hdr *prof_hdr)
6864345865bSWeidong Wang {
6874345865bSWeidong Wang 	struct aw_all_prof_info *all_prof_info;
6884345865bSWeidong Wang 	int ret;
6894345865bSWeidong Wang 
6904345865bSWeidong Wang 	all_prof_info = devm_kzalloc(aw_dev->dev, sizeof(struct aw_all_prof_info), GFP_KERNEL);
6914345865bSWeidong Wang 	if (!all_prof_info)
6924345865bSWeidong Wang 		return -ENOMEM;
6934345865bSWeidong Wang 
6944345865bSWeidong Wang 	ret = aw_dev_parse_dev_type(aw_dev, prof_hdr, all_prof_info);
6954345865bSWeidong Wang 	if (ret < 0) {
6964345865bSWeidong Wang 		goto exit;
6974345865bSWeidong Wang 	} else if (ret == AW88395_DEV_TYPE_NONE) {
6984345865bSWeidong Wang 		dev_dbg(aw_dev->dev, "get dev type num is 0, parse default dev");
6994345865bSWeidong Wang 		ret = aw_dev_parse_dev_default_type(aw_dev, prof_hdr, all_prof_info);
7004345865bSWeidong Wang 		if (ret < 0)
7014345865bSWeidong Wang 			goto exit;
7024345865bSWeidong Wang 	}
7034345865bSWeidong Wang 
7047f4ec778SWeidong Wang 	switch (aw_dev->chip_id) {
7057f4ec778SWeidong Wang 	case AW88395_CHIP_ID:
7067f4ec778SWeidong Wang 		ret = aw88395_dev_cfg_get_valid_prof(aw_dev, *all_prof_info);
7074345865bSWeidong Wang 		if (ret < 0)
7084345865bSWeidong Wang 			goto exit;
7097f4ec778SWeidong Wang 		break;
7107f4ec778SWeidong Wang 	case AW88261_CHIP_ID:
7117f4ec778SWeidong Wang 		ret = aw88261_dev_cfg_get_valid_prof(aw_dev, *all_prof_info);
7127f4ec778SWeidong Wang 		if (ret < 0)
7137f4ec778SWeidong Wang 			goto exit;
7147f4ec778SWeidong Wang 		break;
7157f4ec778SWeidong Wang 	default:
7167f4ec778SWeidong Wang 		dev_err(aw_dev->dev, "valid prof unsupported");
7177f4ec778SWeidong Wang 		ret = -EINVAL;
7187f4ec778SWeidong Wang 		break;
7197f4ec778SWeidong Wang 	}
7204345865bSWeidong Wang 
7214345865bSWeidong Wang 	aw_dev->prof_info.prof_name_list = profile_name;
7224345865bSWeidong Wang 
7234345865bSWeidong Wang exit:
7244345865bSWeidong Wang 	devm_kfree(aw_dev->dev, all_prof_info);
7254345865bSWeidong Wang 	return ret;
7264345865bSWeidong Wang }
7274345865bSWeidong Wang 
aw_dev_create_prof_name_list_v1(struct aw_device * aw_dev)7284345865bSWeidong Wang static int aw_dev_create_prof_name_list_v1(struct aw_device *aw_dev)
7294345865bSWeidong Wang {
7304345865bSWeidong Wang 	struct aw_prof_info *prof_info = &aw_dev->prof_info;
7314345865bSWeidong Wang 	struct aw_prof_desc *prof_desc = prof_info->prof_desc;
7324345865bSWeidong Wang 	int i;
7334345865bSWeidong Wang 
7344345865bSWeidong Wang 	if (!prof_desc) {
7354345865bSWeidong Wang 		dev_err(aw_dev->dev, "prof_desc is NULL");
7364345865bSWeidong Wang 		return -EINVAL;
7374345865bSWeidong Wang 	}
7384345865bSWeidong Wang 
7394345865bSWeidong Wang 	prof_info->prof_name_list = devm_kzalloc(aw_dev->dev,
7404345865bSWeidong Wang 					prof_info->count * PROFILE_STR_MAX,
7414345865bSWeidong Wang 					GFP_KERNEL);
7424345865bSWeidong Wang 	if (!prof_info->prof_name_list)
7434345865bSWeidong Wang 		return -ENOMEM;
7444345865bSWeidong Wang 
7454345865bSWeidong Wang 	for (i = 0; i < prof_info->count; i++) {
7464345865bSWeidong Wang 		prof_desc[i].id = i;
7474345865bSWeidong Wang 		prof_info->prof_name_list[i] = prof_desc[i].prf_str;
7484345865bSWeidong Wang 		dev_dbg(aw_dev->dev, "prof name is %s", prof_info->prof_name_list[i]);
7494345865bSWeidong Wang 	}
7504345865bSWeidong Wang 
7514345865bSWeidong Wang 	return 0;
7524345865bSWeidong Wang }
7534345865bSWeidong Wang 
aw_get_dde_type_info(struct aw_device * aw_dev,struct aw_container * aw_cfg)7544345865bSWeidong Wang static int aw_get_dde_type_info(struct aw_device *aw_dev, struct aw_container *aw_cfg)
7554345865bSWeidong Wang {
7564345865bSWeidong Wang 	struct aw_cfg_hdr *cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
7574345865bSWeidong Wang 	struct aw_cfg_dde_v1 *cfg_dde =
7584345865bSWeidong Wang 		(struct aw_cfg_dde_v1 *)(aw_cfg->data + cfg_hdr->hdr_offset);
7594345865bSWeidong Wang 	int default_num = 0;
7604345865bSWeidong Wang 	int dev_num = 0;
7614345865bSWeidong Wang 	unsigned int i;
7624345865bSWeidong Wang 
7634345865bSWeidong Wang 	for (i = 0; i < cfg_hdr->ddt_num; i++) {
7644345865bSWeidong Wang 		if (cfg_dde[i].type == AW88395_DEV_TYPE_ID)
7654345865bSWeidong Wang 			dev_num++;
7664345865bSWeidong Wang 
7674345865bSWeidong Wang 		if (cfg_dde[i].type == AW88395_DEV_DEFAULT_TYPE_ID)
7684345865bSWeidong Wang 			default_num++;
7694345865bSWeidong Wang 	}
7704345865bSWeidong Wang 
7714345865bSWeidong Wang 	if (dev_num != 0) {
7724345865bSWeidong Wang 		aw_dev->prof_info.prof_type = AW88395_DEV_TYPE_ID;
7734345865bSWeidong Wang 	} else if (default_num != 0) {
7744345865bSWeidong Wang 		aw_dev->prof_info.prof_type = AW88395_DEV_DEFAULT_TYPE_ID;
7754345865bSWeidong Wang 	} else {
7764345865bSWeidong Wang 		dev_err(aw_dev->dev, "can't find scene");
7774345865bSWeidong Wang 		return -EINVAL;
7784345865bSWeidong Wang 	}
7794345865bSWeidong Wang 
7804345865bSWeidong Wang 	return 0;
7814345865bSWeidong Wang }
7824345865bSWeidong Wang 
aw_get_dev_scene_count_v1(struct aw_device * aw_dev,struct aw_container * aw_cfg,unsigned int * scene_num)7834345865bSWeidong Wang static int aw_get_dev_scene_count_v1(struct aw_device *aw_dev, struct aw_container *aw_cfg,
7844345865bSWeidong Wang 						unsigned int *scene_num)
7854345865bSWeidong Wang {
7864345865bSWeidong Wang 	struct aw_cfg_hdr *cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
7874345865bSWeidong Wang 	struct aw_cfg_dde_v1 *cfg_dde =
7884345865bSWeidong Wang 		(struct aw_cfg_dde_v1 *)(aw_cfg->data + cfg_hdr->hdr_offset);
7894345865bSWeidong Wang 	unsigned int i;
7907f4ec778SWeidong Wang 	int ret;
7914345865bSWeidong Wang 
7927f4ec778SWeidong Wang 	switch (aw_dev->chip_id) {
7937f4ec778SWeidong Wang 	case AW88395_CHIP_ID:
7944345865bSWeidong Wang 		for (i = 0; i < cfg_hdr->ddt_num; ++i) {
7954345865bSWeidong Wang 			if ((cfg_dde[i].data_type == ACF_SEC_TYPE_MULTIPLE_BIN) &&
7964345865bSWeidong Wang 			    (aw_dev->chip_id == cfg_dde[i].chip_id) &&
7974345865bSWeidong Wang 			    (aw_dev->i2c->adapter->nr == cfg_dde[i].dev_bus) &&
7984345865bSWeidong Wang 			    (aw_dev->i2c->addr == cfg_dde[i].dev_addr))
7994345865bSWeidong Wang 				(*scene_num)++;
8004345865bSWeidong Wang 		}
8017f4ec778SWeidong Wang 		ret = 0;
8027f4ec778SWeidong Wang 		break;
8037f4ec778SWeidong Wang 	case AW88261_CHIP_ID:
8047f4ec778SWeidong Wang 		for (i = 0; i < cfg_hdr->ddt_num; ++i) {
8057f4ec778SWeidong Wang 			if (((cfg_dde[i].data_type == ACF_SEC_TYPE_REG) ||
8067f4ec778SWeidong Wang 			     (cfg_dde[i].data_type == ACF_SEC_TYPE_HDR_REG)) &&
8077f4ec778SWeidong Wang 			    (aw_dev->chip_id == cfg_dde[i].chip_id) &&
8087f4ec778SWeidong Wang 			    (aw_dev->i2c->adapter->nr == cfg_dde[i].dev_bus) &&
8097f4ec778SWeidong Wang 			    (aw_dev->i2c->addr == cfg_dde[i].dev_addr))
8107f4ec778SWeidong Wang 				(*scene_num)++;
8117f4ec778SWeidong Wang 		}
8127f4ec778SWeidong Wang 		ret = 0;
8137f4ec778SWeidong Wang 		break;
8147f4ec778SWeidong Wang 	default:
8157f4ec778SWeidong Wang 		dev_err(aw_dev->dev, "unsupported device");
8167f4ec778SWeidong Wang 		ret = -EINVAL;
8177f4ec778SWeidong Wang 		break;
8187f4ec778SWeidong Wang 	}
8194345865bSWeidong Wang 
8207f4ec778SWeidong Wang 	return ret;
8214345865bSWeidong Wang }
8224345865bSWeidong Wang 
aw_get_default_scene_count_v1(struct aw_device * aw_dev,struct aw_container * aw_cfg,unsigned int * scene_num)8234345865bSWeidong Wang static int aw_get_default_scene_count_v1(struct aw_device *aw_dev,
8244345865bSWeidong Wang 						struct aw_container *aw_cfg,
8254345865bSWeidong Wang 						unsigned int *scene_num)
8264345865bSWeidong Wang {
8274345865bSWeidong Wang 	struct aw_cfg_hdr *cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
8284345865bSWeidong Wang 	struct aw_cfg_dde_v1 *cfg_dde =
8294345865bSWeidong Wang 		(struct aw_cfg_dde_v1 *)(aw_cfg->data + cfg_hdr->hdr_offset);
8304345865bSWeidong Wang 	unsigned int i;
8317f4ec778SWeidong Wang 	int ret;
8324345865bSWeidong Wang 
8337f4ec778SWeidong Wang 	switch (aw_dev->chip_id) {
8347f4ec778SWeidong Wang 	case AW88395_CHIP_ID:
8354345865bSWeidong Wang 		for (i = 0; i < cfg_hdr->ddt_num; ++i) {
8364345865bSWeidong Wang 			if ((cfg_dde[i].data_type == ACF_SEC_TYPE_MULTIPLE_BIN) &&
8374345865bSWeidong Wang 			    (aw_dev->chip_id == cfg_dde[i].chip_id) &&
8384345865bSWeidong Wang 			    (aw_dev->channel == cfg_dde[i].dev_index))
8394345865bSWeidong Wang 				(*scene_num)++;
8404345865bSWeidong Wang 		}
8417f4ec778SWeidong Wang 		ret = 0;
8427f4ec778SWeidong Wang 		break;
8437f4ec778SWeidong Wang 	case AW88261_CHIP_ID:
8447f4ec778SWeidong Wang 		for (i = 0; i < cfg_hdr->ddt_num; ++i) {
8457f4ec778SWeidong Wang 			if (((cfg_dde[i].data_type == ACF_SEC_TYPE_REG) ||
8467f4ec778SWeidong Wang 			     (cfg_dde[i].data_type == ACF_SEC_TYPE_HDR_REG)) &&
8477f4ec778SWeidong Wang 			    (aw_dev->chip_id == cfg_dde[i].chip_id) &&
8487f4ec778SWeidong Wang 			    (aw_dev->channel == cfg_dde[i].dev_index))
8497f4ec778SWeidong Wang 				(*scene_num)++;
8507f4ec778SWeidong Wang 		}
8517f4ec778SWeidong Wang 		ret = 0;
8527f4ec778SWeidong Wang 		break;
8537f4ec778SWeidong Wang 	default:
8547f4ec778SWeidong Wang 		dev_err(aw_dev->dev, "unsupported device");
8557f4ec778SWeidong Wang 		ret = -EINVAL;
8567f4ec778SWeidong Wang 		break;
8577f4ec778SWeidong Wang 	}
8584345865bSWeidong Wang 
8597f4ec778SWeidong Wang 	return ret;
8604345865bSWeidong Wang }
8614345865bSWeidong Wang 
aw_dev_parse_scene_count_v1(struct aw_device * aw_dev,struct aw_container * aw_cfg,unsigned int * count)8624345865bSWeidong Wang static int aw_dev_parse_scene_count_v1(struct aw_device *aw_dev,
8634345865bSWeidong Wang 							struct aw_container *aw_cfg,
8644345865bSWeidong Wang 							unsigned int *count)
8654345865bSWeidong Wang {
8664345865bSWeidong Wang 	int ret;
8674345865bSWeidong Wang 
8684345865bSWeidong Wang 	ret = aw_get_dde_type_info(aw_dev, aw_cfg);
8694345865bSWeidong Wang 	if (ret < 0)
8704345865bSWeidong Wang 		return ret;
8714345865bSWeidong Wang 
8724345865bSWeidong Wang 	switch (aw_dev->prof_info.prof_type) {
8734345865bSWeidong Wang 	case AW88395_DEV_TYPE_ID:
8744345865bSWeidong Wang 		ret = aw_get_dev_scene_count_v1(aw_dev, aw_cfg, count);
8754345865bSWeidong Wang 		break;
8764345865bSWeidong Wang 	case AW88395_DEV_DEFAULT_TYPE_ID:
8774345865bSWeidong Wang 		ret = aw_get_default_scene_count_v1(aw_dev, aw_cfg, count);
8784345865bSWeidong Wang 		break;
8794345865bSWeidong Wang 	default:
8804345865bSWeidong Wang 		dev_err(aw_dev->dev, "unsupported prof_type[%x]", aw_dev->prof_info.prof_type);
8814345865bSWeidong Wang 		ret = -EINVAL;
8824345865bSWeidong Wang 		break;
8834345865bSWeidong Wang 	}
8844345865bSWeidong Wang 
8854345865bSWeidong Wang 	return ret;
8864345865bSWeidong Wang }
8874345865bSWeidong Wang 
aw_dev_parse_data_by_sec_type_v1(struct aw_device * aw_dev,struct aw_cfg_hdr * prof_hdr,struct aw_cfg_dde_v1 * cfg_dde,int * cur_scene_id)8884345865bSWeidong Wang static int aw_dev_parse_data_by_sec_type_v1(struct aw_device *aw_dev,
8894345865bSWeidong Wang 							struct aw_cfg_hdr *prof_hdr,
8904345865bSWeidong Wang 							struct aw_cfg_dde_v1 *cfg_dde,
8914345865bSWeidong Wang 							int *cur_scene_id)
8924345865bSWeidong Wang {
8934345865bSWeidong Wang 	struct aw_prof_info *prof_info = &aw_dev->prof_info;
8944345865bSWeidong Wang 	int ret;
8954345865bSWeidong Wang 
8964345865bSWeidong Wang 	switch (cfg_dde->data_type) {
8974345865bSWeidong Wang 	case ACF_SEC_TYPE_MULTIPLE_BIN:
8984345865bSWeidong Wang 		ret = aw_dev_prof_parse_multi_bin(aw_dev, (u8 *)prof_hdr + cfg_dde->data_offset,
8994345865bSWeidong Wang 					cfg_dde->data_size, &prof_info->prof_desc[*cur_scene_id]);
9004345865bSWeidong Wang 		if (ret < 0) {
9014345865bSWeidong Wang 			dev_err(aw_dev->dev, "parse multi bin failed");
9024345865bSWeidong Wang 			return ret;
9034345865bSWeidong Wang 		}
9044345865bSWeidong Wang 		prof_info->prof_desc[*cur_scene_id].prf_str = cfg_dde->dev_profile_str;
9054345865bSWeidong Wang 		prof_info->prof_desc[*cur_scene_id].id = cfg_dde->dev_profile;
9064345865bSWeidong Wang 		(*cur_scene_id)++;
9074345865bSWeidong Wang 		break;
9087f4ec778SWeidong Wang 	case ACF_SEC_TYPE_HDR_REG:
9097f4ec778SWeidong Wang 		ret =  aw_dev_parse_reg_bin_with_hdr(aw_dev,
9107f4ec778SWeidong Wang 				(uint8_t *)prof_hdr + cfg_dde->data_offset,
9117f4ec778SWeidong Wang 				cfg_dde->data_size, &prof_info->prof_desc[*cur_scene_id]);
9127f4ec778SWeidong Wang 		if (ret < 0) {
9137f4ec778SWeidong Wang 			dev_err(aw_dev->dev, "parse reg bin with hdr failed");
9147f4ec778SWeidong Wang 			return ret;
9157f4ec778SWeidong Wang 		}
9167f4ec778SWeidong Wang 		prof_info->prof_desc[*cur_scene_id].prf_str = cfg_dde->dev_profile_str;
9177f4ec778SWeidong Wang 		prof_info->prof_desc[*cur_scene_id].id = cfg_dde->dev_profile;
9187f4ec778SWeidong Wang 		(*cur_scene_id)++;
9197f4ec778SWeidong Wang 		break;
9204345865bSWeidong Wang 	default:
9214345865bSWeidong Wang 		dev_err(aw_dev->dev, "unsupported SEC_TYPE [%d]", cfg_dde->data_type);
9224345865bSWeidong Wang 		return -EINVAL;
9234345865bSWeidong Wang 	}
9244345865bSWeidong Wang 
9254345865bSWeidong Wang 	return 0;
9264345865bSWeidong Wang }
9274345865bSWeidong Wang 
aw_dev_parse_dev_type_v1(struct aw_device * aw_dev,struct aw_cfg_hdr * prof_hdr)9284345865bSWeidong Wang static int aw_dev_parse_dev_type_v1(struct aw_device *aw_dev,
9294345865bSWeidong Wang 		struct aw_cfg_hdr *prof_hdr)
9304345865bSWeidong Wang {
9314345865bSWeidong Wang 	struct aw_cfg_dde_v1 *cfg_dde =
9324345865bSWeidong Wang 		(struct aw_cfg_dde_v1 *)((char *)prof_hdr + prof_hdr->hdr_offset);
933983272a2STom Rix 	int cur_scene_id = 0;
9344345865bSWeidong Wang 	unsigned int i;
9354345865bSWeidong Wang 	int ret;
9364345865bSWeidong Wang 
9374345865bSWeidong Wang 	for (i = 0; i < prof_hdr->ddt_num; i++) {
9384345865bSWeidong Wang 		if ((aw_dev->i2c->adapter->nr == cfg_dde[i].dev_bus) &&
9394345865bSWeidong Wang 		    (aw_dev->i2c->addr == cfg_dde[i].dev_addr) &&
9404345865bSWeidong Wang 		    (aw_dev->chip_id == cfg_dde[i].chip_id)) {
9414345865bSWeidong Wang 			ret = aw_dev_parse_data_by_sec_type_v1(aw_dev, prof_hdr,
9424345865bSWeidong Wang 							&cfg_dde[i], &cur_scene_id);
9434345865bSWeidong Wang 			if (ret < 0) {
9444345865bSWeidong Wang 				dev_err(aw_dev->dev, "parse failed");
9454345865bSWeidong Wang 				return ret;
9464345865bSWeidong Wang 			}
9474345865bSWeidong Wang 		}
9484345865bSWeidong Wang 	}
9494345865bSWeidong Wang 
9504345865bSWeidong Wang 	if (cur_scene_id == 0) {
9514345865bSWeidong Wang 		dev_err(aw_dev->dev, "get dev type failed, get num [%d]", cur_scene_id);
9524345865bSWeidong Wang 		return -EINVAL;
9534345865bSWeidong Wang 	}
9544345865bSWeidong Wang 
9554345865bSWeidong Wang 	return 0;
9564345865bSWeidong Wang }
9574345865bSWeidong Wang 
aw_dev_parse_default_type_v1(struct aw_device * aw_dev,struct aw_cfg_hdr * prof_hdr)9584345865bSWeidong Wang static int aw_dev_parse_default_type_v1(struct aw_device *aw_dev,
9594345865bSWeidong Wang 		struct aw_cfg_hdr *prof_hdr)
9604345865bSWeidong Wang {
9614345865bSWeidong Wang 	struct aw_cfg_dde_v1 *cfg_dde =
9624345865bSWeidong Wang 		(struct aw_cfg_dde_v1 *)((char *)prof_hdr + prof_hdr->hdr_offset);
9634345865bSWeidong Wang 	int cur_scene_id = 0;
9644345865bSWeidong Wang 	unsigned int i;
9654345865bSWeidong Wang 	int ret;
9664345865bSWeidong Wang 
9674345865bSWeidong Wang 	for (i = 0; i < prof_hdr->ddt_num; i++) {
9684345865bSWeidong Wang 		if ((aw_dev->channel == cfg_dde[i].dev_index) &&
9694345865bSWeidong Wang 			(aw_dev->chip_id == cfg_dde[i].chip_id)) {
9704345865bSWeidong Wang 			ret = aw_dev_parse_data_by_sec_type_v1(aw_dev, prof_hdr,
9714345865bSWeidong Wang 							&cfg_dde[i], &cur_scene_id);
9724345865bSWeidong Wang 			if (ret < 0) {
9734345865bSWeidong Wang 				dev_err(aw_dev->dev, "parse failed");
9744345865bSWeidong Wang 				return ret;
9754345865bSWeidong Wang 			}
9764345865bSWeidong Wang 		}
9774345865bSWeidong Wang 	}
9784345865bSWeidong Wang 
9794345865bSWeidong Wang 	if (cur_scene_id == 0) {
9804345865bSWeidong Wang 		dev_err(aw_dev->dev, "get dev default type failed, get num[%d]", cur_scene_id);
9814345865bSWeidong Wang 		return -EINVAL;
9824345865bSWeidong Wang 	}
9834345865bSWeidong Wang 
9844345865bSWeidong Wang 	return 0;
9854345865bSWeidong Wang }
9864345865bSWeidong Wang 
aw_dev_parse_by_hdr_v1(struct aw_device * aw_dev,struct aw_cfg_hdr * cfg_hdr)9874345865bSWeidong Wang static int aw_dev_parse_by_hdr_v1(struct aw_device *aw_dev,
9884345865bSWeidong Wang 		struct aw_cfg_hdr *cfg_hdr)
9894345865bSWeidong Wang {
9904345865bSWeidong Wang 	int ret;
9914345865bSWeidong Wang 
9924345865bSWeidong Wang 	switch (aw_dev->prof_info.prof_type) {
9934345865bSWeidong Wang 	case AW88395_DEV_TYPE_ID:
9944345865bSWeidong Wang 		ret = aw_dev_parse_dev_type_v1(aw_dev, cfg_hdr);
9954345865bSWeidong Wang 		break;
9964345865bSWeidong Wang 	case AW88395_DEV_DEFAULT_TYPE_ID:
9974345865bSWeidong Wang 		ret = aw_dev_parse_default_type_v1(aw_dev, cfg_hdr);
9984345865bSWeidong Wang 		break;
9994345865bSWeidong Wang 	default:
10004345865bSWeidong Wang 		dev_err(aw_dev->dev, "prof type matched failed, get num[%d]",
10014345865bSWeidong Wang 			aw_dev->prof_info.prof_type);
10024345865bSWeidong Wang 		ret =  -EINVAL;
10034345865bSWeidong Wang 		break;
10044345865bSWeidong Wang 	}
10054345865bSWeidong Wang 
10064345865bSWeidong Wang 	return ret;
10074345865bSWeidong Wang }
10084345865bSWeidong Wang 
aw_dev_load_cfg_by_hdr_v1(struct aw_device * aw_dev,struct aw_container * aw_cfg)10094345865bSWeidong Wang static int aw_dev_load_cfg_by_hdr_v1(struct aw_device *aw_dev,
10104345865bSWeidong Wang 						struct aw_container *aw_cfg)
10114345865bSWeidong Wang {
10124345865bSWeidong Wang 	struct aw_cfg_hdr *cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
10134345865bSWeidong Wang 	struct aw_prof_info *prof_info = &aw_dev->prof_info;
10144345865bSWeidong Wang 	int ret;
10154345865bSWeidong Wang 
10164345865bSWeidong Wang 	ret = aw_dev_parse_scene_count_v1(aw_dev, aw_cfg, &prof_info->count);
10174345865bSWeidong Wang 	if (ret < 0) {
10184345865bSWeidong Wang 		dev_err(aw_dev->dev, "get scene count failed");
10194345865bSWeidong Wang 		return ret;
10204345865bSWeidong Wang 	}
10214345865bSWeidong Wang 
10224345865bSWeidong Wang 	prof_info->prof_desc = devm_kcalloc(aw_dev->dev,
10234345865bSWeidong Wang 					prof_info->count, sizeof(struct aw_prof_desc),
10244345865bSWeidong Wang 					GFP_KERNEL);
10254345865bSWeidong Wang 	if (!prof_info->prof_desc)
10264345865bSWeidong Wang 		return -ENOMEM;
10274345865bSWeidong Wang 
10284345865bSWeidong Wang 	ret = aw_dev_parse_by_hdr_v1(aw_dev, cfg_hdr);
10294345865bSWeidong Wang 	if (ret < 0) {
10304345865bSWeidong Wang 		dev_err(aw_dev->dev, "parse hdr failed");
10314345865bSWeidong Wang 		return ret;
10324345865bSWeidong Wang 	}
10334345865bSWeidong Wang 
10344345865bSWeidong Wang 	ret = aw_dev_create_prof_name_list_v1(aw_dev);
10354345865bSWeidong Wang 	if (ret < 0) {
10364345865bSWeidong Wang 		dev_err(aw_dev->dev, "create prof name list failed");
10374345865bSWeidong Wang 		return ret;
10384345865bSWeidong Wang 	}
10394345865bSWeidong Wang 
10404345865bSWeidong Wang 	return 0;
10414345865bSWeidong Wang }
10424345865bSWeidong Wang 
aw88395_dev_cfg_load(struct aw_device * aw_dev,struct aw_container * aw_cfg)10434345865bSWeidong Wang int aw88395_dev_cfg_load(struct aw_device *aw_dev, struct aw_container *aw_cfg)
10444345865bSWeidong Wang {
10454345865bSWeidong Wang 	struct aw_cfg_hdr *cfg_hdr;
10464345865bSWeidong Wang 	int ret;
10474345865bSWeidong Wang 
10484345865bSWeidong Wang 	cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
10494345865bSWeidong Wang 
10504345865bSWeidong Wang 	switch (cfg_hdr->hdr_version) {
10514345865bSWeidong Wang 	case AW88395_CFG_HDR_VER:
10524345865bSWeidong Wang 		ret = aw_dev_load_cfg_by_hdr(aw_dev, cfg_hdr);
10534345865bSWeidong Wang 		if (ret < 0) {
10542a096315SColin Ian King 			dev_err(aw_dev->dev, "hdr_version[0x%x] parse failed",
10554345865bSWeidong Wang 						cfg_hdr->hdr_version);
10564345865bSWeidong Wang 			return ret;
10574345865bSWeidong Wang 		}
10584345865bSWeidong Wang 		break;
10594345865bSWeidong Wang 	case AW88395_CFG_HDR_VER_V1:
10604345865bSWeidong Wang 		ret = aw_dev_load_cfg_by_hdr_v1(aw_dev, aw_cfg);
10614345865bSWeidong Wang 		if (ret < 0) {
10622a096315SColin Ian King 			dev_err(aw_dev->dev, "hdr_version[0x%x] parse failed",
10634345865bSWeidong Wang 						cfg_hdr->hdr_version);
10644345865bSWeidong Wang 			return ret;
10654345865bSWeidong Wang 		}
10664345865bSWeidong Wang 		break;
10674345865bSWeidong Wang 	default:
10684345865bSWeidong Wang 		dev_err(aw_dev->dev, "unsupported hdr_version [0x%x]", cfg_hdr->hdr_version);
10694345865bSWeidong Wang 		return -EINVAL;
10704345865bSWeidong Wang 	}
10714345865bSWeidong Wang 	aw_dev->fw_status = AW88395_DEV_FW_OK;
10724345865bSWeidong Wang 
10734345865bSWeidong Wang 	return 0;
10744345865bSWeidong Wang }
10754345865bSWeidong Wang EXPORT_SYMBOL_GPL(aw88395_dev_cfg_load);
10764345865bSWeidong Wang 
aw_dev_check_cfg_by_hdr(struct aw_device * aw_dev,struct aw_container * aw_cfg)10774345865bSWeidong Wang static int aw_dev_check_cfg_by_hdr(struct aw_device *aw_dev, struct aw_container *aw_cfg)
10784345865bSWeidong Wang {
10794345865bSWeidong Wang 	unsigned int end_data_offset;
10804345865bSWeidong Wang 	struct aw_cfg_hdr *cfg_hdr;
10814345865bSWeidong Wang 	struct aw_cfg_dde *cfg_dde;
10824345865bSWeidong Wang 	unsigned int act_data = 0;
10834345865bSWeidong Wang 	unsigned int hdr_ddt_len;
10844345865bSWeidong Wang 	unsigned int i;
10854345865bSWeidong Wang 	u8 act_crc8;
10864345865bSWeidong Wang 
10874345865bSWeidong Wang 	cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
10884345865bSWeidong Wang 	/* check file type id is awinic acf file */
10894345865bSWeidong Wang 	if (cfg_hdr->id != ACF_FILE_ID) {
10904345865bSWeidong Wang 		dev_err(aw_dev->dev, "not acf type file");
10914345865bSWeidong Wang 		return -EINVAL;
10924345865bSWeidong Wang 	}
10934345865bSWeidong Wang 
10944345865bSWeidong Wang 	hdr_ddt_len = cfg_hdr->hdr_offset + cfg_hdr->ddt_size;
10954345865bSWeidong Wang 	if (hdr_ddt_len > aw_cfg->len) {
109614d5d454SWeidong Wang 		dev_err(aw_dev->dev, "hdr_len with ddt_len [%d] overflow file size[%d]",
10974345865bSWeidong Wang 		cfg_hdr->hdr_offset, aw_cfg->len);
10984345865bSWeidong Wang 		return -EINVAL;
10994345865bSWeidong Wang 	}
11004345865bSWeidong Wang 
11014345865bSWeidong Wang 	/* check data size */
11024345865bSWeidong Wang 	cfg_dde = (struct aw_cfg_dde *)((char *)aw_cfg->data + cfg_hdr->hdr_offset);
11034345865bSWeidong Wang 	act_data += hdr_ddt_len;
11044345865bSWeidong Wang 	for (i = 0; i < cfg_hdr->ddt_num; i++)
11054345865bSWeidong Wang 		act_data += cfg_dde[i].data_size;
11064345865bSWeidong Wang 
11074345865bSWeidong Wang 	if (act_data != aw_cfg->len) {
11084345865bSWeidong Wang 		dev_err(aw_dev->dev, "act_data[%d] not equal to file size[%d]!",
11094345865bSWeidong Wang 			act_data, aw_cfg->len);
11104345865bSWeidong Wang 		return -EINVAL;
11114345865bSWeidong Wang 	}
11124345865bSWeidong Wang 
11134345865bSWeidong Wang 	for (i = 0; i < cfg_hdr->ddt_num; i++) {
11144345865bSWeidong Wang 		/* data check */
11154345865bSWeidong Wang 		end_data_offset = cfg_dde[i].data_offset + cfg_dde[i].data_size;
11164345865bSWeidong Wang 		if (end_data_offset > aw_cfg->len) {
11174345865bSWeidong Wang 			dev_err(aw_dev->dev, "ddt_num[%d] end_data_offset[%d] overflow size[%d]",
11184345865bSWeidong Wang 				i, end_data_offset, aw_cfg->len);
11194345865bSWeidong Wang 			return -EINVAL;
11204345865bSWeidong Wang 		}
11214345865bSWeidong Wang 
11224345865bSWeidong Wang 		/* crc check */
11234345865bSWeidong Wang 		act_crc8 = crc8(aw_crc8_table, aw_cfg->data + cfg_dde[i].data_offset,
11244345865bSWeidong Wang 							cfg_dde[i].data_size, 0);
11254345865bSWeidong Wang 		if (act_crc8 != cfg_dde[i].data_crc) {
11264345865bSWeidong Wang 			dev_err(aw_dev->dev, "ddt_num[%d] act_crc8:0x%x != data_crc:0x%x",
11274345865bSWeidong Wang 				i, (u32)act_crc8, cfg_dde[i].data_crc);
11284345865bSWeidong Wang 			return -EINVAL;
11294345865bSWeidong Wang 		}
11304345865bSWeidong Wang 	}
11314345865bSWeidong Wang 
11324345865bSWeidong Wang 	return 0;
11334345865bSWeidong Wang }
11344345865bSWeidong Wang 
aw_dev_check_acf_by_hdr_v1(struct aw_device * aw_dev,struct aw_container * aw_cfg)11354345865bSWeidong Wang static int aw_dev_check_acf_by_hdr_v1(struct aw_device *aw_dev, struct aw_container *aw_cfg)
11364345865bSWeidong Wang {
11374345865bSWeidong Wang 	struct aw_cfg_dde_v1 *cfg_dde;
11384345865bSWeidong Wang 	unsigned int end_data_offset;
11394345865bSWeidong Wang 	struct aw_cfg_hdr *cfg_hdr;
11404345865bSWeidong Wang 	unsigned int act_data = 0;
11414345865bSWeidong Wang 	unsigned int hdr_ddt_len;
11424345865bSWeidong Wang 	u8 act_crc8;
11434345865bSWeidong Wang 	int i;
11444345865bSWeidong Wang 
11454345865bSWeidong Wang 	cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
11464345865bSWeidong Wang 
11474345865bSWeidong Wang 	/* check file type id is awinic acf file */
11484345865bSWeidong Wang 	if (cfg_hdr->id != ACF_FILE_ID) {
11494345865bSWeidong Wang 		dev_err(aw_dev->dev, "not acf type file");
11504345865bSWeidong Wang 		return -EINVAL;
11514345865bSWeidong Wang 	}
11524345865bSWeidong Wang 
11534345865bSWeidong Wang 	hdr_ddt_len = cfg_hdr->hdr_offset + cfg_hdr->ddt_size;
11544345865bSWeidong Wang 	if (hdr_ddt_len > aw_cfg->len) {
11554345865bSWeidong Wang 		dev_err(aw_dev->dev, "hdrlen with ddt_len [%d] overflow file size[%d]",
11564345865bSWeidong Wang 		cfg_hdr->hdr_offset, aw_cfg->len);
11574345865bSWeidong Wang 		return -EINVAL;
11584345865bSWeidong Wang 	}
11594345865bSWeidong Wang 
11604345865bSWeidong Wang 	/* check data size */
11614345865bSWeidong Wang 	cfg_dde = (struct aw_cfg_dde_v1 *)((char *)aw_cfg->data + cfg_hdr->hdr_offset);
11624345865bSWeidong Wang 	act_data += hdr_ddt_len;
11634345865bSWeidong Wang 	for (i = 0; i < cfg_hdr->ddt_num; i++)
11644345865bSWeidong Wang 		act_data += cfg_dde[i].data_size;
11654345865bSWeidong Wang 
11664345865bSWeidong Wang 	if (act_data != aw_cfg->len) {
11674345865bSWeidong Wang 		dev_err(aw_dev->dev, "act_data[%d] not equal to file size[%d]!",
11684345865bSWeidong Wang 			act_data, aw_cfg->len);
11694345865bSWeidong Wang 		return -EINVAL;
11704345865bSWeidong Wang 	}
11714345865bSWeidong Wang 
11724345865bSWeidong Wang 	for (i = 0; i < cfg_hdr->ddt_num; i++) {
11734345865bSWeidong Wang 		/* data check */
11744345865bSWeidong Wang 		end_data_offset = cfg_dde[i].data_offset + cfg_dde[i].data_size;
11754345865bSWeidong Wang 		if (end_data_offset > aw_cfg->len) {
11764345865bSWeidong Wang 			dev_err(aw_dev->dev, "ddt_num[%d] end_data_offset[%d] overflow size[%d]",
11774345865bSWeidong Wang 				i, end_data_offset, aw_cfg->len);
11784345865bSWeidong Wang 			return -EINVAL;
11794345865bSWeidong Wang 		}
11804345865bSWeidong Wang 
11814345865bSWeidong Wang 		/* crc check */
11824345865bSWeidong Wang 		act_crc8 = crc8(aw_crc8_table, aw_cfg->data + cfg_dde[i].data_offset,
11834345865bSWeidong Wang 									cfg_dde[i].data_size, 0);
11844345865bSWeidong Wang 		if (act_crc8 != cfg_dde[i].data_crc) {
11854345865bSWeidong Wang 			dev_err(aw_dev->dev, "ddt_num[%d] act_crc8:0x%x != data_crc 0x%x",
11864345865bSWeidong Wang 				i, (u32)act_crc8, cfg_dde[i].data_crc);
11874345865bSWeidong Wang 			return -EINVAL;
11884345865bSWeidong Wang 		}
11894345865bSWeidong Wang 	}
11904345865bSWeidong Wang 
11914345865bSWeidong Wang 	return 0;
11924345865bSWeidong Wang }
11934345865bSWeidong Wang 
aw88395_dev_load_acf_check(struct aw_device * aw_dev,struct aw_container * aw_cfg)11944345865bSWeidong Wang int aw88395_dev_load_acf_check(struct aw_device *aw_dev, struct aw_container *aw_cfg)
11954345865bSWeidong Wang {
11964345865bSWeidong Wang 	struct aw_cfg_hdr *cfg_hdr;
11974345865bSWeidong Wang 
11984345865bSWeidong Wang 	if (!aw_cfg) {
11994345865bSWeidong Wang 		dev_err(aw_dev->dev, "aw_prof is NULL");
12004345865bSWeidong Wang 		return -EINVAL;
12014345865bSWeidong Wang 	}
12024345865bSWeidong Wang 
12034345865bSWeidong Wang 	if (aw_cfg->len < sizeof(struct aw_cfg_hdr)) {
12044345865bSWeidong Wang 		dev_err(aw_dev->dev, "cfg hdr size[%d] overflow file size[%d]",
12054345865bSWeidong Wang 			aw_cfg->len, (int)sizeof(struct aw_cfg_hdr));
12064345865bSWeidong Wang 		return -EINVAL;
12074345865bSWeidong Wang 	}
12084345865bSWeidong Wang 
12094345865bSWeidong Wang 	crc8_populate_lsb(aw_crc8_table, AW88395_CRC8_POLYNOMIAL);
12104345865bSWeidong Wang 
12114345865bSWeidong Wang 	cfg_hdr = (struct aw_cfg_hdr *)aw_cfg->data;
12124345865bSWeidong Wang 	switch (cfg_hdr->hdr_version) {
12134345865bSWeidong Wang 	case AW88395_CFG_HDR_VER:
12144345865bSWeidong Wang 		return aw_dev_check_cfg_by_hdr(aw_dev, aw_cfg);
12154345865bSWeidong Wang 	case AW88395_CFG_HDR_VER_V1:
12164345865bSWeidong Wang 		return aw_dev_check_acf_by_hdr_v1(aw_dev, aw_cfg);
12174345865bSWeidong Wang 	default:
12184345865bSWeidong Wang 		dev_err(aw_dev->dev, "unsupported hdr_version [0x%x]", cfg_hdr->hdr_version);
12194345865bSWeidong Wang 		return -EINVAL;
12204345865bSWeidong Wang 	}
12214345865bSWeidong Wang 
12224345865bSWeidong Wang 	return 0;
12234345865bSWeidong Wang }
12244345865bSWeidong Wang EXPORT_SYMBOL_GPL(aw88395_dev_load_acf_check);
12254345865bSWeidong Wang 
12264345865bSWeidong Wang MODULE_DESCRIPTION("AW88395 ACF File Parsing Lib");
12274345865bSWeidong Wang MODULE_LICENSE("GPL v2");
1228