583 lines
15 KiB
C
583 lines
15 KiB
C
// SPDX-License-Identifier: (GPL-2.0 OR MIT)
|
|
/*
|
|
* Copyright (c) 2018 Synopsys, Inc. and/or its affiliates.
|
|
* stmmac XGMAC support.
|
|
*/
|
|
|
|
#include <linux/iopoll.h>
|
|
#include "stmmac.h"
|
|
#include "dwxgmac2.h"
|
|
|
|
static int dwxgmac2_dma_reset(void __iomem *ioaddr)
|
|
{
|
|
u32 value = readl(ioaddr + XGMAC_DMA_MODE);
|
|
|
|
/* DMA SW reset */
|
|
writel(value | XGMAC_SWR, ioaddr + XGMAC_DMA_MODE);
|
|
|
|
return readl_poll_timeout(ioaddr + XGMAC_DMA_MODE, value,
|
|
!(value & XGMAC_SWR), 0, 100000);
|
|
}
|
|
|
|
static void dwxgmac2_dma_init(void __iomem *ioaddr,
|
|
struct stmmac_dma_cfg *dma_cfg, int atds)
|
|
{
|
|
u32 value = readl(ioaddr + XGMAC_DMA_SYSBUS_MODE);
|
|
|
|
if (dma_cfg->aal)
|
|
value |= XGMAC_AAL;
|
|
|
|
if (dma_cfg->eame)
|
|
value |= XGMAC_EAME;
|
|
|
|
writel(value, ioaddr + XGMAC_DMA_SYSBUS_MODE);
|
|
}
|
|
|
|
static void dwxgmac2_dma_init_chan(void __iomem *ioaddr,
|
|
struct stmmac_dma_cfg *dma_cfg, u32 chan)
|
|
{
|
|
u32 value = readl(ioaddr + XGMAC_DMA_CH_CONTROL(chan));
|
|
|
|
if (dma_cfg->pblx8)
|
|
value |= XGMAC_PBLx8;
|
|
|
|
writel(value, ioaddr + XGMAC_DMA_CH_CONTROL(chan));
|
|
writel(XGMAC_DMA_INT_DEFAULT_EN, ioaddr + XGMAC_DMA_CH_INT_EN(chan));
|
|
}
|
|
|
|
static void dwxgmac2_dma_init_rx_chan(void __iomem *ioaddr,
|
|
struct stmmac_dma_cfg *dma_cfg,
|
|
dma_addr_t phy, u32 chan)
|
|
{
|
|
u32 rxpbl = dma_cfg->rxpbl ?: dma_cfg->pbl;
|
|
u32 value;
|
|
|
|
value = readl(ioaddr + XGMAC_DMA_CH_RX_CONTROL(chan));
|
|
value &= ~XGMAC_RxPBL;
|
|
value |= (rxpbl << XGMAC_RxPBL_SHIFT) & XGMAC_RxPBL;
|
|
writel(value, ioaddr + XGMAC_DMA_CH_RX_CONTROL(chan));
|
|
|
|
writel(upper_32_bits(phy), ioaddr + XGMAC_DMA_CH_RxDESC_HADDR(chan));
|
|
writel(lower_32_bits(phy), ioaddr + XGMAC_DMA_CH_RxDESC_LADDR(chan));
|
|
}
|
|
|
|
static void dwxgmac2_dma_init_tx_chan(void __iomem *ioaddr,
|
|
struct stmmac_dma_cfg *dma_cfg,
|
|
dma_addr_t phy, u32 chan)
|
|
{
|
|
u32 txpbl = dma_cfg->txpbl ?: dma_cfg->pbl;
|
|
u32 value;
|
|
|
|
value = readl(ioaddr + XGMAC_DMA_CH_TX_CONTROL(chan));
|
|
value &= ~XGMAC_TxPBL;
|
|
value |= (txpbl << XGMAC_TxPBL_SHIFT) & XGMAC_TxPBL;
|
|
value |= XGMAC_OSP;
|
|
writel(value, ioaddr + XGMAC_DMA_CH_TX_CONTROL(chan));
|
|
|
|
writel(upper_32_bits(phy), ioaddr + XGMAC_DMA_CH_TxDESC_HADDR(chan));
|
|
writel(lower_32_bits(phy), ioaddr + XGMAC_DMA_CH_TxDESC_LADDR(chan));
|
|
}
|
|
|
|
static void dwxgmac2_dma_axi(void __iomem *ioaddr, struct stmmac_axi *axi)
|
|
{
|
|
u32 value = readl(ioaddr + XGMAC_DMA_SYSBUS_MODE);
|
|
int i;
|
|
|
|
if (axi->axi_lpi_en)
|
|
value |= XGMAC_EN_LPI;
|
|
if (axi->axi_xit_frm)
|
|
value |= XGMAC_LPI_XIT_PKT;
|
|
|
|
value &= ~XGMAC_WR_OSR_LMT;
|
|
value |= (axi->axi_wr_osr_lmt << XGMAC_WR_OSR_LMT_SHIFT) &
|
|
XGMAC_WR_OSR_LMT;
|
|
|
|
value &= ~XGMAC_RD_OSR_LMT;
|
|
value |= (axi->axi_rd_osr_lmt << XGMAC_RD_OSR_LMT_SHIFT) &
|
|
XGMAC_RD_OSR_LMT;
|
|
|
|
if (!axi->axi_fb)
|
|
value |= XGMAC_UNDEF;
|
|
|
|
value &= ~XGMAC_BLEN;
|
|
for (i = 0; i < AXI_BLEN; i++) {
|
|
switch (axi->axi_blen[i]) {
|
|
case 256:
|
|
value |= XGMAC_BLEN256;
|
|
break;
|
|
case 128:
|
|
value |= XGMAC_BLEN128;
|
|
break;
|
|
case 64:
|
|
value |= XGMAC_BLEN64;
|
|
break;
|
|
case 32:
|
|
value |= XGMAC_BLEN32;
|
|
break;
|
|
case 16:
|
|
value |= XGMAC_BLEN16;
|
|
break;
|
|
case 8:
|
|
value |= XGMAC_BLEN8;
|
|
break;
|
|
case 4:
|
|
value |= XGMAC_BLEN4;
|
|
break;
|
|
}
|
|
}
|
|
|
|
writel(value, ioaddr + XGMAC_DMA_SYSBUS_MODE);
|
|
writel(XGMAC_TDPS, ioaddr + XGMAC_TX_EDMA_CTRL);
|
|
writel(XGMAC_RDPS, ioaddr + XGMAC_RX_EDMA_CTRL);
|
|
}
|
|
|
|
static void dwxgmac2_dma_dump_regs(void __iomem *ioaddr, u32 *reg_space)
|
|
{
|
|
int i;
|
|
|
|
for (i = (XGMAC_DMA_MODE / 4); i < XGMAC_REGSIZE; i++)
|
|
reg_space[i] = readl(ioaddr + i * 4);
|
|
}
|
|
|
|
static void dwxgmac2_dma_rx_mode(void __iomem *ioaddr, int mode,
|
|
u32 channel, int fifosz, u8 qmode)
|
|
{
|
|
u32 value = readl(ioaddr + XGMAC_MTL_RXQ_OPMODE(channel));
|
|
unsigned int rqs = fifosz / 256 - 1;
|
|
|
|
if (mode == SF_DMA_MODE) {
|
|
value |= XGMAC_RSF;
|
|
} else {
|
|
value &= ~XGMAC_RSF;
|
|
value &= ~XGMAC_RTC;
|
|
|
|
if (mode <= 64)
|
|
value |= 0x0 << XGMAC_RTC_SHIFT;
|
|
else if (mode <= 96)
|
|
value |= 0x2 << XGMAC_RTC_SHIFT;
|
|
else
|
|
value |= 0x3 << XGMAC_RTC_SHIFT;
|
|
}
|
|
|
|
value &= ~XGMAC_RQS;
|
|
value |= (rqs << XGMAC_RQS_SHIFT) & XGMAC_RQS;
|
|
|
|
if ((fifosz >= 4096) && (qmode != MTL_QUEUE_AVB)) {
|
|
u32 flow = readl(ioaddr + XGMAC_MTL_RXQ_FLOW_CONTROL(channel));
|
|
unsigned int rfd, rfa;
|
|
|
|
value |= XGMAC_EHFC;
|
|
|
|
/* Set Threshold for Activating Flow Control to min 2 frames,
|
|
* i.e. 1500 * 2 = 3000 bytes.
|
|
*
|
|
* Set Threshold for Deactivating Flow Control to min 1 frame,
|
|
* i.e. 1500 bytes.
|
|
*/
|
|
switch (fifosz) {
|
|
case 4096:
|
|
/* This violates the above formula because of FIFO size
|
|
* limit therefore overflow may occur in spite of this.
|
|
*/
|
|
rfd = 0x03; /* Full-2.5K */
|
|
rfa = 0x01; /* Full-1.5K */
|
|
break;
|
|
|
|
default:
|
|
rfd = 0x07; /* Full-4.5K */
|
|
rfa = 0x04; /* Full-3K */
|
|
break;
|
|
}
|
|
|
|
flow &= ~XGMAC_RFD;
|
|
flow |= rfd << XGMAC_RFD_SHIFT;
|
|
|
|
flow &= ~XGMAC_RFA;
|
|
flow |= rfa << XGMAC_RFA_SHIFT;
|
|
|
|
writel(flow, ioaddr + XGMAC_MTL_RXQ_FLOW_CONTROL(channel));
|
|
}
|
|
|
|
writel(value, ioaddr + XGMAC_MTL_RXQ_OPMODE(channel));
|
|
|
|
/* Enable MTL RX overflow */
|
|
value = readl(ioaddr + XGMAC_MTL_QINTEN(channel));
|
|
writel(value | XGMAC_RXOIE, ioaddr + XGMAC_MTL_QINTEN(channel));
|
|
}
|
|
|
|
static void dwxgmac2_dma_tx_mode(void __iomem *ioaddr, int mode,
|
|
u32 channel, int fifosz, u8 qmode)
|
|
{
|
|
u32 value = readl(ioaddr + XGMAC_MTL_TXQ_OPMODE(channel));
|
|
unsigned int tqs = fifosz / 256 - 1;
|
|
|
|
if (mode == SF_DMA_MODE) {
|
|
value |= XGMAC_TSF;
|
|
} else {
|
|
value &= ~XGMAC_TSF;
|
|
value &= ~XGMAC_TTC;
|
|
|
|
if (mode <= 64)
|
|
value |= 0x0 << XGMAC_TTC_SHIFT;
|
|
else if (mode <= 96)
|
|
value |= 0x2 << XGMAC_TTC_SHIFT;
|
|
else if (mode <= 128)
|
|
value |= 0x3 << XGMAC_TTC_SHIFT;
|
|
else if (mode <= 192)
|
|
value |= 0x4 << XGMAC_TTC_SHIFT;
|
|
else if (mode <= 256)
|
|
value |= 0x5 << XGMAC_TTC_SHIFT;
|
|
else if (mode <= 384)
|
|
value |= 0x6 << XGMAC_TTC_SHIFT;
|
|
else
|
|
value |= 0x7 << XGMAC_TTC_SHIFT;
|
|
}
|
|
|
|
/* Use static TC to Queue mapping */
|
|
value |= (channel << XGMAC_Q2TCMAP_SHIFT) & XGMAC_Q2TCMAP;
|
|
|
|
value &= ~XGMAC_TXQEN;
|
|
if (qmode != MTL_QUEUE_AVB)
|
|
value |= 0x2 << XGMAC_TXQEN_SHIFT;
|
|
else
|
|
value |= 0x1 << XGMAC_TXQEN_SHIFT;
|
|
|
|
value &= ~XGMAC_TQS;
|
|
value |= (tqs << XGMAC_TQS_SHIFT) & XGMAC_TQS;
|
|
|
|
writel(value, ioaddr + XGMAC_MTL_TXQ_OPMODE(channel));
|
|
}
|
|
|
|
static void dwxgmac2_enable_dma_irq(void __iomem *ioaddr, u32 chan,
|
|
bool rx, bool tx)
|
|
{
|
|
u32 value = readl(ioaddr + XGMAC_DMA_CH_INT_EN(chan));
|
|
|
|
if (rx)
|
|
value |= XGMAC_DMA_INT_DEFAULT_RX;
|
|
if (tx)
|
|
value |= XGMAC_DMA_INT_DEFAULT_TX;
|
|
|
|
writel(value, ioaddr + XGMAC_DMA_CH_INT_EN(chan));
|
|
}
|
|
|
|
static void dwxgmac2_disable_dma_irq(void __iomem *ioaddr, u32 chan,
|
|
bool rx, bool tx)
|
|
{
|
|
u32 value = readl(ioaddr + XGMAC_DMA_CH_INT_EN(chan));
|
|
|
|
if (rx)
|
|
value &= ~XGMAC_DMA_INT_DEFAULT_RX;
|
|
if (tx)
|
|
value &= ~XGMAC_DMA_INT_DEFAULT_TX;
|
|
|
|
writel(value, ioaddr + XGMAC_DMA_CH_INT_EN(chan));
|
|
}
|
|
|
|
static void dwxgmac2_dma_start_tx(void __iomem *ioaddr, u32 chan)
|
|
{
|
|
u32 value;
|
|
|
|
value = readl(ioaddr + XGMAC_DMA_CH_TX_CONTROL(chan));
|
|
value |= XGMAC_TXST;
|
|
writel(value, ioaddr + XGMAC_DMA_CH_TX_CONTROL(chan));
|
|
|
|
value = readl(ioaddr + XGMAC_TX_CONFIG);
|
|
value |= XGMAC_CONFIG_TE;
|
|
writel(value, ioaddr + XGMAC_TX_CONFIG);
|
|
}
|
|
|
|
static void dwxgmac2_dma_stop_tx(void __iomem *ioaddr, u32 chan)
|
|
{
|
|
u32 value;
|
|
|
|
value = readl(ioaddr + XGMAC_DMA_CH_TX_CONTROL(chan));
|
|
value &= ~XGMAC_TXST;
|
|
writel(value, ioaddr + XGMAC_DMA_CH_TX_CONTROL(chan));
|
|
|
|
value = readl(ioaddr + XGMAC_TX_CONFIG);
|
|
value &= ~XGMAC_CONFIG_TE;
|
|
writel(value, ioaddr + XGMAC_TX_CONFIG);
|
|
}
|
|
|
|
static void dwxgmac2_dma_start_rx(void __iomem *ioaddr, u32 chan)
|
|
{
|
|
u32 value;
|
|
|
|
value = readl(ioaddr + XGMAC_DMA_CH_RX_CONTROL(chan));
|
|
value |= XGMAC_RXST;
|
|
writel(value, ioaddr + XGMAC_DMA_CH_RX_CONTROL(chan));
|
|
|
|
value = readl(ioaddr + XGMAC_RX_CONFIG);
|
|
value |= XGMAC_CONFIG_RE;
|
|
writel(value, ioaddr + XGMAC_RX_CONFIG);
|
|
}
|
|
|
|
static void dwxgmac2_dma_stop_rx(void __iomem *ioaddr, u32 chan)
|
|
{
|
|
u32 value;
|
|
|
|
value = readl(ioaddr + XGMAC_DMA_CH_RX_CONTROL(chan));
|
|
value &= ~XGMAC_RXST;
|
|
writel(value, ioaddr + XGMAC_DMA_CH_RX_CONTROL(chan));
|
|
}
|
|
|
|
static int dwxgmac2_dma_interrupt(void __iomem *ioaddr,
|
|
struct stmmac_extra_stats *x, u32 chan,
|
|
u32 dir)
|
|
{
|
|
u32 intr_status = readl(ioaddr + XGMAC_DMA_CH_STATUS(chan));
|
|
u32 intr_en = readl(ioaddr + XGMAC_DMA_CH_INT_EN(chan));
|
|
int ret = 0;
|
|
|
|
if (dir == DMA_DIR_RX)
|
|
intr_status &= XGMAC_DMA_STATUS_MSK_RX;
|
|
else if (dir == DMA_DIR_TX)
|
|
intr_status &= XGMAC_DMA_STATUS_MSK_TX;
|
|
|
|
/* ABNORMAL interrupts */
|
|
if (unlikely(intr_status & XGMAC_AIS)) {
|
|
if (unlikely(intr_status & XGMAC_RBU)) {
|
|
x->rx_buf_unav_irq++;
|
|
ret |= handle_rx;
|
|
}
|
|
if (unlikely(intr_status & XGMAC_TPS)) {
|
|
x->tx_process_stopped_irq++;
|
|
ret |= tx_hard_error;
|
|
}
|
|
if (unlikely(intr_status & XGMAC_FBE)) {
|
|
x->fatal_bus_error_irq++;
|
|
ret |= tx_hard_error;
|
|
}
|
|
}
|
|
|
|
/* TX/RX NORMAL interrupts */
|
|
if (likely(intr_status & XGMAC_NIS)) {
|
|
x->normal_irq_n++;
|
|
|
|
if (likely(intr_status & XGMAC_RI)) {
|
|
x->rx_normal_irq_n++;
|
|
ret |= handle_rx;
|
|
}
|
|
if (likely(intr_status & (XGMAC_TI | XGMAC_TBU))) {
|
|
x->tx_normal_irq_n++;
|
|
ret |= handle_tx;
|
|
}
|
|
}
|
|
|
|
/* Clear interrupts */
|
|
writel(intr_en & intr_status, ioaddr + XGMAC_DMA_CH_STATUS(chan));
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int dwxgmac2_get_hw_feature(void __iomem *ioaddr,
|
|
struct dma_features *dma_cap)
|
|
{
|
|
u32 hw_cap;
|
|
|
|
/* MAC HW feature 0 */
|
|
hw_cap = readl(ioaddr + XGMAC_HW_FEATURE0);
|
|
dma_cap->vlins = (hw_cap & XGMAC_HWFEAT_SAVLANINS) >> 27;
|
|
dma_cap->rx_coe = (hw_cap & XGMAC_HWFEAT_RXCOESEL) >> 16;
|
|
dma_cap->tx_coe = (hw_cap & XGMAC_HWFEAT_TXCOESEL) >> 14;
|
|
dma_cap->eee = (hw_cap & XGMAC_HWFEAT_EEESEL) >> 13;
|
|
dma_cap->atime_stamp = (hw_cap & XGMAC_HWFEAT_TSSEL) >> 12;
|
|
dma_cap->av = (hw_cap & XGMAC_HWFEAT_AVSEL) >> 11;
|
|
dma_cap->av &= !((hw_cap & XGMAC_HWFEAT_RAVSEL) >> 10);
|
|
dma_cap->arpoffsel = (hw_cap & XGMAC_HWFEAT_ARPOFFSEL) >> 9;
|
|
dma_cap->rmon = (hw_cap & XGMAC_HWFEAT_MMCSEL) >> 8;
|
|
dma_cap->pmt_magic_frame = (hw_cap & XGMAC_HWFEAT_MGKSEL) >> 7;
|
|
dma_cap->pmt_remote_wake_up = (hw_cap & XGMAC_HWFEAT_RWKSEL) >> 6;
|
|
dma_cap->vlhash = (hw_cap & XGMAC_HWFEAT_VLHASH) >> 4;
|
|
dma_cap->mbps_1000 = (hw_cap & XGMAC_HWFEAT_GMIISEL) >> 1;
|
|
|
|
/* MAC HW feature 1 */
|
|
hw_cap = readl(ioaddr + XGMAC_HW_FEATURE1);
|
|
dma_cap->l3l4fnum = (hw_cap & XGMAC_HWFEAT_L3L4FNUM) >> 27;
|
|
dma_cap->hash_tb_sz = (hw_cap & XGMAC_HWFEAT_HASHTBLSZ) >> 24;
|
|
dma_cap->rssen = (hw_cap & XGMAC_HWFEAT_RSSEN) >> 20;
|
|
dma_cap->tsoen = (hw_cap & XGMAC_HWFEAT_TSOEN) >> 18;
|
|
dma_cap->sphen = (hw_cap & XGMAC_HWFEAT_SPHEN) >> 17;
|
|
|
|
dma_cap->addr64 = (hw_cap & XGMAC_HWFEAT_ADDR64) >> 14;
|
|
switch (dma_cap->addr64) {
|
|
case 0:
|
|
dma_cap->addr64 = 32;
|
|
break;
|
|
case 1:
|
|
dma_cap->addr64 = 40;
|
|
break;
|
|
case 2:
|
|
dma_cap->addr64 = 48;
|
|
break;
|
|
default:
|
|
dma_cap->addr64 = 32;
|
|
break;
|
|
}
|
|
|
|
dma_cap->tx_fifo_size =
|
|
128 << ((hw_cap & XGMAC_HWFEAT_TXFIFOSIZE) >> 6);
|
|
dma_cap->rx_fifo_size =
|
|
128 << ((hw_cap & XGMAC_HWFEAT_RXFIFOSIZE) >> 0);
|
|
|
|
/* MAC HW feature 2 */
|
|
hw_cap = readl(ioaddr + XGMAC_HW_FEATURE2);
|
|
dma_cap->pps_out_num = (hw_cap & XGMAC_HWFEAT_PPSOUTNUM) >> 24;
|
|
dma_cap->number_tx_channel =
|
|
((hw_cap & XGMAC_HWFEAT_TXCHCNT) >> 18) + 1;
|
|
dma_cap->number_rx_channel =
|
|
((hw_cap & XGMAC_HWFEAT_RXCHCNT) >> 12) + 1;
|
|
dma_cap->number_tx_queues =
|
|
((hw_cap & XGMAC_HWFEAT_TXQCNT) >> 6) + 1;
|
|
dma_cap->number_rx_queues =
|
|
((hw_cap & XGMAC_HWFEAT_RXQCNT) >> 0) + 1;
|
|
|
|
/* MAC HW feature 3 */
|
|
hw_cap = readl(ioaddr + XGMAC_HW_FEATURE3);
|
|
dma_cap->tbssel = (hw_cap & XGMAC_HWFEAT_TBSSEL) >> 27;
|
|
dma_cap->fpesel = (hw_cap & XGMAC_HWFEAT_FPESEL) >> 26;
|
|
dma_cap->estwid = (hw_cap & XGMAC_HWFEAT_ESTWID) >> 23;
|
|
dma_cap->estdep = (hw_cap & XGMAC_HWFEAT_ESTDEP) >> 20;
|
|
dma_cap->estsel = (hw_cap & XGMAC_HWFEAT_ESTSEL) >> 19;
|
|
dma_cap->asp = (hw_cap & XGMAC_HWFEAT_ASP) >> 14;
|
|
dma_cap->dvlan = (hw_cap & XGMAC_HWFEAT_DVLAN) >> 13;
|
|
dma_cap->frpes = (hw_cap & XGMAC_HWFEAT_FRPES) >> 11;
|
|
dma_cap->frpbs = (hw_cap & XGMAC_HWFEAT_FRPPB) >> 9;
|
|
dma_cap->frpsel = (hw_cap & XGMAC_HWFEAT_FRPSEL) >> 3;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void dwxgmac2_rx_watchdog(void __iomem *ioaddr, u32 riwt, u32 queue)
|
|
{
|
|
writel(riwt & XGMAC_RWT, ioaddr + XGMAC_DMA_CH_Rx_WATCHDOG(queue));
|
|
}
|
|
|
|
static void dwxgmac2_set_rx_ring_len(void __iomem *ioaddr, u32 len, u32 chan)
|
|
{
|
|
writel(len, ioaddr + XGMAC_DMA_CH_RxDESC_RING_LEN(chan));
|
|
}
|
|
|
|
static void dwxgmac2_set_tx_ring_len(void __iomem *ioaddr, u32 len, u32 chan)
|
|
{
|
|
writel(len, ioaddr + XGMAC_DMA_CH_TxDESC_RING_LEN(chan));
|
|
}
|
|
|
|
static void dwxgmac2_set_rx_tail_ptr(void __iomem *ioaddr, u32 ptr, u32 chan)
|
|
{
|
|
writel(ptr, ioaddr + XGMAC_DMA_CH_RxDESC_TAIL_LPTR(chan));
|
|
}
|
|
|
|
static void dwxgmac2_set_tx_tail_ptr(void __iomem *ioaddr, u32 ptr, u32 chan)
|
|
{
|
|
writel(ptr, ioaddr + XGMAC_DMA_CH_TxDESC_TAIL_LPTR(chan));
|
|
}
|
|
|
|
static void dwxgmac2_enable_tso(void __iomem *ioaddr, bool en, u32 chan)
|
|
{
|
|
u32 value = readl(ioaddr + XGMAC_DMA_CH_TX_CONTROL(chan));
|
|
|
|
if (en)
|
|
value |= XGMAC_TSE;
|
|
else
|
|
value &= ~XGMAC_TSE;
|
|
|
|
writel(value, ioaddr + XGMAC_DMA_CH_TX_CONTROL(chan));
|
|
}
|
|
|
|
static void dwxgmac2_qmode(void __iomem *ioaddr, u32 channel, u8 qmode)
|
|
{
|
|
u32 value = readl(ioaddr + XGMAC_MTL_TXQ_OPMODE(channel));
|
|
u32 flow = readl(ioaddr + XGMAC_RX_FLOW_CTRL);
|
|
|
|
value &= ~XGMAC_TXQEN;
|
|
if (qmode != MTL_QUEUE_AVB) {
|
|
value |= 0x2 << XGMAC_TXQEN_SHIFT;
|
|
writel(0, ioaddr + XGMAC_MTL_TCx_ETS_CONTROL(channel));
|
|
} else {
|
|
value |= 0x1 << XGMAC_TXQEN_SHIFT;
|
|
writel(flow & (~XGMAC_RFE), ioaddr + XGMAC_RX_FLOW_CTRL);
|
|
}
|
|
|
|
writel(value, ioaddr + XGMAC_MTL_TXQ_OPMODE(channel));
|
|
}
|
|
|
|
static void dwxgmac2_set_bfsize(void __iomem *ioaddr, int bfsize, u32 chan)
|
|
{
|
|
u32 value;
|
|
|
|
value = readl(ioaddr + XGMAC_DMA_CH_RX_CONTROL(chan));
|
|
value &= ~XGMAC_RBSZ;
|
|
value |= bfsize << XGMAC_RBSZ_SHIFT;
|
|
writel(value, ioaddr + XGMAC_DMA_CH_RX_CONTROL(chan));
|
|
}
|
|
|
|
static void dwxgmac2_enable_sph(void __iomem *ioaddr, bool en, u32 chan)
|
|
{
|
|
u32 value = readl(ioaddr + XGMAC_RX_CONFIG);
|
|
|
|
value &= ~XGMAC_CONFIG_HDSMS;
|
|
value |= XGMAC_CONFIG_HDSMS_256; /* Segment max 256 bytes */
|
|
writel(value, ioaddr + XGMAC_RX_CONFIG);
|
|
|
|
value = readl(ioaddr + XGMAC_DMA_CH_CONTROL(chan));
|
|
if (en)
|
|
value |= XGMAC_SPH;
|
|
else
|
|
value &= ~XGMAC_SPH;
|
|
writel(value, ioaddr + XGMAC_DMA_CH_CONTROL(chan));
|
|
}
|
|
|
|
static int dwxgmac2_enable_tbs(void __iomem *ioaddr, bool en, u32 chan)
|
|
{
|
|
u32 value = readl(ioaddr + XGMAC_DMA_CH_TX_CONTROL(chan));
|
|
|
|
if (en)
|
|
value |= XGMAC_EDSE;
|
|
else
|
|
value &= ~XGMAC_EDSE;
|
|
|
|
writel(value, ioaddr + XGMAC_DMA_CH_TX_CONTROL(chan));
|
|
|
|
value = readl(ioaddr + XGMAC_DMA_CH_TX_CONTROL(chan)) & XGMAC_EDSE;
|
|
if (en && !value)
|
|
return -EIO;
|
|
|
|
writel(XGMAC_DEF_FTOS, ioaddr + XGMAC_DMA_TBS_CTRL0);
|
|
writel(XGMAC_DEF_FTOS, ioaddr + XGMAC_DMA_TBS_CTRL1);
|
|
writel(XGMAC_DEF_FTOS, ioaddr + XGMAC_DMA_TBS_CTRL2);
|
|
writel(XGMAC_DEF_FTOS, ioaddr + XGMAC_DMA_TBS_CTRL3);
|
|
return 0;
|
|
}
|
|
|
|
const struct stmmac_dma_ops dwxgmac210_dma_ops = {
|
|
.reset = dwxgmac2_dma_reset,
|
|
.init = dwxgmac2_dma_init,
|
|
.init_chan = dwxgmac2_dma_init_chan,
|
|
.init_rx_chan = dwxgmac2_dma_init_rx_chan,
|
|
.init_tx_chan = dwxgmac2_dma_init_tx_chan,
|
|
.axi = dwxgmac2_dma_axi,
|
|
.dump_regs = dwxgmac2_dma_dump_regs,
|
|
.dma_rx_mode = dwxgmac2_dma_rx_mode,
|
|
.dma_tx_mode = dwxgmac2_dma_tx_mode,
|
|
.enable_dma_irq = dwxgmac2_enable_dma_irq,
|
|
.disable_dma_irq = dwxgmac2_disable_dma_irq,
|
|
.start_tx = dwxgmac2_dma_start_tx,
|
|
.stop_tx = dwxgmac2_dma_stop_tx,
|
|
.start_rx = dwxgmac2_dma_start_rx,
|
|
.stop_rx = dwxgmac2_dma_stop_rx,
|
|
.dma_interrupt = dwxgmac2_dma_interrupt,
|
|
.get_hw_feature = dwxgmac2_get_hw_feature,
|
|
.rx_watchdog = dwxgmac2_rx_watchdog,
|
|
.set_rx_ring_len = dwxgmac2_set_rx_ring_len,
|
|
.set_tx_ring_len = dwxgmac2_set_tx_ring_len,
|
|
.set_rx_tail_ptr = dwxgmac2_set_rx_tail_ptr,
|
|
.set_tx_tail_ptr = dwxgmac2_set_tx_tail_ptr,
|
|
.enable_tso = dwxgmac2_enable_tso,
|
|
.qmode = dwxgmac2_qmode,
|
|
.set_bfsize = dwxgmac2_set_bfsize,
|
|
.enable_sph = dwxgmac2_enable_sph,
|
|
.enable_tbs = dwxgmac2_enable_tbs,
|
|
};
|