1 // SPDX-License-Identifier: GPL-2.0+
2 // Copyright (c) 2025 Hisilicon Limited.
3
4 #include <linux/iopoll.h>
5 #include <linux/phy.h>
6 #include "hbg_common.h"
7 #include "hbg_ethtool.h"
8 #include "hbg_hw.h"
9 #include "hbg_diagnose.h"
10
11 #define HBG_MSG_DATA_MAX_NUM 64
12
13 struct hbg_diagnose_message {
14 u32 opcode;
15 u32 status;
16 u32 data_num;
17 struct hbg_priv *priv;
18
19 u32 data[HBG_MSG_DATA_MAX_NUM];
20 };
21
22 #define HBG_HW_PUSH_WAIT_TIMEOUT_US (2 * 1000 * 1000)
23 #define HBG_HW_PUSH_WAIT_INTERVAL_US (1 * 1000)
24
25 enum hbg_push_cmd {
26 HBG_PUSH_CMD_IRQ = 0,
27 HBG_PUSH_CMD_STATS,
28 HBG_PUSH_CMD_LINK,
29 };
30
31 struct hbg_push_stats_info {
32 /* id is used to match the name of the current stats item.
33 * and is used for pretty print on BMC
34 */
35 u32 id;
36 u64 offset;
37 };
38
39 struct hbg_push_irq_info {
40 /* id is used to match the name of the current irq.
41 * and is used for pretty print on BMC
42 */
43 u32 id;
44 u32 mask;
45 };
46
47 #define HBG_PUSH_IRQ_I(name, id) {id, HBG_INT_MSK_##name##_B}
48 static const struct hbg_push_irq_info hbg_push_irq_list[] = {
49 HBG_PUSH_IRQ_I(RX, 0),
50 HBG_PUSH_IRQ_I(TX, 1),
51 HBG_PUSH_IRQ_I(TX_PKT_CPL, 2),
52 HBG_PUSH_IRQ_I(MAC_MII_FIFO_ERR, 3),
53 HBG_PUSH_IRQ_I(MAC_PCS_RX_FIFO_ERR, 4),
54 HBG_PUSH_IRQ_I(MAC_PCS_TX_FIFO_ERR, 5),
55 HBG_PUSH_IRQ_I(MAC_APP_RX_FIFO_ERR, 6),
56 HBG_PUSH_IRQ_I(MAC_APP_TX_FIFO_ERR, 7),
57 HBG_PUSH_IRQ_I(SRAM_PARITY_ERR, 8),
58 HBG_PUSH_IRQ_I(TX_AHB_ERR, 9),
59 HBG_PUSH_IRQ_I(RX_BUF_AVL, 10),
60 HBG_PUSH_IRQ_I(REL_BUF_ERR, 11),
61 HBG_PUSH_IRQ_I(TXCFG_AVL, 12),
62 HBG_PUSH_IRQ_I(TX_DROP, 13),
63 HBG_PUSH_IRQ_I(RX_DROP, 14),
64 HBG_PUSH_IRQ_I(RX_AHB_ERR, 15),
65 HBG_PUSH_IRQ_I(MAC_FIFO_ERR, 16),
66 HBG_PUSH_IRQ_I(RBREQ_ERR, 17),
67 HBG_PUSH_IRQ_I(WE_ERR, 18),
68 };
69
70 #define HBG_PUSH_STATS_I(name, id) {id, HBG_STATS_FIELD_OFF(name)}
71 static const struct hbg_push_stats_info hbg_push_stats_list[] = {
72 HBG_PUSH_STATS_I(rx_desc_drop, 0),
73 HBG_PUSH_STATS_I(rx_desc_l2_err_cnt, 1),
74 HBG_PUSH_STATS_I(rx_desc_pkt_len_err_cnt, 2),
75 HBG_PUSH_STATS_I(rx_desc_l3_wrong_head_cnt, 3),
76 HBG_PUSH_STATS_I(rx_desc_l3_csum_err_cnt, 4),
77 HBG_PUSH_STATS_I(rx_desc_l3_len_err_cnt, 5),
78 HBG_PUSH_STATS_I(rx_desc_l3_zero_ttl_cnt, 6),
79 HBG_PUSH_STATS_I(rx_desc_l3_other_cnt, 7),
80 HBG_PUSH_STATS_I(rx_desc_l4_err_cnt, 8),
81 HBG_PUSH_STATS_I(rx_desc_l4_wrong_head_cnt, 9),
82 HBG_PUSH_STATS_I(rx_desc_l4_len_err_cnt, 10),
83 HBG_PUSH_STATS_I(rx_desc_l4_csum_err_cnt, 11),
84 HBG_PUSH_STATS_I(rx_desc_l4_zero_port_num_cnt, 12),
85 HBG_PUSH_STATS_I(rx_desc_l4_other_cnt, 13),
86 HBG_PUSH_STATS_I(rx_desc_frag_cnt, 14),
87 HBG_PUSH_STATS_I(rx_desc_ip_ver_err_cnt, 15),
88 HBG_PUSH_STATS_I(rx_desc_ipv4_pkt_cnt, 16),
89 HBG_PUSH_STATS_I(rx_desc_ipv6_pkt_cnt, 17),
90 HBG_PUSH_STATS_I(rx_desc_no_ip_pkt_cnt, 18),
91 HBG_PUSH_STATS_I(rx_desc_ip_pkt_cnt, 19),
92 HBG_PUSH_STATS_I(rx_desc_tcp_pkt_cnt, 20),
93 HBG_PUSH_STATS_I(rx_desc_udp_pkt_cnt, 21),
94 HBG_PUSH_STATS_I(rx_desc_vlan_pkt_cnt, 22),
95 HBG_PUSH_STATS_I(rx_desc_icmp_pkt_cnt, 23),
96 HBG_PUSH_STATS_I(rx_desc_arp_pkt_cnt, 24),
97 HBG_PUSH_STATS_I(rx_desc_rarp_pkt_cnt, 25),
98 HBG_PUSH_STATS_I(rx_desc_multicast_pkt_cnt, 26),
99 HBG_PUSH_STATS_I(rx_desc_broadcast_pkt_cnt, 27),
100 HBG_PUSH_STATS_I(rx_desc_ipsec_pkt_cnt, 28),
101 HBG_PUSH_STATS_I(rx_desc_ip_opt_pkt_cnt, 29),
102 HBG_PUSH_STATS_I(rx_desc_key_not_match_cnt, 30),
103 HBG_PUSH_STATS_I(rx_octets_total_ok_cnt, 31),
104 HBG_PUSH_STATS_I(rx_uc_pkt_cnt, 32),
105 HBG_PUSH_STATS_I(rx_mc_pkt_cnt, 33),
106 HBG_PUSH_STATS_I(rx_bc_pkt_cnt, 34),
107 HBG_PUSH_STATS_I(rx_vlan_pkt_cnt, 35),
108 HBG_PUSH_STATS_I(rx_octets_bad_cnt, 36),
109 HBG_PUSH_STATS_I(rx_octets_total_filt_cnt, 37),
110 HBG_PUSH_STATS_I(rx_filt_pkt_cnt, 38),
111 HBG_PUSH_STATS_I(rx_trans_pkt_cnt, 39),
112 HBG_PUSH_STATS_I(rx_framesize_64, 40),
113 HBG_PUSH_STATS_I(rx_framesize_65_127, 41),
114 HBG_PUSH_STATS_I(rx_framesize_128_255, 42),
115 HBG_PUSH_STATS_I(rx_framesize_256_511, 43),
116 HBG_PUSH_STATS_I(rx_framesize_512_1023, 44),
117 HBG_PUSH_STATS_I(rx_framesize_1024_1518, 45),
118 HBG_PUSH_STATS_I(rx_framesize_bt_1518, 46),
119 HBG_PUSH_STATS_I(rx_fcs_error_cnt, 47),
120 HBG_PUSH_STATS_I(rx_data_error_cnt, 48),
121 HBG_PUSH_STATS_I(rx_align_error_cnt, 49),
122 HBG_PUSH_STATS_I(rx_frame_long_err_cnt, 50),
123 HBG_PUSH_STATS_I(rx_jabber_err_cnt, 51),
124 HBG_PUSH_STATS_I(rx_pause_macctl_frame_cnt, 52),
125 HBG_PUSH_STATS_I(rx_unknown_macctl_frame_cnt, 53),
126 HBG_PUSH_STATS_I(rx_frame_very_long_err_cnt, 54),
127 HBG_PUSH_STATS_I(rx_frame_runt_err_cnt, 55),
128 HBG_PUSH_STATS_I(rx_frame_short_err_cnt, 56),
129 HBG_PUSH_STATS_I(rx_overflow_cnt, 57),
130 HBG_PUSH_STATS_I(rx_bufrq_err_cnt, 58),
131 HBG_PUSH_STATS_I(rx_we_err_cnt, 59),
132 HBG_PUSH_STATS_I(rx_overrun_cnt, 60),
133 HBG_PUSH_STATS_I(rx_lengthfield_err_cnt, 61),
134 HBG_PUSH_STATS_I(rx_fail_comma_cnt, 62),
135 HBG_PUSH_STATS_I(rx_dma_err_cnt, 63),
136 HBG_PUSH_STATS_I(rx_fifo_less_empty_thrsld_cnt, 64),
137 HBG_PUSH_STATS_I(tx_octets_total_ok_cnt, 65),
138 HBG_PUSH_STATS_I(tx_uc_pkt_cnt, 66),
139 HBG_PUSH_STATS_I(tx_mc_pkt_cnt, 67),
140 HBG_PUSH_STATS_I(tx_bc_pkt_cnt, 68),
141 HBG_PUSH_STATS_I(tx_vlan_pkt_cnt, 69),
142 HBG_PUSH_STATS_I(tx_octets_bad_cnt, 70),
143 HBG_PUSH_STATS_I(tx_trans_pkt_cnt, 71),
144 HBG_PUSH_STATS_I(tx_pause_frame_cnt, 72),
145 HBG_PUSH_STATS_I(tx_framesize_64, 73),
146 HBG_PUSH_STATS_I(tx_framesize_65_127, 74),
147 HBG_PUSH_STATS_I(tx_framesize_128_255, 75),
148 HBG_PUSH_STATS_I(tx_framesize_256_511, 76),
149 HBG_PUSH_STATS_I(tx_framesize_512_1023, 77),
150 HBG_PUSH_STATS_I(tx_framesize_1024_1518, 78),
151 HBG_PUSH_STATS_I(tx_framesize_bt_1518, 79),
152 HBG_PUSH_STATS_I(tx_underrun_err_cnt, 80),
153 HBG_PUSH_STATS_I(tx_add_cs_fail_cnt, 81),
154 HBG_PUSH_STATS_I(tx_bufrl_err_cnt, 82),
155 HBG_PUSH_STATS_I(tx_crc_err_cnt, 83),
156 HBG_PUSH_STATS_I(tx_drop_cnt, 84),
157 HBG_PUSH_STATS_I(tx_excessive_length_drop_cnt, 85),
158 HBG_PUSH_STATS_I(tx_dma_err_cnt, 86),
159 HBG_PUSH_STATS_I(reset_fail_cnt, 87),
160 };
161
hbg_push_msg_send(struct hbg_priv * priv,struct hbg_diagnose_message * msg)162 static int hbg_push_msg_send(struct hbg_priv *priv,
163 struct hbg_diagnose_message *msg)
164 {
165 u32 header = 0;
166 u32 i;
167
168 if (msg->data_num == 0)
169 return 0;
170
171 for (i = 0; i < msg->data_num && i < HBG_MSG_DATA_MAX_NUM; i++)
172 hbg_reg_write(priv,
173 HBG_REG_MSG_DATA_BASE_ADDR + i * sizeof(u32),
174 msg->data[i]);
175
176 hbg_field_modify(header, HBG_REG_MSG_HEADER_OPCODE_M, msg->opcode);
177 hbg_field_modify(header, HBG_REG_MSG_HEADER_DATA_NUM_M, msg->data_num);
178 hbg_field_modify(header, HBG_REG_MSG_HEADER_RESP_CODE_M, ETIMEDOUT);
179
180 /* start status */
181 hbg_field_modify(header, HBG_REG_MSG_HEADER_STATUS_M, 1);
182
183 /* write header msg to start push */
184 hbg_reg_write(priv, HBG_REG_MSG_HEADER_ADDR, header);
185
186 /* wait done */
187 readl_poll_timeout(priv->io_base + HBG_REG_MSG_HEADER_ADDR, header,
188 !FIELD_GET(HBG_REG_MSG_HEADER_STATUS_M, header),
189 HBG_HW_PUSH_WAIT_INTERVAL_US,
190 HBG_HW_PUSH_WAIT_TIMEOUT_US);
191
192 msg->status = FIELD_GET(HBG_REG_MSG_HEADER_STATUS_M, header);
193 return -(int)FIELD_GET(HBG_REG_MSG_HEADER_RESP_CODE_M, header);
194 }
195
hbg_push_data(struct hbg_priv * priv,u32 opcode,u32 * data,u32 data_num)196 static int hbg_push_data(struct hbg_priv *priv,
197 u32 opcode, u32 *data, u32 data_num)
198 {
199 struct hbg_diagnose_message msg = {0};
200 u32 data_left_num;
201 u32 i, j;
202 int ret;
203
204 msg.priv = priv;
205 msg.opcode = opcode;
206 for (i = 0; i < data_num / HBG_MSG_DATA_MAX_NUM + 1; i++) {
207 if (i * HBG_MSG_DATA_MAX_NUM >= data_num)
208 break;
209
210 data_left_num = data_num - i * HBG_MSG_DATA_MAX_NUM;
211 for (j = 0; j < data_left_num && j < HBG_MSG_DATA_MAX_NUM; j++)
212 msg.data[j] = data[i * HBG_MSG_DATA_MAX_NUM + j];
213
214 msg.data_num = j;
215 ret = hbg_push_msg_send(priv, &msg);
216 if (ret)
217 return ret;
218 }
219
220 return 0;
221 }
222
hbg_push_data_u64(struct hbg_priv * priv,u32 opcode,u64 * data,u32 data_num)223 static int hbg_push_data_u64(struct hbg_priv *priv, u32 opcode,
224 u64 *data, u32 data_num)
225 {
226 /* The length of u64 is twice that of u32,
227 * the data_num must be multiplied by 2.
228 */
229 return hbg_push_data(priv, opcode, (u32 *)data, data_num * 2);
230 }
231
hbg_get_irq_stats(struct hbg_vector * vectors,u32 mask)232 static u64 hbg_get_irq_stats(struct hbg_vector *vectors, u32 mask)
233 {
234 u32 i = 0;
235
236 for (i = 0; i < vectors->info_array_len; i++)
237 if (vectors->info_array[i].mask == mask)
238 return vectors->stats_array[i];
239
240 return 0;
241 }
242
hbg_push_irq_cnt(struct hbg_priv * priv)243 static int hbg_push_irq_cnt(struct hbg_priv *priv)
244 {
245 /* An id needs to be added for each data.
246 * Therefore, the data_num must be multiplied by 2.
247 */
248 u32 data_num = ARRAY_SIZE(hbg_push_irq_list) * 2;
249 struct hbg_vector *vectors = &priv->vectors;
250 const struct hbg_push_irq_info *info;
251 u32 i, j = 0;
252 u64 *data;
253 int ret;
254
255 data = kcalloc(data_num, sizeof(u64), GFP_KERNEL);
256 if (!data)
257 return -ENOMEM;
258
259 /* An id needs to be added for each data.
260 * So i + 2 for each loop.
261 */
262 for (i = 0; i < data_num; i += 2) {
263 info = &hbg_push_irq_list[j++];
264 data[i] = info->id;
265 data[i + 1] = hbg_get_irq_stats(vectors, info->mask);
266 }
267
268 ret = hbg_push_data_u64(priv, HBG_PUSH_CMD_IRQ, data, data_num);
269 kfree(data);
270 return ret;
271 }
272
hbg_push_link_status(struct hbg_priv * priv)273 static int hbg_push_link_status(struct hbg_priv *priv)
274 {
275 u32 link_status[2];
276
277 /* phy link status */
278 link_status[0] = priv->mac.phydev->link;
279 /* mac link status */
280 link_status[1] = hbg_reg_read_field(priv, HBG_REG_AN_NEG_STATE_ADDR,
281 HBG_REG_AN_NEG_STATE_NP_LINK_OK_B);
282
283 return hbg_push_data(priv, HBG_PUSH_CMD_LINK,
284 link_status, ARRAY_SIZE(link_status));
285 }
286
hbg_push_stats(struct hbg_priv * priv)287 static int hbg_push_stats(struct hbg_priv *priv)
288 {
289 /* An id needs to be added for each data.
290 * Therefore, the data_num must be multiplied by 2.
291 */
292 u64 data_num = ARRAY_SIZE(hbg_push_stats_list) * 2;
293 struct hbg_stats *stats = &priv->stats;
294 const struct hbg_push_stats_info *info;
295 u32 i, j = 0;
296 u64 *data;
297 int ret;
298
299 data = kcalloc(data_num, sizeof(u64), GFP_KERNEL);
300 if (!data)
301 return -ENOMEM;
302
303 /* An id needs to be added for each data.
304 * So i + 2 for each loop.
305 */
306 for (i = 0; i < data_num; i += 2) {
307 info = &hbg_push_stats_list[j++];
308 data[i] = info->id;
309 data[i + 1] = HBG_STATS_R(stats, info->offset);
310 }
311
312 ret = hbg_push_data_u64(priv, HBG_PUSH_CMD_STATS, data, data_num);
313 kfree(data);
314 return ret;
315 }
316
hbg_diagnose_message_push(struct hbg_priv * priv)317 void hbg_diagnose_message_push(struct hbg_priv *priv)
318 {
319 int ret;
320
321 if (test_bit(HBG_NIC_STATE_RESETTING, &priv->state))
322 return;
323
324 /* only 1 is the right value */
325 if (hbg_reg_read(priv, HBG_REG_PUSH_REQ_ADDR) != 1)
326 return;
327
328 ret = hbg_push_irq_cnt(priv);
329 if (ret) {
330 dev_err(&priv->pdev->dev,
331 "failed to push irq cnt, ret = %d\n", ret);
332 goto push_done;
333 }
334
335 ret = hbg_push_link_status(priv);
336 if (ret) {
337 dev_err(&priv->pdev->dev,
338 "failed to push link status, ret = %d\n", ret);
339 goto push_done;
340 }
341
342 ret = hbg_push_stats(priv);
343 if (ret)
344 dev_err(&priv->pdev->dev,
345 "failed to push stats, ret = %d\n", ret);
346
347 push_done:
348 hbg_reg_write(priv, HBG_REG_PUSH_REQ_ADDR, 0);
349 }
350