Commit | Line | Data |
---|---|---|
75a6faf6 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
48863ce5 AT |
2 | /* |
3 | * Copyright (C) 2007-2015 STMicroelectronics Ltd | |
4 | * | |
48863ce5 AT |
5 | * Author: Alexandre Torgue <alexandre.torgue@st.com> |
6 | */ | |
7 | ||
8 | #include <linux/io.h> | |
9 | #include <linux/delay.h> | |
10 | #include "common.h" | |
11 | #include "dwmac4_dma.h" | |
12 | #include "dwmac4.h" | |
13 | ||
14 | int dwmac4_dma_reset(void __iomem *ioaddr) | |
15 | { | |
16 | u32 value = readl(ioaddr + DMA_BUS_MODE); | |
17 | int limit; | |
18 | ||
19 | /* DMA SW reset */ | |
20 | value |= DMA_BUS_MODE_SFT_RESET; | |
21 | writel(value, ioaddr + DMA_BUS_MODE); | |
22 | limit = 10; | |
23 | while (limit--) { | |
24 | if (!(readl(ioaddr + DMA_BUS_MODE) & DMA_BUS_MODE_SFT_RESET)) | |
25 | break; | |
26 | mdelay(10); | |
27 | } | |
28 | ||
29 | if (limit < 0) | |
30 | return -EBUSY; | |
31 | ||
32 | return 0; | |
33 | } | |
34 | ||
35 | void dwmac4_set_rx_tail_ptr(void __iomem *ioaddr, u32 tail_ptr, u32 chan) | |
36 | { | |
89cc57c5 | 37 | writel(tail_ptr, ioaddr + DMA_CHAN_RX_END_ADDR(chan)); |
48863ce5 AT |
38 | } |
39 | ||
40 | void dwmac4_set_tx_tail_ptr(void __iomem *ioaddr, u32 tail_ptr, u32 chan) | |
41 | { | |
89cc57c5 | 42 | writel(tail_ptr, ioaddr + DMA_CHAN_TX_END_ADDR(chan)); |
48863ce5 AT |
43 | } |
44 | ||
ae4f0d46 | 45 | void dwmac4_dma_start_tx(void __iomem *ioaddr, u32 chan) |
48863ce5 | 46 | { |
ae4f0d46 | 47 | u32 value = readl(ioaddr + DMA_CHAN_TX_CONTROL(chan)); |
48863ce5 AT |
48 | |
49 | value |= DMA_CONTROL_ST; | |
ae4f0d46 | 50 | writel(value, ioaddr + DMA_CHAN_TX_CONTROL(chan)); |
48863ce5 AT |
51 | |
52 | value = readl(ioaddr + GMAC_CONFIG); | |
53 | value |= GMAC_CONFIG_TE; | |
54 | writel(value, ioaddr + GMAC_CONFIG); | |
55 | } | |
56 | ||
ae4f0d46 | 57 | void dwmac4_dma_stop_tx(void __iomem *ioaddr, u32 chan) |
48863ce5 | 58 | { |
ae4f0d46 | 59 | u32 value = readl(ioaddr + DMA_CHAN_TX_CONTROL(chan)); |
48863ce5 AT |
60 | |
61 | value &= ~DMA_CONTROL_ST; | |
ae4f0d46 | 62 | writel(value, ioaddr + DMA_CHAN_TX_CONTROL(chan)); |
48863ce5 AT |
63 | |
64 | value = readl(ioaddr + GMAC_CONFIG); | |
65 | value &= ~GMAC_CONFIG_TE; | |
66 | writel(value, ioaddr + GMAC_CONFIG); | |
67 | } | |
68 | ||
ae4f0d46 | 69 | void dwmac4_dma_start_rx(void __iomem *ioaddr, u32 chan) |
48863ce5 | 70 | { |
ae4f0d46 | 71 | u32 value = readl(ioaddr + DMA_CHAN_RX_CONTROL(chan)); |
48863ce5 AT |
72 | |
73 | value |= DMA_CONTROL_SR; | |
74 | ||
ae4f0d46 | 75 | writel(value, ioaddr + DMA_CHAN_RX_CONTROL(chan)); |
48863ce5 AT |
76 | |
77 | value = readl(ioaddr + GMAC_CONFIG); | |
78 | value |= GMAC_CONFIG_RE; | |
79 | writel(value, ioaddr + GMAC_CONFIG); | |
80 | } | |
81 | ||
ae4f0d46 | 82 | void dwmac4_dma_stop_rx(void __iomem *ioaddr, u32 chan) |
48863ce5 | 83 | { |
ae4f0d46 | 84 | u32 value = readl(ioaddr + DMA_CHAN_RX_CONTROL(chan)); |
48863ce5 AT |
85 | |
86 | value &= ~DMA_CONTROL_SR; | |
ae4f0d46 | 87 | writel(value, ioaddr + DMA_CHAN_RX_CONTROL(chan)); |
48863ce5 AT |
88 | } |
89 | ||
4854ab99 | 90 | void dwmac4_set_tx_ring_len(void __iomem *ioaddr, u32 len, u32 chan) |
48863ce5 | 91 | { |
4854ab99 | 92 | writel(len, ioaddr + DMA_CHAN_TX_RING_LEN(chan)); |
48863ce5 AT |
93 | } |
94 | ||
4854ab99 | 95 | void dwmac4_set_rx_ring_len(void __iomem *ioaddr, u32 len, u32 chan) |
48863ce5 | 96 | { |
4854ab99 | 97 | writel(len, ioaddr + DMA_CHAN_RX_RING_LEN(chan)); |
48863ce5 AT |
98 | } |
99 | ||
4f513ecd | 100 | void dwmac4_enable_dma_irq(void __iomem *ioaddr, u32 chan) |
48863ce5 AT |
101 | { |
102 | writel(DMA_CHAN_INTR_DEFAULT_MASK, ioaddr + | |
4f513ecd | 103 | DMA_CHAN_INTR_ENA(chan)); |
48863ce5 AT |
104 | } |
105 | ||
4f513ecd | 106 | void dwmac410_enable_dma_irq(void __iomem *ioaddr, u32 chan) |
48863ce5 AT |
107 | { |
108 | writel(DMA_CHAN_INTR_DEFAULT_MASK_4_10, | |
4f513ecd | 109 | ioaddr + DMA_CHAN_INTR_ENA(chan)); |
48863ce5 AT |
110 | } |
111 | ||
4f513ecd | 112 | void dwmac4_disable_dma_irq(void __iomem *ioaddr, u32 chan) |
48863ce5 | 113 | { |
4f513ecd | 114 | writel(0, ioaddr + DMA_CHAN_INTR_ENA(chan)); |
48863ce5 AT |
115 | } |
116 | ||
117 | int dwmac4_dma_interrupt(void __iomem *ioaddr, | |
d62a107a | 118 | struct stmmac_extra_stats *x, u32 chan) |
48863ce5 | 119 | { |
d62a107a | 120 | u32 intr_status = readl(ioaddr + DMA_CHAN_STATUS(chan)); |
1103d3a5 JA |
121 | u32 intr_en = readl(ioaddr + DMA_CHAN_INTR_ENA(chan)); |
122 | int ret = 0; | |
48863ce5 AT |
123 | |
124 | /* ABNORMAL interrupts */ | |
125 | if (unlikely(intr_status & DMA_CHAN_STATUS_AIS)) { | |
126 | if (unlikely(intr_status & DMA_CHAN_STATUS_RBU)) | |
127 | x->rx_buf_unav_irq++; | |
128 | if (unlikely(intr_status & DMA_CHAN_STATUS_RPS)) | |
129 | x->rx_process_stopped_irq++; | |
130 | if (unlikely(intr_status & DMA_CHAN_STATUS_RWT)) | |
131 | x->rx_watchdog_irq++; | |
132 | if (unlikely(intr_status & DMA_CHAN_STATUS_ETI)) | |
133 | x->tx_early_irq++; | |
134 | if (unlikely(intr_status & DMA_CHAN_STATUS_TPS)) { | |
135 | x->tx_process_stopped_irq++; | |
136 | ret = tx_hard_error; | |
137 | } | |
138 | if (unlikely(intr_status & DMA_CHAN_STATUS_FBE)) { | |
139 | x->fatal_bus_error_irq++; | |
140 | ret = tx_hard_error; | |
141 | } | |
142 | } | |
143 | /* TX/RX NORMAL interrupts */ | |
144 | if (likely(intr_status & DMA_CHAN_STATUS_NIS)) { | |
145 | x->normal_irq_n++; | |
146 | if (likely(intr_status & DMA_CHAN_STATUS_RI)) { | |
1103d3a5 JA |
147 | x->rx_normal_irq_n++; |
148 | ret |= handle_rx; | |
48863ce5 | 149 | } |
1103d3a5 JA |
150 | if (likely(intr_status & (DMA_CHAN_STATUS_TI | |
151 | DMA_CHAN_STATUS_TBU))) { | |
48863ce5 AT |
152 | x->tx_normal_irq_n++; |
153 | ret |= handle_tx; | |
154 | } | |
155 | if (unlikely(intr_status & DMA_CHAN_STATUS_ERI)) | |
156 | x->rx_early_irq++; | |
157 | } | |
158 | ||
1103d3a5 | 159 | writel(intr_status & intr_en, ioaddr + DMA_CHAN_STATUS(chan)); |
48863ce5 AT |
160 | return ret; |
161 | } | |
162 | ||
163 | void stmmac_dwmac4_set_mac_addr(void __iomem *ioaddr, u8 addr[6], | |
164 | unsigned int high, unsigned int low) | |
165 | { | |
166 | unsigned long data; | |
167 | ||
168 | data = (addr[5] << 8) | addr[4]; | |
169 | /* For MAC Addr registers se have to set the Address Enable (AE) | |
170 | * bit that has no effect on the High Reg 0 where the bit 31 (MO) | |
171 | * is RO. | |
172 | */ | |
173 | data |= (STMMAC_CHAN0 << GMAC_HI_DCS_SHIFT); | |
174 | writel(data | GMAC_HI_REG_AE, ioaddr + high); | |
175 | data = (addr[3] << 24) | (addr[2] << 16) | (addr[1] << 8) | addr[0]; | |
176 | writel(data, ioaddr + low); | |
177 | } | |
178 | ||
179 | /* Enable disable MAC RX/TX */ | |
180 | void stmmac_dwmac4_set_mac(void __iomem *ioaddr, bool enable) | |
181 | { | |
182 | u32 value = readl(ioaddr + GMAC_CONFIG); | |
183 | ||
184 | if (enable) | |
185 | value |= GMAC_CONFIG_RE | GMAC_CONFIG_TE; | |
186 | else | |
187 | value &= ~(GMAC_CONFIG_TE | GMAC_CONFIG_RE); | |
188 | ||
189 | writel(value, ioaddr + GMAC_CONFIG); | |
190 | } | |
191 | ||
192 | void stmmac_dwmac4_get_mac_addr(void __iomem *ioaddr, unsigned char *addr, | |
193 | unsigned int high, unsigned int low) | |
194 | { | |
195 | unsigned int hi_addr, lo_addr; | |
196 | ||
197 | /* Read the MAC address from the hardware */ | |
198 | hi_addr = readl(ioaddr + high); | |
199 | lo_addr = readl(ioaddr + low); | |
200 | ||
201 | /* Extract the MAC address from the high and low words */ | |
202 | addr[0] = lo_addr & 0xff; | |
203 | addr[1] = (lo_addr >> 8) & 0xff; | |
204 | addr[2] = (lo_addr >> 16) & 0xff; | |
205 | addr[3] = (lo_addr >> 24) & 0xff; | |
206 | addr[4] = hi_addr & 0xff; | |
207 | addr[5] = (hi_addr >> 8) & 0xff; | |
208 | } |