2 * Copyright (c) 2006, 2007 Cisco Systems, Inc. All rights reserved.
3 * Copyright (c) 2007, 2008 Mellanox Technologies. All rights reserved.
5 * This software is available to you under a choice of one of two
6 * licenses. You may choose to be licensed under the terms of the GNU
7 * General Public License (GPL) Version 2, available from the file
8 * COPYING in the main directory of this source tree, or the
9 * OpenIB.org BSD license below:
11 * Redistribution and use in source and binary forms, with or
12 * without modification, are permitted provided that the following
15 * - Redistributions of source code must retain the above
16 * copyright notice, this list of conditions and the following
19 * - Redistributions in binary form must reproduce the above
20 * copyright notice, this list of conditions and the following
21 * disclaimer in the documentation and/or other materials
22 * provided with the distribution.
24 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
25 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
26 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
27 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
28 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
29 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
30 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
34 #include <linux/string.h>
35 #include <linux/etherdevice.h>
37 #include <linux/mlx4/cmd.h>
41 #define MGM_QPN_MASK 0x00FFFFFF
42 #define MGM_BLCK_LB_BIT 30
44 static const u8 zero_gid
[16]; /* automatically initialized to 0 */
46 static int mlx4_READ_ENTRY(struct mlx4_dev
*dev
, int index
,
47 struct mlx4_cmd_mailbox
*mailbox
)
49 return mlx4_cmd_box(dev
, 0, mailbox
->dma
, index
, 0, MLX4_CMD_READ_MCG
,
50 MLX4_CMD_TIME_CLASS_A
);
53 static int mlx4_WRITE_ENTRY(struct mlx4_dev
*dev
, int index
,
54 struct mlx4_cmd_mailbox
*mailbox
)
56 return mlx4_cmd(dev
, mailbox
->dma
, index
, 0, MLX4_CMD_WRITE_MCG
,
57 MLX4_CMD_TIME_CLASS_A
);
60 static int mlx4_WRITE_PROMISC(struct mlx4_dev
*dev
, u8 vep_num
, u8 port
, u8 steer
,
61 struct mlx4_cmd_mailbox
*mailbox
)
65 in_mod
= (u32
) vep_num
<< 24 | (u32
) port
<< 16 | steer
<< 1;
66 return mlx4_cmd(dev
, mailbox
->dma
, in_mod
, 0x1,
67 MLX4_CMD_WRITE_MCG
, MLX4_CMD_TIME_CLASS_A
);
70 static int mlx4_GID_HASH(struct mlx4_dev
*dev
, struct mlx4_cmd_mailbox
*mailbox
,
76 err
= mlx4_cmd_imm(dev
, mailbox
->dma
, &imm
, 0, op_mod
,
77 MLX4_CMD_MGID_HASH
, MLX4_CMD_TIME_CLASS_A
);
85 static struct mlx4_promisc_qp
*get_promisc_qp(struct mlx4_dev
*dev
, u8 pf_num
,
86 enum mlx4_steer_type steer
,
89 struct mlx4_steer
*s_steer
= &mlx4_priv(dev
)->steer
[pf_num
];
90 struct mlx4_promisc_qp
*pqp
;
92 list_for_each_entry(pqp
, &s_steer
->promisc_qps
[steer
], list
) {
101 * Add new entry to steering data structure.
102 * All promisc QPs should be added as well
104 static int new_steering_entry(struct mlx4_dev
*dev
, u8 vep_num
, u8 port
,
105 enum mlx4_steer_type steer
,
106 unsigned int index
, u32 qpn
)
108 struct mlx4_steer
*s_steer
;
109 struct mlx4_cmd_mailbox
*mailbox
;
110 struct mlx4_mgm
*mgm
;
112 struct mlx4_steer_index
*new_entry
;
113 struct mlx4_promisc_qp
*pqp
;
114 struct mlx4_promisc_qp
*dqp
;
119 pf_num
= (dev
->caps
.num_ports
== 1) ? vep_num
: (vep_num
<< 1) | (port
- 1);
120 s_steer
= &mlx4_priv(dev
)->steer
[pf_num
];
121 new_entry
= kzalloc(sizeof *new_entry
, GFP_KERNEL
);
125 INIT_LIST_HEAD(&new_entry
->duplicates
);
126 new_entry
->index
= index
;
127 list_add_tail(&new_entry
->list
, &s_steer
->steer_entries
[steer
]);
129 /* If the given qpn is also a promisc qp,
130 * it should be inserted to duplicates list
132 pqp
= get_promisc_qp(dev
, pf_num
, steer
, qpn
);
134 dqp
= kmalloc(sizeof *dqp
, GFP_KERNEL
);
140 list_add_tail(&dqp
->list
, &new_entry
->duplicates
);
143 /* if no promisc qps for this vep, we are done */
144 if (list_empty(&s_steer
->promisc_qps
[steer
]))
147 /* now need to add all the promisc qps to the new
148 * steering entry, as they should also receive the packets
149 * destined to this address */
150 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
151 if (IS_ERR(mailbox
)) {
157 err
= mlx4_READ_ENTRY(dev
, index
, mailbox
);
161 members_count
= be32_to_cpu(mgm
->members_count
) & 0xffffff;
162 prot
= be32_to_cpu(mgm
->members_count
) >> 30;
163 list_for_each_entry(pqp
, &s_steer
->promisc_qps
[steer
], list
) {
164 /* don't add already existing qpn */
167 if (members_count
== MLX4_QP_PER_MGM
) {
174 mgm
->qp
[members_count
++] = cpu_to_be32(pqp
->qpn
& MGM_QPN_MASK
);
176 /* update the qps count and update the entry with all the promisc qps*/
177 mgm
->members_count
= cpu_to_be32(members_count
| (prot
<< 30));
178 err
= mlx4_WRITE_ENTRY(dev
, index
, mailbox
);
181 mlx4_free_cmd_mailbox(dev
, mailbox
);
186 list_del(&dqp
->list
);
189 list_del(&new_entry
->list
);
194 /* update the data structures with existing steering entry */
195 static int existing_steering_entry(struct mlx4_dev
*dev
, u8 vep_num
, u8 port
,
196 enum mlx4_steer_type steer
,
197 unsigned int index
, u32 qpn
)
199 struct mlx4_steer
*s_steer
;
200 struct mlx4_steer_index
*tmp_entry
, *entry
= NULL
;
201 struct mlx4_promisc_qp
*pqp
;
202 struct mlx4_promisc_qp
*dqp
;
205 pf_num
= (dev
->caps
.num_ports
== 1) ? vep_num
: (vep_num
<< 1) | (port
- 1);
206 s_steer
= &mlx4_priv(dev
)->steer
[pf_num
];
208 pqp
= get_promisc_qp(dev
, pf_num
, steer
, qpn
);
210 return 0; /* nothing to do */
212 list_for_each_entry(tmp_entry
, &s_steer
->steer_entries
[steer
], list
) {
213 if (tmp_entry
->index
== index
) {
218 if (unlikely(!entry
)) {
219 mlx4_warn(dev
, "Steering entry at index %x is not registered\n", index
);
223 /* the given qpn is listed as a promisc qpn
224 * we need to add it as a duplicate to this entry
225 * for future references */
226 list_for_each_entry(dqp
, &entry
->duplicates
, list
) {
228 return 0; /* qp is already duplicated */
231 /* add the qp as a duplicate on this index */
232 dqp
= kmalloc(sizeof *dqp
, GFP_KERNEL
);
236 list_add_tail(&dqp
->list
, &entry
->duplicates
);
241 /* Check whether a qpn is a duplicate on steering entry
242 * If so, it should not be removed from mgm */
243 static bool check_duplicate_entry(struct mlx4_dev
*dev
, u8 vep_num
, u8 port
,
244 enum mlx4_steer_type steer
,
245 unsigned int index
, u32 qpn
)
247 struct mlx4_steer
*s_steer
;
248 struct mlx4_steer_index
*tmp_entry
, *entry
= NULL
;
249 struct mlx4_promisc_qp
*dqp
, *tmp_dqp
;
252 pf_num
= (dev
->caps
.num_ports
== 1) ? vep_num
: (vep_num
<< 1) | (port
- 1);
253 s_steer
= &mlx4_priv(dev
)->steer
[pf_num
];
255 /* if qp is not promisc, it cannot be duplicated */
256 if (!get_promisc_qp(dev
, pf_num
, steer
, qpn
))
259 /* The qp is promisc qp so it is a duplicate on this index
260 * Find the index entry, and remove the duplicate */
261 list_for_each_entry(tmp_entry
, &s_steer
->steer_entries
[steer
], list
) {
262 if (tmp_entry
->index
== index
) {
267 if (unlikely(!entry
)) {
268 mlx4_warn(dev
, "Steering entry for index %x is not registered\n", index
);
271 list_for_each_entry_safe(dqp
, tmp_dqp
, &entry
->duplicates
, list
) {
272 if (dqp
->qpn
== qpn
) {
273 list_del(&dqp
->list
);
280 /* I a steering entry contains only promisc QPs, it can be removed. */
281 static bool can_remove_steering_entry(struct mlx4_dev
*dev
, u8 vep_num
, u8 port
,
282 enum mlx4_steer_type steer
,
283 unsigned int index
, u32 tqpn
)
285 struct mlx4_steer
*s_steer
;
286 struct mlx4_cmd_mailbox
*mailbox
;
287 struct mlx4_mgm
*mgm
;
288 struct mlx4_steer_index
*entry
= NULL
, *tmp_entry
;
295 pf_num
= (dev
->caps
.num_ports
== 1) ? vep_num
: (vep_num
<< 1) | (port
- 1);
296 s_steer
= &mlx4_priv(dev
)->steer
[pf_num
];
298 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
303 if (mlx4_READ_ENTRY(dev
, index
, mailbox
))
305 members_count
= be32_to_cpu(mgm
->members_count
) & 0xffffff;
306 for (i
= 0; i
< members_count
; i
++) {
307 qpn
= be32_to_cpu(mgm
->qp
[i
]) & MGM_QPN_MASK
;
308 if (!get_promisc_qp(dev
, pf_num
, steer
, qpn
) && qpn
!= tqpn
) {
309 /* the qp is not promisc, the entry can't be removed */
313 /* All the qps currently registered for this entry are promiscuous,
314 * Checking for duplicates */
316 list_for_each_entry_safe(entry
, tmp_entry
, &s_steer
->steer_entries
[steer
], list
) {
317 if (entry
->index
== index
) {
318 if (list_empty(&entry
->duplicates
)) {
319 list_del(&entry
->list
);
322 /* This entry contains duplicates so it shouldn't be removed */
330 mlx4_free_cmd_mailbox(dev
, mailbox
);
334 static int add_promisc_qp(struct mlx4_dev
*dev
, u8 vep_num
, u8 port
,
335 enum mlx4_steer_type steer
, u32 qpn
)
337 struct mlx4_steer
*s_steer
;
338 struct mlx4_cmd_mailbox
*mailbox
;
339 struct mlx4_mgm
*mgm
;
340 struct mlx4_steer_index
*entry
;
341 struct mlx4_promisc_qp
*pqp
;
342 struct mlx4_promisc_qp
*dqp
;
350 struct mlx4_priv
*priv
= mlx4_priv(dev
);
351 pf_num
= (dev
->caps
.num_ports
== 1) ? vep_num
: (vep_num
<< 1) | (port
- 1);
352 s_steer
= &mlx4_priv(dev
)->steer
[pf_num
];
354 mutex_lock(&priv
->mcg_table
.mutex
);
356 if (get_promisc_qp(dev
, pf_num
, steer
, qpn
)) {
357 err
= 0; /* Noting to do, already exists */
361 pqp
= kmalloc(sizeof *pqp
, GFP_KERNEL
);
368 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
369 if (IS_ERR(mailbox
)) {
375 /* the promisc qp needs to be added for each one of the steering
376 * entries, if it already exists, needs to be added as a duplicate
378 list_for_each_entry(entry
, &s_steer
->steer_entries
[steer
], list
) {
379 err
= mlx4_READ_ENTRY(dev
, entry
->index
, mailbox
);
383 members_count
= be32_to_cpu(mgm
->members_count
) & 0xffffff;
384 prot
= be32_to_cpu(mgm
->members_count
) >> 30;
386 for (i
= 0; i
< members_count
; i
++) {
387 if ((be32_to_cpu(mgm
->qp
[i
]) & MGM_QPN_MASK
) == qpn
) {
388 /* Entry already exists, add to duplicates */
389 dqp
= kmalloc(sizeof *dqp
, GFP_KERNEL
);
393 list_add_tail(&dqp
->list
, &entry
->duplicates
);
398 /* Need to add the qpn to mgm */
399 if (members_count
== MLX4_QP_PER_MGM
) {
404 mgm
->qp
[members_count
++] = cpu_to_be32(qpn
& MGM_QPN_MASK
);
405 mgm
->members_count
= cpu_to_be32(members_count
| (prot
<< 30));
406 err
= mlx4_WRITE_ENTRY(dev
, entry
->index
, mailbox
);
410 last_index
= entry
->index
;
413 /* add the new qpn to list of promisc qps */
414 list_add_tail(&pqp
->list
, &s_steer
->promisc_qps
[steer
]);
415 /* now need to add all the promisc qps to default entry */
416 memset(mgm
, 0, sizeof *mgm
);
418 list_for_each_entry(dqp
, &s_steer
->promisc_qps
[steer
], list
)
419 mgm
->qp
[members_count
++] = cpu_to_be32(dqp
->qpn
& MGM_QPN_MASK
);
420 mgm
->members_count
= cpu_to_be32(members_count
| MLX4_PROT_ETH
<< 30);
422 err
= mlx4_WRITE_PROMISC(dev
, vep_num
, port
, steer
, mailbox
);
426 mlx4_free_cmd_mailbox(dev
, mailbox
);
427 mutex_unlock(&priv
->mcg_table
.mutex
);
431 list_del(&pqp
->list
);
433 mlx4_free_cmd_mailbox(dev
, mailbox
);
437 mutex_unlock(&priv
->mcg_table
.mutex
);
441 static int remove_promisc_qp(struct mlx4_dev
*dev
, u8 vep_num
, u8 port
,
442 enum mlx4_steer_type steer
, u32 qpn
)
444 struct mlx4_priv
*priv
= mlx4_priv(dev
);
445 struct mlx4_steer
*s_steer
;
446 struct mlx4_cmd_mailbox
*mailbox
;
447 struct mlx4_mgm
*mgm
;
448 struct mlx4_steer_index
*entry
;
449 struct mlx4_promisc_qp
*pqp
;
450 struct mlx4_promisc_qp
*dqp
;
453 bool back_to_list
= false;
458 pf_num
= (dev
->caps
.num_ports
== 1) ? vep_num
: (vep_num
<< 1) | (port
- 1);
459 s_steer
= &mlx4_priv(dev
)->steer
[pf_num
];
460 mutex_lock(&priv
->mcg_table
.mutex
);
462 pqp
= get_promisc_qp(dev
, pf_num
, steer
, qpn
);
463 if (unlikely(!pqp
)) {
464 mlx4_warn(dev
, "QP %x is not promiscuous QP\n", qpn
);
470 /*remove from list of promisc qps */
471 list_del(&pqp
->list
);
474 /* set the default entry not to include the removed one */
475 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
476 if (IS_ERR(mailbox
)) {
483 list_for_each_entry(dqp
, &s_steer
->promisc_qps
[steer
], list
)
484 mgm
->qp
[members_count
++] = cpu_to_be32(dqp
->qpn
& MGM_QPN_MASK
);
485 mgm
->members_count
= cpu_to_be32(members_count
| MLX4_PROT_ETH
<< 30);
487 err
= mlx4_WRITE_PROMISC(dev
, vep_num
, port
, steer
, mailbox
);
491 /* remove the qp from all the steering entries*/
492 list_for_each_entry(entry
, &s_steer
->steer_entries
[steer
], list
) {
494 list_for_each_entry(dqp
, &entry
->duplicates
, list
) {
495 if (dqp
->qpn
== qpn
) {
501 /* a duplicate, no need to change the mgm,
502 * only update the duplicates list */
503 list_del(&dqp
->list
);
506 err
= mlx4_READ_ENTRY(dev
, entry
->index
, mailbox
);
509 members_count
= be32_to_cpu(mgm
->members_count
) & 0xffffff;
510 for (loc
= -1, i
= 0; i
< members_count
; ++i
)
511 if ((be32_to_cpu(mgm
->qp
[i
]) & MGM_QPN_MASK
) == qpn
)
514 mgm
->members_count
= cpu_to_be32(--members_count
|
515 (MLX4_PROT_ETH
<< 30));
516 mgm
->qp
[loc
] = mgm
->qp
[i
- 1];
519 err
= mlx4_WRITE_ENTRY(dev
, entry
->index
, mailbox
);
527 mlx4_free_cmd_mailbox(dev
, mailbox
);
530 list_add_tail(&pqp
->list
, &s_steer
->promisc_qps
[steer
]);
532 mutex_unlock(&priv
->mcg_table
.mutex
);
537 * Caller must hold MCG table semaphore. gid and mgm parameters must
538 * be properly aligned for command interface.
540 * Returns 0 unless a firmware command error occurs.
542 * If GID is found in MGM or MGM is empty, *index = *hash, *prev = -1
543 * and *mgm holds MGM entry.
545 * if GID is found in AMGM, *index = index in AMGM, *prev = index of
546 * previous entry in hash chain and *mgm holds AMGM entry.
548 * If no AMGM exists for given gid, *index = -1, *prev = index of last
549 * entry in hash chain and *mgm holds end of hash chain.
551 static int find_entry(struct mlx4_dev
*dev
, u8 port
,
552 u8
*gid
, enum mlx4_protocol prot
,
553 enum mlx4_steer_type steer
,
554 struct mlx4_cmd_mailbox
*mgm_mailbox
,
555 u16
*hash
, int *prev
, int *index
)
557 struct mlx4_cmd_mailbox
*mailbox
;
558 struct mlx4_mgm
*mgm
= mgm_mailbox
->buf
;
561 u8 op_mod
= (prot
== MLX4_PROT_ETH
) ? !!(dev
->caps
.vep_mc_steering
) : 0;
563 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
568 memcpy(mgid
, gid
, 16);
570 err
= mlx4_GID_HASH(dev
, mailbox
, hash
, op_mod
);
571 mlx4_free_cmd_mailbox(dev
, mailbox
);
576 mlx4_dbg(dev
, "Hash for %pI6 is %04x\n", gid
, *hash
);
582 err
= mlx4_READ_ENTRY(dev
, *index
, mgm_mailbox
);
586 if (!(be32_to_cpu(mgm
->members_count
) & 0xffffff)) {
587 if (*index
!= *hash
) {
588 mlx4_err(dev
, "Found zero MGID in AMGM.\n");
594 if (!memcmp(mgm
->gid
, gid
, 16) &&
595 be32_to_cpu(mgm
->members_count
) >> 30 == prot
)
599 *index
= be32_to_cpu(mgm
->next_gid_index
) >> 6;
606 int mlx4_qp_attach_common(struct mlx4_dev
*dev
, struct mlx4_qp
*qp
, u8 gid
[16],
607 int block_mcast_loopback
, enum mlx4_protocol prot
,
608 enum mlx4_steer_type steer
)
610 struct mlx4_priv
*priv
= mlx4_priv(dev
);
611 struct mlx4_cmd_mailbox
*mailbox
;
612 struct mlx4_mgm
*mgm
;
622 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
624 return PTR_ERR(mailbox
);
627 mutex_lock(&priv
->mcg_table
.mutex
);
628 err
= find_entry(dev
, port
, gid
, prot
, steer
,
629 mailbox
, &hash
, &prev
, &index
);
634 if (!(be32_to_cpu(mgm
->members_count
) & 0xffffff)) {
636 memcpy(mgm
->gid
, gid
, 16);
641 index
= mlx4_bitmap_alloc(&priv
->mcg_table
.bitmap
);
643 mlx4_err(dev
, "No AMGM entries left\n");
647 index
+= dev
->caps
.num_mgms
;
649 memset(mgm
, 0, sizeof *mgm
);
650 memcpy(mgm
->gid
, gid
, 16);
653 members_count
= be32_to_cpu(mgm
->members_count
) & 0xffffff;
654 if (members_count
== MLX4_QP_PER_MGM
) {
655 mlx4_err(dev
, "MGM at index %x is full.\n", index
);
660 for (i
= 0; i
< members_count
; ++i
)
661 if ((be32_to_cpu(mgm
->qp
[i
]) & MGM_QPN_MASK
) == qp
->qpn
) {
662 mlx4_dbg(dev
, "QP %06x already a member of MGM\n", qp
->qpn
);
667 if (block_mcast_loopback
)
668 mgm
->qp
[members_count
++] = cpu_to_be32((qp
->qpn
& MGM_QPN_MASK
) |
669 (1U << MGM_BLCK_LB_BIT
));
671 mgm
->qp
[members_count
++] = cpu_to_be32(qp
->qpn
& MGM_QPN_MASK
);
673 mgm
->members_count
= cpu_to_be32(members_count
| (u32
) prot
<< 30);
675 err
= mlx4_WRITE_ENTRY(dev
, index
, mailbox
);
682 err
= mlx4_READ_ENTRY(dev
, prev
, mailbox
);
686 mgm
->next_gid_index
= cpu_to_be32(index
<< 6);
688 err
= mlx4_WRITE_ENTRY(dev
, prev
, mailbox
);
693 if (prot
== MLX4_PROT_ETH
) {
694 /* manage the steering entry for promisc mode */
696 new_steering_entry(dev
, 0, port
, steer
, index
, qp
->qpn
);
698 existing_steering_entry(dev
, 0, port
, steer
,
701 if (err
&& link
&& index
!= -1) {
702 if (index
< dev
->caps
.num_mgms
)
703 mlx4_warn(dev
, "Got AMGM index %d < %d",
704 index
, dev
->caps
.num_mgms
);
706 mlx4_bitmap_free(&priv
->mcg_table
.bitmap
,
707 index
- dev
->caps
.num_mgms
);
709 mutex_unlock(&priv
->mcg_table
.mutex
);
711 mlx4_free_cmd_mailbox(dev
, mailbox
);
715 int mlx4_qp_detach_common(struct mlx4_dev
*dev
, struct mlx4_qp
*qp
, u8 gid
[16],
716 enum mlx4_protocol prot
, enum mlx4_steer_type steer
)
718 struct mlx4_priv
*priv
= mlx4_priv(dev
);
719 struct mlx4_cmd_mailbox
*mailbox
;
720 struct mlx4_mgm
*mgm
;
727 bool removed_entry
= false;
729 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
731 return PTR_ERR(mailbox
);
734 mutex_lock(&priv
->mcg_table
.mutex
);
736 err
= find_entry(dev
, port
, gid
, prot
, steer
,
737 mailbox
, &hash
, &prev
, &index
);
742 mlx4_err(dev
, "MGID %pI6 not found\n", gid
);
747 /* if this pq is also a promisc qp, it shouldn't be removed */
748 if (prot
== MLX4_PROT_ETH
&&
749 check_duplicate_entry(dev
, 0, port
, steer
, index
, qp
->qpn
))
752 members_count
= be32_to_cpu(mgm
->members_count
) & 0xffffff;
753 for (loc
= -1, i
= 0; i
< members_count
; ++i
)
754 if ((be32_to_cpu(mgm
->qp
[i
]) & MGM_QPN_MASK
) == qp
->qpn
)
758 mlx4_err(dev
, "QP %06x not found in MGM\n", qp
->qpn
);
764 mgm
->members_count
= cpu_to_be32(--members_count
| (u32
) prot
<< 30);
765 mgm
->qp
[loc
] = mgm
->qp
[i
- 1];
768 if (prot
== MLX4_PROT_ETH
)
769 removed_entry
= can_remove_steering_entry(dev
, 0, port
, steer
, index
, qp
->qpn
);
770 if (i
!= 1 && (prot
!= MLX4_PROT_ETH
|| !removed_entry
)) {
771 err
= mlx4_WRITE_ENTRY(dev
, index
, mailbox
);
775 /* We are going to delete the entry, members count should be 0 */
776 mgm
->members_count
= cpu_to_be32((u32
) prot
<< 30);
779 /* Remove entry from MGM */
780 int amgm_index
= be32_to_cpu(mgm
->next_gid_index
) >> 6;
782 err
= mlx4_READ_ENTRY(dev
, amgm_index
, mailbox
);
786 memset(mgm
->gid
, 0, 16);
788 err
= mlx4_WRITE_ENTRY(dev
, index
, mailbox
);
793 if (amgm_index
< dev
->caps
.num_mgms
)
794 mlx4_warn(dev
, "MGM entry %d had AMGM index %d < %d",
795 index
, amgm_index
, dev
->caps
.num_mgms
);
797 mlx4_bitmap_free(&priv
->mcg_table
.bitmap
,
798 amgm_index
- dev
->caps
.num_mgms
);
801 /* Remove entry from AMGM */
802 int cur_next_index
= be32_to_cpu(mgm
->next_gid_index
) >> 6;
803 err
= mlx4_READ_ENTRY(dev
, prev
, mailbox
);
807 mgm
->next_gid_index
= cpu_to_be32(cur_next_index
<< 6);
809 err
= mlx4_WRITE_ENTRY(dev
, prev
, mailbox
);
813 if (index
< dev
->caps
.num_mgms
)
814 mlx4_warn(dev
, "entry %d had next AMGM index %d < %d",
815 prev
, index
, dev
->caps
.num_mgms
);
817 mlx4_bitmap_free(&priv
->mcg_table
.bitmap
,
818 index
- dev
->caps
.num_mgms
);
822 mutex_unlock(&priv
->mcg_table
.mutex
);
824 mlx4_free_cmd_mailbox(dev
, mailbox
);
829 int mlx4_multicast_attach(struct mlx4_dev
*dev
, struct mlx4_qp
*qp
, u8 gid
[16],
830 int block_mcast_loopback
, enum mlx4_protocol prot
)
832 enum mlx4_steer_type steer
;
834 steer
= (is_valid_ether_addr(&gid
[10])) ? MLX4_UC_STEER
: MLX4_MC_STEER
;
836 if (prot
== MLX4_PROT_ETH
&& !dev
->caps
.vep_mc_steering
)
839 if (prot
== MLX4_PROT_ETH
)
840 gid
[7] |= (steer
<< 1);
842 return mlx4_qp_attach_common(dev
, qp
, gid
,
843 block_mcast_loopback
, prot
,
846 EXPORT_SYMBOL_GPL(mlx4_multicast_attach
);
848 int mlx4_multicast_detach(struct mlx4_dev
*dev
, struct mlx4_qp
*qp
, u8 gid
[16],
849 enum mlx4_protocol prot
)
851 enum mlx4_steer_type steer
;
853 steer
= (is_valid_ether_addr(&gid
[10])) ? MLX4_UC_STEER
: MLX4_MC_STEER
;
855 if (prot
== MLX4_PROT_ETH
&& !dev
->caps
.vep_mc_steering
)
858 if (prot
== MLX4_PROT_ETH
) {
859 gid
[7] |= (steer
<< 1);
862 return mlx4_qp_detach_common(dev
, qp
, gid
, prot
, steer
);
864 EXPORT_SYMBOL_GPL(mlx4_multicast_detach
);
867 int mlx4_multicast_promisc_add(struct mlx4_dev
*dev
, u32 qpn
, u8 port
)
869 if (!dev
->caps
.vep_mc_steering
)
873 return add_promisc_qp(dev
, 0, port
, MLX4_MC_STEER
, qpn
);
875 EXPORT_SYMBOL_GPL(mlx4_multicast_promisc_add
);
877 int mlx4_multicast_promisc_remove(struct mlx4_dev
*dev
, u32 qpn
, u8 port
)
879 if (!dev
->caps
.vep_mc_steering
)
883 return remove_promisc_qp(dev
, 0, port
, MLX4_MC_STEER
, qpn
);
885 EXPORT_SYMBOL_GPL(mlx4_multicast_promisc_remove
);
887 int mlx4_unicast_promisc_add(struct mlx4_dev
*dev
, u32 qpn
, u8 port
)
889 if (!dev
->caps
.vep_mc_steering
)
893 return add_promisc_qp(dev
, 0, port
, MLX4_UC_STEER
, qpn
);
895 EXPORT_SYMBOL_GPL(mlx4_unicast_promisc_add
);
897 int mlx4_unicast_promisc_remove(struct mlx4_dev
*dev
, u32 qpn
, u8 port
)
899 if (!dev
->caps
.vep_mc_steering
)
902 return remove_promisc_qp(dev
, 0, port
, MLX4_UC_STEER
, qpn
);
904 EXPORT_SYMBOL_GPL(mlx4_unicast_promisc_remove
);
906 int mlx4_init_mcg_table(struct mlx4_dev
*dev
)
908 struct mlx4_priv
*priv
= mlx4_priv(dev
);
911 err
= mlx4_bitmap_init(&priv
->mcg_table
.bitmap
, dev
->caps
.num_amgms
,
912 dev
->caps
.num_amgms
- 1, 0, 0);
916 mutex_init(&priv
->mcg_table
.mutex
);
921 void mlx4_cleanup_mcg_table(struct mlx4_dev
*dev
)
923 mlx4_bitmap_cleanup(&mlx4_priv(dev
)->mcg_table
.bitmap
);