Commit | Line | Data |
---|---|---|
2a2336f8 YP |
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 | ||
36 | #include <linux/mlx4/cmd.h> | |
37 | ||
38 | #include "mlx4.h" | |
39 | ||
40 | #define MLX4_MAC_VALID (1ull << 63) | |
41 | #define MLX4_MAC_MASK 0xffffffffffffULL | |
42 | ||
43 | #define MLX4_VLAN_VALID (1u << 31) | |
44 | #define MLX4_VLAN_MASK 0xfff | |
45 | ||
46 | void mlx4_init_mac_table(struct mlx4_dev *dev, struct mlx4_mac_table *table) | |
47 | { | |
48 | int i; | |
49 | ||
50 | mutex_init(&table->mutex); | |
51 | for (i = 0; i < MLX4_MAX_MAC_NUM; i++) { | |
52 | table->entries[i] = 0; | |
53 | table->refs[i] = 0; | |
54 | } | |
55 | table->max = 1 << dev->caps.log_num_macs; | |
56 | table->total = 0; | |
57 | } | |
58 | ||
59 | void mlx4_init_vlan_table(struct mlx4_dev *dev, struct mlx4_vlan_table *table) | |
60 | { | |
61 | int i; | |
62 | ||
63 | mutex_init(&table->mutex); | |
64 | for (i = 0; i < MLX4_MAX_VLAN_NUM; i++) { | |
65 | table->entries[i] = 0; | |
66 | table->refs[i] = 0; | |
67 | } | |
e72ebf5a | 68 | table->max = (1 << dev->caps.log_num_vlans) - MLX4_VLAN_REGULAR; |
2a2336f8 YP |
69 | table->total = 0; |
70 | } | |
71 | ||
72 | static int mlx4_set_port_mac_table(struct mlx4_dev *dev, u8 port, | |
73 | __be64 *entries) | |
74 | { | |
75 | struct mlx4_cmd_mailbox *mailbox; | |
76 | u32 in_mod; | |
77 | int err; | |
78 | ||
79 | mailbox = mlx4_alloc_cmd_mailbox(dev); | |
80 | if (IS_ERR(mailbox)) | |
81 | return PTR_ERR(mailbox); | |
82 | ||
83 | memcpy(mailbox->buf, entries, MLX4_MAC_TABLE_SIZE); | |
84 | ||
85 | in_mod = MLX4_SET_PORT_MAC_TABLE << 8 | port; | |
86 | err = mlx4_cmd(dev, mailbox->dma, in_mod, 1, MLX4_CMD_SET_PORT, | |
87 | MLX4_CMD_TIME_CLASS_B); | |
88 | ||
89 | mlx4_free_cmd_mailbox(dev, mailbox); | |
90 | return err; | |
91 | } | |
92 | ||
1679200f YP |
93 | static int mlx4_uc_steer_add(struct mlx4_dev *dev, u8 port, |
94 | u64 mac, int *qpn, u8 reserve) | |
2a2336f8 | 95 | { |
1679200f YP |
96 | struct mlx4_qp qp; |
97 | u8 gid[16] = {0}; | |
98 | int err; | |
99 | ||
100 | if (reserve) { | |
101 | err = mlx4_qp_reserve_range(dev, 1, 1, qpn); | |
102 | if (err) { | |
103 | mlx4_err(dev, "Failed to reserve qp for mac registration\n"); | |
104 | return err; | |
105 | } | |
106 | } | |
107 | qp.qpn = *qpn; | |
108 | ||
109 | mac &= 0xffffffffffffULL; | |
110 | mac = cpu_to_be64(mac << 16); | |
111 | memcpy(&gid[10], &mac, ETH_ALEN); | |
112 | gid[5] = port; | |
113 | gid[7] = MLX4_UC_STEER << 1; | |
114 | ||
115 | err = mlx4_qp_attach_common(dev, &qp, gid, 0, | |
116 | MLX4_PROT_ETH, MLX4_UC_STEER); | |
117 | if (err && reserve) | |
118 | mlx4_qp_release_range(dev, *qpn, 1); | |
119 | ||
120 | return err; | |
121 | } | |
122 | ||
123 | static void mlx4_uc_steer_release(struct mlx4_dev *dev, u8 port, | |
124 | u64 mac, int qpn, u8 free) | |
125 | { | |
126 | struct mlx4_qp qp; | |
127 | u8 gid[16] = {0}; | |
128 | ||
129 | qp.qpn = qpn; | |
130 | mac &= 0xffffffffffffULL; | |
131 | mac = cpu_to_be64(mac << 16); | |
132 | memcpy(&gid[10], &mac, ETH_ALEN); | |
133 | gid[5] = port; | |
134 | gid[7] = MLX4_UC_STEER << 1; | |
135 | ||
136 | mlx4_qp_detach_common(dev, &qp, gid, MLX4_PROT_ETH, MLX4_UC_STEER); | |
137 | if (free) | |
138 | mlx4_qp_release_range(dev, qpn, 1); | |
139 | } | |
140 | ||
141 | int mlx4_register_mac(struct mlx4_dev *dev, u8 port, u64 mac, int *qpn, u8 wrap) | |
142 | { | |
143 | struct mlx4_port_info *info = &mlx4_priv(dev)->port[port]; | |
144 | struct mlx4_mac_table *table = &info->mac_table; | |
145 | struct mlx4_mac_entry *entry; | |
2a2336f8 YP |
146 | int i, err = 0; |
147 | int free = -1; | |
148 | ||
ccf86321 | 149 | if (dev->caps.flags & MLX4_DEV_CAP_FLAG_VEP_UC_STEER) { |
1679200f YP |
150 | err = mlx4_uc_steer_add(dev, port, mac, qpn, 1); |
151 | if (!err) { | |
152 | entry = kmalloc(sizeof *entry, GFP_KERNEL); | |
153 | if (!entry) { | |
154 | mlx4_uc_steer_release(dev, port, mac, *qpn, 1); | |
155 | return -ENOMEM; | |
156 | } | |
157 | entry->mac = mac; | |
158 | err = radix_tree_insert(&info->mac_tree, *qpn, entry); | |
159 | if (err) { | |
160 | mlx4_uc_steer_release(dev, port, mac, *qpn, 1); | |
161 | return err; | |
162 | } | |
163 | } else | |
164 | return err; | |
165 | } | |
2a2336f8 YP |
166 | mlx4_dbg(dev, "Registering MAC: 0x%llx\n", (unsigned long long) mac); |
167 | mutex_lock(&table->mutex); | |
168 | for (i = 0; i < MLX4_MAX_MAC_NUM - 1; i++) { | |
169 | if (free < 0 && !table->refs[i]) { | |
170 | free = i; | |
171 | continue; | |
172 | } | |
173 | ||
174 | if (mac == (MLX4_MAC_MASK & be64_to_cpu(table->entries[i]))) { | |
25985edc | 175 | /* MAC already registered, increase references count */ |
2a2336f8 YP |
176 | ++table->refs[i]; |
177 | goto out; | |
178 | } | |
179 | } | |
0926f910 EC |
180 | |
181 | if (free < 0) { | |
182 | err = -ENOMEM; | |
183 | goto out; | |
184 | } | |
185 | ||
2a2336f8 YP |
186 | mlx4_dbg(dev, "Free MAC index is %d\n", free); |
187 | ||
188 | if (table->total == table->max) { | |
189 | /* No free mac entries */ | |
190 | err = -ENOSPC; | |
191 | goto out; | |
192 | } | |
193 | ||
194 | /* Register new MAC */ | |
195 | table->refs[free] = 1; | |
196 | table->entries[free] = cpu_to_be64(mac | MLX4_MAC_VALID); | |
197 | ||
198 | err = mlx4_set_port_mac_table(dev, port, table->entries); | |
199 | if (unlikely(err)) { | |
200 | mlx4_err(dev, "Failed adding MAC: 0x%llx\n", (unsigned long long) mac); | |
201 | table->refs[free] = 0; | |
202 | table->entries[free] = 0; | |
203 | goto out; | |
204 | } | |
205 | ||
ccf86321 | 206 | if (!(dev->caps.flags & MLX4_DEV_CAP_FLAG_VEP_UC_STEER)) |
1679200f | 207 | *qpn = info->base_qpn + free; |
2a2336f8 YP |
208 | ++table->total; |
209 | out: | |
210 | mutex_unlock(&table->mutex); | |
211 | return err; | |
212 | } | |
213 | EXPORT_SYMBOL_GPL(mlx4_register_mac); | |
214 | ||
1679200f YP |
215 | static int validate_index(struct mlx4_dev *dev, |
216 | struct mlx4_mac_table *table, int index) | |
2a2336f8 | 217 | { |
1679200f | 218 | int err = 0; |
2a2336f8 | 219 | |
1679200f YP |
220 | if (index < 0 || index >= table->max || !table->entries[index]) { |
221 | mlx4_warn(dev, "No valid Mac entry for the given index\n"); | |
222 | err = -EINVAL; | |
2a2336f8 | 223 | } |
1679200f YP |
224 | return err; |
225 | } | |
226 | ||
227 | static int find_index(struct mlx4_dev *dev, | |
228 | struct mlx4_mac_table *table, u64 mac) | |
229 | { | |
230 | int i; | |
231 | for (i = 0; i < MLX4_MAX_MAC_NUM; i++) { | |
232 | if (mac == (MLX4_MAC_MASK & be64_to_cpu(table->entries[i]))) | |
233 | return i; | |
234 | } | |
235 | /* Mac not found */ | |
236 | return -EINVAL; | |
237 | } | |
238 | ||
239 | void mlx4_unregister_mac(struct mlx4_dev *dev, u8 port, int qpn) | |
240 | { | |
241 | struct mlx4_port_info *info = &mlx4_priv(dev)->port[port]; | |
242 | struct mlx4_mac_table *table = &info->mac_table; | |
243 | int index = qpn - info->base_qpn; | |
244 | struct mlx4_mac_entry *entry; | |
245 | ||
ccf86321 | 246 | if (dev->caps.flags & MLX4_DEV_CAP_FLAG_VEP_UC_STEER) { |
1679200f YP |
247 | entry = radix_tree_lookup(&info->mac_tree, qpn); |
248 | if (entry) { | |
249 | mlx4_uc_steer_release(dev, port, entry->mac, qpn, 1); | |
250 | radix_tree_delete(&info->mac_tree, qpn); | |
251 | index = find_index(dev, table, entry->mac); | |
252 | kfree(entry); | |
253 | } | |
2a2336f8 | 254 | } |
1679200f YP |
255 | |
256 | mutex_lock(&table->mutex); | |
257 | ||
258 | if (validate_index(dev, table, index)) | |
259 | goto out; | |
260 | ||
20e72a44 YP |
261 | /* Check whether this address has reference count */ |
262 | if (!(--table->refs[index])) { | |
263 | table->entries[index] = 0; | |
264 | mlx4_set_port_mac_table(dev, port, table->entries); | |
265 | --table->total; | |
266 | } | |
2a2336f8 YP |
267 | out: |
268 | mutex_unlock(&table->mutex); | |
269 | } | |
270 | EXPORT_SYMBOL_GPL(mlx4_unregister_mac); | |
271 | ||
1679200f YP |
272 | int mlx4_replace_mac(struct mlx4_dev *dev, u8 port, int qpn, u64 new_mac, u8 wrap) |
273 | { | |
274 | struct mlx4_port_info *info = &mlx4_priv(dev)->port[port]; | |
275 | struct mlx4_mac_table *table = &info->mac_table; | |
276 | int index = qpn - info->base_qpn; | |
277 | struct mlx4_mac_entry *entry; | |
278 | int err; | |
279 | ||
ccf86321 | 280 | if (dev->caps.flags & MLX4_DEV_CAP_FLAG_VEP_UC_STEER) { |
1679200f YP |
281 | entry = radix_tree_lookup(&info->mac_tree, qpn); |
282 | if (!entry) | |
283 | return -EINVAL; | |
284 | index = find_index(dev, table, entry->mac); | |
285 | mlx4_uc_steer_release(dev, port, entry->mac, qpn, 0); | |
286 | entry->mac = new_mac; | |
287 | err = mlx4_uc_steer_add(dev, port, entry->mac, &qpn, 0); | |
288 | if (err || index < 0) | |
289 | return err; | |
290 | } | |
291 | ||
292 | mutex_lock(&table->mutex); | |
293 | ||
294 | err = validate_index(dev, table, index); | |
295 | if (err) | |
296 | goto out; | |
297 | ||
298 | table->entries[index] = cpu_to_be64(new_mac | MLX4_MAC_VALID); | |
299 | ||
300 | err = mlx4_set_port_mac_table(dev, port, table->entries); | |
301 | if (unlikely(err)) { | |
302 | mlx4_err(dev, "Failed adding MAC: 0x%llx\n", (unsigned long long) new_mac); | |
303 | table->entries[index] = 0; | |
304 | } | |
305 | out: | |
306 | mutex_unlock(&table->mutex); | |
307 | return err; | |
308 | } | |
309 | EXPORT_SYMBOL_GPL(mlx4_replace_mac); | |
2a2336f8 YP |
310 | static int mlx4_set_port_vlan_table(struct mlx4_dev *dev, u8 port, |
311 | __be32 *entries) | |
312 | { | |
313 | struct mlx4_cmd_mailbox *mailbox; | |
314 | u32 in_mod; | |
315 | int err; | |
316 | ||
317 | mailbox = mlx4_alloc_cmd_mailbox(dev); | |
318 | if (IS_ERR(mailbox)) | |
319 | return PTR_ERR(mailbox); | |
320 | ||
321 | memcpy(mailbox->buf, entries, MLX4_VLAN_TABLE_SIZE); | |
322 | in_mod = MLX4_SET_PORT_VLAN_TABLE << 8 | port; | |
323 | err = mlx4_cmd(dev, mailbox->dma, in_mod, 1, MLX4_CMD_SET_PORT, | |
324 | MLX4_CMD_TIME_CLASS_B); | |
325 | ||
326 | mlx4_free_cmd_mailbox(dev, mailbox); | |
327 | ||
328 | return err; | |
329 | } | |
330 | ||
4c3eb3ca EC |
331 | int mlx4_find_cached_vlan(struct mlx4_dev *dev, u8 port, u16 vid, int *idx) |
332 | { | |
333 | struct mlx4_vlan_table *table = &mlx4_priv(dev)->port[port].vlan_table; | |
334 | int i; | |
335 | ||
336 | for (i = 0; i < MLX4_MAX_VLAN_NUM; ++i) { | |
337 | if (table->refs[i] && | |
338 | (vid == (MLX4_VLAN_MASK & | |
339 | be32_to_cpu(table->entries[i])))) { | |
340 | /* VLAN already registered, increase reference count */ | |
341 | *idx = i; | |
342 | return 0; | |
343 | } | |
344 | } | |
345 | ||
346 | return -ENOENT; | |
347 | } | |
348 | EXPORT_SYMBOL_GPL(mlx4_find_cached_vlan); | |
349 | ||
2a2336f8 YP |
350 | int mlx4_register_vlan(struct mlx4_dev *dev, u8 port, u16 vlan, int *index) |
351 | { | |
352 | struct mlx4_vlan_table *table = &mlx4_priv(dev)->port[port].vlan_table; | |
353 | int i, err = 0; | |
354 | int free = -1; | |
355 | ||
356 | mutex_lock(&table->mutex); | |
e72ebf5a YP |
357 | |
358 | if (table->total == table->max) { | |
359 | /* No free vlan entries */ | |
360 | err = -ENOSPC; | |
361 | goto out; | |
362 | } | |
363 | ||
2a2336f8 YP |
364 | for (i = MLX4_VLAN_REGULAR; i < MLX4_MAX_VLAN_NUM; i++) { |
365 | if (free < 0 && (table->refs[i] == 0)) { | |
366 | free = i; | |
367 | continue; | |
368 | } | |
369 | ||
370 | if (table->refs[i] && | |
371 | (vlan == (MLX4_VLAN_MASK & | |
372 | be32_to_cpu(table->entries[i])))) { | |
25985edc | 373 | /* Vlan already registered, increase references count */ |
2a2336f8 YP |
374 | *index = i; |
375 | ++table->refs[i]; | |
376 | goto out; | |
377 | } | |
378 | } | |
379 | ||
0926f910 EC |
380 | if (free < 0) { |
381 | err = -ENOMEM; | |
382 | goto out; | |
383 | } | |
384 | ||
2a2336f8 YP |
385 | /* Register new MAC */ |
386 | table->refs[free] = 1; | |
387 | table->entries[free] = cpu_to_be32(vlan | MLX4_VLAN_VALID); | |
388 | ||
389 | err = mlx4_set_port_vlan_table(dev, port, table->entries); | |
390 | if (unlikely(err)) { | |
391 | mlx4_warn(dev, "Failed adding vlan: %u\n", vlan); | |
392 | table->refs[free] = 0; | |
393 | table->entries[free] = 0; | |
394 | goto out; | |
395 | } | |
396 | ||
397 | *index = free; | |
398 | ++table->total; | |
399 | out: | |
400 | mutex_unlock(&table->mutex); | |
401 | return err; | |
402 | } | |
403 | EXPORT_SYMBOL_GPL(mlx4_register_vlan); | |
404 | ||
405 | void mlx4_unregister_vlan(struct mlx4_dev *dev, u8 port, int index) | |
406 | { | |
407 | struct mlx4_vlan_table *table = &mlx4_priv(dev)->port[port].vlan_table; | |
408 | ||
409 | if (index < MLX4_VLAN_REGULAR) { | |
410 | mlx4_warn(dev, "Trying to free special vlan index %d\n", index); | |
411 | return; | |
412 | } | |
413 | ||
414 | mutex_lock(&table->mutex); | |
415 | if (!table->refs[index]) { | |
416 | mlx4_warn(dev, "No vlan entry for index %d\n", index); | |
417 | goto out; | |
418 | } | |
419 | if (--table->refs[index]) { | |
420 | mlx4_dbg(dev, "Have more references for index %d," | |
421 | "no need to modify vlan table\n", index); | |
422 | goto out; | |
423 | } | |
424 | table->entries[index] = 0; | |
425 | mlx4_set_port_vlan_table(dev, port, table->entries); | |
426 | --table->total; | |
427 | out: | |
428 | mutex_unlock(&table->mutex); | |
429 | } | |
430 | EXPORT_SYMBOL_GPL(mlx4_unregister_vlan); | |
7ff93f8b | 431 | |
9a5aa622 JM |
432 | int mlx4_get_port_ib_caps(struct mlx4_dev *dev, u8 port, __be32 *caps) |
433 | { | |
434 | struct mlx4_cmd_mailbox *inmailbox, *outmailbox; | |
435 | u8 *inbuf, *outbuf; | |
436 | int err; | |
437 | ||
438 | inmailbox = mlx4_alloc_cmd_mailbox(dev); | |
439 | if (IS_ERR(inmailbox)) | |
440 | return PTR_ERR(inmailbox); | |
441 | ||
442 | outmailbox = mlx4_alloc_cmd_mailbox(dev); | |
443 | if (IS_ERR(outmailbox)) { | |
444 | mlx4_free_cmd_mailbox(dev, inmailbox); | |
445 | return PTR_ERR(outmailbox); | |
446 | } | |
447 | ||
448 | inbuf = inmailbox->buf; | |
449 | outbuf = outmailbox->buf; | |
450 | memset(inbuf, 0, 256); | |
451 | memset(outbuf, 0, 256); | |
452 | inbuf[0] = 1; | |
453 | inbuf[1] = 1; | |
454 | inbuf[2] = 1; | |
455 | inbuf[3] = 1; | |
456 | *(__be16 *) (&inbuf[16]) = cpu_to_be16(0x0015); | |
457 | *(__be32 *) (&inbuf[20]) = cpu_to_be32(port); | |
458 | ||
459 | err = mlx4_cmd_box(dev, inmailbox->dma, outmailbox->dma, port, 3, | |
460 | MLX4_CMD_MAD_IFC, MLX4_CMD_TIME_CLASS_C); | |
461 | if (!err) | |
462 | *caps = *(__be32 *) (outbuf + 84); | |
463 | mlx4_free_cmd_mailbox(dev, inmailbox); | |
464 | mlx4_free_cmd_mailbox(dev, outmailbox); | |
465 | return err; | |
466 | } | |
467 | ||
7ff93f8b YP |
468 | int mlx4_SET_PORT(struct mlx4_dev *dev, u8 port) |
469 | { | |
470 | struct mlx4_cmd_mailbox *mailbox; | |
471 | int err; | |
7ff93f8b | 472 | |
352b09ed RD |
473 | if (dev->caps.port_type[port] == MLX4_PORT_TYPE_ETH) |
474 | return 0; | |
475 | ||
7ff93f8b YP |
476 | mailbox = mlx4_alloc_cmd_mailbox(dev); |
477 | if (IS_ERR(mailbox)) | |
478 | return PTR_ERR(mailbox); | |
479 | ||
480 | memset(mailbox->buf, 0, 256); | |
793730bf YP |
481 | |
482 | ((__be32 *) mailbox->buf)[1] = dev->caps.ib_port_def_cap[port]; | |
483 | err = mlx4_cmd(dev, mailbox->dma, port, 0, MLX4_CMD_SET_PORT, | |
7ff93f8b YP |
484 | MLX4_CMD_TIME_CLASS_B); |
485 | ||
486 | mlx4_free_cmd_mailbox(dev, mailbox); | |
487 | return err; | |
488 | } |