public-mirrors/linux
1
0
Fork 0
mirror of git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git synced 2025-04-13 09:59:31 +00:00
Code Issues Projects Releases Packages Wiki Activity Actions

wifi: mt76: add WED RX support to mt76_dma_{add,get}_buf

Browse source 
Introduce the capability to configure RX WED in mt76_dma_{add,get}_buf
utility routines.

Tested-by: Daniel Golle <daniel@makrotopia.org>
Co-developed-by: Sujuan Chen <sujuan.chen@mediatek.com>
Signed-off-by: Sujuan Chen <sujuan.chen@mediatek.com>
Signed-off-by: Lorenzo Bianconi <lorenzo@kernel.org>
Signed-off-by: Felix Fietkau <nbd@nbd.name>
This commit is contained in:
Lorenzo Bianconi 2022-11-12 16:40:35 +01:00 • committed by Felix Fietkau
parent 2666bece09
commit cd372b8c99
2 changed files with 86 additions and 37 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

121
drivers/net/wireless/mediatek/mt76/dma.c
View file

@ -215,11 +215,6 @@ mt76_dma_add_buf(struct mt76_dev *dev, struct mt76_queue *q,
u32 ctrl; u32 ctrl;
int i, idx = -1; int i, idx = -1;
if (txwi) {
q->entry[q->head].txwi = DMA_DUMMY_DATA;
q->entry[q->head].skip_buf0 = true;
}
for (i = 0; i < nbufs; i += 2, buf += 2) { for (i = 0; i < nbufs; i += 2, buf += 2) {
u32 buf0 = buf[0].addr, buf1 = 0; u32 buf0 = buf[0].addr, buf1 = 0;
@ -229,28 +224,48 @@ mt76_dma_add_buf(struct mt76_dev *dev, struct mt76_queue *q,
desc = &q->desc[idx]; desc = &q->desc[idx];
entry = &q->entry[idx]; entry = &q->entry[idx];
if (buf[0].skip_unmap) if ((q->flags & MT_QFLAG_WED) &&
entry->skip_buf0 = true; FIELD_GET(MT_QFLAG_WED_TYPE, q->flags) == MT76_WED_Q_RX) {
entry->skip_buf1 = i == nbufs - 1; struct mt76_txwi_cache *t = txwi;
int rx_token;
entry->dma_addr[0] = buf[0].addr; if (!t)
entry->dma_len[0] = buf[0].len; return -ENOMEM;
ctrl = FIELD_PREP(MT_DMA_CTL_SD_LEN0, buf[0].len); rx_token = mt76_rx_token_consume(dev, (void *)skb, t,
if (i < nbufs - 1) { buf[0].addr);
entry->dma_addr[1] = buf[1].addr; buf1 |= FIELD_PREP(MT_DMA_CTL_TOKEN, rx_token);
entry->dma_len[1] = buf[1].len; ctrl = FIELD_PREP(MT_DMA_CTL_SD_LEN0, buf[0].len) |
buf1 = buf[1].addr; MT_DMA_CTL_TO_HOST;
ctrl |= FIELD_PREP(MT_DMA_CTL_SD_LEN1, buf[1].len); } else {
if (buf[1].skip_unmap) if (txwi) {
entry->skip_buf1 = true; q->entry[q->head].txwi = DMA_DUMMY_DATA;
q->entry[q->head].skip_buf0 = true;
}
if (buf[0].skip_unmap)
entry->skip_buf0 = true;
entry->skip_buf1 = i == nbufs - 1;
entry->dma_addr[0] = buf[0].addr;
entry->dma_len[0] = buf[0].len;
ctrl = FIELD_PREP(MT_DMA_CTL_SD_LEN0, buf[0].len);
if (i < nbufs - 1) {
entry->dma_addr[1] = buf[1].addr;
entry->dma_len[1] = buf[1].len;
buf1 = buf[1].addr;
ctrl |= FIELD_PREP(MT_DMA_CTL_SD_LEN1, buf[1].len);
if (buf[1].skip_unmap)
entry->skip_buf1 = true;
}
if (i == nbufs - 1)
ctrl |= MT_DMA_CTL_LAST_SEC0;
else if (i == nbufs - 2)
ctrl |= MT_DMA_CTL_LAST_SEC1;
} }
if (i == nbufs - 1)
ctrl |= MT_DMA_CTL_LAST_SEC0;
else if (i == nbufs - 2)
ctrl |= MT_DMA_CTL_LAST_SEC1;
WRITE_ONCE(desc->buf0, cpu_to_le32(buf0)); WRITE_ONCE(desc->buf0, cpu_to_le32(buf0));
WRITE_ONCE(desc->buf1, cpu_to_le32(buf1)); WRITE_ONCE(desc->buf1, cpu_to_le32(buf1));
WRITE_ONCE(desc->info, cpu_to_le32(info)); WRITE_ONCE(desc->info, cpu_to_le32(info));
@ -339,33 +354,60 @@ mt76_dma_tx_cleanup(struct mt76_dev *dev, struct mt76_queue *q, bool flush)
static void * static void *
mt76_dma_get_buf(struct mt76_dev *dev, struct mt76_queue *q, int idx, mt76_dma_get_buf(struct mt76_dev *dev, struct mt76_queue *q, int idx,
int *len, u32 *info, bool *more) int *len, u32 *info, bool *more, bool *drop)
{ {
struct mt76_queue_entry *e = &q->entry[idx]; struct mt76_queue_entry *e = &q->entry[idx];
struct mt76_desc *desc = &q->desc[idx]; struct mt76_desc *desc = &q->desc[idx];
dma_addr_t buf_addr; void *buf;
void *buf = e->buf;
int buf_len = SKB_WITH_OVERHEAD(q->buf_size);
buf_addr = e->dma_addr[0];
if (len) { if (len) {
u32 ctl = le32_to_cpu(READ_ONCE(desc->ctrl)); u32 ctrl = le32_to_cpu(READ_ONCE(desc->ctrl));
*len = FIELD_GET(MT_DMA_CTL_SD_LEN0, ctl); *len = FIELD_GET(MT_DMA_CTL_SD_LEN0, ctrl);
*more = !(ctl & MT_DMA_CTL_LAST_SEC0); *more = !(ctrl & MT_DMA_CTL_LAST_SEC0);
} }
if (info) if (info)
*info = le32_to_cpu(desc->info); *info = le32_to_cpu(desc->info);
dma_unmap_single(dev->dma_dev, buf_addr, buf_len, DMA_FROM_DEVICE); if ((q->flags & MT_QFLAG_WED) &&
e->buf = NULL; FIELD_GET(MT_QFLAG_WED_TYPE, q->flags) == MT76_WED_Q_RX) {
u32 token = FIELD_GET(MT_DMA_CTL_TOKEN,
le32_to_cpu(desc->buf1));
struct mt76_txwi_cache *t = mt76_rx_token_release(dev, token);
if (!t)
return NULL;
dma_unmap_single(dev->dma_dev, t->dma_addr,
SKB_WITH_OVERHEAD(q->buf_size),
DMA_FROM_DEVICE);
buf = t->ptr;
t->dma_addr = 0;
t->ptr = NULL;
mt76_put_rxwi(dev, t);
if (drop) {
u32 ctrl = le32_to_cpu(READ_ONCE(desc->ctrl));
*drop = !!(ctrl & (MT_DMA_CTL_TO_HOST_A |
MT_DMA_CTL_DROP));
}
} else {
buf = e->buf;
e->buf = NULL;
dma_unmap_single(dev->dma_dev, e->dma_addr[0],
SKB_WITH_OVERHEAD(q->buf_size),
DMA_FROM_DEVICE);
}
return buf; return buf;
} }
static void * static void *
mt76_dma_dequeue(struct mt76_dev *dev, struct mt76_queue *q, bool flush, mt76_dma_dequeue(struct mt76_dev *dev, struct mt76_queue *q, bool flush,
int *len, u32 *info, bool *more) int *len, u32 *info, bool *more, bool *drop)
{ {
int idx = q->tail; int idx = q->tail;
@ -381,7 +423,7 @@ mt76_dma_dequeue(struct mt76_dev *dev, struct mt76_queue *q, bool flush,
q->tail = (q->tail + 1) % q->ndesc; q->tail = (q->tail + 1) % q->ndesc;
q->queued--; q->queued--;
return mt76_dma_get_buf(dev, q, idx, len, info, more); return mt76_dma_get_buf(dev, q, idx, len, info, more, drop);
} }
static int static int
@ -641,7 +683,7 @@ mt76_dma_rx_cleanup(struct mt76_dev *dev, struct mt76_queue *q)
spin_lock_bh(&q->lock); spin_lock_bh(&q->lock);
do { do {
buf = mt76_dma_dequeue(dev, q, true, NULL, NULL, &more); buf = mt76_dma_dequeue(dev, q, true, NULL, NULL, &more, NULL);
if (!buf) if (!buf)
break; break;
@ -723,6 +765,7 @@ mt76_dma_rx_process(struct mt76_dev *dev, struct mt76_queue *q, int budget)
} }
while (done < budget) { while (done < budget) {
bool drop = false;
u32 info; u32 info;
if (check_ddone) { if (check_ddone) {
@ -733,10 +776,14 @@ mt76_dma_rx_process(struct mt76_dev *dev, struct mt76_queue *q, int budget)
break; break;
} }
data = mt76_dma_dequeue(dev, q, false, &len, &info, &more); data = mt76_dma_dequeue(dev, q, false, &len, &info, &more,
&drop);
if (!data) if (!data)
break; break;
if (drop)
goto free_frag;
if (q->rx_head) if (q->rx_head)
data_len = q->buf_size; data_len = q->buf_size;
else else

2
drivers/net/wireless/mediatek/mt76/mt76.h
View file

@ -35,6 +35,7 @@
FIELD_PREP(MT_QFLAG_WED_TYPE, _type) | \ FIELD_PREP(MT_QFLAG_WED_TYPE, _type) | \
FIELD_PREP(MT_QFLAG_WED_RING, _n)) FIELD_PREP(MT_QFLAG_WED_RING, _n))
#define MT_WED_Q_TX(_n) __MT_WED_Q(MT76_WED_Q_TX, _n) #define MT_WED_Q_TX(_n) __MT_WED_Q(MT76_WED_Q_TX, _n)
#define MT_WED_Q_RX(_n) __MT_WED_Q(MT76_WED_Q_RX, _n)
#define MT_WED_Q_TXFREE __MT_WED_Q(MT76_WED_Q_TXFREE, 0) #define MT_WED_Q_TXFREE __MT_WED_Q(MT76_WED_Q_TXFREE, 0)
struct mt76_dev; struct mt76_dev;
@ -56,6 +57,7 @@ enum mt76_bus_type {
enum mt76_wed_type { enum mt76_wed_type {
MT76_WED_Q_TX, MT76_WED_Q_TX,
MT76_WED_Q_TXFREE, MT76_WED_Q_TXFREE,
MT76_WED_Q_RX,
}; };
struct mt76_bus_ops { struct mt76_bus_ops {