[][MAC80211][mt76][Implement pre-cal support in testmode]
[Description]
Add atenl and mt76-test commands for getting pre-cal data.
[Release-log]
N/A
Change-Id: Ib113465d0ce1c8e9c8d5461e6911ba26c0afde1c
Reviewed-on: https://gerrit.mediatek.inc/c/openwrt/feeds/mtk_openwrt_feeds/+/6365523
diff --git a/feed/atenl/src/atenl.h b/feed/atenl/src/atenl.h
index 4078825..42d9455 100644
--- a/feed/atenl/src/atenl.h
+++ b/feed/atenl/src/atenl.h
@@ -22,6 +22,13 @@
#define RACFG_PKT_MAX_SIZE 1600
#define RACFG_HLEN 12
#define RACFG_MAGIC_NO 0x18142880
+#define PRE_CAL_INFO 16
+#define DPD_INFO_CH_SHIFT 24
+#define DPD_INFO_2G_SHIFT 16
+#define DPD_INFO_5G_SHIFT 8
+#define DPD_INFO_6G_SHIFT 0
+#define DPD_INFO_MASK GENMASK(7, 0)
+#define MT_EE_CAL_UNIT 1024
#define RACFG_CMD_TYPE_MASK GENMASK(14, 0)
#define RACFG_CMD_TYPE_ETHREQ BIT(3)
@@ -84,9 +91,14 @@
const char *mtd_part;
u32 mtd_offset;
+ u8 is_main_phy;
u8 *eeprom_data;
int eeprom_fd;
u16 eeprom_size;
+ u32 eeprom_prek_offs;
+
+ u8 *cal;
+ u32 cal_info[5];
bool cmd_mode;
@@ -350,6 +362,16 @@
TXBF_ACT_IBF_PHASE_E2P_UPDATE = 16,
};
+enum prek_ops {
+ PREK_SYNC_ALL = 1,
+ PREK_SYNC_GROUP,
+ PREK_SYNC_DPD_2G,
+ PREK_SYNC_DPD_5G,
+ PREK_SYNC_DPD_6G,
+ PREK_CLEAN_GROUP,
+ PREK_CLEAN_DPD,
+};
+
static inline bool is_mt7915(struct atenl *an)
{
return an->chip_id == 0x7915;
@@ -378,9 +400,11 @@
int atenl_nl_set_state(struct atenl *an, u8 band,
enum mt76_testmode_state state);
int atenl_nl_set_aid(struct atenl *an, u8 band, u8 aid);
+int atenl_nl_precal_sync_from_driver(struct atenl *an, enum prek_ops ops);
int atenl_eeprom_init(struct atenl *an, u8 phy_idx);
void atenl_eeprom_close(struct atenl *an);
int atenl_eeprom_write_mtd(struct atenl *an);
+int atenl_eeprom_update_precal(struct atenl *an, int write_offs, int size);
int atenl_eeprom_read_from_driver(struct atenl *an, u32 offset, int len);
void atenl_eeprom_cmd_handler(struct atenl *an, u8 phy_idx, char *cmd);
u16 atenl_get_center_channel(u8 bw, u8 ch_band, u16 ctrl_ch);
diff --git a/feed/atenl/src/eeprom.c b/feed/atenl/src/eeprom.c
index ee77ed7..1c1cb6c 100644
--- a/feed/atenl/src/eeprom.c
+++ b/feed/atenl/src/eeprom.c
@@ -6,7 +6,7 @@
#include "atenl.h"
-#define EEPROM_PART_SIZE 20480
+#define EEPROM_PART_SIZE 0x64000
char *eeprom_file;
static FILE *mtd_open(const char *mtd)
@@ -36,7 +36,7 @@
static int
atenl_flash_create_file(struct atenl *an)
{
-#define READ_LEN_LIMIT 20000
+#define READ_LEN_LIMIT 0x64000
char buf[1024];
ssize_t len, limit = 0;
FILE *f;
@@ -47,6 +47,7 @@
atenl_err("Failed to open MTD device\n");
return -1;
}
+ fseek(f, an->mtd_offset, SEEK_SET);
fd = open(eeprom_file, O_RDWR | O_CREAT | O_EXCL, 00644);
if (fd < 0)
@@ -212,11 +213,13 @@
switch (an->chip_id) {
case 0x7915:
an->eeprom_size = 3584;
+ an->eeprom_prek_offs = 0x62;
break;
case 0x7906:
case 0x7916:
case 0x7986:
an->eeprom_size = 4096;
+ an->eeprom_prek_offs = 0x19a;
break;
default:
break;
@@ -309,20 +312,24 @@
bool flash_mode;
int eeprom_fd;
char buf[30];
+ u8 main_phy_idx = phy_idx;
set_band_val(an, 0, phy_idx, phy_idx);
- snprintf(buf, sizeof(buf), "/tmp/atenl-eeprom-phy%u", phy_idx);
- eeprom_file = strdup(buf);
-
atenl_nl_check_mtd(an);
flash_mode = an->mtd_part != NULL;
+ if (flash_mode)
+ main_phy_idx = an->is_main_phy ? main_phy_idx : (main_phy_idx - 1);
+
+ snprintf(buf, sizeof(buf), "/tmp/atenl-eeprom-phy%u", main_phy_idx);
+ eeprom_file = strdup(buf);
+
eeprom_fd = atenl_eeprom_init_file(an, flash_mode);
if (eeprom_fd < 0)
return -1;
an->eeprom_data = mmap(NULL, EEPROM_PART_SIZE, PROT_READ | PROT_WRITE,
- MAP_SHARED, eeprom_fd, an->mtd_offset);
+ MAP_SHARED, eeprom_fd, 0);
if (!an->eeprom_data) {
perror("mmap");
close(eeprom_fd);
@@ -355,10 +362,35 @@
free(eeprom_file);
}
+int atenl_eeprom_update_precal(struct atenl *an, int write_offs, int size)
+{
+ u32 offs = an->eeprom_prek_offs;
+ u8 cal_indicator, *eeprom, *pre_cal;
+
+ if (!an->cal && !an->cal_info)
+ return 0;
+
+ eeprom = an->eeprom_data;
+ pre_cal = eeprom + an->eeprom_size;
+ cal_indicator = an->cal_info[4];
+
+ memcpy(eeprom + offs, &cal_indicator, sizeof(u8));
+ memcpy(pre_cal, an->cal_info, PRE_CAL_INFO);
+ pre_cal += (PRE_CAL_INFO + write_offs);
+
+ if (an->cal)
+ memcpy(pre_cal, an->cal, size);
+ else
+ memset(pre_cal, 0, size);
+
+ return 0;
+}
+
int atenl_eeprom_write_mtd(struct atenl *an)
{
bool flash_mode = an->mtd_part != NULL;
pid_t pid;
+ char offset[10];
if (!flash_mode)
return 0;
@@ -368,9 +400,10 @@
perror("Fork");
return EXIT_FAILURE;
} else if (pid == 0) {
- char *part = strdup(an->mtd_part);
- char *cmd[] = {"mtd", "write", eeprom_file, part, NULL};
int ret;
+ char *part = strdup(an->mtd_part);
+ snprintf(offset, sizeof(offset), "%d", an->mtd_offset);
+ char *cmd[] = {"mtd", "-p", offset, "write", eeprom_file, part, NULL};
ret = execvp("mtd", cmd);
if (ret < 0) {
@@ -500,6 +533,27 @@
atenl_info("val = 0x%x (%u)\n", an->eeprom_data[offset],
an->eeprom_data[offset]);
+ } else if (!strncmp(s, "precal", 6)) {
+ s = strchr(s, ' ');
+ if (!s)
+ return;
+ s++;
+
+ if (!strncmp(s, "sync group", 10)) {
+ atenl_nl_precal_sync_from_driver(an, PREK_SYNC_GROUP);
+ } else if (!strncmp(s, "sync dpd 2g", 11)) {
+ atenl_nl_precal_sync_from_driver(an, PREK_SYNC_DPD_2G);
+ } else if (!strncmp(s, "sync dpd 5g", 11)) {
+ atenl_nl_precal_sync_from_driver(an, PREK_SYNC_DPD_5G);
+ } else if (!strncmp(s, "sync dpd 6g", 11)) {
+ atenl_nl_precal_sync_from_driver(an, PREK_SYNC_DPD_6G);
+ } else if (!strncmp(s, "group clean", 11)) {
+ atenl_nl_precal_sync_from_driver(an, PREK_CLEAN_GROUP);
+ } else if (!strncmp(s, "dpd clean", 9)) {
+ atenl_nl_precal_sync_from_driver(an, PREK_CLEAN_DPD);
+ } else if (!strncmp(s, "sync", 4)) {
+ atenl_nl_precal_sync_from_driver(an, PREK_SYNC_ALL);
+ }
} else {
atenl_err("Unknown eeprom command: %s\n", cmd);
}
diff --git a/feed/atenl/src/nl.c b/feed/atenl/src/nl.c
index 368ffbd..85af9dc 100644
--- a/feed/atenl/src/nl.c
+++ b/feed/atenl/src/nl.c
@@ -26,6 +26,7 @@
[MT76_TM_ATTR_STATE] = { .type = NLA_U8 },
[MT76_TM_ATTR_MTD_PART] = { .type = NLA_STRING },
[MT76_TM_ATTR_MTD_OFFSET] = { .type = NLA_U32 },
+ [MT76_TM_ATTR_IS_MAIN_PHY] = { .type = NLA_U8 },
[MT76_TM_ATTR_TX_COUNT] = { .type = NLA_U32 },
[MT76_TM_ATTR_TX_LENGTH] = { .type = NLA_U32 },
[MT76_TM_ATTR_TX_RATE_MODE] = { .type = NLA_U8 },
@@ -39,6 +40,8 @@
[MT76_TM_ATTR_TX_ANTENNA] = { .type = NLA_U8 },
[MT76_TM_ATTR_FREQ_OFFSET] = { .type = NLA_U32 },
[MT76_TM_ATTR_STATS] = { .type = NLA_NESTED },
+ [MT76_TM_ATTR_PRECAL] = { .type = NLA_NESTED },
+ [MT76_TM_ATTR_PRECAL_INFO] = { .type = NLA_NESTED },
};
static struct nla_policy stats_policy[NUM_MT76_TM_STATS_ATTRS] = {
@@ -122,7 +125,6 @@
{
if (!tx_antenna)
return;
-
if (is_mt7915(an))
nla_put_u8(msg, MT76_TM_ATTR_TX_ANTENNA,
tx_antenna << (2 * an->cur_band));
@@ -1177,6 +1179,7 @@
an->mtd_part = strdup(nla_get_string(tb[MT76_TM_ATTR_MTD_PART]));
an->mtd_offset = nla_get_u32(tb[MT76_TM_ATTR_MTD_OFFSET]);
+ an->is_main_phy = nla_get_u32(tb[MT76_TM_ATTR_IS_MAIN_PHY]);
return NL_SKIP;
}
@@ -1306,3 +1309,187 @@
return 0;
}
+static int atenl_nl_precal_sync_from_driver_cb(struct nl_msg *msg, void *arg)
+{
+ struct atenl_nl_priv *nl_priv = (struct atenl_nl_priv *)arg;
+ struct atenl *an = nl_priv->an;
+ struct nlattr *tb[NUM_MT76_TM_ATTRS];
+ struct nlattr *attr, *cur;
+ int i, rem, prek_offset = nl_priv->attr;
+
+
+ attr = unl_find_attr(&nl_priv->unl, msg, NL80211_ATTR_TESTDATA);
+ if (!attr)
+ return NL_SKIP;
+
+ nla_parse_nested(tb, MT76_TM_ATTR_MAX, attr, testdata_policy);
+
+ if (!tb[MT76_TM_ATTR_PRECAL_INFO] && !tb[MT76_TM_ATTR_PRECAL]) {
+ atenl_info("No Pre cal data or info!\n");
+ return NL_SKIP;
+ }
+
+ if (tb[MT76_TM_ATTR_PRECAL_INFO]) {
+ i = 0;
+ nla_for_each_nested(cur, tb[MT76_TM_ATTR_PRECAL_INFO], rem) {
+ an->cal_info[i] = (u32) nla_get_u32(cur);
+ i++;
+ }
+ return NL_SKIP;
+ }
+
+ if (tb[MT76_TM_ATTR_PRECAL] && an->cal) {
+ i = prek_offset;
+ nla_for_each_nested(cur, tb[MT76_TM_ATTR_PRECAL], rem) {
+ an->cal[i] = (u8) nla_get_u8(cur);
+ i++;
+ }
+ return NL_SKIP;
+ }
+ atenl_info("No data found for pre-cal!\n");
+
+ return NL_SKIP;
+}
+
+static int
+atenl_nl_precal_sync_partition(struct atenl_nl_priv *nl_priv, enum mt76_testmode_attr attr,
+ int prek_type, int prek_offset)
+{
+ int ret;
+ void *ptr;
+ struct nl_msg *msg;
+ struct atenl *an = nl_priv->an;
+
+ msg = unl_genl_msg(&(nl_priv->unl), NL80211_CMD_TESTMODE, true);
+ nla_put_u32(msg, NL80211_ATTR_WIPHY, get_band_val(an, an->cur_band, phy_idx));
+ nl_priv->msg = msg;
+ nl_priv->attr = prek_offset;
+
+ ptr = nla_nest_start(msg, NL80211_ATTR_TESTDATA);
+ if (!ptr)
+ return -ENOMEM;
+
+ nla_put_flag(msg, attr);
+ if (attr == MT76_TM_ATTR_PRECAL)
+ nla_put_u8(msg, MT76_TM_ATTR_PRECAL_INFO, prek_type);
+ nla_nest_end(msg, ptr);
+
+ ret = unl_genl_request(&(nl_priv->unl), msg, atenl_nl_precal_sync_from_driver_cb, (void *)nl_priv);
+
+ if (ret) {
+ atenl_err("command process error!\n");
+ return ret;
+ }
+
+ return 0;
+}
+
+int atenl_nl_precal_sync_from_driver(struct atenl *an, enum prek_ops ops)
+{
+#define GROUP_IND_MASK BIT(0)
+#define DPD_IND_MASK GENMASK(3, 1)
+ int ret;
+ u32 i, times, group_size, dpd_size, total_size, transmit_size, offs;
+ u32 dpd_per_chan_size, dpd_chan_num[3], total_chan_num;
+ u32 size, base, base_idx, *size_ptr;
+ u8 cal_indicator, *precal_info;
+ struct atenl_nl_priv nl_priv = { .an = an };
+
+ offs = an->eeprom_prek_offs;
+ cal_indicator = an->eeprom_data[offs];
+
+ if (cal_indicator) {
+ precal_info = an->eeprom_data + an->eeprom_size;
+ memcpy(an->cal_info, precal_info, PRE_CAL_INFO);
+ group_size = an->cal_info[0];
+ dpd_size = an->cal_info[1];
+ total_size = group_size + dpd_size;
+ dpd_chan_num[0] = (an->cal_info[2] >> DPD_INFO_6G_SHIFT) & DPD_INFO_MASK;
+ dpd_chan_num[1] = (an->cal_info[2] >> DPD_INFO_5G_SHIFT) & DPD_INFO_MASK;
+ dpd_chan_num[2] = (an->cal_info[2] >> DPD_INFO_2G_SHIFT) & DPD_INFO_MASK;
+ dpd_per_chan_size = (an->cal_info[2] >> DPD_INFO_CH_SHIFT) & DPD_INFO_MASK;
+ total_chan_num = dpd_chan_num[0] + dpd_chan_num[1] + dpd_chan_num[2];
+ }
+
+ switch (ops){
+ case PREK_SYNC_ALL:
+ size_ptr = &total_size;
+ base_idx = 0;
+ goto start;
+ case PREK_SYNC_GROUP:
+ size_ptr = &group_size;
+ base_idx = 0;
+ goto start;
+ case PREK_SYNC_DPD_6G:
+ size_ptr = &dpd_size;
+ base_idx = 0;
+ goto start;
+ case PREK_SYNC_DPD_5G:
+ size_ptr = &dpd_size;
+ base_idx = 1;
+ goto start;
+ case PREK_SYNC_DPD_2G:
+ size_ptr = &dpd_size;
+ base_idx = 2;
+
+start:
+ if (unl_genl_init(&nl_priv.unl, "nl80211") < 0) {
+ atenl_err("Failed to connect to nl80211\n");
+ return 2;
+ }
+
+ ret = atenl_nl_precal_sync_partition(&nl_priv, MT76_TM_ATTR_PRECAL_INFO, 0, 0);
+ if (ret || !an->cal_info)
+ goto out;
+
+ group_size = an->cal_info[0];
+ dpd_size = an->cal_info[1];
+ total_size = group_size + dpd_size;
+ dpd_chan_num[0] = (an->cal_info[2] >> DPD_INFO_6G_SHIFT) & DPD_INFO_MASK;
+ dpd_chan_num[1] = (an->cal_info[2] >> DPD_INFO_5G_SHIFT) & DPD_INFO_MASK;
+ dpd_chan_num[2] = (an->cal_info[2] >> DPD_INFO_2G_SHIFT) & DPD_INFO_MASK;
+ dpd_per_chan_size = (an->cal_info[2] >> DPD_INFO_CH_SHIFT) & DPD_INFO_MASK;
+ total_chan_num = dpd_chan_num[0] + dpd_chan_num[1] + dpd_chan_num[2];
+ transmit_size = an->cal_info[3];
+
+ size = *size_ptr;
+ size = (size_ptr == &dpd_size) ? (size / total_chan_num * dpd_chan_num[base_idx]) :
+ size;
+ base = 0;
+ for (i = 0; i < base_idx; i++) {
+ base += dpd_chan_num[i] * dpd_per_chan_size * MT_EE_CAL_UNIT;
+ }
+ base += (size_ptr == &dpd_size) ? group_size : 0;
+
+ if (!an->cal)
+ an->cal = (u8 *) calloc(size, sizeof(u8));
+ times = size / transmit_size + 1;
+ for (i = 0; i < times; i++) {
+ ret = atenl_nl_precal_sync_partition(&nl_priv, MT76_TM_ATTR_PRECAL, ops,
+ i * transmit_size);
+ if (ret)
+ goto out;
+ }
+
+ ret = atenl_eeprom_update_precal(an, base, size);
+ break;
+ case PREK_CLEAN_GROUP:
+ if (!(cal_indicator & GROUP_IND_MASK))
+ return 0;
+ an->cal_info[4] = cal_indicator & (u8) ~GROUP_IND_MASK;
+ ret = atenl_eeprom_update_precal(an, 0, group_size);
+ break;
+ case PREK_CLEAN_DPD:
+ if (!(cal_indicator & DPD_IND_MASK))
+ return 0;
+ an->cal_info[4] = cal_indicator & (u8) ~DPD_IND_MASK;
+ ret = atenl_eeprom_update_precal(an, group_size, dpd_size);
+ break;
+ default:
+ break;
+ }
+
+out:
+ unl_free(&nl_priv.unl);
+ return ret;
+}
diff --git a/feed/atenl/src/nl.h b/feed/atenl/src/nl.h
index 0f21578..eaf082f 100644
--- a/feed/atenl/src/nl.h
+++ b/feed/atenl/src/nl.h
@@ -14,6 +14,7 @@
*
* @MT76_TM_ATTR_MTD_PART: mtd partition used for eeprom data (string)
* @MT76_TM_ATTR_MTD_OFFSET: offset of eeprom data within the partition (u32)
+ * @MT76_TM_ATTR_IS_MAIN_PHY: Is current phy index the main phy or the ext phy (u8)
*
* @MT76_TM_ATTR_TX_COUNT: configured number of frames to send when setting
* state to MT76_TM_STATE_TX_FRAMES (u32)
@@ -35,6 +36,12 @@
*
* @MT76_TM_ATTR_STATS: statistics (nested, see &enum mt76_testmode_stats_attr)
*
+ * @MT76_TM_ATTR_PRECAL: Pre-cal data (u8)
+ * @MT76_TM_ATTR_PRECAL: Pre-cal data (u8)
+ * @MT76_TM_ATTR_PRECAL_INFO: group size, dpd size, dpd_info, transmit size,
+ * eeprom cal indicator (u32),
+ * dpd_info = [dpd_per_chan_size, chan_num_2g,
+ * chan_num_5g, chan_num_6g]
* @MT76_TM_ATTR_TX_SPE_IDX: tx spatial extension index (u8)
*
* @MT76_TM_ATTR_TX_DUTY_CYCLE: packet tx duty cycle (u8)
@@ -50,6 +57,7 @@
MT76_TM_ATTR_MTD_PART,
MT76_TM_ATTR_MTD_OFFSET,
+ MT76_TM_ATTR_IS_MAIN_PHY,
MT76_TM_ATTR_TX_COUNT,
MT76_TM_ATTR_TX_LENGTH,
@@ -69,6 +77,9 @@
MT76_TM_ATTR_STATS,
+ MT76_TM_ATTR_PRECAL,
+ MT76_TM_ATTR_PRECAL_INFO,
+
MT76_TM_ATTR_TX_SPE_IDX,
MT76_TM_ATTR_TX_DUTY_CYCLE,