1
2
3
4
5#include <linux/bitops.h>
6#include <linux/iopoll.h>
7#include "common.h"
8#include "dwmac4.h"
9#include "dwmac5.h"
10
11struct dwmac5_error_desc {
12 bool valid;
13 const char *desc;
14 const char *detailed_desc;
15};
16
17#define STAT_OFF(field) offsetof(struct stmmac_safety_stats, field)
18
19static void dwmac5_log_error(struct net_device *ndev, u32 value, bool corr,
20 const char *module_name, const struct dwmac5_error_desc *desc,
21 unsigned long field_offset, struct stmmac_safety_stats *stats)
22{
23 unsigned long loc, mask;
24 u8 *bptr = (u8 *)stats;
25 unsigned long *ptr;
26
27 ptr = (unsigned long *)(bptr + field_offset);
28
29 mask = value;
30 for_each_set_bit(loc, &mask, 32) {
31 netdev_err(ndev, "Found %s error in %s: '%s: %s'\n", corr ?
32 "correctable" : "uncorrectable", module_name,
33 desc[loc].desc, desc[loc].detailed_desc);
34
35
36 ptr[loc]++;
37 }
38}
39
40static const struct dwmac5_error_desc dwmac5_mac_errors[32]= {
41 { true, "ATPES", "Application Transmit Interface Parity Check Error" },
42 { true, "TPES", "TSO Data Path Parity Check Error" },
43 { true, "RDPES", "Read Descriptor Parity Check Error" },
44 { true, "MPES", "MTL Data Path Parity Check Error" },
45 { true, "MTSPES", "MTL TX Status Data Path Parity Check Error" },
46 { true, "ARPES", "Application Receive Interface Data Path Parity Check Error" },
47 { true, "CWPES", "CSR Write Data Path Parity Check Error" },
48 { true, "ASRPES", "AXI Slave Read Data Path Parity Check Error" },
49 { true, "TTES", "TX FSM Timeout Error" },
50 { true, "RTES", "RX FSM Timeout Error" },
51 { true, "CTES", "CSR FSM Timeout Error" },
52 { true, "ATES", "APP FSM Timeout Error" },
53 { true, "PTES", "PTP FSM Timeout Error" },
54 { true, "T125ES", "TX125 FSM Timeout Error" },
55 { true, "R125ES", "RX125 FSM Timeout Error" },
56 { true, "RVCTES", "REV MDC FSM Timeout Error" },
57 { true, "MSTTES", "Master Read/Write Timeout Error" },
58 { true, "SLVTES", "Slave Read/Write Timeout Error" },
59 { true, "ATITES", "Application Timeout on ATI Interface Error" },
60 { true, "ARITES", "Application Timeout on ARI Interface Error" },
61 { false, "UNKNOWN", "Unknown Error" },
62 { false, "UNKNOWN", "Unknown Error" },
63 { false, "UNKNOWN", "Unknown Error" },
64 { false, "UNKNOWN", "Unknown Error" },
65 { true, "FSMPES", "FSM State Parity Error" },
66 { false, "UNKNOWN", "Unknown Error" },
67 { false, "UNKNOWN", "Unknown Error" },
68 { false, "UNKNOWN", "Unknown Error" },
69 { false, "UNKNOWN", "Unknown Error" },
70 { false, "UNKNOWN", "Unknown Error" },
71 { false, "UNKNOWN", "Unknown Error" },
72 { false, "UNKNOWN", "Unknown Error" },
73};
74
75static void dwmac5_handle_mac_err(struct net_device *ndev,
76 void __iomem *ioaddr, bool correctable,
77 struct stmmac_safety_stats *stats)
78{
79 u32 value;
80
81 value = readl(ioaddr + MAC_DPP_FSM_INT_STATUS);
82 writel(value, ioaddr + MAC_DPP_FSM_INT_STATUS);
83
84 dwmac5_log_error(ndev, value, correctable, "MAC", dwmac5_mac_errors,
85 STAT_OFF(mac_errors), stats);
86}
87
88static const struct dwmac5_error_desc dwmac5_mtl_errors[32]= {
89 { true, "TXCES", "MTL TX Memory Error" },
90 { true, "TXAMS", "MTL TX Memory Address Mismatch Error" },
91 { true, "TXUES", "MTL TX Memory Error" },
92 { false, "UNKNOWN", "Unknown Error" },
93 { true, "RXCES", "MTL RX Memory Error" },
94 { true, "RXAMS", "MTL RX Memory Address Mismatch Error" },
95 { true, "RXUES", "MTL RX Memory Error" },
96 { false, "UNKNOWN", "Unknown Error" },
97 { true, "ECES", "MTL EST Memory Error" },
98 { true, "EAMS", "MTL EST Memory Address Mismatch Error" },
99 { true, "EUES", "MTL EST Memory Error" },
100 { false, "UNKNOWN", "Unknown Error" },
101 { true, "RPCES", "MTL RX Parser Memory Error" },
102 { true, "RPAMS", "MTL RX Parser Memory Address Mismatch Error" },
103 { true, "RPUES", "MTL RX Parser Memory Error" },
104 { false, "UNKNOWN", "Unknown Error" },
105 { false, "UNKNOWN", "Unknown Error" },
106 { false, "UNKNOWN", "Unknown Error" },
107 { false, "UNKNOWN", "Unknown Error" },
108 { false, "UNKNOWN", "Unknown Error" },
109 { false, "UNKNOWN", "Unknown Error" },
110 { false, "UNKNOWN", "Unknown Error" },
111 { false, "UNKNOWN", "Unknown Error" },
112 { false, "UNKNOWN", "Unknown Error" },
113 { false, "UNKNOWN", "Unknown Error" },
114 { false, "UNKNOWN", "Unknown Error" },
115 { false, "UNKNOWN", "Unknown Error" },
116 { false, "UNKNOWN", "Unknown Error" },
117 { false, "UNKNOWN", "Unknown Error" },
118 { false, "UNKNOWN", "Unknown Error" },
119 { false, "UNKNOWN", "Unknown Error" },
120 { false, "UNKNOWN", "Unknown Error" },
121};
122
123static void dwmac5_handle_mtl_err(struct net_device *ndev,
124 void __iomem *ioaddr, bool correctable,
125 struct stmmac_safety_stats *stats)
126{
127 u32 value;
128
129 value = readl(ioaddr + MTL_ECC_INT_STATUS);
130 writel(value, ioaddr + MTL_ECC_INT_STATUS);
131
132 dwmac5_log_error(ndev, value, correctable, "MTL", dwmac5_mtl_errors,
133 STAT_OFF(mtl_errors), stats);
134}
135
136static const struct dwmac5_error_desc dwmac5_dma_errors[32]= {
137 { true, "TCES", "DMA TSO Memory Error" },
138 { true, "TAMS", "DMA TSO Memory Address Mismatch Error" },
139 { true, "TUES", "DMA TSO Memory Error" },
140 { false, "UNKNOWN", "Unknown Error" },
141 { false, "UNKNOWN", "Unknown Error" },
142 { false, "UNKNOWN", "Unknown Error" },
143 { false, "UNKNOWN", "Unknown Error" },
144 { false, "UNKNOWN", "Unknown Error" },
145 { false, "UNKNOWN", "Unknown Error" },
146 { false, "UNKNOWN", "Unknown Error" },
147 { false, "UNKNOWN", "Unknown Error" },
148 { false, "UNKNOWN", "Unknown Error" },
149 { false, "UNKNOWN", "Unknown Error" },
150 { false, "UNKNOWN", "Unknown Error" },
151 { false, "UNKNOWN", "Unknown Error" },
152 { false, "UNKNOWN", "Unknown Error" },
153 { false, "UNKNOWN", "Unknown Error" },
154 { false, "UNKNOWN", "Unknown Error" },
155 { false, "UNKNOWN", "Unknown Error" },
156 { false, "UNKNOWN", "Unknown Error" },
157 { false, "UNKNOWN", "Unknown Error" },
158 { false, "UNKNOWN", "Unknown Error" },
159 { false, "UNKNOWN", "Unknown Error" },
160 { false, "UNKNOWN", "Unknown Error" },
161 { false, "UNKNOWN", "Unknown Error" },
162 { false, "UNKNOWN", "Unknown Error" },
163 { false, "UNKNOWN", "Unknown Error" },
164 { false, "UNKNOWN", "Unknown Error" },
165 { false, "UNKNOWN", "Unknown Error" },
166 { false, "UNKNOWN", "Unknown Error" },
167 { false, "UNKNOWN", "Unknown Error" },
168 { false, "UNKNOWN", "Unknown Error" },
169};
170
171static void dwmac5_handle_dma_err(struct net_device *ndev,
172 void __iomem *ioaddr, bool correctable,
173 struct stmmac_safety_stats *stats)
174{
175 u32 value;
176
177 value = readl(ioaddr + DMA_ECC_INT_STATUS);
178 writel(value, ioaddr + DMA_ECC_INT_STATUS);
179
180 dwmac5_log_error(ndev, value, correctable, "DMA", dwmac5_dma_errors,
181 STAT_OFF(dma_errors), stats);
182}
183
184int dwmac5_safety_feat_config(void __iomem *ioaddr, unsigned int asp)
185{
186 u32 value;
187
188 if (!asp)
189 return -EINVAL;
190
191
192 value = readl(ioaddr + MTL_ECC_CONTROL);
193 value |= TSOEE;
194 value |= MRXPEE;
195 value |= MESTEE;
196 value |= MRXEE;
197 value |= MTXEE;
198 writel(value, ioaddr + MTL_ECC_CONTROL);
199
200
201 value = readl(ioaddr + MTL_ECC_INT_ENABLE);
202 value |= RPCEIE;
203 value |= ECEIE;
204 value |= RXCEIE;
205 value |= TXCEIE;
206 writel(value, ioaddr + MTL_ECC_INT_ENABLE);
207
208
209 value = readl(ioaddr + DMA_ECC_INT_ENABLE);
210 value |= TCEIE;
211 writel(value, ioaddr + DMA_ECC_INT_ENABLE);
212
213
214 if (asp <= 0x1)
215 return 0;
216
217
218 value = readl(ioaddr + MAC_FSM_CONTROL);
219 value |= PRTYEN;
220 value |= TMOUTEN;
221 writel(value, ioaddr + MAC_FSM_CONTROL);
222
223
224 value = readl(ioaddr + MTL_DPP_CONTROL);
225 value |= EDPP;
226 writel(value, ioaddr + MTL_DPP_CONTROL);
227
228
229
230
231
232 if (asp <= 0x2)
233 return 0;
234
235 value |= EPSI;
236 writel(value, ioaddr + MTL_DPP_CONTROL);
237 return 0;
238}
239
240bool dwmac5_safety_feat_irq_status(struct net_device *ndev,
241 void __iomem *ioaddr, unsigned int asp,
242 struct stmmac_safety_stats *stats)
243{
244 bool ret = false, err, corr;
245 u32 mtl, dma;
246
247 if (!asp)
248 return false;
249
250 mtl = readl(ioaddr + MTL_SAFETY_INT_STATUS);
251 dma = readl(ioaddr + DMA_SAFETY_INT_STATUS);
252
253 err = (mtl & MCSIS) || (dma & MCSIS);
254 corr = false;
255 if (err) {
256 dwmac5_handle_mac_err(ndev, ioaddr, corr, stats);
257 ret |= !corr;
258 }
259
260 err = (mtl & (MEUIS | MECIS)) || (dma & (MSUIS | MSCIS));
261 corr = (mtl & MECIS) || (dma & MSCIS);
262 if (err) {
263 dwmac5_handle_mtl_err(ndev, ioaddr, corr, stats);
264 ret |= !corr;
265 }
266
267 err = dma & (DEUIS | DECIS);
268 corr = dma & DECIS;
269 if (err) {
270 dwmac5_handle_dma_err(ndev, ioaddr, corr, stats);
271 ret |= !corr;
272 }
273
274 return ret;
275}
276
277static const struct dwmac5_error {
278 const struct dwmac5_error_desc *desc;
279} dwmac5_all_errors[] = {
280 { dwmac5_mac_errors },
281 { dwmac5_mtl_errors },
282 { dwmac5_dma_errors },
283};
284
285const char *dwmac5_safety_feat_dump(struct stmmac_safety_stats *stats,
286 int index, unsigned long *count)
287{
288 int module = index / 32, offset = index % 32;
289 unsigned long *ptr = (unsigned long *)stats;
290
291 if (module >= ARRAY_SIZE(dwmac5_all_errors))
292 return NULL;
293 if (!dwmac5_all_errors[module].desc[offset].valid)
294 return NULL;
295 if (count)
296 *count = *(ptr + index);
297 return dwmac5_all_errors[module].desc[offset].desc;
298}
299