1 /*
2 * Copyright (c) 2006, 2007 Cisco Systems, Inc. All rights reserved.
3 * Copyright (c) 2007, 2008 Mellanox Technologies. All rights reserved.
4 *
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:
10 *
11 * Redistribution and use in source and binary forms, with or
12 * without modification, are permitted provided that the following
13 * conditions are met:
14 *
15 * - Redistributions of source code must retain the above
16 * copyright notice, this list of conditions and the following
17 * disclaimer.
18 *
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.
23 *
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
31 * SOFTWARE.
32 */
33
34 #include <linux/string.h>
35 #include <linux/etherdevice.h>
36
37 #include <linux/mlx4/cmd.h>
38
39 #include "mlx4.h"
40
41 #define MGM_QPN_MASK 0x00FFFFFF
42 #define MGM_BLCK_LB_BIT 30
43
44 static const u8 zero_gid[16]; /* automatically initialized to 0 */
45
mlx4_READ_ENTRY(struct mlx4_dev * dev,int index,struct mlx4_cmd_mailbox * mailbox)46 static int mlx4_READ_ENTRY(struct mlx4_dev *dev, int index,
47 struct mlx4_cmd_mailbox *mailbox)
48 {
49 return mlx4_cmd_box(dev, 0, mailbox->dma, index, 0, MLX4_CMD_READ_MCG,
50 MLX4_CMD_TIME_CLASS_A);
51 }
52
mlx4_WRITE_ENTRY(struct mlx4_dev * dev,int index,struct mlx4_cmd_mailbox * mailbox)53 static int mlx4_WRITE_ENTRY(struct mlx4_dev *dev, int index,
54 struct mlx4_cmd_mailbox *mailbox)
55 {
56 return mlx4_cmd(dev, mailbox->dma, index, 0, MLX4_CMD_WRITE_MCG,
57 MLX4_CMD_TIME_CLASS_A);
58 }
59
mlx4_WRITE_PROMISC(struct mlx4_dev * dev,u8 vep_num,u8 port,u8 steer,struct mlx4_cmd_mailbox * mailbox)60 static int mlx4_WRITE_PROMISC(struct mlx4_dev *dev, u8 vep_num, u8 port, u8 steer,
61 struct mlx4_cmd_mailbox *mailbox)
62 {
63 u32 in_mod;
64
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);
68 }
69
mlx4_GID_HASH(struct mlx4_dev * dev,struct mlx4_cmd_mailbox * mailbox,u16 * hash,u8 op_mod)70 static int mlx4_GID_HASH(struct mlx4_dev *dev, struct mlx4_cmd_mailbox *mailbox,
71 u16 *hash, u8 op_mod)
72 {
73 u64 imm;
74 int err;
75
76 err = mlx4_cmd_imm(dev, mailbox->dma, &imm, 0, op_mod,
77 MLX4_CMD_MGID_HASH, MLX4_CMD_TIME_CLASS_A);
78
79 if (!err)
80 *hash = imm;
81
82 return err;
83 }
84
get_promisc_qp(struct mlx4_dev * dev,u8 pf_num,enum mlx4_steer_type steer,u32 qpn)85 static struct mlx4_promisc_qp *get_promisc_qp(struct mlx4_dev *dev, u8 pf_num,
86 enum mlx4_steer_type steer,
87 u32 qpn)
88 {
89 struct mlx4_steer *s_steer = &mlx4_priv(dev)->steer[pf_num];
90 struct mlx4_promisc_qp *pqp;
91
92 list_for_each_entry(pqp, &s_steer->promisc_qps[steer], list) {
93 if (pqp->qpn == qpn)
94 return pqp;
95 }
96 /* not found */
97 return NULL;
98 }
99
100 /*
101 * Add new entry to steering data structure.
102 * All promisc QPs should be added as well
103 */
new_steering_entry(struct mlx4_dev * dev,u8 vep_num,u8 port,enum mlx4_steer_type steer,unsigned int index,u32 qpn)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)
107 {
108 struct mlx4_steer *s_steer;
109 struct mlx4_cmd_mailbox *mailbox;
110 struct mlx4_mgm *mgm;
111 u32 members_count;
112 struct mlx4_steer_index *new_entry;
113 struct mlx4_promisc_qp *pqp;
114 struct mlx4_promisc_qp *dqp = NULL;
115 u32 prot;
116 int err;
117 u8 pf_num;
118
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);
122 if (!new_entry)
123 return -ENOMEM;
124
125 INIT_LIST_HEAD(&new_entry->duplicates);
126 new_entry->index = index;
127 list_add_tail(&new_entry->list, &s_steer->steer_entries[steer]);
128
129 /* If the given qpn is also a promisc qp,
130 * it should be inserted to duplicates list
131 */
132 pqp = get_promisc_qp(dev, pf_num, steer, qpn);
133 if (pqp) {
134 dqp = kmalloc(sizeof *dqp, GFP_KERNEL);
135 if (!dqp) {
136 err = -ENOMEM;
137 goto out_alloc;
138 }
139 dqp->qpn = qpn;
140 list_add_tail(&dqp->list, &new_entry->duplicates);
141 }
142
143 /* if no promisc qps for this vep, we are done */
144 if (list_empty(&s_steer->promisc_qps[steer]))
145 return 0;
146
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)) {
152 err = -ENOMEM;
153 goto out_alloc;
154 }
155 mgm = mailbox->buf;
156
157 err = mlx4_READ_ENTRY(dev, index, mailbox);
158 if (err)
159 goto out_mailbox;
160
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 */
165 if (pqp->qpn == qpn)
166 continue;
167 if (members_count == MLX4_QP_PER_MGM) {
168 /* out of space */
169 err = -ENOMEM;
170 goto out_mailbox;
171 }
172
173 /* add the qpn */
174 mgm->qp[members_count++] = cpu_to_be32(pqp->qpn & MGM_QPN_MASK);
175 }
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);
179
180 out_mailbox:
181 mlx4_free_cmd_mailbox(dev, mailbox);
182 if (!err)
183 return 0;
184 out_alloc:
185 if (dqp) {
186 list_del(&dqp->list);
187 kfree(dqp);
188 }
189 list_del(&new_entry->list);
190 kfree(new_entry);
191 return err;
192 }
193
194 /* update the data structures with existing steering entry */
existing_steering_entry(struct mlx4_dev * dev,u8 vep_num,u8 port,enum mlx4_steer_type steer,unsigned int index,u32 qpn)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)
198 {
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;
203 u8 pf_num;
204
205 pf_num = (dev->caps.num_ports == 1) ? vep_num : (vep_num << 1) | (port - 1);
206 s_steer = &mlx4_priv(dev)->steer[pf_num];
207
208 pqp = get_promisc_qp(dev, pf_num, steer, qpn);
209 if (!pqp)
210 return 0; /* nothing to do */
211
212 list_for_each_entry(tmp_entry, &s_steer->steer_entries[steer], list) {
213 if (tmp_entry->index == index) {
214 entry = tmp_entry;
215 break;
216 }
217 }
218 if (unlikely(!entry)) {
219 mlx4_warn(dev, "Steering entry at index %x is not registered\n", index);
220 return -EINVAL;
221 }
222
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) {
227 if (qpn == dqp->qpn)
228 return 0; /* qp is already duplicated */
229 }
230
231 /* add the qp as a duplicate on this index */
232 dqp = kmalloc(sizeof *dqp, GFP_KERNEL);
233 if (!dqp)
234 return -ENOMEM;
235 dqp->qpn = qpn;
236 list_add_tail(&dqp->list, &entry->duplicates);
237
238 return 0;
239 }
240
241 /* Check whether a qpn is a duplicate on steering entry
242 * If so, it should not be removed from mgm */
check_duplicate_entry(struct mlx4_dev * dev,u8 vep_num,u8 port,enum mlx4_steer_type steer,unsigned int index,u32 qpn)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)
246 {
247 struct mlx4_steer *s_steer;
248 struct mlx4_steer_index *tmp_entry, *entry = NULL;
249 struct mlx4_promisc_qp *dqp, *tmp_dqp;
250 u8 pf_num;
251
252 pf_num = (dev->caps.num_ports == 1) ? vep_num : (vep_num << 1) | (port - 1);
253 s_steer = &mlx4_priv(dev)->steer[pf_num];
254
255 /* if qp is not promisc, it cannot be duplicated */
256 if (!get_promisc_qp(dev, pf_num, steer, qpn))
257 return false;
258
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) {
263 entry = tmp_entry;
264 break;
265 }
266 }
267 if (unlikely(!entry)) {
268 mlx4_warn(dev, "Steering entry for index %x is not registered\n", index);
269 return false;
270 }
271 list_for_each_entry_safe(dqp, tmp_dqp, &entry->duplicates, list) {
272 if (dqp->qpn == qpn) {
273 list_del(&dqp->list);
274 kfree(dqp);
275 }
276 }
277 return true;
278 }
279
280 /* I a steering entry contains only promisc QPs, it can be removed. */
can_remove_steering_entry(struct mlx4_dev * dev,u8 vep_num,u8 port,enum mlx4_steer_type steer,unsigned int index,u32 tqpn)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)
284 {
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;
289 u32 qpn;
290 u32 members_count;
291 bool ret = false;
292 int i;
293 u8 pf_num;
294
295 pf_num = (dev->caps.num_ports == 1) ? vep_num : (vep_num << 1) | (port - 1);
296 s_steer = &mlx4_priv(dev)->steer[pf_num];
297
298 mailbox = mlx4_alloc_cmd_mailbox(dev);
299 if (IS_ERR(mailbox))
300 return false;
301 mgm = mailbox->buf;
302
303 if (mlx4_READ_ENTRY(dev, index, mailbox))
304 goto out;
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 */
310 goto out;
311 }
312 }
313 /* All the qps currently registered for this entry are promiscuous,
314 * Checking for duplicates */
315 ret = true;
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);
320 kfree(entry);
321 } else {
322 /* This entry contains duplicates so it shouldn't be removed */
323 ret = false;
324 goto out;
325 }
326 }
327 }
328
329 out:
330 mlx4_free_cmd_mailbox(dev, mailbox);
331 return ret;
332 }
333
add_promisc_qp(struct mlx4_dev * dev,u8 vep_num,u8 port,enum mlx4_steer_type steer,u32 qpn)334 static int add_promisc_qp(struct mlx4_dev *dev, u8 vep_num, u8 port,
335 enum mlx4_steer_type steer, u32 qpn)
336 {
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;
343 u32 members_count;
344 u32 prot;
345 int i;
346 bool found;
347 int last_index;
348 int err;
349 u8 pf_num;
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];
353
354 mutex_lock(&priv->mcg_table.mutex);
355
356 if (get_promisc_qp(dev, pf_num, steer, qpn)) {
357 err = 0; /* Noting to do, already exists */
358 goto out_mutex;
359 }
360
361 pqp = kmalloc(sizeof *pqp, GFP_KERNEL);
362 if (!pqp) {
363 err = -ENOMEM;
364 goto out_mutex;
365 }
366 pqp->qpn = qpn;
367
368 mailbox = mlx4_alloc_cmd_mailbox(dev);
369 if (IS_ERR(mailbox)) {
370 err = -ENOMEM;
371 goto out_alloc;
372 }
373 mgm = mailbox->buf;
374
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
377 * for this entry */
378 list_for_each_entry(entry, &s_steer->steer_entries[steer], list) {
379 err = mlx4_READ_ENTRY(dev, entry->index, mailbox);
380 if (err)
381 goto out_mailbox;
382
383 members_count = be32_to_cpu(mgm->members_count) & 0xffffff;
384 prot = be32_to_cpu(mgm->members_count) >> 30;
385 found = false;
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);
390 if (!dqp)
391 goto out_mailbox;
392 dqp->qpn = qpn;
393 list_add_tail(&dqp->list, &entry->duplicates);
394 found = true;
395 }
396 }
397 if (!found) {
398 /* Need to add the qpn to mgm */
399 if (members_count == MLX4_QP_PER_MGM) {
400 /* entry is full */
401 err = -ENOMEM;
402 goto out_mailbox;
403 }
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);
407 if (err)
408 goto out_mailbox;
409 }
410 last_index = entry->index;
411 }
412
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);
417 members_count = 0;
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);
421
422 err = mlx4_WRITE_PROMISC(dev, vep_num, port, steer, mailbox);
423 if (err)
424 goto out_list;
425
426 mlx4_free_cmd_mailbox(dev, mailbox);
427 mutex_unlock(&priv->mcg_table.mutex);
428 return 0;
429
430 out_list:
431 list_del(&pqp->list);
432 out_mailbox:
433 mlx4_free_cmd_mailbox(dev, mailbox);
434 out_alloc:
435 kfree(pqp);
436 out_mutex:
437 mutex_unlock(&priv->mcg_table.mutex);
438 return err;
439 }
440
remove_promisc_qp(struct mlx4_dev * dev,u8 vep_num,u8 port,enum mlx4_steer_type steer,u32 qpn)441 static int remove_promisc_qp(struct mlx4_dev *dev, u8 vep_num, u8 port,
442 enum mlx4_steer_type steer, u32 qpn)
443 {
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;
451 u32 members_count;
452 bool found;
453 bool back_to_list = false;
454 int loc, i;
455 int err;
456 u8 pf_num;
457
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);
461
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);
465 /* nothing to do */
466 err = 0;
467 goto out_mutex;
468 }
469
470 /*remove from list of promisc qps */
471 list_del(&pqp->list);
472
473 /* set the default entry not to include the removed one */
474 mailbox = mlx4_alloc_cmd_mailbox(dev);
475 if (IS_ERR(mailbox)) {
476 err = -ENOMEM;
477 back_to_list = true;
478 goto out_list;
479 }
480 mgm = mailbox->buf;
481 members_count = 0;
482 list_for_each_entry(dqp, &s_steer->promisc_qps[steer], list)
483 mgm->qp[members_count++] = cpu_to_be32(dqp->qpn & MGM_QPN_MASK);
484 mgm->members_count = cpu_to_be32(members_count | MLX4_PROT_ETH << 30);
485
486 err = mlx4_WRITE_PROMISC(dev, vep_num, port, steer, mailbox);
487 if (err)
488 goto out_mailbox;
489
490 /* remove the qp from all the steering entries*/
491 list_for_each_entry(entry, &s_steer->steer_entries[steer], list) {
492 found = false;
493 list_for_each_entry(dqp, &entry->duplicates, list) {
494 if (dqp->qpn == qpn) {
495 found = true;
496 break;
497 }
498 }
499 if (found) {
500 /* a duplicate, no need to change the mgm,
501 * only update the duplicates list */
502 list_del(&dqp->list);
503 kfree(dqp);
504 } else {
505 err = mlx4_READ_ENTRY(dev, entry->index, mailbox);
506 if (err)
507 goto out_mailbox;
508 members_count = be32_to_cpu(mgm->members_count) & 0xffffff;
509 for (loc = -1, i = 0; i < members_count; ++i)
510 if ((be32_to_cpu(mgm->qp[i]) & MGM_QPN_MASK) == qpn)
511 loc = i;
512
513 mgm->members_count = cpu_to_be32(--members_count |
514 (MLX4_PROT_ETH << 30));
515 mgm->qp[loc] = mgm->qp[i - 1];
516 mgm->qp[i - 1] = 0;
517
518 err = mlx4_WRITE_ENTRY(dev, entry->index, mailbox);
519 if (err)
520 goto out_mailbox;
521 }
522
523 }
524
525 out_mailbox:
526 mlx4_free_cmd_mailbox(dev, mailbox);
527 out_list:
528 if (back_to_list)
529 list_add_tail(&pqp->list, &s_steer->promisc_qps[steer]);
530 else
531 kfree(pqp);
532 out_mutex:
533 mutex_unlock(&priv->mcg_table.mutex);
534 return err;
535 }
536
537 /*
538 * Caller must hold MCG table semaphore. gid and mgm parameters must
539 * be properly aligned for command interface.
540 *
541 * Returns 0 unless a firmware command error occurs.
542 *
543 * If GID is found in MGM or MGM is empty, *index = *hash, *prev = -1
544 * and *mgm holds MGM entry.
545 *
546 * if GID is found in AMGM, *index = index in AMGM, *prev = index of
547 * previous entry in hash chain and *mgm holds AMGM entry.
548 *
549 * If no AMGM exists for given gid, *index = -1, *prev = index of last
550 * entry in hash chain and *mgm holds end of hash chain.
551 */
find_entry(struct mlx4_dev * dev,u8 port,u8 * gid,enum mlx4_protocol prot,enum mlx4_steer_type steer,struct mlx4_cmd_mailbox * mgm_mailbox,u16 * hash,int * prev,int * index)552 static int find_entry(struct mlx4_dev *dev, u8 port,
553 u8 *gid, enum mlx4_protocol prot,
554 enum mlx4_steer_type steer,
555 struct mlx4_cmd_mailbox *mgm_mailbox,
556 u16 *hash, int *prev, int *index)
557 {
558 struct mlx4_cmd_mailbox *mailbox;
559 struct mlx4_mgm *mgm = mgm_mailbox->buf;
560 u8 *mgid;
561 int err;
562 u8 op_mod = (prot == MLX4_PROT_ETH) ? !!(dev->caps.vep_mc_steering) : 0;
563
564 mailbox = mlx4_alloc_cmd_mailbox(dev);
565 if (IS_ERR(mailbox))
566 return -ENOMEM;
567 mgid = mailbox->buf;
568
569 memcpy(mgid, gid, 16);
570
571 err = mlx4_GID_HASH(dev, mailbox, hash, op_mod);
572 mlx4_free_cmd_mailbox(dev, mailbox);
573 if (err)
574 return err;
575
576 if (0)
577 mlx4_dbg(dev, "Hash for %pI6 is %04x\n", gid, *hash);
578
579 *index = *hash;
580 *prev = -1;
581
582 do {
583 err = mlx4_READ_ENTRY(dev, *index, mgm_mailbox);
584 if (err)
585 return err;
586
587 if (!(be32_to_cpu(mgm->members_count) & 0xffffff)) {
588 if (*index != *hash) {
589 mlx4_err(dev, "Found zero MGID in AMGM.\n");
590 err = -EINVAL;
591 }
592 return err;
593 }
594
595 if (!memcmp(mgm->gid, gid, 16) &&
596 be32_to_cpu(mgm->members_count) >> 30 == prot)
597 return err;
598
599 *prev = *index;
600 *index = be32_to_cpu(mgm->next_gid_index) >> 6;
601 } while (*index);
602
603 *index = -1;
604 return err;
605 }
606
mlx4_qp_attach_common(struct mlx4_dev * dev,struct mlx4_qp * qp,u8 gid[16],int block_mcast_loopback,enum mlx4_protocol prot,enum mlx4_steer_type steer)607 int mlx4_qp_attach_common(struct mlx4_dev *dev, struct mlx4_qp *qp, u8 gid[16],
608 int block_mcast_loopback, enum mlx4_protocol prot,
609 enum mlx4_steer_type steer)
610 {
611 struct mlx4_priv *priv = mlx4_priv(dev);
612 struct mlx4_cmd_mailbox *mailbox;
613 struct mlx4_mgm *mgm;
614 u32 members_count;
615 u16 hash;
616 int index, prev;
617 int link = 0;
618 int i;
619 int err;
620 u8 port = gid[5];
621 u8 new_entry = 0;
622
623 mailbox = mlx4_alloc_cmd_mailbox(dev);
624 if (IS_ERR(mailbox))
625 return PTR_ERR(mailbox);
626 mgm = mailbox->buf;
627
628 mutex_lock(&priv->mcg_table.mutex);
629 err = find_entry(dev, port, gid, prot, steer,
630 mailbox, &hash, &prev, &index);
631 if (err)
632 goto out;
633
634 if (index != -1) {
635 if (!(be32_to_cpu(mgm->members_count) & 0xffffff)) {
636 new_entry = 1;
637 memcpy(mgm->gid, gid, 16);
638 }
639 } else {
640 link = 1;
641
642 index = mlx4_bitmap_alloc(&priv->mcg_table.bitmap);
643 if (index == -1) {
644 mlx4_err(dev, "No AMGM entries left\n");
645 err = -ENOMEM;
646 goto out;
647 }
648 index += dev->caps.num_mgms;
649
650 memset(mgm, 0, sizeof *mgm);
651 memcpy(mgm->gid, gid, 16);
652 }
653
654 members_count = be32_to_cpu(mgm->members_count) & 0xffffff;
655 if (members_count == MLX4_QP_PER_MGM) {
656 mlx4_err(dev, "MGM at index %x is full.\n", index);
657 err = -ENOMEM;
658 goto out;
659 }
660
661 for (i = 0; i < members_count; ++i)
662 if ((be32_to_cpu(mgm->qp[i]) & MGM_QPN_MASK) == qp->qpn) {
663 mlx4_dbg(dev, "QP %06x already a member of MGM\n", qp->qpn);
664 err = 0;
665 goto out;
666 }
667
668 if (block_mcast_loopback)
669 mgm->qp[members_count++] = cpu_to_be32((qp->qpn & MGM_QPN_MASK) |
670 (1U << MGM_BLCK_LB_BIT));
671 else
672 mgm->qp[members_count++] = cpu_to_be32(qp->qpn & MGM_QPN_MASK);
673
674 mgm->members_count = cpu_to_be32(members_count | (u32) prot << 30);
675
676 err = mlx4_WRITE_ENTRY(dev, index, mailbox);
677 if (err)
678 goto out;
679
680 if (!link)
681 goto out;
682
683 err = mlx4_READ_ENTRY(dev, prev, mailbox);
684 if (err)
685 goto out;
686
687 mgm->next_gid_index = cpu_to_be32(index << 6);
688
689 err = mlx4_WRITE_ENTRY(dev, prev, mailbox);
690 if (err)
691 goto out;
692
693 out:
694 if (prot == MLX4_PROT_ETH) {
695 /* manage the steering entry for promisc mode */
696 if (new_entry)
697 new_steering_entry(dev, 0, port, steer, index, qp->qpn);
698 else
699 existing_steering_entry(dev, 0, port, steer,
700 index, qp->qpn);
701 }
702 if (err && link && index != -1) {
703 if (index < dev->caps.num_mgms)
704 mlx4_warn(dev, "Got AMGM index %d < %d",
705 index, dev->caps.num_mgms);
706 else
707 mlx4_bitmap_free(&priv->mcg_table.bitmap,
708 index - dev->caps.num_mgms);
709 }
710 mutex_unlock(&priv->mcg_table.mutex);
711
712 mlx4_free_cmd_mailbox(dev, mailbox);
713 return err;
714 }
715
mlx4_qp_detach_common(struct mlx4_dev * dev,struct mlx4_qp * qp,u8 gid[16],enum mlx4_protocol prot,enum mlx4_steer_type steer)716 int mlx4_qp_detach_common(struct mlx4_dev *dev, struct mlx4_qp *qp, u8 gid[16],
717 enum mlx4_protocol prot, enum mlx4_steer_type steer)
718 {
719 struct mlx4_priv *priv = mlx4_priv(dev);
720 struct mlx4_cmd_mailbox *mailbox;
721 struct mlx4_mgm *mgm;
722 u32 members_count;
723 u16 hash;
724 int prev, index;
725 int i, loc;
726 int err;
727 u8 port = gid[5];
728 bool removed_entry = false;
729
730 mailbox = mlx4_alloc_cmd_mailbox(dev);
731 if (IS_ERR(mailbox))
732 return PTR_ERR(mailbox);
733 mgm = mailbox->buf;
734
735 mutex_lock(&priv->mcg_table.mutex);
736
737 err = find_entry(dev, port, gid, prot, steer,
738 mailbox, &hash, &prev, &index);
739 if (err)
740 goto out;
741
742 if (index == -1) {
743 mlx4_err(dev, "MGID %pI6 not found\n", gid);
744 err = -EINVAL;
745 goto out;
746 }
747
748 /* if this pq is also a promisc qp, it shouldn't be removed */
749 if (prot == MLX4_PROT_ETH &&
750 check_duplicate_entry(dev, 0, port, steer, index, qp->qpn))
751 goto out;
752
753 members_count = be32_to_cpu(mgm->members_count) & 0xffffff;
754 for (loc = -1, i = 0; i < members_count; ++i)
755 if ((be32_to_cpu(mgm->qp[i]) & MGM_QPN_MASK) == qp->qpn)
756 loc = i;
757
758 if (loc == -1) {
759 mlx4_err(dev, "QP %06x not found in MGM\n", qp->qpn);
760 err = -EINVAL;
761 goto out;
762 }
763
764
765 mgm->members_count = cpu_to_be32(--members_count | (u32) prot << 30);
766 mgm->qp[loc] = mgm->qp[i - 1];
767 mgm->qp[i - 1] = 0;
768
769 if (prot == MLX4_PROT_ETH)
770 removed_entry = can_remove_steering_entry(dev, 0, port, steer, index, qp->qpn);
771 if (i != 1 && (prot != MLX4_PROT_ETH || !removed_entry)) {
772 err = mlx4_WRITE_ENTRY(dev, index, mailbox);
773 goto out;
774 }
775
776 /* We are going to delete the entry, members count should be 0 */
777 mgm->members_count = cpu_to_be32((u32) prot << 30);
778
779 if (prev == -1) {
780 /* Remove entry from MGM */
781 int amgm_index = be32_to_cpu(mgm->next_gid_index) >> 6;
782 if (amgm_index) {
783 err = mlx4_READ_ENTRY(dev, amgm_index, mailbox);
784 if (err)
785 goto out;
786 } else
787 memset(mgm->gid, 0, 16);
788
789 err = mlx4_WRITE_ENTRY(dev, index, mailbox);
790 if (err)
791 goto out;
792
793 if (amgm_index) {
794 if (amgm_index < dev->caps.num_mgms)
795 mlx4_warn(dev, "MGM entry %d had AMGM index %d < %d",
796 index, amgm_index, dev->caps.num_mgms);
797 else
798 mlx4_bitmap_free(&priv->mcg_table.bitmap,
799 amgm_index - dev->caps.num_mgms);
800 }
801 } else {
802 /* Remove entry from AMGM */
803 int cur_next_index = be32_to_cpu(mgm->next_gid_index) >> 6;
804 err = mlx4_READ_ENTRY(dev, prev, mailbox);
805 if (err)
806 goto out;
807
808 mgm->next_gid_index = cpu_to_be32(cur_next_index << 6);
809
810 err = mlx4_WRITE_ENTRY(dev, prev, mailbox);
811 if (err)
812 goto out;
813
814 if (index < dev->caps.num_mgms)
815 mlx4_warn(dev, "entry %d had next AMGM index %d < %d",
816 prev, index, dev->caps.num_mgms);
817 else
818 mlx4_bitmap_free(&priv->mcg_table.bitmap,
819 index - dev->caps.num_mgms);
820 }
821
822 out:
823 mutex_unlock(&priv->mcg_table.mutex);
824
825 mlx4_free_cmd_mailbox(dev, mailbox);
826 return err;
827 }
828
829
mlx4_multicast_attach(struct mlx4_dev * dev,struct mlx4_qp * qp,u8 gid[16],int block_mcast_loopback,enum mlx4_protocol prot)830 int mlx4_multicast_attach(struct mlx4_dev *dev, struct mlx4_qp *qp, u8 gid[16],
831 int block_mcast_loopback, enum mlx4_protocol prot)
832 {
833 enum mlx4_steer_type steer;
834
835 steer = (is_valid_ether_addr(&gid[10])) ? MLX4_UC_STEER : MLX4_MC_STEER;
836
837 if (prot == MLX4_PROT_ETH && !dev->caps.vep_mc_steering)
838 return 0;
839
840 if (prot == MLX4_PROT_ETH)
841 gid[7] |= (steer << 1);
842
843 return mlx4_qp_attach_common(dev, qp, gid,
844 block_mcast_loopback, prot,
845 steer);
846 }
847 EXPORT_SYMBOL_GPL(mlx4_multicast_attach);
848
mlx4_multicast_detach(struct mlx4_dev * dev,struct mlx4_qp * qp,u8 gid[16],enum mlx4_protocol prot)849 int mlx4_multicast_detach(struct mlx4_dev *dev, struct mlx4_qp *qp, u8 gid[16],
850 enum mlx4_protocol prot)
851 {
852 enum mlx4_steer_type steer;
853
854 steer = (is_valid_ether_addr(&gid[10])) ? MLX4_UC_STEER : MLX4_MC_STEER;
855
856 if (prot == MLX4_PROT_ETH && !dev->caps.vep_mc_steering)
857 return 0;
858
859 if (prot == MLX4_PROT_ETH) {
860 gid[7] |= (steer << 1);
861 }
862
863 return mlx4_qp_detach_common(dev, qp, gid, prot, steer);
864 }
865 EXPORT_SYMBOL_GPL(mlx4_multicast_detach);
866
867
mlx4_multicast_promisc_add(struct mlx4_dev * dev,u32 qpn,u8 port)868 int mlx4_multicast_promisc_add(struct mlx4_dev *dev, u32 qpn, u8 port)
869 {
870 if (!dev->caps.vep_mc_steering)
871 return 0;
872
873
874 return add_promisc_qp(dev, 0, port, MLX4_MC_STEER, qpn);
875 }
876 EXPORT_SYMBOL_GPL(mlx4_multicast_promisc_add);
877
mlx4_multicast_promisc_remove(struct mlx4_dev * dev,u32 qpn,u8 port)878 int mlx4_multicast_promisc_remove(struct mlx4_dev *dev, u32 qpn, u8 port)
879 {
880 if (!dev->caps.vep_mc_steering)
881 return 0;
882
883
884 return remove_promisc_qp(dev, 0, port, MLX4_MC_STEER, qpn);
885 }
886 EXPORT_SYMBOL_GPL(mlx4_multicast_promisc_remove);
887
mlx4_unicast_promisc_add(struct mlx4_dev * dev,u32 qpn,u8 port)888 int mlx4_unicast_promisc_add(struct mlx4_dev *dev, u32 qpn, u8 port)
889 {
890 if (!dev->caps.vep_mc_steering)
891 return 0;
892
893
894 return add_promisc_qp(dev, 0, port, MLX4_UC_STEER, qpn);
895 }
896 EXPORT_SYMBOL_GPL(mlx4_unicast_promisc_add);
897
mlx4_unicast_promisc_remove(struct mlx4_dev * dev,u32 qpn,u8 port)898 int mlx4_unicast_promisc_remove(struct mlx4_dev *dev, u32 qpn, u8 port)
899 {
900 if (!dev->caps.vep_mc_steering)
901 return 0;
902
903 return remove_promisc_qp(dev, 0, port, MLX4_UC_STEER, qpn);
904 }
905 EXPORT_SYMBOL_GPL(mlx4_unicast_promisc_remove);
906
mlx4_init_mcg_table(struct mlx4_dev * dev)907 int mlx4_init_mcg_table(struct mlx4_dev *dev)
908 {
909 struct mlx4_priv *priv = mlx4_priv(dev);
910 int err;
911
912 err = mlx4_bitmap_init(&priv->mcg_table.bitmap, dev->caps.num_amgms,
913 dev->caps.num_amgms - 1, 0, 0);
914 if (err)
915 return err;
916
917 mutex_init(&priv->mcg_table.mutex);
918
919 return 0;
920 }
921
mlx4_cleanup_mcg_table(struct mlx4_dev * dev)922 void mlx4_cleanup_mcg_table(struct mlx4_dev *dev)
923 {
924 mlx4_bitmap_cleanup(&mlx4_priv(dev)->mcg_table.bitmap);
925 }
926