|
@@ -486,7 +486,7 @@ static void xgbe_enable_mtl_interrupts(struct xgbe_prv_data *pdata)
|
|
|
XGMAC_MTL_IOWRITE(pdata, i, MTL_Q_ISR, mtl_q_isr);
|
|
|
|
|
|
/* No MTL interrupts to be enabled */
|
|
|
- XGMAC_MTL_IOWRITE(pdata, i, MTL_Q_ISR, 0);
|
|
|
+ XGMAC_MTL_IOWRITE(pdata, i, MTL_Q_IER, 0);
|
|
|
}
|
|
|
}
|
|
|
|
|
@@ -1306,56 +1306,48 @@ static int xgbe_is_last_desc(struct xgbe_ring_desc *rdesc)
|
|
|
return XGMAC_GET_BITS_LE(rdesc->desc3, TX_NORMAL_DESC3, LD);
|
|
|
}
|
|
|
|
|
|
-static void xgbe_save_interrupt_status(struct xgbe_channel *channel,
|
|
|
- enum xgbe_int_state int_state)
|
|
|
+static int xgbe_enable_int(struct xgbe_channel *channel,
|
|
|
+ enum xgbe_int int_id)
|
|
|
{
|
|
|
unsigned int dma_ch_ier;
|
|
|
|
|
|
- if (int_state == XGMAC_INT_STATE_SAVE) {
|
|
|
- channel->saved_ier = XGMAC_DMA_IOREAD(channel, DMA_CH_IER);
|
|
|
- channel->saved_ier &= XGBE_DMA_INTERRUPT_MASK;
|
|
|
- } else {
|
|
|
- dma_ch_ier = XGMAC_DMA_IOREAD(channel, DMA_CH_IER);
|
|
|
- dma_ch_ier |= channel->saved_ier;
|
|
|
- XGMAC_DMA_IOWRITE(channel, DMA_CH_IER, dma_ch_ier);
|
|
|
- }
|
|
|
-}
|
|
|
+ dma_ch_ier = XGMAC_DMA_IOREAD(channel, DMA_CH_IER);
|
|
|
|
|
|
-static int xgbe_enable_int(struct xgbe_channel *channel,
|
|
|
- enum xgbe_int int_id)
|
|
|
-{
|
|
|
switch (int_id) {
|
|
|
- case XGMAC_INT_DMA_ISR_DC0IS:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, TIE, 1);
|
|
|
- break;
|
|
|
case XGMAC_INT_DMA_CH_SR_TI:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, TIE, 1);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, TIE, 1);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_CH_SR_TPS:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, TXSE, 1);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, TXSE, 1);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_CH_SR_TBU:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, TBUE, 1);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, TBUE, 1);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_CH_SR_RI:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, RIE, 1);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, RIE, 1);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_CH_SR_RBU:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, RBUE, 1);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, RBUE, 1);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_CH_SR_RPS:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, RSE, 1);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, RSE, 1);
|
|
|
+ break;
|
|
|
+ case XGMAC_INT_DMA_CH_SR_TI_RI:
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, TIE, 1);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, RIE, 1);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_CH_SR_FBE:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, FBEE, 1);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, FBEE, 1);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_ALL:
|
|
|
- xgbe_save_interrupt_status(channel, XGMAC_INT_STATE_RESTORE);
|
|
|
+ dma_ch_ier |= channel->saved_ier;
|
|
|
break;
|
|
|
default:
|
|
|
return -1;
|
|
|
}
|
|
|
|
|
|
+ XGMAC_DMA_IOWRITE(channel, DMA_CH_IER, dma_ch_ier);
|
|
|
+
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
@@ -1364,42 +1356,44 @@ static int xgbe_disable_int(struct xgbe_channel *channel,
|
|
|
{
|
|
|
unsigned int dma_ch_ier;
|
|
|
|
|
|
+ dma_ch_ier = XGMAC_DMA_IOREAD(channel, DMA_CH_IER);
|
|
|
+
|
|
|
switch (int_id) {
|
|
|
- case XGMAC_INT_DMA_ISR_DC0IS:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, TIE, 0);
|
|
|
- break;
|
|
|
case XGMAC_INT_DMA_CH_SR_TI:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, TIE, 0);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, TIE, 0);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_CH_SR_TPS:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, TXSE, 0);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, TXSE, 0);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_CH_SR_TBU:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, TBUE, 0);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, TBUE, 0);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_CH_SR_RI:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, RIE, 0);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, RIE, 0);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_CH_SR_RBU:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, RBUE, 0);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, RBUE, 0);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_CH_SR_RPS:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, RSE, 0);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, RSE, 0);
|
|
|
+ break;
|
|
|
+ case XGMAC_INT_DMA_CH_SR_TI_RI:
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, TIE, 0);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, RIE, 0);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_CH_SR_FBE:
|
|
|
- XGMAC_DMA_IOWRITE_BITS(channel, DMA_CH_IER, FBEE, 0);
|
|
|
+ XGMAC_SET_BITS(dma_ch_ier, DMA_CH_IER, FBEE, 0);
|
|
|
break;
|
|
|
case XGMAC_INT_DMA_ALL:
|
|
|
- xgbe_save_interrupt_status(channel, XGMAC_INT_STATE_SAVE);
|
|
|
-
|
|
|
- dma_ch_ier = XGMAC_DMA_IOREAD(channel, DMA_CH_IER);
|
|
|
+ channel->saved_ier = dma_ch_ier & XGBE_DMA_INTERRUPT_MASK;
|
|
|
dma_ch_ier &= ~XGBE_DMA_INTERRUPT_MASK;
|
|
|
- XGMAC_DMA_IOWRITE(channel, DMA_CH_IER, dma_ch_ier);
|
|
|
break;
|
|
|
default:
|
|
|
return -1;
|
|
|
}
|
|
|
|
|
|
+ XGMAC_DMA_IOWRITE(channel, DMA_CH_IER, dma_ch_ier);
|
|
|
+
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
@@ -1453,6 +1447,7 @@ static void xgbe_config_dma_bus(struct xgbe_prv_data *pdata)
|
|
|
|
|
|
/* Set the System Bus mode */
|
|
|
XGMAC_IOWRITE_BITS(pdata, DMA_SBMR, UNDEF, 1);
|
|
|
+ XGMAC_IOWRITE_BITS(pdata, DMA_SBMR, BLEN_256, 1);
|
|
|
}
|
|
|
|
|
|
static void xgbe_config_dma_cache(struct xgbe_prv_data *pdata)
|
|
@@ -1460,23 +1455,23 @@ static void xgbe_config_dma_cache(struct xgbe_prv_data *pdata)
|
|
|
unsigned int arcache, awcache;
|
|
|
|
|
|
arcache = 0;
|
|
|
- XGMAC_SET_BITS(arcache, DMA_AXIARCR, DRC, XGBE_DMA_ARCACHE);
|
|
|
- XGMAC_SET_BITS(arcache, DMA_AXIARCR, DRD, XGBE_DMA_ARDOMAIN);
|
|
|
- XGMAC_SET_BITS(arcache, DMA_AXIARCR, TEC, XGBE_DMA_ARCACHE);
|
|
|
- XGMAC_SET_BITS(arcache, DMA_AXIARCR, TED, XGBE_DMA_ARDOMAIN);
|
|
|
- XGMAC_SET_BITS(arcache, DMA_AXIARCR, THC, XGBE_DMA_ARCACHE);
|
|
|
- XGMAC_SET_BITS(arcache, DMA_AXIARCR, THD, XGBE_DMA_ARDOMAIN);
|
|
|
+ XGMAC_SET_BITS(arcache, DMA_AXIARCR, DRC, pdata->arcache);
|
|
|
+ XGMAC_SET_BITS(arcache, DMA_AXIARCR, DRD, pdata->axdomain);
|
|
|
+ XGMAC_SET_BITS(arcache, DMA_AXIARCR, TEC, pdata->arcache);
|
|
|
+ XGMAC_SET_BITS(arcache, DMA_AXIARCR, TED, pdata->axdomain);
|
|
|
+ XGMAC_SET_BITS(arcache, DMA_AXIARCR, THC, pdata->arcache);
|
|
|
+ XGMAC_SET_BITS(arcache, DMA_AXIARCR, THD, pdata->axdomain);
|
|
|
XGMAC_IOWRITE(pdata, DMA_AXIARCR, arcache);
|
|
|
|
|
|
awcache = 0;
|
|
|
- XGMAC_SET_BITS(awcache, DMA_AXIAWCR, DWC, XGBE_DMA_AWCACHE);
|
|
|
- XGMAC_SET_BITS(awcache, DMA_AXIAWCR, DWD, XGBE_DMA_AWDOMAIN);
|
|
|
- XGMAC_SET_BITS(awcache, DMA_AXIAWCR, RPC, XGBE_DMA_AWCACHE);
|
|
|
- XGMAC_SET_BITS(awcache, DMA_AXIAWCR, RPD, XGBE_DMA_AWDOMAIN);
|
|
|
- XGMAC_SET_BITS(awcache, DMA_AXIAWCR, RHC, XGBE_DMA_AWCACHE);
|
|
|
- XGMAC_SET_BITS(awcache, DMA_AXIAWCR, RHD, XGBE_DMA_AWDOMAIN);
|
|
|
- XGMAC_SET_BITS(awcache, DMA_AXIAWCR, TDC, XGBE_DMA_AWCACHE);
|
|
|
- XGMAC_SET_BITS(awcache, DMA_AXIAWCR, TDD, XGBE_DMA_AWDOMAIN);
|
|
|
+ XGMAC_SET_BITS(awcache, DMA_AXIAWCR, DWC, pdata->awcache);
|
|
|
+ XGMAC_SET_BITS(awcache, DMA_AXIAWCR, DWD, pdata->axdomain);
|
|
|
+ XGMAC_SET_BITS(awcache, DMA_AXIAWCR, RPC, pdata->awcache);
|
|
|
+ XGMAC_SET_BITS(awcache, DMA_AXIAWCR, RPD, pdata->axdomain);
|
|
|
+ XGMAC_SET_BITS(awcache, DMA_AXIAWCR, RHC, pdata->awcache);
|
|
|
+ XGMAC_SET_BITS(awcache, DMA_AXIAWCR, RHD, pdata->axdomain);
|
|
|
+ XGMAC_SET_BITS(awcache, DMA_AXIAWCR, TDC, pdata->awcache);
|
|
|
+ XGMAC_SET_BITS(awcache, DMA_AXIAWCR, TDD, pdata->axdomain);
|
|
|
XGMAC_IOWRITE(pdata, DMA_AXIAWCR, awcache);
|
|
|
}
|
|
|
|