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 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 * $Id: mthca_provider.c 1397 2004-12-28 05:09:00Z roland $ 37 */ 38 39 #include <rdma/ib_smi.h> 40 #include <linux/mm.h> 41 42 #include "mthca_dev.h" 43 #include "mthca_cmd.h" 44 #include "mthca_user.h" 45 #include "mthca_memfree.h" 46 47 static int mthca_query_device(struct ib_device *ibdev, 48 struct ib_device_attr *props) 49 { 50 struct ib_smp *in_mad = NULL; 51 struct ib_smp *out_mad = NULL; 52 int err = -ENOMEM; 53 struct mthca_dev* mdev = to_mdev(ibdev); 54 55 u8 status; 56 57 in_mad = kmalloc(sizeof *in_mad, GFP_KERNEL); 58 out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL); 59 if (!in_mad || !out_mad) 60 goto out; 61 62 memset(props, 0, sizeof *props); 63 64 props->fw_ver = mdev->fw_ver; 65 66 memset(in_mad, 0, sizeof *in_mad); 67 in_mad->base_version = 1; 68 in_mad->mgmt_class = IB_MGMT_CLASS_SUBN_LID_ROUTED; 69 in_mad->class_version = 1; 70 in_mad->method = IB_MGMT_METHOD_GET; 71 in_mad->attr_id = IB_SMP_ATTR_NODE_INFO; 72 73 err = mthca_MAD_IFC(mdev, 1, 1, 74 1, NULL, NULL, in_mad, out_mad, 75 &status); 76 if (err) 77 goto out; 78 if (status) { 79 err = -EINVAL; 80 goto out; 81 } 82 83 props->device_cap_flags = mdev->device_cap_flags; 84 props->vendor_id = be32_to_cpup((__be32 *) (out_mad->data + 36)) & 85 0xffffff; 86 props->vendor_part_id = be16_to_cpup((__be16 *) (out_mad->data + 30)); 87 props->hw_ver = be32_to_cpup((__be32 *) (out_mad->data + 32)); 88 memcpy(&props->sys_image_guid, out_mad->data + 4, 8); 89 memcpy(&props->node_guid, out_mad->data + 12, 8); 90 91 props->max_mr_size = ~0ull; 92 props->max_qp = mdev->limits.num_qps - mdev->limits.reserved_qps; 93 props->max_qp_wr = 0xffff; 94 props->max_sge = mdev->limits.max_sg; 95 props->max_cq = mdev->limits.num_cqs - mdev->limits.reserved_cqs; 96 props->max_cqe = 0xffff; 97 props->max_mr = mdev->limits.num_mpts - mdev->limits.reserved_mrws; 98 props->max_pd = mdev->limits.num_pds - mdev->limits.reserved_pds; 99 props->max_qp_rd_atom = 1 << mdev->qp_table.rdb_shift; 100 props->max_qp_init_rd_atom = 1 << mdev->qp_table.rdb_shift; 101 props->local_ca_ack_delay = mdev->limits.local_ca_ack_delay; 102 103 err = 0; 104 out: 105 kfree(in_mad); 106 kfree(out_mad); 107 return err; 108 } 109 110 static int mthca_query_port(struct ib_device *ibdev, 111 u8 port, struct ib_port_attr *props) 112 { 113 struct ib_smp *in_mad = NULL; 114 struct ib_smp *out_mad = NULL; 115 int err = -ENOMEM; 116 u8 status; 117 118 in_mad = kmalloc(sizeof *in_mad, GFP_KERNEL); 119 out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL); 120 if (!in_mad || !out_mad) 121 goto out; 122 123 memset(props, 0, sizeof *props); 124 125 memset(in_mad, 0, sizeof *in_mad); 126 in_mad->base_version = 1; 127 in_mad->mgmt_class = IB_MGMT_CLASS_SUBN_LID_ROUTED; 128 in_mad->class_version = 1; 129 in_mad->method = IB_MGMT_METHOD_GET; 130 in_mad->attr_id = IB_SMP_ATTR_PORT_INFO; 131 in_mad->attr_mod = cpu_to_be32(port); 132 133 err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1, 134 port, NULL, NULL, in_mad, out_mad, 135 &status); 136 if (err) 137 goto out; 138 if (status) { 139 err = -EINVAL; 140 goto out; 141 } 142 143 props->lid = be16_to_cpup((__be16 *) (out_mad->data + 16)); 144 props->lmc = out_mad->data[34] & 0x7; 145 props->sm_lid = be16_to_cpup((__be16 *) (out_mad->data + 18)); 146 props->sm_sl = out_mad->data[36] & 0xf; 147 props->state = out_mad->data[32] & 0xf; 148 props->phys_state = out_mad->data[33] >> 4; 149 props->port_cap_flags = be32_to_cpup((__be32 *) (out_mad->data + 20)); 150 props->gid_tbl_len = to_mdev(ibdev)->limits.gid_table_len; 151 props->max_msg_sz = 0x80000000; 152 props->pkey_tbl_len = to_mdev(ibdev)->limits.pkey_table_len; 153 props->qkey_viol_cntr = be16_to_cpup((__be16 *) (out_mad->data + 48)); 154 props->active_width = out_mad->data[31] & 0xf; 155 props->active_speed = out_mad->data[35] >> 4; 156 157 out: 158 kfree(in_mad); 159 kfree(out_mad); 160 return err; 161 } 162 163 static int mthca_modify_port(struct ib_device *ibdev, 164 u8 port, int port_modify_mask, 165 struct ib_port_modify *props) 166 { 167 struct mthca_set_ib_param set_ib; 168 struct ib_port_attr attr; 169 int err; 170 u8 status; 171 172 if (down_interruptible(&to_mdev(ibdev)->cap_mask_mutex)) 173 return -ERESTARTSYS; 174 175 err = mthca_query_port(ibdev, port, &attr); 176 if (err) 177 goto out; 178 179 set_ib.set_si_guid = 0; 180 set_ib.reset_qkey_viol = !!(port_modify_mask & IB_PORT_RESET_QKEY_CNTR); 181 182 set_ib.cap_mask = (attr.port_cap_flags | props->set_port_cap_mask) & 183 ~props->clr_port_cap_mask; 184 185 err = mthca_SET_IB(to_mdev(ibdev), &set_ib, port, &status); 186 if (err) 187 goto out; 188 if (status) { 189 err = -EINVAL; 190 goto out; 191 } 192 193 out: 194 up(&to_mdev(ibdev)->cap_mask_mutex); 195 return err; 196 } 197 198 static int mthca_query_pkey(struct ib_device *ibdev, 199 u8 port, u16 index, u16 *pkey) 200 { 201 struct ib_smp *in_mad = NULL; 202 struct ib_smp *out_mad = NULL; 203 int err = -ENOMEM; 204 u8 status; 205 206 in_mad = kmalloc(sizeof *in_mad, GFP_KERNEL); 207 out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL); 208 if (!in_mad || !out_mad) 209 goto out; 210 211 memset(in_mad, 0, sizeof *in_mad); 212 in_mad->base_version = 1; 213 in_mad->mgmt_class = IB_MGMT_CLASS_SUBN_LID_ROUTED; 214 in_mad->class_version = 1; 215 in_mad->method = IB_MGMT_METHOD_GET; 216 in_mad->attr_id = IB_SMP_ATTR_PKEY_TABLE; 217 in_mad->attr_mod = cpu_to_be32(index / 32); 218 219 err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1, 220 port, NULL, NULL, in_mad, out_mad, 221 &status); 222 if (err) 223 goto out; 224 if (status) { 225 err = -EINVAL; 226 goto out; 227 } 228 229 *pkey = be16_to_cpu(((__be16 *) out_mad->data)[index % 32]); 230 231 out: 232 kfree(in_mad); 233 kfree(out_mad); 234 return err; 235 } 236 237 static int mthca_query_gid(struct ib_device *ibdev, u8 port, 238 int index, union ib_gid *gid) 239 { 240 struct ib_smp *in_mad = NULL; 241 struct ib_smp *out_mad = NULL; 242 int err = -ENOMEM; 243 u8 status; 244 245 in_mad = kmalloc(sizeof *in_mad, GFP_KERNEL); 246 out_mad = kmalloc(sizeof *out_mad, GFP_KERNEL); 247 if (!in_mad || !out_mad) 248 goto out; 249 250 memset(in_mad, 0, sizeof *in_mad); 251 in_mad->base_version = 1; 252 in_mad->mgmt_class = IB_MGMT_CLASS_SUBN_LID_ROUTED; 253 in_mad->class_version = 1; 254 in_mad->method = IB_MGMT_METHOD_GET; 255 in_mad->attr_id = IB_SMP_ATTR_PORT_INFO; 256 in_mad->attr_mod = cpu_to_be32(port); 257 258 err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1, 259 port, NULL, NULL, in_mad, out_mad, 260 &status); 261 if (err) 262 goto out; 263 if (status) { 264 err = -EINVAL; 265 goto out; 266 } 267 268 memcpy(gid->raw, out_mad->data + 8, 8); 269 270 memset(in_mad, 0, sizeof *in_mad); 271 in_mad->base_version = 1; 272 in_mad->mgmt_class = IB_MGMT_CLASS_SUBN_LID_ROUTED; 273 in_mad->class_version = 1; 274 in_mad->method = IB_MGMT_METHOD_GET; 275 in_mad->attr_id = IB_SMP_ATTR_GUID_INFO; 276 in_mad->attr_mod = cpu_to_be32(index / 8); 277 278 err = mthca_MAD_IFC(to_mdev(ibdev), 1, 1, 279 port, NULL, NULL, in_mad, out_mad, 280 &status); 281 if (err) 282 goto out; 283 if (status) { 284 err = -EINVAL; 285 goto out; 286 } 287 288 memcpy(gid->raw + 8, out_mad->data + (index % 8) * 16, 8); 289 290 out: 291 kfree(in_mad); 292 kfree(out_mad); 293 return err; 294 } 295 296 static struct ib_ucontext *mthca_alloc_ucontext(struct ib_device *ibdev, 297 struct ib_udata *udata) 298 { 299 struct mthca_alloc_ucontext_resp uresp; 300 struct mthca_ucontext *context; 301 int err; 302 303 memset(&uresp, 0, sizeof uresp); 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 context = kmalloc(sizeof *context, GFP_KERNEL); 312 if (!context) 313 return ERR_PTR(-ENOMEM); 314 315 err = mthca_uar_alloc(to_mdev(ibdev), &context->uar); 316 if (err) { 317 kfree(context); 318 return ERR_PTR(err); 319 } 320 321 context->db_tab = mthca_init_user_db_tab(to_mdev(ibdev)); 322 if (IS_ERR(context->db_tab)) { 323 err = PTR_ERR(context->db_tab); 324 mthca_uar_free(to_mdev(ibdev), &context->uar); 325 kfree(context); 326 return ERR_PTR(err); 327 } 328 329 if (ib_copy_to_udata(udata, &uresp, sizeof uresp)) { 330 mthca_cleanup_user_db_tab(to_mdev(ibdev), &context->uar, context->db_tab); 331 mthca_uar_free(to_mdev(ibdev), &context->uar); 332 kfree(context); 333 return ERR_PTR(-EFAULT); 334 } 335 336 return &context->ibucontext; 337 } 338 339 static int mthca_dealloc_ucontext(struct ib_ucontext *context) 340 { 341 mthca_cleanup_user_db_tab(to_mdev(context->device), &to_mucontext(context)->uar, 342 to_mucontext(context)->db_tab); 343 mthca_uar_free(to_mdev(context->device), &to_mucontext(context)->uar); 344 kfree(to_mucontext(context)); 345 346 return 0; 347 } 348 349 static int mthca_mmap_uar(struct ib_ucontext *context, 350 struct vm_area_struct *vma) 351 { 352 if (vma->vm_end - vma->vm_start != PAGE_SIZE) 353 return -EINVAL; 354 355 vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); 356 357 if (io_remap_pfn_range(vma, vma->vm_start, 358 to_mucontext(context)->uar.pfn, 359 PAGE_SIZE, vma->vm_page_prot)) 360 return -EAGAIN; 361 362 return 0; 363 } 364 365 static struct ib_pd *mthca_alloc_pd(struct ib_device *ibdev, 366 struct ib_ucontext *context, 367 struct ib_udata *udata) 368 { 369 struct mthca_pd *pd; 370 int err; 371 372 pd = kmalloc(sizeof *pd, GFP_KERNEL); 373 if (!pd) 374 return ERR_PTR(-ENOMEM); 375 376 err = mthca_pd_alloc(to_mdev(ibdev), !context, pd); 377 if (err) { 378 kfree(pd); 379 return ERR_PTR(err); 380 } 381 382 if (context) { 383 if (ib_copy_to_udata(udata, &pd->pd_num, sizeof (__u32))) { 384 mthca_pd_free(to_mdev(ibdev), pd); 385 kfree(pd); 386 return ERR_PTR(-EFAULT); 387 } 388 } 389 390 return &pd->ibpd; 391 } 392 393 static int mthca_dealloc_pd(struct ib_pd *pd) 394 { 395 mthca_pd_free(to_mdev(pd->device), to_mpd(pd)); 396 kfree(pd); 397 398 return 0; 399 } 400 401 static struct ib_ah *mthca_ah_create(struct ib_pd *pd, 402 struct ib_ah_attr *ah_attr) 403 { 404 int err; 405 struct mthca_ah *ah; 406 407 ah = kmalloc(sizeof *ah, GFP_ATOMIC); 408 if (!ah) 409 return ERR_PTR(-ENOMEM); 410 411 err = mthca_create_ah(to_mdev(pd->device), to_mpd(pd), ah_attr, ah); 412 if (err) { 413 kfree(ah); 414 return ERR_PTR(err); 415 } 416 417 return &ah->ibah; 418 } 419 420 static int mthca_ah_destroy(struct ib_ah *ah) 421 { 422 mthca_destroy_ah(to_mdev(ah->device), to_mah(ah)); 423 kfree(ah); 424 425 return 0; 426 } 427 428 static struct ib_srq *mthca_create_srq(struct ib_pd *pd, 429 struct ib_srq_init_attr *init_attr, 430 struct ib_udata *udata) 431 { 432 struct mthca_create_srq ucmd; 433 struct mthca_ucontext *context = NULL; 434 struct mthca_srq *srq; 435 int err; 436 437 srq = kmalloc(sizeof *srq, GFP_KERNEL); 438 if (!srq) 439 return ERR_PTR(-ENOMEM); 440 441 if (pd->uobject) { 442 context = to_mucontext(pd->uobject->context); 443 444 if (ib_copy_from_udata(&ucmd, udata, sizeof ucmd)) 445 return ERR_PTR(-EFAULT); 446 447 err = mthca_map_user_db(to_mdev(pd->device), &context->uar, 448 context->db_tab, ucmd.db_index, 449 ucmd.db_page); 450 451 if (err) 452 goto err_free; 453 454 srq->mr.ibmr.lkey = ucmd.lkey; 455 srq->db_index = ucmd.db_index; 456 } 457 458 err = mthca_alloc_srq(to_mdev(pd->device), to_mpd(pd), 459 &init_attr->attr, srq); 460 461 if (err && pd->uobject) 462 mthca_unmap_user_db(to_mdev(pd->device), &context->uar, 463 context->db_tab, ucmd.db_index); 464 465 if (err) 466 goto err_free; 467 468 if (context && ib_copy_to_udata(udata, &srq->srqn, sizeof (__u32))) { 469 mthca_free_srq(to_mdev(pd->device), srq); 470 err = -EFAULT; 471 goto err_free; 472 } 473 474 return &srq->ibsrq; 475 476 err_free: 477 kfree(srq); 478 479 return ERR_PTR(err); 480 } 481 482 static int mthca_destroy_srq(struct ib_srq *srq) 483 { 484 struct mthca_ucontext *context; 485 486 if (srq->uobject) { 487 context = to_mucontext(srq->uobject->context); 488 489 mthca_unmap_user_db(to_mdev(srq->device), &context->uar, 490 context->db_tab, to_msrq(srq)->db_index); 491 } 492 493 mthca_free_srq(to_mdev(srq->device), to_msrq(srq)); 494 kfree(srq); 495 496 return 0; 497 } 498 499 static struct ib_qp *mthca_create_qp(struct ib_pd *pd, 500 struct ib_qp_init_attr *init_attr, 501 struct ib_udata *udata) 502 { 503 struct mthca_create_qp ucmd; 504 struct mthca_qp *qp; 505 int err; 506 507 switch (init_attr->qp_type) { 508 case IB_QPT_RC: 509 case IB_QPT_UC: 510 case IB_QPT_UD: 511 { 512 struct mthca_ucontext *context; 513 514 qp = kmalloc(sizeof *qp, GFP_KERNEL); 515 if (!qp) 516 return ERR_PTR(-ENOMEM); 517 518 if (pd->uobject) { 519 context = to_mucontext(pd->uobject->context); 520 521 if (ib_copy_from_udata(&ucmd, udata, sizeof ucmd)) 522 return ERR_PTR(-EFAULT); 523 524 err = mthca_map_user_db(to_mdev(pd->device), &context->uar, 525 context->db_tab, 526 ucmd.sq_db_index, ucmd.sq_db_page); 527 if (err) { 528 kfree(qp); 529 return ERR_PTR(err); 530 } 531 532 err = mthca_map_user_db(to_mdev(pd->device), &context->uar, 533 context->db_tab, 534 ucmd.rq_db_index, ucmd.rq_db_page); 535 if (err) { 536 mthca_unmap_user_db(to_mdev(pd->device), 537 &context->uar, 538 context->db_tab, 539 ucmd.sq_db_index); 540 kfree(qp); 541 return ERR_PTR(err); 542 } 543 544 qp->mr.ibmr.lkey = ucmd.lkey; 545 qp->sq.db_index = ucmd.sq_db_index; 546 qp->rq.db_index = ucmd.rq_db_index; 547 } 548 549 err = mthca_alloc_qp(to_mdev(pd->device), to_mpd(pd), 550 to_mcq(init_attr->send_cq), 551 to_mcq(init_attr->recv_cq), 552 init_attr->qp_type, init_attr->sq_sig_type, 553 &init_attr->cap, qp); 554 555 if (err && pd->uobject) { 556 context = to_mucontext(pd->uobject->context); 557 558 mthca_unmap_user_db(to_mdev(pd->device), 559 &context->uar, 560 context->db_tab, 561 ucmd.sq_db_index); 562 mthca_unmap_user_db(to_mdev(pd->device), 563 &context->uar, 564 context->db_tab, 565 ucmd.rq_db_index); 566 } 567 568 qp->ibqp.qp_num = qp->qpn; 569 break; 570 } 571 case IB_QPT_SMI: 572 case IB_QPT_GSI: 573 { 574 /* Don't allow userspace to create special QPs */ 575 if (pd->uobject) 576 return ERR_PTR(-EINVAL); 577 578 qp = kmalloc(sizeof (struct mthca_sqp), GFP_KERNEL); 579 if (!qp) 580 return ERR_PTR(-ENOMEM); 581 582 qp->ibqp.qp_num = init_attr->qp_type == IB_QPT_SMI ? 0 : 1; 583 584 err = mthca_alloc_sqp(to_mdev(pd->device), to_mpd(pd), 585 to_mcq(init_attr->send_cq), 586 to_mcq(init_attr->recv_cq), 587 init_attr->sq_sig_type, &init_attr->cap, 588 qp->ibqp.qp_num, init_attr->port_num, 589 to_msqp(qp)); 590 break; 591 } 592 default: 593 /* Don't support raw QPs */ 594 return ERR_PTR(-ENOSYS); 595 } 596 597 if (err) { 598 kfree(qp); 599 return ERR_PTR(err); 600 } 601 602 init_attr->cap.max_inline_data = 0; 603 init_attr->cap.max_send_wr = qp->sq.max; 604 init_attr->cap.max_recv_wr = qp->rq.max; 605 init_attr->cap.max_send_sge = qp->sq.max_gs; 606 init_attr->cap.max_recv_sge = qp->rq.max_gs; 607 608 return &qp->ibqp; 609 } 610 611 static int mthca_destroy_qp(struct ib_qp *qp) 612 { 613 if (qp->uobject) { 614 mthca_unmap_user_db(to_mdev(qp->device), 615 &to_mucontext(qp->uobject->context)->uar, 616 to_mucontext(qp->uobject->context)->db_tab, 617 to_mqp(qp)->sq.db_index); 618 mthca_unmap_user_db(to_mdev(qp->device), 619 &to_mucontext(qp->uobject->context)->uar, 620 to_mucontext(qp->uobject->context)->db_tab, 621 to_mqp(qp)->rq.db_index); 622 } 623 mthca_free_qp(to_mdev(qp->device), to_mqp(qp)); 624 kfree(qp); 625 return 0; 626 } 627 628 static struct ib_cq *mthca_create_cq(struct ib_device *ibdev, int entries, 629 struct ib_ucontext *context, 630 struct ib_udata *udata) 631 { 632 struct mthca_create_cq ucmd; 633 struct mthca_cq *cq; 634 int nent; 635 int err; 636 637 if (context) { 638 if (ib_copy_from_udata(&ucmd, udata, sizeof ucmd)) 639 return ERR_PTR(-EFAULT); 640 641 err = mthca_map_user_db(to_mdev(ibdev), &to_mucontext(context)->uar, 642 to_mucontext(context)->db_tab, 643 ucmd.set_db_index, ucmd.set_db_page); 644 if (err) 645 return ERR_PTR(err); 646 647 err = mthca_map_user_db(to_mdev(ibdev), &to_mucontext(context)->uar, 648 to_mucontext(context)->db_tab, 649 ucmd.arm_db_index, ucmd.arm_db_page); 650 if (err) 651 goto err_unmap_set; 652 } 653 654 cq = kmalloc(sizeof *cq, GFP_KERNEL); 655 if (!cq) { 656 err = -ENOMEM; 657 goto err_unmap_arm; 658 } 659 660 if (context) { 661 cq->mr.ibmr.lkey = ucmd.lkey; 662 cq->set_ci_db_index = ucmd.set_db_index; 663 cq->arm_db_index = ucmd.arm_db_index; 664 } 665 666 for (nent = 1; nent <= entries; nent <<= 1) 667 ; /* nothing */ 668 669 err = mthca_init_cq(to_mdev(ibdev), nent, 670 context ? to_mucontext(context) : NULL, 671 context ? ucmd.pdn : to_mdev(ibdev)->driver_pd.pd_num, 672 cq); 673 if (err) 674 goto err_free; 675 676 if (context && ib_copy_to_udata(udata, &cq->cqn, sizeof (__u32))) { 677 mthca_free_cq(to_mdev(ibdev), cq); 678 goto err_free; 679 } 680 681 return &cq->ibcq; 682 683 err_free: 684 kfree(cq); 685 686 err_unmap_arm: 687 if (context) 688 mthca_unmap_user_db(to_mdev(ibdev), &to_mucontext(context)->uar, 689 to_mucontext(context)->db_tab, ucmd.arm_db_index); 690 691 err_unmap_set: 692 if (context) 693 mthca_unmap_user_db(to_mdev(ibdev), &to_mucontext(context)->uar, 694 to_mucontext(context)->db_tab, ucmd.set_db_index); 695 696 return ERR_PTR(err); 697 } 698 699 static int mthca_destroy_cq(struct ib_cq *cq) 700 { 701 if (cq->uobject) { 702 mthca_unmap_user_db(to_mdev(cq->device), 703 &to_mucontext(cq->uobject->context)->uar, 704 to_mucontext(cq->uobject->context)->db_tab, 705 to_mcq(cq)->arm_db_index); 706 mthca_unmap_user_db(to_mdev(cq->device), 707 &to_mucontext(cq->uobject->context)->uar, 708 to_mucontext(cq->uobject->context)->db_tab, 709 to_mcq(cq)->set_ci_db_index); 710 } 711 mthca_free_cq(to_mdev(cq->device), to_mcq(cq)); 712 kfree(cq); 713 714 return 0; 715 } 716 717 static inline u32 convert_access(int acc) 718 { 719 return (acc & IB_ACCESS_REMOTE_ATOMIC ? MTHCA_MPT_FLAG_ATOMIC : 0) | 720 (acc & IB_ACCESS_REMOTE_WRITE ? MTHCA_MPT_FLAG_REMOTE_WRITE : 0) | 721 (acc & IB_ACCESS_REMOTE_READ ? MTHCA_MPT_FLAG_REMOTE_READ : 0) | 722 (acc & IB_ACCESS_LOCAL_WRITE ? MTHCA_MPT_FLAG_LOCAL_WRITE : 0) | 723 MTHCA_MPT_FLAG_LOCAL_READ; 724 } 725 726 static struct ib_mr *mthca_get_dma_mr(struct ib_pd *pd, int acc) 727 { 728 struct mthca_mr *mr; 729 int err; 730 731 mr = kmalloc(sizeof *mr, GFP_KERNEL); 732 if (!mr) 733 return ERR_PTR(-ENOMEM); 734 735 err = mthca_mr_alloc_notrans(to_mdev(pd->device), 736 to_mpd(pd)->pd_num, 737 convert_access(acc), mr); 738 739 if (err) { 740 kfree(mr); 741 return ERR_PTR(err); 742 } 743 744 return &mr->ibmr; 745 } 746 747 static struct ib_mr *mthca_reg_phys_mr(struct ib_pd *pd, 748 struct ib_phys_buf *buffer_list, 749 int num_phys_buf, 750 int acc, 751 u64 *iova_start) 752 { 753 struct mthca_mr *mr; 754 u64 *page_list; 755 u64 total_size; 756 u64 mask; 757 int shift; 758 int npages; 759 int err; 760 int i, j, n; 761 762 /* First check that we have enough alignment */ 763 if ((*iova_start & ~PAGE_MASK) != (buffer_list[0].addr & ~PAGE_MASK)) 764 return ERR_PTR(-EINVAL); 765 766 if (num_phys_buf > 1 && 767 ((buffer_list[0].addr + buffer_list[0].size) & ~PAGE_MASK)) 768 return ERR_PTR(-EINVAL); 769 770 mask = 0; 771 total_size = 0; 772 for (i = 0; i < num_phys_buf; ++i) { 773 if (i != 0 && buffer_list[i].addr & ~PAGE_MASK) 774 return ERR_PTR(-EINVAL); 775 if (i != 0 && i != num_phys_buf - 1 && 776 (buffer_list[i].size & ~PAGE_MASK)) 777 return ERR_PTR(-EINVAL); 778 779 total_size += buffer_list[i].size; 780 if (i > 0) 781 mask |= buffer_list[i].addr; 782 } 783 784 /* Find largest page shift we can use to cover buffers */ 785 for (shift = PAGE_SHIFT; shift < 31; ++shift) 786 if (num_phys_buf > 1) { 787 if ((1ULL << shift) & mask) 788 break; 789 } else { 790 if (1ULL << shift >= 791 buffer_list[0].size + 792 (buffer_list[0].addr & ((1ULL << shift) - 1))) 793 break; 794 } 795 796 buffer_list[0].size += buffer_list[0].addr & ((1ULL << shift) - 1); 797 buffer_list[0].addr &= ~0ull << shift; 798 799 mr = kmalloc(sizeof *mr, GFP_KERNEL); 800 if (!mr) 801 return ERR_PTR(-ENOMEM); 802 803 npages = 0; 804 for (i = 0; i < num_phys_buf; ++i) 805 npages += (buffer_list[i].size + (1ULL << shift) - 1) >> shift; 806 807 if (!npages) 808 return &mr->ibmr; 809 810 page_list = kmalloc(npages * sizeof *page_list, GFP_KERNEL); 811 if (!page_list) { 812 kfree(mr); 813 return ERR_PTR(-ENOMEM); 814 } 815 816 n = 0; 817 for (i = 0; i < num_phys_buf; ++i) 818 for (j = 0; 819 j < (buffer_list[i].size + (1ULL << shift) - 1) >> shift; 820 ++j) 821 page_list[n++] = buffer_list[i].addr + ((u64) j << shift); 822 823 mthca_dbg(to_mdev(pd->device), "Registering memory at %llx (iova %llx) " 824 "in PD %x; shift %d, npages %d.\n", 825 (unsigned long long) buffer_list[0].addr, 826 (unsigned long long) *iova_start, 827 to_mpd(pd)->pd_num, 828 shift, npages); 829 830 err = mthca_mr_alloc_phys(to_mdev(pd->device), 831 to_mpd(pd)->pd_num, 832 page_list, shift, npages, 833 *iova_start, total_size, 834 convert_access(acc), mr); 835 836 if (err) { 837 kfree(page_list); 838 kfree(mr); 839 return ERR_PTR(err); 840 } 841 842 kfree(page_list); 843 return &mr->ibmr; 844 } 845 846 static struct ib_mr *mthca_reg_user_mr(struct ib_pd *pd, struct ib_umem *region, 847 int acc, struct ib_udata *udata) 848 { 849 struct mthca_dev *dev = to_mdev(pd->device); 850 struct ib_umem_chunk *chunk; 851 struct mthca_mr *mr; 852 u64 *pages; 853 int shift, n, len; 854 int i, j, k; 855 int err = 0; 856 857 shift = ffs(region->page_size) - 1; 858 859 mr = kmalloc(sizeof *mr, GFP_KERNEL); 860 if (!mr) 861 return ERR_PTR(-ENOMEM); 862 863 n = 0; 864 list_for_each_entry(chunk, ®ion->chunk_list, list) 865 n += chunk->nents; 866 867 mr->mtt = mthca_alloc_mtt(dev, n); 868 if (IS_ERR(mr->mtt)) { 869 err = PTR_ERR(mr->mtt); 870 goto err; 871 } 872 873 pages = (u64 *) __get_free_page(GFP_KERNEL); 874 if (!pages) { 875 err = -ENOMEM; 876 goto err_mtt; 877 } 878 879 i = n = 0; 880 881 list_for_each_entry(chunk, ®ion->chunk_list, list) 882 for (j = 0; j < chunk->nmap; ++j) { 883 len = sg_dma_len(&chunk->page_list[j]) >> shift; 884 for (k = 0; k < len; ++k) { 885 pages[i++] = sg_dma_address(&chunk->page_list[j]) + 886 region->page_size * k; 887 /* 888 * Be friendly to WRITE_MTT command 889 * and leave two empty slots for the 890 * index and reserved fields of the 891 * mailbox. 892 */ 893 if (i == PAGE_SIZE / sizeof (u64) - 2) { 894 err = mthca_write_mtt(dev, mr->mtt, 895 n, pages, i); 896 if (err) 897 goto mtt_done; 898 n += i; 899 i = 0; 900 } 901 } 902 } 903 904 if (i) 905 err = mthca_write_mtt(dev, mr->mtt, n, pages, i); 906 mtt_done: 907 free_page((unsigned long) pages); 908 if (err) 909 goto err_mtt; 910 911 err = mthca_mr_alloc(dev, to_mpd(pd)->pd_num, shift, region->virt_base, 912 region->length, convert_access(acc), mr); 913 914 if (err) 915 goto err_mtt; 916 917 return &mr->ibmr; 918 919 err_mtt: 920 mthca_free_mtt(dev, mr->mtt); 921 922 err: 923 kfree(mr); 924 return ERR_PTR(err); 925 } 926 927 static int mthca_dereg_mr(struct ib_mr *mr) 928 { 929 struct mthca_mr *mmr = to_mmr(mr); 930 mthca_free_mr(to_mdev(mr->device), mmr); 931 kfree(mmr); 932 return 0; 933 } 934 935 static struct ib_fmr *mthca_alloc_fmr(struct ib_pd *pd, int mr_access_flags, 936 struct ib_fmr_attr *fmr_attr) 937 { 938 struct mthca_fmr *fmr; 939 int err; 940 941 fmr = kmalloc(sizeof *fmr, GFP_KERNEL); 942 if (!fmr) 943 return ERR_PTR(-ENOMEM); 944 945 memcpy(&fmr->attr, fmr_attr, sizeof *fmr_attr); 946 err = mthca_fmr_alloc(to_mdev(pd->device), to_mpd(pd)->pd_num, 947 convert_access(mr_access_flags), fmr); 948 949 if (err) { 950 kfree(fmr); 951 return ERR_PTR(err); 952 } 953 954 return &fmr->ibmr; 955 } 956 957 static int mthca_dealloc_fmr(struct ib_fmr *fmr) 958 { 959 struct mthca_fmr *mfmr = to_mfmr(fmr); 960 int err; 961 962 err = mthca_free_fmr(to_mdev(fmr->device), mfmr); 963 if (err) 964 return err; 965 966 kfree(mfmr); 967 return 0; 968 } 969 970 static int mthca_unmap_fmr(struct list_head *fmr_list) 971 { 972 struct ib_fmr *fmr; 973 int err; 974 u8 status; 975 struct mthca_dev *mdev = NULL; 976 977 list_for_each_entry(fmr, fmr_list, list) { 978 if (mdev && to_mdev(fmr->device) != mdev) 979 return -EINVAL; 980 mdev = to_mdev(fmr->device); 981 } 982 983 if (!mdev) 984 return 0; 985 986 if (mthca_is_memfree(mdev)) { 987 list_for_each_entry(fmr, fmr_list, list) 988 mthca_arbel_fmr_unmap(mdev, to_mfmr(fmr)); 989 990 wmb(); 991 } else 992 list_for_each_entry(fmr, fmr_list, list) 993 mthca_tavor_fmr_unmap(mdev, to_mfmr(fmr)); 994 995 err = mthca_SYNC_TPT(mdev, &status); 996 if (err) 997 return err; 998 if (status) 999 return -EINVAL; 1000 return 0; 1001 } 1002 1003 static ssize_t show_rev(struct class_device *cdev, char *buf) 1004 { 1005 struct mthca_dev *dev = container_of(cdev, struct mthca_dev, ib_dev.class_dev); 1006 return sprintf(buf, "%x\n", dev->rev_id); 1007 } 1008 1009 static ssize_t show_fw_ver(struct class_device *cdev, char *buf) 1010 { 1011 struct mthca_dev *dev = container_of(cdev, struct mthca_dev, ib_dev.class_dev); 1012 return sprintf(buf, "%x.%x.%x\n", (int) (dev->fw_ver >> 32), 1013 (int) (dev->fw_ver >> 16) & 0xffff, 1014 (int) dev->fw_ver & 0xffff); 1015 } 1016 1017 static ssize_t show_hca(struct class_device *cdev, char *buf) 1018 { 1019 struct mthca_dev *dev = container_of(cdev, struct mthca_dev, ib_dev.class_dev); 1020 switch (dev->pdev->device) { 1021 case PCI_DEVICE_ID_MELLANOX_TAVOR: 1022 return sprintf(buf, "MT23108\n"); 1023 case PCI_DEVICE_ID_MELLANOX_ARBEL_COMPAT: 1024 return sprintf(buf, "MT25208 (MT23108 compat mode)\n"); 1025 case PCI_DEVICE_ID_MELLANOX_ARBEL: 1026 return sprintf(buf, "MT25208\n"); 1027 case PCI_DEVICE_ID_MELLANOX_SINAI: 1028 case PCI_DEVICE_ID_MELLANOX_SINAI_OLD: 1029 return sprintf(buf, "MT25204\n"); 1030 default: 1031 return sprintf(buf, "unknown\n"); 1032 } 1033 } 1034 1035 static ssize_t show_board(struct class_device *cdev, char *buf) 1036 { 1037 struct mthca_dev *dev = container_of(cdev, struct mthca_dev, ib_dev.class_dev); 1038 return sprintf(buf, "%.*s\n", MTHCA_BOARD_ID_LEN, dev->board_id); 1039 } 1040 1041 static CLASS_DEVICE_ATTR(hw_rev, S_IRUGO, show_rev, NULL); 1042 static CLASS_DEVICE_ATTR(fw_ver, S_IRUGO, show_fw_ver, NULL); 1043 static CLASS_DEVICE_ATTR(hca_type, S_IRUGO, show_hca, NULL); 1044 static CLASS_DEVICE_ATTR(board_id, S_IRUGO, show_board, NULL); 1045 1046 static struct class_device_attribute *mthca_class_attributes[] = { 1047 &class_device_attr_hw_rev, 1048 &class_device_attr_fw_ver, 1049 &class_device_attr_hca_type, 1050 &class_device_attr_board_id 1051 }; 1052 1053 int mthca_register_device(struct mthca_dev *dev) 1054 { 1055 int ret; 1056 int i; 1057 1058 strlcpy(dev->ib_dev.name, "mthca%d", IB_DEVICE_NAME_MAX); 1059 dev->ib_dev.owner = THIS_MODULE; 1060 1061 dev->ib_dev.node_type = IB_NODE_CA; 1062 dev->ib_dev.phys_port_cnt = dev->limits.num_ports; 1063 dev->ib_dev.dma_device = &dev->pdev->dev; 1064 dev->ib_dev.class_dev.dev = &dev->pdev->dev; 1065 dev->ib_dev.query_device = mthca_query_device; 1066 dev->ib_dev.query_port = mthca_query_port; 1067 dev->ib_dev.modify_port = mthca_modify_port; 1068 dev->ib_dev.query_pkey = mthca_query_pkey; 1069 dev->ib_dev.query_gid = mthca_query_gid; 1070 dev->ib_dev.alloc_ucontext = mthca_alloc_ucontext; 1071 dev->ib_dev.dealloc_ucontext = mthca_dealloc_ucontext; 1072 dev->ib_dev.mmap = mthca_mmap_uar; 1073 dev->ib_dev.alloc_pd = mthca_alloc_pd; 1074 dev->ib_dev.dealloc_pd = mthca_dealloc_pd; 1075 dev->ib_dev.create_ah = mthca_ah_create; 1076 dev->ib_dev.destroy_ah = mthca_ah_destroy; 1077 1078 if (dev->mthca_flags & MTHCA_FLAG_SRQ) { 1079 dev->ib_dev.create_srq = mthca_create_srq; 1080 dev->ib_dev.destroy_srq = mthca_destroy_srq; 1081 1082 if (mthca_is_memfree(dev)) 1083 dev->ib_dev.post_srq_recv = mthca_arbel_post_srq_recv; 1084 else 1085 dev->ib_dev.post_srq_recv = mthca_tavor_post_srq_recv; 1086 } 1087 1088 dev->ib_dev.create_qp = mthca_create_qp; 1089 dev->ib_dev.modify_qp = mthca_modify_qp; 1090 dev->ib_dev.destroy_qp = mthca_destroy_qp; 1091 dev->ib_dev.create_cq = mthca_create_cq; 1092 dev->ib_dev.destroy_cq = mthca_destroy_cq; 1093 dev->ib_dev.poll_cq = mthca_poll_cq; 1094 dev->ib_dev.get_dma_mr = mthca_get_dma_mr; 1095 dev->ib_dev.reg_phys_mr = mthca_reg_phys_mr; 1096 dev->ib_dev.reg_user_mr = mthca_reg_user_mr; 1097 dev->ib_dev.dereg_mr = mthca_dereg_mr; 1098 1099 if (dev->mthca_flags & MTHCA_FLAG_FMR) { 1100 dev->ib_dev.alloc_fmr = mthca_alloc_fmr; 1101 dev->ib_dev.unmap_fmr = mthca_unmap_fmr; 1102 dev->ib_dev.dealloc_fmr = mthca_dealloc_fmr; 1103 if (mthca_is_memfree(dev)) 1104 dev->ib_dev.map_phys_fmr = mthca_arbel_map_phys_fmr; 1105 else 1106 dev->ib_dev.map_phys_fmr = mthca_tavor_map_phys_fmr; 1107 } 1108 1109 dev->ib_dev.attach_mcast = mthca_multicast_attach; 1110 dev->ib_dev.detach_mcast = mthca_multicast_detach; 1111 dev->ib_dev.process_mad = mthca_process_mad; 1112 1113 if (mthca_is_memfree(dev)) { 1114 dev->ib_dev.req_notify_cq = mthca_arbel_arm_cq; 1115 dev->ib_dev.post_send = mthca_arbel_post_send; 1116 dev->ib_dev.post_recv = mthca_arbel_post_receive; 1117 } else { 1118 dev->ib_dev.req_notify_cq = mthca_tavor_arm_cq; 1119 dev->ib_dev.post_send = mthca_tavor_post_send; 1120 dev->ib_dev.post_recv = mthca_tavor_post_receive; 1121 } 1122 1123 init_MUTEX(&dev->cap_mask_mutex); 1124 1125 ret = ib_register_device(&dev->ib_dev); 1126 if (ret) 1127 return ret; 1128 1129 for (i = 0; i < ARRAY_SIZE(mthca_class_attributes); ++i) { 1130 ret = class_device_create_file(&dev->ib_dev.class_dev, 1131 mthca_class_attributes[i]); 1132 if (ret) { 1133 ib_unregister_device(&dev->ib_dev); 1134 return ret; 1135 } 1136 } 1137 1138 return 0; 1139 } 1140 1141 void mthca_unregister_device(struct mthca_dev *dev) 1142 { 1143 ib_unregister_device(&dev->ib_dev); 1144 } 1145