16c92544dSBjoern A. Zeeb // SPDX-License-Identifier: ISC
26c92544dSBjoern A. Zeeb /* Copyright (C) 2020 MediaTek Inc. */
36c92544dSBjoern A. Zeeb
46c92544dSBjoern A. Zeeb #include <linux/fs.h>
56c92544dSBjoern A. Zeeb #include <linux/firmware.h>
66c92544dSBjoern A. Zeeb #include "mt7921.h"
76c92544dSBjoern A. Zeeb #include "mcu.h"
8cbb3ec25SBjoern A. Zeeb #include "../mt76_connac2_mac.h"
9cbb3ec25SBjoern A. Zeeb #include "../mt792x_trace.h"
106c92544dSBjoern A. Zeeb
116c92544dSBjoern A. Zeeb #define MT_STA_BFER BIT(0)
126c92544dSBjoern A. Zeeb #define MT_STA_BFEE BIT(1)
136c92544dSBjoern A. Zeeb
146c92544dSBjoern A. Zeeb static bool mt7921_disable_clc;
156c92544dSBjoern A. Zeeb module_param_named(disable_clc, mt7921_disable_clc, bool, 0644);
166c92544dSBjoern A. Zeeb MODULE_PARM_DESC(disable_clc, "disable CLC support");
176c92544dSBjoern A. Zeeb
mt7921_mcu_parse_response(struct mt76_dev * mdev,int cmd,struct sk_buff * skb,int seq)186c92544dSBjoern A. Zeeb int mt7921_mcu_parse_response(struct mt76_dev *mdev, int cmd,
196c92544dSBjoern A. Zeeb struct sk_buff *skb, int seq)
206c92544dSBjoern A. Zeeb {
216c92544dSBjoern A. Zeeb int mcu_cmd = FIELD_GET(__MCU_CMD_FIELD_ID, cmd);
226c92544dSBjoern A. Zeeb struct mt76_connac2_mcu_rxd *rxd;
236c92544dSBjoern A. Zeeb int ret = 0;
246c92544dSBjoern A. Zeeb
256c92544dSBjoern A. Zeeb if (!skb) {
266c92544dSBjoern A. Zeeb dev_err(mdev->dev, "Message %08x (seq %d) timeout\n",
276c92544dSBjoern A. Zeeb cmd, seq);
28cbb3ec25SBjoern A. Zeeb mt792x_reset(mdev);
296c92544dSBjoern A. Zeeb
306c92544dSBjoern A. Zeeb return -ETIMEDOUT;
316c92544dSBjoern A. Zeeb }
326c92544dSBjoern A. Zeeb
336c92544dSBjoern A. Zeeb rxd = (struct mt76_connac2_mcu_rxd *)skb->data;
346c92544dSBjoern A. Zeeb if (seq != rxd->seq)
356c92544dSBjoern A. Zeeb return -EAGAIN;
366c92544dSBjoern A. Zeeb
376c92544dSBjoern A. Zeeb if (cmd == MCU_CMD(PATCH_SEM_CONTROL) ||
386c92544dSBjoern A. Zeeb cmd == MCU_CMD(PATCH_FINISH_REQ)) {
396c92544dSBjoern A. Zeeb skb_pull(skb, sizeof(*rxd) - 4);
406c92544dSBjoern A. Zeeb ret = *skb->data;
416c92544dSBjoern A. Zeeb } else if (cmd == MCU_EXT_CMD(THERMAL_CTRL)) {
426c92544dSBjoern A. Zeeb skb_pull(skb, sizeof(*rxd) + 4);
436c92544dSBjoern A. Zeeb ret = le32_to_cpu(*(__le32 *)skb->data);
446c92544dSBjoern A. Zeeb } else if (cmd == MCU_UNI_CMD(DEV_INFO_UPDATE) ||
456c92544dSBjoern A. Zeeb cmd == MCU_UNI_CMD(BSS_INFO_UPDATE) ||
466c92544dSBjoern A. Zeeb cmd == MCU_UNI_CMD(STA_REC_UPDATE) ||
476c92544dSBjoern A. Zeeb cmd == MCU_UNI_CMD(HIF_CTRL) ||
486c92544dSBjoern A. Zeeb cmd == MCU_UNI_CMD(OFFLOAD) ||
496c92544dSBjoern A. Zeeb cmd == MCU_UNI_CMD(SUSPEND)) {
50cbb3ec25SBjoern A. Zeeb struct mt76_connac_mcu_uni_event *event;
516c92544dSBjoern A. Zeeb
526c92544dSBjoern A. Zeeb skb_pull(skb, sizeof(*rxd));
53cbb3ec25SBjoern A. Zeeb event = (struct mt76_connac_mcu_uni_event *)skb->data;
546c92544dSBjoern A. Zeeb ret = le32_to_cpu(event->status);
556c92544dSBjoern A. Zeeb /* skip invalid event */
566c92544dSBjoern A. Zeeb if (mcu_cmd != event->cid)
576c92544dSBjoern A. Zeeb ret = -EAGAIN;
586c92544dSBjoern A. Zeeb } else if (cmd == MCU_CE_QUERY(REG_READ)) {
59cbb3ec25SBjoern A. Zeeb struct mt76_connac_mcu_reg_event *event;
606c92544dSBjoern A. Zeeb
616c92544dSBjoern A. Zeeb skb_pull(skb, sizeof(*rxd));
62cbb3ec25SBjoern A. Zeeb event = (struct mt76_connac_mcu_reg_event *)skb->data;
636c92544dSBjoern A. Zeeb ret = (int)le32_to_cpu(event->val);
64*8ba4d145SBjoern A. Zeeb } else if (cmd == MCU_EXT_CMD(WF_RF_PIN_CTRL)) {
65*8ba4d145SBjoern A. Zeeb struct mt7921_wf_rf_pin_ctrl_event *event;
66*8ba4d145SBjoern A. Zeeb
67*8ba4d145SBjoern A. Zeeb skb_pull(skb, sizeof(*rxd));
68*8ba4d145SBjoern A. Zeeb event = (struct mt7921_wf_rf_pin_ctrl_event *)skb->data;
69*8ba4d145SBjoern A. Zeeb ret = (int)event->result;
706c92544dSBjoern A. Zeeb } else {
716c92544dSBjoern A. Zeeb skb_pull(skb, sizeof(struct mt76_connac2_mcu_rxd));
726c92544dSBjoern A. Zeeb }
736c92544dSBjoern A. Zeeb
746c92544dSBjoern A. Zeeb return ret;
756c92544dSBjoern A. Zeeb }
766c92544dSBjoern A. Zeeb EXPORT_SYMBOL_GPL(mt7921_mcu_parse_response);
776c92544dSBjoern A. Zeeb
mt7921_mcu_read_eeprom(struct mt792x_dev * dev,u32 offset,u8 * val)78cbb3ec25SBjoern A. Zeeb static int mt7921_mcu_read_eeprom(struct mt792x_dev *dev, u32 offset, u8 *val)
796c92544dSBjoern A. Zeeb {
806c92544dSBjoern A. Zeeb struct mt7921_mcu_eeprom_info *res, req = {
816c92544dSBjoern A. Zeeb .addr = cpu_to_le32(round_down(offset,
826c92544dSBjoern A. Zeeb MT7921_EEPROM_BLOCK_SIZE)),
836c92544dSBjoern A. Zeeb };
846c92544dSBjoern A. Zeeb struct sk_buff *skb;
856c92544dSBjoern A. Zeeb int ret;
866c92544dSBjoern A. Zeeb
876c92544dSBjoern A. Zeeb ret = mt76_mcu_send_and_get_msg(&dev->mt76, MCU_EXT_QUERY(EFUSE_ACCESS),
886c92544dSBjoern A. Zeeb &req, sizeof(req), true, &skb);
896c92544dSBjoern A. Zeeb if (ret)
906c92544dSBjoern A. Zeeb return ret;
916c92544dSBjoern A. Zeeb
926c92544dSBjoern A. Zeeb res = (struct mt7921_mcu_eeprom_info *)skb->data;
936c92544dSBjoern A. Zeeb *val = res->data[offset % MT7921_EEPROM_BLOCK_SIZE];
946c92544dSBjoern A. Zeeb dev_kfree_skb(skb);
956c92544dSBjoern A. Zeeb
966c92544dSBjoern A. Zeeb return 0;
976c92544dSBjoern A. Zeeb }
986c92544dSBjoern A. Zeeb
996c92544dSBjoern A. Zeeb #ifdef CONFIG_PM
1006c92544dSBjoern A. Zeeb
1016c92544dSBjoern A. Zeeb static int
mt7921_mcu_set_ipv6_ns_filter(struct mt76_dev * dev,struct ieee80211_vif * vif,bool suspend)1026c92544dSBjoern A. Zeeb mt7921_mcu_set_ipv6_ns_filter(struct mt76_dev *dev,
1036c92544dSBjoern A. Zeeb struct ieee80211_vif *vif, bool suspend)
1046c92544dSBjoern A. Zeeb {
105cbb3ec25SBjoern A. Zeeb struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
1066c92544dSBjoern A. Zeeb struct {
1076c92544dSBjoern A. Zeeb struct {
1086c92544dSBjoern A. Zeeb u8 bss_idx;
1096c92544dSBjoern A. Zeeb u8 pad[3];
1106c92544dSBjoern A. Zeeb } __packed hdr;
1116c92544dSBjoern A. Zeeb struct mt76_connac_arpns_tlv arpns;
1126c92544dSBjoern A. Zeeb } req = {
1136c92544dSBjoern A. Zeeb .hdr = {
114*8ba4d145SBjoern A. Zeeb .bss_idx = mvif->bss_conf.mt76.idx,
1156c92544dSBjoern A. Zeeb },
1166c92544dSBjoern A. Zeeb .arpns = {
1176c92544dSBjoern A. Zeeb .tag = cpu_to_le16(UNI_OFFLOAD_OFFLOAD_ND),
1186c92544dSBjoern A. Zeeb .len = cpu_to_le16(sizeof(struct mt76_connac_arpns_tlv)),
1196c92544dSBjoern A. Zeeb .mode = suspend,
1206c92544dSBjoern A. Zeeb },
1216c92544dSBjoern A. Zeeb };
1226c92544dSBjoern A. Zeeb
1236c92544dSBjoern A. Zeeb return mt76_mcu_send_msg(dev, MCU_UNI_CMD_OFFLOAD, &req, sizeof(req),
1246c92544dSBjoern A. Zeeb true);
1256c92544dSBjoern A. Zeeb }
1266c92544dSBjoern A. Zeeb
mt7921_mcu_set_suspend_iter(void * priv,u8 * mac,struct ieee80211_vif * vif)1276c92544dSBjoern A. Zeeb void mt7921_mcu_set_suspend_iter(void *priv, u8 *mac, struct ieee80211_vif *vif)
1286c92544dSBjoern A. Zeeb {
1296c92544dSBjoern A. Zeeb if (IS_ENABLED(CONFIG_IPV6)) {
1306c92544dSBjoern A. Zeeb struct mt76_phy *phy = priv;
1316c92544dSBjoern A. Zeeb
1326c92544dSBjoern A. Zeeb mt7921_mcu_set_ipv6_ns_filter(phy->dev, vif,
1336c92544dSBjoern A. Zeeb !test_bit(MT76_STATE_RUNNING,
1346c92544dSBjoern A. Zeeb &phy->state));
1356c92544dSBjoern A. Zeeb }
1366c92544dSBjoern A. Zeeb
1376c92544dSBjoern A. Zeeb mt76_connac_mcu_set_suspend_iter(priv, mac, vif);
1386c92544dSBjoern A. Zeeb }
1396c92544dSBjoern A. Zeeb
1406c92544dSBjoern A. Zeeb #endif /* CONFIG_PM */
1416c92544dSBjoern A. Zeeb
1426c92544dSBjoern A. Zeeb static void
mt7921_mcu_uni_roc_event(struct mt792x_dev * dev,struct sk_buff * skb)143cbb3ec25SBjoern A. Zeeb mt7921_mcu_uni_roc_event(struct mt792x_dev *dev, struct sk_buff *skb)
144cbb3ec25SBjoern A. Zeeb {
145cbb3ec25SBjoern A. Zeeb struct mt7921_roc_grant_tlv *grant;
146cbb3ec25SBjoern A. Zeeb struct mt76_connac2_mcu_rxd *rxd;
147cbb3ec25SBjoern A. Zeeb int duration;
148cbb3ec25SBjoern A. Zeeb
149cbb3ec25SBjoern A. Zeeb rxd = (struct mt76_connac2_mcu_rxd *)skb->data;
150cbb3ec25SBjoern A. Zeeb grant = (struct mt7921_roc_grant_tlv *)(rxd->tlv + 4);
151cbb3ec25SBjoern A. Zeeb
152cbb3ec25SBjoern A. Zeeb /* should never happen */
153cbb3ec25SBjoern A. Zeeb WARN_ON_ONCE((le16_to_cpu(grant->tag) != UNI_EVENT_ROC_GRANT));
154cbb3ec25SBjoern A. Zeeb
155cbb3ec25SBjoern A. Zeeb if (grant->reqtype == MT7921_ROC_REQ_ROC)
156cbb3ec25SBjoern A. Zeeb ieee80211_ready_on_channel(dev->mt76.phy.hw);
157cbb3ec25SBjoern A. Zeeb
158cbb3ec25SBjoern A. Zeeb dev->phy.roc_grant = true;
159cbb3ec25SBjoern A. Zeeb wake_up(&dev->phy.roc_wait);
160cbb3ec25SBjoern A. Zeeb duration = le32_to_cpu(grant->max_interval);
161cbb3ec25SBjoern A. Zeeb mod_timer(&dev->phy.roc_timer,
162cbb3ec25SBjoern A. Zeeb jiffies + msecs_to_jiffies(duration));
163cbb3ec25SBjoern A. Zeeb }
164cbb3ec25SBjoern A. Zeeb
165cbb3ec25SBjoern A. Zeeb static void
mt7921_mcu_scan_event(struct mt792x_dev * dev,struct sk_buff * skb)166cbb3ec25SBjoern A. Zeeb mt7921_mcu_scan_event(struct mt792x_dev *dev, struct sk_buff *skb)
1676c92544dSBjoern A. Zeeb {
1686c92544dSBjoern A. Zeeb struct mt76_phy *mphy = &dev->mt76.phy;
169*8ba4d145SBjoern A. Zeeb struct mt792x_phy *phy = mphy->priv;
1706c92544dSBjoern A. Zeeb
1716c92544dSBjoern A. Zeeb spin_lock_bh(&dev->mt76.lock);
1726c92544dSBjoern A. Zeeb __skb_queue_tail(&phy->scan_event_list, skb);
1736c92544dSBjoern A. Zeeb spin_unlock_bh(&dev->mt76.lock);
1746c92544dSBjoern A. Zeeb
1756c92544dSBjoern A. Zeeb ieee80211_queue_delayed_work(mphy->hw, &phy->scan_work,
176cbb3ec25SBjoern A. Zeeb MT792x_HW_SCAN_TIMEOUT);
1776c92544dSBjoern A. Zeeb }
1786c92544dSBjoern A. Zeeb
1796c92544dSBjoern A. Zeeb static void
mt7921_mcu_connection_loss_iter(void * priv,u8 * mac,struct ieee80211_vif * vif)1806c92544dSBjoern A. Zeeb mt7921_mcu_connection_loss_iter(void *priv, u8 *mac,
1816c92544dSBjoern A. Zeeb struct ieee80211_vif *vif)
1826c92544dSBjoern A. Zeeb {
183*8ba4d145SBjoern A. Zeeb struct mt76_vif_link *mvif = (struct mt76_vif_link *)vif->drv_priv;
1846c92544dSBjoern A. Zeeb struct mt76_connac_beacon_loss_event *event = priv;
1856c92544dSBjoern A. Zeeb
1866c92544dSBjoern A. Zeeb if (mvif->idx != event->bss_idx)
1876c92544dSBjoern A. Zeeb return;
1886c92544dSBjoern A. Zeeb
1896c92544dSBjoern A. Zeeb if (!(vif->driver_flags & IEEE80211_VIF_BEACON_FILTER) ||
1906c92544dSBjoern A. Zeeb vif->type != NL80211_IFTYPE_STATION)
1916c92544dSBjoern A. Zeeb return;
1926c92544dSBjoern A. Zeeb
1936c92544dSBjoern A. Zeeb ieee80211_connection_loss(vif);
1946c92544dSBjoern A. Zeeb }
1956c92544dSBjoern A. Zeeb
1966c92544dSBjoern A. Zeeb static void
mt7921_mcu_connection_loss_event(struct mt792x_dev * dev,struct sk_buff * skb)197cbb3ec25SBjoern A. Zeeb mt7921_mcu_connection_loss_event(struct mt792x_dev *dev, struct sk_buff *skb)
1986c92544dSBjoern A. Zeeb {
1996c92544dSBjoern A. Zeeb struct mt76_connac_beacon_loss_event *event;
2006c92544dSBjoern A. Zeeb struct mt76_phy *mphy = &dev->mt76.phy;
2016c92544dSBjoern A. Zeeb
2026c92544dSBjoern A. Zeeb skb_pull(skb, sizeof(struct mt76_connac2_mcu_rxd));
2036c92544dSBjoern A. Zeeb event = (struct mt76_connac_beacon_loss_event *)skb->data;
2046c92544dSBjoern A. Zeeb
2056c92544dSBjoern A. Zeeb ieee80211_iterate_active_interfaces_atomic(mphy->hw,
2066c92544dSBjoern A. Zeeb IEEE80211_IFACE_ITER_RESUME_ALL,
2076c92544dSBjoern A. Zeeb mt7921_mcu_connection_loss_iter, event);
2086c92544dSBjoern A. Zeeb }
2096c92544dSBjoern A. Zeeb
2106c92544dSBjoern A. Zeeb static void
mt7921_mcu_debug_msg_event(struct mt792x_dev * dev,struct sk_buff * skb)211cbb3ec25SBjoern A. Zeeb mt7921_mcu_debug_msg_event(struct mt792x_dev *dev, struct sk_buff *skb)
2126c92544dSBjoern A. Zeeb {
2136c92544dSBjoern A. Zeeb struct mt7921_debug_msg {
2146c92544dSBjoern A. Zeeb __le16 id;
2156c92544dSBjoern A. Zeeb u8 type;
2166c92544dSBjoern A. Zeeb u8 flag;
2176c92544dSBjoern A. Zeeb __le32 value;
2186c92544dSBjoern A. Zeeb __le16 len;
2196c92544dSBjoern A. Zeeb u8 content[512];
2206c92544dSBjoern A. Zeeb } __packed * msg;
2216c92544dSBjoern A. Zeeb
2226c92544dSBjoern A. Zeeb skb_pull(skb, sizeof(struct mt76_connac2_mcu_rxd));
2236c92544dSBjoern A. Zeeb msg = (struct mt7921_debug_msg *)skb->data;
2246c92544dSBjoern A. Zeeb
2256c92544dSBjoern A. Zeeb if (msg->type == 3) { /* fw log */
2266c92544dSBjoern A. Zeeb u16 len = min_t(u16, le16_to_cpu(msg->len), 512);
2276c92544dSBjoern A. Zeeb int i;
2286c92544dSBjoern A. Zeeb
2296c92544dSBjoern A. Zeeb for (i = 0 ; i < len; i++) {
2306c92544dSBjoern A. Zeeb if (!msg->content[i])
2316c92544dSBjoern A. Zeeb msg->content[i] = ' ';
2326c92544dSBjoern A. Zeeb }
2336c92544dSBjoern A. Zeeb wiphy_info(mt76_hw(dev)->wiphy, "%.*s", len, msg->content);
2346c92544dSBjoern A. Zeeb }
2356c92544dSBjoern A. Zeeb }
2366c92544dSBjoern A. Zeeb
2376c92544dSBjoern A. Zeeb static void
mt7921_mcu_low_power_event(struct mt792x_dev * dev,struct sk_buff * skb)238cbb3ec25SBjoern A. Zeeb mt7921_mcu_low_power_event(struct mt792x_dev *dev, struct sk_buff *skb)
2396c92544dSBjoern A. Zeeb {
2406c92544dSBjoern A. Zeeb struct mt7921_mcu_lp_event {
2416c92544dSBjoern A. Zeeb u8 state;
2426c92544dSBjoern A. Zeeb u8 reserved[3];
2436c92544dSBjoern A. Zeeb } __packed * event;
2446c92544dSBjoern A. Zeeb
2456c92544dSBjoern A. Zeeb skb_pull(skb, sizeof(struct mt76_connac2_mcu_rxd));
2466c92544dSBjoern A. Zeeb event = (struct mt7921_mcu_lp_event *)skb->data;
2476c92544dSBjoern A. Zeeb
2486c92544dSBjoern A. Zeeb trace_lp_event(dev, event->state);
2496c92544dSBjoern A. Zeeb }
2506c92544dSBjoern A. Zeeb
2516c92544dSBjoern A. Zeeb static void
mt7921_mcu_tx_done_event(struct mt792x_dev * dev,struct sk_buff * skb)252cbb3ec25SBjoern A. Zeeb mt7921_mcu_tx_done_event(struct mt792x_dev *dev, struct sk_buff *skb)
2536c92544dSBjoern A. Zeeb {
2546c92544dSBjoern A. Zeeb struct mt7921_mcu_tx_done_event *event;
2556c92544dSBjoern A. Zeeb
2566c92544dSBjoern A. Zeeb skb_pull(skb, sizeof(struct mt76_connac2_mcu_rxd));
2576c92544dSBjoern A. Zeeb event = (struct mt7921_mcu_tx_done_event *)skb->data;
2586c92544dSBjoern A. Zeeb
2596c92544dSBjoern A. Zeeb mt7921_mac_add_txs(dev, event->txs);
2606c92544dSBjoern A. Zeeb }
2616c92544dSBjoern A. Zeeb
2626c92544dSBjoern A. Zeeb static void
mt7921_mcu_rssi_monitor_iter(void * priv,u8 * mac,struct ieee80211_vif * vif)263*8ba4d145SBjoern A. Zeeb mt7921_mcu_rssi_monitor_iter(void *priv, u8 *mac,
264*8ba4d145SBjoern A. Zeeb struct ieee80211_vif *vif)
265*8ba4d145SBjoern A. Zeeb {
266*8ba4d145SBjoern A. Zeeb struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
267*8ba4d145SBjoern A. Zeeb struct mt76_connac_rssi_notify_event *event = priv;
268*8ba4d145SBjoern A. Zeeb enum nl80211_cqm_rssi_threshold_event nl_event;
269*8ba4d145SBjoern A. Zeeb s32 rssi = le32_to_cpu(event->rssi[mvif->bss_conf.mt76.idx]);
270*8ba4d145SBjoern A. Zeeb
271*8ba4d145SBjoern A. Zeeb if (!rssi)
272*8ba4d145SBjoern A. Zeeb return;
273*8ba4d145SBjoern A. Zeeb
274*8ba4d145SBjoern A. Zeeb if (!(vif->driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI))
275*8ba4d145SBjoern A. Zeeb return;
276*8ba4d145SBjoern A. Zeeb
277*8ba4d145SBjoern A. Zeeb if (rssi > vif->bss_conf.cqm_rssi_thold)
278*8ba4d145SBjoern A. Zeeb nl_event = NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH;
279*8ba4d145SBjoern A. Zeeb else
280*8ba4d145SBjoern A. Zeeb nl_event = NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW;
281*8ba4d145SBjoern A. Zeeb
282*8ba4d145SBjoern A. Zeeb ieee80211_cqm_rssi_notify(vif, nl_event, rssi, GFP_KERNEL);
283*8ba4d145SBjoern A. Zeeb }
284*8ba4d145SBjoern A. Zeeb
285*8ba4d145SBjoern A. Zeeb static void
mt7921_mcu_rssi_monitor_event(struct mt792x_dev * dev,struct sk_buff * skb)286*8ba4d145SBjoern A. Zeeb mt7921_mcu_rssi_monitor_event(struct mt792x_dev *dev, struct sk_buff *skb)
287*8ba4d145SBjoern A. Zeeb {
288*8ba4d145SBjoern A. Zeeb struct mt76_connac_rssi_notify_event *event;
289*8ba4d145SBjoern A. Zeeb
290*8ba4d145SBjoern A. Zeeb skb_pull(skb, sizeof(struct mt76_connac2_mcu_rxd));
291*8ba4d145SBjoern A. Zeeb event = (struct mt76_connac_rssi_notify_event *)skb->data;
292*8ba4d145SBjoern A. Zeeb
293*8ba4d145SBjoern A. Zeeb ieee80211_iterate_active_interfaces_atomic(mt76_hw(dev),
294*8ba4d145SBjoern A. Zeeb IEEE80211_IFACE_ITER_RESUME_ALL,
295*8ba4d145SBjoern A. Zeeb mt7921_mcu_rssi_monitor_iter, event);
296*8ba4d145SBjoern A. Zeeb }
297*8ba4d145SBjoern A. Zeeb
298*8ba4d145SBjoern A. Zeeb static void
mt7921_mcu_rx_unsolicited_event(struct mt792x_dev * dev,struct sk_buff * skb)299cbb3ec25SBjoern A. Zeeb mt7921_mcu_rx_unsolicited_event(struct mt792x_dev *dev, struct sk_buff *skb)
3006c92544dSBjoern A. Zeeb {
3016c92544dSBjoern A. Zeeb struct mt76_connac2_mcu_rxd *rxd;
3026c92544dSBjoern A. Zeeb
3036c92544dSBjoern A. Zeeb rxd = (struct mt76_connac2_mcu_rxd *)skb->data;
3046c92544dSBjoern A. Zeeb switch (rxd->eid) {
3056c92544dSBjoern A. Zeeb case MCU_EVENT_BSS_BEACON_LOSS:
3066c92544dSBjoern A. Zeeb mt7921_mcu_connection_loss_event(dev, skb);
3076c92544dSBjoern A. Zeeb break;
3086c92544dSBjoern A. Zeeb case MCU_EVENT_SCHED_SCAN_DONE:
3096c92544dSBjoern A. Zeeb case MCU_EVENT_SCAN_DONE:
3106c92544dSBjoern A. Zeeb mt7921_mcu_scan_event(dev, skb);
3116c92544dSBjoern A. Zeeb return;
3126c92544dSBjoern A. Zeeb case MCU_EVENT_DBG_MSG:
3136c92544dSBjoern A. Zeeb mt7921_mcu_debug_msg_event(dev, skb);
3146c92544dSBjoern A. Zeeb break;
3156c92544dSBjoern A. Zeeb case MCU_EVENT_COREDUMP:
3166c92544dSBjoern A. Zeeb dev->fw_assert = true;
3176c92544dSBjoern A. Zeeb mt76_connac_mcu_coredump_event(&dev->mt76, skb,
3186c92544dSBjoern A. Zeeb &dev->coredump);
3196c92544dSBjoern A. Zeeb return;
3206c92544dSBjoern A. Zeeb case MCU_EVENT_LP_INFO:
3216c92544dSBjoern A. Zeeb mt7921_mcu_low_power_event(dev, skb);
3226c92544dSBjoern A. Zeeb break;
3236c92544dSBjoern A. Zeeb case MCU_EVENT_TX_DONE:
3246c92544dSBjoern A. Zeeb mt7921_mcu_tx_done_event(dev, skb);
3256c92544dSBjoern A. Zeeb break;
326*8ba4d145SBjoern A. Zeeb case MCU_EVENT_RSSI_NOTIFY:
327*8ba4d145SBjoern A. Zeeb mt7921_mcu_rssi_monitor_event(dev, skb);
328*8ba4d145SBjoern A. Zeeb break;
3296c92544dSBjoern A. Zeeb default:
3306c92544dSBjoern A. Zeeb break;
3316c92544dSBjoern A. Zeeb }
3326c92544dSBjoern A. Zeeb dev_kfree_skb(skb);
3336c92544dSBjoern A. Zeeb }
3346c92544dSBjoern A. Zeeb
335cbb3ec25SBjoern A. Zeeb static void
mt7921_mcu_uni_rx_unsolicited_event(struct mt792x_dev * dev,struct sk_buff * skb)336cbb3ec25SBjoern A. Zeeb mt7921_mcu_uni_rx_unsolicited_event(struct mt792x_dev *dev,
337cbb3ec25SBjoern A. Zeeb struct sk_buff *skb)
338cbb3ec25SBjoern A. Zeeb {
339cbb3ec25SBjoern A. Zeeb struct mt76_connac2_mcu_rxd *rxd;
340cbb3ec25SBjoern A. Zeeb
341cbb3ec25SBjoern A. Zeeb rxd = (struct mt76_connac2_mcu_rxd *)skb->data;
342cbb3ec25SBjoern A. Zeeb
343cbb3ec25SBjoern A. Zeeb switch (rxd->eid) {
344cbb3ec25SBjoern A. Zeeb case MCU_UNI_EVENT_ROC:
345cbb3ec25SBjoern A. Zeeb mt7921_mcu_uni_roc_event(dev, skb);
346cbb3ec25SBjoern A. Zeeb break;
347cbb3ec25SBjoern A. Zeeb default:
348cbb3ec25SBjoern A. Zeeb break;
349cbb3ec25SBjoern A. Zeeb }
350cbb3ec25SBjoern A. Zeeb dev_kfree_skb(skb);
351cbb3ec25SBjoern A. Zeeb }
352cbb3ec25SBjoern A. Zeeb
mt7921_mcu_rx_event(struct mt792x_dev * dev,struct sk_buff * skb)353cbb3ec25SBjoern A. Zeeb void mt7921_mcu_rx_event(struct mt792x_dev *dev, struct sk_buff *skb)
3546c92544dSBjoern A. Zeeb {
3556c92544dSBjoern A. Zeeb struct mt76_connac2_mcu_rxd *rxd;
3566c92544dSBjoern A. Zeeb
3576c92544dSBjoern A. Zeeb if (skb_linearize(skb))
3586c92544dSBjoern A. Zeeb return;
3596c92544dSBjoern A. Zeeb
3606c92544dSBjoern A. Zeeb rxd = (struct mt76_connac2_mcu_rxd *)skb->data;
3616c92544dSBjoern A. Zeeb
362cbb3ec25SBjoern A. Zeeb if (rxd->option & MCU_UNI_CMD_UNSOLICITED_EVENT) {
363cbb3ec25SBjoern A. Zeeb mt7921_mcu_uni_rx_unsolicited_event(dev, skb);
364cbb3ec25SBjoern A. Zeeb return;
365cbb3ec25SBjoern A. Zeeb }
366cbb3ec25SBjoern A. Zeeb
3676c92544dSBjoern A. Zeeb if (rxd->eid == 0x6) {
3686c92544dSBjoern A. Zeeb mt76_mcu_rx_event(&dev->mt76, skb);
3696c92544dSBjoern A. Zeeb return;
3706c92544dSBjoern A. Zeeb }
3716c92544dSBjoern A. Zeeb
3726c92544dSBjoern A. Zeeb if (rxd->ext_eid == MCU_EXT_EVENT_RATE_REPORT ||
3736c92544dSBjoern A. Zeeb rxd->eid == MCU_EVENT_BSS_BEACON_LOSS ||
3746c92544dSBjoern A. Zeeb rxd->eid == MCU_EVENT_SCHED_SCAN_DONE ||
375*8ba4d145SBjoern A. Zeeb rxd->eid == MCU_EVENT_RSSI_NOTIFY ||
3766c92544dSBjoern A. Zeeb rxd->eid == MCU_EVENT_SCAN_DONE ||
3776c92544dSBjoern A. Zeeb rxd->eid == MCU_EVENT_TX_DONE ||
3786c92544dSBjoern A. Zeeb rxd->eid == MCU_EVENT_DBG_MSG ||
3796c92544dSBjoern A. Zeeb rxd->eid == MCU_EVENT_COREDUMP ||
3806c92544dSBjoern A. Zeeb rxd->eid == MCU_EVENT_LP_INFO ||
3816c92544dSBjoern A. Zeeb !rxd->seq)
3826c92544dSBjoern A. Zeeb mt7921_mcu_rx_unsolicited_event(dev, skb);
3836c92544dSBjoern A. Zeeb else
3846c92544dSBjoern A. Zeeb mt76_mcu_rx_event(&dev->mt76, skb);
3856c92544dSBjoern A. Zeeb }
3866c92544dSBjoern A. Zeeb
3876c92544dSBjoern A. Zeeb /** starec & wtbl **/
mt7921_mcu_uni_tx_ba(struct mt792x_dev * dev,struct ieee80211_ampdu_params * params,bool enable)388cbb3ec25SBjoern A. Zeeb int mt7921_mcu_uni_tx_ba(struct mt792x_dev *dev,
3896c92544dSBjoern A. Zeeb struct ieee80211_ampdu_params *params,
3906c92544dSBjoern A. Zeeb bool enable)
3916c92544dSBjoern A. Zeeb {
392cbb3ec25SBjoern A. Zeeb struct mt792x_sta *msta = (struct mt792x_sta *)params->sta->drv_priv;
3936c92544dSBjoern A. Zeeb
3946c92544dSBjoern A. Zeeb if (enable && !params->amsdu)
395*8ba4d145SBjoern A. Zeeb msta->deflink.wcid.amsdu = false;
3966c92544dSBjoern A. Zeeb
397*8ba4d145SBjoern A. Zeeb return mt76_connac_mcu_sta_ba(&dev->mt76, &msta->vif->bss_conf.mt76, params,
3986c92544dSBjoern A. Zeeb MCU_UNI_CMD(STA_REC_UPDATE),
3996c92544dSBjoern A. Zeeb enable, true);
4006c92544dSBjoern A. Zeeb }
4016c92544dSBjoern A. Zeeb
mt7921_mcu_uni_rx_ba(struct mt792x_dev * dev,struct ieee80211_ampdu_params * params,bool enable)402cbb3ec25SBjoern A. Zeeb int mt7921_mcu_uni_rx_ba(struct mt792x_dev *dev,
4036c92544dSBjoern A. Zeeb struct ieee80211_ampdu_params *params,
4046c92544dSBjoern A. Zeeb bool enable)
4056c92544dSBjoern A. Zeeb {
406cbb3ec25SBjoern A. Zeeb struct mt792x_sta *msta = (struct mt792x_sta *)params->sta->drv_priv;
4076c92544dSBjoern A. Zeeb
408*8ba4d145SBjoern A. Zeeb return mt76_connac_mcu_sta_ba(&dev->mt76, &msta->vif->bss_conf.mt76, params,
4096c92544dSBjoern A. Zeeb MCU_UNI_CMD(STA_REC_UPDATE),
4106c92544dSBjoern A. Zeeb enable, false);
4116c92544dSBjoern A. Zeeb }
4126c92544dSBjoern A. Zeeb
mt7921_load_clc(struct mt792x_dev * dev,const char * fw_name)413cbb3ec25SBjoern A. Zeeb static int mt7921_load_clc(struct mt792x_dev *dev, const char *fw_name)
4146c92544dSBjoern A. Zeeb {
4156c92544dSBjoern A. Zeeb const struct mt76_connac2_fw_trailer *hdr;
4166c92544dSBjoern A. Zeeb const struct mt76_connac2_fw_region *region;
4176c92544dSBjoern A. Zeeb const struct mt7921_clc *clc;
4186c92544dSBjoern A. Zeeb struct mt76_dev *mdev = &dev->mt76;
419cbb3ec25SBjoern A. Zeeb struct mt792x_phy *phy = &dev->phy;
4206c92544dSBjoern A. Zeeb const struct firmware *fw;
4216c92544dSBjoern A. Zeeb int ret, i, len, offset = 0;
4226c92544dSBjoern A. Zeeb #if defined(__linux__)
4236c92544dSBjoern A. Zeeb u8 *clc_base = NULL, hw_encap = 0;
4246c92544dSBjoern A. Zeeb #elif defined(__FreeBSD__)
4256c92544dSBjoern A. Zeeb const u8 *clc_base = NULL;
4266c92544dSBjoern A. Zeeb u8 hw_encap = 0;
4276c92544dSBjoern A. Zeeb #endif
4286c92544dSBjoern A. Zeeb
429*8ba4d145SBjoern A. Zeeb dev->phy.clc_chan_conf = 0xff;
4306c92544dSBjoern A. Zeeb if (mt7921_disable_clc ||
4316c92544dSBjoern A. Zeeb mt76_is_usb(&dev->mt76))
4326c92544dSBjoern A. Zeeb return 0;
4336c92544dSBjoern A. Zeeb
4346c92544dSBjoern A. Zeeb if (mt76_is_mmio(&dev->mt76)) {
4356c92544dSBjoern A. Zeeb ret = mt7921_mcu_read_eeprom(dev, MT_EE_HW_TYPE, &hw_encap);
4366c92544dSBjoern A. Zeeb if (ret)
4376c92544dSBjoern A. Zeeb return ret;
4386c92544dSBjoern A. Zeeb hw_encap = u8_get_bits(hw_encap, MT_EE_HW_TYPE_ENCAP);
4396c92544dSBjoern A. Zeeb }
4406c92544dSBjoern A. Zeeb
4416c92544dSBjoern A. Zeeb ret = request_firmware(&fw, fw_name, mdev->dev);
4426c92544dSBjoern A. Zeeb if (ret)
4436c92544dSBjoern A. Zeeb return ret;
4446c92544dSBjoern A. Zeeb
4456c92544dSBjoern A. Zeeb if (!fw || !fw->data || fw->size < sizeof(*hdr)) {
4466c92544dSBjoern A. Zeeb dev_err(mdev->dev, "Invalid firmware\n");
4476c92544dSBjoern A. Zeeb ret = -EINVAL;
4486c92544dSBjoern A. Zeeb goto out;
4496c92544dSBjoern A. Zeeb }
4506c92544dSBjoern A. Zeeb
4516c92544dSBjoern A. Zeeb hdr = (const void *)(fw->data + fw->size - sizeof(*hdr));
4526c92544dSBjoern A. Zeeb for (i = 0; i < hdr->n_region; i++) {
4536c92544dSBjoern A. Zeeb region = (const void *)((const u8 *)hdr -
4546c92544dSBjoern A. Zeeb (hdr->n_region - i) * sizeof(*region));
4556c92544dSBjoern A. Zeeb len = le32_to_cpu(region->len);
4566c92544dSBjoern A. Zeeb
4576c92544dSBjoern A. Zeeb /* check if we have valid buffer size */
4586c92544dSBjoern A. Zeeb if (offset + len > fw->size) {
4596c92544dSBjoern A. Zeeb dev_err(mdev->dev, "Invalid firmware region\n");
4606c92544dSBjoern A. Zeeb ret = -EINVAL;
4616c92544dSBjoern A. Zeeb goto out;
4626c92544dSBjoern A. Zeeb }
4636c92544dSBjoern A. Zeeb
4646c92544dSBjoern A. Zeeb if ((region->feature_set & FW_FEATURE_NON_DL) &&
4656c92544dSBjoern A. Zeeb region->type == FW_TYPE_CLC) {
4666c92544dSBjoern A. Zeeb #if defined(__linux__)
4676c92544dSBjoern A. Zeeb clc_base = (u8 *)(fw->data + offset);
4686c92544dSBjoern A. Zeeb #elif defined(__FreeBSD__)
4696c92544dSBjoern A. Zeeb clc_base = (const u8 *)(fw->data + offset);
4706c92544dSBjoern A. Zeeb #endif
4716c92544dSBjoern A. Zeeb break;
4726c92544dSBjoern A. Zeeb }
4736c92544dSBjoern A. Zeeb offset += len;
4746c92544dSBjoern A. Zeeb }
4756c92544dSBjoern A. Zeeb
4766c92544dSBjoern A. Zeeb if (!clc_base)
4776c92544dSBjoern A. Zeeb goto out;
4786c92544dSBjoern A. Zeeb
4796c92544dSBjoern A. Zeeb for (offset = 0; offset < len; offset += le32_to_cpu(clc->len)) {
4806c92544dSBjoern A. Zeeb clc = (const struct mt7921_clc *)(clc_base + offset);
4816c92544dSBjoern A. Zeeb
4826c92544dSBjoern A. Zeeb /* do not init buf again if chip reset triggered */
4836c92544dSBjoern A. Zeeb if (phy->clc[clc->idx])
4846c92544dSBjoern A. Zeeb continue;
4856c92544dSBjoern A. Zeeb
4866c92544dSBjoern A. Zeeb /* header content sanity */
4876c92544dSBjoern A. Zeeb if (clc->idx == MT7921_CLC_POWER &&
4886c92544dSBjoern A. Zeeb u8_get_bits(clc->type, MT_EE_HW_TYPE_ENCAP) != hw_encap)
4896c92544dSBjoern A. Zeeb continue;
4906c92544dSBjoern A. Zeeb
4916c92544dSBjoern A. Zeeb phy->clc[clc->idx] = devm_kmemdup(mdev->dev, clc,
4926c92544dSBjoern A. Zeeb le32_to_cpu(clc->len),
4936c92544dSBjoern A. Zeeb GFP_KERNEL);
4946c92544dSBjoern A. Zeeb
4956c92544dSBjoern A. Zeeb if (!phy->clc[clc->idx]) {
4966c92544dSBjoern A. Zeeb ret = -ENOMEM;
4976c92544dSBjoern A. Zeeb goto out;
4986c92544dSBjoern A. Zeeb }
4996c92544dSBjoern A. Zeeb }
5006c92544dSBjoern A. Zeeb ret = mt7921_mcu_set_clc(dev, "00", ENVIRON_INDOOR);
5016c92544dSBjoern A. Zeeb out:
5026c92544dSBjoern A. Zeeb release_firmware(fw);
5036c92544dSBjoern A. Zeeb
5046c92544dSBjoern A. Zeeb return ret;
5056c92544dSBjoern A. Zeeb }
5066c92544dSBjoern A. Zeeb
mt7921_mcu_parse_tx_resource(struct mt76_dev * dev,struct sk_buff * skb)507*8ba4d145SBjoern A. Zeeb static void mt7921_mcu_parse_tx_resource(struct mt76_dev *dev,
508*8ba4d145SBjoern A. Zeeb struct sk_buff *skb)
509*8ba4d145SBjoern A. Zeeb {
510*8ba4d145SBjoern A. Zeeb struct mt76_sdio *sdio = &dev->sdio;
511*8ba4d145SBjoern A. Zeeb struct mt7921_tx_resource {
512*8ba4d145SBjoern A. Zeeb __le32 version;
513*8ba4d145SBjoern A. Zeeb __le32 pse_data_quota;
514*8ba4d145SBjoern A. Zeeb __le32 pse_mcu_quota;
515*8ba4d145SBjoern A. Zeeb __le32 ple_data_quota;
516*8ba4d145SBjoern A. Zeeb __le32 ple_mcu_quota;
517*8ba4d145SBjoern A. Zeeb __le16 pse_page_size;
518*8ba4d145SBjoern A. Zeeb __le16 ple_page_size;
519*8ba4d145SBjoern A. Zeeb u8 pp_padding;
520*8ba4d145SBjoern A. Zeeb u8 pad[3];
521*8ba4d145SBjoern A. Zeeb } __packed * tx_res;
522*8ba4d145SBjoern A. Zeeb
523*8ba4d145SBjoern A. Zeeb tx_res = (struct mt7921_tx_resource *)skb->data;
524*8ba4d145SBjoern A. Zeeb sdio->sched.pse_data_quota = le32_to_cpu(tx_res->pse_data_quota);
525*8ba4d145SBjoern A. Zeeb sdio->pse_mcu_quota_max = le32_to_cpu(tx_res->pse_mcu_quota);
526*8ba4d145SBjoern A. Zeeb /* The mcu quota usage of this function itself must be taken into consideration */
527*8ba4d145SBjoern A. Zeeb sdio->sched.pse_mcu_quota =
528*8ba4d145SBjoern A. Zeeb sdio->sched.pse_mcu_quota ? sdio->pse_mcu_quota_max : sdio->pse_mcu_quota_max - 1;
529*8ba4d145SBjoern A. Zeeb sdio->sched.ple_data_quota = le32_to_cpu(tx_res->ple_data_quota);
530*8ba4d145SBjoern A. Zeeb sdio->sched.pse_page_size = le16_to_cpu(tx_res->pse_page_size);
531*8ba4d145SBjoern A. Zeeb sdio->sched.deficit = tx_res->pp_padding;
532*8ba4d145SBjoern A. Zeeb }
533*8ba4d145SBjoern A. Zeeb
mt7921_mcu_parse_phy_cap(struct mt76_dev * dev,struct sk_buff * skb)534*8ba4d145SBjoern A. Zeeb static void mt7921_mcu_parse_phy_cap(struct mt76_dev *dev,
535*8ba4d145SBjoern A. Zeeb struct sk_buff *skb)
536*8ba4d145SBjoern A. Zeeb {
537*8ba4d145SBjoern A. Zeeb struct mt7921_phy_cap {
538*8ba4d145SBjoern A. Zeeb u8 ht;
539*8ba4d145SBjoern A. Zeeb u8 vht;
540*8ba4d145SBjoern A. Zeeb u8 _5g;
541*8ba4d145SBjoern A. Zeeb u8 max_bw;
542*8ba4d145SBjoern A. Zeeb u8 nss;
543*8ba4d145SBjoern A. Zeeb u8 dbdc;
544*8ba4d145SBjoern A. Zeeb u8 tx_ldpc;
545*8ba4d145SBjoern A. Zeeb u8 rx_ldpc;
546*8ba4d145SBjoern A. Zeeb u8 tx_stbc;
547*8ba4d145SBjoern A. Zeeb u8 rx_stbc;
548*8ba4d145SBjoern A. Zeeb u8 hw_path;
549*8ba4d145SBjoern A. Zeeb u8 he;
550*8ba4d145SBjoern A. Zeeb } __packed * cap;
551*8ba4d145SBjoern A. Zeeb
552*8ba4d145SBjoern A. Zeeb enum {
553*8ba4d145SBjoern A. Zeeb WF0_24G,
554*8ba4d145SBjoern A. Zeeb WF0_5G
555*8ba4d145SBjoern A. Zeeb };
556*8ba4d145SBjoern A. Zeeb
557*8ba4d145SBjoern A. Zeeb cap = (struct mt7921_phy_cap *)skb->data;
558*8ba4d145SBjoern A. Zeeb
559*8ba4d145SBjoern A. Zeeb dev->phy.antenna_mask = BIT(cap->nss) - 1;
560*8ba4d145SBjoern A. Zeeb dev->phy.chainmask = dev->phy.antenna_mask;
561*8ba4d145SBjoern A. Zeeb dev->phy.cap.has_2ghz = cap->hw_path & BIT(WF0_24G);
562*8ba4d145SBjoern A. Zeeb dev->phy.cap.has_5ghz = cap->hw_path & BIT(WF0_5G);
563*8ba4d145SBjoern A. Zeeb }
564*8ba4d145SBjoern A. Zeeb
mt7921_mcu_get_nic_capability(struct mt792x_phy * mphy)565*8ba4d145SBjoern A. Zeeb static int mt7921_mcu_get_nic_capability(struct mt792x_phy *mphy)
566*8ba4d145SBjoern A. Zeeb {
567*8ba4d145SBjoern A. Zeeb struct mt76_connac_cap_hdr {
568*8ba4d145SBjoern A. Zeeb __le16 n_element;
569*8ba4d145SBjoern A. Zeeb u8 rsv[2];
570*8ba4d145SBjoern A. Zeeb } __packed * hdr;
571*8ba4d145SBjoern A. Zeeb struct sk_buff *skb;
572*8ba4d145SBjoern A. Zeeb struct mt76_phy *phy = mphy->mt76;
573*8ba4d145SBjoern A. Zeeb int ret, i;
574*8ba4d145SBjoern A. Zeeb
575*8ba4d145SBjoern A. Zeeb ret = mt76_mcu_send_and_get_msg(phy->dev, MCU_CE_CMD(GET_NIC_CAPAB),
576*8ba4d145SBjoern A. Zeeb NULL, 0, true, &skb);
577*8ba4d145SBjoern A. Zeeb if (ret)
578*8ba4d145SBjoern A. Zeeb return ret;
579*8ba4d145SBjoern A. Zeeb
580*8ba4d145SBjoern A. Zeeb hdr = (struct mt76_connac_cap_hdr *)skb->data;
581*8ba4d145SBjoern A. Zeeb if (skb->len < sizeof(*hdr)) {
582*8ba4d145SBjoern A. Zeeb ret = -EINVAL;
583*8ba4d145SBjoern A. Zeeb goto out;
584*8ba4d145SBjoern A. Zeeb }
585*8ba4d145SBjoern A. Zeeb
586*8ba4d145SBjoern A. Zeeb skb_pull(skb, sizeof(*hdr));
587*8ba4d145SBjoern A. Zeeb
588*8ba4d145SBjoern A. Zeeb for (i = 0; i < le16_to_cpu(hdr->n_element); i++) {
589*8ba4d145SBjoern A. Zeeb struct tlv_hdr {
590*8ba4d145SBjoern A. Zeeb __le32 type;
591*8ba4d145SBjoern A. Zeeb __le32 len;
592*8ba4d145SBjoern A. Zeeb } __packed * tlv = (struct tlv_hdr *)skb->data;
593*8ba4d145SBjoern A. Zeeb int len;
594*8ba4d145SBjoern A. Zeeb
595*8ba4d145SBjoern A. Zeeb if (skb->len < sizeof(*tlv))
596*8ba4d145SBjoern A. Zeeb break;
597*8ba4d145SBjoern A. Zeeb
598*8ba4d145SBjoern A. Zeeb skb_pull(skb, sizeof(*tlv));
599*8ba4d145SBjoern A. Zeeb
600*8ba4d145SBjoern A. Zeeb len = le32_to_cpu(tlv->len);
601*8ba4d145SBjoern A. Zeeb if (skb->len < len)
602*8ba4d145SBjoern A. Zeeb break;
603*8ba4d145SBjoern A. Zeeb
604*8ba4d145SBjoern A. Zeeb switch (le32_to_cpu(tlv->type)) {
605*8ba4d145SBjoern A. Zeeb case MT_NIC_CAP_6G:
606*8ba4d145SBjoern A. Zeeb phy->cap.has_6ghz = skb->data[0];
607*8ba4d145SBjoern A. Zeeb break;
608*8ba4d145SBjoern A. Zeeb case MT_NIC_CAP_MAC_ADDR:
609*8ba4d145SBjoern A. Zeeb memcpy(phy->macaddr, (void *)skb->data, ETH_ALEN);
610*8ba4d145SBjoern A. Zeeb break;
611*8ba4d145SBjoern A. Zeeb case MT_NIC_CAP_PHY:
612*8ba4d145SBjoern A. Zeeb mt7921_mcu_parse_phy_cap(phy->dev, skb);
613*8ba4d145SBjoern A. Zeeb break;
614*8ba4d145SBjoern A. Zeeb case MT_NIC_CAP_TX_RESOURCE:
615*8ba4d145SBjoern A. Zeeb if (mt76_is_sdio(phy->dev))
616*8ba4d145SBjoern A. Zeeb mt7921_mcu_parse_tx_resource(phy->dev,
617*8ba4d145SBjoern A. Zeeb skb);
618*8ba4d145SBjoern A. Zeeb break;
619*8ba4d145SBjoern A. Zeeb case MT_NIC_CAP_CHIP_CAP:
620*8ba4d145SBjoern A. Zeeb memcpy(&mphy->chip_cap, (void *)skb->data, sizeof(u64));
621*8ba4d145SBjoern A. Zeeb break;
622*8ba4d145SBjoern A. Zeeb default:
623*8ba4d145SBjoern A. Zeeb break;
624*8ba4d145SBjoern A. Zeeb }
625*8ba4d145SBjoern A. Zeeb skb_pull(skb, len);
626*8ba4d145SBjoern A. Zeeb }
627*8ba4d145SBjoern A. Zeeb out:
628*8ba4d145SBjoern A. Zeeb dev_kfree_skb(skb);
629*8ba4d145SBjoern A. Zeeb
630*8ba4d145SBjoern A. Zeeb return ret;
631*8ba4d145SBjoern A. Zeeb }
632*8ba4d145SBjoern A. Zeeb
mt7921_mcu_fw_log_2_host(struct mt792x_dev * dev,u8 ctrl)633cbb3ec25SBjoern A. Zeeb int mt7921_mcu_fw_log_2_host(struct mt792x_dev *dev, u8 ctrl)
6346c92544dSBjoern A. Zeeb {
6356c92544dSBjoern A. Zeeb struct {
6366c92544dSBjoern A. Zeeb u8 ctrl_val;
6376c92544dSBjoern A. Zeeb u8 pad[3];
6386c92544dSBjoern A. Zeeb } data = {
6396c92544dSBjoern A. Zeeb .ctrl_val = ctrl
6406c92544dSBjoern A. Zeeb };
6416c92544dSBjoern A. Zeeb
6426c92544dSBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(FWLOG_2_HOST),
6436c92544dSBjoern A. Zeeb &data, sizeof(data), false);
6446c92544dSBjoern A. Zeeb }
6456c92544dSBjoern A. Zeeb
mt7921_run_firmware(struct mt792x_dev * dev)646cbb3ec25SBjoern A. Zeeb int mt7921_run_firmware(struct mt792x_dev *dev)
6476c92544dSBjoern A. Zeeb {
6486c92544dSBjoern A. Zeeb int err;
6496c92544dSBjoern A. Zeeb
650cbb3ec25SBjoern A. Zeeb err = mt792x_load_firmware(dev);
6516c92544dSBjoern A. Zeeb if (err)
6526c92544dSBjoern A. Zeeb return err;
6536c92544dSBjoern A. Zeeb
654*8ba4d145SBjoern A. Zeeb err = mt7921_mcu_get_nic_capability(&dev->phy);
6556c92544dSBjoern A. Zeeb if (err)
6566c92544dSBjoern A. Zeeb return err;
6576c92544dSBjoern A. Zeeb
6586c92544dSBjoern A. Zeeb set_bit(MT76_STATE_MCU_RUNNING, &dev->mphy.state);
659cbb3ec25SBjoern A. Zeeb err = mt7921_load_clc(dev, mt792x_ram_name(dev));
6606c92544dSBjoern A. Zeeb if (err)
6616c92544dSBjoern A. Zeeb return err;
6626c92544dSBjoern A. Zeeb
6636c92544dSBjoern A. Zeeb return mt7921_mcu_fw_log_2_host(dev, 1);
6646c92544dSBjoern A. Zeeb }
6656c92544dSBjoern A. Zeeb EXPORT_SYMBOL_GPL(mt7921_run_firmware);
6666c92544dSBjoern A. Zeeb
mt7921_mcu_radio_led_ctrl(struct mt792x_dev * dev,u8 value)667*8ba4d145SBjoern A. Zeeb int mt7921_mcu_radio_led_ctrl(struct mt792x_dev *dev, u8 value)
668*8ba4d145SBjoern A. Zeeb {
669*8ba4d145SBjoern A. Zeeb struct {
670*8ba4d145SBjoern A. Zeeb u8 ctrlid;
671*8ba4d145SBjoern A. Zeeb u8 rsv[3];
672*8ba4d145SBjoern A. Zeeb } __packed req = {
673*8ba4d145SBjoern A. Zeeb .ctrlid = value,
674*8ba4d145SBjoern A. Zeeb };
675*8ba4d145SBjoern A. Zeeb
676*8ba4d145SBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD(ID_RADIO_ON_OFF_CTRL),
677*8ba4d145SBjoern A. Zeeb &req, sizeof(req), false);
678*8ba4d145SBjoern A. Zeeb }
679*8ba4d145SBjoern A. Zeeb EXPORT_SYMBOL_GPL(mt7921_mcu_radio_led_ctrl);
680*8ba4d145SBjoern A. Zeeb
mt7921_mcu_set_tx(struct mt792x_dev * dev,struct ieee80211_vif * vif)681cbb3ec25SBjoern A. Zeeb int mt7921_mcu_set_tx(struct mt792x_dev *dev, struct ieee80211_vif *vif)
6826c92544dSBjoern A. Zeeb {
683cbb3ec25SBjoern A. Zeeb struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
6846c92544dSBjoern A. Zeeb struct edca {
6856c92544dSBjoern A. Zeeb __le16 cw_min;
6866c92544dSBjoern A. Zeeb __le16 cw_max;
6876c92544dSBjoern A. Zeeb __le16 txop;
6886c92544dSBjoern A. Zeeb __le16 aifs;
6896c92544dSBjoern A. Zeeb u8 guardtime;
6906c92544dSBjoern A. Zeeb u8 acm;
6916c92544dSBjoern A. Zeeb } __packed;
6926c92544dSBjoern A. Zeeb struct mt7921_mcu_tx {
6936c92544dSBjoern A. Zeeb struct edca edca[IEEE80211_NUM_ACS];
6946c92544dSBjoern A. Zeeb u8 bss_idx;
6956c92544dSBjoern A. Zeeb u8 qos;
6966c92544dSBjoern A. Zeeb u8 wmm_idx;
6976c92544dSBjoern A. Zeeb u8 pad;
6986c92544dSBjoern A. Zeeb } __packed req = {
699*8ba4d145SBjoern A. Zeeb .bss_idx = mvif->bss_conf.mt76.idx,
7006c92544dSBjoern A. Zeeb .qos = vif->bss_conf.qos,
701*8ba4d145SBjoern A. Zeeb .wmm_idx = mvif->bss_conf.mt76.wmm_idx,
7026c92544dSBjoern A. Zeeb };
7036c92544dSBjoern A. Zeeb struct mu_edca {
7046c92544dSBjoern A. Zeeb u8 cw_min;
7056c92544dSBjoern A. Zeeb u8 cw_max;
7066c92544dSBjoern A. Zeeb u8 aifsn;
7076c92544dSBjoern A. Zeeb u8 acm;
7086c92544dSBjoern A. Zeeb u8 timer;
7096c92544dSBjoern A. Zeeb u8 padding[3];
7106c92544dSBjoern A. Zeeb };
7116c92544dSBjoern A. Zeeb struct mt7921_mcu_mu_tx {
7126c92544dSBjoern A. Zeeb u8 ver;
7136c92544dSBjoern A. Zeeb u8 pad0;
7146c92544dSBjoern A. Zeeb __le16 len;
7156c92544dSBjoern A. Zeeb u8 bss_idx;
7166c92544dSBjoern A. Zeeb u8 qos;
7176c92544dSBjoern A. Zeeb u8 wmm_idx;
7186c92544dSBjoern A. Zeeb u8 pad1;
7196c92544dSBjoern A. Zeeb struct mu_edca edca[IEEE80211_NUM_ACS];
7206c92544dSBjoern A. Zeeb u8 pad3[32];
7216c92544dSBjoern A. Zeeb } __packed req_mu = {
722*8ba4d145SBjoern A. Zeeb .bss_idx = mvif->bss_conf.mt76.idx,
7236c92544dSBjoern A. Zeeb .qos = vif->bss_conf.qos,
724*8ba4d145SBjoern A. Zeeb .wmm_idx = mvif->bss_conf.mt76.wmm_idx,
7256c92544dSBjoern A. Zeeb };
7266c92544dSBjoern A. Zeeb static const int to_aci[] = { 1, 0, 2, 3 };
7276c92544dSBjoern A. Zeeb int ac, ret;
7286c92544dSBjoern A. Zeeb
7296c92544dSBjoern A. Zeeb for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
730*8ba4d145SBjoern A. Zeeb struct ieee80211_tx_queue_params *q = &mvif->bss_conf.queue_params[ac];
7316c92544dSBjoern A. Zeeb struct edca *e = &req.edca[to_aci[ac]];
7326c92544dSBjoern A. Zeeb
7336c92544dSBjoern A. Zeeb e->aifs = cpu_to_le16(q->aifs);
7346c92544dSBjoern A. Zeeb e->txop = cpu_to_le16(q->txop);
7356c92544dSBjoern A. Zeeb
7366c92544dSBjoern A. Zeeb if (q->cw_min)
7376c92544dSBjoern A. Zeeb e->cw_min = cpu_to_le16(q->cw_min);
7386c92544dSBjoern A. Zeeb else
7396c92544dSBjoern A. Zeeb e->cw_min = cpu_to_le16(5);
7406c92544dSBjoern A. Zeeb
7416c92544dSBjoern A. Zeeb if (q->cw_max)
7426c92544dSBjoern A. Zeeb e->cw_max = cpu_to_le16(q->cw_max);
7436c92544dSBjoern A. Zeeb else
7446c92544dSBjoern A. Zeeb e->cw_max = cpu_to_le16(10);
7456c92544dSBjoern A. Zeeb }
7466c92544dSBjoern A. Zeeb
7476c92544dSBjoern A. Zeeb ret = mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(SET_EDCA_PARMS), &req,
7486c92544dSBjoern A. Zeeb sizeof(req), false);
7496c92544dSBjoern A. Zeeb if (ret)
7506c92544dSBjoern A. Zeeb return ret;
7516c92544dSBjoern A. Zeeb
7526c92544dSBjoern A. Zeeb if (!vif->bss_conf.he_support)
7536c92544dSBjoern A. Zeeb return 0;
7546c92544dSBjoern A. Zeeb
7556c92544dSBjoern A. Zeeb for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
7566c92544dSBjoern A. Zeeb struct ieee80211_he_mu_edca_param_ac_rec *q;
7576c92544dSBjoern A. Zeeb struct mu_edca *e;
7586c92544dSBjoern A. Zeeb
759*8ba4d145SBjoern A. Zeeb if (!mvif->bss_conf.queue_params[ac].mu_edca)
7606c92544dSBjoern A. Zeeb break;
7616c92544dSBjoern A. Zeeb
762*8ba4d145SBjoern A. Zeeb q = &mvif->bss_conf.queue_params[ac].mu_edca_param_rec;
7636c92544dSBjoern A. Zeeb e = &(req_mu.edca[to_aci[ac]]);
7646c92544dSBjoern A. Zeeb
7656c92544dSBjoern A. Zeeb e->cw_min = q->ecw_min_max & 0xf;
7666c92544dSBjoern A. Zeeb e->cw_max = (q->ecw_min_max & 0xf0) >> 4;
7676c92544dSBjoern A. Zeeb e->aifsn = q->aifsn;
7686c92544dSBjoern A. Zeeb e->timer = q->mu_edca_timer;
7696c92544dSBjoern A. Zeeb }
7706c92544dSBjoern A. Zeeb
7716c92544dSBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(SET_MU_EDCA_PARMS),
7726c92544dSBjoern A. Zeeb &req_mu, sizeof(req_mu), false);
7736c92544dSBjoern A. Zeeb }
7746c92544dSBjoern A. Zeeb
mt7921_mcu_set_roc(struct mt792x_phy * phy,struct mt792x_vif * vif,struct ieee80211_channel * chan,int duration,enum mt7921_roc_req type,u8 token_id)775cbb3ec25SBjoern A. Zeeb int mt7921_mcu_set_roc(struct mt792x_phy *phy, struct mt792x_vif *vif,
776cbb3ec25SBjoern A. Zeeb struct ieee80211_channel *chan, int duration,
777cbb3ec25SBjoern A. Zeeb enum mt7921_roc_req type, u8 token_id)
7786c92544dSBjoern A. Zeeb {
779cbb3ec25SBjoern A. Zeeb int center_ch = ieee80211_frequency_to_channel(chan->center_freq);
780cbb3ec25SBjoern A. Zeeb struct mt792x_dev *dev = phy->dev;
781cbb3ec25SBjoern A. Zeeb struct {
782cbb3ec25SBjoern A. Zeeb struct {
783cbb3ec25SBjoern A. Zeeb u8 rsv[4];
784cbb3ec25SBjoern A. Zeeb } __packed hdr;
785cbb3ec25SBjoern A. Zeeb struct roc_acquire_tlv {
786cbb3ec25SBjoern A. Zeeb __le16 tag;
787cbb3ec25SBjoern A. Zeeb __le16 len;
788cbb3ec25SBjoern A. Zeeb u8 bss_idx;
789cbb3ec25SBjoern A. Zeeb u8 tokenid;
790cbb3ec25SBjoern A. Zeeb u8 control_channel;
791cbb3ec25SBjoern A. Zeeb u8 sco;
792cbb3ec25SBjoern A. Zeeb u8 band;
793cbb3ec25SBjoern A. Zeeb u8 bw;
794cbb3ec25SBjoern A. Zeeb u8 center_chan;
795cbb3ec25SBjoern A. Zeeb u8 center_chan2;
796cbb3ec25SBjoern A. Zeeb u8 bw_from_ap;
797cbb3ec25SBjoern A. Zeeb u8 center_chan_from_ap;
798cbb3ec25SBjoern A. Zeeb u8 center_chan2_from_ap;
799cbb3ec25SBjoern A. Zeeb u8 reqtype;
800cbb3ec25SBjoern A. Zeeb __le32 maxinterval;
801cbb3ec25SBjoern A. Zeeb u8 dbdcband;
802cbb3ec25SBjoern A. Zeeb u8 rsv[3];
803cbb3ec25SBjoern A. Zeeb } __packed roc;
804cbb3ec25SBjoern A. Zeeb } __packed req = {
805cbb3ec25SBjoern A. Zeeb .roc = {
806cbb3ec25SBjoern A. Zeeb .tag = cpu_to_le16(UNI_ROC_ACQUIRE),
807cbb3ec25SBjoern A. Zeeb .len = cpu_to_le16(sizeof(struct roc_acquire_tlv)),
808cbb3ec25SBjoern A. Zeeb .tokenid = token_id,
809cbb3ec25SBjoern A. Zeeb .reqtype = type,
810cbb3ec25SBjoern A. Zeeb .maxinterval = cpu_to_le32(duration),
811*8ba4d145SBjoern A. Zeeb .bss_idx = vif->bss_conf.mt76.idx,
812cbb3ec25SBjoern A. Zeeb .control_channel = chan->hw_value,
813cbb3ec25SBjoern A. Zeeb .bw = CMD_CBW_20MHZ,
814cbb3ec25SBjoern A. Zeeb .bw_from_ap = CMD_CBW_20MHZ,
815cbb3ec25SBjoern A. Zeeb .center_chan = center_ch,
816cbb3ec25SBjoern A. Zeeb .center_chan_from_ap = center_ch,
817cbb3ec25SBjoern A. Zeeb .dbdcband = 0xff, /* auto */
818cbb3ec25SBjoern A. Zeeb },
819cbb3ec25SBjoern A. Zeeb };
820cbb3ec25SBjoern A. Zeeb
821cbb3ec25SBjoern A. Zeeb if (chan->hw_value < center_ch)
822cbb3ec25SBjoern A. Zeeb req.roc.sco = 1; /* SCA */
823cbb3ec25SBjoern A. Zeeb else if (chan->hw_value > center_ch)
824cbb3ec25SBjoern A. Zeeb req.roc.sco = 3; /* SCB */
825cbb3ec25SBjoern A. Zeeb
826cbb3ec25SBjoern A. Zeeb switch (chan->band) {
827cbb3ec25SBjoern A. Zeeb case NL80211_BAND_6GHZ:
828cbb3ec25SBjoern A. Zeeb req.roc.band = 3;
829cbb3ec25SBjoern A. Zeeb break;
830cbb3ec25SBjoern A. Zeeb case NL80211_BAND_5GHZ:
831cbb3ec25SBjoern A. Zeeb req.roc.band = 2;
832cbb3ec25SBjoern A. Zeeb break;
833cbb3ec25SBjoern A. Zeeb default:
834cbb3ec25SBjoern A. Zeeb req.roc.band = 1;
835cbb3ec25SBjoern A. Zeeb break;
836cbb3ec25SBjoern A. Zeeb }
837cbb3ec25SBjoern A. Zeeb
838cbb3ec25SBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(ROC),
839cbb3ec25SBjoern A. Zeeb &req, sizeof(req), false);
840cbb3ec25SBjoern A. Zeeb }
841cbb3ec25SBjoern A. Zeeb
mt7921_mcu_abort_roc(struct mt792x_phy * phy,struct mt792x_vif * vif,u8 token_id)842cbb3ec25SBjoern A. Zeeb int mt7921_mcu_abort_roc(struct mt792x_phy *phy, struct mt792x_vif *vif,
843cbb3ec25SBjoern A. Zeeb u8 token_id)
844cbb3ec25SBjoern A. Zeeb {
845cbb3ec25SBjoern A. Zeeb struct mt792x_dev *dev = phy->dev;
846cbb3ec25SBjoern A. Zeeb struct {
847cbb3ec25SBjoern A. Zeeb struct {
848cbb3ec25SBjoern A. Zeeb u8 rsv[4];
849cbb3ec25SBjoern A. Zeeb } __packed hdr;
850cbb3ec25SBjoern A. Zeeb struct roc_abort_tlv {
851cbb3ec25SBjoern A. Zeeb __le16 tag;
852cbb3ec25SBjoern A. Zeeb __le16 len;
853cbb3ec25SBjoern A. Zeeb u8 bss_idx;
854cbb3ec25SBjoern A. Zeeb u8 tokenid;
855cbb3ec25SBjoern A. Zeeb u8 dbdcband;
856cbb3ec25SBjoern A. Zeeb u8 rsv[5];
857cbb3ec25SBjoern A. Zeeb } __packed abort;
858cbb3ec25SBjoern A. Zeeb } __packed req = {
859cbb3ec25SBjoern A. Zeeb .abort = {
860cbb3ec25SBjoern A. Zeeb .tag = cpu_to_le16(UNI_ROC_ABORT),
861cbb3ec25SBjoern A. Zeeb .len = cpu_to_le16(sizeof(struct roc_abort_tlv)),
862cbb3ec25SBjoern A. Zeeb .tokenid = token_id,
863*8ba4d145SBjoern A. Zeeb .bss_idx = vif->bss_conf.mt76.idx,
864cbb3ec25SBjoern A. Zeeb .dbdcband = 0xff, /* auto*/
865cbb3ec25SBjoern A. Zeeb },
866cbb3ec25SBjoern A. Zeeb };
867cbb3ec25SBjoern A. Zeeb
868cbb3ec25SBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(ROC),
869cbb3ec25SBjoern A. Zeeb &req, sizeof(req), false);
870cbb3ec25SBjoern A. Zeeb }
871cbb3ec25SBjoern A. Zeeb
mt7921_mcu_set_chan_info(struct mt792x_phy * phy,int cmd)872cbb3ec25SBjoern A. Zeeb int mt7921_mcu_set_chan_info(struct mt792x_phy *phy, int cmd)
873cbb3ec25SBjoern A. Zeeb {
874cbb3ec25SBjoern A. Zeeb struct mt792x_dev *dev = phy->dev;
8756c92544dSBjoern A. Zeeb struct cfg80211_chan_def *chandef = &phy->mt76->chandef;
8766c92544dSBjoern A. Zeeb int freq1 = chandef->center_freq1;
8776c92544dSBjoern A. Zeeb struct {
8786c92544dSBjoern A. Zeeb u8 control_ch;
8796c92544dSBjoern A. Zeeb u8 center_ch;
8806c92544dSBjoern A. Zeeb u8 bw;
8816c92544dSBjoern A. Zeeb u8 tx_streams_num;
8826c92544dSBjoern A. Zeeb u8 rx_streams; /* mask or num */
8836c92544dSBjoern A. Zeeb u8 switch_reason;
8846c92544dSBjoern A. Zeeb u8 band_idx;
8856c92544dSBjoern A. Zeeb u8 center_ch2; /* for 80+80 only */
8866c92544dSBjoern A. Zeeb __le16 cac_case;
8876c92544dSBjoern A. Zeeb u8 channel_band;
8886c92544dSBjoern A. Zeeb u8 rsv0;
8896c92544dSBjoern A. Zeeb __le32 outband_freq;
8906c92544dSBjoern A. Zeeb u8 txpower_drop;
8916c92544dSBjoern A. Zeeb u8 ap_bw;
8926c92544dSBjoern A. Zeeb u8 ap_center_ch;
8936c92544dSBjoern A. Zeeb u8 rsv1[57];
8946c92544dSBjoern A. Zeeb } __packed req = {
8956c92544dSBjoern A. Zeeb .control_ch = chandef->chan->hw_value,
8966c92544dSBjoern A. Zeeb .center_ch = ieee80211_frequency_to_channel(freq1),
8976c92544dSBjoern A. Zeeb .bw = mt76_connac_chan_bw(chandef),
8986c92544dSBjoern A. Zeeb .tx_streams_num = hweight8(phy->mt76->antenna_mask),
8996c92544dSBjoern A. Zeeb .rx_streams = phy->mt76->antenna_mask,
9006c92544dSBjoern A. Zeeb .band_idx = phy != &dev->phy,
9016c92544dSBjoern A. Zeeb };
9026c92544dSBjoern A. Zeeb
9036c92544dSBjoern A. Zeeb if (chandef->chan->band == NL80211_BAND_6GHZ)
9046c92544dSBjoern A. Zeeb req.channel_band = 2;
9056c92544dSBjoern A. Zeeb else
9066c92544dSBjoern A. Zeeb req.channel_band = chandef->chan->band;
9076c92544dSBjoern A. Zeeb
9086c92544dSBjoern A. Zeeb if (cmd == MCU_EXT_CMD(SET_RX_PATH) ||
9096c92544dSBjoern A. Zeeb dev->mt76.hw->conf.flags & IEEE80211_CONF_MONITOR)
9106c92544dSBjoern A. Zeeb req.switch_reason = CH_SWITCH_NORMAL;
911*8ba4d145SBjoern A. Zeeb else if (phy->mt76->offchannel)
9126c92544dSBjoern A. Zeeb req.switch_reason = CH_SWITCH_SCAN_BYPASS_DPD;
9136c92544dSBjoern A. Zeeb else if (!cfg80211_reg_can_beacon(dev->mt76.hw->wiphy, chandef,
9146c92544dSBjoern A. Zeeb NL80211_IFTYPE_AP))
9156c92544dSBjoern A. Zeeb req.switch_reason = CH_SWITCH_DFS;
9166c92544dSBjoern A. Zeeb else
9176c92544dSBjoern A. Zeeb req.switch_reason = CH_SWITCH_NORMAL;
9186c92544dSBjoern A. Zeeb
9196c92544dSBjoern A. Zeeb if (cmd == MCU_EXT_CMD(CHANNEL_SWITCH))
9206c92544dSBjoern A. Zeeb req.rx_streams = hweight8(req.rx_streams);
9216c92544dSBjoern A. Zeeb
9226c92544dSBjoern A. Zeeb if (chandef->width == NL80211_CHAN_WIDTH_80P80) {
9236c92544dSBjoern A. Zeeb int freq2 = chandef->center_freq2;
9246c92544dSBjoern A. Zeeb
9256c92544dSBjoern A. Zeeb req.center_ch2 = ieee80211_frequency_to_channel(freq2);
9266c92544dSBjoern A. Zeeb }
9276c92544dSBjoern A. Zeeb
9286c92544dSBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, cmd, &req, sizeof(req), true);
9296c92544dSBjoern A. Zeeb }
9306c92544dSBjoern A. Zeeb
mt7921_mcu_set_eeprom(struct mt792x_dev * dev)931cbb3ec25SBjoern A. Zeeb int mt7921_mcu_set_eeprom(struct mt792x_dev *dev)
9326c92544dSBjoern A. Zeeb {
9336c92544dSBjoern A. Zeeb struct req_hdr {
9346c92544dSBjoern A. Zeeb u8 buffer_mode;
9356c92544dSBjoern A. Zeeb u8 format;
9366c92544dSBjoern A. Zeeb __le16 len;
9376c92544dSBjoern A. Zeeb } __packed req = {
9386c92544dSBjoern A. Zeeb .buffer_mode = EE_MODE_EFUSE,
9396c92544dSBjoern A. Zeeb .format = EE_FORMAT_WHOLE,
9406c92544dSBjoern A. Zeeb };
9416c92544dSBjoern A. Zeeb
9426c92544dSBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD(EFUSE_BUFFER_MODE),
9436c92544dSBjoern A. Zeeb &req, sizeof(req), true);
9446c92544dSBjoern A. Zeeb }
9456c92544dSBjoern A. Zeeb EXPORT_SYMBOL_GPL(mt7921_mcu_set_eeprom);
9466c92544dSBjoern A. Zeeb
mt7921_mcu_uni_bss_ps(struct mt792x_dev * dev,struct ieee80211_vif * vif)947cbb3ec25SBjoern A. Zeeb int mt7921_mcu_uni_bss_ps(struct mt792x_dev *dev, struct ieee80211_vif *vif)
9486c92544dSBjoern A. Zeeb {
949cbb3ec25SBjoern A. Zeeb struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
9506c92544dSBjoern A. Zeeb struct {
9516c92544dSBjoern A. Zeeb struct {
9526c92544dSBjoern A. Zeeb u8 bss_idx;
9536c92544dSBjoern A. Zeeb u8 pad[3];
9546c92544dSBjoern A. Zeeb } __packed hdr;
9556c92544dSBjoern A. Zeeb struct ps_tlv {
9566c92544dSBjoern A. Zeeb __le16 tag;
9576c92544dSBjoern A. Zeeb __le16 len;
9586c92544dSBjoern A. Zeeb u8 ps_state; /* 0: device awake
9596c92544dSBjoern A. Zeeb * 1: static power save
9606c92544dSBjoern A. Zeeb * 2: dynamic power saving
9616c92544dSBjoern A. Zeeb * 3: enter TWT power saving
9626c92544dSBjoern A. Zeeb * 4: leave TWT power saving
9636c92544dSBjoern A. Zeeb */
9646c92544dSBjoern A. Zeeb u8 pad[3];
9656c92544dSBjoern A. Zeeb } __packed ps;
9666c92544dSBjoern A. Zeeb } __packed ps_req = {
9676c92544dSBjoern A. Zeeb .hdr = {
968*8ba4d145SBjoern A. Zeeb .bss_idx = mvif->bss_conf.mt76.idx,
9696c92544dSBjoern A. Zeeb },
9706c92544dSBjoern A. Zeeb .ps = {
9716c92544dSBjoern A. Zeeb .tag = cpu_to_le16(UNI_BSS_INFO_PS),
9726c92544dSBjoern A. Zeeb .len = cpu_to_le16(sizeof(struct ps_tlv)),
9736c92544dSBjoern A. Zeeb .ps_state = vif->cfg.ps ? 2 : 0,
9746c92544dSBjoern A. Zeeb },
9756c92544dSBjoern A. Zeeb };
9766c92544dSBjoern A. Zeeb
9776c92544dSBjoern A. Zeeb if (vif->type != NL80211_IFTYPE_STATION)
9786c92544dSBjoern A. Zeeb return -EOPNOTSUPP;
9796c92544dSBjoern A. Zeeb
9806c92544dSBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(BSS_INFO_UPDATE),
9816c92544dSBjoern A. Zeeb &ps_req, sizeof(ps_req), true);
9826c92544dSBjoern A. Zeeb }
9836c92544dSBjoern A. Zeeb
9846c92544dSBjoern A. Zeeb static int
mt7921_mcu_uni_bss_bcnft(struct mt792x_dev * dev,struct ieee80211_vif * vif,bool enable)985cbb3ec25SBjoern A. Zeeb mt7921_mcu_uni_bss_bcnft(struct mt792x_dev *dev, struct ieee80211_vif *vif,
9866c92544dSBjoern A. Zeeb bool enable)
9876c92544dSBjoern A. Zeeb {
988cbb3ec25SBjoern A. Zeeb struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
9896c92544dSBjoern A. Zeeb struct {
9906c92544dSBjoern A. Zeeb struct {
9916c92544dSBjoern A. Zeeb u8 bss_idx;
9926c92544dSBjoern A. Zeeb u8 pad[3];
9936c92544dSBjoern A. Zeeb } __packed hdr;
9946c92544dSBjoern A. Zeeb struct bcnft_tlv {
9956c92544dSBjoern A. Zeeb __le16 tag;
9966c92544dSBjoern A. Zeeb __le16 len;
9976c92544dSBjoern A. Zeeb __le16 bcn_interval;
9986c92544dSBjoern A. Zeeb u8 dtim_period;
9996c92544dSBjoern A. Zeeb u8 pad;
10006c92544dSBjoern A. Zeeb } __packed bcnft;
10016c92544dSBjoern A. Zeeb } __packed bcnft_req = {
10026c92544dSBjoern A. Zeeb .hdr = {
1003*8ba4d145SBjoern A. Zeeb .bss_idx = mvif->bss_conf.mt76.idx,
10046c92544dSBjoern A. Zeeb },
10056c92544dSBjoern A. Zeeb .bcnft = {
10066c92544dSBjoern A. Zeeb .tag = cpu_to_le16(UNI_BSS_INFO_BCNFT),
10076c92544dSBjoern A. Zeeb .len = cpu_to_le16(sizeof(struct bcnft_tlv)),
10086c92544dSBjoern A. Zeeb .bcn_interval = cpu_to_le16(vif->bss_conf.beacon_int),
10096c92544dSBjoern A. Zeeb .dtim_period = vif->bss_conf.dtim_period,
10106c92544dSBjoern A. Zeeb },
10116c92544dSBjoern A. Zeeb };
10126c92544dSBjoern A. Zeeb
10136c92544dSBjoern A. Zeeb if (vif->type != NL80211_IFTYPE_STATION)
10146c92544dSBjoern A. Zeeb return 0;
10156c92544dSBjoern A. Zeeb
10166c92544dSBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(BSS_INFO_UPDATE),
10176c92544dSBjoern A. Zeeb &bcnft_req, sizeof(bcnft_req), true);
10186c92544dSBjoern A. Zeeb }
10196c92544dSBjoern A. Zeeb
10206c92544dSBjoern A. Zeeb int
mt7921_mcu_set_bss_pm(struct mt792x_dev * dev,struct ieee80211_vif * vif,bool enable)1021cbb3ec25SBjoern A. Zeeb mt7921_mcu_set_bss_pm(struct mt792x_dev *dev, struct ieee80211_vif *vif,
10226c92544dSBjoern A. Zeeb bool enable)
10236c92544dSBjoern A. Zeeb {
1024cbb3ec25SBjoern A. Zeeb struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
10256c92544dSBjoern A. Zeeb struct {
10266c92544dSBjoern A. Zeeb u8 bss_idx;
10276c92544dSBjoern A. Zeeb u8 dtim_period;
10286c92544dSBjoern A. Zeeb __le16 aid;
10296c92544dSBjoern A. Zeeb __le16 bcn_interval;
10306c92544dSBjoern A. Zeeb __le16 atim_window;
10316c92544dSBjoern A. Zeeb u8 uapsd;
10326c92544dSBjoern A. Zeeb u8 bmc_delivered_ac;
10336c92544dSBjoern A. Zeeb u8 bmc_triggered_ac;
10346c92544dSBjoern A. Zeeb u8 pad;
10356c92544dSBjoern A. Zeeb } req = {
1036*8ba4d145SBjoern A. Zeeb .bss_idx = mvif->bss_conf.mt76.idx,
10376c92544dSBjoern A. Zeeb .aid = cpu_to_le16(vif->cfg.aid),
10386c92544dSBjoern A. Zeeb .dtim_period = vif->bss_conf.dtim_period,
10396c92544dSBjoern A. Zeeb .bcn_interval = cpu_to_le16(vif->bss_conf.beacon_int),
10406c92544dSBjoern A. Zeeb };
10416c92544dSBjoern A. Zeeb struct {
10426c92544dSBjoern A. Zeeb u8 bss_idx;
10436c92544dSBjoern A. Zeeb u8 pad[3];
10446c92544dSBjoern A. Zeeb } req_hdr = {
1045*8ba4d145SBjoern A. Zeeb .bss_idx = mvif->bss_conf.mt76.idx,
10466c92544dSBjoern A. Zeeb };
10476c92544dSBjoern A. Zeeb int err;
10486c92544dSBjoern A. Zeeb
10496c92544dSBjoern A. Zeeb err = mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(SET_BSS_ABORT),
10506c92544dSBjoern A. Zeeb &req_hdr, sizeof(req_hdr), false);
10516c92544dSBjoern A. Zeeb if (err < 0 || !enable)
10526c92544dSBjoern A. Zeeb return err;
10536c92544dSBjoern A. Zeeb
10546c92544dSBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(SET_BSS_CONNECTED),
10556c92544dSBjoern A. Zeeb &req, sizeof(req), false);
10566c92544dSBjoern A. Zeeb }
10576c92544dSBjoern A. Zeeb
mt7921_mcu_sta_update(struct mt792x_dev * dev,struct ieee80211_sta * sta,struct ieee80211_vif * vif,bool enable,enum mt76_sta_info_state state)1058cbb3ec25SBjoern A. Zeeb int mt7921_mcu_sta_update(struct mt792x_dev *dev, struct ieee80211_sta *sta,
10596c92544dSBjoern A. Zeeb struct ieee80211_vif *vif, bool enable,
10606c92544dSBjoern A. Zeeb enum mt76_sta_info_state state)
10616c92544dSBjoern A. Zeeb {
1062cbb3ec25SBjoern A. Zeeb struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
1063*8ba4d145SBjoern A. Zeeb int rssi = -ewma_rssi_read(&mvif->bss_conf.rssi);
10646c92544dSBjoern A. Zeeb struct mt76_sta_cmd_info info = {
10656c92544dSBjoern A. Zeeb .sta = sta,
10666c92544dSBjoern A. Zeeb .vif = vif,
10676c92544dSBjoern A. Zeeb .enable = enable,
10686c92544dSBjoern A. Zeeb .cmd = MCU_UNI_CMD(STA_REC_UPDATE),
10696c92544dSBjoern A. Zeeb .state = state,
10706c92544dSBjoern A. Zeeb .offload_fw = true,
10716c92544dSBjoern A. Zeeb .rcpi = to_rcpi(rssi),
10726c92544dSBjoern A. Zeeb };
1073cbb3ec25SBjoern A. Zeeb struct mt792x_sta *msta;
10746c92544dSBjoern A. Zeeb
1075cbb3ec25SBjoern A. Zeeb msta = sta ? (struct mt792x_sta *)sta->drv_priv : NULL;
1076*8ba4d145SBjoern A. Zeeb info.wcid = msta ? &msta->deflink.wcid : &mvif->sta.deflink.wcid;
10776c92544dSBjoern A. Zeeb info.newly = msta ? state != MT76_STA_INFO_STATE_ASSOC : true;
10786c92544dSBjoern A. Zeeb
10796c92544dSBjoern A. Zeeb return mt76_connac_mcu_sta_cmd(&dev->mphy, &info);
10806c92544dSBjoern A. Zeeb }
10816c92544dSBjoern A. Zeeb
mt7921_mcu_set_beacon_filter(struct mt792x_dev * dev,struct ieee80211_vif * vif,bool enable)1082cbb3ec25SBjoern A. Zeeb int mt7921_mcu_set_beacon_filter(struct mt792x_dev *dev,
10836c92544dSBjoern A. Zeeb struct ieee80211_vif *vif,
10846c92544dSBjoern A. Zeeb bool enable)
10856c92544dSBjoern A. Zeeb {
1086cbb3ec25SBjoern A. Zeeb #define MT7921_FIF_BIT_CLR BIT(1)
1087cbb3ec25SBjoern A. Zeeb #define MT7921_FIF_BIT_SET BIT(0)
10886c92544dSBjoern A. Zeeb int err;
10896c92544dSBjoern A. Zeeb
10906c92544dSBjoern A. Zeeb if (enable) {
10916c92544dSBjoern A. Zeeb err = mt7921_mcu_uni_bss_bcnft(dev, vif, true);
10926c92544dSBjoern A. Zeeb if (err)
10936c92544dSBjoern A. Zeeb return err;
10946c92544dSBjoern A. Zeeb
1095cbb3ec25SBjoern A. Zeeb err = mt7921_mcu_set_rxfilter(dev, 0,
1096cbb3ec25SBjoern A. Zeeb MT7921_FIF_BIT_SET,
1097cbb3ec25SBjoern A. Zeeb MT_WF_RFCR_DROP_OTHER_BEACON);
1098cbb3ec25SBjoern A. Zeeb if (err)
1099cbb3ec25SBjoern A. Zeeb return err;
11006c92544dSBjoern A. Zeeb
11016c92544dSBjoern A. Zeeb return 0;
11026c92544dSBjoern A. Zeeb }
11036c92544dSBjoern A. Zeeb
11046c92544dSBjoern A. Zeeb err = mt7921_mcu_set_bss_pm(dev, vif, false);
11056c92544dSBjoern A. Zeeb if (err)
11066c92544dSBjoern A. Zeeb return err;
11076c92544dSBjoern A. Zeeb
1108cbb3ec25SBjoern A. Zeeb err = mt7921_mcu_set_rxfilter(dev, 0,
1109cbb3ec25SBjoern A. Zeeb MT7921_FIF_BIT_CLR,
1110cbb3ec25SBjoern A. Zeeb MT_WF_RFCR_DROP_OTHER_BEACON);
1111cbb3ec25SBjoern A. Zeeb if (err)
1112cbb3ec25SBjoern A. Zeeb return err;
11136c92544dSBjoern A. Zeeb
11146c92544dSBjoern A. Zeeb return 0;
11156c92544dSBjoern A. Zeeb }
11166c92544dSBjoern A. Zeeb
mt7921_get_txpwr_info(struct mt792x_dev * dev,struct mt7921_txpwr * txpwr)1117cbb3ec25SBjoern A. Zeeb int mt7921_get_txpwr_info(struct mt792x_dev *dev, struct mt7921_txpwr *txpwr)
11186c92544dSBjoern A. Zeeb {
11196c92544dSBjoern A. Zeeb struct mt7921_txpwr_event *event;
11206c92544dSBjoern A. Zeeb struct mt7921_txpwr_req req = {
11216c92544dSBjoern A. Zeeb .dbdc_idx = 0,
11226c92544dSBjoern A. Zeeb };
11236c92544dSBjoern A. Zeeb struct sk_buff *skb;
11246c92544dSBjoern A. Zeeb int ret;
11256c92544dSBjoern A. Zeeb
11266c92544dSBjoern A. Zeeb ret = mt76_mcu_send_and_get_msg(&dev->mt76, MCU_CE_CMD(GET_TXPWR),
11276c92544dSBjoern A. Zeeb &req, sizeof(req), true, &skb);
11286c92544dSBjoern A. Zeeb if (ret)
11296c92544dSBjoern A. Zeeb return ret;
11306c92544dSBjoern A. Zeeb
11316c92544dSBjoern A. Zeeb event = (struct mt7921_txpwr_event *)skb->data;
11326c92544dSBjoern A. Zeeb WARN_ON(skb->len != le16_to_cpu(event->len));
11336c92544dSBjoern A. Zeeb memcpy(txpwr, &event->txpwr, sizeof(event->txpwr));
11346c92544dSBjoern A. Zeeb
11356c92544dSBjoern A. Zeeb dev_kfree_skb(skb);
11366c92544dSBjoern A. Zeeb
11376c92544dSBjoern A. Zeeb return 0;
11386c92544dSBjoern A. Zeeb }
11396c92544dSBjoern A. Zeeb
mt7921_mcu_set_sniffer(struct mt792x_dev * dev,struct ieee80211_vif * vif,bool enable)1140cbb3ec25SBjoern A. Zeeb int mt7921_mcu_set_sniffer(struct mt792x_dev *dev, struct ieee80211_vif *vif,
11416c92544dSBjoern A. Zeeb bool enable)
11426c92544dSBjoern A. Zeeb {
1143*8ba4d145SBjoern A. Zeeb struct mt76_vif_link *mvif = (struct mt76_vif_link *)vif->drv_priv;
11446c92544dSBjoern A. Zeeb struct {
11456c92544dSBjoern A. Zeeb struct {
11466c92544dSBjoern A. Zeeb u8 band_idx;
11476c92544dSBjoern A. Zeeb u8 pad[3];
11486c92544dSBjoern A. Zeeb } __packed hdr;
11496c92544dSBjoern A. Zeeb struct sniffer_enable_tlv {
11506c92544dSBjoern A. Zeeb __le16 tag;
11516c92544dSBjoern A. Zeeb __le16 len;
11526c92544dSBjoern A. Zeeb u8 enable;
11536c92544dSBjoern A. Zeeb u8 pad[3];
11546c92544dSBjoern A. Zeeb } __packed enable;
11556c92544dSBjoern A. Zeeb } req = {
11566c92544dSBjoern A. Zeeb .hdr = {
11576c92544dSBjoern A. Zeeb .band_idx = mvif->band_idx,
11586c92544dSBjoern A. Zeeb },
11596c92544dSBjoern A. Zeeb .enable = {
11606c92544dSBjoern A. Zeeb .tag = cpu_to_le16(0),
11616c92544dSBjoern A. Zeeb .len = cpu_to_le16(sizeof(struct sniffer_enable_tlv)),
11626c92544dSBjoern A. Zeeb .enable = enable,
11636c92544dSBjoern A. Zeeb },
11646c92544dSBjoern A. Zeeb };
11656c92544dSBjoern A. Zeeb
11666c92544dSBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(SNIFFER), &req, sizeof(req),
11676c92544dSBjoern A. Zeeb true);
11686c92544dSBjoern A. Zeeb }
11696c92544dSBjoern A. Zeeb
mt7921_mcu_config_sniffer(struct mt792x_vif * vif,struct ieee80211_chanctx_conf * ctx)1170cbb3ec25SBjoern A. Zeeb int mt7921_mcu_config_sniffer(struct mt792x_vif *vif,
1171cbb3ec25SBjoern A. Zeeb struct ieee80211_chanctx_conf *ctx)
1172cbb3ec25SBjoern A. Zeeb {
1173cbb3ec25SBjoern A. Zeeb struct cfg80211_chan_def *chandef = &ctx->def;
1174cbb3ec25SBjoern A. Zeeb int freq1 = chandef->center_freq1, freq2 = chandef->center_freq2;
1175*8ba4d145SBjoern A. Zeeb static const u8 ch_band[] = {
1176cbb3ec25SBjoern A. Zeeb [NL80211_BAND_2GHZ] = 1,
1177cbb3ec25SBjoern A. Zeeb [NL80211_BAND_5GHZ] = 2,
1178cbb3ec25SBjoern A. Zeeb [NL80211_BAND_6GHZ] = 3,
1179cbb3ec25SBjoern A. Zeeb };
1180*8ba4d145SBjoern A. Zeeb static const u8 ch_width[] = {
1181cbb3ec25SBjoern A. Zeeb [NL80211_CHAN_WIDTH_20_NOHT] = 0,
1182cbb3ec25SBjoern A. Zeeb [NL80211_CHAN_WIDTH_20] = 0,
1183cbb3ec25SBjoern A. Zeeb [NL80211_CHAN_WIDTH_40] = 0,
1184cbb3ec25SBjoern A. Zeeb [NL80211_CHAN_WIDTH_80] = 1,
1185cbb3ec25SBjoern A. Zeeb [NL80211_CHAN_WIDTH_160] = 2,
1186cbb3ec25SBjoern A. Zeeb [NL80211_CHAN_WIDTH_80P80] = 3,
1187cbb3ec25SBjoern A. Zeeb [NL80211_CHAN_WIDTH_5] = 4,
1188cbb3ec25SBjoern A. Zeeb [NL80211_CHAN_WIDTH_10] = 5,
1189cbb3ec25SBjoern A. Zeeb [NL80211_CHAN_WIDTH_320] = 6,
1190cbb3ec25SBjoern A. Zeeb };
1191cbb3ec25SBjoern A. Zeeb struct {
1192cbb3ec25SBjoern A. Zeeb struct {
1193cbb3ec25SBjoern A. Zeeb u8 band_idx;
1194cbb3ec25SBjoern A. Zeeb u8 pad[3];
1195cbb3ec25SBjoern A. Zeeb } __packed hdr;
1196cbb3ec25SBjoern A. Zeeb struct config_tlv {
1197cbb3ec25SBjoern A. Zeeb __le16 tag;
1198cbb3ec25SBjoern A. Zeeb __le16 len;
1199cbb3ec25SBjoern A. Zeeb u16 aid;
1200cbb3ec25SBjoern A. Zeeb u8 ch_band;
1201cbb3ec25SBjoern A. Zeeb u8 bw;
1202cbb3ec25SBjoern A. Zeeb u8 control_ch;
1203cbb3ec25SBjoern A. Zeeb u8 sco;
1204cbb3ec25SBjoern A. Zeeb u8 center_ch;
1205cbb3ec25SBjoern A. Zeeb u8 center_ch2;
1206cbb3ec25SBjoern A. Zeeb u8 drop_err;
1207cbb3ec25SBjoern A. Zeeb u8 pad[3];
1208cbb3ec25SBjoern A. Zeeb } __packed tlv;
1209cbb3ec25SBjoern A. Zeeb } __packed req = {
1210cbb3ec25SBjoern A. Zeeb .hdr = {
1211*8ba4d145SBjoern A. Zeeb .band_idx = vif->bss_conf.mt76.band_idx,
1212cbb3ec25SBjoern A. Zeeb },
1213cbb3ec25SBjoern A. Zeeb .tlv = {
1214cbb3ec25SBjoern A. Zeeb .tag = cpu_to_le16(1),
1215cbb3ec25SBjoern A. Zeeb .len = cpu_to_le16(sizeof(req.tlv)),
1216cbb3ec25SBjoern A. Zeeb .control_ch = chandef->chan->hw_value,
1217cbb3ec25SBjoern A. Zeeb .center_ch = ieee80211_frequency_to_channel(freq1),
1218cbb3ec25SBjoern A. Zeeb .drop_err = 1,
1219cbb3ec25SBjoern A. Zeeb },
1220cbb3ec25SBjoern A. Zeeb };
1221cbb3ec25SBjoern A. Zeeb if (chandef->chan->band < ARRAY_SIZE(ch_band))
1222cbb3ec25SBjoern A. Zeeb req.tlv.ch_band = ch_band[chandef->chan->band];
1223cbb3ec25SBjoern A. Zeeb if (chandef->width < ARRAY_SIZE(ch_width))
1224cbb3ec25SBjoern A. Zeeb req.tlv.bw = ch_width[chandef->width];
1225cbb3ec25SBjoern A. Zeeb
1226cbb3ec25SBjoern A. Zeeb if (freq2)
1227cbb3ec25SBjoern A. Zeeb req.tlv.center_ch2 = ieee80211_frequency_to_channel(freq2);
1228cbb3ec25SBjoern A. Zeeb
1229cbb3ec25SBjoern A. Zeeb if (req.tlv.control_ch < req.tlv.center_ch)
1230cbb3ec25SBjoern A. Zeeb req.tlv.sco = 1; /* SCA */
1231cbb3ec25SBjoern A. Zeeb else if (req.tlv.control_ch > req.tlv.center_ch)
1232cbb3ec25SBjoern A. Zeeb req.tlv.sco = 3; /* SCB */
1233cbb3ec25SBjoern A. Zeeb
1234cbb3ec25SBjoern A. Zeeb return mt76_mcu_send_msg(vif->phy->mt76->dev, MCU_UNI_CMD(SNIFFER),
1235cbb3ec25SBjoern A. Zeeb &req, sizeof(req), true);
1236cbb3ec25SBjoern A. Zeeb }
1237cbb3ec25SBjoern A. Zeeb
12386c92544dSBjoern A. Zeeb int
mt7921_mcu_uni_add_beacon_offload(struct mt792x_dev * dev,struct ieee80211_hw * hw,struct ieee80211_vif * vif,bool enable)1239cbb3ec25SBjoern A. Zeeb mt7921_mcu_uni_add_beacon_offload(struct mt792x_dev *dev,
12406c92544dSBjoern A. Zeeb struct ieee80211_hw *hw,
12416c92544dSBjoern A. Zeeb struct ieee80211_vif *vif,
12426c92544dSBjoern A. Zeeb bool enable)
12436c92544dSBjoern A. Zeeb {
1244cbb3ec25SBjoern A. Zeeb struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
12456c92544dSBjoern A. Zeeb struct mt76_wcid *wcid = &dev->mt76.global_wcid;
12466c92544dSBjoern A. Zeeb struct ieee80211_mutable_offsets offs;
12476c92544dSBjoern A. Zeeb struct {
12486c92544dSBjoern A. Zeeb struct req_hdr {
12496c92544dSBjoern A. Zeeb u8 bss_idx;
12506c92544dSBjoern A. Zeeb u8 pad[3];
12516c92544dSBjoern A. Zeeb } __packed hdr;
12526c92544dSBjoern A. Zeeb struct bcn_content_tlv {
12536c92544dSBjoern A. Zeeb __le16 tag;
12546c92544dSBjoern A. Zeeb __le16 len;
12556c92544dSBjoern A. Zeeb __le16 tim_ie_pos;
12566c92544dSBjoern A. Zeeb __le16 csa_ie_pos;
12576c92544dSBjoern A. Zeeb __le16 bcc_ie_pos;
12586c92544dSBjoern A. Zeeb /* 0: disable beacon offload
12596c92544dSBjoern A. Zeeb * 1: enable beacon offload
12606c92544dSBjoern A. Zeeb * 2: update probe respond offload
12616c92544dSBjoern A. Zeeb */
12626c92544dSBjoern A. Zeeb u8 enable;
12636c92544dSBjoern A. Zeeb /* 0: legacy format (TXD + payload)
12646c92544dSBjoern A. Zeeb * 1: only cap field IE
12656c92544dSBjoern A. Zeeb */
12666c92544dSBjoern A. Zeeb u8 type;
12676c92544dSBjoern A. Zeeb __le16 pkt_len;
12686c92544dSBjoern A. Zeeb u8 pkt[512];
12696c92544dSBjoern A. Zeeb } __packed beacon_tlv;
12706c92544dSBjoern A. Zeeb } req = {
12716c92544dSBjoern A. Zeeb .hdr = {
1272*8ba4d145SBjoern A. Zeeb .bss_idx = mvif->bss_conf.mt76.idx,
12736c92544dSBjoern A. Zeeb },
12746c92544dSBjoern A. Zeeb .beacon_tlv = {
12756c92544dSBjoern A. Zeeb .tag = cpu_to_le16(UNI_BSS_INFO_BCN_CONTENT),
12766c92544dSBjoern A. Zeeb .len = cpu_to_le16(sizeof(struct bcn_content_tlv)),
12776c92544dSBjoern A. Zeeb .enable = enable,
12786c92544dSBjoern A. Zeeb },
12796c92544dSBjoern A. Zeeb };
12806c92544dSBjoern A. Zeeb struct sk_buff *skb;
12816c92544dSBjoern A. Zeeb
12826c92544dSBjoern A. Zeeb /* support enable/update process only
12836c92544dSBjoern A. Zeeb * disable flow would be handled in bss stop handler automatically
12846c92544dSBjoern A. Zeeb */
12856c92544dSBjoern A. Zeeb if (!enable)
12866c92544dSBjoern A. Zeeb return -EOPNOTSUPP;
12876c92544dSBjoern A. Zeeb
12886c92544dSBjoern A. Zeeb skb = ieee80211_beacon_get_template(mt76_hw(dev), vif, &offs, 0);
12896c92544dSBjoern A. Zeeb if (!skb)
12906c92544dSBjoern A. Zeeb return -EINVAL;
12916c92544dSBjoern A. Zeeb
12926c92544dSBjoern A. Zeeb if (skb->len > 512 - MT_TXD_SIZE) {
12936c92544dSBjoern A. Zeeb dev_err(dev->mt76.dev, "beacon size limit exceed\n");
12946c92544dSBjoern A. Zeeb dev_kfree_skb(skb);
12956c92544dSBjoern A. Zeeb return -EINVAL;
12966c92544dSBjoern A. Zeeb }
12976c92544dSBjoern A. Zeeb
12986c92544dSBjoern A. Zeeb mt76_connac2_mac_write_txwi(&dev->mt76, (__le32 *)(req.beacon_tlv.pkt),
12996c92544dSBjoern A. Zeeb skb, wcid, NULL, 0, 0, BSS_CHANGED_BEACON);
13006c92544dSBjoern A. Zeeb memcpy(req.beacon_tlv.pkt + MT_TXD_SIZE, skb->data, skb->len);
13016c92544dSBjoern A. Zeeb req.beacon_tlv.pkt_len = cpu_to_le16(MT_TXD_SIZE + skb->len);
13026c92544dSBjoern A. Zeeb req.beacon_tlv.tim_ie_pos = cpu_to_le16(MT_TXD_SIZE + offs.tim_offset);
13036c92544dSBjoern A. Zeeb
13046c92544dSBjoern A. Zeeb if (offs.cntdwn_counter_offs[0]) {
13056c92544dSBjoern A. Zeeb u16 csa_offs;
13066c92544dSBjoern A. Zeeb
13076c92544dSBjoern A. Zeeb csa_offs = MT_TXD_SIZE + offs.cntdwn_counter_offs[0] - 4;
13086c92544dSBjoern A. Zeeb req.beacon_tlv.csa_ie_pos = cpu_to_le16(csa_offs);
13096c92544dSBjoern A. Zeeb }
13106c92544dSBjoern A. Zeeb dev_kfree_skb(skb);
13116c92544dSBjoern A. Zeeb
13126c92544dSBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_UNI_CMD(BSS_INFO_UPDATE),
13136c92544dSBjoern A. Zeeb &req, sizeof(req), true);
13146c92544dSBjoern A. Zeeb }
13156c92544dSBjoern A. Zeeb
13166c92544dSBjoern A. Zeeb static
__mt7921_mcu_set_clc(struct mt792x_dev * dev,u8 * alpha2,enum environment_cap env_cap,struct mt7921_clc * clc,u8 idx)1317cbb3ec25SBjoern A. Zeeb int __mt7921_mcu_set_clc(struct mt792x_dev *dev, u8 *alpha2,
13186c92544dSBjoern A. Zeeb enum environment_cap env_cap,
13196c92544dSBjoern A. Zeeb struct mt7921_clc *clc,
13206c92544dSBjoern A. Zeeb u8 idx)
13216c92544dSBjoern A. Zeeb {
1322*8ba4d145SBjoern A. Zeeb #define CLC_CAP_EVT_EN BIT(0)
1323*8ba4d145SBjoern A. Zeeb #define CLC_CAP_DTS_EN BIT(1)
1324*8ba4d145SBjoern A. Zeeb struct sk_buff *skb, *ret_skb = NULL;
13256c92544dSBjoern A. Zeeb struct {
13266c92544dSBjoern A. Zeeb u8 ver;
13276c92544dSBjoern A. Zeeb u8 pad0;
13286c92544dSBjoern A. Zeeb __le16 len;
13296c92544dSBjoern A. Zeeb u8 idx;
13306c92544dSBjoern A. Zeeb u8 env;
1331cbb3ec25SBjoern A. Zeeb u8 acpi_conf;
1332*8ba4d145SBjoern A. Zeeb u8 cap;
13336c92544dSBjoern A. Zeeb u8 alpha2[2];
13346c92544dSBjoern A. Zeeb u8 type[2];
1335*8ba4d145SBjoern A. Zeeb u8 env_6g;
1336*8ba4d145SBjoern A. Zeeb u8 mtcl_conf;
1337*8ba4d145SBjoern A. Zeeb u8 rsvd[62];
13386c92544dSBjoern A. Zeeb } __packed req = {
1339*8ba4d145SBjoern A. Zeeb .ver = 1,
13406c92544dSBjoern A. Zeeb .idx = idx,
13416c92544dSBjoern A. Zeeb .env = env_cap,
1342*8ba4d145SBjoern A. Zeeb .env_6g = dev->phy.power_type,
1343cbb3ec25SBjoern A. Zeeb .acpi_conf = mt792x_acpi_get_flags(&dev->phy),
1344*8ba4d145SBjoern A. Zeeb .mtcl_conf = mt792x_acpi_get_mtcl_conf(&dev->phy, alpha2),
13456c92544dSBjoern A. Zeeb };
13466c92544dSBjoern A. Zeeb int ret, valid_cnt = 0;
1347*8ba4d145SBjoern A. Zeeb u32 buf_len = 0;
1348*8ba4d145SBjoern A. Zeeb u8 *pos;
13496c92544dSBjoern A. Zeeb
13506c92544dSBjoern A. Zeeb if (!clc)
13516c92544dSBjoern A. Zeeb return 0;
13526c92544dSBjoern A. Zeeb
1353*8ba4d145SBjoern A. Zeeb if (dev->phy.chip_cap & MT792x_CHIP_CAP_CLC_EVT_EN)
1354*8ba4d145SBjoern A. Zeeb req.cap |= CLC_CAP_EVT_EN;
1355*8ba4d145SBjoern A. Zeeb if (mt76_find_power_limits_node(&dev->mt76))
1356*8ba4d145SBjoern A. Zeeb req.cap |= CLC_CAP_DTS_EN;
1357*8ba4d145SBjoern A. Zeeb
1358*8ba4d145SBjoern A. Zeeb buf_len = le32_to_cpu(clc->len) - sizeof(*clc);
13596c92544dSBjoern A. Zeeb pos = clc->data;
1360*8ba4d145SBjoern A. Zeeb while (buf_len > 16) {
13616c92544dSBjoern A. Zeeb struct mt7921_clc_rule *rule = (struct mt7921_clc_rule *)pos;
13626c92544dSBjoern A. Zeeb u16 len = le16_to_cpu(rule->len);
1363*8ba4d145SBjoern A. Zeeb u16 offset = len + sizeof(*rule);
13646c92544dSBjoern A. Zeeb
1365*8ba4d145SBjoern A. Zeeb pos += offset;
1366*8ba4d145SBjoern A. Zeeb buf_len -= offset;
13676c92544dSBjoern A. Zeeb if (rule->alpha2[0] != alpha2[0] ||
13686c92544dSBjoern A. Zeeb rule->alpha2[1] != alpha2[1])
13696c92544dSBjoern A. Zeeb continue;
13706c92544dSBjoern A. Zeeb
13716c92544dSBjoern A. Zeeb memcpy(req.alpha2, rule->alpha2, 2);
13726c92544dSBjoern A. Zeeb memcpy(req.type, rule->type, 2);
13736c92544dSBjoern A. Zeeb
13746c92544dSBjoern A. Zeeb req.len = cpu_to_le16(sizeof(req) + len);
13756c92544dSBjoern A. Zeeb skb = __mt76_mcu_msg_alloc(&dev->mt76, &req,
13766c92544dSBjoern A. Zeeb le16_to_cpu(req.len),
13776c92544dSBjoern A. Zeeb sizeof(req), GFP_KERNEL);
13786c92544dSBjoern A. Zeeb if (!skb)
13796c92544dSBjoern A. Zeeb return -ENOMEM;
13806c92544dSBjoern A. Zeeb skb_put_data(skb, rule->data, len);
13816c92544dSBjoern A. Zeeb
1382*8ba4d145SBjoern A. Zeeb ret = mt76_mcu_skb_send_and_get_msg(&dev->mt76, skb,
1383*8ba4d145SBjoern A. Zeeb MCU_CE_CMD(SET_CLC),
1384*8ba4d145SBjoern A. Zeeb !!(req.cap & CLC_CAP_EVT_EN),
1385*8ba4d145SBjoern A. Zeeb &ret_skb);
13866c92544dSBjoern A. Zeeb if (ret < 0)
13876c92544dSBjoern A. Zeeb return ret;
1388*8ba4d145SBjoern A. Zeeb
1389*8ba4d145SBjoern A. Zeeb if (ret_skb) {
1390*8ba4d145SBjoern A. Zeeb struct mt7921_clc_info_tlv *info;
1391*8ba4d145SBjoern A. Zeeb
1392*8ba4d145SBjoern A. Zeeb info = (struct mt7921_clc_info_tlv *)(ret_skb->data + 4);
1393*8ba4d145SBjoern A. Zeeb dev->phy.clc_chan_conf = info->chan_conf;
1394*8ba4d145SBjoern A. Zeeb dev_kfree_skb(ret_skb);
1395*8ba4d145SBjoern A. Zeeb }
1396*8ba4d145SBjoern A. Zeeb
13976c92544dSBjoern A. Zeeb valid_cnt++;
13986c92544dSBjoern A. Zeeb }
13996c92544dSBjoern A. Zeeb
14006c92544dSBjoern A. Zeeb if (!valid_cnt)
14016c92544dSBjoern A. Zeeb return -ENOENT;
14026c92544dSBjoern A. Zeeb
14036c92544dSBjoern A. Zeeb return 0;
14046c92544dSBjoern A. Zeeb }
14056c92544dSBjoern A. Zeeb
mt7921_mcu_set_clc(struct mt792x_dev * dev,u8 * alpha2,enum environment_cap env_cap)1406cbb3ec25SBjoern A. Zeeb int mt7921_mcu_set_clc(struct mt792x_dev *dev, u8 *alpha2,
14076c92544dSBjoern A. Zeeb enum environment_cap env_cap)
14086c92544dSBjoern A. Zeeb {
1409cbb3ec25SBjoern A. Zeeb struct mt792x_phy *phy = (struct mt792x_phy *)&dev->phy;
14106c92544dSBjoern A. Zeeb int i, ret;
14116c92544dSBjoern A. Zeeb
14126c92544dSBjoern A. Zeeb /* submit all clc config */
14136c92544dSBjoern A. Zeeb for (i = 0; i < ARRAY_SIZE(phy->clc); i++) {
14146c92544dSBjoern A. Zeeb ret = __mt7921_mcu_set_clc(dev, alpha2, env_cap,
14156c92544dSBjoern A. Zeeb phy->clc[i], i);
14166c92544dSBjoern A. Zeeb
14176c92544dSBjoern A. Zeeb /* If no country found, set "00" as default */
14186c92544dSBjoern A. Zeeb if (ret == -ENOENT)
14196c92544dSBjoern A. Zeeb ret = __mt7921_mcu_set_clc(dev, "00",
14206c92544dSBjoern A. Zeeb ENVIRON_INDOOR,
14216c92544dSBjoern A. Zeeb phy->clc[i], i);
14226c92544dSBjoern A. Zeeb if (ret < 0)
14236c92544dSBjoern A. Zeeb return ret;
14246c92544dSBjoern A. Zeeb }
14256c92544dSBjoern A. Zeeb return 0;
14266c92544dSBjoern A. Zeeb }
1427cbb3ec25SBjoern A. Zeeb
mt7921_mcu_get_temperature(struct mt792x_phy * phy)1428cbb3ec25SBjoern A. Zeeb int mt7921_mcu_get_temperature(struct mt792x_phy *phy)
1429cbb3ec25SBjoern A. Zeeb {
1430cbb3ec25SBjoern A. Zeeb struct mt792x_dev *dev = phy->dev;
1431cbb3ec25SBjoern A. Zeeb struct {
1432cbb3ec25SBjoern A. Zeeb u8 ctrl_id;
1433cbb3ec25SBjoern A. Zeeb u8 action;
1434cbb3ec25SBjoern A. Zeeb u8 band_idx;
1435cbb3ec25SBjoern A. Zeeb u8 rsv[5];
1436cbb3ec25SBjoern A. Zeeb } req = {
1437cbb3ec25SBjoern A. Zeeb .ctrl_id = THERMAL_SENSOR_TEMP_QUERY,
1438cbb3ec25SBjoern A. Zeeb .band_idx = phy->mt76->band_idx,
1439cbb3ec25SBjoern A. Zeeb };
1440cbb3ec25SBjoern A. Zeeb
1441cbb3ec25SBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD(THERMAL_CTRL), &req,
1442cbb3ec25SBjoern A. Zeeb sizeof(req), true);
1443cbb3ec25SBjoern A. Zeeb }
1444cbb3ec25SBjoern A. Zeeb
mt7921_mcu_wf_rf_pin_ctrl(struct mt792x_phy * phy,u8 action)1445*8ba4d145SBjoern A. Zeeb int mt7921_mcu_wf_rf_pin_ctrl(struct mt792x_phy *phy, u8 action)
1446*8ba4d145SBjoern A. Zeeb {
1447*8ba4d145SBjoern A. Zeeb struct mt792x_dev *dev = phy->dev;
1448*8ba4d145SBjoern A. Zeeb struct {
1449*8ba4d145SBjoern A. Zeeb u8 action;
1450*8ba4d145SBjoern A. Zeeb u8 value;
1451*8ba4d145SBjoern A. Zeeb } req = {
1452*8ba4d145SBjoern A. Zeeb .action = action,
1453*8ba4d145SBjoern A. Zeeb .value = 0,
1454*8ba4d145SBjoern A. Zeeb };
1455*8ba4d145SBjoern A. Zeeb
1456*8ba4d145SBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD(WF_RF_PIN_CTRL), &req,
1457*8ba4d145SBjoern A. Zeeb sizeof(req), action ? true : false);
1458*8ba4d145SBjoern A. Zeeb }
1459*8ba4d145SBjoern A. Zeeb
mt7921_mcu_set_rxfilter(struct mt792x_dev * dev,u32 fif,u8 bit_op,u32 bit_map)1460cbb3ec25SBjoern A. Zeeb int mt7921_mcu_set_rxfilter(struct mt792x_dev *dev, u32 fif,
1461cbb3ec25SBjoern A. Zeeb u8 bit_op, u32 bit_map)
1462cbb3ec25SBjoern A. Zeeb {
1463cbb3ec25SBjoern A. Zeeb struct {
1464cbb3ec25SBjoern A. Zeeb u8 rsv[4];
1465cbb3ec25SBjoern A. Zeeb u8 mode;
1466cbb3ec25SBjoern A. Zeeb u8 rsv2[3];
1467cbb3ec25SBjoern A. Zeeb __le32 fif;
1468cbb3ec25SBjoern A. Zeeb __le32 bit_map; /* bit_* for bitmap update */
1469cbb3ec25SBjoern A. Zeeb u8 bit_op;
1470cbb3ec25SBjoern A. Zeeb u8 pad[51];
1471cbb3ec25SBjoern A. Zeeb } __packed data = {
1472cbb3ec25SBjoern A. Zeeb .mode = fif ? 1 : 2,
1473cbb3ec25SBjoern A. Zeeb .fif = cpu_to_le32(fif),
1474cbb3ec25SBjoern A. Zeeb .bit_map = cpu_to_le32(bit_map),
1475cbb3ec25SBjoern A. Zeeb .bit_op = bit_op,
1476cbb3ec25SBjoern A. Zeeb };
1477cbb3ec25SBjoern A. Zeeb
1478cbb3ec25SBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(SET_RX_FILTER),
1479cbb3ec25SBjoern A. Zeeb &data, sizeof(data), false);
1480cbb3ec25SBjoern A. Zeeb }
1481*8ba4d145SBjoern A. Zeeb
mt7921_mcu_set_rssimonitor(struct mt792x_dev * dev,struct ieee80211_vif * vif)1482*8ba4d145SBjoern A. Zeeb int mt7921_mcu_set_rssimonitor(struct mt792x_dev *dev, struct ieee80211_vif *vif)
1483*8ba4d145SBjoern A. Zeeb {
1484*8ba4d145SBjoern A. Zeeb struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv;
1485*8ba4d145SBjoern A. Zeeb struct {
1486*8ba4d145SBjoern A. Zeeb u8 enable;
1487*8ba4d145SBjoern A. Zeeb s8 cqm_rssi_high;
1488*8ba4d145SBjoern A. Zeeb s8 cqm_rssi_low;
1489*8ba4d145SBjoern A. Zeeb u8 bss_idx;
1490*8ba4d145SBjoern A. Zeeb u16 duration;
1491*8ba4d145SBjoern A. Zeeb u8 rsv2[2];
1492*8ba4d145SBjoern A. Zeeb } __packed data = {
1493*8ba4d145SBjoern A. Zeeb .enable = vif->cfg.assoc,
1494*8ba4d145SBjoern A. Zeeb .cqm_rssi_high = vif->bss_conf.cqm_rssi_thold + vif->bss_conf.cqm_rssi_hyst,
1495*8ba4d145SBjoern A. Zeeb .cqm_rssi_low = vif->bss_conf.cqm_rssi_thold - vif->bss_conf.cqm_rssi_hyst,
1496*8ba4d145SBjoern A. Zeeb .bss_idx = mvif->bss_conf.mt76.idx,
1497*8ba4d145SBjoern A. Zeeb };
1498*8ba4d145SBjoern A. Zeeb
1499*8ba4d145SBjoern A. Zeeb return mt76_mcu_send_msg(&dev->mt76, MCU_CE_CMD(RSSI_MONITOR),
1500*8ba4d145SBjoern A. Zeeb &data, sizeof(data), false);
1501*8ba4d145SBjoern A. Zeeb }
1502