mirror of
https://github.com/Telecominfraproject/wlan-ap.git
synced 2025-12-03 06:33:53 +00:00
322 lines
8.8 KiB
Diff
322 lines
8.8 KiB
Diff
From 9291fdb4f324728e5f4e233a08282f828cc04b80 Mon Sep 17 00:00:00 2001
|
|
From: StanleyYP Wang <StanleyYP.Wang@mediatek.com>
|
|
Date: Thu, 7 Jul 2022 11:09:59 +0800
|
|
Subject: [PATCH 1016/1053] wifi: mt76: mt7915: implement bin file mode
|
|
|
|
Signed-off-by: StanleyYP Wang <StanleyYP.Wang@mediatek.com>
|
|
Signed-off-by: Shayne Chen <shayne.chen@mediatek.com>
|
|
---
|
|
eeprom.c | 25 ++++++++++++++++++
|
|
mt76.h | 4 +++
|
|
mt7915/eeprom.c | 63 +++++++++++++++++++++++++++++++++++++++++---
|
|
mt7915/eeprom.h | 7 +++++
|
|
mt7915/mt7915.h | 3 +++
|
|
mt7915/mtk_debugfs.c | 44 +++++++++++++++++++++++++++++++
|
|
testmode.h | 2 +-
|
|
7 files changed, 144 insertions(+), 4 deletions(-)
|
|
|
|
diff --git a/eeprom.c b/eeprom.c
|
|
index 3625b16..9d029c0 100644
|
|
--- a/eeprom.c
|
|
+++ b/eeprom.c
|
|
@@ -161,6 +161,31 @@ static int mt76_get_of_eeprom(struct mt76_dev *dev, void *eep, int len)
|
|
return mt76_get_of_data_from_nvmem(dev, eep, "eeprom", len);
|
|
}
|
|
|
|
+bool mt76_check_bin_file_mode(struct mt76_dev *dev)
|
|
+{
|
|
+ struct device_node *np = dev->dev->of_node;
|
|
+ const char *bin_file_name = NULL;
|
|
+
|
|
+ if (!np)
|
|
+ return false;
|
|
+
|
|
+ of_property_read_string(np, "bin_file_name", &bin_file_name);
|
|
+
|
|
+ dev->bin_file_name = bin_file_name;
|
|
+ if (dev->bin_file_name) {
|
|
+ dev_info(dev->dev, "Using bin file %s\n", dev->bin_file_name);
|
|
+#ifdef CONFIG_NL80211_TESTMODE
|
|
+ dev->test_mtd.name = devm_kstrdup(dev->dev, bin_file_name, GFP_KERNEL);
|
|
+ dev->test_mtd.offset = -1;
|
|
+#endif
|
|
+ }
|
|
+
|
|
+ of_node_put(np);
|
|
+
|
|
+ return dev->bin_file_name ? true : false;
|
|
+}
|
|
+EXPORT_SYMBOL_GPL(mt76_check_bin_file_mode);
|
|
+
|
|
void
|
|
mt76_eeprom_override(struct mt76_phy *phy)
|
|
{
|
|
diff --git a/mt76.h b/mt76.h
|
|
index 8025e04..48e98a3 100644
|
|
--- a/mt76.h
|
|
+++ b/mt76.h
|
|
@@ -983,6 +983,9 @@ struct mt76_dev {
|
|
struct mt76_usb usb;
|
|
struct mt76_sdio sdio;
|
|
};
|
|
+
|
|
+ /* for mtk internal */
|
|
+ const char *bin_file_name;
|
|
};
|
|
|
|
/* per-phy stats. */
|
|
@@ -1246,6 +1249,7 @@ void mt76_eeprom_override(struct mt76_phy *phy);
|
|
int mt76_get_of_data_from_mtd(struct mt76_dev *dev, void *eep, int offset, int len);
|
|
int mt76_get_of_data_from_nvmem(struct mt76_dev *dev, void *eep,
|
|
const char *cell_name, int len);
|
|
+bool mt76_check_bin_file_mode(struct mt76_dev *dev);
|
|
|
|
struct mt76_queue *
|
|
mt76_init_queue(struct mt76_dev *dev, int qid, int idx, int n_desc,
|
|
diff --git a/mt7915/eeprom.c b/mt7915/eeprom.c
|
|
index f4876fe..c8b1c18 100644
|
|
--- a/mt7915/eeprom.c
|
|
+++ b/mt7915/eeprom.c
|
|
@@ -5,6 +5,30 @@
|
|
#include "mt7915.h"
|
|
#include "eeprom.h"
|
|
|
|
+static int
|
|
+mt7915_eeprom_load_precal_binfile(struct mt7915_dev *dev, u32 offs, u32 size)
|
|
+{
|
|
+ const struct firmware *fw = NULL;
|
|
+ int ret;
|
|
+
|
|
+ ret = request_firmware(&fw, dev->mt76.bin_file_name, dev->mt76.dev);
|
|
+ if (ret)
|
|
+ return ret;
|
|
+
|
|
+ if (!fw || !fw->data) {
|
|
+ dev_err(dev->mt76.dev, "Invalid bin (bin file mode), load precal fail\n");
|
|
+ ret = -EINVAL;
|
|
+ goto out;
|
|
+ }
|
|
+
|
|
+ memcpy(dev->cal, fw->data + offs, size);
|
|
+
|
|
+out:
|
|
+ release_firmware(fw);
|
|
+
|
|
+ return ret;
|
|
+}
|
|
+
|
|
static int mt7915_eeprom_load_precal(struct mt7915_dev *dev)
|
|
{
|
|
struct mt76_dev *mdev = &dev->mt76;
|
|
@@ -24,6 +48,9 @@ static int mt7915_eeprom_load_precal(struct mt7915_dev *dev)
|
|
|
|
offs = is_mt7915(&dev->mt76) ? MT_EE_PRECAL : MT_EE_PRECAL_V2;
|
|
|
|
+ if (dev->bin_file_mode)
|
|
+ return mt7915_eeprom_load_precal_binfile(dev, offs, size);
|
|
+
|
|
ret = mt76_get_of_data_from_mtd(mdev, dev->cal, offs, size);
|
|
if (!ret)
|
|
return ret;
|
|
@@ -59,8 +86,11 @@ static int mt7915_check_eeprom(struct mt7915_dev *dev)
|
|
}
|
|
}
|
|
|
|
-static char *mt7915_eeprom_name(struct mt7915_dev *dev)
|
|
+const char *mt7915_eeprom_name(struct mt7915_dev *dev)
|
|
{
|
|
+ if (dev->bin_file_mode)
|
|
+ return dev->mt76.bin_file_name;
|
|
+
|
|
switch (mt76_chip(&dev->mt76)) {
|
|
case 0x7915:
|
|
return dev->dbdc_support ?
|
|
@@ -101,7 +131,10 @@ mt7915_eeprom_load_default(struct mt7915_dev *dev)
|
|
return ret;
|
|
|
|
if (!fw || !fw->data) {
|
|
- dev_err(dev->mt76.dev, "Invalid default bin\n");
|
|
+ if (dev->bin_file_mode)
|
|
+ dev_err(dev->mt76.dev, "Invalid bin (bin file mode)\n");
|
|
+ else
|
|
+ dev_err(dev->mt76.dev, "Invalid default bin\n");
|
|
ret = -EINVAL;
|
|
goto out;
|
|
}
|
|
@@ -126,6 +159,7 @@ static int mt7915_eeprom_load(struct mt7915_dev *dev)
|
|
|
|
if (ret) {
|
|
dev->flash_mode = true;
|
|
+ dev->eeprom_mode = FLASH_MODE;
|
|
} else {
|
|
u8 free_block_num;
|
|
u32 block_num, i;
|
|
@@ -146,6 +180,8 @@ static int mt7915_eeprom_load(struct mt7915_dev *dev)
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
+
|
|
+ dev->eeprom_mode = EFUSE_MODE;
|
|
}
|
|
|
|
return mt7915_check_eeprom(dev);
|
|
@@ -251,12 +287,33 @@ int mt7915_eeprom_init(struct mt7915_dev *dev)
|
|
{
|
|
int ret;
|
|
|
|
- ret = mt7915_eeprom_load(dev);
|
|
+ dev->bin_file_mode = mt76_check_bin_file_mode(&dev->mt76);
|
|
+ if (dev->bin_file_mode) {
|
|
+ dev->mt76.eeprom.size = mt7915_eeprom_size(dev);
|
|
+ dev->mt76.eeprom.data = devm_kzalloc(dev->mt76.dev, dev->mt76.eeprom.size,
|
|
+ GFP_KERNEL);
|
|
+ if (!dev->mt76.eeprom.data)
|
|
+ return -ENOMEM;
|
|
+ ret = mt7915_eeprom_load_default(dev);
|
|
+ if (ret)
|
|
+ return ret;
|
|
+
|
|
+ ret = mt7915_check_eeprom(dev);
|
|
+ if (ret)
|
|
+ return ret;
|
|
+ dev->eeprom_mode = BIN_FILE_MODE;
|
|
+ } else {
|
|
+ ret = mt7915_eeprom_load(dev);
|
|
+ }
|
|
+
|
|
if (ret < 0) {
|
|
if (ret != -EINVAL)
|
|
return ret;
|
|
|
|
dev_warn(dev->mt76.dev, "eeprom load fail, use default bin\n");
|
|
+ dev->bin_file_mode = false;
|
|
+ dev->eeprom_mode = DEFAULT_BIN_MODE;
|
|
+
|
|
ret = mt7915_eeprom_load_default(dev);
|
|
if (ret)
|
|
return ret;
|
|
diff --git a/mt7915/eeprom.h b/mt7915/eeprom.h
|
|
index 509fb43..99101f9 100644
|
|
--- a/mt7915/eeprom.h
|
|
+++ b/mt7915/eeprom.h
|
|
@@ -109,6 +109,13 @@ enum mt7915_sku_rate_group {
|
|
MAX_SKU_RATE_GROUP_NUM,
|
|
};
|
|
|
|
+enum mt7915_eeprom_mode {
|
|
+ DEFAULT_BIN_MODE,
|
|
+ EFUSE_MODE,
|
|
+ FLASH_MODE,
|
|
+ BIN_FILE_MODE,
|
|
+};
|
|
+
|
|
static inline int
|
|
mt7915_get_channel_group_5g(int channel, bool is_7976)
|
|
{
|
|
diff --git a/mt7915/mt7915.h b/mt7915/mt7915.h
|
|
index 000751b..a06a46e 100644
|
|
--- a/mt7915/mt7915.h
|
|
+++ b/mt7915/mt7915.h
|
|
@@ -397,6 +397,8 @@ struct mt7915_dev {
|
|
|
|
bool dbdc_support;
|
|
bool flash_mode;
|
|
+ bool bin_file_mode;
|
|
+ u8 eeprom_mode;
|
|
bool muru_debug;
|
|
bool ibf;
|
|
|
|
@@ -783,6 +785,7 @@ void mt7915_dump_tmac_info(u8 *tmac_info);
|
|
int mt7915_mcu_set_txpower_level(struct mt7915_phy *phy, u8 drop_level);
|
|
void mt7915_packet_log_to_host(struct mt7915_dev *dev, const void *data, int len, int type, int des_len);
|
|
int mt7915_mcu_set_amsdu_algo(struct mt7915_dev *dev, u16 wcid, u8 enable);
|
|
+const char *mt7915_eeprom_name(struct mt7915_dev *dev);
|
|
|
|
#define PKT_BIN_DEBUG_MAGIC 0xc8763123
|
|
enum {
|
|
diff --git a/mt7915/mtk_debugfs.c b/mt7915/mtk_debugfs.c
|
|
index 30c5f68..02e0db3 100644
|
|
--- a/mt7915/mtk_debugfs.c
|
|
+++ b/mt7915/mtk_debugfs.c
|
|
@@ -3,6 +3,7 @@
|
|
#include "mt7915_debug.h"
|
|
#include "mac.h"
|
|
#include "mcu.h"
|
|
+#include "eeprom.h"
|
|
|
|
#ifdef MTK_DEBUG
|
|
#define LWTBL_IDX2BASE_ID GENMASK(14, 8)
|
|
@@ -3728,6 +3729,47 @@ static int mt7915_fw_wm_info_read(struct seq_file *s, void *data)
|
|
return 0;
|
|
}
|
|
|
|
+static int mt7915_show_eeprom_mode(struct seq_file *s, void *data)
|
|
+{
|
|
+ struct mt7915_dev *dev = dev_get_drvdata(s->private);
|
|
+ struct mt76_dev *mdev = &dev->mt76;
|
|
+ u8 free_block_num = 0;
|
|
+#ifdef CONFIG_NL80211_TESTMODE
|
|
+ const char *mtd_name = mdev->test_mtd.name;
|
|
+ u32 mtd_offset = mdev->test_mtd.offset;
|
|
+#else
|
|
+ const char *mtd_name = NULL;
|
|
+ u32 mtd_offset;
|
|
+#endif
|
|
+
|
|
+ seq_printf(s, "Current eeprom mode:\n");
|
|
+
|
|
+ switch (dev->eeprom_mode) {
|
|
+ case DEFAULT_BIN_MODE:
|
|
+ seq_printf(s, " default bin mode\n filename = %s\n", mt7915_eeprom_name(dev));
|
|
+ break;
|
|
+ case EFUSE_MODE:
|
|
+ seq_printf(s, " efuse mode\n");
|
|
+ mt7915_mcu_get_eeprom_free_block(dev, &free_block_num);
|
|
+ seq_printf(s, " free block number = %d\n", free_block_num);
|
|
+ break;
|
|
+ case FLASH_MODE:
|
|
+ if (mtd_name)
|
|
+ seq_printf(s, " flash mode\n mtd name = %s\n flash offset = 0x%x\n",
|
|
+ mtd_name, mtd_offset);
|
|
+ else
|
|
+ seq_printf(s, " flash mode\n");
|
|
+ break;
|
|
+ case BIN_FILE_MODE:
|
|
+ seq_printf(s, " bin file mode\n filename = %s\n", mt7915_eeprom_name(dev));
|
|
+ break;
|
|
+ default:
|
|
+ break;
|
|
+ }
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
int mt7915_mtk_init_debugfs(struct mt7915_phy *phy, struct dentry *dir)
|
|
{
|
|
struct mt7915_dev *dev = phy->dev;
|
|
@@ -3814,6 +3856,8 @@ int mt7915_mtk_init_debugfs(struct mt7915_phy *phy, struct dentry *dir)
|
|
|
|
debugfs_create_u8("sku_disable", 0600, dir, &dev->dbg.sku_disable);
|
|
|
|
+ debugfs_create_devm_seqfile(dev->mt76.dev, "eeprom_mode", dir,
|
|
+ mt7915_show_eeprom_mode);
|
|
return 0;
|
|
}
|
|
#endif
|
|
diff --git a/testmode.h b/testmode.h
|
|
index 20fab3e..91d1e86 100644
|
|
--- a/testmode.h
|
|
+++ b/testmode.h
|
|
@@ -17,7 +17,7 @@
|
|
* @MT76_TM_ATTR_RESET: reset parameters to default (flag)
|
|
* @MT76_TM_ATTR_STATE: test state (u32), see &enum mt76_testmode_state
|
|
*
|
|
- * @MT76_TM_ATTR_MTD_PART: mtd partition used for eeprom data (string)
|
|
+ * @MT76_TM_ATTR_MTD_PART: mtd partition or binfile used for eeprom data (string)
|
|
* @MT76_TM_ATTR_MTD_OFFSET: offset of eeprom data within the partition (u32)
|
|
* @MT76_TM_ATTR_BAND_IDX: band idx of the chip (u8)
|
|
*
|
|
--
|
|
2.18.0
|
|
|