mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-04 20:46:42 +07:00
p54spi: fix p54spi_tx_frame DMA transfer initiation and skb cleanup
p54spi_tx_frame wasn't waiting for HOST_ALLOWED in SPI_ADRS_DMA_WRITE_CTRL. This resulted in frequent 'WR_READY timeout' on beacon resubmission. Also don't free skb on error path, as it gets freed on p54spi_wq_tx. Signed-off-by: Max Filippov <jcmvbkbc@gmail.com> Acked-by: Christian Lamparter <chunkeey@web.de> Signed-off-by: John W. Linville <linville@tuxdriver.com>
This commit is contained in:
parent
684d6b3602
commit
4f5cab969b
@ -179,6 +179,25 @@ static int p54spi_wait_bit(struct p54s_priv *priv, u16 reg, __le32 bits)
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int p54spi_spi_write_dma(struct p54s_priv *priv, __le32 base,
|
||||
const void *buf, size_t len)
|
||||
{
|
||||
p54spi_write16(priv, SPI_ADRS_DMA_WRITE_CTRL,
|
||||
cpu_to_le16(SPI_DMA_WRITE_CTRL_ENABLE));
|
||||
|
||||
if (p54spi_wait_bit(priv, SPI_ADRS_DMA_WRITE_CTRL,
|
||||
cpu_to_le32(HOST_ALLOWED)) == 0) {
|
||||
dev_err(&priv->spi->dev, "spi_write_dma not allowed "
|
||||
"to DMA write.");
|
||||
return -EAGAIN;
|
||||
}
|
||||
|
||||
p54spi_write16(priv, SPI_ADRS_DMA_WRITE_LEN, cpu_to_le16(len));
|
||||
p54spi_write32(priv, SPI_ADRS_DMA_WRITE_BASE, base);
|
||||
p54spi_spi_write(priv, SPI_ADRS_DMA_DATA, buf, len);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int p54spi_request_firmware(struct ieee80211_hw *dev)
|
||||
{
|
||||
struct p54s_priv *priv = dev->priv;
|
||||
@ -254,24 +273,11 @@ static int p54spi_upload_firmware(struct ieee80211_hw *dev)
|
||||
while (fw_len > 0) {
|
||||
_fw_len = min_t(long, fw_len, SPI_MAX_PACKET_SIZE);
|
||||
|
||||
p54spi_write16(priv, SPI_ADRS_DMA_WRITE_CTRL,
|
||||
cpu_to_le16(SPI_DMA_WRITE_CTRL_ENABLE));
|
||||
|
||||
if (p54spi_wait_bit(priv, SPI_ADRS_DMA_WRITE_CTRL,
|
||||
cpu_to_le32(HOST_ALLOWED)) == 0) {
|
||||
dev_err(&priv->spi->dev, "fw_upload not allowed "
|
||||
"to DMA write.");
|
||||
err = -EAGAIN;
|
||||
err = p54spi_spi_write_dma(priv, cpu_to_le32(
|
||||
ISL38XX_DEV_FIRMWARE_ADDR + offset),
|
||||
(fw + offset), _fw_len);
|
||||
if (err < 0)
|
||||
goto out;
|
||||
}
|
||||
|
||||
p54spi_write16(priv, SPI_ADRS_DMA_WRITE_LEN,
|
||||
cpu_to_le16(_fw_len));
|
||||
p54spi_write32(priv, SPI_ADRS_DMA_WRITE_BASE, cpu_to_le32(
|
||||
ISL38XX_DEV_FIRMWARE_ADDR + offset));
|
||||
|
||||
p54spi_spi_write(priv, SPI_ADRS_DMA_DATA,
|
||||
(fw + offset), _fw_len);
|
||||
|
||||
fw_len -= _fw_len;
|
||||
offset += _fw_len;
|
||||
@ -418,27 +424,21 @@ static irqreturn_t p54spi_interrupt(int irq, void *config)
|
||||
static int p54spi_tx_frame(struct p54s_priv *priv, struct sk_buff *skb)
|
||||
{
|
||||
struct p54_hdr *hdr = (struct p54_hdr *) skb->data;
|
||||
struct p54s_dma_regs dma_regs;
|
||||
unsigned long timeout;
|
||||
int ret = 0;
|
||||
u32 ints;
|
||||
|
||||
p54spi_wakeup(priv);
|
||||
|
||||
dma_regs.cmd = cpu_to_le16(SPI_DMA_WRITE_CTRL_ENABLE);
|
||||
dma_regs.len = cpu_to_le16(skb->len);
|
||||
dma_regs.addr = hdr->req_id;
|
||||
|
||||
p54spi_spi_write(priv, SPI_ADRS_DMA_WRITE_CTRL, &dma_regs,
|
||||
sizeof(dma_regs));
|
||||
|
||||
p54spi_spi_write(priv, SPI_ADRS_DMA_DATA, skb->data, skb->len);
|
||||
ret = p54spi_spi_write_dma(priv, hdr->req_id, skb->data, skb->len);
|
||||
if (ret < 0)
|
||||
goto out;
|
||||
|
||||
timeout = jiffies + 2 * HZ;
|
||||
ints = p54spi_read32(priv, SPI_ADRS_HOST_INTERRUPTS);
|
||||
while (!(ints & SPI_HOST_INT_WR_READY)) {
|
||||
if (time_after(jiffies, timeout)) {
|
||||
dev_err(&priv->spi->dev, "WR_READY timeout");
|
||||
dev_err(&priv->spi->dev, "WR_READY timeout\n");
|
||||
ret = -1;
|
||||
goto out;
|
||||
}
|
||||
@ -448,9 +448,9 @@ static int p54spi_tx_frame(struct p54s_priv *priv, struct sk_buff *skb)
|
||||
p54spi_int_ack(priv, SPI_HOST_INT_WR_READY);
|
||||
p54spi_sleep(priv);
|
||||
|
||||
out:
|
||||
if (FREE_AFTER_TX(skb))
|
||||
p54_free_skb(priv->hw, skb);
|
||||
out:
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
Loading…
Reference in New Issue
Block a user