| From 117480121b8833507a563ecd319bcf57c270b977 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 1122/1128] mt76: mt7915: implement bin file mode |
| |
| Signed-off-by: StanleyYP Wang <StanleyYP.Wang@mediatek.com> |
| --- |
| eeprom.c | 18 +++++++++++++++ |
| mt76.h | 1 + |
| mt7915/eeprom.c | 53 ++++++++++++++++++++------------------------ |
| mt7915/eeprom.h | 44 ++++++++++++++++++++++++++++++++++++ |
| mt7915/mt7915.h | 17 +++++++++++--- |
| mt7915/mtk_debugfs.c | 41 ++++++++++++++++++++++++++++++++++ |
| 6 files changed, 142 insertions(+), 32 deletions(-) |
| |
| diff --git a/eeprom.c b/eeprom.c |
| index cb6ff17a..aac70efb 100644 |
| --- a/eeprom.c |
| +++ b/eeprom.c |
| @@ -104,6 +104,24 @@ out_put_node: |
| } |
| EXPORT_SYMBOL_GPL(mt76_get_of_eeprom); |
| |
| +bool mt76_check_bin_file_mode(struct mt76_dev *dev) |
| +{ |
| + struct device_node *np = dev->dev->of_node; |
| + const __be32 *bin_file_mode; |
| + bool ret = false; |
| + |
| + if (!np) |
| + return false; |
| + |
| + bin_file_mode = of_get_property(np, "bin_file_mode", NULL); |
| + if (bin_file_mode && be32_to_cpu(*bin_file_mode)) |
| + ret = true; |
| + |
| + of_node_put(np); |
| + return ret; |
| +} |
| +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 2bacc1b4..d102333b 100644 |
| --- a/mt76.h |
| +++ b/mt76.h |
| @@ -1029,6 +1029,7 @@ void mt76_seq_puts_array(struct seq_file *file, const char *str, |
| int mt76_eeprom_init(struct mt76_dev *dev, int len); |
| void mt76_eeprom_override(struct mt76_phy *phy); |
| int mt76_get_of_eeprom(struct mt76_dev *dev, void *data, int offset, 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 7bdd4d52..64a7750b 100644 |
| --- a/mt7915/eeprom.c |
| +++ b/mt7915/eeprom.c |
| @@ -42,33 +42,6 @@ static int mt7915_check_eeprom(struct mt7915_dev *dev) |
| } |
| } |
| |
| -static char *mt7915_eeprom_name(struct mt7915_dev *dev) |
| -{ |
| - switch (mt76_chip(&dev->mt76)) { |
| - case 0x7915: |
| - return dev->dbdc_support ? |
| - MT7915_EEPROM_DEFAULT_DBDC : MT7915_EEPROM_DEFAULT; |
| - case 0x7986: |
| - switch (mt7915_check_adie(dev, true)) { |
| - case MT7976_ONE_ADIE_DBDC: |
| - return MT7986_EEPROM_MT7976_DEFAULT_DBDC; |
| - case MT7975_ONE_ADIE: |
| - return MT7986_EEPROM_MT7975_DEFAULT; |
| - case MT7976_ONE_ADIE: |
| - return MT7986_EEPROM_MT7976_DEFAULT; |
| - case MT7975_DUAL_ADIE: |
| - return MT7986_EEPROM_MT7975_DUAL_DEFAULT; |
| - case MT7976_DUAL_ADIE: |
| - return MT7986_EEPROM_MT7976_DUAL_DEFAULT; |
| - default: |
| - break; |
| - } |
| - return NULL; |
| - default: |
| - return MT7916_EEPROM_DEFAULT; |
| - } |
| -} |
| - |
| static int |
| mt7915_eeprom_load_default(struct mt7915_dev *dev) |
| { |
| @@ -81,7 +54,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; |
| } |
| @@ -106,6 +82,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; |
| @@ -126,6 +103,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); |
| @@ -231,12 +210,28 @@ 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); |
| + 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 fdae347e..f228926b 100644 |
| --- a/mt7915/eeprom.h |
| +++ b/mt7915/eeprom.h |
| @@ -108,6 +108,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) |
| { |
| @@ -184,6 +191,43 @@ mt7915_get_cal_group_size(struct mt7915_dev *dev) |
| } |
| } |
| |
| +static inline char *mt7915_eeprom_name(struct mt7915_dev *dev) |
| +{ |
| + switch (mt76_chip(&dev->mt76)) { |
| + case 0x7915: |
| + if (dev->bin_file_mode) |
| + return dev->dbdc_support ? |
| + MT7915_BIN_FILE_DBDC : MT7915_BIN_FILE; |
| + else |
| + return dev->dbdc_support ? |
| + MT7915_EEPROM_DEFAULT_DBDC : MT7915_EEPROM_DEFAULT; |
| + case 0x7986: |
| + switch (mt7915_check_adie(dev, true)) { |
| + case MT7976_ONE_ADIE_DBDC: |
| + return dev->bin_file_mode ? |
| + MT7986_BIN_FILE_MT7976_DBDC : MT7986_EEPROM_MT7976_DEFAULT_DBDC; |
| + case MT7975_ONE_ADIE: |
| + return dev->bin_file_mode ? |
| + MT7986_BIN_FILE_MT7975 : MT7986_EEPROM_MT7975_DEFAULT; |
| + case MT7976_ONE_ADIE: |
| + return dev->bin_file_mode ? |
| + MT7986_BIN_FILE_MT7976 : MT7986_EEPROM_MT7976_DEFAULT; |
| + case MT7975_DUAL_ADIE: |
| + return dev->bin_file_mode ? |
| + MT7986_BIN_FILE_MT7975_DUAL : MT7986_EEPROM_MT7975_DUAL_DEFAULT; |
| + case MT7976_DUAL_ADIE: |
| + return dev->bin_file_mode ? |
| + MT7986_BIN_FILE_MT7976_DUAL : MT7986_EEPROM_MT7976_DUAL_DEFAULT; |
| + default: |
| + break; |
| + } |
| + return NULL; |
| + default: |
| + return dev->bin_file_mode ? |
| + MT7916_BIN_FILE : MT7916_EEPROM_DEFAULT; |
| + } |
| +} |
| + |
| extern const u8 mt7915_sku_group_len[MAX_SKU_RATE_GROUP_NUM]; |
| |
| #endif |
| diff --git a/mt7915/mt7915.h b/mt7915/mt7915.h |
| index 5bffcff5..239eef58 100644 |
| --- a/mt7915/mt7915.h |
| +++ b/mt7915/mt7915.h |
| @@ -42,15 +42,24 @@ |
| #define MT7986_ROM_PATCH "mediatek/mt7986_rom_patch.bin" |
| #define MT7986_ROM_PATCH_MT7975 "mediatek/mt7986_rom_patch_mt7975.bin" |
| |
| -#define MT7915_EEPROM_DEFAULT "mediatek/mt7915_eeprom.bin" |
| -#define MT7915_EEPROM_DEFAULT_DBDC "mediatek/mt7915_eeprom_dbdc.bin" |
| -#define MT7916_EEPROM_DEFAULT "mediatek/mt7916_eeprom.bin" |
| +#define MT7915_EEPROM_DEFAULT "mediatek/mt7915_eeprom.bin" |
| +#define MT7915_EEPROM_DEFAULT_DBDC "mediatek/mt7915_eeprom_dbdc.bin" |
| +#define MT7916_EEPROM_DEFAULT "mediatek/mt7916_eeprom.bin" |
| #define MT7986_EEPROM_MT7975_DEFAULT "mediatek/mt7986_eeprom_mt7975.bin" |
| #define MT7986_EEPROM_MT7975_DUAL_DEFAULT "mediatek/mt7986_eeprom_mt7975_dual.bin" |
| #define MT7986_EEPROM_MT7976_DEFAULT "mediatek/mt7986_eeprom_mt7976.bin" |
| #define MT7986_EEPROM_MT7976_DEFAULT_DBDC "mediatek/mt7986_eeprom_mt7976_dbdc.bin" |
| #define MT7986_EEPROM_MT7976_DUAL_DEFAULT "mediatek/mt7986_eeprom_mt7976_dual.bin" |
| |
| +#define MT7915_BIN_FILE "mediatek/mt7915_binfile.bin" |
| +#define MT7915_BIN_FILE_DBDC "mediatek/mt7915_binfile_dbdc.bin" |
| +#define MT7916_BIN_FILE "mediatek/mt7916_binfile.bin" |
| +#define MT7986_BIN_FILE_MT7975 "mediatek/mt7986_binfile_mt7975.bin" |
| +#define MT7986_BIN_FILE_MT7975_DUAL "mediatek/mt7986_binfile_mt7975_dual.bin" |
| +#define MT7986_BIN_FILE_MT7976 "mediatek/mt7986_binfile_mt7976.bin" |
| +#define MT7986_BIN_FILE_MT7976_DBDC "mediatek/mt7986_binfile_mt7976_dbdc.bin" |
| +#define MT7986_BIN_FILE_MT7976_DUAL "mediatek/mt7986_binfile_mt7976_dual.bin" |
| + |
| #define MT7915_EEPROM_SIZE 3584 |
| #define MT7916_EEPROM_SIZE 4096 |
| |
| @@ -396,6 +405,8 @@ struct mt7915_dev { |
| |
| bool dbdc_support; |
| bool flash_mode; |
| + bool bin_file_mode; |
| + u8 eeprom_mode; |
| bool muru_debug; |
| bool ibf; |
| |
| diff --git a/mt7915/mtk_debugfs.c b/mt7915/mtk_debugfs.c |
| index d96f222a..376e5f89 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) |
| @@ -2893,6 +2894,44 @@ mt7915_wa_debug(void *data, u64 val) |
| DEFINE_DEBUGFS_ATTRIBUTE(fops_wa_debug, NULL, mt7915_wa_debug, |
| "0x%llx\n"); |
| |
| +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; |
| +#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"); |
| + 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; |
| @@ -2973,6 +3012,8 @@ int mt7915_mtk_init_debugfs(struct mt7915_phy *phy, struct dentry *dir) |
| debugfs_create_devm_seqfile(dev->mt76.dev, "fw_version", dir, |
| mt7915_dump_version); |
| |
| + debugfs_create_devm_seqfile(dev->mt76.dev, "eeprom_mode", dir, |
| + mt7915_show_eeprom_mode); |
| return 0; |
| } |
| #endif |
| -- |
| 2.25.1 |
| |