1/*
2 * Copyright (c) 2007, 2014 Mellanox Technologies. All rights reserved.
3 *
4 * This software is available to you under a choice of one of two
5 * licenses.  You may choose to be licensed under the terms of the GNU
6 * General Public License (GPL) Version 2, available from the file
7 * COPYING in the main directory of this source tree, or the
8 * OpenIB.org BSD license below:
9 *
10 *     Redistribution and use in source and binary forms, with or
11 *     without modification, are permitted provided that the following
12 *     conditions are met:
13 *
14 *      - Redistributions of source code must retain the above
15 *        copyright notice, this list of conditions and the following
16 *        disclaimer.
17 *
18 *      - Redistributions in binary form must reproduce the above
19 *        copyright notice, this list of conditions and the following
20 *        disclaimer in the documentation and/or other materials
21 *        provided with the distribution.
22 *
23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30 * SOFTWARE.
31 *
32 */
33
34#include <sys/types.h>
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#define EN_IFQ_MIN_INTERVAL 3000
43
44
45int mlx4_SET_VLAN_FLTR(struct mlx4_dev *dev, struct mlx4_en_priv *priv)
46{
47	struct mlx4_cmd_mailbox *mailbox;
48	struct mlx4_set_vlan_fltr_mbox *filter;
49	int i;
50	int j;
51	int index = 0;
52	u32 entry;
53	int err = 0;
54
55	mailbox = mlx4_alloc_cmd_mailbox(dev);
56	if (IS_ERR(mailbox))
57		return PTR_ERR(mailbox);
58
59	filter = mailbox->buf;
60	memset(filter, 0, sizeof(*filter));
61	for (i = VLAN_FLTR_SIZE - 1; i >= 0; i--) {
62		entry = 0;
63		for (j = 0; j < 32; j++)
64			if (test_bit(index, priv->active_vlans))
65				entry |= 1 << j;
66                        index++;
67		filter->entry[i] = cpu_to_be32(entry);
68	}
69	err = mlx4_cmd(dev, mailbox->dma, priv->port, 0, MLX4_CMD_SET_VLAN_FLTR,
70		       MLX4_CMD_TIME_CLASS_B, MLX4_CMD_WRAPPED);
71	mlx4_free_cmd_mailbox(dev, mailbox);
72	return err;
73}
74
75int mlx4_en_QUERY_PORT(struct mlx4_en_dev *mdev, u8 port)
76{
77	struct mlx4_en_query_port_context *qport_context;
78	struct mlx4_en_priv *priv = netdev_priv(mdev->pndev[port]);
79	struct mlx4_en_port_state *state = &priv->port_state;
80	struct mlx4_cmd_mailbox *mailbox;
81	int err;
82
83	mailbox = mlx4_alloc_cmd_mailbox(mdev->dev);
84	if (IS_ERR(mailbox))
85		return PTR_ERR(mailbox);
86	memset(mailbox->buf, 0, sizeof(*qport_context));
87	err = mlx4_cmd_box(mdev->dev, 0, mailbox->dma, port, 0,
88			   MLX4_CMD_QUERY_PORT, MLX4_CMD_TIME_CLASS_B,
89			   MLX4_CMD_WRAPPED);
90	if (err)
91		goto out;
92	qport_context = mailbox->buf;
93
94	/* This command is always accessed from Ethtool context
95	 * already synchronized, no need in locking */
96	state->link_state = !!(qport_context->link_up & MLX4_EN_LINK_UP_MASK);
97	switch (qport_context->link_speed & MLX4_EN_SPEED_MASK) {
98	case MLX4_EN_1G_SPEED:
99		state->link_speed = 1000;
100		break;
101	case MLX4_EN_10G_SPEED_XAUI:
102	case MLX4_EN_10G_SPEED_XFI:
103		state->link_speed = 10000;
104		break;
105	case MLX4_EN_20G_SPEED:
106		state->link_speed = 20000;
107		break;
108	case MLX4_EN_40G_SPEED:
109		state->link_speed = 40000;
110		break;
111	case MLX4_EN_56G_SPEED:
112		state->link_speed = 56000;
113		break;
114	default:
115		state->link_speed = -1;
116		break;
117	}
118	state->transciver = qport_context->transceiver;
119	state->autoneg = !!(qport_context->autoneg & MLX4_EN_AUTONEG_MASK);
120
121out:
122	mlx4_free_cmd_mailbox(mdev->dev, mailbox);
123	return err;
124}
125
126int mlx4_en_DUMP_ETH_STATS(struct mlx4_en_dev *mdev, u8 port, u8 reset)
127{
128	struct mlx4_en_stat_out_mbox *mlx4_en_stats;
129	struct mlx4_en_stat_out_flow_control_mbox *flowstats;
130	struct mlx4_en_priv *priv = netdev_priv(mdev->pndev[port]);
131	struct mlx4_en_vport_stats *vport_stats = &priv->vport_stats;
132	struct mlx4_cmd_mailbox *mailbox = NULL;
133	struct mlx4_cmd_mailbox *mailbox_flow = NULL;
134	u64 in_mod = reset << 8 | port;
135	int err;
136	int i;
137	int do_if_stat = 1;
138	unsigned long period = (unsigned long) (jiffies - priv->last_ifq_jiffies);
139	struct mlx4_en_vport_stats tmp_vport_stats;
140        struct net_device *dev;
141
142	if (jiffies_to_msecs(period) < EN_IFQ_MIN_INTERVAL ||
143				priv->counter_index == 0xff)
144		do_if_stat = 0;
145
146	mailbox = mlx4_alloc_cmd_mailbox(mdev->dev);
147	if (IS_ERR(mailbox)) {
148		err = PTR_ERR(mailbox);
149		goto mailbox_out;
150	}
151
152	mailbox_flow = mlx4_alloc_cmd_mailbox(mdev->dev);
153	if (IS_ERR(mailbox_flow)) {
154		mlx4_free_cmd_mailbox(mdev->dev, mailbox);
155		err = PTR_ERR(mailbox_flow);
156		goto mailbox_out;
157	}
158
159	/* 0xffs indicates invalid value */
160	memset(mailbox_flow->buf, 0xff, sizeof(*flowstats) *
161		MLX4_NUM_PRIORITIES);
162
163	if (mdev->dev->caps.flags2 & MLX4_DEV_CAP_FLAG2_FLOWSTATS_EN) {
164		memset(mailbox_flow->buf, 0, sizeof(*flowstats));
165		err = mlx4_cmd_box(mdev->dev, 0, mailbox_flow->dma,
166				   in_mod | 1<<12, 0, MLX4_CMD_DUMP_ETH_STATS,
167				   MLX4_CMD_TIME_CLASS_B, MLX4_CMD_NATIVE);
168
169		if (err)
170			goto out;
171	}
172
173	err = mlx4_cmd_box(mdev->dev, 0, mailbox->dma, in_mod, 0,
174			   MLX4_CMD_DUMP_ETH_STATS, MLX4_CMD_TIME_CLASS_B,
175			   MLX4_CMD_NATIVE);
176	if (err)
177		goto out;
178
179	mlx4_en_stats = mailbox->buf;
180
181	spin_lock(&priv->stats_lock);
182
183	priv->port_stats.rx_chksum_good = 0;
184	priv->port_stats.rx_chksum_none = 0;
185	for (i = 0; i < priv->rx_ring_num; i++) {
186		priv->port_stats.rx_chksum_good += priv->rx_ring[i]->csum_ok;
187		priv->port_stats.rx_chksum_none += priv->rx_ring[i]->csum_none;
188	}
189
190	priv->port_stats.tx_chksum_offload = 0;
191	priv->port_stats.queue_stopped = 0;
192	priv->port_stats.wake_queue = 0;
193	for (i = 0; i < priv->tx_ring_num; i++) {
194		priv->port_stats.tx_chksum_offload += priv->tx_ring[i]->tx_csum;
195		priv->port_stats.queue_stopped += priv->tx_ring[i]->queue_stopped;
196		priv->port_stats.wake_queue += priv->tx_ring[i]->wake_queue;
197	}
198	/* RX Statistics */
199	priv->pkstats.rx_packets = be64_to_cpu(mlx4_en_stats->RTOT_prio_0) +
200		be64_to_cpu(mlx4_en_stats->RTOT_prio_1) +
201		be64_to_cpu(mlx4_en_stats->RTOT_prio_2) +
202		be64_to_cpu(mlx4_en_stats->RTOT_prio_3) +
203		be64_to_cpu(mlx4_en_stats->RTOT_prio_4) +
204		be64_to_cpu(mlx4_en_stats->RTOT_prio_5) +
205		be64_to_cpu(mlx4_en_stats->RTOT_prio_6) +
206		be64_to_cpu(mlx4_en_stats->RTOT_prio_7) +
207		be64_to_cpu(mlx4_en_stats->RTOT_novlan);
208	priv->pkstats.rx_bytes = be64_to_cpu(mlx4_en_stats->ROCT_prio_0) +
209		be64_to_cpu(mlx4_en_stats->ROCT_prio_1) +
210		be64_to_cpu(mlx4_en_stats->ROCT_prio_2) +
211		be64_to_cpu(mlx4_en_stats->ROCT_prio_3) +
212		be64_to_cpu(mlx4_en_stats->ROCT_prio_4) +
213		be64_to_cpu(mlx4_en_stats->ROCT_prio_5) +
214		be64_to_cpu(mlx4_en_stats->ROCT_prio_6) +
215		be64_to_cpu(mlx4_en_stats->ROCT_prio_7) +
216		be64_to_cpu(mlx4_en_stats->ROCT_novlan);
217	priv->pkstats.rx_multicast_packets = be64_to_cpu(mlx4_en_stats->MCAST_prio_0) +
218		be64_to_cpu(mlx4_en_stats->MCAST_prio_1) +
219		be64_to_cpu(mlx4_en_stats->MCAST_prio_2) +
220		be64_to_cpu(mlx4_en_stats->MCAST_prio_3) +
221		be64_to_cpu(mlx4_en_stats->MCAST_prio_4) +
222		be64_to_cpu(mlx4_en_stats->MCAST_prio_5) +
223		be64_to_cpu(mlx4_en_stats->MCAST_prio_6) +
224		be64_to_cpu(mlx4_en_stats->MCAST_prio_7) +
225		be64_to_cpu(mlx4_en_stats->MCAST_novlan);
226	priv->pkstats.rx_broadcast_packets = be64_to_cpu(mlx4_en_stats->RBCAST_prio_0) +
227		be64_to_cpu(mlx4_en_stats->RBCAST_prio_1) +
228		be64_to_cpu(mlx4_en_stats->RBCAST_prio_2) +
229		be64_to_cpu(mlx4_en_stats->RBCAST_prio_3) +
230		be64_to_cpu(mlx4_en_stats->RBCAST_prio_4) +
231		be64_to_cpu(mlx4_en_stats->RBCAST_prio_5) +
232		be64_to_cpu(mlx4_en_stats->RBCAST_prio_6) +
233		be64_to_cpu(mlx4_en_stats->RBCAST_prio_7) +
234		be64_to_cpu(mlx4_en_stats->RBCAST_novlan);
235	priv->pkstats.rx_errors = be64_to_cpu(mlx4_en_stats->PCS) +
236		be32_to_cpu(mlx4_en_stats->RJBBR) +
237		be32_to_cpu(mlx4_en_stats->RCRC) +
238		be32_to_cpu(mlx4_en_stats->RRUNT) +
239		be64_to_cpu(mlx4_en_stats->RInRangeLengthErr) +
240		be64_to_cpu(mlx4_en_stats->ROutRangeLengthErr) +
241		be32_to_cpu(mlx4_en_stats->RSHORT) +
242		be64_to_cpu(mlx4_en_stats->RGIANT_prio_0) +
243		be64_to_cpu(mlx4_en_stats->RGIANT_prio_1) +
244		be64_to_cpu(mlx4_en_stats->RGIANT_prio_2) +
245		be64_to_cpu(mlx4_en_stats->RGIANT_prio_3) +
246		be64_to_cpu(mlx4_en_stats->RGIANT_prio_4) +
247		be64_to_cpu(mlx4_en_stats->RGIANT_prio_5) +
248		be64_to_cpu(mlx4_en_stats->RGIANT_prio_6) +
249		be64_to_cpu(mlx4_en_stats->RGIANT_prio_7) +
250		be64_to_cpu(mlx4_en_stats->RGIANT_novlan);
251	priv->pkstats.rx_dropped = be32_to_cpu(mlx4_en_stats->RdropOvflw);
252	priv->pkstats.rx_length_errors = be32_to_cpu(mlx4_en_stats->RdropLength);
253	priv->pkstats.rx_over_errors = be32_to_cpu(mlx4_en_stats->RdropOvflw);
254	priv->pkstats.rx_crc_errors = be32_to_cpu(mlx4_en_stats->RCRC);
255	priv->pkstats.rx_jabbers = be32_to_cpu(mlx4_en_stats->RJBBR);
256	priv->pkstats.rx_in_range_length_error = be64_to_cpu(mlx4_en_stats->RInRangeLengthErr);
257	priv->pkstats.rx_out_range_length_error = be64_to_cpu(mlx4_en_stats->ROutRangeLengthErr);
258	priv->pkstats.rx_lt_64_bytes_packets = be64_to_cpu(mlx4_en_stats->R64_prio_0) +
259		be64_to_cpu(mlx4_en_stats->R64_prio_1) +
260		be64_to_cpu(mlx4_en_stats->R64_prio_2) +
261		be64_to_cpu(mlx4_en_stats->R64_prio_3) +
262		be64_to_cpu(mlx4_en_stats->R64_prio_4) +
263		be64_to_cpu(mlx4_en_stats->R64_prio_5) +
264		be64_to_cpu(mlx4_en_stats->R64_prio_6) +
265		be64_to_cpu(mlx4_en_stats->R64_prio_7) +
266		be64_to_cpu(mlx4_en_stats->R64_novlan);
267	priv->pkstats.rx_127_bytes_packets = be64_to_cpu(mlx4_en_stats->R127_prio_0) +
268		be64_to_cpu(mlx4_en_stats->R127_prio_1) +
269		be64_to_cpu(mlx4_en_stats->R127_prio_2) +
270		be64_to_cpu(mlx4_en_stats->R127_prio_3) +
271		be64_to_cpu(mlx4_en_stats->R127_prio_4) +
272		be64_to_cpu(mlx4_en_stats->R127_prio_5) +
273		be64_to_cpu(mlx4_en_stats->R127_prio_6) +
274		be64_to_cpu(mlx4_en_stats->R127_prio_7) +
275		be64_to_cpu(mlx4_en_stats->R127_novlan);
276	priv->pkstats.rx_255_bytes_packets = be64_to_cpu(mlx4_en_stats->R255_prio_0) +
277		be64_to_cpu(mlx4_en_stats->R255_prio_1) +
278		be64_to_cpu(mlx4_en_stats->R255_prio_2) +
279		be64_to_cpu(mlx4_en_stats->R255_prio_3) +
280		be64_to_cpu(mlx4_en_stats->R255_prio_4) +
281		be64_to_cpu(mlx4_en_stats->R255_prio_5) +
282		be64_to_cpu(mlx4_en_stats->R255_prio_6) +
283		be64_to_cpu(mlx4_en_stats->R255_prio_7) +
284		be64_to_cpu(mlx4_en_stats->R255_novlan);
285	priv->pkstats.rx_511_bytes_packets = be64_to_cpu(mlx4_en_stats->R511_prio_0) +
286		be64_to_cpu(mlx4_en_stats->R511_prio_1) +
287		be64_to_cpu(mlx4_en_stats->R511_prio_2) +
288		be64_to_cpu(mlx4_en_stats->R511_prio_3) +
289		be64_to_cpu(mlx4_en_stats->R511_prio_4) +
290		be64_to_cpu(mlx4_en_stats->R511_prio_5) +
291		be64_to_cpu(mlx4_en_stats->R511_prio_6) +
292		be64_to_cpu(mlx4_en_stats->R511_prio_7) +
293		be64_to_cpu(mlx4_en_stats->R511_novlan);
294	priv->pkstats.rx_1023_bytes_packets = be64_to_cpu(mlx4_en_stats->R1023_prio_0) +
295		be64_to_cpu(mlx4_en_stats->R1023_prio_1) +
296		be64_to_cpu(mlx4_en_stats->R1023_prio_2) +
297		be64_to_cpu(mlx4_en_stats->R1023_prio_3) +
298		be64_to_cpu(mlx4_en_stats->R1023_prio_4) +
299		be64_to_cpu(mlx4_en_stats->R1023_prio_5) +
300		be64_to_cpu(mlx4_en_stats->R1023_prio_6) +
301		be64_to_cpu(mlx4_en_stats->R1023_prio_7) +
302		be64_to_cpu(mlx4_en_stats->R1023_novlan);
303	priv->pkstats.rx_1518_bytes_packets = be64_to_cpu(mlx4_en_stats->R1518_prio_0) +
304		be64_to_cpu(mlx4_en_stats->R1518_prio_1) +
305		be64_to_cpu(mlx4_en_stats->R1518_prio_2) +
306		be64_to_cpu(mlx4_en_stats->R1518_prio_3) +
307		be64_to_cpu(mlx4_en_stats->R1518_prio_4) +
308		be64_to_cpu(mlx4_en_stats->R1518_prio_5) +
309		be64_to_cpu(mlx4_en_stats->R1518_prio_6) +
310		be64_to_cpu(mlx4_en_stats->R1518_prio_7) +
311		be64_to_cpu(mlx4_en_stats->R1518_novlan);
312	priv->pkstats.rx_1522_bytes_packets = be64_to_cpu(mlx4_en_stats->R1522_prio_0) +
313		be64_to_cpu(mlx4_en_stats->R1522_prio_1) +
314		be64_to_cpu(mlx4_en_stats->R1522_prio_2) +
315		be64_to_cpu(mlx4_en_stats->R1522_prio_3) +
316		be64_to_cpu(mlx4_en_stats->R1522_prio_4) +
317		be64_to_cpu(mlx4_en_stats->R1522_prio_5) +
318		be64_to_cpu(mlx4_en_stats->R1522_prio_6) +
319		be64_to_cpu(mlx4_en_stats->R1522_prio_7) +
320		be64_to_cpu(mlx4_en_stats->R1522_novlan);
321	priv->pkstats.rx_1548_bytes_packets = be64_to_cpu(mlx4_en_stats->R1548_prio_0) +
322		be64_to_cpu(mlx4_en_stats->R1548_prio_1) +
323		be64_to_cpu(mlx4_en_stats->R1548_prio_2) +
324		be64_to_cpu(mlx4_en_stats->R1548_prio_3) +
325		be64_to_cpu(mlx4_en_stats->R1548_prio_4) +
326		be64_to_cpu(mlx4_en_stats->R1548_prio_5) +
327		be64_to_cpu(mlx4_en_stats->R1548_prio_6) +
328		be64_to_cpu(mlx4_en_stats->R1548_prio_7) +
329		be64_to_cpu(mlx4_en_stats->R1548_novlan);
330	priv->pkstats.rx_gt_1548_bytes_packets = be64_to_cpu(mlx4_en_stats->R2MTU_prio_0) +
331		be64_to_cpu(mlx4_en_stats->R2MTU_prio_1) +
332		be64_to_cpu(mlx4_en_stats->R2MTU_prio_2) +
333		be64_to_cpu(mlx4_en_stats->R2MTU_prio_3) +
334		be64_to_cpu(mlx4_en_stats->R2MTU_prio_4) +
335		be64_to_cpu(mlx4_en_stats->R2MTU_prio_5) +
336		be64_to_cpu(mlx4_en_stats->R2MTU_prio_6) +
337		be64_to_cpu(mlx4_en_stats->R2MTU_prio_7) +
338		be64_to_cpu(mlx4_en_stats->R2MTU_novlan);
339
340	/* Tx Stats */
341	priv->pkstats.tx_packets = be64_to_cpu(mlx4_en_stats->TTOT_prio_0) +
342		be64_to_cpu(mlx4_en_stats->TTOT_prio_1) +
343		be64_to_cpu(mlx4_en_stats->TTOT_prio_2) +
344		be64_to_cpu(mlx4_en_stats->TTOT_prio_3) +
345		be64_to_cpu(mlx4_en_stats->TTOT_prio_4) +
346		be64_to_cpu(mlx4_en_stats->TTOT_prio_5) +
347		be64_to_cpu(mlx4_en_stats->TTOT_prio_6) +
348		be64_to_cpu(mlx4_en_stats->TTOT_prio_7) +
349		be64_to_cpu(mlx4_en_stats->TTOT_novlan);
350	priv->pkstats.tx_bytes = be64_to_cpu(mlx4_en_stats->TOCT_prio_0) +
351		be64_to_cpu(mlx4_en_stats->TOCT_prio_1) +
352		be64_to_cpu(mlx4_en_stats->TOCT_prio_2) +
353		be64_to_cpu(mlx4_en_stats->TOCT_prio_3) +
354		be64_to_cpu(mlx4_en_stats->TOCT_prio_4) +
355		be64_to_cpu(mlx4_en_stats->TOCT_prio_5) +
356		be64_to_cpu(mlx4_en_stats->TOCT_prio_6) +
357		be64_to_cpu(mlx4_en_stats->TOCT_prio_7) +
358		be64_to_cpu(mlx4_en_stats->TOCT_novlan);
359	priv->pkstats.tx_multicast_packets = be64_to_cpu(mlx4_en_stats->TMCAST_prio_0) +
360		be64_to_cpu(mlx4_en_stats->TMCAST_prio_1) +
361		be64_to_cpu(mlx4_en_stats->TMCAST_prio_2) +
362		be64_to_cpu(mlx4_en_stats->TMCAST_prio_3) +
363		be64_to_cpu(mlx4_en_stats->TMCAST_prio_4) +
364		be64_to_cpu(mlx4_en_stats->TMCAST_prio_5) +
365		be64_to_cpu(mlx4_en_stats->TMCAST_prio_6) +
366		be64_to_cpu(mlx4_en_stats->TMCAST_prio_7) +
367		be64_to_cpu(mlx4_en_stats->TMCAST_novlan);
368	priv->pkstats.tx_broadcast_packets = be64_to_cpu(mlx4_en_stats->TBCAST_prio_0) +
369		be64_to_cpu(mlx4_en_stats->TBCAST_prio_1) +
370		be64_to_cpu(mlx4_en_stats->TBCAST_prio_2) +
371		be64_to_cpu(mlx4_en_stats->TBCAST_prio_3) +
372		be64_to_cpu(mlx4_en_stats->TBCAST_prio_4) +
373		be64_to_cpu(mlx4_en_stats->TBCAST_prio_5) +
374		be64_to_cpu(mlx4_en_stats->TBCAST_prio_6) +
375		be64_to_cpu(mlx4_en_stats->TBCAST_prio_7) +
376		be64_to_cpu(mlx4_en_stats->TBCAST_novlan);
377	priv->pkstats.tx_errors = be64_to_cpu(mlx4_en_stats->TGIANT_prio_0) +
378		be64_to_cpu(mlx4_en_stats->TGIANT_prio_1) +
379		be64_to_cpu(mlx4_en_stats->TGIANT_prio_2) +
380		be64_to_cpu(mlx4_en_stats->TGIANT_prio_3) +
381		be64_to_cpu(mlx4_en_stats->TGIANT_prio_4) +
382		be64_to_cpu(mlx4_en_stats->TGIANT_prio_5) +
383		be64_to_cpu(mlx4_en_stats->TGIANT_prio_6) +
384		be64_to_cpu(mlx4_en_stats->TGIANT_prio_7) +
385		be64_to_cpu(mlx4_en_stats->TGIANT_novlan);
386	priv->pkstats.tx_dropped = be32_to_cpu(mlx4_en_stats->TDROP) -
387		priv->pkstats.tx_errors;
388	priv->pkstats.tx_lt_64_bytes_packets = be64_to_cpu(mlx4_en_stats->T64_prio_0) +
389		be64_to_cpu(mlx4_en_stats->T64_prio_1) +
390		be64_to_cpu(mlx4_en_stats->T64_prio_2) +
391		be64_to_cpu(mlx4_en_stats->T64_prio_3) +
392		be64_to_cpu(mlx4_en_stats->T64_prio_4) +
393		be64_to_cpu(mlx4_en_stats->T64_prio_5) +
394		be64_to_cpu(mlx4_en_stats->T64_prio_6) +
395		be64_to_cpu(mlx4_en_stats->T64_prio_7) +
396		be64_to_cpu(mlx4_en_stats->T64_novlan);
397	priv->pkstats.tx_127_bytes_packets = be64_to_cpu(mlx4_en_stats->T127_prio_0) +
398		be64_to_cpu(mlx4_en_stats->T127_prio_1) +
399		be64_to_cpu(mlx4_en_stats->T127_prio_2) +
400		be64_to_cpu(mlx4_en_stats->T127_prio_3) +
401		be64_to_cpu(mlx4_en_stats->T127_prio_4) +
402		be64_to_cpu(mlx4_en_stats->T127_prio_5) +
403		be64_to_cpu(mlx4_en_stats->T127_prio_6) +
404		be64_to_cpu(mlx4_en_stats->T127_prio_7) +
405		be64_to_cpu(mlx4_en_stats->T127_novlan);
406	priv->pkstats.tx_255_bytes_packets = be64_to_cpu(mlx4_en_stats->T255_prio_0) +
407		be64_to_cpu(mlx4_en_stats->T255_prio_1) +
408		be64_to_cpu(mlx4_en_stats->T255_prio_2) +
409		be64_to_cpu(mlx4_en_stats->T255_prio_3) +
410		be64_to_cpu(mlx4_en_stats->T255_prio_4) +
411		be64_to_cpu(mlx4_en_stats->T255_prio_5) +
412		be64_to_cpu(mlx4_en_stats->T255_prio_6) +
413		be64_to_cpu(mlx4_en_stats->T255_prio_7) +
414		be64_to_cpu(mlx4_en_stats->T255_novlan);
415	priv->pkstats.tx_511_bytes_packets = be64_to_cpu(mlx4_en_stats->T511_prio_0) +
416		be64_to_cpu(mlx4_en_stats->T511_prio_1) +
417		be64_to_cpu(mlx4_en_stats->T511_prio_2) +
418		be64_to_cpu(mlx4_en_stats->T511_prio_3) +
419		be64_to_cpu(mlx4_en_stats->T511_prio_4) +
420		be64_to_cpu(mlx4_en_stats->T511_prio_5) +
421		be64_to_cpu(mlx4_en_stats->T511_prio_6) +
422		be64_to_cpu(mlx4_en_stats->T511_prio_7) +
423		be64_to_cpu(mlx4_en_stats->T511_novlan);
424	priv->pkstats.tx_1023_bytes_packets = be64_to_cpu(mlx4_en_stats->T1023_prio_0) +
425		be64_to_cpu(mlx4_en_stats->T1023_prio_1) +
426		be64_to_cpu(mlx4_en_stats->T1023_prio_2) +
427		be64_to_cpu(mlx4_en_stats->T1023_prio_3) +
428		be64_to_cpu(mlx4_en_stats->T1023_prio_4) +
429		be64_to_cpu(mlx4_en_stats->T1023_prio_5) +
430		be64_to_cpu(mlx4_en_stats->T1023_prio_6) +
431		be64_to_cpu(mlx4_en_stats->T1023_prio_7) +
432		be64_to_cpu(mlx4_en_stats->T1023_novlan);
433	priv->pkstats.tx_1518_bytes_packets = be64_to_cpu(mlx4_en_stats->T1518_prio_0) +
434		be64_to_cpu(mlx4_en_stats->T1518_prio_1) +
435		be64_to_cpu(mlx4_en_stats->T1518_prio_2) +
436		be64_to_cpu(mlx4_en_stats->T1518_prio_3) +
437		be64_to_cpu(mlx4_en_stats->T1518_prio_4) +
438		be64_to_cpu(mlx4_en_stats->T1518_prio_5) +
439		be64_to_cpu(mlx4_en_stats->T1518_prio_6) +
440		be64_to_cpu(mlx4_en_stats->T1518_prio_7) +
441		be64_to_cpu(mlx4_en_stats->T1518_novlan);
442	priv->pkstats.tx_1522_bytes_packets = be64_to_cpu(mlx4_en_stats->T1522_prio_0) +
443		be64_to_cpu(mlx4_en_stats->T1522_prio_1) +
444		be64_to_cpu(mlx4_en_stats->T1522_prio_2) +
445		be64_to_cpu(mlx4_en_stats->T1522_prio_3) +
446		be64_to_cpu(mlx4_en_stats->T1522_prio_4) +
447		be64_to_cpu(mlx4_en_stats->T1522_prio_5) +
448		be64_to_cpu(mlx4_en_stats->T1522_prio_6) +
449		be64_to_cpu(mlx4_en_stats->T1522_prio_7) +
450		be64_to_cpu(mlx4_en_stats->T1522_novlan);
451	priv->pkstats.tx_1548_bytes_packets = be64_to_cpu(mlx4_en_stats->T1548_prio_0) +
452		be64_to_cpu(mlx4_en_stats->T1548_prio_1) +
453		be64_to_cpu(mlx4_en_stats->T1548_prio_2) +
454		be64_to_cpu(mlx4_en_stats->T1548_prio_3) +
455		be64_to_cpu(mlx4_en_stats->T1548_prio_4) +
456		be64_to_cpu(mlx4_en_stats->T1548_prio_5) +
457		be64_to_cpu(mlx4_en_stats->T1548_prio_6) +
458		be64_to_cpu(mlx4_en_stats->T1548_prio_7) +
459		be64_to_cpu(mlx4_en_stats->T1548_novlan);
460	priv->pkstats.tx_gt_1548_bytes_packets = be64_to_cpu(mlx4_en_stats->T2MTU_prio_0) +
461		be64_to_cpu(mlx4_en_stats->T2MTU_prio_1) +
462		be64_to_cpu(mlx4_en_stats->T2MTU_prio_2) +
463		be64_to_cpu(mlx4_en_stats->T2MTU_prio_3) +
464		be64_to_cpu(mlx4_en_stats->T2MTU_prio_4) +
465		be64_to_cpu(mlx4_en_stats->T2MTU_prio_5) +
466		be64_to_cpu(mlx4_en_stats->T2MTU_prio_6) +
467		be64_to_cpu(mlx4_en_stats->T2MTU_prio_7) +
468		be64_to_cpu(mlx4_en_stats->T2MTU_novlan);
469
470	priv->pkstats.rx_prio[0][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_0);
471	priv->pkstats.rx_prio[0][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_0);
472	priv->pkstats.rx_prio[1][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_1);
473	priv->pkstats.rx_prio[1][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_1);
474	priv->pkstats.rx_prio[2][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_2);
475	priv->pkstats.rx_prio[2][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_2);
476	priv->pkstats.rx_prio[3][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_3);
477	priv->pkstats.rx_prio[3][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_3);
478	priv->pkstats.rx_prio[4][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_4);
479	priv->pkstats.rx_prio[4][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_4);
480	priv->pkstats.rx_prio[5][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_5);
481	priv->pkstats.rx_prio[5][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_5);
482	priv->pkstats.rx_prio[6][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_6);
483	priv->pkstats.rx_prio[6][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_6);
484	priv->pkstats.rx_prio[7][0] = be64_to_cpu(mlx4_en_stats->RTOT_prio_7);
485	priv->pkstats.rx_prio[7][1] = be64_to_cpu(mlx4_en_stats->ROCT_prio_7);
486	priv->pkstats.rx_prio[8][0] = be64_to_cpu(mlx4_en_stats->RTOT_novlan);
487	priv->pkstats.rx_prio[8][1] = be64_to_cpu(mlx4_en_stats->ROCT_novlan);
488	priv->pkstats.tx_prio[0][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_0);
489	priv->pkstats.tx_prio[0][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_0);
490	priv->pkstats.tx_prio[1][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_1);
491	priv->pkstats.tx_prio[1][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_1);
492	priv->pkstats.tx_prio[2][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_2);
493	priv->pkstats.tx_prio[2][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_2);
494	priv->pkstats.tx_prio[3][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_3);
495	priv->pkstats.tx_prio[3][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_3);
496	priv->pkstats.tx_prio[4][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_4);
497	priv->pkstats.tx_prio[4][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_4);
498	priv->pkstats.tx_prio[5][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_5);
499	priv->pkstats.tx_prio[5][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_5);
500	priv->pkstats.tx_prio[6][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_6);
501	priv->pkstats.tx_prio[6][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_6);
502	priv->pkstats.tx_prio[7][0] = be64_to_cpu(mlx4_en_stats->TTOT_prio_7);
503	priv->pkstats.tx_prio[7][1] = be64_to_cpu(mlx4_en_stats->TOCT_prio_7);
504	priv->pkstats.tx_prio[8][0] = be64_to_cpu(mlx4_en_stats->TTOT_novlan);
505	priv->pkstats.tx_prio[8][1] = be64_to_cpu(mlx4_en_stats->TOCT_novlan);
506
507	flowstats = mailbox_flow->buf;
508
509	for (i = 0; i < MLX4_NUM_PRIORITIES; i++)	{
510		priv->flowstats[i].rx_pause =
511			be64_to_cpu(flowstats[i].rx_pause);
512		priv->flowstats[i].rx_pause_duration =
513			be64_to_cpu(flowstats[i].rx_pause_duration);
514		priv->flowstats[i].rx_pause_transition =
515			be64_to_cpu(flowstats[i].rx_pause_transition);
516		priv->flowstats[i].tx_pause =
517			be64_to_cpu(flowstats[i].tx_pause);
518		priv->flowstats[i].tx_pause_duration =
519			be64_to_cpu(flowstats[i].tx_pause_duration);
520		priv->flowstats[i].tx_pause_transition =
521			be64_to_cpu(flowstats[i].tx_pause_transition);
522	}
523
524	memset(&tmp_vport_stats, 0, sizeof(tmp_vport_stats));
525	spin_unlock(&priv->stats_lock);
526	err = mlx4_get_vport_ethtool_stats(mdev->dev, port,
527					   &tmp_vport_stats, reset);
528	spin_lock(&priv->stats_lock);
529	if (!err) {
530		/* ethtool stats format */
531		vport_stats->rx_unicast_packets = tmp_vport_stats.rx_unicast_packets;
532		vport_stats->rx_unicast_bytes = tmp_vport_stats.rx_unicast_bytes;
533		vport_stats->rx_multicast_packets = tmp_vport_stats.rx_multicast_packets;
534		vport_stats->rx_multicast_bytes = tmp_vport_stats.rx_multicast_bytes;
535		vport_stats->rx_broadcast_packets = tmp_vport_stats.rx_broadcast_packets;
536		vport_stats->rx_broadcast_bytes = tmp_vport_stats.rx_broadcast_bytes;
537		vport_stats->rx_dropped = tmp_vport_stats.rx_dropped;
538		vport_stats->rx_errors = tmp_vport_stats.rx_errors;
539		vport_stats->tx_unicast_packets = tmp_vport_stats.tx_unicast_packets;
540		vport_stats->tx_unicast_bytes = tmp_vport_stats.tx_unicast_bytes;
541		vport_stats->tx_multicast_packets = tmp_vport_stats.tx_multicast_packets;
542		vport_stats->tx_multicast_bytes = tmp_vport_stats.tx_multicast_bytes;
543		vport_stats->tx_broadcast_packets = tmp_vport_stats.tx_broadcast_packets;
544		vport_stats->tx_broadcast_bytes = tmp_vport_stats.tx_broadcast_bytes;
545		vport_stats->tx_errors = tmp_vport_stats.tx_errors;
546	}
547
548	if (!mlx4_is_mfunc(mdev->dev)) {
549		/* netdevice stats format */
550                dev                     = mdev->pndev[port];
551		dev->if_ipackets        = priv->pkstats.rx_packets;
552		dev->if_opackets        = priv->pkstats.tx_packets;
553		dev->if_ibytes          = priv->pkstats.rx_bytes;
554		dev->if_obytes          = priv->pkstats.tx_bytes;
555		dev->if_ierrors         = priv->pkstats.rx_errors;
556		dev->if_iqdrops         = priv->pkstats.rx_dropped;
557		dev->if_imcasts         = priv->pkstats.rx_multicast_packets;
558                dev->if_omcasts         = priv->pkstats.tx_multicast_packets;
559                dev->if_collisions      = 0;
560	}
561
562	spin_unlock(&priv->stats_lock);
563
564out:
565	mlx4_free_cmd_mailbox(mdev->dev, mailbox_flow);
566	mlx4_free_cmd_mailbox(mdev->dev, mailbox);
567
568mailbox_out:
569	if (do_if_stat)
570		priv->last_ifq_jiffies = jiffies;
571
572	return err;
573}
574