wifi: mt76: mt7925: add test mode support

The test mode interface allows controlled execution of chip-level
operations such as continuous transmission, reception tests, and
register access, which are essential during bring-up, diagnostics,
and factory testing.

Co-developed-by: Sean Wang <sean.wang@mediatek.com>
Signed-off-by: Sean Wang <sean.wang@mediatek.com>
Signed-off-by: Michael Lo <michael.lo@mediatek.com>
Link: https://patch.msgid.link/20250505233618.1951021-2-sean.wang@kernel.org
Signed-off-by: Felix Fietkau <nbd@nbd.name>

diff --git a/drivers/net/wireless/mediatek/mt76/mt7925/Makefile b/drivers/net/wireless/mediatek/mt76/mt7925/Makefile
index d321e4ed732fea6b7781efad6add8f5661043ad0..ade5e647c9415dec6c5981a68bb700783a509e7b 100644 (file)
--- a/drivers/net/wireless/mediatek/mt76/mt7925/Makefile
+++ b/drivers/net/wireless/mediatek/mt76/mt7925/Makefile
@@ -5,5 +5,6 @@ obj-$(CONFIG_MT7925E) += mt7925e.o
 obj-$(CONFIG_MT7925U) += mt7925u.o
 
 mt7925-common-y := mac.o mcu.o main.o init.o debugfs.o
+mt7925-common-$(CONFIG_NL80211_TESTMODE) += testmode.o
 mt7925e-y := pci.o pci_mac.o pci_mcu.o
 mt7925u-y := usb.o

diff --git a/drivers/net/wireless/mediatek/mt76/mt7925/main.c b/drivers/net/wireless/mediatek/mt76/mt7925/main.c
index 128a742ca6317e1d8a25169db6173bedc46684dd..f1d0e29ebd55ccb4786571dbd360e6be7e3a9d1a 100644 (file)
--- a/drivers/net/wireless/mediatek/mt76/mt7925/main.c
+++ b/drivers/net/wireless/mediatek/mt76/mt7925/main.c
@@ -2244,6 +2244,8 @@ const struct ieee80211_ops mt7925_ops = {
        .sta_statistics = mt792x_sta_statistics,
        .sched_scan_start = mt7925_start_sched_scan,
        .sched_scan_stop = mt7925_stop_sched_scan,
+       CFG80211_TESTMODE_CMD(mt7925_testmode_cmd)
+       CFG80211_TESTMODE_DUMP(mt7925_testmode_dump)
 #ifdef CONFIG_PM
        .suspend = mt7925_suspend,
        .resume = mt7925_resume,

diff --git a/drivers/net/wireless/mediatek/mt76/mt7925/mt7925.h b/drivers/net/wireless/mediatek/mt76/mt7925/mt7925.h
index 4e50f2597ccd4fad390141de5da0c865af8fa2ba..c507dcae07d4d17ffc6c1ddf31d72ef49f9f77ec 100644 (file)
--- a/drivers/net/wireless/mediatek/mt76/mt7925/mt7925.h
+++ b/drivers/net/wireless/mediatek/mt76/mt7925/mt7925.h
@@ -366,4 +366,9 @@ int mt7925_mcu_wtbl_update_hdr_trans(struct mt792x_dev *dev,
                                     struct ieee80211_sta *sta,
                                     int link_id);
 
+int mt7925_testmode_cmd(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
+                       void *data, int len);
+int mt7925_testmode_dump(struct ieee80211_hw *hw, struct sk_buff *msg,
+                        struct netlink_callback *cb, void *data, int len);
+
 #endif

diff --git a/drivers/net/wireless/mediatek/mt76/mt7925/testmode.c b/drivers/net/wireless/mediatek/mt76/mt7925/testmode.c
new file mode 100644 (file)
index 0000000..a3c9716
--- /dev/null
+++ b/drivers/net/wireless/mediatek/mt76/mt7925/testmode.c
@@ -0,0 +1,201 @@
+// SPDX-License-Identifier: ISC
+
+#include "mt7925.h"
+#include "mcu.h"
+
+#define MT7925_EVT_RSP_LEN 512
+
+enum mt7925_testmode_attr {
+       MT7925_TM_ATTR_UNSPEC,
+       MT7925_TM_ATTR_SET,
+       MT7925_TM_ATTR_QUERY,
+       MT7925_TM_ATTR_RSP,
+
+       /* keep last */
+       NUM_MT7925_TM_ATTRS,
+       MT7925_TM_ATTR_MAX = NUM_MT7925_TM_ATTRS - 1,
+};
+
+struct mt7925_tm_cmd {
+       u8 padding[4];
+       struct uni_cmd_testmode_ctrl c;
+} __packed;
+
+struct mt7925_tm_evt {
+       u32 param0;
+       u32 param1;
+} __packed;
+
+static const struct nla_policy mt7925_tm_policy[NUM_MT7925_TM_ATTRS] = {
+       [MT7925_TM_ATTR_SET] = NLA_POLICY_EXACT_LEN(sizeof(struct mt7925_tm_cmd)),
+       [MT7925_TM_ATTR_QUERY] = NLA_POLICY_EXACT_LEN(sizeof(struct mt7925_tm_cmd)),
+};
+
+static int
+mt7925_tm_set(struct mt792x_dev *dev, struct mt7925_tm_cmd *req)
+{
+       struct mt7925_rftest_cmd cmd;
+       struct mt7925_rftest_cmd *pcmd = &cmd;
+       bool testmode = false, normal = false;
+       struct mt76_connac_pm *pm = &dev->pm;
+       struct mt76_phy *phy = &dev->mphy;
+       int ret = -ENOTCONN;
+
+       memset(pcmd, 0, sizeof(*pcmd));
+       memcpy(pcmd, req, sizeof(struct mt7925_tm_cmd));
+
+       mutex_lock(&dev->mt76.mutex);
+
+       if (pcmd->ctrl.action == CMD_TEST_CTRL_ACT_SWITCH_MODE) {
+               if (pcmd->ctrl.data.op_mode == CMD_TEST_CTRL_ACT_SWITCH_MODE_NORMAL)
+                       normal = true;
+               else
+                       testmode = true;
+       }
+
+       if (testmode) {
+               /* Make sure testmode running on full power mode */
+               pm->enable = false;
+               cancel_delayed_work_sync(&pm->ps_work);
+               cancel_work_sync(&pm->wake_work);
+               __mt792x_mcu_drv_pmctrl(dev);
+
+               phy->test.state = MT76_TM_STATE_ON;
+       }
+
+       if (!mt76_testmode_enabled(phy))
+               goto out;
+
+       ret = mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(TESTMODE_CTRL), &cmd,
+                               sizeof(cmd), false);
+
+       if (ret)
+               goto out;
+
+       if (normal) {
+               /* Switch back to the normal world */
+               phy->test.state = MT76_TM_STATE_OFF;
+               pm->enable = true;
+       }
+out:
+       mutex_unlock(&dev->mt76.mutex);
+
+       return ret;
+}
+
+static int
+mt7925_tm_query(struct mt792x_dev *dev, struct mt7925_tm_cmd *req,
+               char *evt_resp)
+{
+       struct mt7925_rftest_cmd cmd;
+       char *pcmd = (char *)&cmd;
+       struct sk_buff *skb = NULL;
+       int ret = 1;
+
+       memset(pcmd, 0, sizeof(*pcmd));
+       memcpy(pcmd + 4, (char *)&req->c, sizeof(struct uni_cmd_testmode_ctrl));
+
+       if (*((uint16_t *)req->padding) == MCU_UNI_CMD_TESTMODE_CTRL)
+               ret = mt76_mcu_send_and_get_msg(&dev->mt76, MCU_UNI_QUERY(TESTMODE_CTRL),
+                                               &cmd, sizeof(cmd), true, &skb);
+       else if (*((uint16_t *)req->padding) == MCU_UNI_CMD_TESTMODE_RX_STAT)
+               ret = mt76_mcu_send_and_get_msg(&dev->mt76, MCU_UNI_QUERY(TESTMODE_RX_STAT),
+                                               &cmd, sizeof(cmd), true, &skb);
+
+       if (ret)
+               goto out;
+
+       memcpy((char *)evt_resp, (char *)skb->data + 8, MT7925_EVT_RSP_LEN);
+
+out:
+       dev_kfree_skb(skb);
+
+       return ret;
+}
+
+int mt7925_testmode_cmd(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
+                       void *data, int len)
+{
+       struct nlattr *tb[NUM_MT76_TM_ATTRS];
+       struct mt76_phy *mphy = hw->priv;
+       struct mt792x_phy *phy = mphy->priv;
+       int err;
+
+       if (!test_bit(MT76_STATE_RUNNING, &mphy->state) ||
+           !(hw->conf.flags & IEEE80211_CONF_MONITOR))
+               return -ENOTCONN;
+
+       err = nla_parse_deprecated(tb, MT76_TM_ATTR_MAX, data, len,
+                                  mt76_tm_policy, NULL);
+       if (err)
+               return err;
+
+       if (tb[MT76_TM_ATTR_DRV_DATA]) {
+               struct nlattr *drv_tb[NUM_MT7925_TM_ATTRS], *data;
+               int ret;
+
+               data = tb[MT76_TM_ATTR_DRV_DATA];
+               ret = nla_parse_nested_deprecated(drv_tb,
+                                                 MT7925_TM_ATTR_MAX,
+                                                 data, mt7925_tm_policy,
+                                                 NULL);
+               if (ret)
+                       return ret;
+
+               data = drv_tb[MT7925_TM_ATTR_SET];
+               if (data)
+                       return mt7925_tm_set(phy->dev, nla_data(data));
+       }
+
+       return -EINVAL;
+}
+
+int mt7925_testmode_dump(struct ieee80211_hw *hw, struct sk_buff *msg,
+                        struct netlink_callback *cb, void *data, int len)
+{
+       struct nlattr *tb[NUM_MT76_TM_ATTRS];
+       struct mt76_phy *mphy = hw->priv;
+       struct mt792x_phy *phy = mphy->priv;
+       int err;
+
+       if (!test_bit(MT76_STATE_RUNNING, &mphy->state) ||
+           !(hw->conf.flags & IEEE80211_CONF_MONITOR) ||
+           !mt76_testmode_enabled(mphy))
+               return -ENOTCONN;
+
+       if (cb->args[2]++ > 0)
+               return -ENOENT;
+
+       err = nla_parse_deprecated(tb, MT76_TM_ATTR_MAX, data, len,
+                                  mt76_tm_policy, NULL);
+       if (err)
+               return err;
+
+       if (tb[MT76_TM_ATTR_DRV_DATA]) {
+               struct nlattr *drv_tb[NUM_MT7925_TM_ATTRS], *data;
+               int ret;
+
+               data = tb[MT76_TM_ATTR_DRV_DATA];
+               ret = nla_parse_nested_deprecated(drv_tb,
+                                                 MT7925_TM_ATTR_MAX,
+                                                 data, mt7925_tm_policy,
+                                                 NULL);
+               if (ret)
+                       return ret;
+
+               data = drv_tb[MT7925_TM_ATTR_QUERY];
+               if (data) {
+                       char evt_resp[MT7925_EVT_RSP_LEN];
+
+                       err = mt7925_tm_query(phy->dev, nla_data(data),
+                                             evt_resp);
+                       if (err)
+                               return err;
+
+                       return nla_put(msg, MT7925_TM_ATTR_RSP,
+                                      sizeof(evt_resp), evt_resp);
+               }
+       }
+
+       return -EINVAL;
+}