#include <linux/types.h>
|
#include <linux/kernel.h>
|
#include <linux/device.h>
|
#include <linux/string.h>
|
#include <linux/uaccess.h>
|
#include <linux/fs.h>
|
#include <linux/file.h>
|
#include <linux/proc_fs.h>
|
#include <linux/slab.h>
|
#include <linux/printk.h>
|
#include <linux/vmalloc.h>
|
#include <linux/kdev_t.h>
|
#include <linux/proc_fs.h>
|
#include "rf_marlin3.h"
|
#include <linux/version.h>
|
#include <wcn_bus.h>
|
#include <marlin_platform.h>
|
|
#include "sprdwl.h"
|
|
#ifdef CUSTOMIZE_WIFI_CFG_PATH
|
#define WIFI_BOARD_CFG_PATH CUSTOMIZE_WIFI_CFG_PATH
|
#else
|
#define WIFI_BOARD_CFG_PATH "/lib/firmware"
|
#endif
|
|
#define CF_TAB(NAME, MEM_OFFSET, TYPE) \
|
{ NAME, (size_t)(&(((struct wifi_conf_t *)(0))->MEM_OFFSET)), TYPE}
|
|
#define OFS_MARK_STRING \
|
"#-----------------------------------------------------------------\r\n"
|
|
static struct nvm_name_table g_config_table[] = {
|
/* [Section 1: Version]
|
*/
|
CF_TAB("Major", version.major, 2),
|
CF_TAB("Minor", version.minor, 2),
|
|
/* [SETCTION 2]Board Config: board_config_t
|
*/
|
CF_TAB("Calib_Bypass", board_config.calib_bypass, 2),
|
CF_TAB("TxChain_Mask", board_config.txchain_mask, 1),
|
CF_TAB("RxChain_Mask", board_config.rxchain_mask, 1),
|
|
/* [SETCTION 3]Board Config TPC: board_config_tpc_t
|
*/
|
CF_TAB("DPD_LUT_idx", board_config_tpc.dpd_lut_idx[0], 1),
|
CF_TAB("TPC_Goal_Chain0", board_config_tpc.tpc_goal_chain0[0], 2),
|
CF_TAB("TPC_Goal_Chain1", board_config_tpc.tpc_goal_chain1[0], 2),
|
/* [SETCTION 4]TPC-LUT: tpc_lut_t
|
*/
|
CF_TAB("Chain0_LUT_0", tpc_lut.chain0_lut[0], 1),
|
CF_TAB("Chain0_LUT_1", tpc_lut.chain0_lut[1], 1),
|
CF_TAB("Chain0_LUT_2", tpc_lut.chain0_lut[2], 1),
|
CF_TAB("Chain0_LUT_3", tpc_lut.chain0_lut[3], 1),
|
CF_TAB("Chain0_LUT_4", tpc_lut.chain0_lut[4], 1),
|
CF_TAB("Chain0_LUT_5", tpc_lut.chain0_lut[5], 1),
|
CF_TAB("Chain0_LUT_6", tpc_lut.chain0_lut[6], 1),
|
CF_TAB("Chain0_LUT_7", tpc_lut.chain0_lut[7], 1),
|
CF_TAB("Chain1_LUT_0", tpc_lut.chain1_lut[0], 1),
|
CF_TAB("Chain1_LUT_1", tpc_lut.chain1_lut[1], 1),
|
CF_TAB("Chain1_LUT_2", tpc_lut.chain1_lut[2], 1),
|
CF_TAB("Chain1_LUT_3", tpc_lut.chain1_lut[3], 1),
|
CF_TAB("Chain1_LUT_4", tpc_lut.chain1_lut[4], 1),
|
CF_TAB("Chain1_LUT_5", tpc_lut.chain1_lut[5], 1),
|
CF_TAB("Chain1_LUT_6", tpc_lut.chain1_lut[6], 1),
|
CF_TAB("Chain1_LUT_7", tpc_lut.chain1_lut[7], 1),
|
|
/*[SETCTION 5]Board Config Frequency Compensation:
|
* board_conf_freq_comp_t
|
*/
|
CF_TAB("2G_Channel_Chain0",
|
board_conf_freq_comp.channel_2g_chain0[0], 1),
|
CF_TAB("2G_Channel_Chain1",
|
board_conf_freq_comp.channel_2g_chain1[0], 1),
|
CF_TAB("5G_Channel_Chain0",
|
board_conf_freq_comp.channel_5g_chain0[0], 1),
|
CF_TAB("5G_Channel_Chain1",
|
board_conf_freq_comp.channel_5g_chain1[0], 1),
|
|
/*[SETCTION 6]Rate To Power with BW 20M: power_20m_t
|
*/
|
CF_TAB("11b_Power", power_20m.power_11b[0], 1),
|
CF_TAB("11ag_Power", power_20m.power_11ag[0], 1),
|
CF_TAB("11n_Power", power_20m.power_11n[0], 1),
|
CF_TAB("11ac_Power", power_20m.power_11ac[0], 1),
|
|
/*[SETCTION 7]Power Backoff:power_backoff_t
|
*/
|
CF_TAB("Green_WIFI_offset", power_backoff.green_wifi_offset, 1),
|
CF_TAB("HT40_Power_offset", power_backoff.ht40_power_offset, 1),
|
CF_TAB("VHT40_Power_offset", power_backoff.vht40_power_offset, 1),
|
CF_TAB("VHT80_Power_offset", power_backoff.vht80_power_offset, 1),
|
CF_TAB("SAR_Power_offset", power_backoff.sar_power_offset, 1),
|
CF_TAB("Mean_Power_offset", power_backoff.mean_power_offset, 1),
|
CF_TAB("TPC_mode", power_backoff.tpc_mode, 1),
|
CF_TAB("MAGIC_word", power_backoff.magic_word, 1),
|
|
/*[SETCTION 8]Reg Domain:reg_domain_t
|
*/
|
CF_TAB("reg_domain1", reg_domain.reg_domain1, 4),
|
CF_TAB("reg_domain2", reg_domain.reg_domain2, 4),
|
|
/*[SETCTION 9]Band Edge Power offset(MKK, FCC, ETSI):
|
* band_edge_power_offset_t
|
*/
|
CF_TAB("BW20M", band_edge_power_offset.bw20m[0], 1),
|
CF_TAB("BW40M", band_edge_power_offset.bw40m[0], 1),
|
CF_TAB("BW80M", band_edge_power_offset.bw80m[0], 1),
|
|
/*[SETCTION 10]TX Scale:tx_scale_t
|
*/
|
CF_TAB("Chain0_1", tx_scale.chain0[0][0], 1),
|
CF_TAB("Chain1_1", tx_scale.chain1[0][0], 1),
|
CF_TAB("Chain0_2", tx_scale.chain0[1][0], 1),
|
CF_TAB("Chain1_2", tx_scale.chain1[1][0], 1),
|
CF_TAB("Chain0_3", tx_scale.chain0[2][0], 1),
|
CF_TAB("Chain1_3", tx_scale.chain1[2][0], 1),
|
CF_TAB("Chain0_4", tx_scale.chain0[3][0], 1),
|
CF_TAB("Chain1_4", tx_scale.chain1[3][0], 1),
|
CF_TAB("Chain0_5", tx_scale.chain0[4][0], 1),
|
CF_TAB("Chain1_5", tx_scale.chain1[4][0], 1),
|
CF_TAB("Chain0_6", tx_scale.chain0[5][0], 1),
|
CF_TAB("Chain1_6", tx_scale.chain1[5][0], 1),
|
CF_TAB("Chain0_7", tx_scale.chain0[6][0], 1),
|
CF_TAB("Chain1_7", tx_scale.chain1[6][0], 1),
|
CF_TAB("Chain0_8", tx_scale.chain0[7][0], 1),
|
CF_TAB("Chain1_8", tx_scale.chain1[7][0], 1),
|
CF_TAB("Chain0_9", tx_scale.chain0[8][0], 1),
|
CF_TAB("Chain1_9", tx_scale.chain1[8][0], 1),
|
CF_TAB("Chain0_10", tx_scale.chain0[9][0], 1),
|
CF_TAB("Chain1_10", tx_scale.chain1[9][0], 1),
|
CF_TAB("Chain0_11", tx_scale.chain0[10][0], 1),
|
CF_TAB("Chain1_11", tx_scale.chain1[10][0], 1),
|
CF_TAB("Chain0_12", tx_scale.chain0[11][0], 1),
|
CF_TAB("Chain1_12", tx_scale.chain1[11][0], 1),
|
CF_TAB("Chain0_13", tx_scale.chain0[12][0], 1),
|
CF_TAB("Chain1_13", tx_scale.chain1[12][0], 1),
|
CF_TAB("Chain0_14", tx_scale.chain0[13][0], 1),
|
CF_TAB("Chain1_14", tx_scale.chain1[13][0], 1),
|
CF_TAB("Chain0_36", tx_scale.chain0[14][0], 1),
|
CF_TAB("Chain1_36", tx_scale.chain1[14][0], 1),
|
CF_TAB("Chain0_40", tx_scale.chain0[15][0], 1),
|
CF_TAB("Chain1_40", tx_scale.chain1[15][0], 1),
|
CF_TAB("Chain0_44", tx_scale.chain0[16][0], 1),
|
CF_TAB("Chain1_44", tx_scale.chain1[16][0], 1),
|
CF_TAB("Chain0_48", tx_scale.chain0[17][0], 1),
|
CF_TAB("Chain1_48", tx_scale.chain1[17][0], 1),
|
CF_TAB("Chain0_52", tx_scale.chain0[18][0], 1),
|
CF_TAB("Chain1_52", tx_scale.chain1[18][0], 1),
|
CF_TAB("Chain0_56", tx_scale.chain0[19][0], 1),
|
CF_TAB("Chain1_56", tx_scale.chain1[19][0], 1),
|
CF_TAB("Chain0_60", tx_scale.chain0[20][0], 1),
|
CF_TAB("Chain1_60", tx_scale.chain1[20][0], 1),
|
CF_TAB("Chain0_64", tx_scale.chain0[21][0], 1),
|
CF_TAB("Chain1_64", tx_scale.chain1[21][0], 1),
|
CF_TAB("Chain0_100", tx_scale.chain0[22][0], 1),
|
CF_TAB("Chain1_100", tx_scale.chain1[22][0], 1),
|
CF_TAB("Chain0_104", tx_scale.chain0[23][0], 1),
|
CF_TAB("Chain1_104", tx_scale.chain1[23][0], 1),
|
CF_TAB("Chain0_108", tx_scale.chain0[24][0], 1),
|
CF_TAB("Chain1_108", tx_scale.chain1[24][0], 1),
|
CF_TAB("Chain0_112", tx_scale.chain0[25][0], 1),
|
CF_TAB("Chain1_112", tx_scale.chain1[25][0], 1),
|
CF_TAB("Chain0_116", tx_scale.chain0[26][0], 1),
|
CF_TAB("Chain1_116", tx_scale.chain1[26][0], 1),
|
CF_TAB("Chain0_120", tx_scale.chain0[27][0], 1),
|
CF_TAB("Chain1_120", tx_scale.chain1[27][0], 1),
|
CF_TAB("Chain0_124", tx_scale.chain0[28][0], 1),
|
CF_TAB("Chain1_124", tx_scale.chain1[28][0], 1),
|
CF_TAB("Chain0_128", tx_scale.chain0[29][0], 1),
|
CF_TAB("Chain1_128", tx_scale.chain1[29][0], 1),
|
CF_TAB("Chain0_132", tx_scale.chain0[30][0], 1),
|
CF_TAB("Chain1_132", tx_scale.chain1[30][0], 1),
|
CF_TAB("Chain0_136", tx_scale.chain0[31][0], 1),
|
CF_TAB("Chain1_136", tx_scale.chain1[31][0], 1),
|
CF_TAB("Chain0_140", tx_scale.chain0[32][0], 1),
|
CF_TAB("Chain1_140", tx_scale.chain1[32][0], 1),
|
CF_TAB("Chain0_144", tx_scale.chain0[33][0], 1),
|
CF_TAB("Chain1_144", tx_scale.chain1[33][0], 1),
|
CF_TAB("Chain0_149", tx_scale.chain0[34][0], 1),
|
CF_TAB("Chain1_149", tx_scale.chain1[34][0], 1),
|
CF_TAB("Chain0_153", tx_scale.chain0[35][0], 1),
|
CF_TAB("Chain1_153", tx_scale.chain1[35][0], 1),
|
CF_TAB("Chain0_157", tx_scale.chain0[36][0], 1),
|
CF_TAB("Chain1_157", tx_scale.chain1[36][0], 1),
|
CF_TAB("Chain0_161", tx_scale.chain0[37][0], 1),
|
CF_TAB("Chain1_161", tx_scale.chain1[37][0], 1),
|
CF_TAB("Chain0_165", tx_scale.chain0[38][0], 1),
|
CF_TAB("Chain1_165", tx_scale.chain1[38][0], 1),
|
|
/*[SETCTION 11]misc:misc_t
|
*/
|
CF_TAB("DFS_switch", misc.dfs_switch, 1),
|
CF_TAB("power_save_switch", misc.power_save_switch, 1),
|
CF_TAB("ex-Fem_and_ex-LNA_param_setup", misc.fem_lan_param_setup, 1),
|
CF_TAB("rssi_report_diff", misc.rssi_report_diff, 1),
|
|
/*[SETCTION 12]debug reg:debug_reg_t
|
*/
|
CF_TAB("address", debug_reg.address[0], 4),
|
CF_TAB("value", debug_reg.value[0], 4),
|
|
/*[SETCTION 13]coex_config:coex_config_t
|
*/
|
CF_TAB("bt_performance_cfg0", coex_config.bt_performance_cfg0, 4),
|
CF_TAB("bt_performance_cfg1", coex_config.bt_performance_cfg1, 4),
|
CF_TAB("wifi_performance_cfg0", coex_config.wifi_performance_cfg0, 4),
|
CF_TAB("wifi_performance_cfg2", coex_config.wifi_performance_cfg2, 4),
|
CF_TAB("strategy_cfg0", coex_config.strategy_cfg0, 4),
|
CF_TAB("strategy_cfg1", coex_config.strategy_cfg1, 4),
|
CF_TAB("strategy_cfg2", coex_config.strategy_cfg2, 4),
|
CF_TAB("compatibility_cfg0", coex_config.compatibility_cfg0, 4),
|
CF_TAB("compatibility_cfg1", coex_config.compatibility_cfg1, 4),
|
CF_TAB("ant_cfg0", coex_config.ant_cfg0, 4),
|
CF_TAB("ant_cfg1", coex_config.ant_cfg1, 4),
|
CF_TAB("isolation_cfg0", coex_config.isolation_cfg0, 4),
|
CF_TAB("isolation_cfg1", coex_config.isolation_cfg1, 4),
|
CF_TAB("reserved_cfg0", coex_config.reserved_cfg0, 4),
|
CF_TAB("reserved_cfg1", coex_config.reserved_cfg1, 4),
|
CF_TAB("reserved_cfg2", coex_config.reserved_cfg2, 4),
|
CF_TAB("reserved_cfg3", coex_config.reserved_cfg3, 4),
|
CF_TAB("reserved_cfg4", coex_config.reserved_cfg4, 4),
|
CF_TAB("reserved_cfg5", coex_config.reserved_cfg5, 4),
|
CF_TAB("reserved_cfg6", coex_config.reserved_cfg6, 4),
|
CF_TAB("reserved_cfg7", coex_config.reserved_cfg7, 4),
|
|
/*
|
* [SETCTION 14] rf_config:rf_config_t
|
*/
|
CF_TAB("rf_config", rf_config.rf_data, 1),
|
};
|
|
static int find_type(char key)
|
{
|
if ((key >= 'a' && key <= 'w') ||
|
(key >= 'y' && key <= 'z') ||
|
(key >= 'A' && key <= 'W') ||
|
(key >= 'Y' && key <= 'Z') ||
|
('_' == key))
|
return 1;
|
if ((key >= '0' && key <= '9') ||
|
('-' == key))
|
return 2;
|
if (('x' == key) ||
|
('X' == key) ||
|
('.' == key))
|
return 3;
|
if ((key == '\0') ||
|
('\r' == key) ||
|
('\n' == key) ||
|
('#' == key))
|
return 4;
|
return 0;
|
}
|
|
static int wifi_nvm_set_cmd(struct nvm_name_table *pTable,
|
struct nvm_cali_cmd *cmd, void *p_data)
|
{
|
int i;
|
unsigned char *p;
|
|
if ((1 != pTable->type) &&
|
(2 != pTable->type) &&
|
(4 != pTable->type))
|
return -1;
|
|
p = (unsigned char *)(p_data) + pTable->mem_offset;
|
|
wl_debug("[g_table]%s, offset:%u, num:%u, value:\
|
%d %d %d %d %d %d %d %d %d %d \n",
|
pTable->itm, pTable->mem_offset, cmd->num,
|
cmd->par[0], cmd->par[1], cmd->par[2],
|
cmd->par[3], cmd->par[4], cmd->par[5],
|
cmd->par[6], cmd->par[7], cmd->par[8],
|
cmd->par[9]);
|
|
for (i = 0; i < cmd->num; i++) {
|
if (1 == pTable->type)
|
*((unsigned char *)p + i)
|
= (unsigned char)(cmd->par[i]);
|
else if (2 == pTable->type)
|
*((unsigned short *)p + i)
|
= (unsigned short)(cmd->par[i]);
|
else if (4 == pTable->type)
|
*((unsigned int *)p + i)
|
= (unsigned int)(cmd->par[i]);
|
else
|
wl_err("%s, type err\n", __func__);
|
}
|
return 0;
|
}
|
|
static void get_cmd_par(char *str, struct nvm_cali_cmd *cmd)
|
{
|
int i, j, bufType, cType, flag;
|
char tmp[128];
|
char c;
|
long val;
|
|
bufType = -1;
|
cType = 0;
|
flag = 0;
|
memset(cmd, 0, sizeof(struct nvm_cali_cmd));
|
|
for (i = 0, j = 0;; i++) {
|
c = str[i];
|
cType = find_type(c);
|
if ((1 == cType) ||
|
(2 == cType) ||
|
(3 == cType)) {
|
tmp[j] = c;
|
j++;
|
if (-1 == bufType) {
|
if (2 == cType)
|
bufType = 2;
|
else
|
bufType = 1;
|
} else if (2 == bufType) {
|
if (1 == cType)
|
bufType = 1;
|
}
|
continue;
|
}
|
if (-1 != bufType) {
|
tmp[j] = '\0';
|
|
if ((1 == bufType) && (0 == flag)) {
|
strcpy(cmd->itm, tmp);
|
flag = 1;
|
} else {
|
if (kstrtol(tmp, 0, &val))
|
wl_info(" %s ", tmp);
|
/* pr_err("kstrtol %s: error\n", tmp); */
|
cmd->par[cmd->num] = val & 0xFFFFFFFF;
|
cmd->num++;
|
}
|
bufType = -1;
|
j = 0;
|
}
|
if (0 == cType)
|
continue;
|
if (4 == cType)
|
return;
|
}
|
}
|
|
static struct nvm_name_table *cf_table_match(struct nvm_cali_cmd *cmd)
|
{
|
int i;
|
struct nvm_name_table *pTable = NULL;
|
int len = sizeof(g_config_table) / sizeof(struct nvm_name_table);
|
|
if (NULL == cmd)
|
return NULL;
|
for (i = 0; i < len; i++) {
|
if (NULL == g_config_table[i].itm)
|
continue;
|
if (0 != strcmp(g_config_table[i].itm, cmd->itm))
|
continue;
|
pTable = &g_config_table[i];
|
break;
|
}
|
return pTable;
|
}
|
|
static int wifi_nvm_buf_operate(char *pBuf, int file_len, void *p_data)
|
{
|
int i, p;
|
struct nvm_cali_cmd *cmd;
|
struct wifi_conf_t *conf;
|
struct nvm_name_table *pTable = NULL;
|
|
if ((NULL == pBuf) || (0 == file_len))
|
return -1;
|
|
cmd = kzalloc(sizeof(struct nvm_cali_cmd), GFP_KERNEL);
|
for (i = 0, p = 0; i < file_len; i++) {
|
if (('\n' == *(pBuf + i)) ||
|
('\r' == *(pBuf + i)) ||
|
('\0' == *(pBuf + i))) {
|
if (5 <= (i - p)) {
|
get_cmd_par((pBuf + p), cmd);
|
pTable = cf_table_match(cmd);
|
|
if (NULL != pTable) {
|
wifi_nvm_set_cmd(pTable, cmd, p_data);
|
if (strcmp(pTable->itm, "rf_config") == 0) {
|
conf = (struct wifi_conf_t *)p_data;
|
conf->rf_config.rf_data_len = cmd->num;
|
}
|
}
|
}
|
p = i + 1;
|
}
|
}
|
|
kfree(cmd);
|
return 0;
|
}
|
|
static int wifi_nvm_parse(const char *path, void *p_data)
|
{
|
unsigned char *p_buf = NULL;
|
unsigned int read_len, buffer_len;
|
struct file *file;
|
char *buffer = NULL;
|
loff_t file_size = 0;
|
loff_t offset = 0;
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)
|
loff_t file_offset = 0;
|
#endif
|
int ret = 0;
|
|
file = filp_open(path, O_RDONLY, 0);
|
if (IS_ERR(file)) {
|
pr_err("open file %s error\n", path);
|
return -1;
|
}
|
|
file_size = vfs_llseek(file, 0, SEEK_END);
|
buffer_len = 0;
|
buffer = vmalloc(file_size);
|
p_buf = buffer;
|
if (!buffer) {
|
fput(file);
|
wl_err("no memory\n");
|
return -1;
|
}
|
|
do {
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)
|
read_len = kernel_read(file, p_buf, file_size, &file_offset);
|
#else
|
read_len = kernel_read(file, offset, p_buf, file_size);
|
#endif
|
if (read_len > 0) {
|
buffer_len += read_len;
|
file_size -= read_len;
|
p_buf += read_len;
|
offset += read_len;
|
}
|
} while ((read_len > 0) && (file_size > 0));
|
|
fput(file);
|
|
wl_info("%s read %s data_len:0x%x\n", __func__, path, buffer_len);
|
ret = wifi_nvm_buf_operate(buffer, buffer_len, p_data);
|
vfree(buffer);
|
wl_info("%s(), ok!\n", __func__);
|
return ret;
|
}
|
|
int get_wifi_config_param(struct wifi_conf_t *p)
|
{
|
int ant = 0;
|
int chipid = 0;
|
char path_buf[256] = {0};
|
char conf_name[32] = {0};
|
size_t len;
|
|
len = strlen(WIFI_BOARD_CFG_PATH);
|
if (len > sizeof(path_buf) - sizeof(conf_name)) {
|
wl_err("WIFI_BOARD_CFG_PATH is too long: %s\n", WIFI_BOARD_CFG_PATH);
|
return -1;
|
}
|
|
strcpy(path_buf, WIFI_BOARD_CFG_PATH);
|
if (path_buf[len - 1] != '/')
|
path_buf[len] = '/';
|
|
ant = marlin_get_ant_num();
|
if (ant < 0) {
|
wl_err("get ant config failed, ant = %d\n", ant);
|
return -1;
|
}
|
|
chipid = marlin_get_wcn_chipid();
|
if (chipid == 0) {
|
wl_err("get chip ip failed, chipid = %d\n", chipid);
|
return -1;
|
}
|
|
sprintf(conf_name, "wifi_%8x_%dant.ini", chipid, ant);
|
strcat(path_buf, conf_name);
|
|
pr_err("wifi ini path = %s\n", path_buf);
|
return wifi_nvm_parse(path_buf, (void *)p);
|
}
|
