0001
0002
0003
0004
0005
0006 #include <linux/netdevice.h>
0007 #include "altera_utils.h"
0008 #include "altera_tse.h"
0009 #include "altera_msgdmahw.h"
0010 #include "altera_msgdma.h"
0011
0012
0013 int msgdma_initialize(struct altera_tse_private *priv)
0014 {
0015 return 0;
0016 }
0017
0018 void msgdma_uninitialize(struct altera_tse_private *priv)
0019 {
0020 }
0021
0022 void msgdma_start_rxdma(struct altera_tse_private *priv)
0023 {
0024 }
0025
0026 void msgdma_reset(struct altera_tse_private *priv)
0027 {
0028 int counter;
0029
0030
0031 csrwr32(MSGDMA_CSR_STAT_MASK, priv->rx_dma_csr,
0032 msgdma_csroffs(status));
0033 csrwr32(MSGDMA_CSR_CTL_RESET, priv->rx_dma_csr,
0034 msgdma_csroffs(control));
0035
0036 counter = 0;
0037 while (counter++ < ALTERA_TSE_SW_RESET_WATCHDOG_CNTR) {
0038 if (tse_bit_is_clear(priv->rx_dma_csr, msgdma_csroffs(status),
0039 MSGDMA_CSR_STAT_RESETTING))
0040 break;
0041 udelay(1);
0042 }
0043
0044 if (counter >= ALTERA_TSE_SW_RESET_WATCHDOG_CNTR)
0045 netif_warn(priv, drv, priv->dev,
0046 "TSE Rx mSGDMA resetting bit never cleared!\n");
0047
0048
0049 csrwr32(MSGDMA_CSR_STAT_MASK, priv->rx_dma_csr, msgdma_csroffs(status));
0050
0051
0052 csrwr32(MSGDMA_CSR_STAT_MASK, priv->tx_dma_csr,
0053 msgdma_csroffs(status));
0054
0055 csrwr32(MSGDMA_CSR_CTL_RESET, priv->tx_dma_csr,
0056 msgdma_csroffs(control));
0057
0058 counter = 0;
0059 while (counter++ < ALTERA_TSE_SW_RESET_WATCHDOG_CNTR) {
0060 if (tse_bit_is_clear(priv->tx_dma_csr, msgdma_csroffs(status),
0061 MSGDMA_CSR_STAT_RESETTING))
0062 break;
0063 udelay(1);
0064 }
0065
0066 if (counter >= ALTERA_TSE_SW_RESET_WATCHDOG_CNTR)
0067 netif_warn(priv, drv, priv->dev,
0068 "TSE Tx mSGDMA resetting bit never cleared!\n");
0069
0070
0071 csrwr32(MSGDMA_CSR_STAT_MASK, priv->tx_dma_csr, msgdma_csroffs(status));
0072 }
0073
0074 void msgdma_disable_rxirq(struct altera_tse_private *priv)
0075 {
0076 tse_clear_bit(priv->rx_dma_csr, msgdma_csroffs(control),
0077 MSGDMA_CSR_CTL_GLOBAL_INTR);
0078 }
0079
0080 void msgdma_enable_rxirq(struct altera_tse_private *priv)
0081 {
0082 tse_set_bit(priv->rx_dma_csr, msgdma_csroffs(control),
0083 MSGDMA_CSR_CTL_GLOBAL_INTR);
0084 }
0085
0086 void msgdma_disable_txirq(struct altera_tse_private *priv)
0087 {
0088 tse_clear_bit(priv->tx_dma_csr, msgdma_csroffs(control),
0089 MSGDMA_CSR_CTL_GLOBAL_INTR);
0090 }
0091
0092 void msgdma_enable_txirq(struct altera_tse_private *priv)
0093 {
0094 tse_set_bit(priv->tx_dma_csr, msgdma_csroffs(control),
0095 MSGDMA_CSR_CTL_GLOBAL_INTR);
0096 }
0097
0098 void msgdma_clear_rxirq(struct altera_tse_private *priv)
0099 {
0100 csrwr32(MSGDMA_CSR_STAT_IRQ, priv->rx_dma_csr, msgdma_csroffs(status));
0101 }
0102
0103 void msgdma_clear_txirq(struct altera_tse_private *priv)
0104 {
0105 csrwr32(MSGDMA_CSR_STAT_IRQ, priv->tx_dma_csr, msgdma_csroffs(status));
0106 }
0107
0108
0109 int msgdma_tx_buffer(struct altera_tse_private *priv, struct tse_buffer *buffer)
0110 {
0111 csrwr32(lower_32_bits(buffer->dma_addr), priv->tx_dma_desc,
0112 msgdma_descroffs(read_addr_lo));
0113 csrwr32(upper_32_bits(buffer->dma_addr), priv->tx_dma_desc,
0114 msgdma_descroffs(read_addr_hi));
0115 csrwr32(0, priv->tx_dma_desc, msgdma_descroffs(write_addr_lo));
0116 csrwr32(0, priv->tx_dma_desc, msgdma_descroffs(write_addr_hi));
0117 csrwr32(buffer->len, priv->tx_dma_desc, msgdma_descroffs(len));
0118 csrwr32(0, priv->tx_dma_desc, msgdma_descroffs(burst_seq_num));
0119 csrwr32(MSGDMA_DESC_TX_STRIDE, priv->tx_dma_desc,
0120 msgdma_descroffs(stride));
0121 csrwr32(MSGDMA_DESC_CTL_TX_SINGLE, priv->tx_dma_desc,
0122 msgdma_descroffs(control));
0123 return 0;
0124 }
0125
0126 u32 msgdma_tx_completions(struct altera_tse_private *priv)
0127 {
0128 u32 ready = 0;
0129 u32 inuse;
0130 u32 status;
0131
0132
0133 inuse = csrrd32(priv->tx_dma_csr, msgdma_csroffs(rw_fill_level))
0134 & 0xffff;
0135
0136 if (inuse) {
0137 ready = max_t(int,
0138 priv->tx_prod - priv->tx_cons - inuse - 1, 0);
0139 } else {
0140
0141 status = csrrd32(priv->tx_dma_csr, msgdma_csroffs(status));
0142 if (status & MSGDMA_CSR_STAT_BUSY)
0143 ready = priv->tx_prod - priv->tx_cons - 1;
0144 else
0145 ready = priv->tx_prod - priv->tx_cons;
0146 }
0147 return ready;
0148 }
0149
0150
0151
0152 void msgdma_add_rx_desc(struct altera_tse_private *priv,
0153 struct tse_buffer *rxbuffer)
0154 {
0155 u32 len = priv->rx_dma_buf_sz;
0156 dma_addr_t dma_addr = rxbuffer->dma_addr;
0157 u32 control = (MSGDMA_DESC_CTL_END_ON_EOP
0158 | MSGDMA_DESC_CTL_END_ON_LEN
0159 | MSGDMA_DESC_CTL_TR_COMP_IRQ
0160 | MSGDMA_DESC_CTL_EARLY_IRQ
0161 | MSGDMA_DESC_CTL_TR_ERR_IRQ
0162 | MSGDMA_DESC_CTL_GO);
0163
0164 csrwr32(0, priv->rx_dma_desc, msgdma_descroffs(read_addr_lo));
0165 csrwr32(0, priv->rx_dma_desc, msgdma_descroffs(read_addr_hi));
0166 csrwr32(lower_32_bits(dma_addr), priv->rx_dma_desc,
0167 msgdma_descroffs(write_addr_lo));
0168 csrwr32(upper_32_bits(dma_addr), priv->rx_dma_desc,
0169 msgdma_descroffs(write_addr_hi));
0170 csrwr32(len, priv->rx_dma_desc, msgdma_descroffs(len));
0171 csrwr32(0, priv->rx_dma_desc, msgdma_descroffs(burst_seq_num));
0172 csrwr32(0x00010001, priv->rx_dma_desc, msgdma_descroffs(stride));
0173 csrwr32(control, priv->rx_dma_desc, msgdma_descroffs(control));
0174 }
0175
0176
0177
0178
0179 u32 msgdma_rx_status(struct altera_tse_private *priv)
0180 {
0181 u32 rxstatus = 0;
0182 u32 pktlength;
0183 u32 pktstatus;
0184
0185 if (csrrd32(priv->rx_dma_csr, msgdma_csroffs(resp_fill_level))
0186 & 0xffff) {
0187 pktlength = csrrd32(priv->rx_dma_resp,
0188 msgdma_respoffs(bytes_transferred));
0189 pktstatus = csrrd32(priv->rx_dma_resp,
0190 msgdma_respoffs(status));
0191 rxstatus = pktstatus;
0192 rxstatus = rxstatus << 16;
0193 rxstatus |= (pktlength & 0xffff);
0194 }
0195 return rxstatus;
0196 }