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>
38 #include <linux/export.h>
42 #define MGM_QPN_MASK 0x00FFFFFF
43 #define MGM_BLCK_LB_BIT 30
45 static const u8 zero_gid
[16]; /* automatically initialized to 0 */
48 __be32 next_gid_index
;
52 __be32 qp
[MLX4_MAX_QP_PER_MGM
];
55 int mlx4_get_mgm_entry_size(struct mlx4_dev
*dev
)
57 return min((1 << mlx4_log_num_mgm_entry_size
), MLX4_MAX_MGM_ENTRY_SIZE
);
60 int mlx4_get_qp_per_mgm(struct mlx4_dev
*dev
)
62 return 4 * (mlx4_get_mgm_entry_size(dev
) / 16 - 2);
65 static int mlx4_READ_ENTRY(struct mlx4_dev
*dev
, int index
,
66 struct mlx4_cmd_mailbox
*mailbox
)
68 return mlx4_cmd_box(dev
, 0, mailbox
->dma
, index
, 0, MLX4_CMD_READ_MCG
,
69 MLX4_CMD_TIME_CLASS_A
, MLX4_CMD_NATIVE
);
72 static int mlx4_WRITE_ENTRY(struct mlx4_dev
*dev
, int index
,
73 struct mlx4_cmd_mailbox
*mailbox
)
75 return mlx4_cmd(dev
, mailbox
->dma
, index
, 0, MLX4_CMD_WRITE_MCG
,
76 MLX4_CMD_TIME_CLASS_A
, MLX4_CMD_NATIVE
);
79 static int mlx4_WRITE_PROMISC(struct mlx4_dev
*dev
, u8 port
, u8 steer
,
80 struct mlx4_cmd_mailbox
*mailbox
)
84 in_mod
= (u32
) port
<< 16 | steer
<< 1;
85 return mlx4_cmd(dev
, mailbox
->dma
, in_mod
, 0x1,
86 MLX4_CMD_WRITE_MCG
, MLX4_CMD_TIME_CLASS_A
,
90 static int mlx4_GID_HASH(struct mlx4_dev
*dev
, struct mlx4_cmd_mailbox
*mailbox
,
96 err
= mlx4_cmd_imm(dev
, mailbox
->dma
, &imm
, 0, op_mod
,
97 MLX4_CMD_MGID_HASH
, MLX4_CMD_TIME_CLASS_A
,
106 static struct mlx4_promisc_qp
*get_promisc_qp(struct mlx4_dev
*dev
, u8 pf_num
,
107 enum mlx4_steer_type steer
,
110 struct mlx4_steer
*s_steer
= &mlx4_priv(dev
)->steer
[pf_num
];
111 struct mlx4_promisc_qp
*pqp
;
113 list_for_each_entry(pqp
, &s_steer
->promisc_qps
[steer
], list
) {
122 * Add new entry to steering data structure.
123 * All promisc QPs should be added as well
125 static int new_steering_entry(struct mlx4_dev
*dev
, u8 port
,
126 enum mlx4_steer_type steer
,
127 unsigned int index
, u32 qpn
)
129 struct mlx4_steer
*s_steer
;
130 struct mlx4_cmd_mailbox
*mailbox
;
131 struct mlx4_mgm
*mgm
;
133 struct mlx4_steer_index
*new_entry
;
134 struct mlx4_promisc_qp
*pqp
;
135 struct mlx4_promisc_qp
*dqp
= NULL
;
139 s_steer
= &mlx4_priv(dev
)->steer
[port
- 1];
140 new_entry
= kzalloc(sizeof *new_entry
, GFP_KERNEL
);
144 INIT_LIST_HEAD(&new_entry
->duplicates
);
145 new_entry
->index
= index
;
146 list_add_tail(&new_entry
->list
, &s_steer
->steer_entries
[steer
]);
148 /* If the given qpn is also a promisc qp,
149 * it should be inserted to duplicates list
151 pqp
= get_promisc_qp(dev
, 0, steer
, qpn
);
153 dqp
= kmalloc(sizeof *dqp
, GFP_KERNEL
);
159 list_add_tail(&dqp
->list
, &new_entry
->duplicates
);
162 /* if no promisc qps for this vep, we are done */
163 if (list_empty(&s_steer
->promisc_qps
[steer
]))
166 /* now need to add all the promisc qps to the new
167 * steering entry, as they should also receive the packets
168 * destined to this address */
169 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
170 if (IS_ERR(mailbox
)) {
176 err
= mlx4_READ_ENTRY(dev
, index
, mailbox
);
180 members_count
= be32_to_cpu(mgm
->members_count
) & 0xffffff;
181 prot
= be32_to_cpu(mgm
->members_count
) >> 30;
182 list_for_each_entry(pqp
, &s_steer
->promisc_qps
[steer
], list
) {
183 /* don't add already existing qpn */
186 if (members_count
== dev
->caps
.num_qp_per_mgm
) {
193 mgm
->qp
[members_count
++] = cpu_to_be32(pqp
->qpn
& MGM_QPN_MASK
);
195 /* update the qps count and update the entry with all the promisc qps*/
196 mgm
->members_count
= cpu_to_be32(members_count
| (prot
<< 30));
197 err
= mlx4_WRITE_ENTRY(dev
, index
, mailbox
);
200 mlx4_free_cmd_mailbox(dev
, mailbox
);
205 list_del(&dqp
->list
);
208 list_del(&new_entry
->list
);
213 /* update the data structures with existing steering entry */
214 static int existing_steering_entry(struct mlx4_dev
*dev
, u8 port
,
215 enum mlx4_steer_type steer
,
216 unsigned int index
, u32 qpn
)
218 struct mlx4_steer
*s_steer
;
219 struct mlx4_steer_index
*tmp_entry
, *entry
= NULL
;
220 struct mlx4_promisc_qp
*pqp
;
221 struct mlx4_promisc_qp
*dqp
;
223 s_steer
= &mlx4_priv(dev
)->steer
[port
- 1];
225 pqp
= get_promisc_qp(dev
, 0, steer
, qpn
);
227 return 0; /* nothing to do */
229 list_for_each_entry(tmp_entry
, &s_steer
->steer_entries
[steer
], list
) {
230 if (tmp_entry
->index
== index
) {
235 if (unlikely(!entry
)) {
236 mlx4_warn(dev
, "Steering entry at index %x is not registered\n", index
);
240 /* the given qpn is listed as a promisc qpn
241 * we need to add it as a duplicate to this entry
242 * for future references */
243 list_for_each_entry(dqp
, &entry
->duplicates
, list
) {
245 return 0; /* qp is already duplicated */
248 /* add the qp as a duplicate on this index */
249 dqp
= kmalloc(sizeof *dqp
, GFP_KERNEL
);
253 list_add_tail(&dqp
->list
, &entry
->duplicates
);
258 /* Check whether a qpn is a duplicate on steering entry
259 * If so, it should not be removed from mgm */
260 static bool check_duplicate_entry(struct mlx4_dev
*dev
, u8 port
,
261 enum mlx4_steer_type steer
,
262 unsigned int index
, u32 qpn
)
264 struct mlx4_steer
*s_steer
;
265 struct mlx4_steer_index
*tmp_entry
, *entry
= NULL
;
266 struct mlx4_promisc_qp
*dqp
, *tmp_dqp
;
268 s_steer
= &mlx4_priv(dev
)->steer
[port
- 1];
270 /* if qp is not promisc, it cannot be duplicated */
271 if (!get_promisc_qp(dev
, 0, steer
, qpn
))
274 /* The qp is promisc qp so it is a duplicate on this index
275 * Find the index entry, and remove the duplicate */
276 list_for_each_entry(tmp_entry
, &s_steer
->steer_entries
[steer
], list
) {
277 if (tmp_entry
->index
== index
) {
282 if (unlikely(!entry
)) {
283 mlx4_warn(dev
, "Steering entry for index %x is not registered\n", index
);
286 list_for_each_entry_safe(dqp
, tmp_dqp
, &entry
->duplicates
, list
) {
287 if (dqp
->qpn
== qpn
) {
288 list_del(&dqp
->list
);
295 /* I a steering entry contains only promisc QPs, it can be removed. */
296 static bool can_remove_steering_entry(struct mlx4_dev
*dev
, u8 port
,
297 enum mlx4_steer_type steer
,
298 unsigned int index
, u32 tqpn
)
300 struct mlx4_steer
*s_steer
;
301 struct mlx4_cmd_mailbox
*mailbox
;
302 struct mlx4_mgm
*mgm
;
303 struct mlx4_steer_index
*entry
= NULL
, *tmp_entry
;
309 s_steer
= &mlx4_priv(dev
)->steer
[port
- 1];
311 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
316 if (mlx4_READ_ENTRY(dev
, index
, mailbox
))
318 members_count
= be32_to_cpu(mgm
->members_count
) & 0xffffff;
319 for (i
= 0; i
< members_count
; i
++) {
320 qpn
= be32_to_cpu(mgm
->qp
[i
]) & MGM_QPN_MASK
;
321 if (!get_promisc_qp(dev
, 0, steer
, qpn
) && qpn
!= tqpn
) {
322 /* the qp is not promisc, the entry can't be removed */
326 /* All the qps currently registered for this entry are promiscuous,
327 * Checking for duplicates */
329 list_for_each_entry_safe(entry
, tmp_entry
, &s_steer
->steer_entries
[steer
], list
) {
330 if (entry
->index
== index
) {
331 if (list_empty(&entry
->duplicates
)) {
332 list_del(&entry
->list
);
335 /* This entry contains duplicates so it shouldn't be removed */
343 mlx4_free_cmd_mailbox(dev
, mailbox
);
347 static int add_promisc_qp(struct mlx4_dev
*dev
, u8 port
,
348 enum mlx4_steer_type steer
, u32 qpn
)
350 struct mlx4_steer
*s_steer
;
351 struct mlx4_cmd_mailbox
*mailbox
;
352 struct mlx4_mgm
*mgm
;
353 struct mlx4_steer_index
*entry
;
354 struct mlx4_promisc_qp
*pqp
;
355 struct mlx4_promisc_qp
*dqp
;
361 struct mlx4_priv
*priv
= mlx4_priv(dev
);
363 s_steer
= &mlx4_priv(dev
)->steer
[port
- 1];
365 mutex_lock(&priv
->mcg_table
.mutex
);
367 if (get_promisc_qp(dev
, 0, steer
, qpn
)) {
368 err
= 0; /* Noting to do, already exists */
372 pqp
= kmalloc(sizeof *pqp
, GFP_KERNEL
);
379 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
380 if (IS_ERR(mailbox
)) {
386 /* the promisc qp needs to be added for each one of the steering
387 * entries, if it already exists, needs to be added as a duplicate
389 list_for_each_entry(entry
, &s_steer
->steer_entries
[steer
], list
) {
390 err
= mlx4_READ_ENTRY(dev
, entry
->index
, mailbox
);
394 members_count
= be32_to_cpu(mgm
->members_count
) & 0xffffff;
395 prot
= be32_to_cpu(mgm
->members_count
) >> 30;
397 for (i
= 0; i
< members_count
; i
++) {
398 if ((be32_to_cpu(mgm
->qp
[i
]) & MGM_QPN_MASK
) == qpn
) {
399 /* Entry already exists, add to duplicates */
400 dqp
= kmalloc(sizeof *dqp
, GFP_KERNEL
);
404 list_add_tail(&dqp
->list
, &entry
->duplicates
);
409 /* Need to add the qpn to mgm */
410 if (members_count
== dev
->caps
.num_qp_per_mgm
) {
415 mgm
->qp
[members_count
++] = cpu_to_be32(qpn
& MGM_QPN_MASK
);
416 mgm
->members_count
= cpu_to_be32(members_count
| (prot
<< 30));
417 err
= mlx4_WRITE_ENTRY(dev
, entry
->index
, mailbox
);
423 /* add the new qpn to list of promisc qps */
424 list_add_tail(&pqp
->list
, &s_steer
->promisc_qps
[steer
]);
425 /* now need to add all the promisc qps to default entry */
426 memset(mgm
, 0, sizeof *mgm
);
428 list_for_each_entry(dqp
, &s_steer
->promisc_qps
[steer
], list
)
429 mgm
->qp
[members_count
++] = cpu_to_be32(dqp
->qpn
& MGM_QPN_MASK
);
430 mgm
->members_count
= cpu_to_be32(members_count
| MLX4_PROT_ETH
<< 30);
432 err
= mlx4_WRITE_PROMISC(dev
, port
, steer
, mailbox
);
436 mlx4_free_cmd_mailbox(dev
, mailbox
);
437 mutex_unlock(&priv
->mcg_table
.mutex
);
441 list_del(&pqp
->list
);
443 mlx4_free_cmd_mailbox(dev
, mailbox
);
447 mutex_unlock(&priv
->mcg_table
.mutex
);
451 static int remove_promisc_qp(struct mlx4_dev
*dev
, u8 port
,
452 enum mlx4_steer_type steer
, u32 qpn
)
454 struct mlx4_priv
*priv
= mlx4_priv(dev
);
455 struct mlx4_steer
*s_steer
;
456 struct mlx4_cmd_mailbox
*mailbox
;
457 struct mlx4_mgm
*mgm
;
458 struct mlx4_steer_index
*entry
;
459 struct mlx4_promisc_qp
*pqp
;
460 struct mlx4_promisc_qp
*dqp
;
463 bool back_to_list
= false;
467 s_steer
= &mlx4_priv(dev
)->steer
[port
- 1];
468 mutex_lock(&priv
->mcg_table
.mutex
);
470 pqp
= get_promisc_qp(dev
, 0, steer
, qpn
);
471 if (unlikely(!pqp
)) {
472 mlx4_warn(dev
, "QP %x is not promiscuous QP\n", qpn
);
478 /*remove from list of promisc qps */
479 list_del(&pqp
->list
);
481 /* set the default entry not to include the removed one */
482 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
483 if (IS_ERR(mailbox
)) {
489 memset(mgm
, 0, sizeof *mgm
);
491 list_for_each_entry(dqp
, &s_steer
->promisc_qps
[steer
], list
)
492 mgm
->qp
[members_count
++] = cpu_to_be32(dqp
->qpn
& MGM_QPN_MASK
);
493 mgm
->members_count
= cpu_to_be32(members_count
| MLX4_PROT_ETH
<< 30);
495 err
= mlx4_WRITE_PROMISC(dev
, port
, steer
, mailbox
);
499 /* remove the qp from all the steering entries*/
500 list_for_each_entry(entry
, &s_steer
->steer_entries
[steer
], list
) {
502 list_for_each_entry(dqp
, &entry
->duplicates
, list
) {
503 if (dqp
->qpn
== qpn
) {
509 /* a duplicate, no need to change the mgm,
510 * only update the duplicates list */
511 list_del(&dqp
->list
);
514 err
= mlx4_READ_ENTRY(dev
, entry
->index
, mailbox
);
517 members_count
= be32_to_cpu(mgm
->members_count
) & 0xffffff;
518 for (loc
= -1, i
= 0; i
< members_count
; ++i
)
519 if ((be32_to_cpu(mgm
->qp
[i
]) & MGM_QPN_MASK
) == qpn
)
522 mgm
->members_count
= cpu_to_be32(--members_count
|
523 (MLX4_PROT_ETH
<< 30));
524 mgm
->qp
[loc
] = mgm
->qp
[i
- 1];
527 err
= mlx4_WRITE_ENTRY(dev
, entry
->index
, mailbox
);
535 mlx4_free_cmd_mailbox(dev
, mailbox
);
538 list_add_tail(&pqp
->list
, &s_steer
->promisc_qps
[steer
]);
542 mutex_unlock(&priv
->mcg_table
.mutex
);
547 * Caller must hold MCG table semaphore. gid and mgm parameters must
548 * be properly aligned for command interface.
550 * Returns 0 unless a firmware command error occurs.
552 * If GID is found in MGM or MGM is empty, *index = *hash, *prev = -1
553 * and *mgm holds MGM entry.
555 * if GID is found in AMGM, *index = index in AMGM, *prev = index of
556 * previous entry in hash chain and *mgm holds AMGM entry.
558 * If no AMGM exists for given gid, *index = -1, *prev = index of last
559 * entry in hash chain and *mgm holds end of hash chain.
561 static int find_entry(struct mlx4_dev
*dev
, u8 port
,
562 u8
*gid
, enum mlx4_protocol prot
,
563 struct mlx4_cmd_mailbox
*mgm_mailbox
,
564 int *prev
, int *index
)
566 struct mlx4_cmd_mailbox
*mailbox
;
567 struct mlx4_mgm
*mgm
= mgm_mailbox
->buf
;
571 u8 op_mod
= (prot
== MLX4_PROT_ETH
) ?
572 !!(dev
->caps
.flags
& MLX4_DEV_CAP_FLAG_VEP_MC_STEER
) : 0;
574 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
579 memcpy(mgid
, gid
, 16);
581 err
= mlx4_GID_HASH(dev
, mailbox
, &hash
, op_mod
);
582 mlx4_free_cmd_mailbox(dev
, mailbox
);
587 mlx4_dbg(dev
, "Hash for %pI6 is %04x\n", gid
, hash
);
593 err
= mlx4_READ_ENTRY(dev
, *index
, mgm_mailbox
);
597 if (!(be32_to_cpu(mgm
->members_count
) & 0xffffff)) {
598 if (*index
!= hash
) {
599 mlx4_err(dev
, "Found zero MGID in AMGM.\n");
605 if (!memcmp(mgm
->gid
, gid
, 16) &&
606 be32_to_cpu(mgm
->members_count
) >> 30 == prot
)
610 *index
= be32_to_cpu(mgm
->next_gid_index
) >> 6;
617 int mlx4_qp_attach_common(struct mlx4_dev
*dev
, struct mlx4_qp
*qp
, u8 gid
[16],
618 int block_mcast_loopback
, enum mlx4_protocol prot
,
619 enum mlx4_steer_type steer
)
621 struct mlx4_priv
*priv
= mlx4_priv(dev
);
622 struct mlx4_cmd_mailbox
*mailbox
;
623 struct mlx4_mgm
*mgm
;
632 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
634 return PTR_ERR(mailbox
);
637 mutex_lock(&priv
->mcg_table
.mutex
);
638 err
= find_entry(dev
, port
, gid
, prot
,
639 mailbox
, &prev
, &index
);
644 if (!(be32_to_cpu(mgm
->members_count
) & 0xffffff)) {
646 memcpy(mgm
->gid
, gid
, 16);
651 index
= mlx4_bitmap_alloc(&priv
->mcg_table
.bitmap
);
653 mlx4_err(dev
, "No AMGM entries left\n");
657 index
+= dev
->caps
.num_mgms
;
660 memset(mgm
, 0, sizeof *mgm
);
661 memcpy(mgm
->gid
, gid
, 16);
664 members_count
= be32_to_cpu(mgm
->members_count
) & 0xffffff;
665 if (members_count
== dev
->caps
.num_qp_per_mgm
) {
666 mlx4_err(dev
, "MGM at index %x is full.\n", index
);
671 for (i
= 0; i
< members_count
; ++i
)
672 if ((be32_to_cpu(mgm
->qp
[i
]) & MGM_QPN_MASK
) == qp
->qpn
) {
673 mlx4_dbg(dev
, "QP %06x already a member of MGM\n", qp
->qpn
);
678 if (block_mcast_loopback
)
679 mgm
->qp
[members_count
++] = cpu_to_be32((qp
->qpn
& MGM_QPN_MASK
) |
680 (1U << MGM_BLCK_LB_BIT
));
682 mgm
->qp
[members_count
++] = cpu_to_be32(qp
->qpn
& MGM_QPN_MASK
);
684 mgm
->members_count
= cpu_to_be32(members_count
| (u32
) prot
<< 30);
686 err
= mlx4_WRITE_ENTRY(dev
, index
, mailbox
);
693 err
= mlx4_READ_ENTRY(dev
, prev
, mailbox
);
697 mgm
->next_gid_index
= cpu_to_be32(index
<< 6);
699 err
= mlx4_WRITE_ENTRY(dev
, prev
, mailbox
);
704 if (prot
== MLX4_PROT_ETH
) {
705 /* manage the steering entry for promisc mode */
707 new_steering_entry(dev
, port
, steer
, index
, qp
->qpn
);
709 existing_steering_entry(dev
, port
, steer
,
712 if (err
&& link
&& index
!= -1) {
713 if (index
< dev
->caps
.num_mgms
)
714 mlx4_warn(dev
, "Got AMGM index %d < %d",
715 index
, dev
->caps
.num_mgms
);
717 mlx4_bitmap_free(&priv
->mcg_table
.bitmap
,
718 index
- dev
->caps
.num_mgms
);
720 mutex_unlock(&priv
->mcg_table
.mutex
);
722 mlx4_free_cmd_mailbox(dev
, mailbox
);
726 int mlx4_qp_detach_common(struct mlx4_dev
*dev
, struct mlx4_qp
*qp
, u8 gid
[16],
727 enum mlx4_protocol prot
, enum mlx4_steer_type steer
)
729 struct mlx4_priv
*priv
= mlx4_priv(dev
);
730 struct mlx4_cmd_mailbox
*mailbox
;
731 struct mlx4_mgm
*mgm
;
737 bool removed_entry
= false;
739 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
741 return PTR_ERR(mailbox
);
744 mutex_lock(&priv
->mcg_table
.mutex
);
746 err
= find_entry(dev
, port
, gid
, prot
,
747 mailbox
, &prev
, &index
);
752 mlx4_err(dev
, "MGID %pI6 not found\n", gid
);
757 /* if this pq is also a promisc qp, it shouldn't be removed */
758 if (prot
== MLX4_PROT_ETH
&&
759 check_duplicate_entry(dev
, port
, steer
, index
, qp
->qpn
))
762 members_count
= be32_to_cpu(mgm
->members_count
) & 0xffffff;
763 for (loc
= -1, i
= 0; i
< members_count
; ++i
)
764 if ((be32_to_cpu(mgm
->qp
[i
]) & MGM_QPN_MASK
) == qp
->qpn
)
768 mlx4_err(dev
, "QP %06x not found in MGM\n", qp
->qpn
);
774 mgm
->members_count
= cpu_to_be32(--members_count
| (u32
) prot
<< 30);
775 mgm
->qp
[loc
] = mgm
->qp
[i
- 1];
778 if (prot
== MLX4_PROT_ETH
)
779 removed_entry
= can_remove_steering_entry(dev
, port
, steer
,
781 if (i
!= 1 && (prot
!= MLX4_PROT_ETH
|| !removed_entry
)) {
782 err
= mlx4_WRITE_ENTRY(dev
, index
, mailbox
);
786 /* We are going to delete the entry, members count should be 0 */
787 mgm
->members_count
= cpu_to_be32((u32
) prot
<< 30);
790 /* Remove entry from MGM */
791 int amgm_index
= be32_to_cpu(mgm
->next_gid_index
) >> 6;
793 err
= mlx4_READ_ENTRY(dev
, amgm_index
, mailbox
);
797 memset(mgm
->gid
, 0, 16);
799 err
= mlx4_WRITE_ENTRY(dev
, index
, mailbox
);
804 if (amgm_index
< dev
->caps
.num_mgms
)
805 mlx4_warn(dev
, "MGM entry %d had AMGM index %d < %d",
806 index
, amgm_index
, dev
->caps
.num_mgms
);
808 mlx4_bitmap_free(&priv
->mcg_table
.bitmap
,
809 amgm_index
- dev
->caps
.num_mgms
);
812 /* Remove entry from AMGM */
813 int cur_next_index
= be32_to_cpu(mgm
->next_gid_index
) >> 6;
814 err
= mlx4_READ_ENTRY(dev
, prev
, mailbox
);
818 mgm
->next_gid_index
= cpu_to_be32(cur_next_index
<< 6);
820 err
= mlx4_WRITE_ENTRY(dev
, prev
, mailbox
);
824 if (index
< dev
->caps
.num_mgms
)
825 mlx4_warn(dev
, "entry %d had next AMGM index %d < %d",
826 prev
, index
, dev
->caps
.num_mgms
);
828 mlx4_bitmap_free(&priv
->mcg_table
.bitmap
,
829 index
- dev
->caps
.num_mgms
);
833 mutex_unlock(&priv
->mcg_table
.mutex
);
835 mlx4_free_cmd_mailbox(dev
, mailbox
);
839 static int mlx4_QP_ATTACH(struct mlx4_dev
*dev
, struct mlx4_qp
*qp
,
840 u8 gid
[16], u8 attach
, u8 block_loopback
,
841 enum mlx4_protocol prot
)
843 struct mlx4_cmd_mailbox
*mailbox
;
847 if (!mlx4_is_mfunc(dev
))
850 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
852 return PTR_ERR(mailbox
);
854 memcpy(mailbox
->buf
, gid
, 16);
857 if (attach
&& block_loopback
)
860 err
= mlx4_cmd(dev
, mailbox
->dma
, qpn
, attach
,
861 MLX4_CMD_QP_ATTACH
, MLX4_CMD_TIME_CLASS_A
,
864 mlx4_free_cmd_mailbox(dev
, mailbox
);
868 int mlx4_multicast_attach(struct mlx4_dev
*dev
, struct mlx4_qp
*qp
, u8 gid
[16],
869 int block_mcast_loopback
, enum mlx4_protocol prot
)
872 switch (dev
->caps
.steering_mode
) {
873 case MLX4_STEERING_MODE_A0
:
874 if (prot
== MLX4_PROT_ETH
)
877 case MLX4_STEERING_MODE_B0
:
878 if (prot
== MLX4_PROT_ETH
)
879 gid
[7] |= (MLX4_MC_STEER
<< 1);
881 if (mlx4_is_mfunc(dev
))
882 return mlx4_QP_ATTACH(dev
, qp
, gid
, 1,
883 block_mcast_loopback
, prot
);
884 return mlx4_qp_attach_common(dev
, qp
, gid
,
885 block_mcast_loopback
, prot
,
892 EXPORT_SYMBOL_GPL(mlx4_multicast_attach
);
894 int mlx4_multicast_detach(struct mlx4_dev
*dev
, struct mlx4_qp
*qp
, u8 gid
[16],
895 enum mlx4_protocol prot
)
897 switch (dev
->caps
.steering_mode
) {
898 case MLX4_STEERING_MODE_A0
:
899 if (prot
== MLX4_PROT_ETH
)
902 case MLX4_STEERING_MODE_B0
:
903 if (prot
== MLX4_PROT_ETH
)
904 gid
[7] |= (MLX4_MC_STEER
<< 1);
906 if (mlx4_is_mfunc(dev
))
907 return mlx4_QP_ATTACH(dev
, qp
, gid
, 0, 0, prot
);
909 return mlx4_qp_detach_common(dev
, qp
, gid
, prot
,
916 EXPORT_SYMBOL_GPL(mlx4_multicast_detach
);
918 int mlx4_unicast_attach(struct mlx4_dev
*dev
,
919 struct mlx4_qp
*qp
, u8 gid
[16],
920 int block_mcast_loopback
, enum mlx4_protocol prot
)
922 if (prot
== MLX4_PROT_ETH
)
923 gid
[7] |= (MLX4_UC_STEER
<< 1);
925 if (mlx4_is_mfunc(dev
))
926 return mlx4_QP_ATTACH(dev
, qp
, gid
, 1,
927 block_mcast_loopback
, prot
);
929 return mlx4_qp_attach_common(dev
, qp
, gid
, block_mcast_loopback
,
930 prot
, MLX4_UC_STEER
);
932 EXPORT_SYMBOL_GPL(mlx4_unicast_attach
);
934 int mlx4_unicast_detach(struct mlx4_dev
*dev
, struct mlx4_qp
*qp
,
935 u8 gid
[16], enum mlx4_protocol prot
)
937 if (prot
== MLX4_PROT_ETH
)
938 gid
[7] |= (MLX4_UC_STEER
<< 1);
940 if (mlx4_is_mfunc(dev
))
941 return mlx4_QP_ATTACH(dev
, qp
, gid
, 0, 0, prot
);
943 return mlx4_qp_detach_common(dev
, qp
, gid
, prot
, MLX4_UC_STEER
);
945 EXPORT_SYMBOL_GPL(mlx4_unicast_detach
);
947 int mlx4_PROMISC_wrapper(struct mlx4_dev
*dev
, int slave
,
948 struct mlx4_vhcr
*vhcr
,
949 struct mlx4_cmd_mailbox
*inbox
,
950 struct mlx4_cmd_mailbox
*outbox
,
951 struct mlx4_cmd_info
*cmd
)
953 u32 qpn
= (u32
) vhcr
->in_param
& 0xffffffff;
954 u8 port
= vhcr
->in_param
>> 62;
955 enum mlx4_steer_type steer
= vhcr
->in_modifier
;
957 /* Promiscuous unicast is not allowed in mfunc */
958 if (mlx4_is_mfunc(dev
) && steer
== MLX4_UC_STEER
)
961 if (vhcr
->op_modifier
)
962 return add_promisc_qp(dev
, port
, steer
, qpn
);
964 return remove_promisc_qp(dev
, port
, steer
, qpn
);
967 static int mlx4_PROMISC(struct mlx4_dev
*dev
, u32 qpn
,
968 enum mlx4_steer_type steer
, u8 add
, u8 port
)
970 return mlx4_cmd(dev
, (u64
) qpn
| (u64
) port
<< 62, (u32
) steer
, add
,
971 MLX4_CMD_PROMISC
, MLX4_CMD_TIME_CLASS_A
,
975 int mlx4_multicast_promisc_add(struct mlx4_dev
*dev
, u32 qpn
, u8 port
)
977 if (mlx4_is_mfunc(dev
))
978 return mlx4_PROMISC(dev
, qpn
, MLX4_MC_STEER
, 1, port
);
980 return add_promisc_qp(dev
, port
, MLX4_MC_STEER
, qpn
);
982 EXPORT_SYMBOL_GPL(mlx4_multicast_promisc_add
);
984 int mlx4_multicast_promisc_remove(struct mlx4_dev
*dev
, u32 qpn
, u8 port
)
986 if (mlx4_is_mfunc(dev
))
987 return mlx4_PROMISC(dev
, qpn
, MLX4_MC_STEER
, 0, port
);
989 return remove_promisc_qp(dev
, port
, MLX4_MC_STEER
, qpn
);
991 EXPORT_SYMBOL_GPL(mlx4_multicast_promisc_remove
);
993 int mlx4_unicast_promisc_add(struct mlx4_dev
*dev
, u32 qpn
, u8 port
)
995 if (mlx4_is_mfunc(dev
))
996 return mlx4_PROMISC(dev
, qpn
, MLX4_UC_STEER
, 1, port
);
998 return add_promisc_qp(dev
, port
, MLX4_UC_STEER
, qpn
);
1000 EXPORT_SYMBOL_GPL(mlx4_unicast_promisc_add
);
1002 int mlx4_unicast_promisc_remove(struct mlx4_dev
*dev
, u32 qpn
, u8 port
)
1004 if (mlx4_is_mfunc(dev
))
1005 return mlx4_PROMISC(dev
, qpn
, MLX4_UC_STEER
, 0, port
);
1007 return remove_promisc_qp(dev
, port
, MLX4_UC_STEER
, qpn
);
1009 EXPORT_SYMBOL_GPL(mlx4_unicast_promisc_remove
);
1011 int mlx4_init_mcg_table(struct mlx4_dev
*dev
)
1013 struct mlx4_priv
*priv
= mlx4_priv(dev
);
1016 err
= mlx4_bitmap_init(&priv
->mcg_table
.bitmap
, dev
->caps
.num_amgms
,
1017 dev
->caps
.num_amgms
- 1, 0, 0);
1021 mutex_init(&priv
->mcg_table
.mutex
);
1026 void mlx4_cleanup_mcg_table(struct mlx4_dev
*dev
)
1028 mlx4_bitmap_cleanup(&mlx4_priv(dev
)->mcg_table
.bitmap
);