xref: /linux/drivers/net/ethernet/mellanox/mlx4/port.c (revision 353b7a55dcaf5fb8758e09ebe2ddf5f3adbac7c5)
1 /*
2  * Copyright (c) 2007 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 #include <linux/errno.h>
34 #include <linux/if_ether.h>
35 #include <linux/if_vlan.h>
36 #include <linux/export.h>
37 
38 #include <linux/mlx4/cmd.h>
39 
40 #include "mlx4.h"
41 #include "mlx4_stats.h"
42 
43 #define MLX4_MAC_VALID		(1ull << 63)
44 
45 #define MLX4_VLAN_VALID		(1u << 31)
46 #define MLX4_VLAN_MASK		0xfff
47 
48 #define MLX4_STATS_TRAFFIC_COUNTERS_MASK	0xfULL
49 #define MLX4_STATS_TRAFFIC_DROPS_MASK		0xc0ULL
50 #define MLX4_STATS_ERROR_COUNTERS_MASK		0x1ffc30ULL
51 #define MLX4_STATS_PORT_COUNTERS_MASK		0x1fe00000ULL
52 
53 #define MLX4_FLAG2_V_IGNORE_FCS_MASK		BIT(1)
54 #define MLX4_FLAG2_V_USER_MTU_MASK		BIT(5)
55 #define MLX4_FLAG2_V_USER_MAC_MASK		BIT(6)
56 #define MLX4_FLAG_V_MTU_MASK			BIT(0)
57 #define MLX4_FLAG_V_PPRX_MASK			BIT(1)
58 #define MLX4_FLAG_V_PPTX_MASK			BIT(2)
59 #define MLX4_IGNORE_FCS_MASK			0x1
60 #define MLX4_TC_MAX_NUMBER			8
61 
62 void mlx4_init_mac_table(struct mlx4_dev *dev, struct mlx4_mac_table *table)
63 {
64 	int i;
65 
66 	mutex_init(&table->mutex);
67 	for (i = 0; i < MLX4_MAX_MAC_NUM; i++) {
68 		table->entries[i] = 0;
69 		table->refs[i]	 = 0;
70 		table->is_dup[i] = false;
71 	}
72 	table->max   = 1 << dev->caps.log_num_macs;
73 	table->total = 0;
74 }
75 
76 void mlx4_init_vlan_table(struct mlx4_dev *dev, struct mlx4_vlan_table *table)
77 {
78 	int i;
79 
80 	mutex_init(&table->mutex);
81 	for (i = 0; i < MLX4_MAX_VLAN_NUM; i++) {
82 		table->entries[i] = 0;
83 		table->refs[i]	 = 0;
84 		table->is_dup[i] = false;
85 	}
86 	table->max   = (1 << dev->caps.log_num_vlans) - MLX4_VLAN_REGULAR;
87 	table->total = 0;
88 }
89 
90 void mlx4_init_roce_gid_table(struct mlx4_dev *dev,
91 			      struct mlx4_roce_gid_table *table)
92 {
93 	int i;
94 
95 	mutex_init(&table->mutex);
96 	for (i = 0; i < MLX4_ROCE_MAX_GIDS; i++)
97 		memset(table->roce_gids[i].raw, 0, MLX4_ROCE_GID_ENTRY_SIZE);
98 }
99 
100 static int validate_index(struct mlx4_dev *dev,
101 			  struct mlx4_mac_table *table, int index)
102 {
103 	int err = 0;
104 
105 	if (index < 0 || index >= table->max || !table->entries[index]) {
106 		mlx4_warn(dev, "No valid Mac entry for the given index\n");
107 		err = -EINVAL;
108 	}
109 	return err;
110 }
111 
112 static int find_index(struct mlx4_dev *dev,
113 		      struct mlx4_mac_table *table, u64 mac)
114 {
115 	int i;
116 
117 	for (i = 0; i < MLX4_MAX_MAC_NUM; i++) {
118 		if (table->refs[i] &&
119 		    (MLX4_MAC_MASK & mac) ==
120 		    (MLX4_MAC_MASK & be64_to_cpu(table->entries[i])))
121 			return i;
122 	}
123 	/* Mac not found */
124 	return -EINVAL;
125 }
126 
127 static int mlx4_set_port_mac_table(struct mlx4_dev *dev, u8 port,
128 				   __be64 *entries)
129 {
130 	struct mlx4_cmd_mailbox *mailbox;
131 	u32 in_mod;
132 	int err;
133 
134 	mailbox = mlx4_alloc_cmd_mailbox(dev);
135 	if (IS_ERR(mailbox))
136 		return PTR_ERR(mailbox);
137 
138 	memcpy(mailbox->buf, entries, MLX4_MAC_TABLE_SIZE);
139 
140 	in_mod = MLX4_SET_PORT_MAC_TABLE << 8 | port;
141 
142 	err = mlx4_cmd(dev, mailbox->dma, in_mod, MLX4_SET_PORT_ETH_OPCODE,
143 		       MLX4_CMD_SET_PORT, MLX4_CMD_TIME_CLASS_B,
144 		       MLX4_CMD_NATIVE);
145 
146 	mlx4_free_cmd_mailbox(dev, mailbox);
147 	return err;
148 }
149 
150 int mlx4_find_cached_mac(struct mlx4_dev *dev, u8 port, u64 mac, int *idx)
151 {
152 	struct mlx4_port_info *info = &mlx4_priv(dev)->port[port];
153 	struct mlx4_mac_table *table = &info->mac_table;
154 	int i;
155 
156 	for (i = 0; i < MLX4_MAX_MAC_NUM; i++) {
157 		if (!table->refs[i])
158 			continue;
159 
160 		if (mac == (MLX4_MAC_MASK & be64_to_cpu(table->entries[i]))) {
161 			*idx = i;
162 			return 0;
163 		}
164 	}
165 
166 	return -ENOENT;
167 }
168 EXPORT_SYMBOL_GPL(mlx4_find_cached_mac);
169 
170 static bool mlx4_need_mf_bond(struct mlx4_dev *dev)
171 {
172 	int i, num_eth_ports = 0;
173 
174 	if (!mlx4_is_mfunc(dev))
175 		return false;
176 	mlx4_foreach_port(i, dev, MLX4_PORT_TYPE_ETH)
177 		++num_eth_ports;
178 
179 	return (num_eth_ports ==  2) ? true : false;
180 }
181 
182 int __mlx4_register_mac(struct mlx4_dev *dev, u8 port, u64 mac)
183 {
184 	struct mlx4_port_info *info = &mlx4_priv(dev)->port[port];
185 	struct mlx4_mac_table *table = &info->mac_table;
186 	int i, err = 0;
187 	int free = -1;
188 	int free_for_dup = -1;
189 	bool dup = mlx4_is_mf_bonded(dev);
190 	u8 dup_port = (port == 1) ? 2 : 1;
191 	struct mlx4_mac_table *dup_table = &mlx4_priv(dev)->port[dup_port].mac_table;
192 	bool need_mf_bond = mlx4_need_mf_bond(dev);
193 	bool can_mf_bond = true;
194 
195 	mlx4_dbg(dev, "Registering MAC: 0x%llx for port %d %s duplicate\n",
196 		 (unsigned long long)mac, port,
197 		 dup ? "with" : "without");
198 
199 	if (need_mf_bond) {
200 		if (port == 1) {
201 			mutex_lock(&table->mutex);
202 			mutex_lock_nested(&dup_table->mutex, SINGLE_DEPTH_NESTING);
203 		} else {
204 			mutex_lock(&dup_table->mutex);
205 			mutex_lock_nested(&table->mutex, SINGLE_DEPTH_NESTING);
206 		}
207 	} else {
208 		mutex_lock(&table->mutex);
209 	}
210 
211 	if (need_mf_bond) {
212 		int index_at_port = -1;
213 		int index_at_dup_port = -1;
214 
215 		for (i = 0; i < MLX4_MAX_MAC_NUM; i++) {
216 			if (((MLX4_MAC_MASK & mac) == (MLX4_MAC_MASK & be64_to_cpu(table->entries[i]))))
217 				index_at_port = i;
218 			if (((MLX4_MAC_MASK & mac) == (MLX4_MAC_MASK & be64_to_cpu(dup_table->entries[i]))))
219 				index_at_dup_port = i;
220 		}
221 
222 		/* check that same mac is not in the tables at different indices */
223 		if ((index_at_port != index_at_dup_port) &&
224 		    (index_at_port >= 0) &&
225 		    (index_at_dup_port >= 0))
226 			can_mf_bond = false;
227 
228 		/* If the mac is already in the primary table, the slot must be
229 		 * available in the duplicate table as well.
230 		 */
231 		if (index_at_port >= 0 && index_at_dup_port < 0 &&
232 		    dup_table->refs[index_at_port]) {
233 			can_mf_bond = false;
234 		}
235 		/* If the mac is already in the duplicate table, check that the
236 		 * corresponding index is not occupied in the primary table, or
237 		 * the primary table already contains the mac at the same index.
238 		 * Otherwise, you cannot bond (primary contains a different mac
239 		 * at that index).
240 		 */
241 		if (index_at_dup_port >= 0) {
242 			if (!table->refs[index_at_dup_port] ||
243 			    ((MLX4_MAC_MASK & mac) == (MLX4_MAC_MASK & be64_to_cpu(table->entries[index_at_dup_port]))))
244 				free_for_dup = index_at_dup_port;
245 			else
246 				can_mf_bond = false;
247 		}
248 	}
249 
250 	for (i = 0; i < MLX4_MAX_MAC_NUM; i++) {
251 		if (!table->refs[i]) {
252 			if (free < 0)
253 				free = i;
254 			if (free_for_dup < 0 && need_mf_bond && can_mf_bond) {
255 				if (!dup_table->refs[i])
256 					free_for_dup = i;
257 			}
258 			continue;
259 		}
260 
261 		if ((MLX4_MAC_MASK & mac) ==
262 		     (MLX4_MAC_MASK & be64_to_cpu(table->entries[i]))) {
263 			/* MAC already registered, increment ref count */
264 			err = i;
265 			++table->refs[i];
266 			if (dup) {
267 				u64 dup_mac = MLX4_MAC_MASK & be64_to_cpu(dup_table->entries[i]);
268 
269 				if (dup_mac != mac || !dup_table->is_dup[i]) {
270 					mlx4_warn(dev, "register mac: expect duplicate mac 0x%llx on port %d index %d\n",
271 						  mac, dup_port, i);
272 				}
273 			}
274 			goto out;
275 		}
276 	}
277 
278 	if (need_mf_bond && (free_for_dup < 0)) {
279 		if (dup) {
280 			mlx4_warn(dev, "Fail to allocate duplicate MAC table entry\n");
281 			mlx4_warn(dev, "High Availability for virtual functions may not work as expected\n");
282 			dup = false;
283 		}
284 		can_mf_bond = false;
285 	}
286 
287 	if (need_mf_bond && can_mf_bond)
288 		free = free_for_dup;
289 
290 	mlx4_dbg(dev, "Free MAC index is %d\n", free);
291 
292 	if (table->total == table->max) {
293 		/* No free mac entries */
294 		err = -ENOSPC;
295 		goto out;
296 	}
297 
298 	/* Register new MAC */
299 	table->entries[free] = cpu_to_be64(mac | MLX4_MAC_VALID);
300 
301 	err = mlx4_set_port_mac_table(dev, port, table->entries);
302 	if (unlikely(err)) {
303 		mlx4_err(dev, "Failed adding MAC: 0x%llx\n",
304 			 (unsigned long long) mac);
305 		table->entries[free] = 0;
306 		goto out;
307 	}
308 	table->refs[free] = 1;
309 	table->is_dup[free] = false;
310 	++table->total;
311 	if (dup) {
312 		dup_table->refs[free] = 0;
313 		dup_table->is_dup[free] = true;
314 		dup_table->entries[free] = cpu_to_be64(mac | MLX4_MAC_VALID);
315 
316 		err = mlx4_set_port_mac_table(dev, dup_port, dup_table->entries);
317 		if (unlikely(err)) {
318 			mlx4_warn(dev, "Failed adding duplicate mac: 0x%llx\n", mac);
319 			dup_table->is_dup[free] = false;
320 			dup_table->entries[free] = 0;
321 			goto out;
322 		}
323 		++dup_table->total;
324 	}
325 	err = free;
326 out:
327 	if (need_mf_bond) {
328 		if (port == 2) {
329 			mutex_unlock(&table->mutex);
330 			mutex_unlock(&dup_table->mutex);
331 		} else {
332 			mutex_unlock(&dup_table->mutex);
333 			mutex_unlock(&table->mutex);
334 		}
335 	} else {
336 		mutex_unlock(&table->mutex);
337 	}
338 	return err;
339 }
340 EXPORT_SYMBOL_GPL(__mlx4_register_mac);
341 
342 int mlx4_register_mac(struct mlx4_dev *dev, u8 port, u64 mac)
343 {
344 	u64 out_param = 0;
345 	int err = -EINVAL;
346 
347 	if (mlx4_is_mfunc(dev)) {
348 		if (!(dev->flags & MLX4_FLAG_OLD_REG_MAC)) {
349 			err = mlx4_cmd_imm(dev, mac, &out_param,
350 					   ((u32) port) << 8 | (u32) RES_MAC,
351 					   RES_OP_RESERVE_AND_MAP, MLX4_CMD_ALLOC_RES,
352 					   MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED);
353 		}
354 		if (err && err == -EINVAL && mlx4_is_slave(dev)) {
355 			/* retry using old REG_MAC format */
356 			set_param_l(&out_param, port);
357 			err = mlx4_cmd_imm(dev, mac, &out_param, RES_MAC,
358 					   RES_OP_RESERVE_AND_MAP, MLX4_CMD_ALLOC_RES,
359 					   MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED);
360 			if (!err)
361 				dev->flags |= MLX4_FLAG_OLD_REG_MAC;
362 		}
363 		if (err)
364 			return err;
365 
366 		return get_param_l(&out_param);
367 	}
368 	return __mlx4_register_mac(dev, port, mac);
369 }
370 EXPORT_SYMBOL_GPL(mlx4_register_mac);
371 
372 int mlx4_get_base_qpn(struct mlx4_dev *dev, u8 port)
373 {
374 	return dev->caps.reserved_qps_base[MLX4_QP_REGION_ETH_ADDR] +
375 			(port - 1) * (1 << dev->caps.log_num_macs);
376 }
377 EXPORT_SYMBOL_GPL(mlx4_get_base_qpn);
378 
379 void __mlx4_unregister_mac(struct mlx4_dev *dev, u8 port, u64 mac)
380 {
381 	struct mlx4_port_info *info;
382 	struct mlx4_mac_table *table;
383 	int index;
384 	bool dup = mlx4_is_mf_bonded(dev);
385 	u8 dup_port = (port == 1) ? 2 : 1;
386 	struct mlx4_mac_table *dup_table = &mlx4_priv(dev)->port[dup_port].mac_table;
387 
388 	if (port < 1 || port > dev->caps.num_ports) {
389 		mlx4_warn(dev, "invalid port number (%d), aborting...\n", port);
390 		return;
391 	}
392 	info = &mlx4_priv(dev)->port[port];
393 	table = &info->mac_table;
394 
395 	if (dup) {
396 		if (port == 1) {
397 			mutex_lock(&table->mutex);
398 			mutex_lock_nested(&dup_table->mutex, SINGLE_DEPTH_NESTING);
399 		} else {
400 			mutex_lock(&dup_table->mutex);
401 			mutex_lock_nested(&table->mutex, SINGLE_DEPTH_NESTING);
402 		}
403 	} else {
404 		mutex_lock(&table->mutex);
405 	}
406 
407 	index = find_index(dev, table, mac);
408 
409 	if (validate_index(dev, table, index))
410 		goto out;
411 
412 	if (--table->refs[index] || table->is_dup[index]) {
413 		mlx4_dbg(dev, "Have more references for index %d, no need to modify mac table\n",
414 			 index);
415 		if (!table->refs[index])
416 			dup_table->is_dup[index] = false;
417 		goto out;
418 	}
419 
420 	table->entries[index] = 0;
421 	if (mlx4_set_port_mac_table(dev, port, table->entries))
422 		mlx4_warn(dev, "Fail to set mac in port %d during unregister\n", port);
423 	--table->total;
424 
425 	if (dup) {
426 		dup_table->is_dup[index] = false;
427 		if (dup_table->refs[index])
428 			goto out;
429 		dup_table->entries[index] = 0;
430 		if (mlx4_set_port_mac_table(dev, dup_port, dup_table->entries))
431 			mlx4_warn(dev, "Fail to set mac in duplicate port %d during unregister\n", dup_port);
432 
433 		--table->total;
434 	}
435 out:
436 	if (dup) {
437 		if (port == 2) {
438 			mutex_unlock(&table->mutex);
439 			mutex_unlock(&dup_table->mutex);
440 		} else {
441 			mutex_unlock(&dup_table->mutex);
442 			mutex_unlock(&table->mutex);
443 		}
444 	} else {
445 		mutex_unlock(&table->mutex);
446 	}
447 }
448 EXPORT_SYMBOL_GPL(__mlx4_unregister_mac);
449 
450 void mlx4_unregister_mac(struct mlx4_dev *dev, u8 port, u64 mac)
451 {
452 	u64 out_param = 0;
453 
454 	if (mlx4_is_mfunc(dev)) {
455 		if (!(dev->flags & MLX4_FLAG_OLD_REG_MAC)) {
456 			(void) mlx4_cmd_imm(dev, mac, &out_param,
457 					    ((u32) port) << 8 | (u32) RES_MAC,
458 					    RES_OP_RESERVE_AND_MAP, MLX4_CMD_FREE_RES,
459 					    MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED);
460 		} else {
461 			/* use old unregister mac format */
462 			set_param_l(&out_param, port);
463 			(void) mlx4_cmd_imm(dev, mac, &out_param, RES_MAC,
464 					    RES_OP_RESERVE_AND_MAP, MLX4_CMD_FREE_RES,
465 					    MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED);
466 		}
467 		return;
468 	}
469 	__mlx4_unregister_mac(dev, port, mac);
470 	return;
471 }
472 EXPORT_SYMBOL_GPL(mlx4_unregister_mac);
473 
474 int __mlx4_replace_mac(struct mlx4_dev *dev, u8 port, int qpn, u64 new_mac)
475 {
476 	struct mlx4_port_info *info = &mlx4_priv(dev)->port[port];
477 	struct mlx4_mac_table *table = &info->mac_table;
478 	int index = qpn - info->base_qpn;
479 	int err = 0;
480 	bool dup = mlx4_is_mf_bonded(dev);
481 	u8 dup_port = (port == 1) ? 2 : 1;
482 	struct mlx4_mac_table *dup_table = &mlx4_priv(dev)->port[dup_port].mac_table;
483 
484 	/* CX1 doesn't support multi-functions */
485 	if (dup) {
486 		if (port == 1) {
487 			mutex_lock(&table->mutex);
488 			mutex_lock_nested(&dup_table->mutex, SINGLE_DEPTH_NESTING);
489 		} else {
490 			mutex_lock(&dup_table->mutex);
491 			mutex_lock_nested(&table->mutex, SINGLE_DEPTH_NESTING);
492 		}
493 	} else {
494 		mutex_lock(&table->mutex);
495 	}
496 
497 	err = validate_index(dev, table, index);
498 	if (err)
499 		goto out;
500 
501 	table->entries[index] = cpu_to_be64(new_mac | MLX4_MAC_VALID);
502 
503 	err = mlx4_set_port_mac_table(dev, port, table->entries);
504 	if (unlikely(err)) {
505 		mlx4_err(dev, "Failed adding MAC: 0x%llx\n",
506 			 (unsigned long long) new_mac);
507 		table->entries[index] = 0;
508 	} else {
509 		if (dup) {
510 			dup_table->entries[index] = cpu_to_be64(new_mac | MLX4_MAC_VALID);
511 
512 			err = mlx4_set_port_mac_table(dev, dup_port, dup_table->entries);
513 			if (unlikely(err)) {
514 				mlx4_err(dev, "Failed adding duplicate MAC: 0x%llx\n",
515 					 (unsigned long long)new_mac);
516 				dup_table->entries[index] = 0;
517 			}
518 		}
519 	}
520 out:
521 	if (dup) {
522 		if (port == 2) {
523 			mutex_unlock(&table->mutex);
524 			mutex_unlock(&dup_table->mutex);
525 		} else {
526 			mutex_unlock(&dup_table->mutex);
527 			mutex_unlock(&table->mutex);
528 		}
529 	} else {
530 		mutex_unlock(&table->mutex);
531 	}
532 	return err;
533 }
534 EXPORT_SYMBOL_GPL(__mlx4_replace_mac);
535 
536 static int mlx4_set_port_vlan_table(struct mlx4_dev *dev, u8 port,
537 				    __be32 *entries)
538 {
539 	struct mlx4_cmd_mailbox *mailbox;
540 	u32 in_mod;
541 	int err;
542 
543 	mailbox = mlx4_alloc_cmd_mailbox(dev);
544 	if (IS_ERR(mailbox))
545 		return PTR_ERR(mailbox);
546 
547 	memcpy(mailbox->buf, entries, MLX4_VLAN_TABLE_SIZE);
548 	in_mod = MLX4_SET_PORT_VLAN_TABLE << 8 | port;
549 	err = mlx4_cmd(dev, mailbox->dma, in_mod, MLX4_SET_PORT_ETH_OPCODE,
550 		       MLX4_CMD_SET_PORT, MLX4_CMD_TIME_CLASS_B,
551 		       MLX4_CMD_NATIVE);
552 
553 	mlx4_free_cmd_mailbox(dev, mailbox);
554 
555 	return err;
556 }
557 
558 int mlx4_find_cached_vlan(struct mlx4_dev *dev, u8 port, u16 vid, int *idx)
559 {
560 	struct mlx4_vlan_table *table = &mlx4_priv(dev)->port[port].vlan_table;
561 	int i;
562 
563 	for (i = 0; i < MLX4_MAX_VLAN_NUM; ++i) {
564 		if (table->refs[i] &&
565 		    (vid == (MLX4_VLAN_MASK &
566 			      be32_to_cpu(table->entries[i])))) {
567 			/* VLAN already registered, increase reference count */
568 			*idx = i;
569 			return 0;
570 		}
571 	}
572 
573 	return -ENOENT;
574 }
575 EXPORT_SYMBOL_GPL(mlx4_find_cached_vlan);
576 
577 int __mlx4_register_vlan(struct mlx4_dev *dev, u8 port, u16 vlan,
578 				int *index)
579 {
580 	struct mlx4_vlan_table *table = &mlx4_priv(dev)->port[port].vlan_table;
581 	int i, err = 0;
582 	int free = -1;
583 	int free_for_dup = -1;
584 	bool dup = mlx4_is_mf_bonded(dev);
585 	u8 dup_port = (port == 1) ? 2 : 1;
586 	struct mlx4_vlan_table *dup_table = &mlx4_priv(dev)->port[dup_port].vlan_table;
587 	bool need_mf_bond = mlx4_need_mf_bond(dev);
588 	bool can_mf_bond = true;
589 
590 	mlx4_dbg(dev, "Registering VLAN: %d for port %d %s duplicate\n",
591 		 vlan, port,
592 		 dup ? "with" : "without");
593 
594 	if (need_mf_bond) {
595 		if (port == 1) {
596 			mutex_lock(&table->mutex);
597 			mutex_lock_nested(&dup_table->mutex, SINGLE_DEPTH_NESTING);
598 		} else {
599 			mutex_lock(&dup_table->mutex);
600 			mutex_lock_nested(&table->mutex, SINGLE_DEPTH_NESTING);
601 		}
602 	} else {
603 		mutex_lock(&table->mutex);
604 	}
605 
606 	if (table->total == table->max) {
607 		/* No free vlan entries */
608 		err = -ENOSPC;
609 		goto out;
610 	}
611 
612 	if (need_mf_bond) {
613 		int index_at_port = -1;
614 		int index_at_dup_port = -1;
615 
616 		for (i = MLX4_VLAN_REGULAR; i < MLX4_MAX_VLAN_NUM; i++) {
617 			if (vlan == (MLX4_VLAN_MASK & be32_to_cpu(table->entries[i])))
618 				index_at_port = i;
619 			if (vlan == (MLX4_VLAN_MASK & be32_to_cpu(dup_table->entries[i])))
620 				index_at_dup_port = i;
621 		}
622 		/* check that same vlan is not in the tables at different indices */
623 		if ((index_at_port != index_at_dup_port) &&
624 		    (index_at_port >= 0) &&
625 		    (index_at_dup_port >= 0))
626 			can_mf_bond = false;
627 
628 		/* If the vlan is already in the primary table, the slot must be
629 		 * available in the duplicate table as well.
630 		 */
631 		if (index_at_port >= 0 && index_at_dup_port < 0 &&
632 		    dup_table->refs[index_at_port]) {
633 			can_mf_bond = false;
634 		}
635 		/* If the vlan is already in the duplicate table, check that the
636 		 * corresponding index is not occupied in the primary table, or
637 		 * the primary table already contains the vlan at the same index.
638 		 * Otherwise, you cannot bond (primary contains a different vlan
639 		 * at that index).
640 		 */
641 		if (index_at_dup_port >= 0) {
642 			if (!table->refs[index_at_dup_port] ||
643 			    (vlan == (MLX4_VLAN_MASK & be32_to_cpu(dup_table->entries[index_at_dup_port]))))
644 				free_for_dup = index_at_dup_port;
645 			else
646 				can_mf_bond = false;
647 		}
648 	}
649 
650 	for (i = MLX4_VLAN_REGULAR; i < MLX4_MAX_VLAN_NUM; i++) {
651 		if (!table->refs[i]) {
652 			if (free < 0)
653 				free = i;
654 			if (free_for_dup < 0 && need_mf_bond && can_mf_bond) {
655 				if (!dup_table->refs[i])
656 					free_for_dup = i;
657 			}
658 		}
659 
660 		if ((table->refs[i] || table->is_dup[i]) &&
661 		    (vlan == (MLX4_VLAN_MASK &
662 			      be32_to_cpu(table->entries[i])))) {
663 			/* Vlan already registered, increase references count */
664 			mlx4_dbg(dev, "vlan %u is already registered.\n", vlan);
665 			*index = i;
666 			++table->refs[i];
667 			if (dup) {
668 				u16 dup_vlan = MLX4_VLAN_MASK & be32_to_cpu(dup_table->entries[i]);
669 
670 				if (dup_vlan != vlan || !dup_table->is_dup[i]) {
671 					mlx4_warn(dev, "register vlan: expected duplicate vlan %u on port %d index %d\n",
672 						  vlan, dup_port, i);
673 				}
674 			}
675 			goto out;
676 		}
677 	}
678 
679 	if (need_mf_bond && (free_for_dup < 0)) {
680 		if (dup) {
681 			mlx4_warn(dev, "Fail to allocate duplicate VLAN table entry\n");
682 			mlx4_warn(dev, "High Availability for virtual functions may not work as expected\n");
683 			dup = false;
684 		}
685 		can_mf_bond = false;
686 	}
687 
688 	if (need_mf_bond && can_mf_bond)
689 		free = free_for_dup;
690 
691 	if (free < 0) {
692 		err = -ENOMEM;
693 		goto out;
694 	}
695 
696 	/* Register new VLAN */
697 	table->refs[free] = 1;
698 	table->is_dup[free] = false;
699 	table->entries[free] = cpu_to_be32(vlan | MLX4_VLAN_VALID);
700 
701 	err = mlx4_set_port_vlan_table(dev, port, table->entries);
702 	if (unlikely(err)) {
703 		mlx4_warn(dev, "Failed adding vlan: %u\n", vlan);
704 		table->refs[free] = 0;
705 		table->entries[free] = 0;
706 		goto out;
707 	}
708 	++table->total;
709 	if (dup) {
710 		dup_table->refs[free] = 0;
711 		dup_table->is_dup[free] = true;
712 		dup_table->entries[free] = cpu_to_be32(vlan | MLX4_VLAN_VALID);
713 
714 		err = mlx4_set_port_vlan_table(dev, dup_port, dup_table->entries);
715 		if (unlikely(err)) {
716 			mlx4_warn(dev, "Failed adding duplicate vlan: %u\n", vlan);
717 			dup_table->is_dup[free] = false;
718 			dup_table->entries[free] = 0;
719 			goto out;
720 		}
721 		++dup_table->total;
722 	}
723 
724 	*index = free;
725 out:
726 	if (need_mf_bond) {
727 		if (port == 2) {
728 			mutex_unlock(&table->mutex);
729 			mutex_unlock(&dup_table->mutex);
730 		} else {
731 			mutex_unlock(&dup_table->mutex);
732 			mutex_unlock(&table->mutex);
733 		}
734 	} else {
735 		mutex_unlock(&table->mutex);
736 	}
737 	return err;
738 }
739 
740 int mlx4_register_vlan(struct mlx4_dev *dev, u8 port, u16 vlan, int *index)
741 {
742 	u64 out_param = 0;
743 	int err;
744 
745 	if (vlan > 4095)
746 		return -EINVAL;
747 
748 	if (mlx4_is_mfunc(dev)) {
749 		err = mlx4_cmd_imm(dev, vlan, &out_param,
750 				   ((u32) port) << 8 | (u32) RES_VLAN,
751 				   RES_OP_RESERVE_AND_MAP, MLX4_CMD_ALLOC_RES,
752 				   MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED);
753 		if (!err)
754 			*index = get_param_l(&out_param);
755 
756 		return err;
757 	}
758 	return __mlx4_register_vlan(dev, port, vlan, index);
759 }
760 EXPORT_SYMBOL_GPL(mlx4_register_vlan);
761 
762 void __mlx4_unregister_vlan(struct mlx4_dev *dev, u8 port, u16 vlan)
763 {
764 	struct mlx4_vlan_table *table = &mlx4_priv(dev)->port[port].vlan_table;
765 	int index;
766 	bool dup = mlx4_is_mf_bonded(dev);
767 	u8 dup_port = (port == 1) ? 2 : 1;
768 	struct mlx4_vlan_table *dup_table = &mlx4_priv(dev)->port[dup_port].vlan_table;
769 
770 	if (dup) {
771 		if (port == 1) {
772 			mutex_lock(&table->mutex);
773 			mutex_lock_nested(&dup_table->mutex, SINGLE_DEPTH_NESTING);
774 		} else {
775 			mutex_lock(&dup_table->mutex);
776 			mutex_lock_nested(&table->mutex, SINGLE_DEPTH_NESTING);
777 		}
778 	} else {
779 		mutex_lock(&table->mutex);
780 	}
781 
782 	if (mlx4_find_cached_vlan(dev, port, vlan, &index)) {
783 		mlx4_warn(dev, "vlan 0x%x is not in the vlan table\n", vlan);
784 		goto out;
785 	}
786 
787 	if (index < MLX4_VLAN_REGULAR) {
788 		mlx4_warn(dev, "Trying to free special vlan index %d\n", index);
789 		goto out;
790 	}
791 
792 	if (--table->refs[index] || table->is_dup[index]) {
793 		mlx4_dbg(dev, "Have %d more references for index %d, no need to modify vlan table\n",
794 			 table->refs[index], index);
795 		if (!table->refs[index])
796 			dup_table->is_dup[index] = false;
797 		goto out;
798 	}
799 	table->entries[index] = 0;
800 	if (mlx4_set_port_vlan_table(dev, port, table->entries))
801 		mlx4_warn(dev, "Fail to set vlan in port %d during unregister\n", port);
802 	--table->total;
803 	if (dup) {
804 		dup_table->is_dup[index] = false;
805 		if (dup_table->refs[index])
806 			goto out;
807 		dup_table->entries[index] = 0;
808 		if (mlx4_set_port_vlan_table(dev, dup_port, dup_table->entries))
809 			mlx4_warn(dev, "Fail to set vlan in duplicate port %d during unregister\n", dup_port);
810 		--dup_table->total;
811 	}
812 out:
813 	if (dup) {
814 		if (port == 2) {
815 			mutex_unlock(&table->mutex);
816 			mutex_unlock(&dup_table->mutex);
817 		} else {
818 			mutex_unlock(&dup_table->mutex);
819 			mutex_unlock(&table->mutex);
820 		}
821 	} else {
822 		mutex_unlock(&table->mutex);
823 	}
824 }
825 
826 void mlx4_unregister_vlan(struct mlx4_dev *dev, u8 port, u16 vlan)
827 {
828 	u64 out_param = 0;
829 
830 	if (mlx4_is_mfunc(dev)) {
831 		(void) mlx4_cmd_imm(dev, vlan, &out_param,
832 				    ((u32) port) << 8 | (u32) RES_VLAN,
833 				    RES_OP_RESERVE_AND_MAP,
834 				    MLX4_CMD_FREE_RES, MLX4_CMD_TIME_CLASS_A,
835 				    MLX4_CMD_WRAPPED);
836 		return;
837 	}
838 	__mlx4_unregister_vlan(dev, port, vlan);
839 }
840 EXPORT_SYMBOL_GPL(mlx4_unregister_vlan);
841 
842 int mlx4_bond_mac_table(struct mlx4_dev *dev)
843 {
844 	struct mlx4_mac_table *t1 = &mlx4_priv(dev)->port[1].mac_table;
845 	struct mlx4_mac_table *t2 = &mlx4_priv(dev)->port[2].mac_table;
846 	int ret = 0;
847 	int i;
848 	bool update1 = false;
849 	bool update2 = false;
850 
851 	mutex_lock(&t1->mutex);
852 	mutex_lock(&t2->mutex);
853 	for (i = 0; i < MLX4_MAX_MAC_NUM; i++) {
854 		if ((t1->entries[i] != t2->entries[i]) &&
855 		    t1->entries[i] && t2->entries[i]) {
856 			mlx4_warn(dev, "can't duplicate entry %d in mac table\n", i);
857 			ret = -EINVAL;
858 			goto unlock;
859 		}
860 	}
861 
862 	for (i = 0; i < MLX4_MAX_MAC_NUM; i++) {
863 		if (t1->entries[i] && !t2->entries[i]) {
864 			t2->entries[i] = t1->entries[i];
865 			t2->is_dup[i] = true;
866 			update2 = true;
867 		} else if (!t1->entries[i] && t2->entries[i]) {
868 			t1->entries[i] = t2->entries[i];
869 			t1->is_dup[i] = true;
870 			update1 = true;
871 		} else if (t1->entries[i] && t2->entries[i]) {
872 			t1->is_dup[i] = true;
873 			t2->is_dup[i] = true;
874 		}
875 	}
876 
877 	if (update1) {
878 		ret = mlx4_set_port_mac_table(dev, 1, t1->entries);
879 		if (ret)
880 			mlx4_warn(dev, "failed to set MAC table for port 1 (%d)\n", ret);
881 	}
882 	if (!ret && update2) {
883 		ret = mlx4_set_port_mac_table(dev, 2, t2->entries);
884 		if (ret)
885 			mlx4_warn(dev, "failed to set MAC table for port 2 (%d)\n", ret);
886 	}
887 
888 	if (ret)
889 		mlx4_warn(dev, "failed to create mirror MAC tables\n");
890 unlock:
891 	mutex_unlock(&t2->mutex);
892 	mutex_unlock(&t1->mutex);
893 	return ret;
894 }
895 
896 int mlx4_unbond_mac_table(struct mlx4_dev *dev)
897 {
898 	struct mlx4_mac_table *t1 = &mlx4_priv(dev)->port[1].mac_table;
899 	struct mlx4_mac_table *t2 = &mlx4_priv(dev)->port[2].mac_table;
900 	int ret = 0;
901 	int ret1;
902 	int i;
903 	bool update1 = false;
904 	bool update2 = false;
905 
906 	mutex_lock(&t1->mutex);
907 	mutex_lock(&t2->mutex);
908 	for (i = 0; i < MLX4_MAX_MAC_NUM; i++) {
909 		if (t1->entries[i] != t2->entries[i]) {
910 			mlx4_warn(dev, "mac table is in an unexpected state when trying to unbond\n");
911 			ret = -EINVAL;
912 			goto unlock;
913 		}
914 	}
915 
916 	for (i = 0; i < MLX4_MAX_MAC_NUM; i++) {
917 		if (!t1->entries[i])
918 			continue;
919 		t1->is_dup[i] = false;
920 		if (!t1->refs[i]) {
921 			t1->entries[i] = 0;
922 			update1 = true;
923 		}
924 		t2->is_dup[i] = false;
925 		if (!t2->refs[i]) {
926 			t2->entries[i] = 0;
927 			update2 = true;
928 		}
929 	}
930 
931 	if (update1) {
932 		ret = mlx4_set_port_mac_table(dev, 1, t1->entries);
933 		if (ret)
934 			mlx4_warn(dev, "failed to unmirror MAC tables for port 1(%d)\n", ret);
935 	}
936 	if (update2) {
937 		ret1 = mlx4_set_port_mac_table(dev, 2, t2->entries);
938 		if (ret1) {
939 			mlx4_warn(dev, "failed to unmirror MAC tables for port 2(%d)\n", ret1);
940 			ret = ret1;
941 		}
942 	}
943 unlock:
944 	mutex_unlock(&t2->mutex);
945 	mutex_unlock(&t1->mutex);
946 	return ret;
947 }
948 
949 int mlx4_bond_vlan_table(struct mlx4_dev *dev)
950 {
951 	struct mlx4_vlan_table *t1 = &mlx4_priv(dev)->port[1].vlan_table;
952 	struct mlx4_vlan_table *t2 = &mlx4_priv(dev)->port[2].vlan_table;
953 	int ret = 0;
954 	int i;
955 	bool update1 = false;
956 	bool update2 = false;
957 
958 	mutex_lock(&t1->mutex);
959 	mutex_lock(&t2->mutex);
960 	for (i = 0; i < MLX4_MAX_VLAN_NUM; i++) {
961 		if ((t1->entries[i] != t2->entries[i]) &&
962 		    t1->entries[i] && t2->entries[i]) {
963 			mlx4_warn(dev, "can't duplicate entry %d in vlan table\n", i);
964 			ret = -EINVAL;
965 			goto unlock;
966 		}
967 	}
968 
969 	for (i = 0; i < MLX4_MAX_VLAN_NUM; i++) {
970 		if (t1->entries[i] && !t2->entries[i]) {
971 			t2->entries[i] = t1->entries[i];
972 			t2->is_dup[i] = true;
973 			update2 = true;
974 		} else if (!t1->entries[i] && t2->entries[i]) {
975 			t1->entries[i] = t2->entries[i];
976 			t1->is_dup[i] = true;
977 			update1 = true;
978 		} else if (t1->entries[i] && t2->entries[i]) {
979 			t1->is_dup[i] = true;
980 			t2->is_dup[i] = true;
981 		}
982 	}
983 
984 	if (update1) {
985 		ret = mlx4_set_port_vlan_table(dev, 1, t1->entries);
986 		if (ret)
987 			mlx4_warn(dev, "failed to set VLAN table for port 1 (%d)\n", ret);
988 	}
989 	if (!ret && update2) {
990 		ret = mlx4_set_port_vlan_table(dev, 2, t2->entries);
991 		if (ret)
992 			mlx4_warn(dev, "failed to set VLAN table for port 2 (%d)\n", ret);
993 	}
994 
995 	if (ret)
996 		mlx4_warn(dev, "failed to create mirror VLAN tables\n");
997 unlock:
998 	mutex_unlock(&t2->mutex);
999 	mutex_unlock(&t1->mutex);
1000 	return ret;
1001 }
1002 
1003 int mlx4_unbond_vlan_table(struct mlx4_dev *dev)
1004 {
1005 	struct mlx4_vlan_table *t1 = &mlx4_priv(dev)->port[1].vlan_table;
1006 	struct mlx4_vlan_table *t2 = &mlx4_priv(dev)->port[2].vlan_table;
1007 	int ret = 0;
1008 	int ret1;
1009 	int i;
1010 	bool update1 = false;
1011 	bool update2 = false;
1012 
1013 	mutex_lock(&t1->mutex);
1014 	mutex_lock(&t2->mutex);
1015 	for (i = 0; i < MLX4_MAX_VLAN_NUM; i++) {
1016 		if (t1->entries[i] != t2->entries[i]) {
1017 			mlx4_warn(dev, "vlan table is in an unexpected state when trying to unbond\n");
1018 			ret = -EINVAL;
1019 			goto unlock;
1020 		}
1021 	}
1022 
1023 	for (i = 0; i < MLX4_MAX_VLAN_NUM; i++) {
1024 		if (!t1->entries[i])
1025 			continue;
1026 		t1->is_dup[i] = false;
1027 		if (!t1->refs[i]) {
1028 			t1->entries[i] = 0;
1029 			update1 = true;
1030 		}
1031 		t2->is_dup[i] = false;
1032 		if (!t2->refs[i]) {
1033 			t2->entries[i] = 0;
1034 			update2 = true;
1035 		}
1036 	}
1037 
1038 	if (update1) {
1039 		ret = mlx4_set_port_vlan_table(dev, 1, t1->entries);
1040 		if (ret)
1041 			mlx4_warn(dev, "failed to unmirror VLAN tables for port 1(%d)\n", ret);
1042 	}
1043 	if (update2) {
1044 		ret1 = mlx4_set_port_vlan_table(dev, 2, t2->entries);
1045 		if (ret1) {
1046 			mlx4_warn(dev, "failed to unmirror VLAN tables for port 2(%d)\n", ret1);
1047 			ret = ret1;
1048 		}
1049 	}
1050 unlock:
1051 	mutex_unlock(&t2->mutex);
1052 	mutex_unlock(&t1->mutex);
1053 	return ret;
1054 }
1055 
1056 int mlx4_get_port_ib_caps(struct mlx4_dev *dev, u8 port, __be32 *caps)
1057 {
1058 	struct mlx4_cmd_mailbox *inmailbox, *outmailbox;
1059 	u8 *inbuf, *outbuf;
1060 	int err;
1061 
1062 	inmailbox = mlx4_alloc_cmd_mailbox(dev);
1063 	if (IS_ERR(inmailbox))
1064 		return PTR_ERR(inmailbox);
1065 
1066 	outmailbox = mlx4_alloc_cmd_mailbox(dev);
1067 	if (IS_ERR(outmailbox)) {
1068 		mlx4_free_cmd_mailbox(dev, inmailbox);
1069 		return PTR_ERR(outmailbox);
1070 	}
1071 
1072 	inbuf = inmailbox->buf;
1073 	outbuf = outmailbox->buf;
1074 	inbuf[0] = 1;
1075 	inbuf[1] = 1;
1076 	inbuf[2] = 1;
1077 	inbuf[3] = 1;
1078 	*(__be16 *) (&inbuf[16]) = cpu_to_be16(0x0015);
1079 	*(__be32 *) (&inbuf[20]) = cpu_to_be32(port);
1080 
1081 	err = mlx4_cmd_box(dev, inmailbox->dma, outmailbox->dma, port, 3,
1082 			   MLX4_CMD_MAD_IFC, MLX4_CMD_TIME_CLASS_C,
1083 			   MLX4_CMD_NATIVE);
1084 	if (!err)
1085 		*caps = *(__be32 *) (outbuf + 84);
1086 	mlx4_free_cmd_mailbox(dev, inmailbox);
1087 	mlx4_free_cmd_mailbox(dev, outmailbox);
1088 	return err;
1089 }
1090 static struct mlx4_roce_gid_entry zgid_entry;
1091 
1092 int mlx4_get_slave_num_gids(struct mlx4_dev *dev, int slave, int port)
1093 {
1094 	int vfs;
1095 	int slave_gid = slave;
1096 	unsigned i;
1097 	struct mlx4_slaves_pport slaves_pport;
1098 	struct mlx4_active_ports actv_ports;
1099 	unsigned max_port_p_one;
1100 
1101 	if (slave == 0)
1102 		return MLX4_ROCE_PF_GIDS;
1103 
1104 	/* Slave is a VF */
1105 	slaves_pport = mlx4_phys_to_slaves_pport(dev, port);
1106 	actv_ports = mlx4_get_active_ports(dev, slave);
1107 	max_port_p_one = find_first_bit(actv_ports.ports, dev->caps.num_ports) +
1108 		bitmap_weight(actv_ports.ports, dev->caps.num_ports) + 1;
1109 
1110 	for (i = 1; i < max_port_p_one; i++) {
1111 		struct mlx4_active_ports exclusive_ports;
1112 		struct mlx4_slaves_pport slaves_pport_actv;
1113 		bitmap_zero(exclusive_ports.ports, dev->caps.num_ports);
1114 		set_bit(i - 1, exclusive_ports.ports);
1115 		if (i == port)
1116 			continue;
1117 		slaves_pport_actv = mlx4_phys_to_slaves_pport_actv(
1118 				    dev, &exclusive_ports);
1119 		slave_gid -= bitmap_weight(slaves_pport_actv.slaves,
1120 					   dev->persist->num_vfs + 1);
1121 	}
1122 	vfs = bitmap_weight(slaves_pport.slaves, dev->persist->num_vfs + 1) - 1;
1123 	if (slave_gid <= ((MLX4_ROCE_MAX_GIDS - MLX4_ROCE_PF_GIDS) % vfs))
1124 		return ((MLX4_ROCE_MAX_GIDS - MLX4_ROCE_PF_GIDS) / vfs) + 1;
1125 	return (MLX4_ROCE_MAX_GIDS - MLX4_ROCE_PF_GIDS) / vfs;
1126 }
1127 
1128 int mlx4_get_base_gid_ix(struct mlx4_dev *dev, int slave, int port)
1129 {
1130 	int gids;
1131 	unsigned i;
1132 	int slave_gid = slave;
1133 	int vfs;
1134 
1135 	struct mlx4_slaves_pport slaves_pport;
1136 	struct mlx4_active_ports actv_ports;
1137 	unsigned max_port_p_one;
1138 
1139 	if (slave == 0)
1140 		return 0;
1141 
1142 	slaves_pport = mlx4_phys_to_slaves_pport(dev, port);
1143 	actv_ports = mlx4_get_active_ports(dev, slave);
1144 	max_port_p_one = find_first_bit(actv_ports.ports, dev->caps.num_ports) +
1145 		bitmap_weight(actv_ports.ports, dev->caps.num_ports) + 1;
1146 
1147 	for (i = 1; i < max_port_p_one; i++) {
1148 		struct mlx4_active_ports exclusive_ports;
1149 		struct mlx4_slaves_pport slaves_pport_actv;
1150 		bitmap_zero(exclusive_ports.ports, dev->caps.num_ports);
1151 		set_bit(i - 1, exclusive_ports.ports);
1152 		if (i == port)
1153 			continue;
1154 		slaves_pport_actv = mlx4_phys_to_slaves_pport_actv(
1155 				    dev, &exclusive_ports);
1156 		slave_gid -= bitmap_weight(slaves_pport_actv.slaves,
1157 					   dev->persist->num_vfs + 1);
1158 	}
1159 	gids = MLX4_ROCE_MAX_GIDS - MLX4_ROCE_PF_GIDS;
1160 	vfs = bitmap_weight(slaves_pport.slaves, dev->persist->num_vfs + 1) - 1;
1161 	if (slave_gid <= gids % vfs)
1162 		return MLX4_ROCE_PF_GIDS + ((gids / vfs) + 1) * (slave_gid - 1);
1163 
1164 	return MLX4_ROCE_PF_GIDS + (gids % vfs) +
1165 		((gids / vfs) * (slave_gid - 1));
1166 }
1167 EXPORT_SYMBOL_GPL(mlx4_get_base_gid_ix);
1168 
1169 static int mlx4_reset_roce_port_gids(struct mlx4_dev *dev, int slave,
1170 				     int port, struct mlx4_cmd_mailbox *mailbox)
1171 {
1172 	struct mlx4_roce_gid_entry *gid_entry_mbox;
1173 	struct mlx4_priv *priv = mlx4_priv(dev);
1174 	int num_gids, base, offset;
1175 	int i, err;
1176 
1177 	num_gids = mlx4_get_slave_num_gids(dev, slave, port);
1178 	base = mlx4_get_base_gid_ix(dev, slave, port);
1179 
1180 	memset(mailbox->buf, 0, MLX4_MAILBOX_SIZE);
1181 
1182 	mutex_lock(&(priv->port[port].gid_table.mutex));
1183 	/* Zero-out gids belonging to that slave in the port GID table */
1184 	for (i = 0, offset = base; i < num_gids; offset++, i++)
1185 		memcpy(priv->port[port].gid_table.roce_gids[offset].raw,
1186 		       zgid_entry.raw, MLX4_ROCE_GID_ENTRY_SIZE);
1187 
1188 	/* Now, copy roce port gids table to mailbox for passing to FW */
1189 	gid_entry_mbox = (struct mlx4_roce_gid_entry *)mailbox->buf;
1190 	for (i = 0; i < MLX4_ROCE_MAX_GIDS; gid_entry_mbox++, i++)
1191 		memcpy(gid_entry_mbox->raw,
1192 		       priv->port[port].gid_table.roce_gids[i].raw,
1193 		       MLX4_ROCE_GID_ENTRY_SIZE);
1194 
1195 	err = mlx4_cmd(dev, mailbox->dma,
1196 		       ((u32)port) | (MLX4_SET_PORT_GID_TABLE << 8),
1197 		       MLX4_SET_PORT_ETH_OPCODE, MLX4_CMD_SET_PORT,
1198 		       MLX4_CMD_TIME_CLASS_B, MLX4_CMD_NATIVE);
1199 	mutex_unlock(&(priv->port[port].gid_table.mutex));
1200 	return err;
1201 }
1202 
1203 
1204 void mlx4_reset_roce_gids(struct mlx4_dev *dev, int slave)
1205 {
1206 	struct mlx4_active_ports actv_ports;
1207 	struct mlx4_cmd_mailbox *mailbox;
1208 	int num_eth_ports, err;
1209 	int i;
1210 
1211 	if (slave < 0 || slave > dev->persist->num_vfs)
1212 		return;
1213 
1214 	actv_ports = mlx4_get_active_ports(dev, slave);
1215 
1216 	for (i = 0, num_eth_ports = 0; i < dev->caps.num_ports; i++) {
1217 		if (test_bit(i, actv_ports.ports)) {
1218 			if (dev->caps.port_type[i + 1] != MLX4_PORT_TYPE_ETH)
1219 				continue;
1220 			num_eth_ports++;
1221 		}
1222 	}
1223 
1224 	if (!num_eth_ports)
1225 		return;
1226 
1227 	/* have ETH ports.  Alloc mailbox for SET_PORT command */
1228 	mailbox = mlx4_alloc_cmd_mailbox(dev);
1229 	if (IS_ERR(mailbox))
1230 		return;
1231 
1232 	for (i = 0; i < dev->caps.num_ports; i++) {
1233 		if (test_bit(i, actv_ports.ports)) {
1234 			if (dev->caps.port_type[i + 1] != MLX4_PORT_TYPE_ETH)
1235 				continue;
1236 			err = mlx4_reset_roce_port_gids(dev, slave, i + 1, mailbox);
1237 			if (err)
1238 				mlx4_warn(dev, "Could not reset ETH port GID table for slave %d, port %d (%d)\n",
1239 					  slave, i + 1, err);
1240 		}
1241 	}
1242 
1243 	mlx4_free_cmd_mailbox(dev, mailbox);
1244 	return;
1245 }
1246 
1247 static void
1248 mlx4_en_set_port_mtu(struct mlx4_dev *dev, int slave, int port,
1249 		     struct mlx4_set_port_general_context *gen_context)
1250 {
1251 	struct mlx4_priv *priv = mlx4_priv(dev);
1252 	struct mlx4_mfunc_master_ctx *master = &priv->mfunc.master;
1253 	struct mlx4_slave_state *slave_st = &master->slave_state[slave];
1254 	u16 mtu, prev_mtu;
1255 
1256 	/* Mtu is configured as the max USER_MTU among all
1257 	 * the functions on the port.
1258 	 */
1259 	mtu = be16_to_cpu(gen_context->mtu);
1260 	mtu = min_t(int, mtu, dev->caps.eth_mtu_cap[port] +
1261 		    ETH_HLEN + VLAN_HLEN + ETH_FCS_LEN);
1262 	prev_mtu = slave_st->mtu[port];
1263 	slave_st->mtu[port] = mtu;
1264 	if (mtu > master->max_mtu[port])
1265 		master->max_mtu[port] = mtu;
1266 	if (mtu < prev_mtu && prev_mtu == master->max_mtu[port]) {
1267 		int i;
1268 
1269 		slave_st->mtu[port] = mtu;
1270 		master->max_mtu[port] = mtu;
1271 		for (i = 0; i < dev->num_slaves; i++)
1272 			master->max_mtu[port] =
1273 				max_t(u16, master->max_mtu[port],
1274 				      master->slave_state[i].mtu[port]);
1275 	}
1276 	gen_context->mtu = cpu_to_be16(master->max_mtu[port]);
1277 }
1278 
1279 static void
1280 mlx4_en_set_port_user_mtu(struct mlx4_dev *dev, int slave, int port,
1281 			  struct mlx4_set_port_general_context *gen_context)
1282 {
1283 	struct mlx4_priv *priv = mlx4_priv(dev);
1284 	struct mlx4_mfunc_master_ctx *master = &priv->mfunc.master;
1285 	struct mlx4_slave_state *slave_st = &master->slave_state[slave];
1286 	u16 user_mtu, prev_user_mtu;
1287 
1288 	/* User Mtu is configured as the max USER_MTU among all
1289 	 * the functions on the port.
1290 	 */
1291 	user_mtu = be16_to_cpu(gen_context->user_mtu);
1292 	user_mtu = min_t(int, user_mtu, dev->caps.eth_mtu_cap[port]);
1293 	prev_user_mtu = slave_st->user_mtu[port];
1294 	slave_st->user_mtu[port] = user_mtu;
1295 	if (user_mtu > master->max_user_mtu[port])
1296 		master->max_user_mtu[port] = user_mtu;
1297 	if (user_mtu < prev_user_mtu &&
1298 	    prev_user_mtu == master->max_user_mtu[port]) {
1299 		int i;
1300 
1301 		slave_st->user_mtu[port] = user_mtu;
1302 		master->max_user_mtu[port] = user_mtu;
1303 		for (i = 0; i < dev->num_slaves; i++)
1304 			master->max_user_mtu[port] =
1305 				max_t(u16, master->max_user_mtu[port],
1306 				      master->slave_state[i].user_mtu[port]);
1307 	}
1308 	gen_context->user_mtu = cpu_to_be16(master->max_user_mtu[port]);
1309 }
1310 
1311 static void
1312 mlx4_en_set_port_global_pause(struct mlx4_dev *dev, int slave,
1313 			      struct mlx4_set_port_general_context *gen_context)
1314 {
1315 	struct mlx4_priv *priv = mlx4_priv(dev);
1316 	struct mlx4_mfunc_master_ctx *master = &priv->mfunc.master;
1317 
1318 	/* Slave cannot change Global Pause configuration */
1319 	if (slave != mlx4_master_func_num(dev) &&
1320 	    (gen_context->pptx != master->pptx ||
1321 	     gen_context->pprx != master->pprx)) {
1322 		gen_context->pptx = master->pptx;
1323 		gen_context->pprx = master->pprx;
1324 		mlx4_warn(dev, "denying Global Pause change for slave:%d\n",
1325 			  slave);
1326 	} else {
1327 		master->pptx = gen_context->pptx;
1328 		master->pprx = gen_context->pprx;
1329 	}
1330 }
1331 
1332 static int mlx4_common_set_port(struct mlx4_dev *dev, int slave, u32 in_mod,
1333 				u8 op_mod, struct mlx4_cmd_mailbox *inbox)
1334 {
1335 	struct mlx4_priv *priv = mlx4_priv(dev);
1336 	struct mlx4_port_info *port_info;
1337 	struct mlx4_set_port_rqp_calc_context *qpn_context;
1338 	struct mlx4_set_port_general_context *gen_context;
1339 	struct mlx4_roce_gid_entry *gid_entry_tbl, *gid_entry_mbox, *gid_entry_mb1;
1340 	int reset_qkey_viols;
1341 	int port;
1342 	int is_eth;
1343 	int num_gids;
1344 	int base;
1345 	u32 in_modifier;
1346 	u32 promisc;
1347 	int err;
1348 	int i, j;
1349 	int offset;
1350 	__be32 agg_cap_mask;
1351 	__be32 slave_cap_mask;
1352 	__be32 new_cap_mask;
1353 
1354 	port = in_mod & 0xff;
1355 	in_modifier = in_mod >> 8;
1356 	is_eth = op_mod;
1357 	port_info = &priv->port[port];
1358 
1359 	/* Slaves cannot perform SET_PORT operations,
1360 	 * except for changing MTU and USER_MTU.
1361 	 */
1362 	if (is_eth) {
1363 		if (slave != dev->caps.function &&
1364 		    in_modifier != MLX4_SET_PORT_GENERAL &&
1365 		    in_modifier != MLX4_SET_PORT_GID_TABLE) {
1366 			mlx4_warn(dev, "denying SET_PORT for slave:%d\n",
1367 					slave);
1368 			return -EINVAL;
1369 		}
1370 		switch (in_modifier) {
1371 		case MLX4_SET_PORT_RQP_CALC:
1372 			qpn_context = inbox->buf;
1373 			qpn_context->base_qpn =
1374 				cpu_to_be32(port_info->base_qpn);
1375 			qpn_context->n_mac = 0x7;
1376 			promisc = be32_to_cpu(qpn_context->promisc) >>
1377 				SET_PORT_PROMISC_SHIFT;
1378 			qpn_context->promisc = cpu_to_be32(
1379 				promisc << SET_PORT_PROMISC_SHIFT |
1380 				port_info->base_qpn);
1381 			promisc = be32_to_cpu(qpn_context->mcast) >>
1382 				SET_PORT_MC_PROMISC_SHIFT;
1383 			qpn_context->mcast = cpu_to_be32(
1384 				promisc << SET_PORT_MC_PROMISC_SHIFT |
1385 				port_info->base_qpn);
1386 			break;
1387 		case MLX4_SET_PORT_GENERAL:
1388 			gen_context = inbox->buf;
1389 
1390 			if (gen_context->flags & MLX4_FLAG_V_MTU_MASK)
1391 				mlx4_en_set_port_mtu(dev, slave, port,
1392 						     gen_context);
1393 
1394 			if (gen_context->flags2 & MLX4_FLAG2_V_USER_MTU_MASK)
1395 				mlx4_en_set_port_user_mtu(dev, slave, port,
1396 							  gen_context);
1397 
1398 			if (gen_context->flags &
1399 			    (MLX4_FLAG_V_PPRX_MASK | MLX4_FLAG_V_PPTX_MASK))
1400 				mlx4_en_set_port_global_pause(dev, slave,
1401 							      gen_context);
1402 
1403 			break;
1404 		case MLX4_SET_PORT_GID_TABLE:
1405 			/* change to MULTIPLE entries: number of guest's gids
1406 			 * need a FOR-loop here over number of gids the guest has.
1407 			 * 1. Check no duplicates in gids passed by slave
1408 			 */
1409 			num_gids = mlx4_get_slave_num_gids(dev, slave, port);
1410 			base = mlx4_get_base_gid_ix(dev, slave, port);
1411 			gid_entry_mbox = (struct mlx4_roce_gid_entry *)(inbox->buf);
1412 			for (i = 0; i < num_gids; gid_entry_mbox++, i++) {
1413 				if (!memcmp(gid_entry_mbox->raw, zgid_entry.raw,
1414 					    sizeof(zgid_entry)))
1415 					continue;
1416 				gid_entry_mb1 = gid_entry_mbox + 1;
1417 				for (j = i + 1; j < num_gids; gid_entry_mb1++, j++) {
1418 					if (!memcmp(gid_entry_mb1->raw,
1419 						    zgid_entry.raw, sizeof(zgid_entry)))
1420 						continue;
1421 					if (!memcmp(gid_entry_mb1->raw, gid_entry_mbox->raw,
1422 						    sizeof(gid_entry_mbox->raw))) {
1423 						/* found duplicate */
1424 						return -EINVAL;
1425 					}
1426 				}
1427 			}
1428 
1429 			/* 2. Check that do not have duplicates in OTHER
1430 			 *    entries in the port GID table
1431 			 */
1432 
1433 			mutex_lock(&(priv->port[port].gid_table.mutex));
1434 			for (i = 0; i < MLX4_ROCE_MAX_GIDS; i++) {
1435 				if (i >= base && i < base + num_gids)
1436 					continue; /* don't compare to slave's current gids */
1437 				gid_entry_tbl = &priv->port[port].gid_table.roce_gids[i];
1438 				if (!memcmp(gid_entry_tbl->raw, zgid_entry.raw, sizeof(zgid_entry)))
1439 					continue;
1440 				gid_entry_mbox = (struct mlx4_roce_gid_entry *)(inbox->buf);
1441 				for (j = 0; j < num_gids; gid_entry_mbox++, j++) {
1442 					if (!memcmp(gid_entry_mbox->raw, zgid_entry.raw,
1443 						    sizeof(zgid_entry)))
1444 						continue;
1445 					if (!memcmp(gid_entry_mbox->raw, gid_entry_tbl->raw,
1446 						    sizeof(gid_entry_tbl->raw))) {
1447 						/* found duplicate */
1448 						mlx4_warn(dev, "requested gid entry for slave:%d is a duplicate of gid at index %d\n",
1449 							  slave, i);
1450 						mutex_unlock(&(priv->port[port].gid_table.mutex));
1451 						return -EINVAL;
1452 					}
1453 				}
1454 			}
1455 
1456 			/* insert slave GIDs with memcpy, starting at slave's base index */
1457 			gid_entry_mbox = (struct mlx4_roce_gid_entry *)(inbox->buf);
1458 			for (i = 0, offset = base; i < num_gids; gid_entry_mbox++, offset++, i++)
1459 				memcpy(priv->port[port].gid_table.roce_gids[offset].raw,
1460 				       gid_entry_mbox->raw, MLX4_ROCE_GID_ENTRY_SIZE);
1461 
1462 			/* Now, copy roce port gids table to current mailbox for passing to FW */
1463 			gid_entry_mbox = (struct mlx4_roce_gid_entry *)(inbox->buf);
1464 			for (i = 0; i < MLX4_ROCE_MAX_GIDS; gid_entry_mbox++, i++)
1465 				memcpy(gid_entry_mbox->raw,
1466 				       priv->port[port].gid_table.roce_gids[i].raw,
1467 				       MLX4_ROCE_GID_ENTRY_SIZE);
1468 
1469 			err = mlx4_cmd(dev, inbox->dma, in_mod & 0xffff, op_mod,
1470 				       MLX4_CMD_SET_PORT, MLX4_CMD_TIME_CLASS_B,
1471 				       MLX4_CMD_NATIVE);
1472 			mutex_unlock(&(priv->port[port].gid_table.mutex));
1473 			return err;
1474 		}
1475 
1476 		return mlx4_cmd(dev, inbox->dma, in_mod & 0xffff, op_mod,
1477 				MLX4_CMD_SET_PORT, MLX4_CMD_TIME_CLASS_B,
1478 				MLX4_CMD_NATIVE);
1479 	}
1480 
1481 	/* Slaves are not allowed to SET_PORT beacon (LED) blink */
1482 	if (op_mod == MLX4_SET_PORT_BEACON_OPCODE) {
1483 		mlx4_warn(dev, "denying SET_PORT Beacon slave:%d\n", slave);
1484 		return -EPERM;
1485 	}
1486 
1487 	/* For IB, we only consider:
1488 	 * - The capability mask, which is set to the aggregate of all
1489 	 *   slave function capabilities
1490 	 * - The QKey violatin counter - reset according to each request.
1491 	 */
1492 
1493 	if (dev->flags & MLX4_FLAG_OLD_PORT_CMDS) {
1494 		reset_qkey_viols = (*(u8 *) inbox->buf) & 0x40;
1495 		new_cap_mask = ((__be32 *) inbox->buf)[2];
1496 	} else {
1497 		reset_qkey_viols = ((u8 *) inbox->buf)[3] & 0x1;
1498 		new_cap_mask = ((__be32 *) inbox->buf)[1];
1499 	}
1500 
1501 	/* slave may not set the IS_SM capability for the port */
1502 	if (slave != mlx4_master_func_num(dev) &&
1503 	    (be32_to_cpu(new_cap_mask) & MLX4_PORT_CAP_IS_SM))
1504 		return -EINVAL;
1505 
1506 	/* No DEV_MGMT in multifunc mode */
1507 	if (mlx4_is_mfunc(dev) &&
1508 	    (be32_to_cpu(new_cap_mask) & MLX4_PORT_CAP_DEV_MGMT_SUP))
1509 		return -EINVAL;
1510 
1511 	agg_cap_mask = 0;
1512 	slave_cap_mask =
1513 		priv->mfunc.master.slave_state[slave].ib_cap_mask[port];
1514 	priv->mfunc.master.slave_state[slave].ib_cap_mask[port] = new_cap_mask;
1515 	for (i = 0; i < dev->num_slaves; i++)
1516 		agg_cap_mask |=
1517 			priv->mfunc.master.slave_state[i].ib_cap_mask[port];
1518 
1519 	/* only clear mailbox for guests.  Master may be setting
1520 	* MTU or PKEY table size
1521 	*/
1522 	if (slave != dev->caps.function)
1523 		memset(inbox->buf, 0, 256);
1524 	if (dev->flags & MLX4_FLAG_OLD_PORT_CMDS) {
1525 		*(u8 *) inbox->buf	   |= !!reset_qkey_viols << 6;
1526 		((__be32 *) inbox->buf)[2] = agg_cap_mask;
1527 	} else {
1528 		((u8 *) inbox->buf)[3]     |= !!reset_qkey_viols;
1529 		((__be32 *) inbox->buf)[1] = agg_cap_mask;
1530 	}
1531 
1532 	err = mlx4_cmd(dev, inbox->dma, port, is_eth, MLX4_CMD_SET_PORT,
1533 		       MLX4_CMD_TIME_CLASS_B, MLX4_CMD_NATIVE);
1534 	if (err)
1535 		priv->mfunc.master.slave_state[slave].ib_cap_mask[port] =
1536 			slave_cap_mask;
1537 	return err;
1538 }
1539 
1540 int mlx4_SET_PORT_wrapper(struct mlx4_dev *dev, int slave,
1541 			  struct mlx4_vhcr *vhcr,
1542 			  struct mlx4_cmd_mailbox *inbox,
1543 			  struct mlx4_cmd_mailbox *outbox,
1544 			  struct mlx4_cmd_info *cmd)
1545 {
1546 	int port = mlx4_slave_convert_port(
1547 			dev, slave, vhcr->in_modifier & 0xFF);
1548 
1549 	if (port < 0)
1550 		return -EINVAL;
1551 
1552 	vhcr->in_modifier = (vhcr->in_modifier & ~0xFF) |
1553 			    (port & 0xFF);
1554 
1555 	return mlx4_common_set_port(dev, slave, vhcr->in_modifier,
1556 				    vhcr->op_modifier, inbox);
1557 }
1558 
1559 /* bit locations for set port command with zero op modifier */
1560 enum {
1561 	MLX4_SET_PORT_VL_CAP	 = 4, /* bits 7:4 */
1562 	MLX4_SET_PORT_MTU_CAP	 = 12, /* bits 15:12 */
1563 	MLX4_CHANGE_PORT_PKEY_TBL_SZ = 20,
1564 	MLX4_CHANGE_PORT_VL_CAP	 = 21,
1565 	MLX4_CHANGE_PORT_MTU_CAP = 22,
1566 };
1567 
1568 int mlx4_SET_PORT(struct mlx4_dev *dev, u8 port, int pkey_tbl_sz)
1569 {
1570 	struct mlx4_cmd_mailbox *mailbox;
1571 	int err, vl_cap, pkey_tbl_flag = 0;
1572 
1573 	if (dev->caps.port_type[port] == MLX4_PORT_TYPE_ETH)
1574 		return 0;
1575 
1576 	mailbox = mlx4_alloc_cmd_mailbox(dev);
1577 	if (IS_ERR(mailbox))
1578 		return PTR_ERR(mailbox);
1579 
1580 	((__be32 *) mailbox->buf)[1] = dev->caps.ib_port_def_cap[port];
1581 
1582 	if (pkey_tbl_sz >= 0 && mlx4_is_master(dev)) {
1583 		pkey_tbl_flag = 1;
1584 		((__be16 *) mailbox->buf)[20] = cpu_to_be16(pkey_tbl_sz);
1585 	}
1586 
1587 	/* IB VL CAP enum isn't used by the firmware, just numerical values */
1588 	for (vl_cap = 8; vl_cap >= 1; vl_cap >>= 1) {
1589 		((__be32 *) mailbox->buf)[0] = cpu_to_be32(
1590 			(1 << MLX4_CHANGE_PORT_MTU_CAP) |
1591 			(1 << MLX4_CHANGE_PORT_VL_CAP)  |
1592 			(pkey_tbl_flag << MLX4_CHANGE_PORT_PKEY_TBL_SZ) |
1593 			(dev->caps.port_ib_mtu[port] << MLX4_SET_PORT_MTU_CAP) |
1594 			(vl_cap << MLX4_SET_PORT_VL_CAP));
1595 		err = mlx4_cmd(dev, mailbox->dma, port,
1596 			       MLX4_SET_PORT_IB_OPCODE, MLX4_CMD_SET_PORT,
1597 			       MLX4_CMD_TIME_CLASS_B, MLX4_CMD_WRAPPED);
1598 		if (err != -ENOMEM)
1599 			break;
1600 	}
1601 
1602 	mlx4_free_cmd_mailbox(dev, mailbox);
1603 	return err;
1604 }
1605 
1606 #define SET_PORT_ROCE_2_FLAGS          0x10
1607 #define MLX4_SET_PORT_ROCE_V1_V2       0x2
1608 int mlx4_SET_PORT_general(struct mlx4_dev *dev, u8 port, int mtu,
1609 			  u8 pptx, u8 pfctx, u8 pprx, u8 pfcrx)
1610 {
1611 	struct mlx4_cmd_mailbox *mailbox;
1612 	struct mlx4_set_port_general_context *context;
1613 	int err;
1614 	u32 in_mod;
1615 
1616 	mailbox = mlx4_alloc_cmd_mailbox(dev);
1617 	if (IS_ERR(mailbox))
1618 		return PTR_ERR(mailbox);
1619 	context = mailbox->buf;
1620 	context->flags = SET_PORT_GEN_ALL_VALID;
1621 	context->mtu = cpu_to_be16(mtu);
1622 	context->pptx = (pptx * (!pfctx)) << 7;
1623 	context->pfctx = pfctx;
1624 	context->pprx = (pprx * (!pfcrx)) << 7;
1625 	context->pfcrx = pfcrx;
1626 
1627 	if (dev->caps.flags2 & MLX4_DEV_CAP_FLAG2_ROCE_V1_V2) {
1628 		context->flags |= SET_PORT_ROCE_2_FLAGS;
1629 		context->roce_mode |=
1630 			MLX4_SET_PORT_ROCE_V1_V2 << 4;
1631 	}
1632 	in_mod = MLX4_SET_PORT_GENERAL << 8 | port;
1633 	err = mlx4_cmd(dev, mailbox->dma, in_mod, MLX4_SET_PORT_ETH_OPCODE,
1634 		       MLX4_CMD_SET_PORT, MLX4_CMD_TIME_CLASS_B,
1635 		       MLX4_CMD_WRAPPED);
1636 
1637 	mlx4_free_cmd_mailbox(dev, mailbox);
1638 	return err;
1639 }
1640 EXPORT_SYMBOL(mlx4_SET_PORT_general);
1641 
1642 int mlx4_SET_PORT_qpn_calc(struct mlx4_dev *dev, u8 port, u32 base_qpn,
1643 			   u8 promisc)
1644 {
1645 	struct mlx4_cmd_mailbox *mailbox;
1646 	struct mlx4_set_port_rqp_calc_context *context;
1647 	int err;
1648 	u32 in_mod;
1649 	u32 m_promisc = (dev->caps.flags & MLX4_DEV_CAP_FLAG_VEP_MC_STEER) ?
1650 		MCAST_DIRECT : MCAST_DEFAULT;
1651 
1652 	if (dev->caps.steering_mode != MLX4_STEERING_MODE_A0)
1653 		return 0;
1654 
1655 	mailbox = mlx4_alloc_cmd_mailbox(dev);
1656 	if (IS_ERR(mailbox))
1657 		return PTR_ERR(mailbox);
1658 	context = mailbox->buf;
1659 	context->base_qpn = cpu_to_be32(base_qpn);
1660 	context->n_mac = dev->caps.log_num_macs;
1661 	context->promisc = cpu_to_be32(promisc << SET_PORT_PROMISC_SHIFT |
1662 				       base_qpn);
1663 	context->mcast = cpu_to_be32(m_promisc << SET_PORT_MC_PROMISC_SHIFT |
1664 				     base_qpn);
1665 	context->intra_no_vlan = 0;
1666 	context->no_vlan = MLX4_NO_VLAN_IDX;
1667 	context->intra_vlan_miss = 0;
1668 	context->vlan_miss = MLX4_VLAN_MISS_IDX;
1669 
1670 	in_mod = MLX4_SET_PORT_RQP_CALC << 8 | port;
1671 	err = mlx4_cmd(dev, mailbox->dma, in_mod, MLX4_SET_PORT_ETH_OPCODE,
1672 		       MLX4_CMD_SET_PORT, MLX4_CMD_TIME_CLASS_B,
1673 		       MLX4_CMD_WRAPPED);
1674 
1675 	mlx4_free_cmd_mailbox(dev, mailbox);
1676 	return err;
1677 }
1678 EXPORT_SYMBOL(mlx4_SET_PORT_qpn_calc);
1679 
1680 int mlx4_SET_PORT_user_mtu(struct mlx4_dev *dev, u8 port, u16 user_mtu)
1681 {
1682 	struct mlx4_cmd_mailbox *mailbox;
1683 	struct mlx4_set_port_general_context *context;
1684 	u32 in_mod;
1685 	int err;
1686 
1687 	mailbox = mlx4_alloc_cmd_mailbox(dev);
1688 	if (IS_ERR(mailbox))
1689 		return PTR_ERR(mailbox);
1690 	context = mailbox->buf;
1691 	context->flags2 |= MLX4_FLAG2_V_USER_MTU_MASK;
1692 	context->user_mtu = cpu_to_be16(user_mtu);
1693 
1694 	in_mod = MLX4_SET_PORT_GENERAL << 8 | port;
1695 	err = mlx4_cmd(dev, mailbox->dma, in_mod, MLX4_SET_PORT_ETH_OPCODE,
1696 		       MLX4_CMD_SET_PORT, MLX4_CMD_TIME_CLASS_B,
1697 		       MLX4_CMD_WRAPPED);
1698 
1699 	mlx4_free_cmd_mailbox(dev, mailbox);
1700 	return err;
1701 }
1702 EXPORT_SYMBOL(mlx4_SET_PORT_user_mtu);
1703 
1704 int mlx4_SET_PORT_user_mac(struct mlx4_dev *dev, u8 port, u8 *user_mac)
1705 {
1706 	struct mlx4_cmd_mailbox *mailbox;
1707 	struct mlx4_set_port_general_context *context;
1708 	u32 in_mod;
1709 	int err;
1710 
1711 	mailbox = mlx4_alloc_cmd_mailbox(dev);
1712 	if (IS_ERR(mailbox))
1713 		return PTR_ERR(mailbox);
1714 	context = mailbox->buf;
1715 	context->flags2 |= MLX4_FLAG2_V_USER_MAC_MASK;
1716 	memcpy(context->user_mac, user_mac, sizeof(context->user_mac));
1717 
1718 	in_mod = MLX4_SET_PORT_GENERAL << 8 | port;
1719 	err = mlx4_cmd(dev, mailbox->dma, in_mod, MLX4_SET_PORT_ETH_OPCODE,
1720 		       MLX4_CMD_SET_PORT, MLX4_CMD_TIME_CLASS_B,
1721 		       MLX4_CMD_NATIVE);
1722 
1723 	mlx4_free_cmd_mailbox(dev, mailbox);
1724 	return err;
1725 }
1726 EXPORT_SYMBOL(mlx4_SET_PORT_user_mac);
1727 
1728 int mlx4_SET_PORT_fcs_check(struct mlx4_dev *dev, u8 port, u8 ignore_fcs_value)
1729 {
1730 	struct mlx4_cmd_mailbox *mailbox;
1731 	struct mlx4_set_port_general_context *context;
1732 	u32 in_mod;
1733 	int err;
1734 
1735 	mailbox = mlx4_alloc_cmd_mailbox(dev);
1736 	if (IS_ERR(mailbox))
1737 		return PTR_ERR(mailbox);
1738 	context = mailbox->buf;
1739 	context->flags2 |= MLX4_FLAG2_V_IGNORE_FCS_MASK;
1740 	if (ignore_fcs_value)
1741 		context->ignore_fcs |= MLX4_IGNORE_FCS_MASK;
1742 	else
1743 		context->ignore_fcs &= ~MLX4_IGNORE_FCS_MASK;
1744 
1745 	in_mod = MLX4_SET_PORT_GENERAL << 8 | port;
1746 	err = mlx4_cmd(dev, mailbox->dma, in_mod, 1, MLX4_CMD_SET_PORT,
1747 		       MLX4_CMD_TIME_CLASS_B, MLX4_CMD_NATIVE);
1748 
1749 	mlx4_free_cmd_mailbox(dev, mailbox);
1750 	return err;
1751 }
1752 EXPORT_SYMBOL(mlx4_SET_PORT_fcs_check);
1753 
1754 enum {
1755 	VXLAN_ENABLE_MODIFY	= 1 << 7,
1756 	VXLAN_STEERING_MODIFY	= 1 << 6,
1757 
1758 	VXLAN_ENABLE		= 1 << 7,
1759 };
1760 
1761 struct mlx4_set_port_vxlan_context {
1762 	u32	reserved1;
1763 	u8	modify_flags;
1764 	u8	reserved2;
1765 	u8	enable_flags;
1766 	u8	steering;
1767 };
1768 
1769 int mlx4_SET_PORT_VXLAN(struct mlx4_dev *dev, u8 port, u8 steering, int enable)
1770 {
1771 	int err;
1772 	u32 in_mod;
1773 	struct mlx4_cmd_mailbox *mailbox;
1774 	struct mlx4_set_port_vxlan_context  *context;
1775 
1776 	mailbox = mlx4_alloc_cmd_mailbox(dev);
1777 	if (IS_ERR(mailbox))
1778 		return PTR_ERR(mailbox);
1779 	context = mailbox->buf;
1780 	memset(context, 0, sizeof(*context));
1781 
1782 	context->modify_flags = VXLAN_ENABLE_MODIFY | VXLAN_STEERING_MODIFY;
1783 	if (enable)
1784 		context->enable_flags = VXLAN_ENABLE;
1785 	context->steering  = steering;
1786 
1787 	in_mod = MLX4_SET_PORT_VXLAN << 8 | port;
1788 	err = mlx4_cmd(dev, mailbox->dma, in_mod, MLX4_SET_PORT_ETH_OPCODE,
1789 		       MLX4_CMD_SET_PORT, MLX4_CMD_TIME_CLASS_B,
1790 		       MLX4_CMD_NATIVE);
1791 
1792 	mlx4_free_cmd_mailbox(dev, mailbox);
1793 	return err;
1794 }
1795 EXPORT_SYMBOL(mlx4_SET_PORT_VXLAN);
1796 
1797 int mlx4_SET_PORT_BEACON(struct mlx4_dev *dev, u8 port, u16 time)
1798 {
1799 	int err;
1800 	struct mlx4_cmd_mailbox *mailbox;
1801 
1802 	mailbox = mlx4_alloc_cmd_mailbox(dev);
1803 	if (IS_ERR(mailbox))
1804 		return PTR_ERR(mailbox);
1805 
1806 	*((__be32 *)mailbox->buf) = cpu_to_be32(time);
1807 
1808 	err = mlx4_cmd(dev, mailbox->dma, port, MLX4_SET_PORT_BEACON_OPCODE,
1809 		       MLX4_CMD_SET_PORT, MLX4_CMD_TIME_CLASS_B,
1810 		       MLX4_CMD_NATIVE);
1811 
1812 	mlx4_free_cmd_mailbox(dev, mailbox);
1813 	return err;
1814 }
1815 EXPORT_SYMBOL(mlx4_SET_PORT_BEACON);
1816 
1817 int mlx4_SET_MCAST_FLTR_wrapper(struct mlx4_dev *dev, int slave,
1818 				struct mlx4_vhcr *vhcr,
1819 				struct mlx4_cmd_mailbox *inbox,
1820 				struct mlx4_cmd_mailbox *outbox,
1821 				struct mlx4_cmd_info *cmd)
1822 {
1823 	int err = 0;
1824 
1825 	return err;
1826 }
1827 
1828 int mlx4_SET_MCAST_FLTR(struct mlx4_dev *dev, u8 port,
1829 			u64 mac, u64 clear, u8 mode)
1830 {
1831 	return mlx4_cmd(dev, (mac | (clear << 63)), port, mode,
1832 			MLX4_CMD_SET_MCAST_FLTR, MLX4_CMD_TIME_CLASS_B,
1833 			MLX4_CMD_WRAPPED);
1834 }
1835 EXPORT_SYMBOL(mlx4_SET_MCAST_FLTR);
1836 
1837 int mlx4_SET_VLAN_FLTR_wrapper(struct mlx4_dev *dev, int slave,
1838 			       struct mlx4_vhcr *vhcr,
1839 			       struct mlx4_cmd_mailbox *inbox,
1840 			       struct mlx4_cmd_mailbox *outbox,
1841 			       struct mlx4_cmd_info *cmd)
1842 {
1843 	int err = 0;
1844 
1845 	return err;
1846 }
1847 
1848 int mlx4_DUMP_ETH_STATS_wrapper(struct mlx4_dev *dev, int slave,
1849 				struct mlx4_vhcr *vhcr,
1850 				struct mlx4_cmd_mailbox *inbox,
1851 				struct mlx4_cmd_mailbox *outbox,
1852 				struct mlx4_cmd_info *cmd)
1853 {
1854 	return 0;
1855 }
1856 
1857 int mlx4_get_slave_from_roce_gid(struct mlx4_dev *dev, int port, u8 *gid,
1858 				 int *slave_id)
1859 {
1860 	struct mlx4_priv *priv = mlx4_priv(dev);
1861 	int i, found_ix = -1;
1862 	int vf_gids = MLX4_ROCE_MAX_GIDS - MLX4_ROCE_PF_GIDS;
1863 	struct mlx4_slaves_pport slaves_pport;
1864 	unsigned num_vfs;
1865 	int slave_gid;
1866 
1867 	if (!mlx4_is_mfunc(dev))
1868 		return -EINVAL;
1869 
1870 	slaves_pport = mlx4_phys_to_slaves_pport(dev, port);
1871 	num_vfs = bitmap_weight(slaves_pport.slaves,
1872 				dev->persist->num_vfs + 1) - 1;
1873 
1874 	for (i = 0; i < MLX4_ROCE_MAX_GIDS; i++) {
1875 		if (!memcmp(priv->port[port].gid_table.roce_gids[i].raw, gid,
1876 			    MLX4_ROCE_GID_ENTRY_SIZE)) {
1877 			found_ix = i;
1878 			break;
1879 		}
1880 	}
1881 
1882 	if (found_ix >= 0) {
1883 		/* Calculate a slave_gid which is the slave number in the gid
1884 		 * table and not a globally unique slave number.
1885 		 */
1886 		if (found_ix < MLX4_ROCE_PF_GIDS)
1887 			slave_gid = 0;
1888 		else if (found_ix < MLX4_ROCE_PF_GIDS + (vf_gids % num_vfs) *
1889 			 (vf_gids / num_vfs + 1))
1890 			slave_gid = ((found_ix - MLX4_ROCE_PF_GIDS) /
1891 				     (vf_gids / num_vfs + 1)) + 1;
1892 		else
1893 			slave_gid =
1894 			((found_ix - MLX4_ROCE_PF_GIDS -
1895 			  ((vf_gids % num_vfs) * ((vf_gids / num_vfs + 1)))) /
1896 			 (vf_gids / num_vfs)) + vf_gids % num_vfs + 1;
1897 
1898 		/* Calculate the globally unique slave id */
1899 		if (slave_gid) {
1900 			struct mlx4_active_ports exclusive_ports;
1901 			struct mlx4_active_ports actv_ports;
1902 			struct mlx4_slaves_pport slaves_pport_actv;
1903 			unsigned max_port_p_one;
1904 			int num_vfs_before = 0;
1905 			int candidate_slave_gid;
1906 
1907 			/* Calculate how many VFs are on the previous port, if exists */
1908 			for (i = 1; i < port; i++) {
1909 				bitmap_zero(exclusive_ports.ports, dev->caps.num_ports);
1910 				set_bit(i - 1, exclusive_ports.ports);
1911 				slaves_pport_actv =
1912 					mlx4_phys_to_slaves_pport_actv(
1913 							dev, &exclusive_ports);
1914 				num_vfs_before += bitmap_weight(
1915 						slaves_pport_actv.slaves,
1916 						dev->persist->num_vfs + 1);
1917 			}
1918 
1919 			/* candidate_slave_gid isn't necessarily the correct slave, but
1920 			 * it has the same number of ports and is assigned to the same
1921 			 * ports as the real slave we're looking for. On dual port VF,
1922 			 * slave_gid = [single port VFs on port <port>] +
1923 			 * [offset of the current slave from the first dual port VF] +
1924 			 * 1 (for the PF).
1925 			 */
1926 			candidate_slave_gid = slave_gid + num_vfs_before;
1927 
1928 			actv_ports = mlx4_get_active_ports(dev, candidate_slave_gid);
1929 			max_port_p_one = find_first_bit(
1930 				actv_ports.ports, dev->caps.num_ports) +
1931 				bitmap_weight(actv_ports.ports,
1932 					      dev->caps.num_ports) + 1;
1933 
1934 			/* Calculate the real slave number */
1935 			for (i = 1; i < max_port_p_one; i++) {
1936 				if (i == port)
1937 					continue;
1938 				bitmap_zero(exclusive_ports.ports,
1939 					    dev->caps.num_ports);
1940 				set_bit(i - 1, exclusive_ports.ports);
1941 				slaves_pport_actv =
1942 					mlx4_phys_to_slaves_pport_actv(
1943 						dev, &exclusive_ports);
1944 				slave_gid += bitmap_weight(
1945 						slaves_pport_actv.slaves,
1946 						dev->persist->num_vfs + 1);
1947 			}
1948 		}
1949 		*slave_id = slave_gid;
1950 	}
1951 
1952 	return (found_ix >= 0) ? 0 : -EINVAL;
1953 }
1954 EXPORT_SYMBOL(mlx4_get_slave_from_roce_gid);
1955 
1956 int mlx4_get_roce_gid_from_slave(struct mlx4_dev *dev, int port, int slave_id,
1957 				 u8 *gid)
1958 {
1959 	struct mlx4_priv *priv = mlx4_priv(dev);
1960 
1961 	if (!mlx4_is_master(dev))
1962 		return -EINVAL;
1963 
1964 	memcpy(gid, priv->port[port].gid_table.roce_gids[slave_id].raw,
1965 	       MLX4_ROCE_GID_ENTRY_SIZE);
1966 	return 0;
1967 }
1968 EXPORT_SYMBOL(mlx4_get_roce_gid_from_slave);
1969 
1970 /* Cable Module Info */
1971 #define MODULE_INFO_MAX_READ 48
1972 
1973 #define I2C_ADDR_LOW  0x50
1974 #define I2C_ADDR_HIGH 0x51
1975 #define I2C_PAGE_SIZE 256
1976 #define I2C_HIGH_PAGE_SIZE 128
1977 
1978 /* Module Info Data */
1979 struct mlx4_cable_info {
1980 	u8	i2c_addr;
1981 	u8	page_num;
1982 	__be16	dev_mem_address;
1983 	__be16	reserved1;
1984 	__be16	size;
1985 	__be32	reserved2[2];
1986 	u8	data[MODULE_INFO_MAX_READ];
1987 };
1988 
1989 enum cable_info_err {
1990 	 CABLE_INF_INV_PORT      = 0x1,
1991 	 CABLE_INF_OP_NOSUP      = 0x2,
1992 	 CABLE_INF_NOT_CONN      = 0x3,
1993 	 CABLE_INF_NO_EEPRM      = 0x4,
1994 	 CABLE_INF_PAGE_ERR      = 0x5,
1995 	 CABLE_INF_INV_ADDR      = 0x6,
1996 	 CABLE_INF_I2C_ADDR      = 0x7,
1997 	 CABLE_INF_QSFP_VIO      = 0x8,
1998 	 CABLE_INF_I2C_BUSY      = 0x9,
1999 };
2000 
2001 #define MAD_STATUS_2_CABLE_ERR(mad_status) ((mad_status >> 8) & 0xFF)
2002 
2003 static inline const char *cable_info_mad_err_str(u16 mad_status)
2004 {
2005 	u8 err = MAD_STATUS_2_CABLE_ERR(mad_status);
2006 
2007 	switch (err) {
2008 	case CABLE_INF_INV_PORT:
2009 		return "invalid port selected";
2010 	case CABLE_INF_OP_NOSUP:
2011 		return "operation not supported for this port (the port is of type CX4 or internal)";
2012 	case CABLE_INF_NOT_CONN:
2013 		return "cable is not connected";
2014 	case CABLE_INF_NO_EEPRM:
2015 		return "the connected cable has no EPROM (passive copper cable)";
2016 	case CABLE_INF_PAGE_ERR:
2017 		return "page number is greater than 15";
2018 	case CABLE_INF_INV_ADDR:
2019 		return "invalid device_address or size (that is, size equals 0 or address+size is greater than 256)";
2020 	case CABLE_INF_I2C_ADDR:
2021 		return "invalid I2C slave address";
2022 	case CABLE_INF_QSFP_VIO:
2023 		return "at least one cable violates the QSFP specification and ignores the modsel signal";
2024 	case CABLE_INF_I2C_BUSY:
2025 		return "I2C bus is constantly busy";
2026 	}
2027 	return "Unknown Error";
2028 }
2029 
2030 static int mlx4_get_module_id(struct mlx4_dev *dev, u8 port, u8 *module_id)
2031 {
2032 	struct mlx4_cmd_mailbox *inbox, *outbox;
2033 	struct mlx4_mad_ifc *inmad, *outmad;
2034 	struct mlx4_cable_info *cable_info;
2035 	int ret;
2036 
2037 	inbox = mlx4_alloc_cmd_mailbox(dev);
2038 	if (IS_ERR(inbox))
2039 		return PTR_ERR(inbox);
2040 
2041 	outbox = mlx4_alloc_cmd_mailbox(dev);
2042 	if (IS_ERR(outbox)) {
2043 		mlx4_free_cmd_mailbox(dev, inbox);
2044 		return PTR_ERR(outbox);
2045 	}
2046 
2047 	inmad = (struct mlx4_mad_ifc *)(inbox->buf);
2048 	outmad = (struct mlx4_mad_ifc *)(outbox->buf);
2049 
2050 	inmad->method = 0x1; /* Get */
2051 	inmad->class_version = 0x1;
2052 	inmad->mgmt_class = 0x1;
2053 	inmad->base_version = 0x1;
2054 	inmad->attr_id = cpu_to_be16(0xFF60); /* Module Info */
2055 
2056 	cable_info = (struct mlx4_cable_info *)inmad->data;
2057 	cable_info->dev_mem_address = 0;
2058 	cable_info->page_num = 0;
2059 	cable_info->i2c_addr = I2C_ADDR_LOW;
2060 	cable_info->size = cpu_to_be16(1);
2061 
2062 	ret = mlx4_cmd_box(dev, inbox->dma, outbox->dma, port, 3,
2063 			   MLX4_CMD_MAD_IFC, MLX4_CMD_TIME_CLASS_C,
2064 			   MLX4_CMD_NATIVE);
2065 	if (ret)
2066 		goto out;
2067 
2068 	if (be16_to_cpu(outmad->status)) {
2069 		/* Mad returned with bad status */
2070 		ret = be16_to_cpu(outmad->status);
2071 		mlx4_warn(dev,
2072 			  "MLX4_CMD_MAD_IFC Get Module ID attr(%x) port(%d) i2c_addr(%x) offset(%d) size(%d): Response Mad Status(%x) - %s\n",
2073 			  0xFF60, port, I2C_ADDR_LOW, 0, 1, ret,
2074 			  cable_info_mad_err_str(ret));
2075 		ret = -ret;
2076 		goto out;
2077 	}
2078 	cable_info = (struct mlx4_cable_info *)outmad->data;
2079 	*module_id = cable_info->data[0];
2080 out:
2081 	mlx4_free_cmd_mailbox(dev, inbox);
2082 	mlx4_free_cmd_mailbox(dev, outbox);
2083 	return ret;
2084 }
2085 
2086 static void mlx4_sfp_eeprom_params_set(u8 *i2c_addr, u8 *page_num, u16 *offset)
2087 {
2088 	*i2c_addr = I2C_ADDR_LOW;
2089 	*page_num = 0;
2090 
2091 	if (*offset < I2C_PAGE_SIZE)
2092 		return;
2093 
2094 	*i2c_addr = I2C_ADDR_HIGH;
2095 	*offset -= I2C_PAGE_SIZE;
2096 }
2097 
2098 static void mlx4_qsfp_eeprom_params_set(u8 *i2c_addr, u8 *page_num, u16 *offset)
2099 {
2100 	/* Offsets 0-255 belong to page 0.
2101 	 * Offsets 256-639 belong to pages 01, 02, 03.
2102 	 * For example, offset 400 is page 02: 1 + (400 - 256) / 128 = 2
2103 	 */
2104 	if (*offset < I2C_PAGE_SIZE)
2105 		*page_num = 0;
2106 	else
2107 		*page_num = 1 + (*offset - I2C_PAGE_SIZE) / I2C_HIGH_PAGE_SIZE;
2108 	*i2c_addr = I2C_ADDR_LOW;
2109 	*offset -= *page_num * I2C_HIGH_PAGE_SIZE;
2110 }
2111 
2112 /**
2113  * mlx4_get_module_info - Read cable module eeprom data
2114  * @dev: mlx4_dev.
2115  * @port: port number.
2116  * @offset: byte offset in eeprom to start reading data from.
2117  * @size: num of bytes to read.
2118  * @data: output buffer to put the requested data into.
2119  *
2120  * Reads cable module eeprom data, puts the outcome data into
2121  * data pointer paramer.
2122  * Returns num of read bytes on success or a negative error
2123  * code.
2124  */
2125 int mlx4_get_module_info(struct mlx4_dev *dev, u8 port,
2126 			 u16 offset, u16 size, u8 *data)
2127 {
2128 	struct mlx4_cmd_mailbox *inbox, *outbox;
2129 	struct mlx4_mad_ifc *inmad, *outmad;
2130 	struct mlx4_cable_info *cable_info;
2131 	u8 module_id, i2c_addr, page_num;
2132 	int ret;
2133 
2134 	if (size > MODULE_INFO_MAX_READ)
2135 		size = MODULE_INFO_MAX_READ;
2136 
2137 	ret = mlx4_get_module_id(dev, port, &module_id);
2138 	if (ret)
2139 		return ret;
2140 
2141 	switch (module_id) {
2142 	case MLX4_MODULE_ID_SFP:
2143 		mlx4_sfp_eeprom_params_set(&i2c_addr, &page_num, &offset);
2144 		break;
2145 	case MLX4_MODULE_ID_QSFP:
2146 	case MLX4_MODULE_ID_QSFP_PLUS:
2147 	case MLX4_MODULE_ID_QSFP28:
2148 		mlx4_qsfp_eeprom_params_set(&i2c_addr, &page_num, &offset);
2149 		break;
2150 	default:
2151 		mlx4_err(dev, "Module ID not recognized: %#x\n", module_id);
2152 		return -EINVAL;
2153 	}
2154 
2155 	inbox = mlx4_alloc_cmd_mailbox(dev);
2156 	if (IS_ERR(inbox))
2157 		return PTR_ERR(inbox);
2158 
2159 	outbox = mlx4_alloc_cmd_mailbox(dev);
2160 	if (IS_ERR(outbox)) {
2161 		mlx4_free_cmd_mailbox(dev, inbox);
2162 		return PTR_ERR(outbox);
2163 	}
2164 
2165 	inmad = (struct mlx4_mad_ifc *)(inbox->buf);
2166 	outmad = (struct mlx4_mad_ifc *)(outbox->buf);
2167 
2168 	inmad->method = 0x1; /* Get */
2169 	inmad->class_version = 0x1;
2170 	inmad->mgmt_class = 0x1;
2171 	inmad->base_version = 0x1;
2172 	inmad->attr_id = cpu_to_be16(0xFF60); /* Module Info */
2173 
2174 	if (offset < I2C_PAGE_SIZE && offset + size > I2C_PAGE_SIZE)
2175 		/* Cross pages reads are not allowed
2176 		 * read until offset 256 in low page
2177 		 */
2178 		size -= offset + size - I2C_PAGE_SIZE;
2179 
2180 	cable_info = (struct mlx4_cable_info *)inmad->data;
2181 	cable_info->dev_mem_address = cpu_to_be16(offset);
2182 	cable_info->page_num = page_num;
2183 	cable_info->i2c_addr = i2c_addr;
2184 	cable_info->size = cpu_to_be16(size);
2185 
2186 	ret = mlx4_cmd_box(dev, inbox->dma, outbox->dma, port, 3,
2187 			   MLX4_CMD_MAD_IFC, MLX4_CMD_TIME_CLASS_C,
2188 			   MLX4_CMD_NATIVE);
2189 	if (ret)
2190 		goto out;
2191 
2192 	if (be16_to_cpu(outmad->status)) {
2193 		/* Mad returned with bad status */
2194 		ret = be16_to_cpu(outmad->status);
2195 		mlx4_warn(dev,
2196 			  "MLX4_CMD_MAD_IFC Get Module info attr(%x) port(%d) i2c_addr(%x) offset(%d) size(%d): Response Mad Status(%x) - %s\n",
2197 			  0xFF60, port, i2c_addr, offset, size,
2198 			  ret, cable_info_mad_err_str(ret));
2199 
2200 		if (i2c_addr == I2C_ADDR_HIGH &&
2201 		    MAD_STATUS_2_CABLE_ERR(ret) == CABLE_INF_I2C_ADDR)
2202 			/* Some SFP cables do not support i2c slave
2203 			 * address 0x51 (high page), abort silently.
2204 			 */
2205 			ret = 0;
2206 		else
2207 			ret = -ret;
2208 		goto out;
2209 	}
2210 	cable_info = (struct mlx4_cable_info *)outmad->data;
2211 	memcpy(data, cable_info->data, size);
2212 	ret = size;
2213 out:
2214 	mlx4_free_cmd_mailbox(dev, inbox);
2215 	mlx4_free_cmd_mailbox(dev, outbox);
2216 	return ret;
2217 }
2218 EXPORT_SYMBOL(mlx4_get_module_info);
2219 
2220 int mlx4_max_tc(struct mlx4_dev *dev)
2221 {
2222 	u8 num_tc = dev->caps.max_tc_eth;
2223 
2224 	if (!num_tc)
2225 		num_tc = MLX4_TC_MAX_NUMBER;
2226 
2227 	return num_tc;
2228 }
2229 EXPORT_SYMBOL(mlx4_max_tc);
2230