mirror of
https://github.com/outbackdingo/mt76.git
synced 2026-10-24 13:26:48 +00:00
Deren WuandFelix Fietkau
eb278f9863
We are introducing a new structure, mt792x_link_sta, to manage per-link configurations in preparation for future station (STA) support of Multi-Link Operation (MLO). This patch only includes structural changes and does not involve any logic changes. We have moved relevant parameters, such as the wcid from the mt76_wcid structure, from the mt7921x_sta structure to the mt792x_link_sta structure. For current drivers that do not support MLO, there is only one link STA, and link information is accessed via the deflink member. However, we have not yet created the per-link BSS configuration indexed by link ID for Multi-Link Device (MLD) support in mt7921x_sta. This step needs to be completed before adding MLD support for STA mode. Co-developed-by: Sean Wang <[email protected]> Signed-off-by: Sean Wang <[email protected]> Signed-off-by: Deren Wu <[email protected]> Link: https://patch.msgid.link/[email protected] Signed-off-by: Felix Fietkau <[email protected]>
127 lines
2.9 KiB
C
127 lines
2.9 KiB
C
// SPDX-License-Identifier: ISC
|
|
/* Copyright (C) 2021 MediaTek Inc. */
|
|
|
|
#include "mt7921.h"
|
|
#include "../dma.h"
|
|
#include "../mt76_connac2_mac.h"
|
|
|
|
int mt7921e_tx_prepare_skb(struct mt76_dev *mdev, void *txwi_ptr,
|
|
enum mt76_txq_id qid, struct mt76_wcid *wcid,
|
|
struct ieee80211_sta *sta,
|
|
struct mt76_tx_info *tx_info)
|
|
{
|
|
struct mt792x_dev *dev = container_of(mdev, struct mt792x_dev, mt76);
|
|
struct ieee80211_tx_info *info = IEEE80211_SKB_CB(tx_info->skb);
|
|
struct ieee80211_key_conf *key = info->control.hw_key;
|
|
struct mt76_connac_hw_txp *txp;
|
|
struct mt76_txwi_cache *t;
|
|
int id, pid;
|
|
u8 *txwi = (u8 *)txwi_ptr;
|
|
|
|
if (unlikely(tx_info->skb->len <= ETH_HLEN))
|
|
return -EINVAL;
|
|
|
|
if (!wcid)
|
|
wcid = &dev->mt76.global_wcid;
|
|
|
|
t = (struct mt76_txwi_cache *)(txwi + mdev->drv->txwi_size);
|
|
t->skb = tx_info->skb;
|
|
|
|
id = mt76_token_consume(mdev, &t);
|
|
if (id < 0)
|
|
return id;
|
|
|
|
if (sta) {
|
|
struct mt792x_sta *msta = (struct mt792x_sta *)sta->drv_priv;
|
|
|
|
if (time_after(jiffies, msta->deflink.last_txs + HZ / 4)) {
|
|
info->flags |= IEEE80211_TX_CTL_REQ_TX_STATUS;
|
|
msta->deflink.last_txs = jiffies;
|
|
}
|
|
}
|
|
|
|
pid = mt76_tx_status_skb_add(mdev, wcid, tx_info->skb);
|
|
mt76_connac2_mac_write_txwi(mdev, txwi_ptr, tx_info->skb, wcid, key,
|
|
pid, qid, 0);
|
|
|
|
txp = (struct mt76_connac_hw_txp *)(txwi + MT_TXD_SIZE);
|
|
memset(txp, 0, sizeof(struct mt76_connac_hw_txp));
|
|
mt76_connac_write_hw_txp(mdev, tx_info, txp, id);
|
|
|
|
tx_info->skb = NULL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int mt7921e_mac_reset(struct mt792x_dev *dev)
|
|
{
|
|
int i, err;
|
|
|
|
mt792xe_mcu_drv_pmctrl(dev);
|
|
|
|
mt76_connac_free_pending_tx_skbs(&dev->pm, NULL);
|
|
|
|
mt76_wr(dev, dev->irq_map->host_irq_enable, 0);
|
|
mt76_wr(dev, MT_PCIE_MAC_INT_ENABLE, 0x0);
|
|
|
|
set_bit(MT76_MCU_RESET, &dev->mphy.state);
|
|
wake_up(&dev->mt76.mcu.wait);
|
|
skb_queue_purge(&dev->mt76.mcu.res_q);
|
|
|
|
mt76_txq_schedule_all(&dev->mphy);
|
|
|
|
mt76_worker_disable(&dev->mt76.tx_worker);
|
|
napi_disable(&dev->mt76.napi[MT_RXQ_MAIN]);
|
|
napi_disable(&dev->mt76.napi[MT_RXQ_MCU]);
|
|
napi_disable(&dev->mt76.napi[MT_RXQ_MCU_WA]);
|
|
napi_disable(&dev->mt76.tx_napi);
|
|
|
|
mt76_connac2_tx_token_put(&dev->mt76);
|
|
idr_init(&dev->mt76.token);
|
|
|
|
mt792x_wpdma_reset(dev, true);
|
|
|
|
local_bh_disable();
|
|
mt76_for_each_q_rx(&dev->mt76, i) {
|
|
napi_enable(&dev->mt76.napi[i]);
|
|
napi_schedule(&dev->mt76.napi[i]);
|
|
}
|
|
local_bh_enable();
|
|
|
|
dev->fw_assert = false;
|
|
clear_bit(MT76_MCU_RESET, &dev->mphy.state);
|
|
|
|
mt76_wr(dev, dev->irq_map->host_irq_enable,
|
|
dev->irq_map->tx.all_complete_mask |
|
|
MT_INT_RX_DONE_ALL | MT_INT_MCU_CMD);
|
|
mt76_wr(dev, MT_PCIE_MAC_INT_ENABLE, 0xff);
|
|
|
|
err = mt7921e_driver_own(dev);
|
|
if (err)
|
|
goto out;
|
|
|
|
err = mt7921_run_firmware(dev);
|
|
if (err)
|
|
goto out;
|
|
|
|
err = mt7921_mcu_set_eeprom(dev);
|
|
if (err)
|
|
goto out;
|
|
|
|
err = mt7921_mac_init(dev);
|
|
if (err)
|
|
goto out;
|
|
|
|
err = __mt7921_start(&dev->phy);
|
|
out:
|
|
|
|
local_bh_disable();
|
|
napi_enable(&dev->mt76.tx_napi);
|
|
napi_schedule(&dev->mt76.tx_napi);
|
|
local_bh_enable();
|
|
|
|
mt76_worker_enable(&dev->mt76.tx_worker);
|
|
|
|
return err;
|
|
}
|