Merge upstream kernel into libata 'passthru' branch
[linux-2.6] / drivers / infiniband / ulp / ipoib / ipoib_verbs.c
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 <rdma/ib_cache.h>
37
38 #include "ipoib.h"
39
40 int ipoib_mcast_attach(struct net_device *dev, u16 mlid, union ib_gid *mgid)
41 {
42         struct ipoib_dev_priv *priv = netdev_priv(dev);
43         struct ib_qp_attr *qp_attr;
44         int attr_mask;
45         int ret;
46         u16 pkey_index;
47
48         ret = -ENOMEM;
49         qp_attr = kmalloc(sizeof *qp_attr, GFP_KERNEL);
50         if (!qp_attr)
51                 goto out;
52
53         if (ib_find_cached_pkey(priv->ca, priv->port, priv->pkey, &pkey_index)) {
54                 clear_bit(IPOIB_PKEY_ASSIGNED, &priv->flags);
55                 ret = -ENXIO;
56                 goto out;
57         }
58         set_bit(IPOIB_PKEY_ASSIGNED, &priv->flags);
59
60         /* set correct QKey for QP */
61         qp_attr->qkey = priv->qkey;
62         attr_mask = IB_QP_QKEY;
63         ret = ib_modify_qp(priv->qp, qp_attr, attr_mask);
64         if (ret) {
65                 ipoib_warn(priv, "failed to modify QP, ret = %d\n", ret);
66                 goto out;
67         }
68
69         /* attach QP to multicast group */
70         down(&priv->mcast_mutex);
71         ret = ib_attach_mcast(priv->qp, mgid, mlid);
72         up(&priv->mcast_mutex);
73         if (ret)
74                 ipoib_warn(priv, "failed to attach to multicast group, ret = %d\n", ret);
75
76 out:
77         kfree(qp_attr);
78         return ret;
79 }
80
81 int ipoib_mcast_detach(struct net_device *dev, u16 mlid, union ib_gid *mgid)
82 {
83         struct ipoib_dev_priv *priv = netdev_priv(dev);
84         int ret;
85
86         down(&priv->mcast_mutex);
87         ret = ib_detach_mcast(priv->qp, mgid, mlid);
88         up(&priv->mcast_mutex);
89         if (ret)
90                 ipoib_warn(priv, "ib_detach_mcast failed (result = %d)\n", ret);
91
92         return ret;
93 }
94
95 int ipoib_qp_create(struct net_device *dev)
96 {
97         struct ipoib_dev_priv *priv = netdev_priv(dev);
98         int ret;
99         u16 pkey_index;
100         struct ib_qp_attr qp_attr;
101         int attr_mask;
102
103         /*
104          * Search through the port P_Key table for the requested pkey value.
105          * The port has to be assigned to the respective IB partition in
106          * advance.
107          */
108         ret = ib_find_cached_pkey(priv->ca, priv->port, priv->pkey, &pkey_index);
109         if (ret) {
110                 clear_bit(IPOIB_PKEY_ASSIGNED, &priv->flags);
111                 return ret;
112         }
113         set_bit(IPOIB_PKEY_ASSIGNED, &priv->flags);
114
115         qp_attr.qp_state = IB_QPS_INIT;
116         qp_attr.qkey = 0;
117         qp_attr.port_num = priv->port;
118         qp_attr.pkey_index = pkey_index;
119         attr_mask =
120             IB_QP_QKEY |
121             IB_QP_PORT |
122             IB_QP_PKEY_INDEX |
123             IB_QP_STATE;
124         ret = ib_modify_qp(priv->qp, &qp_attr, attr_mask);
125         if (ret) {
126                 ipoib_warn(priv, "failed to modify QP to init, ret = %d\n", ret);
127                 goto out_fail;
128         }
129
130         qp_attr.qp_state = IB_QPS_RTR;
131         /* Can't set this in a INIT->RTR transition */
132         attr_mask &= ~IB_QP_PORT;
133         ret = ib_modify_qp(priv->qp, &qp_attr, attr_mask);
134         if (ret) {
135                 ipoib_warn(priv, "failed to modify QP to RTR, ret = %d\n", ret);
136                 goto out_fail;
137         }
138
139         qp_attr.qp_state = IB_QPS_RTS;
140         qp_attr.sq_psn = 0;
141         attr_mask |= IB_QP_SQ_PSN;
142         attr_mask &= ~IB_QP_PKEY_INDEX;
143         ret = ib_modify_qp(priv->qp, &qp_attr, attr_mask);
144         if (ret) {
145                 ipoib_warn(priv, "failed to modify QP to RTS, ret = %d\n", ret);
146                 goto out_fail;
147         }
148
149         return 0;
150
151 out_fail:
152         ib_destroy_qp(priv->qp);
153         priv->qp = NULL;
154
155         return -EINVAL;
156 }
157
158 int ipoib_transport_dev_init(struct net_device *dev, struct ib_device *ca)
159 {
160         struct ipoib_dev_priv *priv = netdev_priv(dev);
161         struct ib_qp_init_attr init_attr = {
162                 .cap = {
163                         .max_send_wr  = IPOIB_TX_RING_SIZE,
164                         .max_recv_wr  = IPOIB_RX_RING_SIZE,
165                         .max_send_sge = 1,
166                         .max_recv_sge = 1
167                 },
168                 .sq_sig_type = IB_SIGNAL_ALL_WR,
169                 .qp_type     = IB_QPT_UD
170         };
171
172         priv->pd = ib_alloc_pd(priv->ca);
173         if (IS_ERR(priv->pd)) {
174                 printk(KERN_WARNING "%s: failed to allocate PD\n", ca->name);
175                 return -ENODEV;
176         }
177
178         priv->cq = ib_create_cq(priv->ca, ipoib_ib_completion, NULL, dev,
179                                 IPOIB_TX_RING_SIZE + IPOIB_RX_RING_SIZE + 1);
180         if (IS_ERR(priv->cq)) {
181                 printk(KERN_WARNING "%s: failed to create CQ\n", ca->name);
182                 goto out_free_pd;
183         }
184
185         if (ib_req_notify_cq(priv->cq, IB_CQ_NEXT_COMP))
186                 goto out_free_cq;
187
188         priv->mr = ib_get_dma_mr(priv->pd, IB_ACCESS_LOCAL_WRITE);
189         if (IS_ERR(priv->mr)) {
190                 printk(KERN_WARNING "%s: ib_get_dma_mr failed\n", ca->name);
191                 goto out_free_cq;
192         }
193
194         init_attr.send_cq = priv->cq;
195         init_attr.recv_cq = priv->cq,
196
197         priv->qp = ib_create_qp(priv->pd, &init_attr);
198         if (IS_ERR(priv->qp)) {
199                 printk(KERN_WARNING "%s: failed to create QP\n", ca->name);
200                 goto out_free_mr;
201         }
202
203         priv->dev->dev_addr[1] = (priv->qp->qp_num >> 16) & 0xff;
204         priv->dev->dev_addr[2] = (priv->qp->qp_num >>  8) & 0xff;
205         priv->dev->dev_addr[3] = (priv->qp->qp_num      ) & 0xff;
206
207         priv->tx_sge.lkey       = priv->mr->lkey;
208
209         priv->tx_wr.opcode      = IB_WR_SEND;
210         priv->tx_wr.sg_list     = &priv->tx_sge;
211         priv->tx_wr.num_sge     = 1;
212         priv->tx_wr.send_flags  = IB_SEND_SIGNALED;
213
214         return 0;
215
216 out_free_mr:
217         ib_dereg_mr(priv->mr);
218
219 out_free_cq:
220         ib_destroy_cq(priv->cq);
221
222 out_free_pd:
223         ib_dealloc_pd(priv->pd);
224         return -ENODEV;
225 }
226
227 void ipoib_transport_dev_cleanup(struct net_device *dev)
228 {
229         struct ipoib_dev_priv *priv = netdev_priv(dev);
230
231         if (priv->qp) {
232                 if (ib_destroy_qp(priv->qp))
233                         ipoib_warn(priv, "ib_qp_destroy failed\n");
234
235                 priv->qp = NULL;
236                 clear_bit(IPOIB_PKEY_ASSIGNED, &priv->flags);
237         }
238
239         if (ib_dereg_mr(priv->mr))
240                 ipoib_warn(priv, "ib_dereg_mr failed\n");
241
242         if (ib_destroy_cq(priv->cq))
243                 ipoib_warn(priv, "ib_cq_destroy failed\n");
244
245         if (ib_dealloc_pd(priv->pd))
246                 ipoib_warn(priv, "ib_dealloc_pd failed\n");
247 }
248
249 void ipoib_event(struct ib_event_handler *handler,
250                  struct ib_event *record)
251 {
252         struct ipoib_dev_priv *priv =
253                 container_of(handler, struct ipoib_dev_priv, event_handler);
254
255         if (record->event == IB_EVENT_PORT_ACTIVE ||
256             record->event == IB_EVENT_LID_CHANGE  ||
257             record->event == IB_EVENT_SM_CHANGE) {
258                 ipoib_dbg(priv, "Port active event\n");
259                 schedule_work(&priv->flush_task);
260         }
261 }