OMAPDSS: VENC: fix NULL pointer dereference in DSS2 VENC sysfs debug attr on OMAP4
[zen-stable.git] / drivers / infiniband / hw / mlx4 / main.c
blob7b445df6a667be9a595ae1f8ed9449e6419ce16a
1 /*
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
13 * conditions are met:
15 * - Redistributions of source code must retain the above
16 * copyright notice, this list of conditions and the following
17 * disclaimer.
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
31 * SOFTWARE.
34 #include <linux/module.h>
35 #include <linux/init.h>
36 #include <linux/slab.h>
37 #include <linux/errno.h>
38 #include <linux/netdevice.h>
39 #include <linux/inetdevice.h>
40 #include <linux/rtnetlink.h>
41 #include <linux/if_vlan.h>
43 #include <rdma/ib_smi.h>
44 #include <rdma/ib_user_verbs.h>
45 #include <rdma/ib_addr.h>
47 #include <linux/mlx4/driver.h>
48 #include <linux/mlx4/cmd.h>
50 #include "mlx4_ib.h"
51 #include "user.h"
53 #define DRV_NAME "mlx4_ib"
54 #define DRV_VERSION "1.0"
55 #define DRV_RELDATE "April 4, 2008"
57 MODULE_AUTHOR("Roland Dreier");
58 MODULE_DESCRIPTION("Mellanox ConnectX HCA InfiniBand driver");
59 MODULE_LICENSE("Dual BSD/GPL");
60 MODULE_VERSION(DRV_VERSION);
62 static const char mlx4_ib_version[] =
63 DRV_NAME ": Mellanox ConnectX InfiniBand driver v"
64 DRV_VERSION " (" DRV_RELDATE ")\n";
66 struct update_gid_work {
67 struct work_struct work;
68 union ib_gid gids[128];
69 struct mlx4_ib_dev *dev;
70 int port;
73 static struct workqueue_struct *wq;
75 static void init_query_mad(struct ib_smp *mad)
77 mad->base_version = 1;
78 mad->mgmt_class = IB_MGMT_CLASS_SUBN_LID_ROUTED;
79 mad->class_version = 1;
80 mad->method = IB_MGMT_METHOD_GET;
83 static union ib_gid zgid;
85 static int mlx4_ib_query_device(struct ib_device *ibdev,
86 struct ib_device_attr *props)
88 struct mlx4_ib_dev *dev = to_mdev(ibdev);
89 struct ib_smp *in_mad = NULL;
90 struct ib_smp *out_mad = NULL;
91 int err = -ENOMEM;
93 in_mad = kzalloc(sizeof *in_mad, GFP_KERNEL);
94 out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
95 if (!in_mad || !out_mad)
96 goto out;
98 init_query_mad(in_mad);
99 in_mad->attr_id = IB_SMP_ATTR_NODE_INFO;
101 err = mlx4_MAD_IFC(to_mdev(ibdev), 1, 1, 1, NULL, NULL, in_mad, out_mad);
102 if (err)
103 goto out;
105 memset(props, 0, sizeof *props);
107 props->fw_ver = dev->dev->caps.fw_ver;
108 props->device_cap_flags = IB_DEVICE_CHANGE_PHY_PORT |
109 IB_DEVICE_PORT_ACTIVE_EVENT |
110 IB_DEVICE_SYS_IMAGE_GUID |
111 IB_DEVICE_RC_RNR_NAK_GEN |
112 IB_DEVICE_BLOCK_MULTICAST_LOOPBACK;
113 if (dev->dev->caps.flags & MLX4_DEV_CAP_FLAG_BAD_PKEY_CNTR)
114 props->device_cap_flags |= IB_DEVICE_BAD_PKEY_CNTR;
115 if (dev->dev->caps.flags & MLX4_DEV_CAP_FLAG_BAD_QKEY_CNTR)
116 props->device_cap_flags |= IB_DEVICE_BAD_QKEY_CNTR;
117 if (dev->dev->caps.flags & MLX4_DEV_CAP_FLAG_APM)
118 props->device_cap_flags |= IB_DEVICE_AUTO_PATH_MIG;
119 if (dev->dev->caps.flags & MLX4_DEV_CAP_FLAG_UD_AV_PORT)
120 props->device_cap_flags |= IB_DEVICE_UD_AV_PORT_ENFORCE;
121 if (dev->dev->caps.flags & MLX4_DEV_CAP_FLAG_IPOIB_CSUM)
122 props->device_cap_flags |= IB_DEVICE_UD_IP_CSUM;
123 if (dev->dev->caps.max_gso_sz && dev->dev->caps.flags & MLX4_DEV_CAP_FLAG_BLH)
124 props->device_cap_flags |= IB_DEVICE_UD_TSO;
125 if (dev->dev->caps.bmme_flags & MLX4_BMME_FLAG_RESERVED_LKEY)
126 props->device_cap_flags |= IB_DEVICE_LOCAL_DMA_LKEY;
127 if ((dev->dev->caps.bmme_flags & MLX4_BMME_FLAG_LOCAL_INV) &&
128 (dev->dev->caps.bmme_flags & MLX4_BMME_FLAG_REMOTE_INV) &&
129 (dev->dev->caps.bmme_flags & MLX4_BMME_FLAG_FAST_REG_WR))
130 props->device_cap_flags |= IB_DEVICE_MEM_MGT_EXTENSIONS;
131 if (dev->dev->caps.flags & MLX4_DEV_CAP_FLAG_XRC)
132 props->device_cap_flags |= IB_DEVICE_XRC;
134 props->vendor_id = be32_to_cpup((__be32 *) (out_mad->data + 36)) &
135 0xffffff;
136 props->vendor_part_id = be16_to_cpup((__be16 *) (out_mad->data + 30));
137 props->hw_ver = be32_to_cpup((__be32 *) (out_mad->data + 32));
138 memcpy(&props->sys_image_guid, out_mad->data + 4, 8);
140 props->max_mr_size = ~0ull;
141 props->page_size_cap = dev->dev->caps.page_size_cap;
142 props->max_qp = dev->dev->caps.num_qps - dev->dev->caps.reserved_qps;
143 props->max_qp_wr = dev->dev->caps.max_wqes;
144 props->max_sge = min(dev->dev->caps.max_sq_sg,
145 dev->dev->caps.max_rq_sg);
146 props->max_cq = dev->dev->caps.num_cqs - dev->dev->caps.reserved_cqs;
147 props->max_cqe = dev->dev->caps.max_cqes;
148 props->max_mr = dev->dev->caps.num_mpts - dev->dev->caps.reserved_mrws;
149 props->max_pd = dev->dev->caps.num_pds - dev->dev->caps.reserved_pds;
150 props->max_qp_rd_atom = dev->dev->caps.max_qp_dest_rdma;
151 props->max_qp_init_rd_atom = dev->dev->caps.max_qp_init_rdma;
152 props->max_res_rd_atom = props->max_qp_rd_atom * props->max_qp;
153 props->max_srq = dev->dev->caps.num_srqs - dev->dev->caps.reserved_srqs;
154 props->max_srq_wr = dev->dev->caps.max_srq_wqes - 1;
155 props->max_srq_sge = dev->dev->caps.max_srq_sge;
156 props->max_fast_reg_page_list_len = MLX4_MAX_FAST_REG_PAGES;
157 props->local_ca_ack_delay = dev->dev->caps.local_ca_ack_delay;
158 props->atomic_cap = dev->dev->caps.flags & MLX4_DEV_CAP_FLAG_ATOMIC ?
159 IB_ATOMIC_HCA : IB_ATOMIC_NONE;
160 props->masked_atomic_cap = IB_ATOMIC_HCA;
161 props->max_pkeys = dev->dev->caps.pkey_table_len[1];
162 props->max_mcast_grp = dev->dev->caps.num_mgms + dev->dev->caps.num_amgms;
163 props->max_mcast_qp_attach = dev->dev->caps.num_qp_per_mgm;
164 props->max_total_mcast_qp_attach = props->max_mcast_qp_attach *
165 props->max_mcast_grp;
166 props->max_map_per_fmr = (1 << (32 - ilog2(dev->dev->caps.num_mpts))) - 1;
168 out:
169 kfree(in_mad);
170 kfree(out_mad);
172 return err;
175 static enum rdma_link_layer
176 mlx4_ib_port_link_layer(struct ib_device *device, u8 port_num)
178 struct mlx4_dev *dev = to_mdev(device)->dev;
180 return dev->caps.port_mask[port_num] == MLX4_PORT_TYPE_IB ?
181 IB_LINK_LAYER_INFINIBAND : IB_LINK_LAYER_ETHERNET;
184 static int ib_link_query_port(struct ib_device *ibdev, u8 port,
185 struct ib_port_attr *props,
186 struct ib_smp *in_mad,
187 struct ib_smp *out_mad)
189 int ext_active_speed;
190 int err;
192 props->lid = be16_to_cpup((__be16 *) (out_mad->data + 16));
193 props->lmc = out_mad->data[34] & 0x7;
194 props->sm_lid = be16_to_cpup((__be16 *) (out_mad->data + 18));
195 props->sm_sl = out_mad->data[36] & 0xf;
196 props->state = out_mad->data[32] & 0xf;
197 props->phys_state = out_mad->data[33] >> 4;
198 props->port_cap_flags = be32_to_cpup((__be32 *) (out_mad->data + 20));
199 props->gid_tbl_len = to_mdev(ibdev)->dev->caps.gid_table_len[port];
200 props->max_msg_sz = to_mdev(ibdev)->dev->caps.max_msg_sz;
201 props->pkey_tbl_len = to_mdev(ibdev)->dev->caps.pkey_table_len[port];
202 props->bad_pkey_cntr = be16_to_cpup((__be16 *) (out_mad->data + 46));
203 props->qkey_viol_cntr = be16_to_cpup((__be16 *) (out_mad->data + 48));
204 props->active_width = out_mad->data[31] & 0xf;
205 props->active_speed = out_mad->data[35] >> 4;
206 props->max_mtu = out_mad->data[41] & 0xf;
207 props->active_mtu = out_mad->data[36] >> 4;
208 props->subnet_timeout = out_mad->data[51] & 0x1f;
209 props->max_vl_num = out_mad->data[37] >> 4;
210 props->init_type_reply = out_mad->data[41] >> 4;
212 /* Check if extended speeds (EDR/FDR/...) are supported */
213 if (props->port_cap_flags & IB_PORT_EXTENDED_SPEEDS_SUP) {
214 ext_active_speed = out_mad->data[62] >> 4;
216 switch (ext_active_speed) {
217 case 1:
218 props->active_speed = 16; /* FDR */
219 break;
220 case 2:
221 props->active_speed = 32; /* EDR */
222 break;
226 /* If reported active speed is QDR, check if is FDR-10 */
227 if (props->active_speed == 4) {
228 if (to_mdev(ibdev)->dev->caps.ext_port_cap[port] &
229 MLX_EXT_PORT_CAP_FLAG_EXTENDED_PORT_INFO) {
230 init_query_mad(in_mad);
231 in_mad->attr_id = MLX4_ATTR_EXTENDED_PORT_INFO;
232 in_mad->attr_mod = cpu_to_be32(port);
234 err = mlx4_MAD_IFC(to_mdev(ibdev), 1, 1, port,
235 NULL, NULL, in_mad, out_mad);
236 if (err)
237 return err;
239 /* Checking LinkSpeedActive for FDR-10 */
240 if (out_mad->data[15] & 0x1)
241 props->active_speed = 8;
245 return 0;
248 static u8 state_to_phys_state(enum ib_port_state state)
250 return state == IB_PORT_ACTIVE ? 5 : 3;
253 static int eth_link_query_port(struct ib_device *ibdev, u8 port,
254 struct ib_port_attr *props,
255 struct ib_smp *out_mad)
257 struct mlx4_ib_iboe *iboe = &to_mdev(ibdev)->iboe;
258 struct net_device *ndev;
259 enum ib_mtu tmp;
261 props->active_width = IB_WIDTH_1X;
262 props->active_speed = 4;
263 props->port_cap_flags = IB_PORT_CM_SUP;
264 props->gid_tbl_len = to_mdev(ibdev)->dev->caps.gid_table_len[port];
265 props->max_msg_sz = to_mdev(ibdev)->dev->caps.max_msg_sz;
266 props->pkey_tbl_len = 1;
267 props->bad_pkey_cntr = be16_to_cpup((__be16 *) (out_mad->data + 46));
268 props->qkey_viol_cntr = be16_to_cpup((__be16 *) (out_mad->data + 48));
269 props->max_mtu = IB_MTU_4096;
270 props->subnet_timeout = 0;
271 props->max_vl_num = out_mad->data[37] >> 4;
272 props->init_type_reply = 0;
273 props->state = IB_PORT_DOWN;
274 props->phys_state = state_to_phys_state(props->state);
275 props->active_mtu = IB_MTU_256;
276 spin_lock(&iboe->lock);
277 ndev = iboe->netdevs[port - 1];
278 if (!ndev)
279 goto out;
281 tmp = iboe_get_mtu(ndev->mtu);
282 props->active_mtu = tmp ? min(props->max_mtu, tmp) : IB_MTU_256;
284 props->state = (netif_running(ndev) && netif_carrier_ok(ndev)) ?
285 IB_PORT_ACTIVE : IB_PORT_DOWN;
286 props->phys_state = state_to_phys_state(props->state);
288 out:
289 spin_unlock(&iboe->lock);
290 return 0;
293 static int mlx4_ib_query_port(struct ib_device *ibdev, u8 port,
294 struct ib_port_attr *props)
296 struct ib_smp *in_mad = NULL;
297 struct ib_smp *out_mad = NULL;
298 int err = -ENOMEM;
300 in_mad = kzalloc(sizeof *in_mad, GFP_KERNEL);
301 out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
302 if (!in_mad || !out_mad)
303 goto out;
305 memset(props, 0, sizeof *props);
307 init_query_mad(in_mad);
308 in_mad->attr_id = IB_SMP_ATTR_PORT_INFO;
309 in_mad->attr_mod = cpu_to_be32(port);
311 err = mlx4_MAD_IFC(to_mdev(ibdev), 1, 1, port, NULL, NULL, in_mad, out_mad);
312 if (err)
313 goto out;
315 err = mlx4_ib_port_link_layer(ibdev, port) == IB_LINK_LAYER_INFINIBAND ?
316 ib_link_query_port(ibdev, port, props, in_mad, out_mad) :
317 eth_link_query_port(ibdev, port, props, out_mad);
319 out:
320 kfree(in_mad);
321 kfree(out_mad);
323 return err;
326 static int __mlx4_ib_query_gid(struct ib_device *ibdev, u8 port, int index,
327 union ib_gid *gid)
329 struct ib_smp *in_mad = NULL;
330 struct ib_smp *out_mad = NULL;
331 int err = -ENOMEM;
333 in_mad = kzalloc(sizeof *in_mad, GFP_KERNEL);
334 out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
335 if (!in_mad || !out_mad)
336 goto out;
338 init_query_mad(in_mad);
339 in_mad->attr_id = IB_SMP_ATTR_PORT_INFO;
340 in_mad->attr_mod = cpu_to_be32(port);
342 err = mlx4_MAD_IFC(to_mdev(ibdev), 1, 1, port, NULL, NULL, in_mad, out_mad);
343 if (err)
344 goto out;
346 memcpy(gid->raw, out_mad->data + 8, 8);
348 init_query_mad(in_mad);
349 in_mad->attr_id = IB_SMP_ATTR_GUID_INFO;
350 in_mad->attr_mod = cpu_to_be32(index / 8);
352 err = mlx4_MAD_IFC(to_mdev(ibdev), 1, 1, port, NULL, NULL, in_mad, out_mad);
353 if (err)
354 goto out;
356 memcpy(gid->raw + 8, out_mad->data + (index % 8) * 8, 8);
358 out:
359 kfree(in_mad);
360 kfree(out_mad);
361 return err;
364 static int iboe_query_gid(struct ib_device *ibdev, u8 port, int index,
365 union ib_gid *gid)
367 struct mlx4_ib_dev *dev = to_mdev(ibdev);
369 *gid = dev->iboe.gid_table[port - 1][index];
371 return 0;
374 static int mlx4_ib_query_gid(struct ib_device *ibdev, u8 port, int index,
375 union ib_gid *gid)
377 if (rdma_port_get_link_layer(ibdev, port) == IB_LINK_LAYER_INFINIBAND)
378 return __mlx4_ib_query_gid(ibdev, port, index, gid);
379 else
380 return iboe_query_gid(ibdev, port, index, gid);
383 static int mlx4_ib_query_pkey(struct ib_device *ibdev, u8 port, u16 index,
384 u16 *pkey)
386 struct ib_smp *in_mad = NULL;
387 struct ib_smp *out_mad = NULL;
388 int err = -ENOMEM;
390 in_mad = kzalloc(sizeof *in_mad, GFP_KERNEL);
391 out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
392 if (!in_mad || !out_mad)
393 goto out;
395 init_query_mad(in_mad);
396 in_mad->attr_id = IB_SMP_ATTR_PKEY_TABLE;
397 in_mad->attr_mod = cpu_to_be32(index / 32);
399 err = mlx4_MAD_IFC(to_mdev(ibdev), 1, 1, port, NULL, NULL, in_mad, out_mad);
400 if (err)
401 goto out;
403 *pkey = be16_to_cpu(((__be16 *) out_mad->data)[index % 32]);
405 out:
406 kfree(in_mad);
407 kfree(out_mad);
408 return err;
411 static int mlx4_ib_modify_device(struct ib_device *ibdev, int mask,
412 struct ib_device_modify *props)
414 struct mlx4_cmd_mailbox *mailbox;
416 if (mask & ~IB_DEVICE_MODIFY_NODE_DESC)
417 return -EOPNOTSUPP;
419 if (!(mask & IB_DEVICE_MODIFY_NODE_DESC))
420 return 0;
422 spin_lock(&to_mdev(ibdev)->sm_lock);
423 memcpy(ibdev->node_desc, props->node_desc, 64);
424 spin_unlock(&to_mdev(ibdev)->sm_lock);
427 * If possible, pass node desc to FW, so it can generate
428 * a 144 trap. If cmd fails, just ignore.
430 mailbox = mlx4_alloc_cmd_mailbox(to_mdev(ibdev)->dev);
431 if (IS_ERR(mailbox))
432 return 0;
434 memset(mailbox->buf, 0, 256);
435 memcpy(mailbox->buf, props->node_desc, 64);
436 mlx4_cmd(to_mdev(ibdev)->dev, mailbox->dma, 1, 0,
437 MLX4_CMD_SET_NODE, MLX4_CMD_TIME_CLASS_A, MLX4_CMD_WRAPPED);
439 mlx4_free_cmd_mailbox(to_mdev(ibdev)->dev, mailbox);
441 return 0;
444 static int mlx4_SET_PORT(struct mlx4_ib_dev *dev, u8 port, int reset_qkey_viols,
445 u32 cap_mask)
447 struct mlx4_cmd_mailbox *mailbox;
448 int err;
449 u8 is_eth = dev->dev->caps.port_type[port] == MLX4_PORT_TYPE_ETH;
451 mailbox = mlx4_alloc_cmd_mailbox(dev->dev);
452 if (IS_ERR(mailbox))
453 return PTR_ERR(mailbox);
455 memset(mailbox->buf, 0, 256);
457 if (dev->dev->flags & MLX4_FLAG_OLD_PORT_CMDS) {
458 *(u8 *) mailbox->buf = !!reset_qkey_viols << 6;
459 ((__be32 *) mailbox->buf)[2] = cpu_to_be32(cap_mask);
460 } else {
461 ((u8 *) mailbox->buf)[3] = !!reset_qkey_viols;
462 ((__be32 *) mailbox->buf)[1] = cpu_to_be32(cap_mask);
465 err = mlx4_cmd(dev->dev, mailbox->dma, port, is_eth, MLX4_CMD_SET_PORT,
466 MLX4_CMD_TIME_CLASS_B, MLX4_CMD_NATIVE);
468 mlx4_free_cmd_mailbox(dev->dev, mailbox);
469 return err;
472 static int mlx4_ib_modify_port(struct ib_device *ibdev, u8 port, int mask,
473 struct ib_port_modify *props)
475 struct ib_port_attr attr;
476 u32 cap_mask;
477 int err;
479 mutex_lock(&to_mdev(ibdev)->cap_mask_mutex);
481 err = mlx4_ib_query_port(ibdev, port, &attr);
482 if (err)
483 goto out;
485 cap_mask = (attr.port_cap_flags | props->set_port_cap_mask) &
486 ~props->clr_port_cap_mask;
488 err = mlx4_SET_PORT(to_mdev(ibdev), port,
489 !!(mask & IB_PORT_RESET_QKEY_CNTR),
490 cap_mask);
492 out:
493 mutex_unlock(&to_mdev(ibdev)->cap_mask_mutex);
494 return err;
497 static struct ib_ucontext *mlx4_ib_alloc_ucontext(struct ib_device *ibdev,
498 struct ib_udata *udata)
500 struct mlx4_ib_dev *dev = to_mdev(ibdev);
501 struct mlx4_ib_ucontext *context;
502 struct mlx4_ib_alloc_ucontext_resp resp;
503 int err;
505 if (!dev->ib_active)
506 return ERR_PTR(-EAGAIN);
508 resp.qp_tab_size = dev->dev->caps.num_qps;
509 resp.bf_reg_size = dev->dev->caps.bf_reg_size;
510 resp.bf_regs_per_page = dev->dev->caps.bf_regs_per_page;
512 context = kmalloc(sizeof *context, GFP_KERNEL);
513 if (!context)
514 return ERR_PTR(-ENOMEM);
516 err = mlx4_uar_alloc(to_mdev(ibdev)->dev, &context->uar);
517 if (err) {
518 kfree(context);
519 return ERR_PTR(err);
522 INIT_LIST_HEAD(&context->db_page_list);
523 mutex_init(&context->db_page_mutex);
525 err = ib_copy_to_udata(udata, &resp, sizeof resp);
526 if (err) {
527 mlx4_uar_free(to_mdev(ibdev)->dev, &context->uar);
528 kfree(context);
529 return ERR_PTR(-EFAULT);
532 return &context->ibucontext;
535 static int mlx4_ib_dealloc_ucontext(struct ib_ucontext *ibcontext)
537 struct mlx4_ib_ucontext *context = to_mucontext(ibcontext);
539 mlx4_uar_free(to_mdev(ibcontext->device)->dev, &context->uar);
540 kfree(context);
542 return 0;
545 static int mlx4_ib_mmap(struct ib_ucontext *context, struct vm_area_struct *vma)
547 struct mlx4_ib_dev *dev = to_mdev(context->device);
549 if (vma->vm_end - vma->vm_start != PAGE_SIZE)
550 return -EINVAL;
552 if (vma->vm_pgoff == 0) {
553 vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
555 if (io_remap_pfn_range(vma, vma->vm_start,
556 to_mucontext(context)->uar.pfn,
557 PAGE_SIZE, vma->vm_page_prot))
558 return -EAGAIN;
559 } else if (vma->vm_pgoff == 1 && dev->dev->caps.bf_reg_size != 0) {
560 vma->vm_page_prot = pgprot_writecombine(vma->vm_page_prot);
562 if (io_remap_pfn_range(vma, vma->vm_start,
563 to_mucontext(context)->uar.pfn +
564 dev->dev->caps.num_uars,
565 PAGE_SIZE, vma->vm_page_prot))
566 return -EAGAIN;
567 } else
568 return -EINVAL;
570 return 0;
573 static struct ib_pd *mlx4_ib_alloc_pd(struct ib_device *ibdev,
574 struct ib_ucontext *context,
575 struct ib_udata *udata)
577 struct mlx4_ib_pd *pd;
578 int err;
580 pd = kmalloc(sizeof *pd, GFP_KERNEL);
581 if (!pd)
582 return ERR_PTR(-ENOMEM);
584 err = mlx4_pd_alloc(to_mdev(ibdev)->dev, &pd->pdn);
585 if (err) {
586 kfree(pd);
587 return ERR_PTR(err);
590 if (context)
591 if (ib_copy_to_udata(udata, &pd->pdn, sizeof (__u32))) {
592 mlx4_pd_free(to_mdev(ibdev)->dev, pd->pdn);
593 kfree(pd);
594 return ERR_PTR(-EFAULT);
597 return &pd->ibpd;
600 static int mlx4_ib_dealloc_pd(struct ib_pd *pd)
602 mlx4_pd_free(to_mdev(pd->device)->dev, to_mpd(pd)->pdn);
603 kfree(pd);
605 return 0;
608 static struct ib_xrcd *mlx4_ib_alloc_xrcd(struct ib_device *ibdev,
609 struct ib_ucontext *context,
610 struct ib_udata *udata)
612 struct mlx4_ib_xrcd *xrcd;
613 int err;
615 if (!(to_mdev(ibdev)->dev->caps.flags & MLX4_DEV_CAP_FLAG_XRC))
616 return ERR_PTR(-ENOSYS);
618 xrcd = kmalloc(sizeof *xrcd, GFP_KERNEL);
619 if (!xrcd)
620 return ERR_PTR(-ENOMEM);
622 err = mlx4_xrcd_alloc(to_mdev(ibdev)->dev, &xrcd->xrcdn);
623 if (err)
624 goto err1;
626 xrcd->pd = ib_alloc_pd(ibdev);
627 if (IS_ERR(xrcd->pd)) {
628 err = PTR_ERR(xrcd->pd);
629 goto err2;
632 xrcd->cq = ib_create_cq(ibdev, NULL, NULL, xrcd, 1, 0);
633 if (IS_ERR(xrcd->cq)) {
634 err = PTR_ERR(xrcd->cq);
635 goto err3;
638 return &xrcd->ibxrcd;
640 err3:
641 ib_dealloc_pd(xrcd->pd);
642 err2:
643 mlx4_xrcd_free(to_mdev(ibdev)->dev, xrcd->xrcdn);
644 err1:
645 kfree(xrcd);
646 return ERR_PTR(err);
649 static int mlx4_ib_dealloc_xrcd(struct ib_xrcd *xrcd)
651 ib_destroy_cq(to_mxrcd(xrcd)->cq);
652 ib_dealloc_pd(to_mxrcd(xrcd)->pd);
653 mlx4_xrcd_free(to_mdev(xrcd->device)->dev, to_mxrcd(xrcd)->xrcdn);
654 kfree(xrcd);
656 return 0;
659 static int add_gid_entry(struct ib_qp *ibqp, union ib_gid *gid)
661 struct mlx4_ib_qp *mqp = to_mqp(ibqp);
662 struct mlx4_ib_dev *mdev = to_mdev(ibqp->device);
663 struct mlx4_ib_gid_entry *ge;
665 ge = kzalloc(sizeof *ge, GFP_KERNEL);
666 if (!ge)
667 return -ENOMEM;
669 ge->gid = *gid;
670 if (mlx4_ib_add_mc(mdev, mqp, gid)) {
671 ge->port = mqp->port;
672 ge->added = 1;
675 mutex_lock(&mqp->mutex);
676 list_add_tail(&ge->list, &mqp->gid_list);
677 mutex_unlock(&mqp->mutex);
679 return 0;
682 int mlx4_ib_add_mc(struct mlx4_ib_dev *mdev, struct mlx4_ib_qp *mqp,
683 union ib_gid *gid)
685 u8 mac[6];
686 struct net_device *ndev;
687 int ret = 0;
689 if (!mqp->port)
690 return 0;
692 spin_lock(&mdev->iboe.lock);
693 ndev = mdev->iboe.netdevs[mqp->port - 1];
694 if (ndev)
695 dev_hold(ndev);
696 spin_unlock(&mdev->iboe.lock);
698 if (ndev) {
699 rdma_get_mcast_mac((struct in6_addr *)gid, mac);
700 rtnl_lock();
701 dev_mc_add(mdev->iboe.netdevs[mqp->port - 1], mac);
702 ret = 1;
703 rtnl_unlock();
704 dev_put(ndev);
707 return ret;
710 static int mlx4_ib_mcg_attach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
712 int err;
713 struct mlx4_ib_dev *mdev = to_mdev(ibqp->device);
714 struct mlx4_ib_qp *mqp = to_mqp(ibqp);
716 err = mlx4_multicast_attach(mdev->dev, &mqp->mqp, gid->raw,
717 !!(mqp->flags & MLX4_IB_QP_BLOCK_MULTICAST_LOOPBACK),
718 MLX4_PROT_IB_IPV6);
719 if (err)
720 return err;
722 err = add_gid_entry(ibqp, gid);
723 if (err)
724 goto err_add;
726 return 0;
728 err_add:
729 mlx4_multicast_detach(mdev->dev, &mqp->mqp, gid->raw, MLX4_PROT_IB_IPV6);
730 return err;
733 static struct mlx4_ib_gid_entry *find_gid_entry(struct mlx4_ib_qp *qp, u8 *raw)
735 struct mlx4_ib_gid_entry *ge;
736 struct mlx4_ib_gid_entry *tmp;
737 struct mlx4_ib_gid_entry *ret = NULL;
739 list_for_each_entry_safe(ge, tmp, &qp->gid_list, list) {
740 if (!memcmp(raw, ge->gid.raw, 16)) {
741 ret = ge;
742 break;
746 return ret;
749 static int mlx4_ib_mcg_detach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
751 int err;
752 struct mlx4_ib_dev *mdev = to_mdev(ibqp->device);
753 struct mlx4_ib_qp *mqp = to_mqp(ibqp);
754 u8 mac[6];
755 struct net_device *ndev;
756 struct mlx4_ib_gid_entry *ge;
758 err = mlx4_multicast_detach(mdev->dev,
759 &mqp->mqp, gid->raw, MLX4_PROT_IB_IPV6);
760 if (err)
761 return err;
763 mutex_lock(&mqp->mutex);
764 ge = find_gid_entry(mqp, gid->raw);
765 if (ge) {
766 spin_lock(&mdev->iboe.lock);
767 ndev = ge->added ? mdev->iboe.netdevs[ge->port - 1] : NULL;
768 if (ndev)
769 dev_hold(ndev);
770 spin_unlock(&mdev->iboe.lock);
771 rdma_get_mcast_mac((struct in6_addr *)gid, mac);
772 if (ndev) {
773 rtnl_lock();
774 dev_mc_del(mdev->iboe.netdevs[ge->port - 1], mac);
775 rtnl_unlock();
776 dev_put(ndev);
778 list_del(&ge->list);
779 kfree(ge);
780 } else
781 printk(KERN_WARNING "could not find mgid entry\n");
783 mutex_unlock(&mqp->mutex);
785 return 0;
788 static int init_node_data(struct mlx4_ib_dev *dev)
790 struct ib_smp *in_mad = NULL;
791 struct ib_smp *out_mad = NULL;
792 int err = -ENOMEM;
794 in_mad = kzalloc(sizeof *in_mad, GFP_KERNEL);
795 out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
796 if (!in_mad || !out_mad)
797 goto out;
799 init_query_mad(in_mad);
800 in_mad->attr_id = IB_SMP_ATTR_NODE_DESC;
802 err = mlx4_MAD_IFC(dev, 1, 1, 1, NULL, NULL, in_mad, out_mad);
803 if (err)
804 goto out;
806 memcpy(dev->ib_dev.node_desc, out_mad->data, 64);
808 in_mad->attr_id = IB_SMP_ATTR_NODE_INFO;
810 err = mlx4_MAD_IFC(dev, 1, 1, 1, NULL, NULL, in_mad, out_mad);
811 if (err)
812 goto out;
814 memcpy(&dev->ib_dev.node_guid, out_mad->data + 12, 8);
816 out:
817 kfree(in_mad);
818 kfree(out_mad);
819 return err;
822 static ssize_t show_hca(struct device *device, struct device_attribute *attr,
823 char *buf)
825 struct mlx4_ib_dev *dev =
826 container_of(device, struct mlx4_ib_dev, ib_dev.dev);
827 return sprintf(buf, "MT%d\n", dev->dev->pdev->device);
830 static ssize_t show_fw_ver(struct device *device, struct device_attribute *attr,
831 char *buf)
833 struct mlx4_ib_dev *dev =
834 container_of(device, struct mlx4_ib_dev, ib_dev.dev);
835 return sprintf(buf, "%d.%d.%d\n", (int) (dev->dev->caps.fw_ver >> 32),
836 (int) (dev->dev->caps.fw_ver >> 16) & 0xffff,
837 (int) dev->dev->caps.fw_ver & 0xffff);
840 static ssize_t show_rev(struct device *device, struct device_attribute *attr,
841 char *buf)
843 struct mlx4_ib_dev *dev =
844 container_of(device, struct mlx4_ib_dev, ib_dev.dev);
845 return sprintf(buf, "%x\n", dev->dev->rev_id);
848 static ssize_t show_board(struct device *device, struct device_attribute *attr,
849 char *buf)
851 struct mlx4_ib_dev *dev =
852 container_of(device, struct mlx4_ib_dev, ib_dev.dev);
853 return sprintf(buf, "%.*s\n", MLX4_BOARD_ID_LEN,
854 dev->dev->board_id);
857 static DEVICE_ATTR(hw_rev, S_IRUGO, show_rev, NULL);
858 static DEVICE_ATTR(fw_ver, S_IRUGO, show_fw_ver, NULL);
859 static DEVICE_ATTR(hca_type, S_IRUGO, show_hca, NULL);
860 static DEVICE_ATTR(board_id, S_IRUGO, show_board, NULL);
862 static struct device_attribute *mlx4_class_attributes[] = {
863 &dev_attr_hw_rev,
864 &dev_attr_fw_ver,
865 &dev_attr_hca_type,
866 &dev_attr_board_id
869 static void mlx4_addrconf_ifid_eui48(u8 *eui, u16 vlan_id, struct net_device *dev)
871 memcpy(eui, dev->dev_addr, 3);
872 memcpy(eui + 5, dev->dev_addr + 3, 3);
873 if (vlan_id < 0x1000) {
874 eui[3] = vlan_id >> 8;
875 eui[4] = vlan_id & 0xff;
876 } else {
877 eui[3] = 0xff;
878 eui[4] = 0xfe;
880 eui[0] ^= 2;
883 static void update_gids_task(struct work_struct *work)
885 struct update_gid_work *gw = container_of(work, struct update_gid_work, work);
886 struct mlx4_cmd_mailbox *mailbox;
887 union ib_gid *gids;
888 int err;
889 struct mlx4_dev *dev = gw->dev->dev;
890 struct ib_event event;
892 mailbox = mlx4_alloc_cmd_mailbox(dev);
893 if (IS_ERR(mailbox)) {
894 printk(KERN_WARNING "update gid table failed %ld\n", PTR_ERR(mailbox));
895 return;
898 gids = mailbox->buf;
899 memcpy(gids, gw->gids, sizeof gw->gids);
901 err = mlx4_cmd(dev, mailbox->dma, MLX4_SET_PORT_GID_TABLE << 8 | gw->port,
902 1, MLX4_CMD_SET_PORT, MLX4_CMD_TIME_CLASS_B,
903 MLX4_CMD_NATIVE);
904 if (err)
905 printk(KERN_WARNING "set port command failed\n");
906 else {
907 memcpy(gw->dev->iboe.gid_table[gw->port - 1], gw->gids, sizeof gw->gids);
908 event.device = &gw->dev->ib_dev;
909 event.element.port_num = gw->port;
910 event.event = IB_EVENT_GID_CHANGE;
911 ib_dispatch_event(&event);
914 mlx4_free_cmd_mailbox(dev, mailbox);
915 kfree(gw);
918 static int update_ipv6_gids(struct mlx4_ib_dev *dev, int port, int clear)
920 struct net_device *ndev = dev->iboe.netdevs[port - 1];
921 struct update_gid_work *work;
922 struct net_device *tmp;
923 int i;
924 u8 *hits;
925 int ret;
926 union ib_gid gid;
927 int free;
928 int found;
929 int need_update = 0;
930 u16 vid;
932 work = kzalloc(sizeof *work, GFP_ATOMIC);
933 if (!work)
934 return -ENOMEM;
936 hits = kzalloc(128, GFP_ATOMIC);
937 if (!hits) {
938 ret = -ENOMEM;
939 goto out;
942 rcu_read_lock();
943 for_each_netdev_rcu(&init_net, tmp) {
944 if (ndev && (tmp == ndev || rdma_vlan_dev_real_dev(tmp) == ndev)) {
945 gid.global.subnet_prefix = cpu_to_be64(0xfe80000000000000LL);
946 vid = rdma_vlan_dev_vlan_id(tmp);
947 mlx4_addrconf_ifid_eui48(&gid.raw[8], vid, ndev);
948 found = 0;
949 free = -1;
950 for (i = 0; i < 128; ++i) {
951 if (free < 0 &&
952 !memcmp(&dev->iboe.gid_table[port - 1][i], &zgid, sizeof zgid))
953 free = i;
954 if (!memcmp(&dev->iboe.gid_table[port - 1][i], &gid, sizeof gid)) {
955 hits[i] = 1;
956 found = 1;
957 break;
961 if (!found) {
962 if (tmp == ndev &&
963 (memcmp(&dev->iboe.gid_table[port - 1][0],
964 &gid, sizeof gid) ||
965 !memcmp(&dev->iboe.gid_table[port - 1][0],
966 &zgid, sizeof gid))) {
967 dev->iboe.gid_table[port - 1][0] = gid;
968 ++need_update;
969 hits[0] = 1;
970 } else if (free >= 0) {
971 dev->iboe.gid_table[port - 1][free] = gid;
972 hits[free] = 1;
973 ++need_update;
978 rcu_read_unlock();
980 for (i = 0; i < 128; ++i)
981 if (!hits[i]) {
982 if (memcmp(&dev->iboe.gid_table[port - 1][i], &zgid, sizeof zgid))
983 ++need_update;
984 dev->iboe.gid_table[port - 1][i] = zgid;
987 if (need_update) {
988 memcpy(work->gids, dev->iboe.gid_table[port - 1], sizeof work->gids);
989 INIT_WORK(&work->work, update_gids_task);
990 work->port = port;
991 work->dev = dev;
992 queue_work(wq, &work->work);
993 } else
994 kfree(work);
996 kfree(hits);
997 return 0;
999 out:
1000 kfree(work);
1001 return ret;
1004 static void handle_en_event(struct mlx4_ib_dev *dev, int port, unsigned long event)
1006 switch (event) {
1007 case NETDEV_UP:
1008 case NETDEV_CHANGEADDR:
1009 update_ipv6_gids(dev, port, 0);
1010 break;
1012 case NETDEV_DOWN:
1013 update_ipv6_gids(dev, port, 1);
1014 dev->iboe.netdevs[port - 1] = NULL;
1018 static void netdev_added(struct mlx4_ib_dev *dev, int port)
1020 update_ipv6_gids(dev, port, 0);
1023 static void netdev_removed(struct mlx4_ib_dev *dev, int port)
1025 update_ipv6_gids(dev, port, 1);
1028 static int mlx4_ib_netdev_event(struct notifier_block *this, unsigned long event,
1029 void *ptr)
1031 struct net_device *dev = ptr;
1032 struct mlx4_ib_dev *ibdev;
1033 struct net_device *oldnd;
1034 struct mlx4_ib_iboe *iboe;
1035 int port;
1037 if (!net_eq(dev_net(dev), &init_net))
1038 return NOTIFY_DONE;
1040 ibdev = container_of(this, struct mlx4_ib_dev, iboe.nb);
1041 iboe = &ibdev->iboe;
1043 spin_lock(&iboe->lock);
1044 mlx4_foreach_ib_transport_port(port, ibdev->dev) {
1045 oldnd = iboe->netdevs[port - 1];
1046 iboe->netdevs[port - 1] =
1047 mlx4_get_protocol_dev(ibdev->dev, MLX4_PROT_ETH, port);
1048 if (oldnd != iboe->netdevs[port - 1]) {
1049 if (iboe->netdevs[port - 1])
1050 netdev_added(ibdev, port);
1051 else
1052 netdev_removed(ibdev, port);
1056 if (dev == iboe->netdevs[0] ||
1057 (iboe->netdevs[0] && rdma_vlan_dev_real_dev(dev) == iboe->netdevs[0]))
1058 handle_en_event(ibdev, 1, event);
1059 else if (dev == iboe->netdevs[1]
1060 || (iboe->netdevs[1] && rdma_vlan_dev_real_dev(dev) == iboe->netdevs[1]))
1061 handle_en_event(ibdev, 2, event);
1063 spin_unlock(&iboe->lock);
1065 return NOTIFY_DONE;
1068 static void *mlx4_ib_add(struct mlx4_dev *dev)
1070 struct mlx4_ib_dev *ibdev;
1071 int num_ports = 0;
1072 int i;
1073 int err;
1074 struct mlx4_ib_iboe *iboe;
1076 printk_once(KERN_INFO "%s", mlx4_ib_version);
1078 if (mlx4_is_mfunc(dev)) {
1079 printk(KERN_WARNING "IB not yet supported in SRIOV\n");
1080 return NULL;
1083 mlx4_foreach_ib_transport_port(i, dev)
1084 num_ports++;
1086 /* No point in registering a device with no ports... */
1087 if (num_ports == 0)
1088 return NULL;
1090 ibdev = (struct mlx4_ib_dev *) ib_alloc_device(sizeof *ibdev);
1091 if (!ibdev) {
1092 dev_err(&dev->pdev->dev, "Device struct alloc failed\n");
1093 return NULL;
1096 iboe = &ibdev->iboe;
1098 if (mlx4_pd_alloc(dev, &ibdev->priv_pdn))
1099 goto err_dealloc;
1101 if (mlx4_uar_alloc(dev, &ibdev->priv_uar))
1102 goto err_pd;
1104 ibdev->uar_map = ioremap((phys_addr_t) ibdev->priv_uar.pfn << PAGE_SHIFT,
1105 PAGE_SIZE);
1106 if (!ibdev->uar_map)
1107 goto err_uar;
1108 MLX4_INIT_DOORBELL_LOCK(&ibdev->uar_lock);
1110 ibdev->dev = dev;
1112 strlcpy(ibdev->ib_dev.name, "mlx4_%d", IB_DEVICE_NAME_MAX);
1113 ibdev->ib_dev.owner = THIS_MODULE;
1114 ibdev->ib_dev.node_type = RDMA_NODE_IB_CA;
1115 ibdev->ib_dev.local_dma_lkey = dev->caps.reserved_lkey;
1116 ibdev->num_ports = num_ports;
1117 ibdev->ib_dev.phys_port_cnt = ibdev->num_ports;
1118 ibdev->ib_dev.num_comp_vectors = dev->caps.num_comp_vectors;
1119 ibdev->ib_dev.dma_device = &dev->pdev->dev;
1121 ibdev->ib_dev.uverbs_abi_ver = MLX4_IB_UVERBS_ABI_VERSION;
1122 ibdev->ib_dev.uverbs_cmd_mask =
1123 (1ull << IB_USER_VERBS_CMD_GET_CONTEXT) |
1124 (1ull << IB_USER_VERBS_CMD_QUERY_DEVICE) |
1125 (1ull << IB_USER_VERBS_CMD_QUERY_PORT) |
1126 (1ull << IB_USER_VERBS_CMD_ALLOC_PD) |
1127 (1ull << IB_USER_VERBS_CMD_DEALLOC_PD) |
1128 (1ull << IB_USER_VERBS_CMD_REG_MR) |
1129 (1ull << IB_USER_VERBS_CMD_DEREG_MR) |
1130 (1ull << IB_USER_VERBS_CMD_CREATE_COMP_CHANNEL) |
1131 (1ull << IB_USER_VERBS_CMD_CREATE_CQ) |
1132 (1ull << IB_USER_VERBS_CMD_RESIZE_CQ) |
1133 (1ull << IB_USER_VERBS_CMD_DESTROY_CQ) |
1134 (1ull << IB_USER_VERBS_CMD_CREATE_QP) |
1135 (1ull << IB_USER_VERBS_CMD_MODIFY_QP) |
1136 (1ull << IB_USER_VERBS_CMD_QUERY_QP) |
1137 (1ull << IB_USER_VERBS_CMD_DESTROY_QP) |
1138 (1ull << IB_USER_VERBS_CMD_ATTACH_MCAST) |
1139 (1ull << IB_USER_VERBS_CMD_DETACH_MCAST) |
1140 (1ull << IB_USER_VERBS_CMD_CREATE_SRQ) |
1141 (1ull << IB_USER_VERBS_CMD_MODIFY_SRQ) |
1142 (1ull << IB_USER_VERBS_CMD_QUERY_SRQ) |
1143 (1ull << IB_USER_VERBS_CMD_DESTROY_SRQ) |
1144 (1ull << IB_USER_VERBS_CMD_CREATE_XSRQ) |
1145 (1ull << IB_USER_VERBS_CMD_OPEN_QP);
1147 ibdev->ib_dev.query_device = mlx4_ib_query_device;
1148 ibdev->ib_dev.query_port = mlx4_ib_query_port;
1149 ibdev->ib_dev.get_link_layer = mlx4_ib_port_link_layer;
1150 ibdev->ib_dev.query_gid = mlx4_ib_query_gid;
1151 ibdev->ib_dev.query_pkey = mlx4_ib_query_pkey;
1152 ibdev->ib_dev.modify_device = mlx4_ib_modify_device;
1153 ibdev->ib_dev.modify_port = mlx4_ib_modify_port;
1154 ibdev->ib_dev.alloc_ucontext = mlx4_ib_alloc_ucontext;
1155 ibdev->ib_dev.dealloc_ucontext = mlx4_ib_dealloc_ucontext;
1156 ibdev->ib_dev.mmap = mlx4_ib_mmap;
1157 ibdev->ib_dev.alloc_pd = mlx4_ib_alloc_pd;
1158 ibdev->ib_dev.dealloc_pd = mlx4_ib_dealloc_pd;
1159 ibdev->ib_dev.create_ah = mlx4_ib_create_ah;
1160 ibdev->ib_dev.query_ah = mlx4_ib_query_ah;
1161 ibdev->ib_dev.destroy_ah = mlx4_ib_destroy_ah;
1162 ibdev->ib_dev.create_srq = mlx4_ib_create_srq;
1163 ibdev->ib_dev.modify_srq = mlx4_ib_modify_srq;
1164 ibdev->ib_dev.query_srq = mlx4_ib_query_srq;
1165 ibdev->ib_dev.destroy_srq = mlx4_ib_destroy_srq;
1166 ibdev->ib_dev.post_srq_recv = mlx4_ib_post_srq_recv;
1167 ibdev->ib_dev.create_qp = mlx4_ib_create_qp;
1168 ibdev->ib_dev.modify_qp = mlx4_ib_modify_qp;
1169 ibdev->ib_dev.query_qp = mlx4_ib_query_qp;
1170 ibdev->ib_dev.destroy_qp = mlx4_ib_destroy_qp;
1171 ibdev->ib_dev.post_send = mlx4_ib_post_send;
1172 ibdev->ib_dev.post_recv = mlx4_ib_post_recv;
1173 ibdev->ib_dev.create_cq = mlx4_ib_create_cq;
1174 ibdev->ib_dev.modify_cq = mlx4_ib_modify_cq;
1175 ibdev->ib_dev.resize_cq = mlx4_ib_resize_cq;
1176 ibdev->ib_dev.destroy_cq = mlx4_ib_destroy_cq;
1177 ibdev->ib_dev.poll_cq = mlx4_ib_poll_cq;
1178 ibdev->ib_dev.req_notify_cq = mlx4_ib_arm_cq;
1179 ibdev->ib_dev.get_dma_mr = mlx4_ib_get_dma_mr;
1180 ibdev->ib_dev.reg_user_mr = mlx4_ib_reg_user_mr;
1181 ibdev->ib_dev.dereg_mr = mlx4_ib_dereg_mr;
1182 ibdev->ib_dev.alloc_fast_reg_mr = mlx4_ib_alloc_fast_reg_mr;
1183 ibdev->ib_dev.alloc_fast_reg_page_list = mlx4_ib_alloc_fast_reg_page_list;
1184 ibdev->ib_dev.free_fast_reg_page_list = mlx4_ib_free_fast_reg_page_list;
1185 ibdev->ib_dev.attach_mcast = mlx4_ib_mcg_attach;
1186 ibdev->ib_dev.detach_mcast = mlx4_ib_mcg_detach;
1187 ibdev->ib_dev.process_mad = mlx4_ib_process_mad;
1189 ibdev->ib_dev.alloc_fmr = mlx4_ib_fmr_alloc;
1190 ibdev->ib_dev.map_phys_fmr = mlx4_ib_map_phys_fmr;
1191 ibdev->ib_dev.unmap_fmr = mlx4_ib_unmap_fmr;
1192 ibdev->ib_dev.dealloc_fmr = mlx4_ib_fmr_dealloc;
1194 if (dev->caps.flags & MLX4_DEV_CAP_FLAG_XRC) {
1195 ibdev->ib_dev.alloc_xrcd = mlx4_ib_alloc_xrcd;
1196 ibdev->ib_dev.dealloc_xrcd = mlx4_ib_dealloc_xrcd;
1197 ibdev->ib_dev.uverbs_cmd_mask |=
1198 (1ull << IB_USER_VERBS_CMD_OPEN_XRCD) |
1199 (1ull << IB_USER_VERBS_CMD_CLOSE_XRCD);
1202 spin_lock_init(&iboe->lock);
1204 if (init_node_data(ibdev))
1205 goto err_map;
1207 for (i = 0; i < ibdev->num_ports; ++i) {
1208 if (mlx4_ib_port_link_layer(&ibdev->ib_dev, i + 1) ==
1209 IB_LINK_LAYER_ETHERNET) {
1210 err = mlx4_counter_alloc(ibdev->dev, &ibdev->counters[i]);
1211 if (err)
1212 ibdev->counters[i] = -1;
1213 } else
1214 ibdev->counters[i] = -1;
1217 spin_lock_init(&ibdev->sm_lock);
1218 mutex_init(&ibdev->cap_mask_mutex);
1220 if (ib_register_device(&ibdev->ib_dev, NULL))
1221 goto err_counter;
1223 if (mlx4_ib_mad_init(ibdev))
1224 goto err_reg;
1226 if (dev->caps.flags & MLX4_DEV_CAP_FLAG_IBOE && !iboe->nb.notifier_call) {
1227 iboe->nb.notifier_call = mlx4_ib_netdev_event;
1228 err = register_netdevice_notifier(&iboe->nb);
1229 if (err)
1230 goto err_reg;
1233 for (i = 0; i < ARRAY_SIZE(mlx4_class_attributes); ++i) {
1234 if (device_create_file(&ibdev->ib_dev.dev,
1235 mlx4_class_attributes[i]))
1236 goto err_notif;
1239 ibdev->ib_active = true;
1241 return ibdev;
1243 err_notif:
1244 if (unregister_netdevice_notifier(&ibdev->iboe.nb))
1245 printk(KERN_WARNING "failure unregistering notifier\n");
1246 flush_workqueue(wq);
1248 err_reg:
1249 ib_unregister_device(&ibdev->ib_dev);
1251 err_counter:
1252 for (; i; --i)
1253 if (ibdev->counters[i - 1] != -1)
1254 mlx4_counter_free(ibdev->dev, ibdev->counters[i - 1]);
1256 err_map:
1257 iounmap(ibdev->uar_map);
1259 err_uar:
1260 mlx4_uar_free(dev, &ibdev->priv_uar);
1262 err_pd:
1263 mlx4_pd_free(dev, ibdev->priv_pdn);
1265 err_dealloc:
1266 ib_dealloc_device(&ibdev->ib_dev);
1268 return NULL;
1271 static void mlx4_ib_remove(struct mlx4_dev *dev, void *ibdev_ptr)
1273 struct mlx4_ib_dev *ibdev = ibdev_ptr;
1274 int p;
1276 mlx4_ib_mad_cleanup(ibdev);
1277 ib_unregister_device(&ibdev->ib_dev);
1278 if (ibdev->iboe.nb.notifier_call) {
1279 if (unregister_netdevice_notifier(&ibdev->iboe.nb))
1280 printk(KERN_WARNING "failure unregistering notifier\n");
1281 ibdev->iboe.nb.notifier_call = NULL;
1283 iounmap(ibdev->uar_map);
1284 for (p = 0; p < ibdev->num_ports; ++p)
1285 if (ibdev->counters[p] != -1)
1286 mlx4_counter_free(ibdev->dev, ibdev->counters[p]);
1287 mlx4_foreach_port(p, dev, MLX4_PORT_TYPE_IB)
1288 mlx4_CLOSE_PORT(dev, p);
1290 mlx4_uar_free(dev, &ibdev->priv_uar);
1291 mlx4_pd_free(dev, ibdev->priv_pdn);
1292 ib_dealloc_device(&ibdev->ib_dev);
1295 static void mlx4_ib_event(struct mlx4_dev *dev, void *ibdev_ptr,
1296 enum mlx4_dev_event event, int port)
1298 struct ib_event ibev;
1299 struct mlx4_ib_dev *ibdev = to_mdev((struct ib_device *) ibdev_ptr);
1301 if (port > ibdev->num_ports)
1302 return;
1304 switch (event) {
1305 case MLX4_DEV_EVENT_PORT_UP:
1306 ibev.event = IB_EVENT_PORT_ACTIVE;
1307 break;
1309 case MLX4_DEV_EVENT_PORT_DOWN:
1310 ibev.event = IB_EVENT_PORT_ERR;
1311 break;
1313 case MLX4_DEV_EVENT_CATASTROPHIC_ERROR:
1314 ibdev->ib_active = false;
1315 ibev.event = IB_EVENT_DEVICE_FATAL;
1316 break;
1318 default:
1319 return;
1322 ibev.device = ibdev_ptr;
1323 ibev.element.port_num = port;
1325 ib_dispatch_event(&ibev);
1328 static struct mlx4_interface mlx4_ib_interface = {
1329 .add = mlx4_ib_add,
1330 .remove = mlx4_ib_remove,
1331 .event = mlx4_ib_event,
1332 .protocol = MLX4_PROT_IB_IPV6
1335 static int __init mlx4_ib_init(void)
1337 int err;
1339 wq = create_singlethread_workqueue("mlx4_ib");
1340 if (!wq)
1341 return -ENOMEM;
1343 err = mlx4_register_interface(&mlx4_ib_interface);
1344 if (err) {
1345 destroy_workqueue(wq);
1346 return err;
1349 return 0;
1352 static void __exit mlx4_ib_cleanup(void)
1354 mlx4_unregister_interface(&mlx4_ib_interface);
1355 destroy_workqueue(wq);
1358 module_init(mlx4_ib_init);
1359 module_exit(mlx4_ib_cleanup);