1f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker/* 2f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Copyright (c) 2005 Ammasso, Inc. All rights reserved. 3f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Copyright (c) 2005 Open Grid Computing, Inc. All rights reserved. 4f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * 5f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * This software is available to you under a choice of one of two 6f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * licenses. You may choose to be licensed under the terms of the GNU 7f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * General Public License (GPL) Version 2, available from the file 8f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * COPYING in the main directory of this source tree, or the 9f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * OpenIB.org BSD license below: 10f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * 11f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Redistribution and use in source and binary forms, with or 12f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * without modification, are permitted provided that the following 13f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * conditions are met: 14f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * 15f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * - Redistributions of source code must retain the above 16f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * copyright notice, this list of conditions and the following 17f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * disclaimer. 18f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * 19f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * - Redistributions in binary form must reproduce the above 20f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * copyright notice, this list of conditions and the following 21f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * disclaimer in the documentation and/or other materials 22f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * provided with the distribution. 23f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * 24f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 25f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 26f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 27f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 28f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 29f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 30f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 31f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * SOFTWARE. 32f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * 33f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 345a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 355a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo 36f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker#include "c2.h" 37f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker#include "c2_wr.h" 38f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker#include "c2_vq.h" 39f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker#include <rdma/iw_cm.h> 40f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 41f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tuckerint c2_llp_connect(struct iw_cm_id *cm_id, struct iw_cm_conn_param *iw_param) 42f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker{ 43f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2_dev *c2dev = to_c2dev(cm_id->device); 44f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct ib_qp *ibqp; 45f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2_qp *qp; 46f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2wr_qp_connect_req *wr; /* variable size needs a malloc. */ 47f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2_vq_req *vq_req; 48f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker int err; 49f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 50f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker ibqp = c2_get_qp(cm_id->device, iw_param->qpn); 51f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!ibqp) 52f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker return -EINVAL; 53f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker qp = to_c2qp(ibqp); 54f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 55f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* Associate QP <--> CM_ID */ 56f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker cm_id->provider_data = qp; 57f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker cm_id->add_ref(cm_id); 58f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker qp->cm_id = cm_id; 59f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 60f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 61f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * only support the max private_data length 62f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 63f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (iw_param->private_data_len > C2_MAX_PRIVATE_DATA_SIZE) { 64f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = -EINVAL; 65f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail0; 66f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 67f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 68f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Set the rdma read limits 69f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 70f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = c2_qp_set_read_limits(c2dev, qp, iw_param->ord, iw_param->ird); 71f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (err) 72f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail0; 73f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 74f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 75f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Create and send a WR_QP_CONNECT... 76f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 77f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr = kmalloc(c2dev->req_vq.msg_size, GFP_KERNEL); 78f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!wr) { 79f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = -ENOMEM; 80f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail0; 81f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 82f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 83f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req = vq_req_alloc(c2dev); 84f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!vq_req) { 85f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = -ENOMEM; 86f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail1; 87f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 88f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 89f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker c2_wr_set_id(wr, CCWR_QP_CONNECT); 90f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr->hdr.context = 0; 91f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr->rnic_handle = c2dev->adapter_handle; 92f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr->qp_handle = qp->adapter_handle; 93f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 94f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr->remote_addr = cm_id->remote_addr.sin_addr.s_addr; 95f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr->remote_port = cm_id->remote_addr.sin_port; 96f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 97f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 98f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Move any private data from the callers's buf into 99f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * the WR. 100f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 101f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (iw_param->private_data) { 102f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr->private_data_length = 103f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker cpu_to_be32(iw_param->private_data_len); 104f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker memcpy(&wr->private_data[0], iw_param->private_data, 105f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker iw_param->private_data_len); 106f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } else 107f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr->private_data_length = 0; 108f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 109f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 110f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Send WR to adapter. NOTE: There is no synch reply from 111f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * the adapter. 112f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 113f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = vq_send_wr(c2dev, (union c2wr *) wr); 114f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_free(c2dev, vq_req); 115f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 116f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker bail1: 117f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker kfree(wr); 118f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker bail0: 119f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (err) { 120f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 121f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * If we fail, release reference on QP and 122f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * disassociate QP from CM_ID 123f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 124f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker cm_id->provider_data = NULL; 125f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker qp->cm_id = NULL; 126f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker cm_id->rem_ref(cm_id); 127f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 128f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker return err; 129f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker} 130f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 131f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tuckerint c2_llp_service_create(struct iw_cm_id *cm_id, int backlog) 132f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker{ 133f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2_dev *c2dev; 134f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2wr_ep_listen_create_req wr; 135f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2wr_ep_listen_create_rep *reply; 136f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2_vq_req *vq_req; 137f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker int err; 138f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 139f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker c2dev = to_c2dev(cm_id->device); 140f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (c2dev == NULL) 141f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker return -EINVAL; 142f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 143f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 144f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Allocate verbs request. 145f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 146f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req = vq_req_alloc(c2dev); 147f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!vq_req) 148f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker return -ENOMEM; 149f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 150f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 151f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Build the WR 152f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 153f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker c2_wr_set_id(&wr, CCWR_EP_LISTEN_CREATE); 154f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr.hdr.context = (u64) (unsigned long) vq_req; 155f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr.rnic_handle = c2dev->adapter_handle; 156f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr.local_addr = cm_id->local_addr.sin_addr.s_addr; 157f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr.local_port = cm_id->local_addr.sin_port; 158f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr.backlog = cpu_to_be32(backlog); 159f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr.user_context = (u64) (unsigned long) cm_id; 160f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 161f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 162f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Reference the request struct. Dereferenced in the int handler. 163f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 164f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_get(c2dev, vq_req); 165f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 166f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 167f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Send WR to adapter 168f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 169f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = vq_send_wr(c2dev, (union c2wr *) & wr); 170f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (err) { 171f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_put(c2dev, vq_req); 172f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail0; 173f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 174f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 175f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 176f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Wait for reply from adapter 177f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 178f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = vq_wait_for_reply(c2dev, vq_req); 179f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (err) 180f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail0; 181f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 182f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 183f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Process reply 184f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 185f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker reply = 186f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker (struct c2wr_ep_listen_create_rep *) (unsigned long) vq_req->reply_msg; 187f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!reply) { 188f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = -ENOMEM; 189f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail1; 190f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 191f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 192f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if ((err = c2_errno(reply)) != 0) 193f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail1; 194f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 195f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 196f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Keep the adapter handle. Used in subsequent destroy 197f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 198f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker cm_id->provider_data = (void*)(unsigned long) reply->ep_handle; 199f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 200f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 201f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * free vq stuff 202f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 203f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_repbuf_free(c2dev, reply); 204f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_free(c2dev, vq_req); 205f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 206f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker return 0; 207f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 208f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker bail1: 209f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_repbuf_free(c2dev, reply); 210f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker bail0: 211f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_free(c2dev, vq_req); 212f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker return err; 213f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker} 214f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 215f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 216f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tuckerint c2_llp_service_destroy(struct iw_cm_id *cm_id) 217f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker{ 218f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 219f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2_dev *c2dev; 220f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2wr_ep_listen_destroy_req wr; 221f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2wr_ep_listen_destroy_rep *reply; 222f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2_vq_req *vq_req; 223f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker int err; 224f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 225f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker c2dev = to_c2dev(cm_id->device); 226f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (c2dev == NULL) 227f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker return -EINVAL; 228f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 229f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 230f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Allocate verbs request. 231f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 232f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req = vq_req_alloc(c2dev); 233f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!vq_req) 234f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker return -ENOMEM; 235f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 236f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 237f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Build the WR 238f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 239f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker c2_wr_set_id(&wr, CCWR_EP_LISTEN_DESTROY); 240f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr.hdr.context = (unsigned long) vq_req; 241f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr.rnic_handle = c2dev->adapter_handle; 242f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr.ep_handle = (u32)(unsigned long)cm_id->provider_data; 243f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 244f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 245f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * reference the request struct. dereferenced in the int handler. 246f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 247f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_get(c2dev, vq_req); 248f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 249f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 250f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Send WR to adapter 251f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 252f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = vq_send_wr(c2dev, (union c2wr *) & wr); 253f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (err) { 254f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_put(c2dev, vq_req); 255f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail0; 256f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 257f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 258f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 259f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Wait for reply from adapter 260f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 261f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = vq_wait_for_reply(c2dev, vq_req); 262f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (err) 263f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail0; 264f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 265f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 266f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Process reply 267f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 268f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker reply=(struct c2wr_ep_listen_destroy_rep *)(unsigned long)vq_req->reply_msg; 269f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!reply) { 270f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = -ENOMEM; 271f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail0; 272f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 273f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if ((err = c2_errno(reply)) != 0) 274f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail1; 275f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 276f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker bail1: 277f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_repbuf_free(c2dev, reply); 278f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker bail0: 279f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_free(c2dev, vq_req); 280f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker return err; 281f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker} 282f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 283f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tuckerint c2_llp_accept(struct iw_cm_id *cm_id, struct iw_cm_conn_param *iw_param) 284f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker{ 285f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2_dev *c2dev = to_c2dev(cm_id->device); 286f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2_qp *qp; 287f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct ib_qp *ibqp; 288f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2wr_cr_accept_req *wr; /* variable length WR */ 289f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2_vq_req *vq_req; 290f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2wr_cr_accept_rep *reply; /* VQ Reply msg ptr. */ 291f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker int err; 292f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 293f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker ibqp = c2_get_qp(cm_id->device, iw_param->qpn); 294f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!ibqp) 295f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker return -EINVAL; 296f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker qp = to_c2qp(ibqp); 297f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 298f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* Set the RDMA read limits */ 299f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = c2_qp_set_read_limits(c2dev, qp, iw_param->ord, iw_param->ird); 300f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (err) 301f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail0; 302f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 303f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* Allocate verbs request. */ 304f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req = vq_req_alloc(c2dev); 305f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!vq_req) { 306f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = -ENOMEM; 30744334bd97e76662c5f40c629357e6acc4dee3e8aEric Sesterhenn goto bail0; 308f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 309f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req->qp = qp; 310f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req->cm_id = cm_id; 311f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req->event = IW_CM_EVENT_ESTABLISHED; 312f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 313f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr = kmalloc(c2dev->req_vq.msg_size, GFP_KERNEL); 314f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!wr) { 315f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = -ENOMEM; 31644334bd97e76662c5f40c629357e6acc4dee3e8aEric Sesterhenn goto bail1; 317f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 318f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 319f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* Build the WR */ 320f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker c2_wr_set_id(wr, CCWR_CR_ACCEPT); 321f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr->hdr.context = (unsigned long) vq_req; 322f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr->rnic_handle = c2dev->adapter_handle; 323f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr->ep_handle = (u32) (unsigned long) cm_id->provider_data; 324f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr->qp_handle = qp->adapter_handle; 325f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 326f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* Replace the cr_handle with the QP after accept */ 327f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker cm_id->provider_data = qp; 328f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker cm_id->add_ref(cm_id); 329f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker qp->cm_id = cm_id; 330f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 331f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker cm_id->provider_data = qp; 332f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 333f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* Validate private_data length */ 334f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (iw_param->private_data_len > C2_MAX_PRIVATE_DATA_SIZE) { 335f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = -EINVAL; 33644334bd97e76662c5f40c629357e6acc4dee3e8aEric Sesterhenn goto bail1; 337f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 338f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 339f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (iw_param->private_data) { 340f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr->private_data_length = cpu_to_be32(iw_param->private_data_len); 341f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker memcpy(&wr->private_data[0], 342f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker iw_param->private_data, iw_param->private_data_len); 343f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } else 344f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr->private_data_length = 0; 345f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 346f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* Reference the request struct. Dereferenced in the int handler. */ 347f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_get(c2dev, vq_req); 348f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 349f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* Send WR to adapter */ 350f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = vq_send_wr(c2dev, (union c2wr *) wr); 351f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (err) { 352f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_put(c2dev, vq_req); 35344334bd97e76662c5f40c629357e6acc4dee3e8aEric Sesterhenn goto bail1; 354f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 355f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 356f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* Wait for reply from adapter */ 357f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = vq_wait_for_reply(c2dev, vq_req); 358f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (err) 35944334bd97e76662c5f40c629357e6acc4dee3e8aEric Sesterhenn goto bail1; 360f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 361f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* Check that reply is present */ 362f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker reply = (struct c2wr_cr_accept_rep *) (unsigned long) vq_req->reply_msg; 363f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!reply) { 364f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = -ENOMEM; 36544334bd97e76662c5f40c629357e6acc4dee3e8aEric Sesterhenn goto bail1; 366f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 367f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 368f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = c2_errno(reply); 369f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_repbuf_free(c2dev, reply); 370f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 371f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!err) 372f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker c2_set_qp_state(qp, C2_QP_STATE_RTS); 373f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker bail1: 37444334bd97e76662c5f40c629357e6acc4dee3e8aEric Sesterhenn kfree(wr); 375f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_free(c2dev, vq_req); 376f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker bail0: 377f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (err) { 378f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 379f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * If we fail, release reference on QP and 380f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * disassociate QP from CM_ID 381f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 382f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker cm_id->provider_data = NULL; 383f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker qp->cm_id = NULL; 384f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker cm_id->rem_ref(cm_id); 385f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 386f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker return err; 387f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker} 388f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 389f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tuckerint c2_llp_reject(struct iw_cm_id *cm_id, const void *pdata, u8 pdata_len) 390f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker{ 391f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2_dev *c2dev; 392f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2wr_cr_reject_req wr; 393f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2_vq_req *vq_req; 394f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker struct c2wr_cr_reject_rep *reply; 395f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker int err; 396f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 397f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker c2dev = to_c2dev(cm_id->device); 398f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 399f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 400f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Allocate verbs request. 401f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 402f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req = vq_req_alloc(c2dev); 403f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!vq_req) 404f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker return -ENOMEM; 405f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 406f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 407f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Build the WR 408f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 409f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker c2_wr_set_id(&wr, CCWR_CR_REJECT); 410f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr.hdr.context = (unsigned long) vq_req; 411f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr.rnic_handle = c2dev->adapter_handle; 412f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker wr.ep_handle = (u32) (unsigned long) cm_id->provider_data; 413f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 414f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 415f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * reference the request struct. dereferenced in the int handler. 416f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 417f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_get(c2dev, vq_req); 418f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 419f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 420f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Send WR to adapter 421f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 422f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = vq_send_wr(c2dev, (union c2wr *) & wr); 423f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (err) { 424f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_put(c2dev, vq_req); 425f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail0; 426f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 427f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 428f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 429f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Wait for reply from adapter 430f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 431f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = vq_wait_for_reply(c2dev, vq_req); 432f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (err) 433f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail0; 434f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 435f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 436f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * Process reply 437f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 438f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker reply = (struct c2wr_cr_reject_rep *) (unsigned long) 439f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req->reply_msg; 440f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker if (!reply) { 441f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = -ENOMEM; 442f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker goto bail0; 443f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker } 444f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker err = c2_errno(reply); 445f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker /* 446f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker * free vq stuff 447f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker */ 448f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_repbuf_free(c2dev, reply); 449f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker 450f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker bail0: 451f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker vq_req_free(c2dev, vq_req); 452f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker return err; 453f94b533d091a42da92d908eb7b3f9ade1923f90dTom Tucker} 454