mirror of
https://github.com/torvalds/linux.git
synced 2025-12-07 20:06:24 +00:00
mt76: mt7921: fix up the monitor mode
Properly set up the monitor mode the firmware can support to fix up RTS/CTS and beacon frames cannot be captured and forwarded to the host. Tested-by: Deren Wu <deren.wu@mediatek.com> Tested-by: Sven Eckelmann <sven@narfation.org> Signed-off-by: Sean Wang <sean.wang@mediatek.com> Signed-off-by: Felix Fietkau <nbd@nbd.name>
This commit is contained in:
@@ -993,6 +993,7 @@ enum {
|
||||
MCU_UNI_CMD_SUSPEND = 0x05,
|
||||
MCU_UNI_CMD_OFFLOAD = 0x06,
|
||||
MCU_UNI_CMD_HIF_CTRL = 0x07,
|
||||
MCU_UNI_CMD_SNIFFER = 0x24,
|
||||
};
|
||||
|
||||
enum {
|
||||
|
||||
@@ -479,6 +479,16 @@ mt7921_pm_interface_iter(void *priv, u8 *mac, struct ieee80211_vif *vif)
|
||||
mt7921_mcu_set_beacon_filter(dev, vif, dev->pm.enable);
|
||||
}
|
||||
|
||||
static void
|
||||
mt7921_sniffer_interface_iter(void *priv, u8 *mac, struct ieee80211_vif *vif)
|
||||
{
|
||||
struct mt7921_dev *dev = priv;
|
||||
struct ieee80211_hw *hw = mt76_hw(dev);
|
||||
bool enabled = !!(hw->conf.flags & IEEE80211_CONF_MONITOR);
|
||||
|
||||
mt7921_mcu_set_sniffer(dev, vif, enabled);
|
||||
}
|
||||
|
||||
void mt7921_set_runtime_pm(struct mt7921_dev *dev)
|
||||
{
|
||||
struct ieee80211_hw *hw = dev->mphy.hw;
|
||||
@@ -516,16 +526,10 @@ static int mt7921_config(struct ieee80211_hw *hw, u32 changed)
|
||||
}
|
||||
|
||||
if (changed & IEEE80211_CONF_CHANGE_MONITOR) {
|
||||
bool enabled = !!(hw->conf.flags & IEEE80211_CONF_MONITOR);
|
||||
|
||||
if (!enabled)
|
||||
phy->rxfilter |= MT_WF_RFCR_DROP_OTHER_UC;
|
||||
else
|
||||
phy->rxfilter &= ~MT_WF_RFCR_DROP_OTHER_UC;
|
||||
|
||||
mt76_rmw_field(dev, MT_DMA_DCR0(0), MT_DMA_DCR0_RXD_G5_EN,
|
||||
enabled);
|
||||
mt76_wr(dev, MT_WF_RFCR(0), phy->rxfilter);
|
||||
ieee80211_iterate_active_interfaces(hw,
|
||||
IEEE80211_IFACE_ITER_RESUME_ALL,
|
||||
mt7921_sniffer_interface_iter, dev);
|
||||
dev->mt76.rxfilter = mt76_rr(dev, MT_WF_RFCR(0));
|
||||
mt7921_set_runtime_pm(dev);
|
||||
}
|
||||
|
||||
|
||||
@@ -1135,3 +1135,33 @@ int mt7921_get_txpwr_info(struct mt7921_dev *dev, struct mt7921_txpwr *txpwr)
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int mt7921_mcu_set_sniffer(struct mt7921_dev *dev, struct ieee80211_vif *vif,
|
||||
bool enable)
|
||||
{
|
||||
struct mt76_vif *mvif = (struct mt76_vif *)vif->drv_priv;
|
||||
struct {
|
||||
struct {
|
||||
u8 band_idx;
|
||||
u8 pad[3];
|
||||
} __packed hdr;
|
||||
struct sniffer_enable_tlv {
|
||||
__le16 tag;
|
||||
__le16 len;
|
||||
u8 enable;
|
||||
u8 pad[3];
|
||||
} __packed enable;
|
||||
} req = {
|
||||
.hdr = {
|
||||
.band_idx = mvif->band_idx,
|
||||
},
|
||||
.enable = {
|
||||
.tag = cpu_to_le16(0),
|
||||
.len = cpu_to_le16(sizeof(struct sniffer_enable_tlv)),
|
||||
.enable = enable,
|
||||
},
|
||||
};
|
||||
|
||||
return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(SNIFFER), &req, sizeof(req),
|
||||
true);
|
||||
}
|
||||
|
||||
@@ -452,4 +452,6 @@ void mt7921s_tx_complete_skb(struct mt76_dev *mdev, struct mt76_queue_entry *e);
|
||||
bool mt7921s_tx_status_data(struct mt76_dev *mdev, u8 *update);
|
||||
void mt7921_mac_add_txs(struct mt7921_dev *dev, void *data);
|
||||
void mt7921_set_runtime_pm(struct mt7921_dev *dev);
|
||||
int mt7921_mcu_set_sniffer(struct mt7921_dev *dev, struct ieee80211_vif *vif,
|
||||
bool enable);
|
||||
#endif
|
||||
|
||||
Reference in New Issue
Block a user