xref: /freebsd/sys/contrib/dev/mediatek/mt76/mt7615/main.c (revision cbb3ec25)
16c92544dSBjoern A. Zeeb // SPDX-License-Identifier: ISC
26c92544dSBjoern A. Zeeb /* Copyright (C) 2019 MediaTek Inc.
36c92544dSBjoern A. Zeeb  *
46c92544dSBjoern A. Zeeb  * Author: Roy Luo <royluo@google.com>
56c92544dSBjoern A. Zeeb  *         Ryder Lee <ryder.lee@mediatek.com>
66c92544dSBjoern A. Zeeb  *         Felix Fietkau <nbd@nbd.name>
76c92544dSBjoern A. Zeeb  *         Lorenzo Bianconi <lorenzo@kernel.org>
86c92544dSBjoern A. Zeeb  */
96c92544dSBjoern A. Zeeb 
106c92544dSBjoern A. Zeeb #include <linux/etherdevice.h>
116c92544dSBjoern A. Zeeb #include <linux/module.h>
126c92544dSBjoern A. Zeeb #include "mt7615.h"
136c92544dSBjoern A. Zeeb #include "mcu.h"
146c92544dSBjoern A. Zeeb 
mt7615_dev_running(struct mt7615_dev * dev)156c92544dSBjoern A. Zeeb static bool mt7615_dev_running(struct mt7615_dev *dev)
166c92544dSBjoern A. Zeeb {
176c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy;
186c92544dSBjoern A. Zeeb 
196c92544dSBjoern A. Zeeb 	if (test_bit(MT76_STATE_RUNNING, &dev->mphy.state))
206c92544dSBjoern A. Zeeb 		return true;
216c92544dSBjoern A. Zeeb 
226c92544dSBjoern A. Zeeb 	phy = mt7615_ext_phy(dev);
236c92544dSBjoern A. Zeeb 
246c92544dSBjoern A. Zeeb 	return phy && test_bit(MT76_STATE_RUNNING, &phy->mt76->state);
256c92544dSBjoern A. Zeeb }
266c92544dSBjoern A. Zeeb 
mt7615_start(struct ieee80211_hw * hw)276c92544dSBjoern A. Zeeb static int mt7615_start(struct ieee80211_hw *hw)
286c92544dSBjoern A. Zeeb {
296c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
306c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
316c92544dSBjoern A. Zeeb 	unsigned long timeout;
326c92544dSBjoern A. Zeeb 	bool running;
336c92544dSBjoern A. Zeeb 	int ret;
346c92544dSBjoern A. Zeeb 
356c92544dSBjoern A. Zeeb 	if (!mt7615_wait_for_mcu_init(dev))
366c92544dSBjoern A. Zeeb 		return -EIO;
376c92544dSBjoern A. Zeeb 
386c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
396c92544dSBjoern A. Zeeb 
406c92544dSBjoern A. Zeeb 	running = mt7615_dev_running(dev);
416c92544dSBjoern A. Zeeb 
426c92544dSBjoern A. Zeeb 	if (!running) {
436c92544dSBjoern A. Zeeb 		ret = mt7615_mcu_set_pm(dev, 0, 0);
446c92544dSBjoern A. Zeeb 		if (ret)
456c92544dSBjoern A. Zeeb 			goto out;
466c92544dSBjoern A. Zeeb 
476c92544dSBjoern A. Zeeb 		ret = mt76_connac_mcu_set_mac_enable(&dev->mt76, 0, true, false);
486c92544dSBjoern A. Zeeb 		if (ret)
496c92544dSBjoern A. Zeeb 			goto out;
506c92544dSBjoern A. Zeeb 
516c92544dSBjoern A. Zeeb 		mt7615_mac_enable_nf(dev, 0);
526c92544dSBjoern A. Zeeb 	}
536c92544dSBjoern A. Zeeb 
546c92544dSBjoern A. Zeeb 	if (phy != &dev->phy) {
556c92544dSBjoern A. Zeeb 		ret = mt7615_mcu_set_pm(dev, 1, 0);
566c92544dSBjoern A. Zeeb 		if (ret)
576c92544dSBjoern A. Zeeb 			goto out;
586c92544dSBjoern A. Zeeb 
596c92544dSBjoern A. Zeeb 		ret = mt76_connac_mcu_set_mac_enable(&dev->mt76, 1, true, false);
606c92544dSBjoern A. Zeeb 		if (ret)
616c92544dSBjoern A. Zeeb 			goto out;
626c92544dSBjoern A. Zeeb 
636c92544dSBjoern A. Zeeb 		mt7615_mac_enable_nf(dev, 1);
646c92544dSBjoern A. Zeeb 	}
656c92544dSBjoern A. Zeeb 
666c92544dSBjoern A. Zeeb 	if (mt7615_firmware_offload(dev)) {
676c92544dSBjoern A. Zeeb 		ret = mt76_connac_mcu_set_channel_domain(phy->mt76);
686c92544dSBjoern A. Zeeb 		if (ret)
696c92544dSBjoern A. Zeeb 			goto out;
706c92544dSBjoern A. Zeeb 
716c92544dSBjoern A. Zeeb 		ret = mt76_connac_mcu_set_rate_txpower(phy->mt76);
726c92544dSBjoern A. Zeeb 		if (ret)
736c92544dSBjoern A. Zeeb 			goto out;
746c92544dSBjoern A. Zeeb 	}
756c92544dSBjoern A. Zeeb 
766c92544dSBjoern A. Zeeb 	ret = mt7615_mcu_set_chan_info(phy, MCU_EXT_CMD(SET_RX_PATH));
776c92544dSBjoern A. Zeeb 	if (ret)
786c92544dSBjoern A. Zeeb 		goto out;
796c92544dSBjoern A. Zeeb 
806c92544dSBjoern A. Zeeb 	set_bit(MT76_STATE_RUNNING, &phy->mt76->state);
816c92544dSBjoern A. Zeeb 
826c92544dSBjoern A. Zeeb 	timeout = mt7615_get_macwork_timeout(dev);
836c92544dSBjoern A. Zeeb 	ieee80211_queue_delayed_work(hw, &phy->mt76->mac_work, timeout);
846c92544dSBjoern A. Zeeb 
856c92544dSBjoern A. Zeeb 	if (!running)
86cbb3ec25SBjoern A. Zeeb 		mt7615_mac_reset_counters(phy);
876c92544dSBjoern A. Zeeb 
886c92544dSBjoern A. Zeeb out:
896c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
906c92544dSBjoern A. Zeeb 
916c92544dSBjoern A. Zeeb 	return ret;
926c92544dSBjoern A. Zeeb }
936c92544dSBjoern A. Zeeb 
mt7615_stop(struct ieee80211_hw * hw)946c92544dSBjoern A. Zeeb static void mt7615_stop(struct ieee80211_hw *hw)
956c92544dSBjoern A. Zeeb {
966c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
976c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
986c92544dSBjoern A. Zeeb 
996c92544dSBjoern A. Zeeb 	cancel_delayed_work_sync(&phy->mt76->mac_work);
1006c92544dSBjoern A. Zeeb 	del_timer_sync(&phy->roc_timer);
1016c92544dSBjoern A. Zeeb 	cancel_work_sync(&phy->roc_work);
1026c92544dSBjoern A. Zeeb 
1036c92544dSBjoern A. Zeeb 	cancel_delayed_work_sync(&dev->pm.ps_work);
1046c92544dSBjoern A. Zeeb 	cancel_work_sync(&dev->pm.wake_work);
1056c92544dSBjoern A. Zeeb 
1066c92544dSBjoern A. Zeeb 	mt76_connac_free_pending_tx_skbs(&dev->pm, NULL);
1076c92544dSBjoern A. Zeeb 
1086c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
1096c92544dSBjoern A. Zeeb 
1106c92544dSBjoern A. Zeeb 	mt76_testmode_reset(phy->mt76, true);
1116c92544dSBjoern A. Zeeb 
1126c92544dSBjoern A. Zeeb 	clear_bit(MT76_STATE_RUNNING, &phy->mt76->state);
1136c92544dSBjoern A. Zeeb 	cancel_delayed_work_sync(&phy->scan_work);
1146c92544dSBjoern A. Zeeb 
1156c92544dSBjoern A. Zeeb 	if (phy != &dev->phy) {
1166c92544dSBjoern A. Zeeb 		mt7615_mcu_set_pm(dev, 1, 1);
1176c92544dSBjoern A. Zeeb 		mt76_connac_mcu_set_mac_enable(&dev->mt76, 1, false, false);
1186c92544dSBjoern A. Zeeb 	}
1196c92544dSBjoern A. Zeeb 
1206c92544dSBjoern A. Zeeb 	if (!mt7615_dev_running(dev)) {
1216c92544dSBjoern A. Zeeb 		mt7615_mcu_set_pm(dev, 0, 1);
1226c92544dSBjoern A. Zeeb 		mt76_connac_mcu_set_mac_enable(&dev->mt76, 0, false, false);
1236c92544dSBjoern A. Zeeb 	}
1246c92544dSBjoern A. Zeeb 
1256c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
1266c92544dSBjoern A. Zeeb }
1276c92544dSBjoern A. Zeeb 
get_free_idx(u32 mask,u8 start,u8 end)1286c92544dSBjoern A. Zeeb static inline int get_free_idx(u32 mask, u8 start, u8 end)
1296c92544dSBjoern A. Zeeb {
1306c92544dSBjoern A. Zeeb 	return ffs(~mask & GENMASK(end, start));
1316c92544dSBjoern A. Zeeb }
1326c92544dSBjoern A. Zeeb 
get_omac_idx(enum nl80211_iftype type,u64 mask)1336c92544dSBjoern A. Zeeb static int get_omac_idx(enum nl80211_iftype type, u64 mask)
1346c92544dSBjoern A. Zeeb {
1356c92544dSBjoern A. Zeeb 	int i;
1366c92544dSBjoern A. Zeeb 
1376c92544dSBjoern A. Zeeb 	switch (type) {
1386c92544dSBjoern A. Zeeb 	case NL80211_IFTYPE_STATION:
1396c92544dSBjoern A. Zeeb 		/* prefer hw bssid slot 1-3 */
1406c92544dSBjoern A. Zeeb 		i = get_free_idx(mask, HW_BSSID_1, HW_BSSID_3);
1416c92544dSBjoern A. Zeeb 		if (i)
1426c92544dSBjoern A. Zeeb 			return i - 1;
1436c92544dSBjoern A. Zeeb 
1446c92544dSBjoern A. Zeeb 		/* next, try to find a free repeater entry for the sta */
1456c92544dSBjoern A. Zeeb 		i = get_free_idx(mask >> REPEATER_BSSID_START, 0,
1466c92544dSBjoern A. Zeeb 				 REPEATER_BSSID_MAX - REPEATER_BSSID_START);
1476c92544dSBjoern A. Zeeb 		if (i)
1486c92544dSBjoern A. Zeeb 			return i + 32 - 1;
1496c92544dSBjoern A. Zeeb 
1506c92544dSBjoern A. Zeeb 		i = get_free_idx(mask, EXT_BSSID_1, EXT_BSSID_MAX);
1516c92544dSBjoern A. Zeeb 		if (i)
1526c92544dSBjoern A. Zeeb 			return i - 1;
1536c92544dSBjoern A. Zeeb 
1546c92544dSBjoern A. Zeeb 		if (~mask & BIT(HW_BSSID_0))
1556c92544dSBjoern A. Zeeb 			return HW_BSSID_0;
1566c92544dSBjoern A. Zeeb 
1576c92544dSBjoern A. Zeeb 		break;
1586c92544dSBjoern A. Zeeb 	case NL80211_IFTYPE_ADHOC:
1596c92544dSBjoern A. Zeeb 	case NL80211_IFTYPE_MESH_POINT:
1606c92544dSBjoern A. Zeeb 	case NL80211_IFTYPE_MONITOR:
1616c92544dSBjoern A. Zeeb 	case NL80211_IFTYPE_AP:
1626c92544dSBjoern A. Zeeb 		/* ap uses hw bssid 0 and ext bssid */
1636c92544dSBjoern A. Zeeb 		if (~mask & BIT(HW_BSSID_0))
1646c92544dSBjoern A. Zeeb 			return HW_BSSID_0;
1656c92544dSBjoern A. Zeeb 
1666c92544dSBjoern A. Zeeb 		i = get_free_idx(mask, EXT_BSSID_1, EXT_BSSID_MAX);
1676c92544dSBjoern A. Zeeb 		if (i)
1686c92544dSBjoern A. Zeeb 			return i - 1;
1696c92544dSBjoern A. Zeeb 
1706c92544dSBjoern A. Zeeb 		break;
1716c92544dSBjoern A. Zeeb 	default:
1726c92544dSBjoern A. Zeeb 		WARN_ON(1);
1736c92544dSBjoern A. Zeeb 		break;
1746c92544dSBjoern A. Zeeb 	}
1756c92544dSBjoern A. Zeeb 
1766c92544dSBjoern A. Zeeb 	return -1;
1776c92544dSBjoern A. Zeeb }
1786c92544dSBjoern A. Zeeb 
mt7615_add_interface(struct ieee80211_hw * hw,struct ieee80211_vif * vif)1796c92544dSBjoern A. Zeeb static int mt7615_add_interface(struct ieee80211_hw *hw,
1806c92544dSBjoern A. Zeeb 				struct ieee80211_vif *vif)
1816c92544dSBjoern A. Zeeb {
1826c92544dSBjoern A. Zeeb 	struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
1836c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
1846c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
1856c92544dSBjoern A. Zeeb 	struct mt76_txq *mtxq;
1866c92544dSBjoern A. Zeeb 	bool ext_phy = phy != &dev->phy;
1876c92544dSBjoern A. Zeeb 	int idx, ret = 0;
1886c92544dSBjoern A. Zeeb 
1896c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
1906c92544dSBjoern A. Zeeb 
1916c92544dSBjoern A. Zeeb 	mt76_testmode_reset(phy->mt76, true);
1926c92544dSBjoern A. Zeeb 
1936c92544dSBjoern A. Zeeb 	if (vif->type == NL80211_IFTYPE_MONITOR &&
1946c92544dSBjoern A. Zeeb 	    is_zero_ether_addr(vif->addr))
1956c92544dSBjoern A. Zeeb 		phy->monitor_vif = vif;
1966c92544dSBjoern A. Zeeb 
1976c92544dSBjoern A. Zeeb 	mvif->mt76.idx = __ffs64(~dev->mt76.vif_mask);
1986c92544dSBjoern A. Zeeb 	if (mvif->mt76.idx >= MT7615_MAX_INTERFACES) {
1996c92544dSBjoern A. Zeeb 		ret = -ENOSPC;
2006c92544dSBjoern A. Zeeb 		goto out;
2016c92544dSBjoern A. Zeeb 	}
2026c92544dSBjoern A. Zeeb 
2036c92544dSBjoern A. Zeeb 	idx = get_omac_idx(vif->type, dev->omac_mask);
2046c92544dSBjoern A. Zeeb 	if (idx < 0) {
2056c92544dSBjoern A. Zeeb 		ret = -ENOSPC;
2066c92544dSBjoern A. Zeeb 		goto out;
2076c92544dSBjoern A. Zeeb 	}
2086c92544dSBjoern A. Zeeb 	mvif->mt76.omac_idx = idx;
2096c92544dSBjoern A. Zeeb 
2106c92544dSBjoern A. Zeeb 	mvif->mt76.band_idx = ext_phy;
2116c92544dSBjoern A. Zeeb 	mvif->mt76.wmm_idx = vif->type != NL80211_IFTYPE_AP;
2126c92544dSBjoern A. Zeeb 	if (ext_phy)
2136c92544dSBjoern A. Zeeb 		mvif->mt76.wmm_idx += 2;
2146c92544dSBjoern A. Zeeb 
2156c92544dSBjoern A. Zeeb 	dev->mt76.vif_mask |= BIT_ULL(mvif->mt76.idx);
2166c92544dSBjoern A. Zeeb 	dev->omac_mask |= BIT_ULL(mvif->mt76.omac_idx);
2176c92544dSBjoern A. Zeeb 	phy->omac_mask |= BIT_ULL(mvif->mt76.omac_idx);
2186c92544dSBjoern A. Zeeb 
2196c92544dSBjoern A. Zeeb 	ret = mt7615_mcu_set_dbdc(dev);
2206c92544dSBjoern A. Zeeb 	if (ret)
2216c92544dSBjoern A. Zeeb 		goto out;
2226c92544dSBjoern A. Zeeb 
2236c92544dSBjoern A. Zeeb 	idx = MT7615_WTBL_RESERVED - mvif->mt76.idx;
2246c92544dSBjoern A. Zeeb 
225cbb3ec25SBjoern A. Zeeb 	INIT_LIST_HEAD(&mvif->sta.wcid.poll_list);
2266c92544dSBjoern A. Zeeb 	mvif->sta.wcid.idx = idx;
2276c92544dSBjoern A. Zeeb 	mvif->sta.wcid.phy_idx = mvif->mt76.band_idx;
2286c92544dSBjoern A. Zeeb 	mvif->sta.wcid.hw_key_idx = -1;
2296c92544dSBjoern A. Zeeb 	mt76_packet_id_init(&mvif->sta.wcid);
2306c92544dSBjoern A. Zeeb 
2316c92544dSBjoern A. Zeeb 	mt7615_mac_wtbl_update(dev, idx,
2326c92544dSBjoern A. Zeeb 			       MT_WTBL_UPDATE_ADM_COUNT_CLEAR);
2336c92544dSBjoern A. Zeeb 
2346c92544dSBjoern A. Zeeb 	rcu_assign_pointer(dev->mt76.wcid[idx], &mvif->sta.wcid);
2356c92544dSBjoern A. Zeeb 	if (vif->txq) {
2366c92544dSBjoern A. Zeeb 		mtxq = (struct mt76_txq *)vif->txq->drv_priv;
2376c92544dSBjoern A. Zeeb 		mtxq->wcid = idx;
2386c92544dSBjoern A. Zeeb 	}
2396c92544dSBjoern A. Zeeb 
2406c92544dSBjoern A. Zeeb 	ret = mt7615_mcu_add_dev_info(phy, vif, true);
2416c92544dSBjoern A. Zeeb out:
2426c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
2436c92544dSBjoern A. Zeeb 
2446c92544dSBjoern A. Zeeb 	return ret;
2456c92544dSBjoern A. Zeeb }
2466c92544dSBjoern A. Zeeb 
mt7615_remove_interface(struct ieee80211_hw * hw,struct ieee80211_vif * vif)2476c92544dSBjoern A. Zeeb static void mt7615_remove_interface(struct ieee80211_hw *hw,
2486c92544dSBjoern A. Zeeb 				    struct ieee80211_vif *vif)
2496c92544dSBjoern A. Zeeb {
2506c92544dSBjoern A. Zeeb 	struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
2516c92544dSBjoern A. Zeeb 	struct mt7615_sta *msta = &mvif->sta;
2526c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
2536c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
2546c92544dSBjoern A. Zeeb 	int idx = msta->wcid.idx;
2556c92544dSBjoern A. Zeeb 
2566c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
2576c92544dSBjoern A. Zeeb 
2586c92544dSBjoern A. Zeeb 	mt7615_mcu_add_bss_info(phy, vif, NULL, false);
2596c92544dSBjoern A. Zeeb 	mt7615_mcu_sta_add(phy, vif, NULL, false);
2606c92544dSBjoern A. Zeeb 
2616c92544dSBjoern A. Zeeb 	mt76_testmode_reset(phy->mt76, true);
2626c92544dSBjoern A. Zeeb 	if (vif == phy->monitor_vif)
2636c92544dSBjoern A. Zeeb 	    phy->monitor_vif = NULL;
2646c92544dSBjoern A. Zeeb 
2656c92544dSBjoern A. Zeeb 	mt76_connac_free_pending_tx_skbs(&dev->pm, &msta->wcid);
2666c92544dSBjoern A. Zeeb 
2676c92544dSBjoern A. Zeeb 	mt7615_mcu_add_dev_info(phy, vif, false);
2686c92544dSBjoern A. Zeeb 
2696c92544dSBjoern A. Zeeb 	rcu_assign_pointer(dev->mt76.wcid[idx], NULL);
2706c92544dSBjoern A. Zeeb 
2716c92544dSBjoern A. Zeeb 	dev->mt76.vif_mask &= ~BIT_ULL(mvif->mt76.idx);
2726c92544dSBjoern A. Zeeb 	dev->omac_mask &= ~BIT_ULL(mvif->mt76.omac_idx);
2736c92544dSBjoern A. Zeeb 	phy->omac_mask &= ~BIT_ULL(mvif->mt76.omac_idx);
2746c92544dSBjoern A. Zeeb 
2756c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
2766c92544dSBjoern A. Zeeb 
277cbb3ec25SBjoern A. Zeeb 	spin_lock_bh(&dev->mt76.sta_poll_lock);
278cbb3ec25SBjoern A. Zeeb 	if (!list_empty(&msta->wcid.poll_list))
279cbb3ec25SBjoern A. Zeeb 		list_del_init(&msta->wcid.poll_list);
280cbb3ec25SBjoern A. Zeeb 	spin_unlock_bh(&dev->mt76.sta_poll_lock);
2816c92544dSBjoern A. Zeeb 
2826c92544dSBjoern A. Zeeb 	mt76_packet_id_flush(&dev->mt76, &mvif->sta.wcid);
2836c92544dSBjoern A. Zeeb }
2846c92544dSBjoern A. Zeeb 
mt7615_set_channel(struct mt7615_phy * phy)2856c92544dSBjoern A. Zeeb int mt7615_set_channel(struct mt7615_phy *phy)
2866c92544dSBjoern A. Zeeb {
2876c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = phy->dev;
2886c92544dSBjoern A. Zeeb 	bool ext_phy = phy != &dev->phy;
2896c92544dSBjoern A. Zeeb 	int ret;
2906c92544dSBjoern A. Zeeb 
2916c92544dSBjoern A. Zeeb 	cancel_delayed_work_sync(&phy->mt76->mac_work);
2926c92544dSBjoern A. Zeeb 
2936c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
2946c92544dSBjoern A. Zeeb 
2956c92544dSBjoern A. Zeeb 	set_bit(MT76_RESET, &phy->mt76->state);
2966c92544dSBjoern A. Zeeb 
2976c92544dSBjoern A. Zeeb 	mt76_set_channel(phy->mt76);
2986c92544dSBjoern A. Zeeb 
2996c92544dSBjoern A. Zeeb 	if (is_mt7615(&dev->mt76) && dev->flash_eeprom) {
3006c92544dSBjoern A. Zeeb 		ret = mt7615_mcu_apply_rx_dcoc(phy);
3016c92544dSBjoern A. Zeeb 		if (ret)
3026c92544dSBjoern A. Zeeb 			goto out;
3036c92544dSBjoern A. Zeeb 
3046c92544dSBjoern A. Zeeb 		ret = mt7615_mcu_apply_tx_dpd(phy);
3056c92544dSBjoern A. Zeeb 		if (ret)
3066c92544dSBjoern A. Zeeb 			goto out;
3076c92544dSBjoern A. Zeeb 	}
3086c92544dSBjoern A. Zeeb 
3096c92544dSBjoern A. Zeeb 	ret = mt7615_mcu_set_chan_info(phy, MCU_EXT_CMD(CHANNEL_SWITCH));
3106c92544dSBjoern A. Zeeb 	if (ret)
3116c92544dSBjoern A. Zeeb 		goto out;
3126c92544dSBjoern A. Zeeb 
3136c92544dSBjoern A. Zeeb 	mt7615_mac_set_timing(phy);
3146c92544dSBjoern A. Zeeb 	ret = mt7615_dfs_init_radar_detector(phy);
3156c92544dSBjoern A. Zeeb 	if (ret)
3166c92544dSBjoern A. Zeeb 		goto out;
3176c92544dSBjoern A. Zeeb 
3186c92544dSBjoern A. Zeeb 	mt7615_mac_cca_stats_reset(phy);
3196c92544dSBjoern A. Zeeb 	ret = mt7615_mcu_set_sku_en(phy, true);
3206c92544dSBjoern A. Zeeb 	if (ret)
3216c92544dSBjoern A. Zeeb 		goto out;
3226c92544dSBjoern A. Zeeb 
323cbb3ec25SBjoern A. Zeeb 	mt7615_mac_reset_counters(phy);
3246c92544dSBjoern A. Zeeb 	phy->noise = 0;
3256c92544dSBjoern A. Zeeb 	phy->chfreq = mt76_rr(dev, MT_CHFREQ(ext_phy));
3266c92544dSBjoern A. Zeeb 
3276c92544dSBjoern A. Zeeb out:
3286c92544dSBjoern A. Zeeb 	clear_bit(MT76_RESET, &phy->mt76->state);
3296c92544dSBjoern A. Zeeb 
3306c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
3316c92544dSBjoern A. Zeeb 
3326c92544dSBjoern A. Zeeb 	mt76_worker_schedule(&dev->mt76.tx_worker);
3336c92544dSBjoern A. Zeeb 	if (!mt76_testmode_enabled(phy->mt76)) {
3346c92544dSBjoern A. Zeeb 		unsigned long timeout = mt7615_get_macwork_timeout(dev);
3356c92544dSBjoern A. Zeeb 
3366c92544dSBjoern A. Zeeb 		ieee80211_queue_delayed_work(phy->mt76->hw,
3376c92544dSBjoern A. Zeeb 					     &phy->mt76->mac_work, timeout);
3386c92544dSBjoern A. Zeeb 	}
3396c92544dSBjoern A. Zeeb 
3406c92544dSBjoern A. Zeeb 	return ret;
3416c92544dSBjoern A. Zeeb }
3426c92544dSBjoern A. Zeeb 
mt7615_set_key(struct ieee80211_hw * hw,enum set_key_cmd cmd,struct ieee80211_vif * vif,struct ieee80211_sta * sta,struct ieee80211_key_conf * key)3436c92544dSBjoern A. Zeeb static int mt7615_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
3446c92544dSBjoern A. Zeeb 			  struct ieee80211_vif *vif, struct ieee80211_sta *sta,
3456c92544dSBjoern A. Zeeb 			  struct ieee80211_key_conf *key)
3466c92544dSBjoern A. Zeeb {
3476c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
3486c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
3496c92544dSBjoern A. Zeeb 	struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
3506c92544dSBjoern A. Zeeb 	struct mt7615_sta *msta = sta ? (struct mt7615_sta *)sta->drv_priv :
3516c92544dSBjoern A. Zeeb 				  &mvif->sta;
3526c92544dSBjoern A. Zeeb 	struct mt76_wcid *wcid = &msta->wcid;
3536c92544dSBjoern A. Zeeb 	int idx = key->keyidx, err = 0;
3546c92544dSBjoern A. Zeeb 	u8 *wcid_keyidx = &wcid->hw_key_idx;
3556c92544dSBjoern A. Zeeb 
3566c92544dSBjoern A. Zeeb 	/* The hardware does not support per-STA RX GTK, fallback
3576c92544dSBjoern A. Zeeb 	 * to software mode for these.
3586c92544dSBjoern A. Zeeb 	 */
3596c92544dSBjoern A. Zeeb 	if ((vif->type == NL80211_IFTYPE_ADHOC ||
3606c92544dSBjoern A. Zeeb 	     vif->type == NL80211_IFTYPE_MESH_POINT) &&
3616c92544dSBjoern A. Zeeb 	    (key->cipher == WLAN_CIPHER_SUITE_TKIP ||
3626c92544dSBjoern A. Zeeb 	     key->cipher == WLAN_CIPHER_SUITE_CCMP) &&
3636c92544dSBjoern A. Zeeb 	    !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE))
3646c92544dSBjoern A. Zeeb 		return -EOPNOTSUPP;
3656c92544dSBjoern A. Zeeb 
3666c92544dSBjoern A. Zeeb 	/* fall back to sw encryption for unsupported ciphers */
3676c92544dSBjoern A. Zeeb 	switch (key->cipher) {
3686c92544dSBjoern A. Zeeb 	case WLAN_CIPHER_SUITE_AES_CMAC:
3696c92544dSBjoern A. Zeeb 		wcid_keyidx = &wcid->hw_key_idx2;
3706c92544dSBjoern A. Zeeb 		key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIE;
3716c92544dSBjoern A. Zeeb 		break;
3726c92544dSBjoern A. Zeeb 	case WLAN_CIPHER_SUITE_TKIP:
3736c92544dSBjoern A. Zeeb 	case WLAN_CIPHER_SUITE_CCMP:
3746c92544dSBjoern A. Zeeb 	case WLAN_CIPHER_SUITE_CCMP_256:
3756c92544dSBjoern A. Zeeb 	case WLAN_CIPHER_SUITE_GCMP:
3766c92544dSBjoern A. Zeeb 	case WLAN_CIPHER_SUITE_GCMP_256:
3776c92544dSBjoern A. Zeeb 	case WLAN_CIPHER_SUITE_SMS4:
3786c92544dSBjoern A. Zeeb 		break;
3796c92544dSBjoern A. Zeeb 	case WLAN_CIPHER_SUITE_WEP40:
3806c92544dSBjoern A. Zeeb 	case WLAN_CIPHER_SUITE_WEP104:
3816c92544dSBjoern A. Zeeb 	default:
3826c92544dSBjoern A. Zeeb 		return -EOPNOTSUPP;
3836c92544dSBjoern A. Zeeb 	}
3846c92544dSBjoern A. Zeeb 
3856c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
3866c92544dSBjoern A. Zeeb 
3876c92544dSBjoern A. Zeeb 	if (cmd == SET_KEY && !sta && !mvif->mt76.cipher) {
3886c92544dSBjoern A. Zeeb 		mvif->mt76.cipher = mt76_connac_mcu_get_cipher(key->cipher);
3896c92544dSBjoern A. Zeeb 		mt7615_mcu_add_bss_info(phy, vif, NULL, true);
3906c92544dSBjoern A. Zeeb 	}
3916c92544dSBjoern A. Zeeb 
3926c92544dSBjoern A. Zeeb 	if (cmd == SET_KEY)
3936c92544dSBjoern A. Zeeb 		*wcid_keyidx = idx;
394cbb3ec25SBjoern A. Zeeb 	else {
395cbb3ec25SBjoern A. Zeeb 		if (idx == *wcid_keyidx)
3966c92544dSBjoern A. Zeeb 			*wcid_keyidx = -1;
3976c92544dSBjoern A. Zeeb 		goto out;
398cbb3ec25SBjoern A. Zeeb 	}
3996c92544dSBjoern A. Zeeb 
400cbb3ec25SBjoern A. Zeeb 	mt76_wcid_key_setup(&dev->mt76, wcid, key);
4016c92544dSBjoern A. Zeeb 	if (mt76_is_mmio(&dev->mt76))
402cbb3ec25SBjoern A. Zeeb 		err = mt7615_mac_wtbl_set_key(dev, wcid, key);
4036c92544dSBjoern A. Zeeb 	else
404cbb3ec25SBjoern A. Zeeb 		err = __mt7615_mac_wtbl_set_key(dev, wcid, key);
4056c92544dSBjoern A. Zeeb 
4066c92544dSBjoern A. Zeeb out:
4076c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
4086c92544dSBjoern A. Zeeb 
4096c92544dSBjoern A. Zeeb 	return err;
4106c92544dSBjoern A. Zeeb }
4116c92544dSBjoern A. Zeeb 
mt7615_set_sar_specs(struct ieee80211_hw * hw,const struct cfg80211_sar_specs * sar)4126c92544dSBjoern A. Zeeb static int mt7615_set_sar_specs(struct ieee80211_hw *hw,
4136c92544dSBjoern A. Zeeb 				const struct cfg80211_sar_specs *sar)
4146c92544dSBjoern A. Zeeb {
4156c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
4166c92544dSBjoern A. Zeeb 	int err;
4176c92544dSBjoern A. Zeeb 
4186c92544dSBjoern A. Zeeb 	if (!cfg80211_chandef_valid(&phy->mt76->chandef))
4196c92544dSBjoern A. Zeeb 		return -EINVAL;
4206c92544dSBjoern A. Zeeb 
4216c92544dSBjoern A. Zeeb 	err = mt76_init_sar_power(hw, sar);
4226c92544dSBjoern A. Zeeb 	if (err)
4236c92544dSBjoern A. Zeeb 		return err;
4246c92544dSBjoern A. Zeeb 
4256c92544dSBjoern A. Zeeb 	if (mt7615_firmware_offload(phy->dev))
4266c92544dSBjoern A. Zeeb 		return mt76_connac_mcu_set_rate_txpower(phy->mt76);
4276c92544dSBjoern A. Zeeb 
4286c92544dSBjoern A. Zeeb 	ieee80211_stop_queues(hw);
4296c92544dSBjoern A. Zeeb 	err = mt7615_set_channel(phy);
4306c92544dSBjoern A. Zeeb 	ieee80211_wake_queues(hw);
4316c92544dSBjoern A. Zeeb 
4326c92544dSBjoern A. Zeeb 	return err;
4336c92544dSBjoern A. Zeeb }
4346c92544dSBjoern A. Zeeb 
mt7615_config(struct ieee80211_hw * hw,u32 changed)4356c92544dSBjoern A. Zeeb static int mt7615_config(struct ieee80211_hw *hw, u32 changed)
4366c92544dSBjoern A. Zeeb {
4376c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
4386c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
4396c92544dSBjoern A. Zeeb 	bool band = phy != &dev->phy;
4406c92544dSBjoern A. Zeeb 	int ret = 0;
4416c92544dSBjoern A. Zeeb 
4426c92544dSBjoern A. Zeeb 	if (changed & (IEEE80211_CONF_CHANGE_CHANNEL |
4436c92544dSBjoern A. Zeeb 		       IEEE80211_CONF_CHANGE_POWER)) {
4446c92544dSBjoern A. Zeeb #ifdef CONFIG_NL80211_TESTMODE
4456c92544dSBjoern A. Zeeb 		if (phy->mt76->test.state != MT76_TM_STATE_OFF) {
4466c92544dSBjoern A. Zeeb 			mt7615_mutex_acquire(dev);
4476c92544dSBjoern A. Zeeb 			mt76_testmode_reset(phy->mt76, false);
4486c92544dSBjoern A. Zeeb 			mt7615_mutex_release(dev);
4496c92544dSBjoern A. Zeeb 		}
4506c92544dSBjoern A. Zeeb #endif
4516c92544dSBjoern A. Zeeb 		ieee80211_stop_queues(hw);
4526c92544dSBjoern A. Zeeb 		ret = mt7615_set_channel(phy);
4536c92544dSBjoern A. Zeeb 		ieee80211_wake_queues(hw);
4546c92544dSBjoern A. Zeeb 	}
4556c92544dSBjoern A. Zeeb 
4566c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
4576c92544dSBjoern A. Zeeb 
4586c92544dSBjoern A. Zeeb 	if (changed & IEEE80211_CONF_CHANGE_MONITOR) {
4596c92544dSBjoern A. Zeeb 		mt76_testmode_reset(phy->mt76, true);
4606c92544dSBjoern A. Zeeb 
4616c92544dSBjoern A. Zeeb 		if (!(hw->conf.flags & IEEE80211_CONF_MONITOR))
4626c92544dSBjoern A. Zeeb 			phy->rxfilter |= MT_WF_RFCR_DROP_OTHER_UC;
4636c92544dSBjoern A. Zeeb 		else
4646c92544dSBjoern A. Zeeb 			phy->rxfilter &= ~MT_WF_RFCR_DROP_OTHER_UC;
4656c92544dSBjoern A. Zeeb 
4666c92544dSBjoern A. Zeeb 		mt76_wr(dev, MT_WF_RFCR(band), phy->rxfilter);
4676c92544dSBjoern A. Zeeb 	}
4686c92544dSBjoern A. Zeeb 
4696c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
4706c92544dSBjoern A. Zeeb 
4716c92544dSBjoern A. Zeeb 	return ret;
4726c92544dSBjoern A. Zeeb }
4736c92544dSBjoern A. Zeeb 
4746c92544dSBjoern A. Zeeb static int
mt7615_conf_tx(struct ieee80211_hw * hw,struct ieee80211_vif * vif,unsigned int link_id,u16 queue,const struct ieee80211_tx_queue_params * params)4756c92544dSBjoern A. Zeeb mt7615_conf_tx(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
4766c92544dSBjoern A. Zeeb 	       unsigned int link_id, u16 queue,
4776c92544dSBjoern A. Zeeb 	       const struct ieee80211_tx_queue_params *params)
4786c92544dSBjoern A. Zeeb {
4796c92544dSBjoern A. Zeeb 	struct mt76_vif *mvif = (struct mt76_vif *)vif->drv_priv;
4806c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
4816c92544dSBjoern A. Zeeb 	int err;
4826c92544dSBjoern A. Zeeb 
4836c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
4846c92544dSBjoern A. Zeeb 
4856c92544dSBjoern A. Zeeb 	queue = mt7615_lmac_mapping(dev, queue);
4866c92544dSBjoern A. Zeeb 	queue += mvif->wmm_idx * MT7615_MAX_WMM_SETS;
4876c92544dSBjoern A. Zeeb 	err = mt7615_mcu_set_wmm(dev, queue, params);
4886c92544dSBjoern A. Zeeb 
4896c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
4906c92544dSBjoern A. Zeeb 
4916c92544dSBjoern A. Zeeb 	return err;
4926c92544dSBjoern A. Zeeb }
4936c92544dSBjoern A. Zeeb 
mt7615_configure_filter(struct ieee80211_hw * hw,unsigned int changed_flags,unsigned int * total_flags,u64 multicast)4946c92544dSBjoern A. Zeeb static void mt7615_configure_filter(struct ieee80211_hw *hw,
4956c92544dSBjoern A. Zeeb 				    unsigned int changed_flags,
4966c92544dSBjoern A. Zeeb 				    unsigned int *total_flags,
4976c92544dSBjoern A. Zeeb 				    u64 multicast)
4986c92544dSBjoern A. Zeeb {
4996c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
5006c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
5016c92544dSBjoern A. Zeeb 	bool band = phy != &dev->phy;
5026c92544dSBjoern A. Zeeb 
5036c92544dSBjoern A. Zeeb 	u32 ctl_flags = MT_WF_RFCR1_DROP_ACK |
5046c92544dSBjoern A. Zeeb 			MT_WF_RFCR1_DROP_BF_POLL |
5056c92544dSBjoern A. Zeeb 			MT_WF_RFCR1_DROP_BA |
5066c92544dSBjoern A. Zeeb 			MT_WF_RFCR1_DROP_CFEND |
5076c92544dSBjoern A. Zeeb 			MT_WF_RFCR1_DROP_CFACK;
5086c92544dSBjoern A. Zeeb 	u32 flags = 0;
5096c92544dSBjoern A. Zeeb 
5106c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
5116c92544dSBjoern A. Zeeb 
5126c92544dSBjoern A. Zeeb #define MT76_FILTER(_flag, _hw) do { \
5136c92544dSBjoern A. Zeeb 		flags |= *total_flags & FIF_##_flag;			\
5146c92544dSBjoern A. Zeeb 		phy->rxfilter &= ~(_hw);				\
5156c92544dSBjoern A. Zeeb 		if (!mt76_testmode_enabled(phy->mt76))			\
5166c92544dSBjoern A. Zeeb 			phy->rxfilter |= !(flags & FIF_##_flag) * (_hw);\
5176c92544dSBjoern A. Zeeb 	} while (0)
5186c92544dSBjoern A. Zeeb 
5196c92544dSBjoern A. Zeeb 	phy->rxfilter &= ~(MT_WF_RFCR_DROP_OTHER_BSS |
5206c92544dSBjoern A. Zeeb 			   MT_WF_RFCR_DROP_FRAME_REPORT |
5216c92544dSBjoern A. Zeeb 			   MT_WF_RFCR_DROP_PROBEREQ |
5226c92544dSBjoern A. Zeeb 			   MT_WF_RFCR_DROP_MCAST_FILTERED |
5236c92544dSBjoern A. Zeeb 			   MT_WF_RFCR_DROP_MCAST |
5246c92544dSBjoern A. Zeeb 			   MT_WF_RFCR_DROP_BCAST |
5256c92544dSBjoern A. Zeeb 			   MT_WF_RFCR_DROP_DUPLICATE |
5266c92544dSBjoern A. Zeeb 			   MT_WF_RFCR_DROP_A2_BSSID |
5276c92544dSBjoern A. Zeeb 			   MT_WF_RFCR_DROP_UNWANTED_CTL |
5286c92544dSBjoern A. Zeeb 			   MT_WF_RFCR_DROP_STBC_MULTI);
5296c92544dSBjoern A. Zeeb 
5306c92544dSBjoern A. Zeeb 	if (phy->n_beacon_vif || !mt7615_firmware_offload(dev))
5316c92544dSBjoern A. Zeeb 		phy->rxfilter &= ~MT_WF_RFCR_DROP_OTHER_BEACON;
5326c92544dSBjoern A. Zeeb 
5336c92544dSBjoern A. Zeeb 	MT76_FILTER(OTHER_BSS, MT_WF_RFCR_DROP_OTHER_TIM |
5346c92544dSBjoern A. Zeeb 			       MT_WF_RFCR_DROP_A3_MAC |
5356c92544dSBjoern A. Zeeb 			       MT_WF_RFCR_DROP_A3_BSSID);
5366c92544dSBjoern A. Zeeb 
5376c92544dSBjoern A. Zeeb 	MT76_FILTER(FCSFAIL, MT_WF_RFCR_DROP_FCSFAIL);
5386c92544dSBjoern A. Zeeb 
5396c92544dSBjoern A. Zeeb 	MT76_FILTER(CONTROL, MT_WF_RFCR_DROP_CTS |
5406c92544dSBjoern A. Zeeb 			     MT_WF_RFCR_DROP_RTS |
5416c92544dSBjoern A. Zeeb 			     MT_WF_RFCR_DROP_CTL_RSV |
5426c92544dSBjoern A. Zeeb 			     MT_WF_RFCR_DROP_NDPA);
5436c92544dSBjoern A. Zeeb 
5446c92544dSBjoern A. Zeeb 	*total_flags = flags;
5456c92544dSBjoern A. Zeeb 	mt76_wr(dev, MT_WF_RFCR(band), phy->rxfilter);
5466c92544dSBjoern A. Zeeb 
5476c92544dSBjoern A. Zeeb 	if (*total_flags & FIF_CONTROL)
5486c92544dSBjoern A. Zeeb 		mt76_clear(dev, MT_WF_RFCR1(band), ctl_flags);
5496c92544dSBjoern A. Zeeb 	else
5506c92544dSBjoern A. Zeeb 		mt76_set(dev, MT_WF_RFCR1(band), ctl_flags);
5516c92544dSBjoern A. Zeeb 
5526c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
5536c92544dSBjoern A. Zeeb }
5546c92544dSBjoern A. Zeeb 
555cbb3ec25SBjoern A. Zeeb static void
mt7615_update_mu_group(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct ieee80211_bss_conf * info)556cbb3ec25SBjoern A. Zeeb mt7615_update_mu_group(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
557cbb3ec25SBjoern A. Zeeb 		       struct ieee80211_bss_conf *info)
558cbb3ec25SBjoern A. Zeeb {
559cbb3ec25SBjoern A. Zeeb 	struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
560cbb3ec25SBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
561cbb3ec25SBjoern A. Zeeb 	u8 i, band = mvif->mt76.band_idx;
562cbb3ec25SBjoern A. Zeeb 	u32 *mu;
563cbb3ec25SBjoern A. Zeeb 
564cbb3ec25SBjoern A. Zeeb 	mu = (u32 *)info->mu_group.membership;
565cbb3ec25SBjoern A. Zeeb 	for (i = 0; i < WLAN_MEMBERSHIP_LEN / sizeof(*mu); i++) {
566cbb3ec25SBjoern A. Zeeb 		if (is_mt7663(&dev->mt76))
567cbb3ec25SBjoern A. Zeeb 			mt76_wr(dev, MT7663_WF_PHY_GID_TAB_VLD(band, i), mu[i]);
568cbb3ec25SBjoern A. Zeeb 		else
569cbb3ec25SBjoern A. Zeeb 			mt76_wr(dev, MT_WF_PHY_GID_TAB_VLD(band, i), mu[i]);
570cbb3ec25SBjoern A. Zeeb 	}
571cbb3ec25SBjoern A. Zeeb 
572cbb3ec25SBjoern A. Zeeb 	mu = (u32 *)info->mu_group.position;
573cbb3ec25SBjoern A. Zeeb 	for (i = 0; i < WLAN_USER_POSITION_LEN / sizeof(*mu); i++) {
574cbb3ec25SBjoern A. Zeeb 		if (is_mt7663(&dev->mt76))
575cbb3ec25SBjoern A. Zeeb 			mt76_wr(dev, MT7663_WF_PHY_GID_TAB_POS(band, i), mu[i]);
576cbb3ec25SBjoern A. Zeeb 		else
577cbb3ec25SBjoern A. Zeeb 			mt76_wr(dev, MT_WF_PHY_GID_TAB_POS(band, i), mu[i]);
578cbb3ec25SBjoern A. Zeeb 	}
579cbb3ec25SBjoern A. Zeeb }
580cbb3ec25SBjoern A. Zeeb 
mt7615_bss_info_changed(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct ieee80211_bss_conf * info,u64 changed)5816c92544dSBjoern A. Zeeb static void mt7615_bss_info_changed(struct ieee80211_hw *hw,
5826c92544dSBjoern A. Zeeb 				    struct ieee80211_vif *vif,
5836c92544dSBjoern A. Zeeb 				    struct ieee80211_bss_conf *info,
5846c92544dSBjoern A. Zeeb 				    u64 changed)
5856c92544dSBjoern A. Zeeb {
5866c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
5876c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
5886c92544dSBjoern A. Zeeb 
5896c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
5906c92544dSBjoern A. Zeeb 
5916c92544dSBjoern A. Zeeb 	if (changed & BSS_CHANGED_ERP_SLOT) {
5926c92544dSBjoern A. Zeeb 		int slottime = info->use_short_slot ? 9 : 20;
5936c92544dSBjoern A. Zeeb 
5946c92544dSBjoern A. Zeeb 		if (slottime != phy->slottime) {
5956c92544dSBjoern A. Zeeb 			phy->slottime = slottime;
5966c92544dSBjoern A. Zeeb 			mt7615_mac_set_timing(phy);
5976c92544dSBjoern A. Zeeb 		}
5986c92544dSBjoern A. Zeeb 	}
5996c92544dSBjoern A. Zeeb 
600cbb3ec25SBjoern A. Zeeb 	if (changed & BSS_CHANGED_ERP_CTS_PROT)
601cbb3ec25SBjoern A. Zeeb 		mt7615_mac_enable_rtscts(dev, vif, info->use_cts_prot);
602cbb3ec25SBjoern A. Zeeb 
6036c92544dSBjoern A. Zeeb 	if (changed & BSS_CHANGED_BEACON_ENABLED && info->enable_beacon) {
6046c92544dSBjoern A. Zeeb 		mt7615_mcu_add_bss_info(phy, vif, NULL, true);
6056c92544dSBjoern A. Zeeb 		mt7615_mcu_sta_add(phy, vif, NULL, true);
6066c92544dSBjoern A. Zeeb 
6076c92544dSBjoern A. Zeeb 		if (mt7615_firmware_offload(dev) && vif->p2p)
6086c92544dSBjoern A. Zeeb 			mt76_connac_mcu_set_p2p_oppps(hw, vif);
6096c92544dSBjoern A. Zeeb 	}
6106c92544dSBjoern A. Zeeb 
6116c92544dSBjoern A. Zeeb 	if (changed & (BSS_CHANGED_BEACON |
6126c92544dSBjoern A. Zeeb 		       BSS_CHANGED_BEACON_ENABLED))
6136c92544dSBjoern A. Zeeb 		mt7615_mcu_add_beacon(dev, hw, vif, info->enable_beacon);
6146c92544dSBjoern A. Zeeb 
6156c92544dSBjoern A. Zeeb 	if (changed & BSS_CHANGED_PS)
6166c92544dSBjoern A. Zeeb 		mt76_connac_mcu_set_vif_ps(&dev->mt76, vif);
6176c92544dSBjoern A. Zeeb 
6186c92544dSBjoern A. Zeeb 	if ((changed & BSS_CHANGED_ARP_FILTER) &&
6196c92544dSBjoern A. Zeeb 	    mt7615_firmware_offload(dev)) {
6206c92544dSBjoern A. Zeeb 		struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
6216c92544dSBjoern A. Zeeb 
6226c92544dSBjoern A. Zeeb 		mt76_connac_mcu_update_arp_filter(&dev->mt76, &mvif->mt76,
6236c92544dSBjoern A. Zeeb 						  info);
6246c92544dSBjoern A. Zeeb 	}
6256c92544dSBjoern A. Zeeb 
6266c92544dSBjoern A. Zeeb 	if (changed & BSS_CHANGED_ASSOC)
6276c92544dSBjoern A. Zeeb 		mt7615_mac_set_beacon_filter(phy, vif, vif->cfg.assoc);
6286c92544dSBjoern A. Zeeb 
629cbb3ec25SBjoern A. Zeeb 	if (changed & BSS_CHANGED_MU_GROUPS)
630cbb3ec25SBjoern A. Zeeb 		 mt7615_update_mu_group(hw, vif, info);
631cbb3ec25SBjoern A. Zeeb 
6326c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
6336c92544dSBjoern A. Zeeb }
6346c92544dSBjoern A. Zeeb 
6356c92544dSBjoern A. Zeeb static void
mt7615_channel_switch_beacon(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct cfg80211_chan_def * chandef)6366c92544dSBjoern A. Zeeb mt7615_channel_switch_beacon(struct ieee80211_hw *hw,
6376c92544dSBjoern A. Zeeb 			     struct ieee80211_vif *vif,
6386c92544dSBjoern A. Zeeb 			     struct cfg80211_chan_def *chandef)
6396c92544dSBjoern A. Zeeb {
6406c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
6416c92544dSBjoern A. Zeeb 
6426c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
6436c92544dSBjoern A. Zeeb 	mt7615_mcu_add_beacon(dev, hw, vif, true);
6446c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
6456c92544dSBjoern A. Zeeb }
6466c92544dSBjoern A. Zeeb 
mt7615_mac_sta_add(struct mt76_dev * mdev,struct ieee80211_vif * vif,struct ieee80211_sta * sta)6476c92544dSBjoern A. Zeeb int mt7615_mac_sta_add(struct mt76_dev *mdev, struct ieee80211_vif *vif,
6486c92544dSBjoern A. Zeeb 		       struct ieee80211_sta *sta)
6496c92544dSBjoern A. Zeeb {
6506c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = container_of(mdev, struct mt7615_dev, mt76);
6516c92544dSBjoern A. Zeeb 	struct mt7615_sta *msta = (struct mt7615_sta *)sta->drv_priv;
6526c92544dSBjoern A. Zeeb 	struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
6536c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy;
6546c92544dSBjoern A. Zeeb 	int idx, err;
6556c92544dSBjoern A. Zeeb 
6566c92544dSBjoern A. Zeeb 	idx = mt76_wcid_alloc(dev->mt76.wcid_mask, MT7615_WTBL_STA - 1);
6576c92544dSBjoern A. Zeeb 	if (idx < 0)
6586c92544dSBjoern A. Zeeb 		return -ENOSPC;
6596c92544dSBjoern A. Zeeb 
660cbb3ec25SBjoern A. Zeeb 	INIT_LIST_HEAD(&msta->wcid.poll_list);
6616c92544dSBjoern A. Zeeb 	msta->vif = mvif;
6626c92544dSBjoern A. Zeeb 	msta->wcid.sta = 1;
6636c92544dSBjoern A. Zeeb 	msta->wcid.idx = idx;
6646c92544dSBjoern A. Zeeb 	msta->wcid.phy_idx = mvif->mt76.band_idx;
6656c92544dSBjoern A. Zeeb 
6666c92544dSBjoern A. Zeeb 	phy = mvif->mt76.band_idx ? mt7615_ext_phy(dev) : &dev->phy;
6676c92544dSBjoern A. Zeeb 	err = mt76_connac_pm_wake(phy->mt76, &dev->pm);
6686c92544dSBjoern A. Zeeb 	if (err)
6696c92544dSBjoern A. Zeeb 		return err;
6706c92544dSBjoern A. Zeeb 
6716c92544dSBjoern A. Zeeb 	if (vif->type == NL80211_IFTYPE_STATION && !sta->tdls) {
6726c92544dSBjoern A. Zeeb 		err = mt7615_mcu_add_bss_info(phy, vif, sta, true);
6736c92544dSBjoern A. Zeeb 		if (err)
6746c92544dSBjoern A. Zeeb 			return err;
6756c92544dSBjoern A. Zeeb 	}
6766c92544dSBjoern A. Zeeb 
6776c92544dSBjoern A. Zeeb 	mt7615_mac_wtbl_update(dev, idx,
6786c92544dSBjoern A. Zeeb 			       MT_WTBL_UPDATE_ADM_COUNT_CLEAR);
6796c92544dSBjoern A. Zeeb 	err = mt7615_mcu_sta_add(&dev->phy, vif, sta, true);
6806c92544dSBjoern A. Zeeb 	if (err)
6816c92544dSBjoern A. Zeeb 		return err;
6826c92544dSBjoern A. Zeeb 
6836c92544dSBjoern A. Zeeb 	mt76_connac_power_save_sched(phy->mt76, &dev->pm);
6846c92544dSBjoern A. Zeeb 
6856c92544dSBjoern A. Zeeb 	return err;
6866c92544dSBjoern A. Zeeb }
6876c92544dSBjoern A. Zeeb EXPORT_SYMBOL_GPL(mt7615_mac_sta_add);
6886c92544dSBjoern A. Zeeb 
mt7615_mac_sta_remove(struct mt76_dev * mdev,struct ieee80211_vif * vif,struct ieee80211_sta * sta)6896c92544dSBjoern A. Zeeb void mt7615_mac_sta_remove(struct mt76_dev *mdev, struct ieee80211_vif *vif,
6906c92544dSBjoern A. Zeeb 			   struct ieee80211_sta *sta)
6916c92544dSBjoern A. Zeeb {
6926c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = container_of(mdev, struct mt7615_dev, mt76);
6936c92544dSBjoern A. Zeeb 	struct mt7615_sta *msta = (struct mt7615_sta *)sta->drv_priv;
6946c92544dSBjoern A. Zeeb 	struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
6956c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy;
6966c92544dSBjoern A. Zeeb 
6976c92544dSBjoern A. Zeeb 	mt76_connac_free_pending_tx_skbs(&dev->pm, &msta->wcid);
6986c92544dSBjoern A. Zeeb 
6996c92544dSBjoern A. Zeeb 	phy = mvif->mt76.band_idx ? mt7615_ext_phy(dev) : &dev->phy;
7006c92544dSBjoern A. Zeeb 	mt76_connac_pm_wake(phy->mt76, &dev->pm);
7016c92544dSBjoern A. Zeeb 
7026c92544dSBjoern A. Zeeb 	mt7615_mcu_sta_add(&dev->phy, vif, sta, false);
7036c92544dSBjoern A. Zeeb 	mt7615_mac_wtbl_update(dev, msta->wcid.idx,
7046c92544dSBjoern A. Zeeb 			       MT_WTBL_UPDATE_ADM_COUNT_CLEAR);
7056c92544dSBjoern A. Zeeb 	if (vif->type == NL80211_IFTYPE_STATION && !sta->tdls)
7066c92544dSBjoern A. Zeeb 		mt7615_mcu_add_bss_info(phy, vif, sta, false);
7076c92544dSBjoern A. Zeeb 
708cbb3ec25SBjoern A. Zeeb 	spin_lock_bh(&mdev->sta_poll_lock);
709cbb3ec25SBjoern A. Zeeb 	if (!list_empty(&msta->wcid.poll_list))
710cbb3ec25SBjoern A. Zeeb 		list_del_init(&msta->wcid.poll_list);
711cbb3ec25SBjoern A. Zeeb 	spin_unlock_bh(&mdev->sta_poll_lock);
7126c92544dSBjoern A. Zeeb 
7136c92544dSBjoern A. Zeeb 	mt76_connac_power_save_sched(phy->mt76, &dev->pm);
7146c92544dSBjoern A. Zeeb }
7156c92544dSBjoern A. Zeeb EXPORT_SYMBOL_GPL(mt7615_mac_sta_remove);
7166c92544dSBjoern A. Zeeb 
mt7615_sta_rate_tbl_update(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct ieee80211_sta * sta)7176c92544dSBjoern A. Zeeb static void mt7615_sta_rate_tbl_update(struct ieee80211_hw *hw,
7186c92544dSBjoern A. Zeeb 				       struct ieee80211_vif *vif,
7196c92544dSBjoern A. Zeeb 				       struct ieee80211_sta *sta)
7206c92544dSBjoern A. Zeeb {
7216c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
7226c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
7236c92544dSBjoern A. Zeeb 	struct mt7615_sta *msta = (struct mt7615_sta *)sta->drv_priv;
7246c92544dSBjoern A. Zeeb 	struct ieee80211_sta_rates *sta_rates = rcu_dereference(sta->rates);
7256c92544dSBjoern A. Zeeb 	int i;
7266c92544dSBjoern A. Zeeb 
7276c92544dSBjoern A. Zeeb 	if (!sta_rates)
7286c92544dSBjoern A. Zeeb 		return;
7296c92544dSBjoern A. Zeeb 
7306c92544dSBjoern A. Zeeb 	spin_lock_bh(&dev->mt76.lock);
7316c92544dSBjoern A. Zeeb 	for (i = 0; i < ARRAY_SIZE(msta->rates); i++) {
7326c92544dSBjoern A. Zeeb 		msta->rates[i].idx = sta_rates->rate[i].idx;
7336c92544dSBjoern A. Zeeb 		msta->rates[i].count = sta_rates->rate[i].count;
7346c92544dSBjoern A. Zeeb 		msta->rates[i].flags = sta_rates->rate[i].flags;
7356c92544dSBjoern A. Zeeb 
7366c92544dSBjoern A. Zeeb 		if (msta->rates[i].idx < 0 || !msta->rates[i].count)
7376c92544dSBjoern A. Zeeb 			break;
7386c92544dSBjoern A. Zeeb 	}
7396c92544dSBjoern A. Zeeb 	msta->n_rates = i;
7406c92544dSBjoern A. Zeeb 	if (mt76_connac_pm_ref(phy->mt76, &dev->pm)) {
7416c92544dSBjoern A. Zeeb 		mt7615_mac_set_rates(phy, msta, NULL, msta->rates);
7426c92544dSBjoern A. Zeeb 		mt76_connac_pm_unref(phy->mt76, &dev->pm);
7436c92544dSBjoern A. Zeeb 	}
7446c92544dSBjoern A. Zeeb 	spin_unlock_bh(&dev->mt76.lock);
7456c92544dSBjoern A. Zeeb }
7466c92544dSBjoern A. Zeeb 
mt7615_tx_worker(struct mt76_worker * w)7476c92544dSBjoern A. Zeeb void mt7615_tx_worker(struct mt76_worker *w)
7486c92544dSBjoern A. Zeeb {
7496c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = container_of(w, struct mt7615_dev,
7506c92544dSBjoern A. Zeeb 					      mt76.tx_worker);
7516c92544dSBjoern A. Zeeb 
7526c92544dSBjoern A. Zeeb 	if (!mt76_connac_pm_ref(&dev->mphy, &dev->pm)) {
7536c92544dSBjoern A. Zeeb 		queue_work(dev->mt76.wq, &dev->pm.wake_work);
7546c92544dSBjoern A. Zeeb 		return;
7556c92544dSBjoern A. Zeeb 	}
7566c92544dSBjoern A. Zeeb 
7576c92544dSBjoern A. Zeeb 	mt76_tx_worker_run(&dev->mt76);
7586c92544dSBjoern A. Zeeb 	mt76_connac_pm_unref(&dev->mphy, &dev->pm);
7596c92544dSBjoern A. Zeeb }
7606c92544dSBjoern A. Zeeb 
mt7615_tx(struct ieee80211_hw * hw,struct ieee80211_tx_control * control,struct sk_buff * skb)7616c92544dSBjoern A. Zeeb static void mt7615_tx(struct ieee80211_hw *hw,
7626c92544dSBjoern A. Zeeb 		      struct ieee80211_tx_control *control,
7636c92544dSBjoern A. Zeeb 		      struct sk_buff *skb)
7646c92544dSBjoern A. Zeeb {
7656c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
7666c92544dSBjoern A. Zeeb 	struct mt76_phy *mphy = hw->priv;
7676c92544dSBjoern A. Zeeb 	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
7686c92544dSBjoern A. Zeeb 	struct ieee80211_vif *vif = info->control.vif;
7696c92544dSBjoern A. Zeeb 	struct mt76_wcid *wcid = &dev->mt76.global_wcid;
7706c92544dSBjoern A. Zeeb 	struct mt7615_sta *msta = NULL;
7716c92544dSBjoern A. Zeeb 	int qid;
7726c92544dSBjoern A. Zeeb 
7736c92544dSBjoern A. Zeeb 	if (control->sta) {
7746c92544dSBjoern A. Zeeb 		msta = (struct mt7615_sta *)control->sta->drv_priv;
7756c92544dSBjoern A. Zeeb 		wcid = &msta->wcid;
7766c92544dSBjoern A. Zeeb 	}
7776c92544dSBjoern A. Zeeb 
7786c92544dSBjoern A. Zeeb 	if (vif && !control->sta) {
7796c92544dSBjoern A. Zeeb 		struct mt7615_vif *mvif;
7806c92544dSBjoern A. Zeeb 
7816c92544dSBjoern A. Zeeb 		mvif = (struct mt7615_vif *)vif->drv_priv;
7826c92544dSBjoern A. Zeeb 		msta = &mvif->sta;
7836c92544dSBjoern A. Zeeb 		wcid = &msta->wcid;
7846c92544dSBjoern A. Zeeb 	}
7856c92544dSBjoern A. Zeeb 
7866c92544dSBjoern A. Zeeb 	if (mt76_connac_pm_ref(mphy, &dev->pm)) {
7876c92544dSBjoern A. Zeeb 		mt76_tx(mphy, control->sta, wcid, skb);
7886c92544dSBjoern A. Zeeb 		mt76_connac_pm_unref(mphy, &dev->pm);
7896c92544dSBjoern A. Zeeb 		return;
7906c92544dSBjoern A. Zeeb 	}
7916c92544dSBjoern A. Zeeb 
7926c92544dSBjoern A. Zeeb 	qid = skb_get_queue_mapping(skb);
7936c92544dSBjoern A. Zeeb 	if (qid >= MT_TXQ_PSD) {
7946c92544dSBjoern A. Zeeb 		qid = IEEE80211_AC_BE;
7956c92544dSBjoern A. Zeeb 		skb_set_queue_mapping(skb, qid);
7966c92544dSBjoern A. Zeeb 	}
7976c92544dSBjoern A. Zeeb 
7986c92544dSBjoern A. Zeeb 	mt76_connac_pm_queue_skb(hw, &dev->pm, wcid, skb);
7996c92544dSBjoern A. Zeeb }
8006c92544dSBjoern A. Zeeb 
mt7615_set_rts_threshold(struct ieee80211_hw * hw,u32 val)8016c92544dSBjoern A. Zeeb static int mt7615_set_rts_threshold(struct ieee80211_hw *hw, u32 val)
8026c92544dSBjoern A. Zeeb {
8036c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
8046c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
8056c92544dSBjoern A. Zeeb 	int err, band = phy != &dev->phy;
8066c92544dSBjoern A. Zeeb 
8076c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
8086c92544dSBjoern A. Zeeb 	err = mt76_connac_mcu_set_rts_thresh(&dev->mt76, val, band);
8096c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
8106c92544dSBjoern A. Zeeb 
8116c92544dSBjoern A. Zeeb 	return err;
8126c92544dSBjoern A. Zeeb }
8136c92544dSBjoern A. Zeeb 
8146c92544dSBjoern A. Zeeb static int
mt7615_ampdu_action(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct ieee80211_ampdu_params * params)8156c92544dSBjoern A. Zeeb mt7615_ampdu_action(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
8166c92544dSBjoern A. Zeeb 		    struct ieee80211_ampdu_params *params)
8176c92544dSBjoern A. Zeeb {
8186c92544dSBjoern A. Zeeb 	enum ieee80211_ampdu_mlme_action action = params->action;
8196c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
8206c92544dSBjoern A. Zeeb 	struct ieee80211_sta *sta = params->sta;
8216c92544dSBjoern A. Zeeb 	struct ieee80211_txq *txq = sta->txq[params->tid];
8226c92544dSBjoern A. Zeeb 	struct mt7615_sta *msta = (struct mt7615_sta *)sta->drv_priv;
8236c92544dSBjoern A. Zeeb 	u16 tid = params->tid;
8246c92544dSBjoern A. Zeeb 	u16 ssn = params->ssn;
8256c92544dSBjoern A. Zeeb 	struct mt76_txq *mtxq;
8266c92544dSBjoern A. Zeeb 	int ret = 0;
8276c92544dSBjoern A. Zeeb 
8286c92544dSBjoern A. Zeeb 	if (!txq)
8296c92544dSBjoern A. Zeeb 		return -EINVAL;
8306c92544dSBjoern A. Zeeb 
8316c92544dSBjoern A. Zeeb 	mtxq = (struct mt76_txq *)txq->drv_priv;
8326c92544dSBjoern A. Zeeb 
8336c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
8346c92544dSBjoern A. Zeeb 
8356c92544dSBjoern A. Zeeb 	switch (action) {
8366c92544dSBjoern A. Zeeb 	case IEEE80211_AMPDU_RX_START:
8376c92544dSBjoern A. Zeeb 		mt76_rx_aggr_start(&dev->mt76, &msta->wcid, tid, ssn,
8386c92544dSBjoern A. Zeeb 				   params->buf_size);
8396c92544dSBjoern A. Zeeb 		ret = mt7615_mcu_add_rx_ba(dev, params, true);
8406c92544dSBjoern A. Zeeb 		break;
8416c92544dSBjoern A. Zeeb 	case IEEE80211_AMPDU_RX_STOP:
8426c92544dSBjoern A. Zeeb 		mt76_rx_aggr_stop(&dev->mt76, &msta->wcid, tid);
8436c92544dSBjoern A. Zeeb 		ret = mt7615_mcu_add_rx_ba(dev, params, false);
8446c92544dSBjoern A. Zeeb 		break;
8456c92544dSBjoern A. Zeeb 	case IEEE80211_AMPDU_TX_OPERATIONAL:
8466c92544dSBjoern A. Zeeb 		mtxq->aggr = true;
8476c92544dSBjoern A. Zeeb 		mtxq->send_bar = false;
8486c92544dSBjoern A. Zeeb 		ret = mt7615_mcu_add_tx_ba(dev, params, true);
8496c92544dSBjoern A. Zeeb 		ssn = mt7615_mac_get_sta_tid_sn(dev, msta->wcid.idx, tid);
8506c92544dSBjoern A. Zeeb 		ieee80211_send_bar(vif, sta->addr, tid,
8516c92544dSBjoern A. Zeeb 				   IEEE80211_SN_TO_SEQ(ssn));
8526c92544dSBjoern A. Zeeb 		break;
8536c92544dSBjoern A. Zeeb 	case IEEE80211_AMPDU_TX_STOP_FLUSH:
8546c92544dSBjoern A. Zeeb 	case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT:
8556c92544dSBjoern A. Zeeb 		mtxq->aggr = false;
8566c92544dSBjoern A. Zeeb 		ret = mt7615_mcu_add_tx_ba(dev, params, false);
8576c92544dSBjoern A. Zeeb 		break;
8586c92544dSBjoern A. Zeeb 	case IEEE80211_AMPDU_TX_START:
8596c92544dSBjoern A. Zeeb 		ssn = mt7615_mac_get_sta_tid_sn(dev, msta->wcid.idx, tid);
8606c92544dSBjoern A. Zeeb 		params->ssn = ssn;
8616c92544dSBjoern A. Zeeb 		ret = IEEE80211_AMPDU_TX_START_IMMEDIATE;
8626c92544dSBjoern A. Zeeb 		break;
8636c92544dSBjoern A. Zeeb 	case IEEE80211_AMPDU_TX_STOP_CONT:
8646c92544dSBjoern A. Zeeb 		mtxq->aggr = false;
8656c92544dSBjoern A. Zeeb 		ret = mt7615_mcu_add_tx_ba(dev, params, false);
8666c92544dSBjoern A. Zeeb 		ieee80211_stop_tx_ba_cb_irqsafe(vif, sta->addr, tid);
8676c92544dSBjoern A. Zeeb 		break;
8686c92544dSBjoern A. Zeeb 	}
8696c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
8706c92544dSBjoern A. Zeeb 
8716c92544dSBjoern A. Zeeb 	return ret;
8726c92544dSBjoern A. Zeeb }
8736c92544dSBjoern A. Zeeb 
8746c92544dSBjoern A. Zeeb static int
mt7615_sta_add(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct ieee80211_sta * sta)8756c92544dSBjoern A. Zeeb mt7615_sta_add(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
8766c92544dSBjoern A. Zeeb 	       struct ieee80211_sta *sta)
8776c92544dSBjoern A. Zeeb {
8786c92544dSBjoern A. Zeeb     return mt76_sta_state(hw, vif, sta, IEEE80211_STA_NOTEXIST,
8796c92544dSBjoern A. Zeeb 			  IEEE80211_STA_NONE);
8806c92544dSBjoern A. Zeeb }
8816c92544dSBjoern A. Zeeb 
8826c92544dSBjoern A. Zeeb static int
mt7615_sta_remove(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct ieee80211_sta * sta)8836c92544dSBjoern A. Zeeb mt7615_sta_remove(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
8846c92544dSBjoern A. Zeeb 		  struct ieee80211_sta *sta)
8856c92544dSBjoern A. Zeeb {
8866c92544dSBjoern A. Zeeb     return mt76_sta_state(hw, vif, sta, IEEE80211_STA_NONE,
8876c92544dSBjoern A. Zeeb 			  IEEE80211_STA_NOTEXIST);
8886c92544dSBjoern A. Zeeb }
8896c92544dSBjoern A. Zeeb 
8906c92544dSBjoern A. Zeeb static int
mt7615_get_stats(struct ieee80211_hw * hw,struct ieee80211_low_level_stats * stats)8916c92544dSBjoern A. Zeeb mt7615_get_stats(struct ieee80211_hw *hw,
8926c92544dSBjoern A. Zeeb 		 struct ieee80211_low_level_stats *stats)
8936c92544dSBjoern A. Zeeb {
8946c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
8956c92544dSBjoern A. Zeeb 	struct mib_stats *mib = &phy->mib;
8966c92544dSBjoern A. Zeeb 
8976c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(phy->dev);
8986c92544dSBjoern A. Zeeb 
8996c92544dSBjoern A. Zeeb 	stats->dot11RTSSuccessCount = mib->rts_cnt;
9006c92544dSBjoern A. Zeeb 	stats->dot11RTSFailureCount = mib->rts_retries_cnt;
9016c92544dSBjoern A. Zeeb 	stats->dot11FCSErrorCount = mib->fcs_err_cnt;
9026c92544dSBjoern A. Zeeb 	stats->dot11ACKFailureCount = mib->ack_fail_cnt;
9036c92544dSBjoern A. Zeeb 
9046c92544dSBjoern A. Zeeb 	mt7615_mutex_release(phy->dev);
9056c92544dSBjoern A. Zeeb 
9066c92544dSBjoern A. Zeeb 	return 0;
9076c92544dSBjoern A. Zeeb }
9086c92544dSBjoern A. Zeeb 
9096c92544dSBjoern A. Zeeb static u64
mt7615_get_tsf(struct ieee80211_hw * hw,struct ieee80211_vif * vif)9106c92544dSBjoern A. Zeeb mt7615_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
9116c92544dSBjoern A. Zeeb {
9126c92544dSBjoern A. Zeeb 	struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
9136c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
9146c92544dSBjoern A. Zeeb 	union {
9156c92544dSBjoern A. Zeeb 		u64 t64;
9166c92544dSBjoern A. Zeeb 		u32 t32[2];
9176c92544dSBjoern A. Zeeb 	} tsf;
9186c92544dSBjoern A. Zeeb 	u16 idx = mvif->mt76.omac_idx;
9196c92544dSBjoern A. Zeeb 	u32 reg;
9206c92544dSBjoern A. Zeeb 
9216c92544dSBjoern A. Zeeb 	idx = idx > HW_BSSID_MAX ? HW_BSSID_0 : idx;
9226c92544dSBjoern A. Zeeb 	reg = idx > 1 ? MT_LPON_TCR2(idx): MT_LPON_TCR0(idx);
9236c92544dSBjoern A. Zeeb 
9246c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
9256c92544dSBjoern A. Zeeb 
9266c92544dSBjoern A. Zeeb 	/* TSF read */
9276c92544dSBjoern A. Zeeb 	mt76_rmw(dev, reg, MT_LPON_TCR_MODE, MT_LPON_TCR_READ);
9286c92544dSBjoern A. Zeeb 	tsf.t32[0] = mt76_rr(dev, MT_LPON_UTTR0);
9296c92544dSBjoern A. Zeeb 	tsf.t32[1] = mt76_rr(dev, MT_LPON_UTTR1);
9306c92544dSBjoern A. Zeeb 
9316c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
9326c92544dSBjoern A. Zeeb 
9336c92544dSBjoern A. Zeeb 	return tsf.t64;
9346c92544dSBjoern A. Zeeb }
9356c92544dSBjoern A. Zeeb 
9366c92544dSBjoern A. Zeeb static void
mt7615_set_tsf(struct ieee80211_hw * hw,struct ieee80211_vif * vif,u64 timestamp)9376c92544dSBjoern A. Zeeb mt7615_set_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
9386c92544dSBjoern A. Zeeb 	       u64 timestamp)
9396c92544dSBjoern A. Zeeb {
9406c92544dSBjoern A. Zeeb 	struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
9416c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
9426c92544dSBjoern A. Zeeb 	union {
9436c92544dSBjoern A. Zeeb 		u64 t64;
9446c92544dSBjoern A. Zeeb 		u32 t32[2];
9456c92544dSBjoern A. Zeeb 	} tsf = { .t64 = timestamp, };
9466c92544dSBjoern A. Zeeb 	u16 idx = mvif->mt76.omac_idx;
9476c92544dSBjoern A. Zeeb 	u32 reg;
9486c92544dSBjoern A. Zeeb 
9496c92544dSBjoern A. Zeeb 	idx = idx > HW_BSSID_MAX ? HW_BSSID_0 : idx;
9506c92544dSBjoern A. Zeeb 	reg = idx > 1 ? MT_LPON_TCR2(idx): MT_LPON_TCR0(idx);
9516c92544dSBjoern A. Zeeb 
9526c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
9536c92544dSBjoern A. Zeeb 
9546c92544dSBjoern A. Zeeb 	mt76_wr(dev, MT_LPON_UTTR0, tsf.t32[0]);
9556c92544dSBjoern A. Zeeb 	mt76_wr(dev, MT_LPON_UTTR1, tsf.t32[1]);
9566c92544dSBjoern A. Zeeb 	/* TSF software overwrite */
9576c92544dSBjoern A. Zeeb 	mt76_rmw(dev, reg, MT_LPON_TCR_MODE, MT_LPON_TCR_WRITE);
9586c92544dSBjoern A. Zeeb 
9596c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
9606c92544dSBjoern A. Zeeb }
9616c92544dSBjoern A. Zeeb 
9626c92544dSBjoern A. Zeeb static void
mt7615_offset_tsf(struct ieee80211_hw * hw,struct ieee80211_vif * vif,s64 timestamp)9636c92544dSBjoern A. Zeeb mt7615_offset_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
9646c92544dSBjoern A. Zeeb 		  s64 timestamp)
9656c92544dSBjoern A. Zeeb {
9666c92544dSBjoern A. Zeeb 	struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
9676c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
9686c92544dSBjoern A. Zeeb 	union {
9696c92544dSBjoern A. Zeeb 		u64 t64;
9706c92544dSBjoern A. Zeeb 		u32 t32[2];
9716c92544dSBjoern A. Zeeb 	} tsf = { .t64 = timestamp, };
9726c92544dSBjoern A. Zeeb 	u16 idx = mvif->mt76.omac_idx;
9736c92544dSBjoern A. Zeeb 	u32 reg;
9746c92544dSBjoern A. Zeeb 
9756c92544dSBjoern A. Zeeb 	idx = idx > HW_BSSID_MAX ? HW_BSSID_0 : idx;
9766c92544dSBjoern A. Zeeb 	reg = idx > 1 ? MT_LPON_TCR2(idx): MT_LPON_TCR0(idx);
9776c92544dSBjoern A. Zeeb 
9786c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
9796c92544dSBjoern A. Zeeb 
9806c92544dSBjoern A. Zeeb 	mt76_wr(dev, MT_LPON_UTTR0, tsf.t32[0]);
9816c92544dSBjoern A. Zeeb 	mt76_wr(dev, MT_LPON_UTTR1, tsf.t32[1]);
9826c92544dSBjoern A. Zeeb 	/* TSF software adjust*/
9836c92544dSBjoern A. Zeeb 	mt76_rmw(dev, reg, MT_LPON_TCR_MODE, MT_LPON_TCR_ADJUST);
9846c92544dSBjoern A. Zeeb 
9856c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
9866c92544dSBjoern A. Zeeb }
9876c92544dSBjoern A. Zeeb 
9886c92544dSBjoern A. Zeeb static void
mt7615_set_coverage_class(struct ieee80211_hw * hw,s16 coverage_class)9896c92544dSBjoern A. Zeeb mt7615_set_coverage_class(struct ieee80211_hw *hw, s16 coverage_class)
9906c92544dSBjoern A. Zeeb {
9916c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
9926c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = phy->dev;
9936c92544dSBjoern A. Zeeb 
9946c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
9956c92544dSBjoern A. Zeeb 	phy->coverage_class = max_t(s16, coverage_class, 0);
9966c92544dSBjoern A. Zeeb 	mt7615_mac_set_timing(phy);
9976c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
9986c92544dSBjoern A. Zeeb }
9996c92544dSBjoern A. Zeeb 
10006c92544dSBjoern A. Zeeb static int
mt7615_set_antenna(struct ieee80211_hw * hw,u32 tx_ant,u32 rx_ant)10016c92544dSBjoern A. Zeeb mt7615_set_antenna(struct ieee80211_hw *hw, u32 tx_ant, u32 rx_ant)
10026c92544dSBjoern A. Zeeb {
10036c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
10046c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
10056c92544dSBjoern A. Zeeb 	int max_nss = hweight8(hw->wiphy->available_antennas_tx);
10066c92544dSBjoern A. Zeeb 	bool ext_phy = phy != &dev->phy;
10076c92544dSBjoern A. Zeeb 
10086c92544dSBjoern A. Zeeb 	if (!tx_ant || tx_ant != rx_ant || ffs(tx_ant) > max_nss)
10096c92544dSBjoern A. Zeeb 		return -EINVAL;
10106c92544dSBjoern A. Zeeb 
10116c92544dSBjoern A. Zeeb 	if ((BIT(hweight8(tx_ant)) - 1) != tx_ant)
10126c92544dSBjoern A. Zeeb 		tx_ant = BIT(ffs(tx_ant) - 1) - 1;
10136c92544dSBjoern A. Zeeb 
10146c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
10156c92544dSBjoern A. Zeeb 
10166c92544dSBjoern A. Zeeb 	phy->mt76->antenna_mask = tx_ant;
10176c92544dSBjoern A. Zeeb 	if (ext_phy) {
10186c92544dSBjoern A. Zeeb 		if (dev->chainmask == 0xf)
10196c92544dSBjoern A. Zeeb 			tx_ant <<= 2;
10206c92544dSBjoern A. Zeeb 		else
10216c92544dSBjoern A. Zeeb 			tx_ant <<= 1;
10226c92544dSBjoern A. Zeeb 	}
10236c92544dSBjoern A. Zeeb 	phy->mt76->chainmask = tx_ant;
10246c92544dSBjoern A. Zeeb 
10256c92544dSBjoern A. Zeeb 	mt76_set_stream_caps(phy->mt76, true);
10266c92544dSBjoern A. Zeeb 
10276c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
10286c92544dSBjoern A. Zeeb 
10296c92544dSBjoern A. Zeeb 	return 0;
10306c92544dSBjoern A. Zeeb }
10316c92544dSBjoern A. Zeeb 
mt7615_roc_iter(void * priv,u8 * mac,struct ieee80211_vif * vif)10326c92544dSBjoern A. Zeeb static void mt7615_roc_iter(void *priv, u8 *mac,
10336c92544dSBjoern A. Zeeb 			    struct ieee80211_vif *vif)
10346c92544dSBjoern A. Zeeb {
10356c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = priv;
10366c92544dSBjoern A. Zeeb 
10376c92544dSBjoern A. Zeeb 	mt7615_mcu_set_roc(phy, vif, NULL, 0);
10386c92544dSBjoern A. Zeeb }
10396c92544dSBjoern A. Zeeb 
mt7615_roc_work(struct work_struct * work)10406c92544dSBjoern A. Zeeb void mt7615_roc_work(struct work_struct *work)
10416c92544dSBjoern A. Zeeb {
10426c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy;
10436c92544dSBjoern A. Zeeb 
10446c92544dSBjoern A. Zeeb 	phy = (struct mt7615_phy *)container_of(work, struct mt7615_phy,
10456c92544dSBjoern A. Zeeb 						roc_work);
10466c92544dSBjoern A. Zeeb 
10476c92544dSBjoern A. Zeeb 	if (!test_and_clear_bit(MT76_STATE_ROC, &phy->mt76->state))
10486c92544dSBjoern A. Zeeb 		return;
10496c92544dSBjoern A. Zeeb 
10506c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(phy->dev);
10516c92544dSBjoern A. Zeeb 	ieee80211_iterate_active_interfaces(phy->mt76->hw,
10526c92544dSBjoern A. Zeeb 					    IEEE80211_IFACE_ITER_RESUME_ALL,
10536c92544dSBjoern A. Zeeb 					    mt7615_roc_iter, phy);
10546c92544dSBjoern A. Zeeb 	mt7615_mutex_release(phy->dev);
10556c92544dSBjoern A. Zeeb 	ieee80211_remain_on_channel_expired(phy->mt76->hw);
10566c92544dSBjoern A. Zeeb }
10576c92544dSBjoern A. Zeeb 
mt7615_roc_timer(struct timer_list * timer)10586c92544dSBjoern A. Zeeb void mt7615_roc_timer(struct timer_list *timer)
10596c92544dSBjoern A. Zeeb {
10606c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = from_timer(phy, timer, roc_timer);
10616c92544dSBjoern A. Zeeb 
10626c92544dSBjoern A. Zeeb 	ieee80211_queue_work(phy->mt76->hw, &phy->roc_work);
10636c92544dSBjoern A. Zeeb }
10646c92544dSBjoern A. Zeeb 
mt7615_scan_work(struct work_struct * work)10656c92544dSBjoern A. Zeeb void mt7615_scan_work(struct work_struct *work)
10666c92544dSBjoern A. Zeeb {
10676c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy;
10686c92544dSBjoern A. Zeeb 
10696c92544dSBjoern A. Zeeb 	phy = (struct mt7615_phy *)container_of(work, struct mt7615_phy,
10706c92544dSBjoern A. Zeeb 						scan_work.work);
10716c92544dSBjoern A. Zeeb 
10726c92544dSBjoern A. Zeeb 	while (true) {
10736c92544dSBjoern A. Zeeb 		struct mt7615_mcu_rxd *rxd;
10746c92544dSBjoern A. Zeeb 		struct sk_buff *skb;
10756c92544dSBjoern A. Zeeb 
10766c92544dSBjoern A. Zeeb 		spin_lock_bh(&phy->dev->mt76.lock);
10776c92544dSBjoern A. Zeeb 		skb = __skb_dequeue(&phy->scan_event_list);
10786c92544dSBjoern A. Zeeb 		spin_unlock_bh(&phy->dev->mt76.lock);
10796c92544dSBjoern A. Zeeb 
10806c92544dSBjoern A. Zeeb 		if (!skb)
10816c92544dSBjoern A. Zeeb 			break;
10826c92544dSBjoern A. Zeeb 
10836c92544dSBjoern A. Zeeb 		rxd = (struct mt7615_mcu_rxd *)skb->data;
10846c92544dSBjoern A. Zeeb 		if (rxd->eid == MCU_EVENT_SCHED_SCAN_DONE) {
10856c92544dSBjoern A. Zeeb 			ieee80211_sched_scan_results(phy->mt76->hw);
10866c92544dSBjoern A. Zeeb 		} else if (test_and_clear_bit(MT76_HW_SCANNING,
10876c92544dSBjoern A. Zeeb 					      &phy->mt76->state)) {
10886c92544dSBjoern A. Zeeb 			struct cfg80211_scan_info info = {
10896c92544dSBjoern A. Zeeb 				.aborted = false,
10906c92544dSBjoern A. Zeeb 			};
10916c92544dSBjoern A. Zeeb 
10926c92544dSBjoern A. Zeeb 			ieee80211_scan_completed(phy->mt76->hw, &info);
10936c92544dSBjoern A. Zeeb 		}
10946c92544dSBjoern A. Zeeb 		dev_kfree_skb(skb);
10956c92544dSBjoern A. Zeeb 	}
10966c92544dSBjoern A. Zeeb }
10976c92544dSBjoern A. Zeeb 
10986c92544dSBjoern A. Zeeb static int
mt7615_hw_scan(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct ieee80211_scan_request * req)10996c92544dSBjoern A. Zeeb mt7615_hw_scan(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
11006c92544dSBjoern A. Zeeb 	       struct ieee80211_scan_request *req)
11016c92544dSBjoern A. Zeeb {
11026c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
11036c92544dSBjoern A. Zeeb 	struct mt76_phy *mphy = hw->priv;
11046c92544dSBjoern A. Zeeb 	int err;
11056c92544dSBjoern A. Zeeb 
11066c92544dSBjoern A. Zeeb 	/* fall-back to sw-scan */
11076c92544dSBjoern A. Zeeb 	if (!mt7615_firmware_offload(dev))
11086c92544dSBjoern A. Zeeb 		return 1;
11096c92544dSBjoern A. Zeeb 
11106c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
11116c92544dSBjoern A. Zeeb 	err = mt76_connac_mcu_hw_scan(mphy, vif, req);
11126c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
11136c92544dSBjoern A. Zeeb 
11146c92544dSBjoern A. Zeeb 	return err;
11156c92544dSBjoern A. Zeeb }
11166c92544dSBjoern A. Zeeb 
11176c92544dSBjoern A. Zeeb static void
mt7615_cancel_hw_scan(struct ieee80211_hw * hw,struct ieee80211_vif * vif)11186c92544dSBjoern A. Zeeb mt7615_cancel_hw_scan(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
11196c92544dSBjoern A. Zeeb {
11206c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
11216c92544dSBjoern A. Zeeb 	struct mt76_phy *mphy = hw->priv;
11226c92544dSBjoern A. Zeeb 
11236c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
11246c92544dSBjoern A. Zeeb 	mt76_connac_mcu_cancel_hw_scan(mphy, vif);
11256c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
11266c92544dSBjoern A. Zeeb }
11276c92544dSBjoern A. Zeeb 
11286c92544dSBjoern A. Zeeb static int
mt7615_start_sched_scan(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct cfg80211_sched_scan_request * req,struct ieee80211_scan_ies * ies)11296c92544dSBjoern A. Zeeb mt7615_start_sched_scan(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
11306c92544dSBjoern A. Zeeb 			struct cfg80211_sched_scan_request *req,
11316c92544dSBjoern A. Zeeb 			struct ieee80211_scan_ies *ies)
11326c92544dSBjoern A. Zeeb {
11336c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
11346c92544dSBjoern A. Zeeb 	struct mt76_phy *mphy = hw->priv;
11356c92544dSBjoern A. Zeeb 	int err;
11366c92544dSBjoern A. Zeeb 
11376c92544dSBjoern A. Zeeb 	if (!mt7615_firmware_offload(dev))
11386c92544dSBjoern A. Zeeb 		return -EOPNOTSUPP;
11396c92544dSBjoern A. Zeeb 
11406c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
11416c92544dSBjoern A. Zeeb 
11426c92544dSBjoern A. Zeeb 	err = mt76_connac_mcu_sched_scan_req(mphy, vif, req);
11436c92544dSBjoern A. Zeeb 	if (err < 0)
11446c92544dSBjoern A. Zeeb 		goto out;
11456c92544dSBjoern A. Zeeb 
11466c92544dSBjoern A. Zeeb 	err = mt76_connac_mcu_sched_scan_enable(mphy, vif, true);
11476c92544dSBjoern A. Zeeb out:
11486c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
11496c92544dSBjoern A. Zeeb 
11506c92544dSBjoern A. Zeeb 	return err;
11516c92544dSBjoern A. Zeeb }
11526c92544dSBjoern A. Zeeb 
11536c92544dSBjoern A. Zeeb static int
mt7615_stop_sched_scan(struct ieee80211_hw * hw,struct ieee80211_vif * vif)11546c92544dSBjoern A. Zeeb mt7615_stop_sched_scan(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
11556c92544dSBjoern A. Zeeb {
11566c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
11576c92544dSBjoern A. Zeeb 	struct mt76_phy *mphy = hw->priv;
11586c92544dSBjoern A. Zeeb 	int err;
11596c92544dSBjoern A. Zeeb 
11606c92544dSBjoern A. Zeeb 	if (!mt7615_firmware_offload(dev))
11616c92544dSBjoern A. Zeeb 		return -EOPNOTSUPP;
11626c92544dSBjoern A. Zeeb 
11636c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
11646c92544dSBjoern A. Zeeb 	err = mt76_connac_mcu_sched_scan_enable(mphy, vif, false);
11656c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
11666c92544dSBjoern A. Zeeb 
11676c92544dSBjoern A. Zeeb 	return err;
11686c92544dSBjoern A. Zeeb }
11696c92544dSBjoern A. Zeeb 
mt7615_remain_on_channel(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct ieee80211_channel * chan,int duration,enum ieee80211_roc_type type)11706c92544dSBjoern A. Zeeb static int mt7615_remain_on_channel(struct ieee80211_hw *hw,
11716c92544dSBjoern A. Zeeb 				    struct ieee80211_vif *vif,
11726c92544dSBjoern A. Zeeb 				    struct ieee80211_channel *chan,
11736c92544dSBjoern A. Zeeb 				    int duration,
11746c92544dSBjoern A. Zeeb 				    enum ieee80211_roc_type type)
11756c92544dSBjoern A. Zeeb {
11766c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
11776c92544dSBjoern A. Zeeb 	int err;
11786c92544dSBjoern A. Zeeb 
11796c92544dSBjoern A. Zeeb 	if (test_and_set_bit(MT76_STATE_ROC, &phy->mt76->state))
11806c92544dSBjoern A. Zeeb 		return 0;
11816c92544dSBjoern A. Zeeb 
11826c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(phy->dev);
11836c92544dSBjoern A. Zeeb 
11846c92544dSBjoern A. Zeeb 	err = mt7615_mcu_set_roc(phy, vif, chan, duration);
11856c92544dSBjoern A. Zeeb 	if (err < 0) {
11866c92544dSBjoern A. Zeeb 		clear_bit(MT76_STATE_ROC, &phy->mt76->state);
11876c92544dSBjoern A. Zeeb 		goto out;
11886c92544dSBjoern A. Zeeb 	}
11896c92544dSBjoern A. Zeeb 
11906c92544dSBjoern A. Zeeb 	if (!wait_event_timeout(phy->roc_wait, phy->roc_grant, HZ)) {
11916c92544dSBjoern A. Zeeb 		mt7615_mcu_set_roc(phy, vif, NULL, 0);
11926c92544dSBjoern A. Zeeb 		clear_bit(MT76_STATE_ROC, &phy->mt76->state);
11936c92544dSBjoern A. Zeeb 		err = -ETIMEDOUT;
11946c92544dSBjoern A. Zeeb 	}
11956c92544dSBjoern A. Zeeb 
11966c92544dSBjoern A. Zeeb out:
11976c92544dSBjoern A. Zeeb 	mt7615_mutex_release(phy->dev);
11986c92544dSBjoern A. Zeeb 
11996c92544dSBjoern A. Zeeb 	return err;
12006c92544dSBjoern A. Zeeb }
12016c92544dSBjoern A. Zeeb 
mt7615_cancel_remain_on_channel(struct ieee80211_hw * hw,struct ieee80211_vif * vif)12026c92544dSBjoern A. Zeeb static int mt7615_cancel_remain_on_channel(struct ieee80211_hw *hw,
12036c92544dSBjoern A. Zeeb 					   struct ieee80211_vif *vif)
12046c92544dSBjoern A. Zeeb {
12056c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
12066c92544dSBjoern A. Zeeb 	int err;
12076c92544dSBjoern A. Zeeb 
12086c92544dSBjoern A. Zeeb 	if (!test_and_clear_bit(MT76_STATE_ROC, &phy->mt76->state))
12096c92544dSBjoern A. Zeeb 		return 0;
12106c92544dSBjoern A. Zeeb 
12116c92544dSBjoern A. Zeeb 	del_timer_sync(&phy->roc_timer);
12126c92544dSBjoern A. Zeeb 	cancel_work_sync(&phy->roc_work);
12136c92544dSBjoern A. Zeeb 
12146c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(phy->dev);
12156c92544dSBjoern A. Zeeb 	err = mt7615_mcu_set_roc(phy, vif, NULL, 0);
12166c92544dSBjoern A. Zeeb 	mt7615_mutex_release(phy->dev);
12176c92544dSBjoern A. Zeeb 
12186c92544dSBjoern A. Zeeb 	return err;
12196c92544dSBjoern A. Zeeb }
12206c92544dSBjoern A. Zeeb 
mt7615_sta_set_decap_offload(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct ieee80211_sta * sta,bool enabled)12216c92544dSBjoern A. Zeeb static void mt7615_sta_set_decap_offload(struct ieee80211_hw *hw,
12226c92544dSBjoern A. Zeeb 				 struct ieee80211_vif *vif,
12236c92544dSBjoern A. Zeeb 				 struct ieee80211_sta *sta,
12246c92544dSBjoern A. Zeeb 				 bool enabled)
12256c92544dSBjoern A. Zeeb {
12266c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
12276c92544dSBjoern A. Zeeb 	struct mt7615_sta *msta = (struct mt7615_sta *)sta->drv_priv;
12286c92544dSBjoern A. Zeeb 
12296c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
12306c92544dSBjoern A. Zeeb 
12316c92544dSBjoern A. Zeeb 	if (enabled)
12326c92544dSBjoern A. Zeeb 		set_bit(MT_WCID_FLAG_HDR_TRANS, &msta->wcid.flags);
12336c92544dSBjoern A. Zeeb 	else
12346c92544dSBjoern A. Zeeb 		clear_bit(MT_WCID_FLAG_HDR_TRANS, &msta->wcid.flags);
12356c92544dSBjoern A. Zeeb 
12366c92544dSBjoern A. Zeeb 	mt7615_mcu_set_sta_decap_offload(dev, vif, sta);
12376c92544dSBjoern A. Zeeb 
12386c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
12396c92544dSBjoern A. Zeeb }
12406c92544dSBjoern A. Zeeb 
12416c92544dSBjoern A. Zeeb #ifdef CONFIG_PM
mt7615_suspend(struct ieee80211_hw * hw,struct cfg80211_wowlan * wowlan)12426c92544dSBjoern A. Zeeb static int mt7615_suspend(struct ieee80211_hw *hw,
12436c92544dSBjoern A. Zeeb 			  struct cfg80211_wowlan *wowlan)
12446c92544dSBjoern A. Zeeb {
12456c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
12466c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
12476c92544dSBjoern A. Zeeb 	int err = 0;
12486c92544dSBjoern A. Zeeb 
12496c92544dSBjoern A. Zeeb 	cancel_delayed_work_sync(&dev->pm.ps_work);
12506c92544dSBjoern A. Zeeb 	mt76_connac_free_pending_tx_skbs(&dev->pm, NULL);
12516c92544dSBjoern A. Zeeb 
12526c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
12536c92544dSBjoern A. Zeeb 
12546c92544dSBjoern A. Zeeb 	clear_bit(MT76_STATE_RUNNING, &phy->mt76->state);
12556c92544dSBjoern A. Zeeb 	cancel_delayed_work_sync(&phy->scan_work);
12566c92544dSBjoern A. Zeeb 	cancel_delayed_work_sync(&phy->mt76->mac_work);
12576c92544dSBjoern A. Zeeb 
12586c92544dSBjoern A. Zeeb 	set_bit(MT76_STATE_SUSPEND, &phy->mt76->state);
12596c92544dSBjoern A. Zeeb 	ieee80211_iterate_active_interfaces(hw,
12606c92544dSBjoern A. Zeeb 					    IEEE80211_IFACE_ITER_RESUME_ALL,
12616c92544dSBjoern A. Zeeb 					    mt76_connac_mcu_set_suspend_iter,
12626c92544dSBjoern A. Zeeb 					    phy->mt76);
12636c92544dSBjoern A. Zeeb 
12646c92544dSBjoern A. Zeeb 	if (!mt7615_dev_running(dev))
12656c92544dSBjoern A. Zeeb 		err = mt76_connac_mcu_set_hif_suspend(&dev->mt76, true);
12666c92544dSBjoern A. Zeeb 
12676c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
12686c92544dSBjoern A. Zeeb 
12696c92544dSBjoern A. Zeeb 	return err;
12706c92544dSBjoern A. Zeeb }
12716c92544dSBjoern A. Zeeb 
mt7615_resume(struct ieee80211_hw * hw)12726c92544dSBjoern A. Zeeb static int mt7615_resume(struct ieee80211_hw *hw)
12736c92544dSBjoern A. Zeeb {
12746c92544dSBjoern A. Zeeb 	struct mt7615_phy *phy = mt7615_hw_phy(hw);
12756c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
12766c92544dSBjoern A. Zeeb 	unsigned long timeout;
12776c92544dSBjoern A. Zeeb 	bool running;
12786c92544dSBjoern A. Zeeb 
12796c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
12806c92544dSBjoern A. Zeeb 
12816c92544dSBjoern A. Zeeb 	running = mt7615_dev_running(dev);
12826c92544dSBjoern A. Zeeb 	set_bit(MT76_STATE_RUNNING, &phy->mt76->state);
12836c92544dSBjoern A. Zeeb 
12846c92544dSBjoern A. Zeeb 	if (!running) {
12856c92544dSBjoern A. Zeeb 		int err;
12866c92544dSBjoern A. Zeeb 
12876c92544dSBjoern A. Zeeb 		err = mt76_connac_mcu_set_hif_suspend(&dev->mt76, false);
12886c92544dSBjoern A. Zeeb 		if (err < 0) {
12896c92544dSBjoern A. Zeeb 			mt7615_mutex_release(dev);
12906c92544dSBjoern A. Zeeb 			return err;
12916c92544dSBjoern A. Zeeb 		}
12926c92544dSBjoern A. Zeeb 	}
12936c92544dSBjoern A. Zeeb 
12946c92544dSBjoern A. Zeeb 	clear_bit(MT76_STATE_SUSPEND, &phy->mt76->state);
12956c92544dSBjoern A. Zeeb 	ieee80211_iterate_active_interfaces(hw,
12966c92544dSBjoern A. Zeeb 					    IEEE80211_IFACE_ITER_RESUME_ALL,
12976c92544dSBjoern A. Zeeb 					    mt76_connac_mcu_set_suspend_iter,
12986c92544dSBjoern A. Zeeb 					    phy->mt76);
12996c92544dSBjoern A. Zeeb 
13006c92544dSBjoern A. Zeeb 	timeout = mt7615_get_macwork_timeout(dev);
13016c92544dSBjoern A. Zeeb 	ieee80211_queue_delayed_work(hw, &phy->mt76->mac_work, timeout);
13026c92544dSBjoern A. Zeeb 
13036c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
13046c92544dSBjoern A. Zeeb 
13056c92544dSBjoern A. Zeeb 	return 0;
13066c92544dSBjoern A. Zeeb }
13076c92544dSBjoern A. Zeeb 
mt7615_set_wakeup(struct ieee80211_hw * hw,bool enabled)13086c92544dSBjoern A. Zeeb static void mt7615_set_wakeup(struct ieee80211_hw *hw, bool enabled)
13096c92544dSBjoern A. Zeeb {
13106c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
13116c92544dSBjoern A. Zeeb 	struct mt76_dev *mdev = &dev->mt76;
13126c92544dSBjoern A. Zeeb 
13136c92544dSBjoern A. Zeeb 	device_set_wakeup_enable(mdev->dev, enabled);
13146c92544dSBjoern A. Zeeb }
13156c92544dSBjoern A. Zeeb 
mt7615_set_rekey_data(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct cfg80211_gtk_rekey_data * data)13166c92544dSBjoern A. Zeeb static void mt7615_set_rekey_data(struct ieee80211_hw *hw,
13176c92544dSBjoern A. Zeeb 				  struct ieee80211_vif *vif,
13186c92544dSBjoern A. Zeeb 				  struct cfg80211_gtk_rekey_data *data)
13196c92544dSBjoern A. Zeeb {
13206c92544dSBjoern A. Zeeb 	struct mt7615_dev *dev = mt7615_hw_dev(hw);
13216c92544dSBjoern A. Zeeb 
13226c92544dSBjoern A. Zeeb 	mt7615_mutex_acquire(dev);
13236c92544dSBjoern A. Zeeb 	mt76_connac_mcu_update_gtk_rekey(hw, vif, data);
13246c92544dSBjoern A. Zeeb 	mt7615_mutex_release(dev);
13256c92544dSBjoern A. Zeeb }
13266c92544dSBjoern A. Zeeb #endif /* CONFIG_PM */
13276c92544dSBjoern A. Zeeb 
13286c92544dSBjoern A. Zeeb const struct ieee80211_ops mt7615_ops = {
13296c92544dSBjoern A. Zeeb 	.tx = mt7615_tx,
13306c92544dSBjoern A. Zeeb 	.start = mt7615_start,
13316c92544dSBjoern A. Zeeb 	.stop = mt7615_stop,
13326c92544dSBjoern A. Zeeb 	.add_interface = mt7615_add_interface,
13336c92544dSBjoern A. Zeeb 	.remove_interface = mt7615_remove_interface,
13346c92544dSBjoern A. Zeeb 	.config = mt7615_config,
13356c92544dSBjoern A. Zeeb 	.conf_tx = mt7615_conf_tx,
13366c92544dSBjoern A. Zeeb 	.configure_filter = mt7615_configure_filter,
13376c92544dSBjoern A. Zeeb 	.bss_info_changed = mt7615_bss_info_changed,
13386c92544dSBjoern A. Zeeb 	.sta_add = mt7615_sta_add,
13396c92544dSBjoern A. Zeeb 	.sta_remove = mt7615_sta_remove,
13406c92544dSBjoern A. Zeeb 	.sta_pre_rcu_remove = mt76_sta_pre_rcu_remove,
13416c92544dSBjoern A. Zeeb 	.set_key = mt7615_set_key,
13426c92544dSBjoern A. Zeeb 	.sta_set_decap_offload = mt7615_sta_set_decap_offload,
13436c92544dSBjoern A. Zeeb 	.ampdu_action = mt7615_ampdu_action,
13446c92544dSBjoern A. Zeeb 	.set_rts_threshold = mt7615_set_rts_threshold,
13456c92544dSBjoern A. Zeeb 	.wake_tx_queue = mt76_wake_tx_queue,
13466c92544dSBjoern A. Zeeb 	.sta_rate_tbl_update = mt7615_sta_rate_tbl_update,
13476c92544dSBjoern A. Zeeb 	.sw_scan_start = mt76_sw_scan,
13486c92544dSBjoern A. Zeeb 	.sw_scan_complete = mt76_sw_scan_complete,
13496c92544dSBjoern A. Zeeb 	.release_buffered_frames = mt76_release_buffered_frames,
13506c92544dSBjoern A. Zeeb 	.get_txpower = mt76_get_txpower,
13516c92544dSBjoern A. Zeeb 	.channel_switch_beacon = mt7615_channel_switch_beacon,
13526c92544dSBjoern A. Zeeb 	.get_stats = mt7615_get_stats,
13536c92544dSBjoern A. Zeeb 	.get_tsf = mt7615_get_tsf,
13546c92544dSBjoern A. Zeeb 	.set_tsf = mt7615_set_tsf,
13556c92544dSBjoern A. Zeeb 	.offset_tsf = mt7615_offset_tsf,
13566c92544dSBjoern A. Zeeb 	.get_survey = mt76_get_survey,
13576c92544dSBjoern A. Zeeb 	.get_antenna = mt76_get_antenna,
13586c92544dSBjoern A. Zeeb 	.set_antenna = mt7615_set_antenna,
13596c92544dSBjoern A. Zeeb 	.set_coverage_class = mt7615_set_coverage_class,
13606c92544dSBjoern A. Zeeb 	.hw_scan = mt7615_hw_scan,
13616c92544dSBjoern A. Zeeb 	.cancel_hw_scan = mt7615_cancel_hw_scan,
13626c92544dSBjoern A. Zeeb 	.sched_scan_start = mt7615_start_sched_scan,
13636c92544dSBjoern A. Zeeb 	.sched_scan_stop = mt7615_stop_sched_scan,
13646c92544dSBjoern A. Zeeb 	.remain_on_channel = mt7615_remain_on_channel,
13656c92544dSBjoern A. Zeeb 	.cancel_remain_on_channel = mt7615_cancel_remain_on_channel,
13666c92544dSBjoern A. Zeeb 	CFG80211_TESTMODE_CMD(mt76_testmode_cmd)
13676c92544dSBjoern A. Zeeb 	CFG80211_TESTMODE_DUMP(mt76_testmode_dump)
13686c92544dSBjoern A. Zeeb #ifdef CONFIG_PM
13696c92544dSBjoern A. Zeeb 	.suspend = mt7615_suspend,
13706c92544dSBjoern A. Zeeb 	.resume = mt7615_resume,
13716c92544dSBjoern A. Zeeb 	.set_wakeup = mt7615_set_wakeup,
13726c92544dSBjoern A. Zeeb 	.set_rekey_data = mt7615_set_rekey_data,
13736c92544dSBjoern A. Zeeb #endif /* CONFIG_PM */
13746c92544dSBjoern A. Zeeb 	.set_sar_specs = mt7615_set_sar_specs,
13756c92544dSBjoern A. Zeeb };
13766c92544dSBjoern A. Zeeb EXPORT_SYMBOL_GPL(mt7615_ops);
13776c92544dSBjoern A. Zeeb 
13786c92544dSBjoern A. Zeeb MODULE_LICENSE("Dual BSD/GPL");
1379