hc
2023-11-22 d0a428a6556ea5a006e22e28b0b1cd037885fe20
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
/*******************************************************************************
  DWMAC Management Counters
 
  Copyright (C) 2011  STMicroelectronics Ltd
 
  This program is free software; you can redistribute it and/or modify it
  under the terms and conditions of the GNU General Public License,
  version 2, as published by the Free Software Foundation.
 
  This program is distributed in the hope it will be useful, but WITHOUT
  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  more details.
 
  The full GNU General Public License is included in this distribution in
  the file called "COPYING".
 
  Author: Giuseppe Cavallaro <peppe.cavallaro@st.com>
*******************************************************************************/
 
#include <linux/kernel.h>
#include <linux/io.h>
#include "mmc.h"
 
/* MAC Management Counters register offset */
 
#define MMC_CNTRL        0x00    /* MMC Control */
#define MMC_RX_INTR        0x04    /* MMC RX Interrupt */
#define MMC_TX_INTR        0x08    /* MMC TX Interrupt */
#define MMC_RX_INTR_MASK    0x0c    /* MMC Interrupt Mask */
#define MMC_TX_INTR_MASK    0x10    /* MMC Interrupt Mask */
#define MMC_DEFAULT_MASK    0xffffffff
 
/* MMC TX counter registers */
 
/* Note:
 * _GB register stands for good and bad frames
 * _G is for good only.
 */
#define MMC_TX_OCTETCOUNT_GB        0x14
#define MMC_TX_FRAMECOUNT_GB        0x18
#define MMC_TX_BROADCASTFRAME_G        0x1c
#define MMC_TX_MULTICASTFRAME_G        0x20
#define MMC_TX_64_OCTETS_GB        0x24
#define MMC_TX_65_TO_127_OCTETS_GB    0x28
#define MMC_TX_128_TO_255_OCTETS_GB    0x2c
#define MMC_TX_256_TO_511_OCTETS_GB    0x30
#define MMC_TX_512_TO_1023_OCTETS_GB    0x34
#define MMC_TX_1024_TO_MAX_OCTETS_GB    0x38
#define MMC_TX_UNICAST_GB        0x3c
#define MMC_TX_MULTICAST_GB        0x40
#define MMC_TX_BROADCAST_GB        0x44
#define MMC_TX_UNDERFLOW_ERROR        0x48
#define MMC_TX_SINGLECOL_G        0x4c
#define MMC_TX_MULTICOL_G        0x50
#define MMC_TX_DEFERRED            0x54
#define MMC_TX_LATECOL            0x58
#define MMC_TX_EXESSCOL            0x5c
#define MMC_TX_CARRIER_ERROR        0x60
#define MMC_TX_OCTETCOUNT_G        0x64
#define MMC_TX_FRAMECOUNT_G        0x68
#define MMC_TX_EXCESSDEF        0x6c
#define MMC_TX_PAUSE_FRAME        0x70
#define MMC_TX_VLAN_FRAME_G        0x74
 
/* MMC RX counter registers */
#define MMC_RX_FRAMECOUNT_GB        0x80
#define MMC_RX_OCTETCOUNT_GB        0x84
#define MMC_RX_OCTETCOUNT_G        0x88
#define MMC_RX_BROADCASTFRAME_G        0x8c
#define MMC_RX_MULTICASTFRAME_G        0x90
#define MMC_RX_CRC_ERROR        0x94
#define MMC_RX_ALIGN_ERROR        0x98
#define MMC_RX_RUN_ERROR        0x9C
#define MMC_RX_JABBER_ERROR        0xA0
#define MMC_RX_UNDERSIZE_G        0xA4
#define MMC_RX_OVERSIZE_G        0xA8
#define MMC_RX_64_OCTETS_GB        0xAC
#define MMC_RX_65_TO_127_OCTETS_GB    0xb0
#define MMC_RX_128_TO_255_OCTETS_GB    0xb4
#define MMC_RX_256_TO_511_OCTETS_GB    0xb8
#define MMC_RX_512_TO_1023_OCTETS_GB    0xbc
#define MMC_RX_1024_TO_MAX_OCTETS_GB    0xc0
#define MMC_RX_UNICAST_G        0xc4
#define MMC_RX_LENGTH_ERROR        0xc8
#define MMC_RX_AUTOFRANGETYPE        0xcc
#define MMC_RX_PAUSE_FRAMES        0xd0
#define MMC_RX_FIFO_OVERFLOW        0xd4
#define MMC_RX_VLAN_FRAMES_GB        0xd8
#define MMC_RX_WATCHDOG_ERROR        0xdc
/* IPC*/
#define MMC_RX_IPC_INTR_MASK        0x100
#define MMC_RX_IPC_INTR            0x108
/* IPv4*/
#define MMC_RX_IPV4_GD            0x110
#define MMC_RX_IPV4_HDERR        0x114
#define MMC_RX_IPV4_NOPAY        0x118
#define MMC_RX_IPV4_FRAG        0x11C
#define MMC_RX_IPV4_UDSBL        0x120
 
#define MMC_RX_IPV4_GD_OCTETS        0x150
#define MMC_RX_IPV4_HDERR_OCTETS    0x154
#define MMC_RX_IPV4_NOPAY_OCTETS    0x158
#define MMC_RX_IPV4_FRAG_OCTETS        0x15c
#define MMC_RX_IPV4_UDSBL_OCTETS    0x160
 
/* IPV6*/
#define MMC_RX_IPV6_GD_OCTETS        0x164
#define MMC_RX_IPV6_HDERR_OCTETS    0x168
#define MMC_RX_IPV6_NOPAY_OCTETS    0x16c
 
#define MMC_RX_IPV6_GD            0x124
#define MMC_RX_IPV6_HDERR        0x128
#define MMC_RX_IPV6_NOPAY        0x12c
 
/* Protocols*/
#define MMC_RX_UDP_GD            0x130
#define MMC_RX_UDP_ERR            0x134
#define MMC_RX_TCP_GD            0x138
#define MMC_RX_TCP_ERR            0x13c
#define MMC_RX_ICMP_GD            0x140
#define MMC_RX_ICMP_ERR            0x144
 
#define MMC_RX_UDP_GD_OCTETS        0x170
#define MMC_RX_UDP_ERR_OCTETS        0x174
#define MMC_RX_TCP_GD_OCTETS        0x178
#define MMC_RX_TCP_ERR_OCTETS        0x17c
#define MMC_RX_ICMP_GD_OCTETS        0x180
#define MMC_RX_ICMP_ERR_OCTETS        0x184
 
void dwmac_mmc_ctrl(void __iomem *mmcaddr, unsigned int mode)
{
   u32 value = readl(mmcaddr + MMC_CNTRL);
 
   value |= (mode & 0x3F);
 
   writel(value, mmcaddr + MMC_CNTRL);
 
   pr_debug("stmmac: MMC ctrl register (offset 0x%x): 0x%08x\n",
        MMC_CNTRL, value);
}
EXPORT_SYMBOL(dwmac_mmc_ctrl);
 
/* To mask all all interrupts.*/
void dwmac_mmc_intr_all_mask(void __iomem *mmcaddr)
{
   writel(MMC_DEFAULT_MASK, mmcaddr + MMC_RX_INTR_MASK);
   writel(MMC_DEFAULT_MASK, mmcaddr + MMC_TX_INTR_MASK);
   writel(MMC_DEFAULT_MASK, mmcaddr + MMC_RX_IPC_INTR_MASK);
}
EXPORT_SYMBOL(dwmac_mmc_intr_all_mask);
 
/* This reads the MAC core counters (if actaully supported).
 * by default the MMC core is programmed to reset each
 * counter after a read. So all the field of the mmc struct
 * have to be incremented.
 */
void dwmac_mmc_read(void __iomem *mmcaddr, struct stmmac_counters *mmc)
{
   mmc->mmc_tx_octetcount_gb += readl(mmcaddr + MMC_TX_OCTETCOUNT_GB);
   mmc->mmc_tx_framecount_gb += readl(mmcaddr + MMC_TX_FRAMECOUNT_GB);
   mmc->mmc_tx_broadcastframe_g += readl(mmcaddr +
                         MMC_TX_BROADCASTFRAME_G);
   mmc->mmc_tx_multicastframe_g += readl(mmcaddr +
                         MMC_TX_MULTICASTFRAME_G);
   mmc->mmc_tx_64_octets_gb += readl(mmcaddr + MMC_TX_64_OCTETS_GB);
   mmc->mmc_tx_65_to_127_octets_gb +=
       readl(mmcaddr + MMC_TX_65_TO_127_OCTETS_GB);
   mmc->mmc_tx_128_to_255_octets_gb +=
       readl(mmcaddr + MMC_TX_128_TO_255_OCTETS_GB);
   mmc->mmc_tx_256_to_511_octets_gb +=
       readl(mmcaddr + MMC_TX_256_TO_511_OCTETS_GB);
   mmc->mmc_tx_512_to_1023_octets_gb +=
       readl(mmcaddr + MMC_TX_512_TO_1023_OCTETS_GB);
   mmc->mmc_tx_1024_to_max_octets_gb +=
       readl(mmcaddr + MMC_TX_1024_TO_MAX_OCTETS_GB);
   mmc->mmc_tx_unicast_gb += readl(mmcaddr + MMC_TX_UNICAST_GB);
   mmc->mmc_tx_multicast_gb += readl(mmcaddr + MMC_TX_MULTICAST_GB);
   mmc->mmc_tx_broadcast_gb += readl(mmcaddr + MMC_TX_BROADCAST_GB);
   mmc->mmc_tx_underflow_error += readl(mmcaddr + MMC_TX_UNDERFLOW_ERROR);
   mmc->mmc_tx_singlecol_g += readl(mmcaddr + MMC_TX_SINGLECOL_G);
   mmc->mmc_tx_multicol_g += readl(mmcaddr + MMC_TX_MULTICOL_G);
   mmc->mmc_tx_deferred += readl(mmcaddr + MMC_TX_DEFERRED);
   mmc->mmc_tx_latecol += readl(mmcaddr + MMC_TX_LATECOL);
   mmc->mmc_tx_exesscol += readl(mmcaddr + MMC_TX_EXESSCOL);
   mmc->mmc_tx_carrier_error += readl(mmcaddr + MMC_TX_CARRIER_ERROR);
   mmc->mmc_tx_octetcount_g += readl(mmcaddr + MMC_TX_OCTETCOUNT_G);
   mmc->mmc_tx_framecount_g += readl(mmcaddr + MMC_TX_FRAMECOUNT_G);
   mmc->mmc_tx_excessdef += readl(mmcaddr + MMC_TX_EXCESSDEF);
   mmc->mmc_tx_pause_frame += readl(mmcaddr + MMC_TX_PAUSE_FRAME);
   mmc->mmc_tx_vlan_frame_g += readl(mmcaddr + MMC_TX_VLAN_FRAME_G);
 
   /* MMC RX counter registers */
   mmc->mmc_rx_framecount_gb += readl(mmcaddr + MMC_RX_FRAMECOUNT_GB);
   mmc->mmc_rx_octetcount_gb += readl(mmcaddr + MMC_RX_OCTETCOUNT_GB);
   mmc->mmc_rx_octetcount_g += readl(mmcaddr + MMC_RX_OCTETCOUNT_G);
   mmc->mmc_rx_broadcastframe_g += readl(mmcaddr +
                         MMC_RX_BROADCASTFRAME_G);
   mmc->mmc_rx_multicastframe_g += readl(mmcaddr +
                         MMC_RX_MULTICASTFRAME_G);
   mmc->mmc_rx_crc_error += readl(mmcaddr + MMC_RX_CRC_ERROR);
   mmc->mmc_rx_align_error += readl(mmcaddr + MMC_RX_ALIGN_ERROR);
   mmc->mmc_rx_run_error += readl(mmcaddr + MMC_RX_RUN_ERROR);
   mmc->mmc_rx_jabber_error += readl(mmcaddr + MMC_RX_JABBER_ERROR);
   mmc->mmc_rx_undersize_g += readl(mmcaddr + MMC_RX_UNDERSIZE_G);
   mmc->mmc_rx_oversize_g += readl(mmcaddr + MMC_RX_OVERSIZE_G);
   mmc->mmc_rx_64_octets_gb += readl(mmcaddr + MMC_RX_64_OCTETS_GB);
   mmc->mmc_rx_65_to_127_octets_gb +=
       readl(mmcaddr + MMC_RX_65_TO_127_OCTETS_GB);
   mmc->mmc_rx_128_to_255_octets_gb +=
       readl(mmcaddr + MMC_RX_128_TO_255_OCTETS_GB);
   mmc->mmc_rx_256_to_511_octets_gb +=
       readl(mmcaddr + MMC_RX_256_TO_511_OCTETS_GB);
   mmc->mmc_rx_512_to_1023_octets_gb +=
       readl(mmcaddr + MMC_RX_512_TO_1023_OCTETS_GB);
   mmc->mmc_rx_1024_to_max_octets_gb +=
       readl(mmcaddr + MMC_RX_1024_TO_MAX_OCTETS_GB);
   mmc->mmc_rx_unicast_g += readl(mmcaddr + MMC_RX_UNICAST_G);
   mmc->mmc_rx_length_error += readl(mmcaddr + MMC_RX_LENGTH_ERROR);
   mmc->mmc_rx_autofrangetype += readl(mmcaddr + MMC_RX_AUTOFRANGETYPE);
   mmc->mmc_rx_pause_frames += readl(mmcaddr + MMC_RX_PAUSE_FRAMES);
   mmc->mmc_rx_fifo_overflow += readl(mmcaddr + MMC_RX_FIFO_OVERFLOW);
   mmc->mmc_rx_vlan_frames_gb += readl(mmcaddr + MMC_RX_VLAN_FRAMES_GB);
   mmc->mmc_rx_watchdog_error += readl(mmcaddr + MMC_RX_WATCHDOG_ERROR);
   /* IPC */
   mmc->mmc_rx_ipc_intr_mask += readl(mmcaddr + MMC_RX_IPC_INTR_MASK);
   mmc->mmc_rx_ipc_intr += readl(mmcaddr + MMC_RX_IPC_INTR);
   /* IPv4 */
   mmc->mmc_rx_ipv4_gd += readl(mmcaddr + MMC_RX_IPV4_GD);
   mmc->mmc_rx_ipv4_hderr += readl(mmcaddr + MMC_RX_IPV4_HDERR);
   mmc->mmc_rx_ipv4_nopay += readl(mmcaddr + MMC_RX_IPV4_NOPAY);
   mmc->mmc_rx_ipv4_frag += readl(mmcaddr + MMC_RX_IPV4_FRAG);
   mmc->mmc_rx_ipv4_udsbl += readl(mmcaddr + MMC_RX_IPV4_UDSBL);
 
   mmc->mmc_rx_ipv4_gd_octets += readl(mmcaddr + MMC_RX_IPV4_GD_OCTETS);
   mmc->mmc_rx_ipv4_hderr_octets +=
       readl(mmcaddr + MMC_RX_IPV4_HDERR_OCTETS);
   mmc->mmc_rx_ipv4_nopay_octets +=
       readl(mmcaddr + MMC_RX_IPV4_NOPAY_OCTETS);
   mmc->mmc_rx_ipv4_frag_octets += readl(mmcaddr +
                         MMC_RX_IPV4_FRAG_OCTETS);
   mmc->mmc_rx_ipv4_udsbl_octets +=
       readl(mmcaddr + MMC_RX_IPV4_UDSBL_OCTETS);
 
   /* IPV6 */
   mmc->mmc_rx_ipv6_gd_octets += readl(mmcaddr + MMC_RX_IPV6_GD_OCTETS);
   mmc->mmc_rx_ipv6_hderr_octets +=
       readl(mmcaddr + MMC_RX_IPV6_HDERR_OCTETS);
   mmc->mmc_rx_ipv6_nopay_octets +=
       readl(mmcaddr + MMC_RX_IPV6_NOPAY_OCTETS);
 
   mmc->mmc_rx_ipv6_gd += readl(mmcaddr + MMC_RX_IPV6_GD);
   mmc->mmc_rx_ipv6_hderr += readl(mmcaddr + MMC_RX_IPV6_HDERR);
   mmc->mmc_rx_ipv6_nopay += readl(mmcaddr + MMC_RX_IPV6_NOPAY);
 
   /* Protocols */
   mmc->mmc_rx_udp_gd += readl(mmcaddr + MMC_RX_UDP_GD);
   mmc->mmc_rx_udp_err += readl(mmcaddr + MMC_RX_UDP_ERR);
   mmc->mmc_rx_tcp_gd += readl(mmcaddr + MMC_RX_TCP_GD);
   mmc->mmc_rx_tcp_err += readl(mmcaddr + MMC_RX_TCP_ERR);
   mmc->mmc_rx_icmp_gd += readl(mmcaddr + MMC_RX_ICMP_GD);
   mmc->mmc_rx_icmp_err += readl(mmcaddr + MMC_RX_ICMP_ERR);
 
   mmc->mmc_rx_udp_gd_octets += readl(mmcaddr + MMC_RX_UDP_GD_OCTETS);
   mmc->mmc_rx_udp_err_octets += readl(mmcaddr + MMC_RX_UDP_ERR_OCTETS);
   mmc->mmc_rx_tcp_gd_octets += readl(mmcaddr + MMC_RX_TCP_GD_OCTETS);
   mmc->mmc_rx_tcp_err_octets += readl(mmcaddr + MMC_RX_TCP_ERR_OCTETS);
   mmc->mmc_rx_icmp_gd_octets += readl(mmcaddr + MMC_RX_ICMP_GD_OCTETS);
   mmc->mmc_rx_icmp_err_octets += readl(mmcaddr + MMC_RX_ICMP_ERR_OCTETS);
}