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#include <linux/if_vlan.h>
36
37#include <linux/mlx4/device.h>
38#include <linux/mlx4/cmd.h>
39
40#include "en_port.h"
41#include "mlx4_en.h"
42
43
44int mlx4_SET_VLAN_FLTR(struct mlx4_dev *dev, struct mlx4_en_priv *priv)
45{
46 struct mlx4_cmd_mailbox *mailbox;
47 struct mlx4_set_vlan_fltr_mbox *filter;
48 int i;
49 int j;
50 int index = 0;
51 u32 entry;
52 int err = 0;
53
54 mailbox = mlx4_alloc_cmd_mailbox(dev);
55 if (IS_ERR(mailbox))
56 return PTR_ERR(mailbox);
57
58 filter = mailbox->buf;
59 for (i = VLAN_FLTR_SIZE - 1; i >= 0; i--) {
60 entry = 0;
61 for (j = 0; j < 32; j++)
62 if (test_bit(index++, priv->active_vlans))
63 entry |= 1 << j;
64 filter->entry[i] = cpu_to_be32(entry);
65 }
66 err = mlx4_cmd(dev, mailbox->dma, priv->port, 0, MLX4_CMD_SET_VLAN_FLTR,
67 MLX4_CMD_TIME_CLASS_B, MLX4_CMD_WRAPPED);
68 mlx4_free_cmd_mailbox(dev, mailbox);
69 return err;
70}
71
72int mlx4_en_QUERY_PORT(struct mlx4_en_dev *mdev, u8 port)
73{
74 struct mlx4_en_query_port_context *qport_context;
75 struct mlx4_en_priv *priv = netdev_priv(mdev->pndev[port]);
76 struct mlx4_en_port_state *state = &priv->port_state;
77 struct mlx4_cmd_mailbox *mailbox;
78 int err;
79
80 mailbox = mlx4_alloc_cmd_mailbox(mdev->dev);
81 if (IS_ERR(mailbox))
82 return PTR_ERR(mailbox);
83 err = mlx4_cmd_box(mdev->dev, 0, mailbox->dma, port, 0,
84 MLX4_CMD_QUERY_PORT, MLX4_CMD_TIME_CLASS_B,
85 MLX4_CMD_WRAPPED);
86 if (err)
87 goto out;
88 qport_context = mailbox->buf;
89
90
91
92 state->link_state = !!(qport_context->link_up & MLX4_EN_LINK_UP_MASK);
93 switch (qport_context->link_speed & MLX4_EN_SPEED_MASK) {
94 case MLX4_EN_100M_SPEED:
95 state->link_speed = SPEED_100;
96 break;
97 case MLX4_EN_1G_SPEED:
98 state->link_speed = SPEED_1000;
99 break;
100 case MLX4_EN_10G_SPEED_XAUI:
101 case MLX4_EN_10G_SPEED_XFI:
102 state->link_speed = SPEED_10000;
103 break;
104 case MLX4_EN_20G_SPEED:
105 state->link_speed = SPEED_20000;
106 break;
107 case MLX4_EN_40G_SPEED:
108 state->link_speed = SPEED_40000;
109 break;
110 case MLX4_EN_56G_SPEED:
111 state->link_speed = SPEED_56000;
112 break;
113 default:
114 state->link_speed = -1;
115 break;
116 }
117
118 state->transceiver = qport_context->transceiver;
119
120 state->flags = 0;
121 state->flags |= (qport_context->link_up & MLX4_EN_ANC_MASK) ?
122 MLX4_EN_PORT_ANC : 0;
123 state->flags |= (qport_context->autoneg & MLX4_EN_AUTONEG_MASK) ?
124 MLX4_EN_PORT_ANE : 0;
125
126out:
127 mlx4_free_cmd_mailbox(mdev->dev, mailbox);
128 return err;
129}
130
131
132
133
134
135static unsigned long en_stats_adder(__be64 *start, __be64 *next, int num)
136{
137 __be64 *curr = start;
138 unsigned long ret = 0;
139 int i;
140 int offset = next - start;
141
142 for (i = 0; i < num; i++) {
143 ret += be64_to_cpu(*curr);
144 curr += offset;
145 }
146
147 return ret;
148}
149
150int mlx4_en_DUMP_ETH_STATS(struct mlx4_en_dev *mdev, u8 port, u8 reset)
151{
152 struct mlx4_counter tmp_counter_stats;
153 struct mlx4_en_stat_out_mbox *mlx4_en_stats;
154 struct mlx4_en_stat_out_flow_control_mbox *flowstats;
155 struct mlx4_en_priv *priv = netdev_priv(mdev->pndev[port]);
156 struct net_device_stats *stats = &priv->stats;
157 struct mlx4_cmd_mailbox *mailbox;
158 u64 in_mod = reset << 8 | port;
159 int err;
160 int i, counter_index;
161
162 mailbox = mlx4_alloc_cmd_mailbox(mdev->dev);
163 if (IS_ERR(mailbox))
164 return PTR_ERR(mailbox);
165 err = mlx4_cmd_box(mdev->dev, 0, mailbox->dma, in_mod, 0,
166 MLX4_CMD_DUMP_ETH_STATS, MLX4_CMD_TIME_CLASS_B,
167 MLX4_CMD_WRAPPED);
168 if (err)
169 goto out;
170
171 mlx4_en_stats = mailbox->buf;
172
173 spin_lock_bh(&priv->stats_lock);
174
175 stats->rx_packets = 0;
176 stats->rx_bytes = 0;
177 priv->port_stats.rx_chksum_good = 0;
178 priv->port_stats.rx_chksum_none = 0;
179 priv->port_stats.rx_chksum_complete = 0;
180 for (i = 0; i < priv->rx_ring_num; i++) {
181 stats->rx_packets += priv->rx_ring[i]->packets;
182 stats->rx_bytes += priv->rx_ring[i]->bytes;
183 priv->port_stats.rx_chksum_good += priv->rx_ring[i]->csum_ok;
184 priv->port_stats.rx_chksum_none += priv->rx_ring[i]->csum_none;
185 priv->port_stats.rx_chksum_complete += priv->rx_ring[i]->csum_complete;
186 }
187 stats->tx_packets = 0;
188 stats->tx_bytes = 0;
189 priv->port_stats.tx_chksum_offload = 0;
190 priv->port_stats.queue_stopped = 0;
191 priv->port_stats.wake_queue = 0;
192 priv->port_stats.tso_packets = 0;
193 priv->port_stats.xmit_more = 0;
194
195 for (i = 0; i < priv->tx_ring_num; i++) {
196 const struct mlx4_en_tx_ring *ring = priv->tx_ring[i];
197
198 stats->tx_packets += ring->packets;
199 stats->tx_bytes += ring->bytes;
200 priv->port_stats.tx_chksum_offload += ring->tx_csum;
201 priv->port_stats.queue_stopped += ring->queue_stopped;
202 priv->port_stats.wake_queue += ring->wake_queue;
203 priv->port_stats.tso_packets += ring->tso_packets;
204 priv->port_stats.xmit_more += ring->xmit_more;
205 }
206 if (mlx4_is_master(mdev->dev)) {
207 stats->rx_packets = en_stats_adder(&mlx4_en_stats->RTOT_prio_0,
208 &mlx4_en_stats->RTOT_prio_1,
209 NUM_PRIORITIES);
210 stats->tx_packets = en_stats_adder(&mlx4_en_stats->TTOT_prio_0,
211 &mlx4_en_stats->TTOT_prio_1,
212 NUM_PRIORITIES);
213 stats->rx_bytes = en_stats_adder(&mlx4_en_stats->ROCT_prio_0,
214 &mlx4_en_stats->ROCT_prio_1,
215 NUM_PRIORITIES);
216 stats->tx_bytes = en_stats_adder(&mlx4_en_stats->TOCT_prio_0,
217 &mlx4_en_stats->TOCT_prio_1,
218 NUM_PRIORITIES);
219 }
220
221
222 stats->rx_errors = be64_to_cpu(mlx4_en_stats->PCS) +
223 be32_to_cpu(mlx4_en_stats->RJBBR) +
224 be32_to_cpu(mlx4_en_stats->RCRC) +
225 be32_to_cpu(mlx4_en_stats->RRUNT) +
226 be64_to_cpu(mlx4_en_stats->RInRangeLengthErr) +
227 be64_to_cpu(mlx4_en_stats->ROutRangeLengthErr) +
228 be32_to_cpu(mlx4_en_stats->RSHORT) +
229 en_stats_adder(&mlx4_en_stats->RGIANT_prio_0,
230 &mlx4_en_stats->RGIANT_prio_1,
231 NUM_PRIORITIES);
232 stats->tx_errors = en_stats_adder(&mlx4_en_stats->TGIANT_prio_0,
233 &mlx4_en_stats->TGIANT_prio_1,
234 NUM_PRIORITIES);
235 stats->multicast = en_stats_adder(&mlx4_en_stats->MCAST_prio_0,
236 &mlx4_en_stats->MCAST_prio_1,
237 NUM_PRIORITIES);
238 stats->collisions = 0;
239 stats->rx_dropped = be32_to_cpu(mlx4_en_stats->RDROP);
240 stats->rx_length_errors = be32_to_cpu(mlx4_en_stats->RdropLength);
241 stats->rx_over_errors = be32_to_cpu(mlx4_en_stats->RdropOvflw);
242 stats->rx_crc_errors = be32_to_cpu(mlx4_en_stats->RCRC);
243 stats->rx_frame_errors = 0;
244 stats->rx_fifo_errors = be32_to_cpu(mlx4_en_stats->RdropOvflw);
245 stats->rx_missed_errors = be32_to_cpu(mlx4_en_stats->RdropOvflw);
246 stats->tx_aborted_errors = 0;
247 stats->tx_carrier_errors = 0;
248 stats->tx_fifo_errors = 0;
249 stats->tx_heartbeat_errors = 0;
250 stats->tx_window_errors = 0;
251 stats->tx_dropped = be32_to_cpu(mlx4_en_stats->TDROP);
252
253
254 priv->pkstats.rx_multicast_packets = stats->multicast;
255 priv->pkstats.rx_broadcast_packets =
256 en_stats_adder(&mlx4_en_stats->RBCAST_prio_0,
257 &mlx4_en_stats->RBCAST_prio_1,
258 NUM_PRIORITIES);
259 priv->pkstats.rx_jabbers = be32_to_cpu(mlx4_en_stats->RJBBR);
260 priv->pkstats.rx_in_range_length_error =
261 be64_to_cpu(mlx4_en_stats->RInRangeLengthErr);
262 priv->pkstats.rx_out_range_length_error =
263 be64_to_cpu(mlx4_en_stats->ROutRangeLengthErr);
264
265
266 priv->pkstats.tx_multicast_packets =
267 en_stats_adder(&mlx4_en_stats->TMCAST_prio_0,
268 &mlx4_en_stats->TMCAST_prio_1,
269 NUM_PRIORITIES);
270 priv->pkstats.tx_broadcast_packets =
271 en_stats_adder(&mlx4_en_stats->TBCAST_prio_0,
272 &mlx4_en_stats->TBCAST_prio_1,
273 NUM_PRIORITIES);
274
275 priv->pkstats.rx_prio[0][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_0);
276 priv->pkstats.rx_prio[0][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_0);
277 priv->pkstats.rx_prio[1][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_1);
278 priv->pkstats.rx_prio[1][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_1);
279 priv->pkstats.rx_prio[2][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_2);
280 priv->pkstats.rx_prio[2][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_2);
281 priv->pkstats.rx_prio[3][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_3);
282 priv->pkstats.rx_prio[3][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_3);
283 priv->pkstats.rx_prio[4][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_4);
284 priv->pkstats.rx_prio[4][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_4);
285 priv->pkstats.rx_prio[5][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_5);
286 priv->pkstats.rx_prio[5][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_5);
287 priv->pkstats.rx_prio[6][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_6);
288 priv->pkstats.rx_prio[6][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_6);
289 priv->pkstats.rx_prio[7][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_7);
290 priv->pkstats.rx_prio[7][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_7);
291 priv->pkstats.rx_prio[8][0] = be64_to_cpu(mlx4_en_stats->RTOT_novlan);
292 priv->pkstats.rx_prio[8][1] = be64_to_cpu(mlx4_en_stats->ROCT_novlan);
293 priv->pkstats.tx_prio[0][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_0);
294 priv->pkstats.tx_prio[0][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_0);
295 priv->pkstats.tx_prio[1][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_1);
296 priv->pkstats.tx_prio[1][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_1);
297 priv->pkstats.tx_prio[2][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_2);
298 priv->pkstats.tx_prio[2][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_2);
299 priv->pkstats.tx_prio[3][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_3);
300 priv->pkstats.tx_prio[3][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_3);
301 priv->pkstats.tx_prio[4][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_4);
302 priv->pkstats.tx_prio[4][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_4);
303 priv->pkstats.tx_prio[5][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_5);
304 priv->pkstats.tx_prio[5][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_5);
305 priv->pkstats.tx_prio[6][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_6);
306 priv->pkstats.tx_prio[6][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_6);
307 priv->pkstats.tx_prio[7][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_7);
308 priv->pkstats.tx_prio[7][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_7);
309 priv->pkstats.tx_prio[8][0] = be64_to_cpu(mlx4_en_stats->TTOT_novlan);
310 priv->pkstats.tx_prio[8][1] = be64_to_cpu(mlx4_en_stats->TOCT_novlan);
311
312 spin_unlock_bh(&priv->stats_lock);
313
314 memset(&tmp_counter_stats, 0, sizeof(tmp_counter_stats));
315 counter_index = mlx4_get_default_counter_index(mdev->dev, port);
316 err = mlx4_get_counter_stats(mdev->dev, counter_index,
317 &tmp_counter_stats, reset);
318
319
320 memset(mailbox->buf, 0xff, sizeof(*flowstats) * MLX4_NUM_PRIORITIES);
321
322 if (mdev->dev->caps.flags2 & MLX4_DEV_CAP_FLAG2_FLOWSTATS_EN) {
323 memset(mailbox->buf, 0,
324 sizeof(*flowstats) * MLX4_NUM_PRIORITIES);
325 err = mlx4_cmd_box(mdev->dev, 0, mailbox->dma,
326 in_mod | MLX4_DUMP_ETH_STATS_FLOW_CONTROL,
327 0, MLX4_CMD_DUMP_ETH_STATS,
328 MLX4_CMD_TIME_CLASS_B, MLX4_CMD_WRAPPED);
329 if (err)
330 goto out;
331 }
332
333 flowstats = mailbox->buf;
334
335 spin_lock_bh(&priv->stats_lock);
336
337 if (tmp_counter_stats.counter_mode == 0) {
338 priv->pf_stats.rx_bytes = be64_to_cpu(tmp_counter_stats.rx_bytes);
339 priv->pf_stats.tx_bytes = be64_to_cpu(tmp_counter_stats.tx_bytes);
340 priv->pf_stats.rx_packets = be64_to_cpu(tmp_counter_stats.rx_frames);
341 priv->pf_stats.tx_packets = be64_to_cpu(tmp_counter_stats.tx_frames);
342 }
343
344 for (i = 0; i < MLX4_NUM_PRIORITIES; i++) {
345 priv->rx_priority_flowstats[i].rx_pause =
346 be64_to_cpu(flowstats[i].rx_pause);
347 priv->rx_priority_flowstats[i].rx_pause_duration =
348 be64_to_cpu(flowstats[i].rx_pause_duration);
349 priv->rx_priority_flowstats[i].rx_pause_transition =
350 be64_to_cpu(flowstats[i].rx_pause_transition);
351 priv->tx_priority_flowstats[i].tx_pause =
352 be64_to_cpu(flowstats[i].tx_pause);
353 priv->tx_priority_flowstats[i].tx_pause_duration =
354 be64_to_cpu(flowstats[i].tx_pause_duration);
355 priv->tx_priority_flowstats[i].tx_pause_transition =
356 be64_to_cpu(flowstats[i].tx_pause_transition);
357 }
358
359
360 priv->rx_flowstats.rx_pause =
361 be64_to_cpu(flowstats[0].rx_pause);
362 priv->rx_flowstats.rx_pause_duration =
363 be64_to_cpu(flowstats[0].rx_pause_duration);
364 priv->rx_flowstats.rx_pause_transition =
365 be64_to_cpu(flowstats[0].rx_pause_transition);
366 priv->tx_flowstats.tx_pause =
367 be64_to_cpu(flowstats[0].tx_pause);
368 priv->tx_flowstats.tx_pause_duration =
369 be64_to_cpu(flowstats[0].tx_pause_duration);
370 priv->tx_flowstats.tx_pause_transition =
371 be64_to_cpu(flowstats[0].tx_pause_transition);
372
373 spin_unlock_bh(&priv->stats_lock);
374
375out:
376 mlx4_free_cmd_mailbox(mdev->dev, mailbox);
377 return err;
378}
379
380
