| 1 |
// SPDX-License-Identifier: BSD-3-Clause-Clear |
| 2 |
/* Copyright (C) 2023 MediaTek Inc. */ |
| 3 |
|
| 4 |
#include "mt7925.h" |
| 5 |
#include "../dma.h" |
| 6 |
#include "mac.h" |
| 7 |
|
| 8 |
int mt7925e_tx_prepare_skb(struct mt76_dev *mdev, void *txwi_ptr, |
| 9 |
enum mt76_txq_id qid, struct mt76_wcid *wcid, |
| 10 |
struct ieee80211_sta *sta, |
| 11 |
struct mt76_tx_info *tx_info) |
| 12 |
{ |
| 13 |
struct mt792x_dev *dev = container_of(mdev, struct mt792x_dev, mt76); |
| 14 |
struct ieee80211_tx_info *info = IEEE80211_SKB_CB(tx_info->skb); |
| 15 |
struct ieee80211_key_conf *key = info->control.hw_key; |
| 16 |
struct mt76_connac_hw_txp *txp; |
| 17 |
struct mt76_txwi_cache *t; |
| 18 |
int id, pid; |
| 19 |
u8 *txwi = (u8 *)txwi_ptr; |
| 20 |
|
| 21 |
if (unlikely(tx_info->skb->len <= ETH_HLEN)) |
| 22 |
return -EINVAL; |
| 23 |
|
| 24 |
if (!wcid) |
| 25 |
wcid = &dev->mt76.global_wcid; |
| 26 |
|
| 27 |
t = (struct mt76_txwi_cache *)(txwi + mdev->drv->txwi_size); |
| 28 |
t->skb = tx_info->skb; |
| 29 |
|
| 30 |
id = mt76_token_consume(mdev, &t); |
| 31 |
if (id < 0) |
| 32 |
return id; |
| 33 |
|
| 34 |
if (sta) { |
| 35 |
struct mt792x_sta *msta = (struct mt792x_sta *)sta->drv_priv; |
| 36 |
|
| 37 |
if (time_after(jiffies, msta->deflink.last_txs + HZ / 4)) { |
| 38 |
info->flags |= IEEE80211_TX_CTL_REQ_TX_STATUS; |
| 39 |
msta->deflink.last_txs = jiffies; |
| 40 |
} |
| 41 |
} |
| 42 |
|
| 43 |
pid = mt76_tx_status_skb_add(mdev, wcid, tx_info->skb); |
| 44 |
mt7925_mac_write_txwi(mdev, txwi_ptr, tx_info->skb, wcid, key, |
| 45 |
pid, qid, 0); |
| 46 |
|
| 47 |
txp = (struct mt76_connac_hw_txp *)(txwi + MT_TXD_SIZE); |
| 48 |
memset(txp, 0, sizeof(struct mt76_connac_hw_txp)); |
| 49 |
mt76_connac_write_hw_txp(mdev, tx_info, txp, id); |
| 50 |
|
| 51 |
tx_info->skb = NULL; |
| 52 |
|
| 53 |
return 0; |
| 54 |
} |
| 55 |
|
| 56 |
void mt7925_tx_token_put(struct mt792x_dev *dev) |
| 57 |
{ |
| 58 |
struct mt76_txwi_cache *txwi; |
| 59 |
int id; |
| 60 |
|
| 61 |
spin_lock_bh(&dev->mt76.token_lock); |
| 62 |
idr_for_each_entry(&dev->mt76.token, txwi, id) { |
| 63 |
mt7925_txwi_free(dev, txwi, NULL, NULL, NULL); |
| 64 |
dev->mt76.token_count--; |
| 65 |
} |
| 66 |
spin_unlock_bh(&dev->mt76.token_lock); |
| 67 |
idr_destroy(&dev->mt76.token); |
| 68 |
} |
| 69 |
|
| 70 |
int mt7925e_mac_reset(struct mt792x_dev *dev) |
| 71 |
{ |
| 72 |
const struct mt792x_irq_map *irq_map = dev->irq_map; |
| 73 |
int i, err; |
| 74 |
|
| 75 |
mt792xe_mcu_drv_pmctrl(dev); |
| 76 |
|
| 77 |
mt76_connac_free_pending_tx_skbs(&dev->pm, NULL); |
| 78 |
|
| 79 |
mt76_wr(dev, dev->irq_map->host_irq_enable, 0); |
| 80 |
mt76_wr(dev, MT_PCIE_MAC_INT_ENABLE, 0x0); |
| 81 |
|
| 82 |
set_bit(MT76_RESET, &dev->mphy.state); |
| 83 |
set_bit(MT76_MCU_RESET, &dev->mphy.state); |
| 84 |
wake_up(&dev->mt76.mcu.wait); |
| 85 |
skb_queue_purge(&dev->mt76.mcu.res_q); |
| 86 |
|
| 87 |
mt76_txq_schedule_all(&dev->mphy); |
| 88 |
|
| 89 |
mt76_worker_disable(&dev->mt76.tx_worker); |
| 90 |
if (irq_map->rx.data_complete_mask) |
| 91 |
napi_disable(&dev->mt76.napi[MT_RXQ_MAIN]); |
| 92 |
if (irq_map->rx.wm_complete_mask) |
| 93 |
napi_disable(&dev->mt76.napi[MT_RXQ_MCU]); |
| 94 |
if (irq_map->rx.wm2_complete_mask) |
| 95 |
napi_disable(&dev->mt76.napi[MT_RXQ_MCU_WA]); |
| 96 |
if (irq_map->tx.all_complete_mask) |
| 97 |
napi_disable(&dev->mt76.tx_napi); |
| 98 |
|
| 99 |
mt7925_tx_token_put(dev); |
| 100 |
idr_init(&dev->mt76.token); |
| 101 |
|
| 102 |
mt792x_wpdma_reset(dev, true); |
| 103 |
|
| 104 |
mt76_for_each_q_rx(&dev->mt76, i) { |
| 105 |
napi_enable(&dev->mt76.napi[i]); |
| 106 |
} |
| 107 |
napi_enable(&dev->mt76.tx_napi); |
| 108 |
|
| 109 |
local_bh_disable(); |
| 110 |
mt76_for_each_q_rx(&dev->mt76, i) { |
| 111 |
napi_schedule(&dev->mt76.napi[i]); |
| 112 |
} |
| 113 |
napi_schedule(&dev->mt76.tx_napi); |
| 114 |
local_bh_enable(); |
| 115 |
|
| 116 |
dev->fw_assert = false; |
| 117 |
clear_bit(MT76_MCU_RESET, &dev->mphy.state); |
| 118 |
|
| 119 |
mt76_wr(dev, dev->irq_map->host_irq_enable, |
| 120 |
dev->irq_map->tx.all_complete_mask | |
| 121 |
MT_INT_RX_DONE_ALL | MT_INT_MCU_CMD); |
| 122 |
mt76_wr(dev, MT_PCIE_MAC_INT_ENABLE, 0xff); |
| 123 |
|
| 124 |
err = mt792xe_mcu_fw_pmctrl(dev); |
| 125 |
if (err) |
| 126 |
return err; |
| 127 |
|
| 128 |
err = __mt792xe_mcu_drv_pmctrl(dev); |
| 129 |
if (err) |
| 130 |
goto out; |
| 131 |
|
| 132 |
err = mt7925_run_firmware(dev); |
| 133 |
if (err) |
| 134 |
goto out; |
| 135 |
|
| 136 |
err = mt7925_mcu_set_eeprom(dev); |
| 137 |
if (err) |
| 138 |
goto out; |
| 139 |
|
| 140 |
err = mt7925_mac_init(dev); |
| 141 |
if (err) |
| 142 |
goto out; |
| 143 |
|
| 144 |
err = __mt7925_start(&dev->phy); |
| 145 |
out: |
| 146 |
clear_bit(MT76_RESET, &dev->mphy.state); |
| 147 |
|
| 148 |
mt76_worker_enable(&dev->mt76.tx_worker); |
| 149 |
|
| 150 |
return err; |
| 151 |
} |