1 /* 2 * Copyright (c) 2004, 2005 Topspin Communications. All rights reserved. 3 * Copyright (c) 2005 Mellanox Technologies. All rights reserved. 4 * 5 * This software is available to you under a choice of one of two 6 * licenses. You may choose to be licensed under the terms of the GNU 7 * General Public License (GPL) Version 2, available from the file 8 * COPYING in the main directory of this source tree, or the 9 * OpenIB.org BSD license below: 10 * 11 * Redistribution and use in source and binary forms, with or 12 * without modification, are permitted provided that the following 13 * conditions are met: 14 * 15 * - Redistributions of source code must retain the above 16 * copyright notice, this list of conditions and the following 17 * disclaimer. 18 * 19 * - Redistributions in binary form must reproduce the above 20 * copyright notice, this list of conditions and the following 21 * disclaimer in the documentation and/or other materials 22 * provided with the distribution. 23 * 24 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 25 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 26 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 27 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 28 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 29 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 30 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 31 * SOFTWARE. 32 * 33 * $Id: ipoib_verbs.c 1349 2004-12-16 21:09:43Z roland $ 34 */ 35 36 #include "ipoib.h" 37 38 int ipoib_mcast_attach(struct net_device *dev, u16 mlid, union ib_gid *mgid) 39 { 40 struct ipoib_dev_priv *priv = netdev_priv(dev); 41 struct ib_qp_attr *qp_attr; 42 int ret; 43 u16 pkey_index; 44 45 ret = -ENOMEM; 46 qp_attr = kmalloc(sizeof *qp_attr, GFP_KERNEL); 47 if (!qp_attr) 48 goto out; 49 50 if (ib_find_pkey(priv->ca, priv->port, priv->pkey, &pkey_index)) { 51 clear_bit(IPOIB_PKEY_ASSIGNED, &priv->flags); 52 ret = -ENXIO; 53 goto out; 54 } 55 set_bit(IPOIB_PKEY_ASSIGNED, &priv->flags); 56 57 /* set correct QKey for QP */ 58 qp_attr->qkey = priv->qkey; 59 ret = ib_modify_qp(priv->qp, qp_attr, IB_QP_QKEY); 60 if (ret) { 61 ipoib_warn(priv, "failed to modify QP, ret = %d\n", ret); 62 goto out; 63 } 64 65 /* attach QP to multicast group */ 66 mutex_lock(&priv->mcast_mutex); 67 ret = ib_attach_mcast(priv->qp, mgid, mlid); 68 mutex_unlock(&priv->mcast_mutex); 69 if (ret) 70 ipoib_warn(priv, "failed to attach to multicast group, ret = %d\n", ret); 71 72 out: 73 kfree(qp_attr); 74 return ret; 75 } 76 77 int ipoib_mcast_detach(struct net_device *dev, u16 mlid, union ib_gid *mgid) 78 { 79 struct ipoib_dev_priv *priv = netdev_priv(dev); 80 int ret; 81 82 mutex_lock(&priv->mcast_mutex); 83 ret = ib_detach_mcast(priv->qp, mgid, mlid); 84 mutex_unlock(&priv->mcast_mutex); 85 if (ret) 86 ipoib_warn(priv, "ib_detach_mcast failed (result = %d)\n", ret); 87 88 return ret; 89 } 90 91 int ipoib_init_qp(struct net_device *dev) 92 { 93 struct ipoib_dev_priv *priv = netdev_priv(dev); 94 int ret; 95 struct ib_qp_attr qp_attr; 96 int attr_mask; 97 98 if (!test_bit(IPOIB_PKEY_ASSIGNED, &priv->flags)) 99 return -1; 100 101 qp_attr.qp_state = IB_QPS_INIT; 102 qp_attr.qkey = 0; 103 qp_attr.port_num = priv->port; 104 qp_attr.pkey_index = priv->pkey_index; 105 attr_mask = 106 IB_QP_QKEY | 107 IB_QP_PORT | 108 IB_QP_PKEY_INDEX | 109 IB_QP_STATE; 110 ret = ib_modify_qp(priv->qp, &qp_attr, attr_mask); 111 if (ret) { 112 ipoib_warn(priv, "failed to modify QP to init, ret = %d\n", ret); 113 goto out_fail; 114 } 115 116 qp_attr.qp_state = IB_QPS_RTR; 117 /* Can't set this in a INIT->RTR transition */ 118 attr_mask &= ~IB_QP_PORT; 119 ret = ib_modify_qp(priv->qp, &qp_attr, attr_mask); 120 if (ret) { 121 ipoib_warn(priv, "failed to modify QP to RTR, ret = %d\n", ret); 122 goto out_fail; 123 } 124 125 qp_attr.qp_state = IB_QPS_RTS; 126 qp_attr.sq_psn = 0; 127 attr_mask |= IB_QP_SQ_PSN; 128 attr_mask &= ~IB_QP_PKEY_INDEX; 129 ret = ib_modify_qp(priv->qp, &qp_attr, attr_mask); 130 if (ret) { 131 ipoib_warn(priv, "failed to modify QP to RTS, ret = %d\n", ret); 132 goto out_fail; 133 } 134 135 return 0; 136 137 out_fail: 138 qp_attr.qp_state = IB_QPS_RESET; 139 if (ib_modify_qp(priv->qp, &qp_attr, IB_QP_STATE)) 140 ipoib_warn(priv, "Failed to modify QP to RESET state\n"); 141 142 return ret; 143 } 144 145 int ipoib_transport_dev_init(struct net_device *dev, struct ib_device *ca) 146 { 147 struct ipoib_dev_priv *priv = netdev_priv(dev); 148 struct ib_qp_init_attr init_attr = { 149 .cap = { 150 .max_send_wr = ipoib_sendq_size, 151 .max_recv_wr = ipoib_recvq_size, 152 .max_send_sge = 1, 153 .max_recv_sge = 1 154 }, 155 .sq_sig_type = IB_SIGNAL_ALL_WR, 156 .qp_type = IB_QPT_UD 157 }; 158 159 int ret, size; 160 int i; 161 162 priv->pd = ib_alloc_pd(priv->ca); 163 if (IS_ERR(priv->pd)) { 164 printk(KERN_WARNING "%s: failed to allocate PD\n", ca->name); 165 return -ENODEV; 166 } 167 168 priv->mr = ib_get_dma_mr(priv->pd, IB_ACCESS_LOCAL_WRITE); 169 if (IS_ERR(priv->mr)) { 170 printk(KERN_WARNING "%s: ib_get_dma_mr failed\n", ca->name); 171 goto out_free_pd; 172 } 173 174 size = ipoib_sendq_size + ipoib_recvq_size + 1; 175 ret = ipoib_cm_dev_init(dev); 176 if (!ret) { 177 if (ipoib_cm_has_srq(dev)) 178 size += ipoib_recvq_size + 1; /* 1 extra for rx_drain_qp */ 179 else 180 size += ipoib_recvq_size * ipoib_max_conn_qp; 181 } 182 183 priv->cq = ib_create_cq(priv->ca, ipoib_ib_completion, NULL, dev, size, 0); 184 if (IS_ERR(priv->cq)) { 185 printk(KERN_WARNING "%s: failed to create CQ\n", ca->name); 186 goto out_free_mr; 187 } 188 189 if (ib_req_notify_cq(priv->cq, IB_CQ_NEXT_COMP)) 190 goto out_free_cq; 191 192 init_attr.send_cq = priv->cq; 193 init_attr.recv_cq = priv->cq; 194 195 if (dev->features & NETIF_F_SG) 196 init_attr.cap.max_send_sge = MAX_SKB_FRAGS + 1; 197 198 priv->qp = ib_create_qp(priv->pd, &init_attr); 199 if (IS_ERR(priv->qp)) { 200 printk(KERN_WARNING "%s: failed to create QP\n", ca->name); 201 goto out_free_cq; 202 } 203 204 priv->dev->dev_addr[1] = (priv->qp->qp_num >> 16) & 0xff; 205 priv->dev->dev_addr[2] = (priv->qp->qp_num >> 8) & 0xff; 206 priv->dev->dev_addr[3] = (priv->qp->qp_num ) & 0xff; 207 208 for (i = 0; i < MAX_SKB_FRAGS + 1; ++i) 209 priv->tx_sge[i].lkey = priv->mr->lkey; 210 211 priv->tx_wr.opcode = IB_WR_SEND; 212 priv->tx_wr.sg_list = priv->tx_sge; 213 priv->tx_wr.send_flags = IB_SEND_SIGNALED; 214 215 return 0; 216 217 out_free_cq: 218 ib_destroy_cq(priv->cq); 219 220 out_free_mr: 221 ib_dereg_mr(priv->mr); 222 ipoib_cm_dev_cleanup(dev); 223 224 out_free_pd: 225 ib_dealloc_pd(priv->pd); 226 return -ENODEV; 227 } 228 229 void ipoib_transport_dev_cleanup(struct net_device *dev) 230 { 231 struct ipoib_dev_priv *priv = netdev_priv(dev); 232 233 if (priv->qp) { 234 if (ib_destroy_qp(priv->qp)) 235 ipoib_warn(priv, "ib_qp_destroy failed\n"); 236 237 priv->qp = NULL; 238 clear_bit(IPOIB_PKEY_ASSIGNED, &priv->flags); 239 } 240 241 if (ib_destroy_cq(priv->cq)) 242 ipoib_warn(priv, "ib_cq_destroy failed\n"); 243 244 ipoib_cm_dev_cleanup(dev); 245 246 if (ib_dereg_mr(priv->mr)) 247 ipoib_warn(priv, "ib_dereg_mr failed\n"); 248 249 if (ib_dealloc_pd(priv->pd)) 250 ipoib_warn(priv, "ib_dealloc_pd failed\n"); 251 } 252 253 void ipoib_event(struct ib_event_handler *handler, 254 struct ib_event *record) 255 { 256 struct ipoib_dev_priv *priv = 257 container_of(handler, struct ipoib_dev_priv, event_handler); 258 259 if (record->element.port_num != priv->port) 260 return; 261 262 if (record->event == IB_EVENT_PORT_ERR || 263 record->event == IB_EVENT_PORT_ACTIVE || 264 record->event == IB_EVENT_LID_CHANGE || 265 record->event == IB_EVENT_SM_CHANGE || 266 record->event == IB_EVENT_CLIENT_REREGISTER) { 267 ipoib_dbg(priv, "Port state change event\n"); 268 queue_work(ipoib_workqueue, &priv->flush_task); 269 } else if (record->event == IB_EVENT_PKEY_CHANGE) { 270 ipoib_dbg(priv, "P_Key change event on port:%d\n", priv->port); 271 queue_work(ipoib_workqueue, &priv->pkey_event_task); 272 } 273 } 274