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>
36 #include <linux/mlx4/cmd.h>
40 #define MGM_QPN_MASK 0x00FFFFFF
41 #define MGM_BLCK_LB_BIT 30
44 __be32 next_gid_index
;
48 __be32 qp
[MLX4_QP_PER_MGM
];
51 static const u8 zero_gid
[16]; /* automatically initialized to 0 */
53 static int mlx4_READ_MCG(struct mlx4_dev
*dev
, int index
,
54 struct mlx4_cmd_mailbox
*mailbox
)
56 return mlx4_cmd_box(dev
, 0, mailbox
->dma
, index
, 0, MLX4_CMD_READ_MCG
,
57 MLX4_CMD_TIME_CLASS_A
);
60 static int mlx4_WRITE_MCG(struct mlx4_dev
*dev
, int index
,
61 struct mlx4_cmd_mailbox
*mailbox
)
63 return mlx4_cmd(dev
, mailbox
->dma
, index
, 0, MLX4_CMD_WRITE_MCG
,
64 MLX4_CMD_TIME_CLASS_A
);
67 static int mlx4_MGID_HASH(struct mlx4_dev
*dev
, struct mlx4_cmd_mailbox
*mailbox
,
73 err
= mlx4_cmd_imm(dev
, mailbox
->dma
, &imm
, 0, 0, MLX4_CMD_MGID_HASH
,
74 MLX4_CMD_TIME_CLASS_A
);
83 * Caller must hold MCG table semaphore. gid and mgm parameters must
84 * be properly aligned for command interface.
86 * Returns 0 unless a firmware command error occurs.
88 * If GID is found in MGM or MGM is empty, *index = *hash, *prev = -1
89 * and *mgm holds MGM entry.
91 * if GID is found in AMGM, *index = index in AMGM, *prev = index of
92 * previous entry in hash chain and *mgm holds AMGM entry.
94 * If no AMGM exists for given gid, *index = -1, *prev = index of last
95 * entry in hash chain and *mgm holds end of hash chain.
97 static int find_mgm(struct mlx4_dev
*dev
,
98 u8
*gid
, struct mlx4_cmd_mailbox
*mgm_mailbox
,
99 u16
*hash
, int *prev
, int *index
)
101 struct mlx4_cmd_mailbox
*mailbox
;
102 struct mlx4_mgm
*mgm
= mgm_mailbox
->buf
;
106 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
111 memcpy(mgid
, gid
, 16);
113 err
= mlx4_MGID_HASH(dev
, mailbox
, hash
);
114 mlx4_free_cmd_mailbox(dev
, mailbox
);
119 mlx4_dbg(dev
, "Hash for %pI6 is %04x\n", gid
, *hash
);
125 err
= mlx4_READ_MCG(dev
, *index
, mgm_mailbox
);
129 if (!memcmp(mgm
->gid
, zero_gid
, 16)) {
130 if (*index
!= *hash
) {
131 mlx4_err(dev
, "Found zero MGID in AMGM.\n");
137 if (!memcmp(mgm
->gid
, gid
, 16))
141 *index
= be32_to_cpu(mgm
->next_gid_index
) >> 6;
148 int mlx4_multicast_attach(struct mlx4_dev
*dev
, struct mlx4_qp
*qp
, u8 gid
[16],
149 int block_mcast_loopback
)
151 struct mlx4_priv
*priv
= mlx4_priv(dev
);
152 struct mlx4_cmd_mailbox
*mailbox
;
153 struct mlx4_mgm
*mgm
;
161 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
163 return PTR_ERR(mailbox
);
166 mutex_lock(&priv
->mcg_table
.mutex
);
168 err
= find_mgm(dev
, gid
, mailbox
, &hash
, &prev
, &index
);
173 if (!memcmp(mgm
->gid
, zero_gid
, 16))
174 memcpy(mgm
->gid
, gid
, 16);
178 index
= mlx4_bitmap_alloc(&priv
->mcg_table
.bitmap
);
180 mlx4_err(dev
, "No AMGM entries left\n");
184 index
+= dev
->caps
.num_mgms
;
186 memset(mgm
, 0, sizeof *mgm
);
187 memcpy(mgm
->gid
, gid
, 16);
190 members_count
= be32_to_cpu(mgm
->members_count
);
191 if (members_count
== MLX4_QP_PER_MGM
) {
192 mlx4_err(dev
, "MGM at index %x is full.\n", index
);
197 for (i
= 0; i
< members_count
; ++i
)
198 if ((be32_to_cpu(mgm
->qp
[i
]) & MGM_QPN_MASK
) == qp
->qpn
) {
199 mlx4_dbg(dev
, "QP %06x already a member of MGM\n", qp
->qpn
);
204 if (block_mcast_loopback
)
205 mgm
->qp
[members_count
++] = cpu_to_be32((qp
->qpn
& MGM_QPN_MASK
) |
206 (1U << MGM_BLCK_LB_BIT
));
208 mgm
->qp
[members_count
++] = cpu_to_be32(qp
->qpn
& MGM_QPN_MASK
);
210 mgm
->members_count
= cpu_to_be32(members_count
);
212 err
= mlx4_WRITE_MCG(dev
, index
, mailbox
);
219 err
= mlx4_READ_MCG(dev
, prev
, mailbox
);
223 mgm
->next_gid_index
= cpu_to_be32(index
<< 6);
225 err
= mlx4_WRITE_MCG(dev
, prev
, mailbox
);
230 if (err
&& link
&& index
!= -1) {
231 if (index
< dev
->caps
.num_mgms
)
232 mlx4_warn(dev
, "Got AMGM index %d < %d",
233 index
, dev
->caps
.num_mgms
);
235 mlx4_bitmap_free(&priv
->mcg_table
.bitmap
,
236 index
- dev
->caps
.num_mgms
);
238 mutex_unlock(&priv
->mcg_table
.mutex
);
240 mlx4_free_cmd_mailbox(dev
, mailbox
);
243 EXPORT_SYMBOL_GPL(mlx4_multicast_attach
);
245 int mlx4_multicast_detach(struct mlx4_dev
*dev
, struct mlx4_qp
*qp
, u8 gid
[16])
247 struct mlx4_priv
*priv
= mlx4_priv(dev
);
248 struct mlx4_cmd_mailbox
*mailbox
;
249 struct mlx4_mgm
*mgm
;
256 mailbox
= mlx4_alloc_cmd_mailbox(dev
);
258 return PTR_ERR(mailbox
);
261 mutex_lock(&priv
->mcg_table
.mutex
);
263 err
= find_mgm(dev
, gid
, mailbox
, &hash
, &prev
, &index
);
268 mlx4_err(dev
, "MGID %pI6 not found\n", gid
);
273 members_count
= be32_to_cpu(mgm
->members_count
);
274 for (loc
= -1, i
= 0; i
< members_count
; ++i
)
275 if ((be32_to_cpu(mgm
->qp
[i
]) & MGM_QPN_MASK
) == qp
->qpn
)
279 mlx4_err(dev
, "QP %06x not found in MGM\n", qp
->qpn
);
285 mgm
->members_count
= cpu_to_be32(--members_count
);
286 mgm
->qp
[loc
] = mgm
->qp
[i
- 1];
290 err
= mlx4_WRITE_MCG(dev
, index
, mailbox
);
295 /* Remove entry from MGM */
296 int amgm_index
= be32_to_cpu(mgm
->next_gid_index
) >> 6;
298 err
= mlx4_READ_MCG(dev
, amgm_index
, mailbox
);
302 memset(mgm
->gid
, 0, 16);
304 err
= mlx4_WRITE_MCG(dev
, index
, mailbox
);
309 if (amgm_index
< dev
->caps
.num_mgms
)
310 mlx4_warn(dev
, "MGM entry %d had AMGM index %d < %d",
311 index
, amgm_index
, dev
->caps
.num_mgms
);
313 mlx4_bitmap_free(&priv
->mcg_table
.bitmap
,
314 amgm_index
- dev
->caps
.num_mgms
);
317 /* Remove entry from AMGM */
318 int cur_next_index
= be32_to_cpu(mgm
->next_gid_index
) >> 6;
319 err
= mlx4_READ_MCG(dev
, prev
, mailbox
);
323 mgm
->next_gid_index
= cpu_to_be32(cur_next_index
<< 6);
325 err
= mlx4_WRITE_MCG(dev
, prev
, mailbox
);
329 if (index
< dev
->caps
.num_mgms
)
330 mlx4_warn(dev
, "entry %d had next AMGM index %d < %d",
331 prev
, index
, dev
->caps
.num_mgms
);
333 mlx4_bitmap_free(&priv
->mcg_table
.bitmap
,
334 index
- dev
->caps
.num_mgms
);
338 mutex_unlock(&priv
->mcg_table
.mutex
);
340 mlx4_free_cmd_mailbox(dev
, mailbox
);
343 EXPORT_SYMBOL_GPL(mlx4_multicast_detach
);
345 int mlx4_init_mcg_table(struct mlx4_dev
*dev
)
347 struct mlx4_priv
*priv
= mlx4_priv(dev
);
350 err
= mlx4_bitmap_init(&priv
->mcg_table
.bitmap
, dev
->caps
.num_amgms
,
351 dev
->caps
.num_amgms
- 1, 0, 0);
355 mutex_init(&priv
->mcg_table
.mutex
);
360 void mlx4_cleanup_mcg_table(struct mlx4_dev
*dev
)
362 mlx4_bitmap_cleanup(&mlx4_priv(dev
)->mcg_table
.bitmap
);
This page took 0.060718 seconds and 5 git commands to generate.