1/*
2 * Copyright (c) 2004, 2005 Topspin Communications.  All rights reserved.
3 * Copyright (c) 2005 Sun Microsystems, Inc. All rights reserved.
4 * Copyright (c) 2005, 2006 Cisco Systems.  All rights reserved.
5 * Copyright (c) 2005 Mellanox Technologies. All rights reserved.
6 * Copyright (c) 2004 Voltaire, Inc. All rights reserved.
7 *
8 * This software is available to you under a choice of one of two
9 * licenses.  You may choose to be licensed under the terms of the GNU
10 * General Public License (GPL) Version 2, available from the file
11 * COPYING in the main directory of this source tree, or the
12 * OpenIB.org BSD license below:
13 *
14 *     Redistribution and use in source and binary forms, with or
15 *     without modification, are permitted provided that the following
16 *     conditions are met:
17 *
18 *      - Redistributions of source code must retain the above
19 *        copyright notice, this list of conditions and the following
20 *        disclaimer.
21 *
22 *      - Redistributions in binary form must reproduce the above
23 *        copyright notice, this list of conditions and the following
24 *        disclaimer in the documentation and/or other materials
25 *        provided with the distribution.
26 *
27 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
28 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
29 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
30 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
31 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
32 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
33 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
34 * SOFTWARE.
35 */
36
37#include <rdma/ib_smi.h>
38#include <rdma/ib_umem.h>
39#include <rdma/ib_user_verbs.h>
40#include <rdma/uverbs_ioctl.h>
41
42#include <linux/sched.h>
43#include <linux/slab.h>
44#include <linux/stat.h>
45#include <linux/mm.h>
46#include <linux/export.h>
47
48#include "mthca_dev.h"
49#include "mthca_cmd.h"
50#include <rdma/mthca-abi.h>
51#include "mthca_memfree.h"
52
53static void init_query_mad(struct ib_smp *mad)
54{
55	mad->base_version  = 1;
56	mad->mgmt_class    = IB_MGMT_CLASS_SUBN_LID_ROUTED;
57	mad->class_version = 1;
58	mad->method    	   = IB_MGMT_METHOD_GET;
59}
60
61static int mthca_query_device(struct ib_device *ibdev, struct ib_device_attr *props,
62			      struct ib_udata *uhw)
63{
64	struct ib_smp *in_mad  = NULL;
65	struct ib_smp *out_mad = NULL;
66	int err = -ENOMEM;
67	struct mthca_dev *mdev = to_mdev(ibdev);
68
69	if (uhw->inlen || uhw->outlen)
70		return -EINVAL;
71
72	in_mad  = kzalloc(sizeof *in_mad, GFP_KERNEL);
73	out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
74	if (!in_mad || !out_mad)
75		goto out;
76
77	memset(props, 0, sizeof *props);
78
79	props->fw_ver              = mdev->fw_ver;
80
81	init_query_mad(in_mad);
82	in_mad->attr_id = IB_SMP_ATTR_NODE_INFO;
83
84	err = mthca_MAD_IFC(mdev, 1, 1,
85			    1, NULL, NULL, in_mad, out_mad);
86	if (err)
87		goto out;
88
89	props->device_cap_flags    = mdev->device_cap_flags;
90	props->vendor_id           = be32_to_cpup((__be32 *) (out_mad->data + 36)) &
91		0xffffff;
92	props->vendor_part_id      = be16_to_cpup((__be16 *) (out_mad->data + 30));
93	props->hw_ver              = be32_to_cpup((__be32 *) (out_mad->data + 32));
94	memcpy(&props->sys_image_guid, out_mad->data +  4, 8);
95
96	props->max_mr_size         = ~0ull;
97	props->page_size_cap       = mdev->limits.page_size_cap;
98	props->max_qp              = mdev->limits.num_qps - mdev->limits.reserved_qps;
99	props->max_qp_wr           = mdev->limits.max_wqes;
100	props->max_send_sge        = mdev->limits.max_sg;
101	props->max_recv_sge        = mdev->limits.max_sg;
102	props->max_sge_rd          = mdev->limits.max_sg;
103	props->max_cq              = mdev->limits.num_cqs - mdev->limits.reserved_cqs;
104	props->max_cqe             = mdev->limits.max_cqes;
105	props->max_mr              = mdev->limits.num_mpts - mdev->limits.reserved_mrws;
106	props->max_pd              = mdev->limits.num_pds - mdev->limits.reserved_pds;
107	props->max_qp_rd_atom      = 1 << mdev->qp_table.rdb_shift;
108	props->max_qp_init_rd_atom = mdev->limits.max_qp_init_rdma;
109	props->max_res_rd_atom     = props->max_qp_rd_atom * props->max_qp;
110	props->max_srq             = mdev->limits.num_srqs - mdev->limits.reserved_srqs;
111	props->max_srq_wr          = mdev->limits.max_srq_wqes;
112	props->max_srq_sge         = mdev->limits.max_srq_sge;
113	props->local_ca_ack_delay  = mdev->limits.local_ca_ack_delay;
114	props->atomic_cap          = mdev->limits.flags & DEV_LIM_FLAG_ATOMIC ?
115					IB_ATOMIC_HCA : IB_ATOMIC_NONE;
116	props->max_pkeys           = mdev->limits.pkey_table_len;
117	props->max_mcast_grp       = mdev->limits.num_mgms + mdev->limits.num_amgms;
118	props->max_mcast_qp_attach = MTHCA_QP_PER_MGM;
119	props->max_total_mcast_qp_attach = props->max_mcast_qp_attach *
120					   props->max_mcast_grp;
121
122	err = 0;
123 out:
124	kfree(in_mad);
125	kfree(out_mad);
126	return err;
127}
128
129static int mthca_query_port(struct ib_device *ibdev,
130			    u8 port, struct ib_port_attr *props)
131{
132	struct ib_smp *in_mad  = NULL;
133	struct ib_smp *out_mad = NULL;
134	int err = -ENOMEM;
135
136	in_mad  = kzalloc(sizeof *in_mad, GFP_KERNEL);
137	out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
138	if (!in_mad || !out_mad)
139		goto out;
140
141	/* props being zeroed by the caller, avoid zeroing it here */
142
143	init_query_mad(in_mad);
144	in_mad->attr_id  = IB_SMP_ATTR_PORT_INFO;
145	in_mad->attr_mod = cpu_to_be32(port);
146
147	err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1,
148			    port, NULL, NULL, in_mad, out_mad);
149	if (err)
150		goto out;
151
152	props->lid               = be16_to_cpup((__be16 *) (out_mad->data + 16));
153	props->lmc               = out_mad->data[34] & 0x7;
154	props->sm_lid            = be16_to_cpup((__be16 *) (out_mad->data + 18));
155	props->sm_sl             = out_mad->data[36] & 0xf;
156	props->state             = out_mad->data[32] & 0xf;
157	props->phys_state        = out_mad->data[33] >> 4;
158	props->port_cap_flags    = be32_to_cpup((__be32 *) (out_mad->data + 20));
159	props->gid_tbl_len       = to_mdev(ibdev)->limits.gid_table_len;
160	props->max_msg_sz        = 0x80000000;
161	props->pkey_tbl_len      = to_mdev(ibdev)->limits.pkey_table_len;
162	props->bad_pkey_cntr     = be16_to_cpup((__be16 *) (out_mad->data + 46));
163	props->qkey_viol_cntr    = be16_to_cpup((__be16 *) (out_mad->data + 48));
164	props->active_width      = out_mad->data[31] & 0xf;
165	props->active_speed      = out_mad->data[35] >> 4;
166	props->max_mtu           = out_mad->data[41] & 0xf;
167	props->active_mtu        = out_mad->data[36] >> 4;
168	props->subnet_timeout    = out_mad->data[51] & 0x1f;
169	props->max_vl_num        = out_mad->data[37] >> 4;
170	props->init_type_reply   = out_mad->data[41] >> 4;
171
172 out:
173	kfree(in_mad);
174	kfree(out_mad);
175	return err;
176}
177
178static int mthca_modify_device(struct ib_device *ibdev,
179			       int mask,
180			       struct ib_device_modify *props)
181{
182	if (mask & ~IB_DEVICE_MODIFY_NODE_DESC)
183		return -EOPNOTSUPP;
184
185	if (mask & IB_DEVICE_MODIFY_NODE_DESC) {
186		if (mutex_lock_interruptible(&to_mdev(ibdev)->cap_mask_mutex))
187			return -ERESTARTSYS;
188		memcpy(ibdev->node_desc, props->node_desc,
189		       IB_DEVICE_NODE_DESC_MAX);
190		mutex_unlock(&to_mdev(ibdev)->cap_mask_mutex);
191	}
192
193	return 0;
194}
195
196static int mthca_modify_port(struct ib_device *ibdev,
197			     u8 port, int port_modify_mask,
198			     struct ib_port_modify *props)
199{
200	struct mthca_set_ib_param set_ib;
201	struct ib_port_attr attr;
202	int err;
203
204	if (mutex_lock_interruptible(&to_mdev(ibdev)->cap_mask_mutex))
205		return -ERESTARTSYS;
206
207	err = ib_query_port(ibdev, port, &attr);
208	if (err)
209		goto out;
210
211	set_ib.set_si_guid     = 0;
212	set_ib.reset_qkey_viol = !!(port_modify_mask & IB_PORT_RESET_QKEY_CNTR);
213
214	set_ib.cap_mask = (attr.port_cap_flags | props->set_port_cap_mask) &
215		~props->clr_port_cap_mask;
216
217	err = mthca_SET_IB(to_mdev(ibdev), &set_ib, port);
218	if (err)
219		goto out;
220out:
221	mutex_unlock(&to_mdev(ibdev)->cap_mask_mutex);
222	return err;
223}
224
225static int mthca_query_pkey(struct ib_device *ibdev,
226			    u8 port, u16 index, u16 *pkey)
227{
228	struct ib_smp *in_mad  = NULL;
229	struct ib_smp *out_mad = NULL;
230	int err = -ENOMEM;
231
232	in_mad  = kzalloc(sizeof *in_mad, GFP_KERNEL);
233	out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
234	if (!in_mad || !out_mad)
235		goto out;
236
237	init_query_mad(in_mad);
238	in_mad->attr_id  = IB_SMP_ATTR_PKEY_TABLE;
239	in_mad->attr_mod = cpu_to_be32(index / 32);
240
241	err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1,
242			    port, NULL, NULL, in_mad, out_mad);
243	if (err)
244		goto out;
245
246	*pkey = be16_to_cpu(((__be16 *) out_mad->data)[index % 32]);
247
248 out:
249	kfree(in_mad);
250	kfree(out_mad);
251	return err;
252}
253
254static int mthca_query_gid(struct ib_device *ibdev, u8 port,
255			   int index, union ib_gid *gid)
256{
257	struct ib_smp *in_mad  = NULL;
258	struct ib_smp *out_mad = NULL;
259	int err = -ENOMEM;
260
261	in_mad  = kzalloc(sizeof *in_mad, GFP_KERNEL);
262	out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
263	if (!in_mad || !out_mad)
264		goto out;
265
266	init_query_mad(in_mad);
267	in_mad->attr_id  = IB_SMP_ATTR_PORT_INFO;
268	in_mad->attr_mod = cpu_to_be32(port);
269
270	err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1,
271			    port, NULL, NULL, in_mad, out_mad);
272	if (err)
273		goto out;
274
275	memcpy(gid->raw, out_mad->data + 8, 8);
276
277	init_query_mad(in_mad);
278	in_mad->attr_id  = IB_SMP_ATTR_GUID_INFO;
279	in_mad->attr_mod = cpu_to_be32(index / 8);
280
281	err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1,
282			    port, NULL, NULL, in_mad, out_mad);
283	if (err)
284		goto out;
285
286	memcpy(gid->raw + 8, out_mad->data + (index % 8) * 8, 8);
287
288 out:
289	kfree(in_mad);
290	kfree(out_mad);
291	return err;
292}
293
294static int mthca_alloc_ucontext(struct ib_ucontext *uctx,
295				struct ib_udata *udata)
296{
297	struct ib_device *ibdev = uctx->device;
298	struct mthca_alloc_ucontext_resp uresp = {};
299	struct mthca_ucontext *context = to_mucontext(uctx);
300	int                              err;
301
302	if (!(to_mdev(ibdev)->active))
303		return -EAGAIN;
304
305	uresp.qp_tab_size = to_mdev(ibdev)->limits.num_qps;
306	if (mthca_is_memfree(to_mdev(ibdev)))
307		uresp.uarc_size = to_mdev(ibdev)->uar_table.uarc_size;
308	else
309		uresp.uarc_size = 0;
310
311	err = mthca_uar_alloc(to_mdev(ibdev), &context->uar);
312	if (err)
313		return err;
314
315	context->db_tab = mthca_init_user_db_tab(to_mdev(ibdev));
316	if (IS_ERR(context->db_tab)) {
317		err = PTR_ERR(context->db_tab);
318		mthca_uar_free(to_mdev(ibdev), &context->uar);
319		return err;
320	}
321
322	if (ib_copy_to_udata(udata, &uresp, sizeof(uresp))) {
323		mthca_cleanup_user_db_tab(to_mdev(ibdev), &context->uar, context->db_tab);
324		mthca_uar_free(to_mdev(ibdev), &context->uar);
325		return -EFAULT;
326	}
327
328	context->reg_mr_warned = 0;
329
330	return 0;
331}
332
333static void mthca_dealloc_ucontext(struct ib_ucontext *context)
334{
335	mthca_cleanup_user_db_tab(to_mdev(context->device), &to_mucontext(context)->uar,
336				  to_mucontext(context)->db_tab);
337	mthca_uar_free(to_mdev(context->device), &to_mucontext(context)->uar);
338}
339
340static int mthca_mmap_uar(struct ib_ucontext *context,
341			  struct vm_area_struct *vma)
342{
343	if (vma->vm_end - vma->vm_start != PAGE_SIZE)
344		return -EINVAL;
345
346	vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
347
348	if (io_remap_pfn_range(vma, vma->vm_start,
349			       to_mucontext(context)->uar.pfn,
350			       PAGE_SIZE, vma->vm_page_prot))
351		return -EAGAIN;
352
353	return 0;
354}
355
356static int mthca_alloc_pd(struct ib_pd *ibpd, struct ib_udata *udata)
357{
358	struct ib_device *ibdev = ibpd->device;
359	struct mthca_pd *pd = to_mpd(ibpd);
360	int err;
361
362	err = mthca_pd_alloc(to_mdev(ibdev), !udata, pd);
363	if (err)
364		return err;
365
366	if (udata) {
367		if (ib_copy_to_udata(udata, &pd->pd_num, sizeof (__u32))) {
368			mthca_pd_free(to_mdev(ibdev), pd);
369			return -EFAULT;
370		}
371	}
372
373	return 0;
374}
375
376static int mthca_dealloc_pd(struct ib_pd *pd, struct ib_udata *udata)
377{
378	mthca_pd_free(to_mdev(pd->device), to_mpd(pd));
379	return 0;
380}
381
382static int mthca_ah_create(struct ib_ah *ibah,
383			   struct rdma_ah_init_attr *init_attr,
384			   struct ib_udata *udata)
385
386{
387	struct mthca_ah *ah = to_mah(ibah);
388
389	return mthca_create_ah(to_mdev(ibah->device), to_mpd(ibah->pd),
390			       init_attr->ah_attr, ah);
391}
392
393static int mthca_ah_destroy(struct ib_ah *ah, u32 flags)
394{
395	mthca_destroy_ah(to_mdev(ah->device), to_mah(ah));
396	return 0;
397}
398
399static int mthca_create_srq(struct ib_srq *ibsrq,
400			    struct ib_srq_init_attr *init_attr,
401			    struct ib_udata *udata)
402{
403	struct mthca_create_srq ucmd;
404	struct mthca_ucontext *context = rdma_udata_to_drv_context(
405		udata, struct mthca_ucontext, ibucontext);
406	struct mthca_srq *srq = to_msrq(ibsrq);
407	int err;
408
409	if (init_attr->srq_type != IB_SRQT_BASIC)
410		return -EOPNOTSUPP;
411
412	if (udata) {
413		if (ib_copy_from_udata(&ucmd, udata, sizeof(ucmd)))
414			return -EFAULT;
415
416		err = mthca_map_user_db(to_mdev(ibsrq->device), &context->uar,
417					context->db_tab, ucmd.db_index,
418					ucmd.db_page);
419
420		if (err)
421			return err;
422
423		srq->mr.ibmr.lkey = ucmd.lkey;
424		srq->db_index     = ucmd.db_index;
425	}
426
427	err = mthca_alloc_srq(to_mdev(ibsrq->device), to_mpd(ibsrq->pd),
428			      &init_attr->attr, srq, udata);
429
430	if (err && udata)
431		mthca_unmap_user_db(to_mdev(ibsrq->device), &context->uar,
432				    context->db_tab, ucmd.db_index);
433
434	if (err)
435		return err;
436
437	if (context && ib_copy_to_udata(udata, &srq->srqn, sizeof(__u32))) {
438		mthca_free_srq(to_mdev(ibsrq->device), srq);
439		return -EFAULT;
440	}
441
442	return 0;
443}
444
445static int mthca_destroy_srq(struct ib_srq *srq, struct ib_udata *udata)
446{
447	if (udata) {
448		struct mthca_ucontext *context =
449			rdma_udata_to_drv_context(
450				udata,
451				struct mthca_ucontext,
452				ibucontext);
453
454		mthca_unmap_user_db(to_mdev(srq->device), &context->uar,
455				    context->db_tab, to_msrq(srq)->db_index);
456	}
457
458	mthca_free_srq(to_mdev(srq->device), to_msrq(srq));
459	return 0;
460}
461
462static struct ib_qp *mthca_create_qp(struct ib_pd *pd,
463				     struct ib_qp_init_attr *init_attr,
464				     struct ib_udata *udata)
465{
466	struct mthca_ucontext *context = rdma_udata_to_drv_context(
467		udata, struct mthca_ucontext, ibucontext);
468	struct mthca_create_qp ucmd;
469	struct mthca_qp *qp;
470	int err;
471
472	if (init_attr->create_flags)
473		return ERR_PTR(-EINVAL);
474
475	switch (init_attr->qp_type) {
476	case IB_QPT_RC:
477	case IB_QPT_UC:
478	case IB_QPT_UD:
479	{
480		qp = kzalloc(sizeof(*qp), GFP_KERNEL);
481		if (!qp)
482			return ERR_PTR(-ENOMEM);
483
484		if (udata) {
485			if (ib_copy_from_udata(&ucmd, udata, sizeof ucmd)) {
486				kfree(qp);
487				return ERR_PTR(-EFAULT);
488			}
489
490			err = mthca_map_user_db(to_mdev(pd->device), &context->uar,
491						context->db_tab,
492						ucmd.sq_db_index, ucmd.sq_db_page);
493			if (err) {
494				kfree(qp);
495				return ERR_PTR(err);
496			}
497
498			err = mthca_map_user_db(to_mdev(pd->device), &context->uar,
499						context->db_tab,
500						ucmd.rq_db_index, ucmd.rq_db_page);
501			if (err) {
502				mthca_unmap_user_db(to_mdev(pd->device),
503						    &context->uar,
504						    context->db_tab,
505						    ucmd.sq_db_index);
506				kfree(qp);
507				return ERR_PTR(err);
508			}
509
510			qp->mr.ibmr.lkey = ucmd.lkey;
511			qp->sq.db_index  = ucmd.sq_db_index;
512			qp->rq.db_index  = ucmd.rq_db_index;
513		}
514
515		err = mthca_alloc_qp(to_mdev(pd->device), to_mpd(pd),
516				     to_mcq(init_attr->send_cq),
517				     to_mcq(init_attr->recv_cq),
518				     init_attr->qp_type, init_attr->sq_sig_type,
519				     &init_attr->cap, qp, udata);
520
521		if (err && udata) {
522			mthca_unmap_user_db(to_mdev(pd->device),
523					    &context->uar,
524					    context->db_tab,
525					    ucmd.sq_db_index);
526			mthca_unmap_user_db(to_mdev(pd->device),
527					    &context->uar,
528					    context->db_tab,
529					    ucmd.rq_db_index);
530		}
531
532		qp->ibqp.qp_num = qp->qpn;
533		break;
534	}
535	case IB_QPT_SMI:
536	case IB_QPT_GSI:
537	{
538		qp = kzalloc(sizeof(*qp), GFP_KERNEL);
539		if (!qp)
540			return ERR_PTR(-ENOMEM);
541		qp->sqp = kzalloc(sizeof(struct mthca_sqp), GFP_KERNEL);
542		if (!qp->sqp) {
543			kfree(qp);
544			return ERR_PTR(-ENOMEM);
545		}
546
547		qp->ibqp.qp_num = init_attr->qp_type == IB_QPT_SMI ? 0 : 1;
548
549		err = mthca_alloc_sqp(to_mdev(pd->device), to_mpd(pd),
550				      to_mcq(init_attr->send_cq),
551				      to_mcq(init_attr->recv_cq),
552				      init_attr->sq_sig_type, &init_attr->cap,
553				      qp->ibqp.qp_num, init_attr->port_num,
554				      qp, udata);
555		break;
556	}
557	default:
558		/* Don't support raw QPs */
559		return ERR_PTR(-EOPNOTSUPP);
560	}
561
562	if (err) {
563		kfree(qp->sqp);
564		kfree(qp);
565		return ERR_PTR(err);
566	}
567
568	init_attr->cap.max_send_wr     = qp->sq.max;
569	init_attr->cap.max_recv_wr     = qp->rq.max;
570	init_attr->cap.max_send_sge    = qp->sq.max_gs;
571	init_attr->cap.max_recv_sge    = qp->rq.max_gs;
572	init_attr->cap.max_inline_data = qp->max_inline_data;
573
574	return &qp->ibqp;
575}
576
577static int mthca_destroy_qp(struct ib_qp *qp, struct ib_udata *udata)
578{
579	if (udata) {
580		struct mthca_ucontext *context =
581			rdma_udata_to_drv_context(
582				udata,
583				struct mthca_ucontext,
584				ibucontext);
585
586		mthca_unmap_user_db(to_mdev(qp->device),
587				    &context->uar,
588				    context->db_tab,
589				    to_mqp(qp)->sq.db_index);
590		mthca_unmap_user_db(to_mdev(qp->device),
591				    &context->uar,
592				    context->db_tab,
593				    to_mqp(qp)->rq.db_index);
594	}
595	mthca_free_qp(to_mdev(qp->device), to_mqp(qp));
596	kfree(to_mqp(qp)->sqp);
597	kfree(to_mqp(qp));
598	return 0;
599}
600
601static int mthca_create_cq(struct ib_cq *ibcq,
602			   const struct ib_cq_init_attr *attr,
603			   struct ib_udata *udata)
604{
605	struct ib_device *ibdev = ibcq->device;
606	int entries = attr->cqe;
607	struct mthca_create_cq ucmd;
608	struct mthca_cq *cq;
609	int nent;
610	int err;
611	struct mthca_ucontext *context = rdma_udata_to_drv_context(
612		udata, struct mthca_ucontext, ibucontext);
613
614	if (attr->flags)
615		return -EINVAL;
616
617	if (entries < 1 || entries > to_mdev(ibdev)->limits.max_cqes)
618		return -EINVAL;
619
620	if (udata) {
621		if (ib_copy_from_udata(&ucmd, udata, sizeof(ucmd)))
622			return -EFAULT;
623
624		err = mthca_map_user_db(to_mdev(ibdev), &context->uar,
625					context->db_tab, ucmd.set_db_index,
626					ucmd.set_db_page);
627		if (err)
628			return err;
629
630		err = mthca_map_user_db(to_mdev(ibdev), &context->uar,
631					context->db_tab, ucmd.arm_db_index,
632					ucmd.arm_db_page);
633		if (err)
634			goto err_unmap_set;
635	}
636
637	cq = to_mcq(ibcq);
638
639	if (udata) {
640		cq->buf.mr.ibmr.lkey = ucmd.lkey;
641		cq->set_ci_db_index  = ucmd.set_db_index;
642		cq->arm_db_index     = ucmd.arm_db_index;
643	}
644
645	for (nent = 1; nent <= entries; nent <<= 1)
646		; /* nothing */
647
648	err = mthca_init_cq(to_mdev(ibdev), nent, context,
649			    udata ? ucmd.pdn : to_mdev(ibdev)->driver_pd.pd_num,
650			    cq);
651	if (err)
652		goto err_unmap_arm;
653
654	if (udata && ib_copy_to_udata(udata, &cq->cqn, sizeof(__u32))) {
655		mthca_free_cq(to_mdev(ibdev), cq);
656		err = -EFAULT;
657		goto err_unmap_arm;
658	}
659
660	cq->resize_buf = NULL;
661
662	return 0;
663
664err_unmap_arm:
665	if (udata)
666		mthca_unmap_user_db(to_mdev(ibdev), &context->uar,
667				    context->db_tab, ucmd.arm_db_index);
668
669err_unmap_set:
670	if (udata)
671		mthca_unmap_user_db(to_mdev(ibdev), &context->uar,
672				    context->db_tab, ucmd.set_db_index);
673
674	return err;
675}
676
677static int mthca_alloc_resize_buf(struct mthca_dev *dev, struct mthca_cq *cq,
678				  int entries)
679{
680	int ret;
681
682	spin_lock_irq(&cq->lock);
683	if (cq->resize_buf) {
684		ret = -EBUSY;
685		goto unlock;
686	}
687
688	cq->resize_buf = kmalloc(sizeof *cq->resize_buf, GFP_ATOMIC);
689	if (!cq->resize_buf) {
690		ret = -ENOMEM;
691		goto unlock;
692	}
693
694	cq->resize_buf->state = CQ_RESIZE_ALLOC;
695
696	ret = 0;
697
698unlock:
699	spin_unlock_irq(&cq->lock);
700
701	if (ret)
702		return ret;
703
704	ret = mthca_alloc_cq_buf(dev, &cq->resize_buf->buf, entries);
705	if (ret) {
706		spin_lock_irq(&cq->lock);
707		kfree(cq->resize_buf);
708		cq->resize_buf = NULL;
709		spin_unlock_irq(&cq->lock);
710		return ret;
711	}
712
713	cq->resize_buf->cqe = entries - 1;
714
715	spin_lock_irq(&cq->lock);
716	cq->resize_buf->state = CQ_RESIZE_READY;
717	spin_unlock_irq(&cq->lock);
718
719	return 0;
720}
721
722static int mthca_resize_cq(struct ib_cq *ibcq, int entries, struct ib_udata *udata)
723{
724	struct mthca_dev *dev = to_mdev(ibcq->device);
725	struct mthca_cq *cq = to_mcq(ibcq);
726	struct mthca_resize_cq ucmd;
727	u32 lkey;
728	int ret;
729
730	if (entries < 1 || entries > dev->limits.max_cqes)
731		return -EINVAL;
732
733	mutex_lock(&cq->mutex);
734
735	entries = roundup_pow_of_two(entries + 1);
736	if (entries == ibcq->cqe + 1) {
737		ret = 0;
738		goto out;
739	}
740
741	if (cq->is_kernel) {
742		ret = mthca_alloc_resize_buf(dev, cq, entries);
743		if (ret)
744			goto out;
745		lkey = cq->resize_buf->buf.mr.ibmr.lkey;
746	} else {
747		if (ib_copy_from_udata(&ucmd, udata, sizeof ucmd)) {
748			ret = -EFAULT;
749			goto out;
750		}
751		lkey = ucmd.lkey;
752	}
753
754	ret = mthca_RESIZE_CQ(dev, cq->cqn, lkey, ilog2(entries));
755
756	if (ret) {
757		if (cq->resize_buf) {
758			mthca_free_cq_buf(dev, &cq->resize_buf->buf,
759					  cq->resize_buf->cqe);
760			kfree(cq->resize_buf);
761			spin_lock_irq(&cq->lock);
762			cq->resize_buf = NULL;
763			spin_unlock_irq(&cq->lock);
764		}
765		goto out;
766	}
767
768	if (cq->is_kernel) {
769		struct mthca_cq_buf tbuf;
770		int tcqe;
771
772		spin_lock_irq(&cq->lock);
773		if (cq->resize_buf->state == CQ_RESIZE_READY) {
774			mthca_cq_resize_copy_cqes(cq);
775			tbuf         = cq->buf;
776			tcqe         = cq->ibcq.cqe;
777			cq->buf      = cq->resize_buf->buf;
778			cq->ibcq.cqe = cq->resize_buf->cqe;
779		} else {
780			tbuf = cq->resize_buf->buf;
781			tcqe = cq->resize_buf->cqe;
782		}
783
784		kfree(cq->resize_buf);
785		cq->resize_buf = NULL;
786		spin_unlock_irq(&cq->lock);
787
788		mthca_free_cq_buf(dev, &tbuf, tcqe);
789	} else
790		ibcq->cqe = entries - 1;
791
792out:
793	mutex_unlock(&cq->mutex);
794
795	return ret;
796}
797
798static int mthca_destroy_cq(struct ib_cq *cq, struct ib_udata *udata)
799{
800	if (udata) {
801		struct mthca_ucontext *context =
802			rdma_udata_to_drv_context(
803				udata,
804				struct mthca_ucontext,
805				ibucontext);
806
807		mthca_unmap_user_db(to_mdev(cq->device),
808				    &context->uar,
809				    context->db_tab,
810				    to_mcq(cq)->arm_db_index);
811		mthca_unmap_user_db(to_mdev(cq->device),
812				    &context->uar,
813				    context->db_tab,
814				    to_mcq(cq)->set_ci_db_index);
815	}
816	mthca_free_cq(to_mdev(cq->device), to_mcq(cq));
817	return 0;
818}
819
820static inline u32 convert_access(int acc)
821{
822	return (acc & IB_ACCESS_REMOTE_ATOMIC ? MTHCA_MPT_FLAG_ATOMIC       : 0) |
823	       (acc & IB_ACCESS_REMOTE_WRITE  ? MTHCA_MPT_FLAG_REMOTE_WRITE : 0) |
824	       (acc & IB_ACCESS_REMOTE_READ   ? MTHCA_MPT_FLAG_REMOTE_READ  : 0) |
825	       (acc & IB_ACCESS_LOCAL_WRITE   ? MTHCA_MPT_FLAG_LOCAL_WRITE  : 0) |
826	       MTHCA_MPT_FLAG_LOCAL_READ;
827}
828
829static struct ib_mr *mthca_get_dma_mr(struct ib_pd *pd, int acc)
830{
831	struct mthca_mr *mr;
832	int err;
833
834	mr = kmalloc(sizeof *mr, GFP_KERNEL);
835	if (!mr)
836		return ERR_PTR(-ENOMEM);
837
838	err = mthca_mr_alloc_notrans(to_mdev(pd->device),
839				     to_mpd(pd)->pd_num,
840				     convert_access(acc), mr);
841
842	if (err) {
843		kfree(mr);
844		return ERR_PTR(err);
845	}
846
847	mr->umem = NULL;
848
849	return &mr->ibmr;
850}
851
852static struct ib_mr *mthca_reg_user_mr(struct ib_pd *pd, u64 start, u64 length,
853				       u64 virt, int acc, struct ib_udata *udata)
854{
855	struct mthca_dev *dev = to_mdev(pd->device);
856	struct ib_block_iter biter;
857	struct mthca_ucontext *context = rdma_udata_to_drv_context(
858		udata, struct mthca_ucontext, ibucontext);
859	struct mthca_mr *mr;
860	struct mthca_reg_mr ucmd;
861	u64 *pages;
862	int n, i;
863	int err = 0;
864	int write_mtt_size;
865
866	if (udata->inlen < sizeof ucmd) {
867		if (!context->reg_mr_warned) {
868			mthca_warn(dev, "Process '%s' did not pass in MR attrs.\n",
869				   current->comm);
870			mthca_warn(dev, "  Update libmthca to fix this.\n");
871		}
872		++context->reg_mr_warned;
873		ucmd.mr_attrs = 0;
874	} else if (ib_copy_from_udata(&ucmd, udata, sizeof ucmd))
875		return ERR_PTR(-EFAULT);
876
877	mr = kmalloc(sizeof *mr, GFP_KERNEL);
878	if (!mr)
879		return ERR_PTR(-ENOMEM);
880
881	mr->umem = ib_umem_get(pd->device, start, length, acc);
882	if (IS_ERR(mr->umem)) {
883		err = PTR_ERR(mr->umem);
884		goto err;
885	}
886
887	n = ib_umem_num_dma_blocks(mr->umem, PAGE_SIZE);
888
889	mr->mtt = mthca_alloc_mtt(dev, n);
890	if (IS_ERR(mr->mtt)) {
891		err = PTR_ERR(mr->mtt);
892		goto err_umem;
893	}
894
895	pages = (u64 *) __get_free_page(GFP_KERNEL);
896	if (!pages) {
897		err = -ENOMEM;
898		goto err_mtt;
899	}
900
901	i = n = 0;
902
903	write_mtt_size = min(mthca_write_mtt_size(dev), (int) (PAGE_SIZE / sizeof *pages));
904
905	rdma_umem_for_each_dma_block(mr->umem, &biter, PAGE_SIZE) {
906		pages[i++] = rdma_block_iter_dma_address(&biter);
907
908		/*
909		 * Be friendly to write_mtt and pass it chunks
910		 * of appropriate size.
911		 */
912		if (i == write_mtt_size) {
913			err = mthca_write_mtt(dev, mr->mtt, n, pages, i);
914			if (err)
915				goto mtt_done;
916			n += i;
917			i = 0;
918		}
919	}
920
921	if (i)
922		err = mthca_write_mtt(dev, mr->mtt, n, pages, i);
923mtt_done:
924	free_page((unsigned long) pages);
925	if (err)
926		goto err_mtt;
927
928	err = mthca_mr_alloc(dev, to_mpd(pd)->pd_num, PAGE_SHIFT, virt, length,
929			     convert_access(acc), mr);
930
931	if (err)
932		goto err_mtt;
933
934	return &mr->ibmr;
935
936err_mtt:
937	mthca_free_mtt(dev, mr->mtt);
938
939err_umem:
940	ib_umem_release(mr->umem);
941
942err:
943	kfree(mr);
944	return ERR_PTR(err);
945}
946
947static int mthca_dereg_mr(struct ib_mr *mr, struct ib_udata *udata)
948{
949	struct mthca_mr *mmr = to_mmr(mr);
950
951	mthca_free_mr(to_mdev(mr->device), mmr);
952	ib_umem_release(mmr->umem);
953	kfree(mmr);
954
955	return 0;
956}
957
958static ssize_t hw_rev_show(struct device *device,
959			   struct device_attribute *attr, char *buf)
960{
961	struct mthca_dev *dev =
962		rdma_device_to_drv_device(device, struct mthca_dev, ib_dev);
963
964	return sprintf(buf, "%x\n", dev->rev_id);
965}
966static DEVICE_ATTR_RO(hw_rev);
967
968static ssize_t hca_type_show(struct device *device,
969			     struct device_attribute *attr, char *buf)
970{
971	struct mthca_dev *dev =
972		rdma_device_to_drv_device(device, struct mthca_dev, ib_dev);
973
974	switch (dev->pdev->device) {
975	case PCI_DEVICE_ID_MELLANOX_TAVOR:
976		return sprintf(buf, "MT23108\n");
977	case PCI_DEVICE_ID_MELLANOX_ARBEL_COMPAT:
978		return sprintf(buf, "MT25208 (MT23108 compat mode)\n");
979	case PCI_DEVICE_ID_MELLANOX_ARBEL:
980		return sprintf(buf, "MT25208\n");
981	case PCI_DEVICE_ID_MELLANOX_SINAI:
982	case PCI_DEVICE_ID_MELLANOX_SINAI_OLD:
983		return sprintf(buf, "MT25204\n");
984	default:
985		return sprintf(buf, "unknown\n");
986	}
987}
988static DEVICE_ATTR_RO(hca_type);
989
990static ssize_t board_id_show(struct device *device,
991			     struct device_attribute *attr, char *buf)
992{
993	struct mthca_dev *dev =
994		rdma_device_to_drv_device(device, struct mthca_dev, ib_dev);
995
996	return sprintf(buf, "%.*s\n", MTHCA_BOARD_ID_LEN, dev->board_id);
997}
998static DEVICE_ATTR_RO(board_id);
999
1000static struct attribute *mthca_dev_attributes[] = {
1001	&dev_attr_hw_rev.attr,
1002	&dev_attr_hca_type.attr,
1003	&dev_attr_board_id.attr,
1004	NULL
1005};
1006
1007static const struct attribute_group mthca_attr_group = {
1008	.attrs = mthca_dev_attributes,
1009};
1010
1011static int mthca_init_node_data(struct mthca_dev *dev)
1012{
1013	struct ib_smp *in_mad  = NULL;
1014	struct ib_smp *out_mad = NULL;
1015	int err = -ENOMEM;
1016
1017	in_mad  = kzalloc(sizeof *in_mad, GFP_KERNEL);
1018	out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL);
1019	if (!in_mad || !out_mad)
1020		goto out;
1021
1022	init_query_mad(in_mad);
1023	in_mad->attr_id = IB_SMP_ATTR_NODE_DESC;
1024
1025	err = mthca_MAD_IFC(dev, 1, 1,
1026			    1, NULL, NULL, in_mad, out_mad);
1027	if (err)
1028		goto out;
1029
1030	memcpy(dev->ib_dev.node_desc, out_mad->data, IB_DEVICE_NODE_DESC_MAX);
1031
1032	in_mad->attr_id = IB_SMP_ATTR_NODE_INFO;
1033
1034	err = mthca_MAD_IFC(dev, 1, 1,
1035			    1, NULL, NULL, in_mad, out_mad);
1036	if (err)
1037		goto out;
1038
1039	if (mthca_is_memfree(dev))
1040		dev->rev_id = be32_to_cpup((__be32 *) (out_mad->data + 32));
1041	memcpy(&dev->ib_dev.node_guid, out_mad->data + 12, 8);
1042
1043out:
1044	kfree(in_mad);
1045	kfree(out_mad);
1046	return err;
1047}
1048
1049static int mthca_port_immutable(struct ib_device *ibdev, u8 port_num,
1050			        struct ib_port_immutable *immutable)
1051{
1052	struct ib_port_attr attr;
1053	int err;
1054
1055	immutable->core_cap_flags = RDMA_CORE_PORT_IBA_IB;
1056
1057	err = ib_query_port(ibdev, port_num, &attr);
1058	if (err)
1059		return err;
1060
1061	immutable->pkey_tbl_len = attr.pkey_tbl_len;
1062	immutable->gid_tbl_len = attr.gid_tbl_len;
1063	immutable->max_mad_size = IB_MGMT_MAD_SIZE;
1064
1065	return 0;
1066}
1067
1068static void get_dev_fw_str(struct ib_device *device, char *str)
1069{
1070	struct mthca_dev *dev =
1071		container_of(device, struct mthca_dev, ib_dev);
1072	snprintf(str, IB_FW_VERSION_NAME_MAX, "%d.%d.%d",
1073		 (int) (dev->fw_ver >> 32),
1074		 (int) (dev->fw_ver >> 16) & 0xffff,
1075		 (int) dev->fw_ver & 0xffff);
1076}
1077
1078static const struct ib_device_ops mthca_dev_ops = {
1079	.owner = THIS_MODULE,
1080	.driver_id = RDMA_DRIVER_MTHCA,
1081	.uverbs_abi_ver = MTHCA_UVERBS_ABI_VERSION,
1082	.uverbs_no_driver_id_binding = 1,
1083
1084	.alloc_pd = mthca_alloc_pd,
1085	.alloc_ucontext = mthca_alloc_ucontext,
1086	.attach_mcast = mthca_multicast_attach,
1087	.create_ah = mthca_ah_create,
1088	.create_cq = mthca_create_cq,
1089	.create_qp = mthca_create_qp,
1090	.dealloc_pd = mthca_dealloc_pd,
1091	.dealloc_ucontext = mthca_dealloc_ucontext,
1092	.dereg_mr = mthca_dereg_mr,
1093	.destroy_ah = mthca_ah_destroy,
1094	.destroy_cq = mthca_destroy_cq,
1095	.destroy_qp = mthca_destroy_qp,
1096	.detach_mcast = mthca_multicast_detach,
1097	.get_dev_fw_str = get_dev_fw_str,
1098	.get_dma_mr = mthca_get_dma_mr,
1099	.get_port_immutable = mthca_port_immutable,
1100	.mmap = mthca_mmap_uar,
1101	.modify_device = mthca_modify_device,
1102	.modify_port = mthca_modify_port,
1103	.modify_qp = mthca_modify_qp,
1104	.poll_cq = mthca_poll_cq,
1105	.process_mad = mthca_process_mad,
1106	.query_ah = mthca_ah_query,
1107	.query_device = mthca_query_device,
1108	.query_gid = mthca_query_gid,
1109	.query_pkey = mthca_query_pkey,
1110	.query_port = mthca_query_port,
1111	.query_qp = mthca_query_qp,
1112	.reg_user_mr = mthca_reg_user_mr,
1113	.resize_cq = mthca_resize_cq,
1114
1115	INIT_RDMA_OBJ_SIZE(ib_ah, mthca_ah, ibah),
1116	INIT_RDMA_OBJ_SIZE(ib_cq, mthca_cq, ibcq),
1117	INIT_RDMA_OBJ_SIZE(ib_pd, mthca_pd, ibpd),
1118	INIT_RDMA_OBJ_SIZE(ib_ucontext, mthca_ucontext, ibucontext),
1119};
1120
1121static const struct ib_device_ops mthca_dev_arbel_srq_ops = {
1122	.create_srq = mthca_create_srq,
1123	.destroy_srq = mthca_destroy_srq,
1124	.modify_srq = mthca_modify_srq,
1125	.post_srq_recv = mthca_arbel_post_srq_recv,
1126	.query_srq = mthca_query_srq,
1127
1128	INIT_RDMA_OBJ_SIZE(ib_srq, mthca_srq, ibsrq),
1129};
1130
1131static const struct ib_device_ops mthca_dev_tavor_srq_ops = {
1132	.create_srq = mthca_create_srq,
1133	.destroy_srq = mthca_destroy_srq,
1134	.modify_srq = mthca_modify_srq,
1135	.post_srq_recv = mthca_tavor_post_srq_recv,
1136	.query_srq = mthca_query_srq,
1137
1138	INIT_RDMA_OBJ_SIZE(ib_srq, mthca_srq, ibsrq),
1139};
1140
1141static const struct ib_device_ops mthca_dev_arbel_ops = {
1142	.post_recv = mthca_arbel_post_receive,
1143	.post_send = mthca_arbel_post_send,
1144	.req_notify_cq = mthca_arbel_arm_cq,
1145};
1146
1147static const struct ib_device_ops mthca_dev_tavor_ops = {
1148	.post_recv = mthca_tavor_post_receive,
1149	.post_send = mthca_tavor_post_send,
1150	.req_notify_cq = mthca_tavor_arm_cq,
1151};
1152
1153int mthca_register_device(struct mthca_dev *dev)
1154{
1155	int ret;
1156
1157	ret = mthca_init_node_data(dev);
1158	if (ret)
1159		return ret;
1160
1161	dev->ib_dev.uverbs_cmd_mask	 =
1162		(1ull << IB_USER_VERBS_CMD_GET_CONTEXT)		|
1163		(1ull << IB_USER_VERBS_CMD_QUERY_DEVICE)	|
1164		(1ull << IB_USER_VERBS_CMD_QUERY_PORT)		|
1165		(1ull << IB_USER_VERBS_CMD_ALLOC_PD)		|
1166		(1ull << IB_USER_VERBS_CMD_DEALLOC_PD)		|
1167		(1ull << IB_USER_VERBS_CMD_REG_MR)		|
1168		(1ull << IB_USER_VERBS_CMD_DEREG_MR)		|
1169		(1ull << IB_USER_VERBS_CMD_CREATE_COMP_CHANNEL)	|
1170		(1ull << IB_USER_VERBS_CMD_CREATE_CQ)		|
1171		(1ull << IB_USER_VERBS_CMD_RESIZE_CQ)		|
1172		(1ull << IB_USER_VERBS_CMD_DESTROY_CQ)		|
1173		(1ull << IB_USER_VERBS_CMD_CREATE_QP)		|
1174		(1ull << IB_USER_VERBS_CMD_QUERY_QP)		|
1175		(1ull << IB_USER_VERBS_CMD_MODIFY_QP)		|
1176		(1ull << IB_USER_VERBS_CMD_DESTROY_QP)		|
1177		(1ull << IB_USER_VERBS_CMD_ATTACH_MCAST)	|
1178		(1ull << IB_USER_VERBS_CMD_DETACH_MCAST);
1179	dev->ib_dev.node_type            = RDMA_NODE_IB_CA;
1180	dev->ib_dev.phys_port_cnt        = dev->limits.num_ports;
1181	dev->ib_dev.num_comp_vectors     = 1;
1182	dev->ib_dev.dev.parent           = &dev->pdev->dev;
1183
1184	if (dev->mthca_flags & MTHCA_FLAG_SRQ) {
1185		dev->ib_dev.uverbs_cmd_mask	|=
1186			(1ull << IB_USER_VERBS_CMD_CREATE_SRQ)		|
1187			(1ull << IB_USER_VERBS_CMD_MODIFY_SRQ)		|
1188			(1ull << IB_USER_VERBS_CMD_QUERY_SRQ)		|
1189			(1ull << IB_USER_VERBS_CMD_DESTROY_SRQ);
1190
1191		if (mthca_is_memfree(dev))
1192			ib_set_device_ops(&dev->ib_dev,
1193					  &mthca_dev_arbel_srq_ops);
1194		else
1195			ib_set_device_ops(&dev->ib_dev,
1196					  &mthca_dev_tavor_srq_ops);
1197	}
1198
1199	ib_set_device_ops(&dev->ib_dev, &mthca_dev_ops);
1200
1201	if (mthca_is_memfree(dev))
1202		ib_set_device_ops(&dev->ib_dev, &mthca_dev_arbel_ops);
1203	else
1204		ib_set_device_ops(&dev->ib_dev, &mthca_dev_tavor_ops);
1205
1206	mutex_init(&dev->cap_mask_mutex);
1207
1208	rdma_set_device_sysfs_group(&dev->ib_dev, &mthca_attr_group);
1209	ret = ib_register_device(&dev->ib_dev, "mthca%d", &dev->pdev->dev);
1210	if (ret)
1211		return ret;
1212
1213	mthca_start_catas_poll(dev);
1214
1215	return 0;
1216}
1217
1218void mthca_unregister_device(struct mthca_dev *dev)
1219{
1220	mthca_stop_catas_poll(dev);
1221	ib_unregister_device(&dev->ib_dev);
1222}
1223