Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * Copyright (c) 2004, 2005 Topspin Communications. All rights reserved. | |
2a1d9b7f | 3 | * Copyright (c) 2005 Mellanox Technologies. All rights reserved. |
1da177e4 LT |
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 | ||
1da177e4 LT |
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; | |
1da177e4 LT |
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 | ||
26bbf13c | 50 | if (ib_find_pkey(priv->ca, priv->port, priv->pkey, &pkey_index)) { |
1da177e4 LT |
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; | |
3bc12e75 | 59 | ret = ib_modify_qp(priv->qp, qp_attr, IB_QP_QKEY); |
1da177e4 LT |
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 */ | |
95ed644f | 66 | mutex_lock(&priv->mcast_mutex); |
1da177e4 | 67 | ret = ib_attach_mcast(priv->qp, mgid, mlid); |
95ed644f | 68 | mutex_unlock(&priv->mcast_mutex); |
1da177e4 LT |
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 | ||
95ed644f | 82 | mutex_lock(&priv->mcast_mutex); |
1da177e4 | 83 | ret = ib_detach_mcast(priv->qp, mgid, mlid); |
95ed644f | 84 | mutex_unlock(&priv->mcast_mutex); |
1da177e4 LT |
85 | if (ret) |
86 | ipoib_warn(priv, "ib_detach_mcast failed (result = %d)\n", ret); | |
87 | ||
88 | return ret; | |
89 | } | |
90 | ||
5b6810e0 | 91 | int ipoib_init_qp(struct net_device *dev) |
1da177e4 LT |
92 | { |
93 | struct ipoib_dev_priv *priv = netdev_priv(dev); | |
94 | int ret; | |
1da177e4 LT |
95 | struct ib_qp_attr qp_attr; |
96 | int attr_mask; | |
97 | ||
26bbf13c YE |
98 | if (!test_bit(IPOIB_PKEY_ASSIGNED, &priv->flags)) |
99 | return -1; | |
1da177e4 LT |
100 | |
101 | qp_attr.qp_state = IB_QPS_INIT; | |
102 | qp_attr.qkey = 0; | |
103 | qp_attr.port_num = priv->port; | |
26bbf13c | 104 | qp_attr.pkey_index = priv->pkey_index; |
1da177e4 LT |
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: | |
5b6810e0 RD |
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"); | |
1da177e4 | 141 | |
5b6810e0 | 142 | return ret; |
1da177e4 LT |
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 = { | |
0f485251 SM |
150 | .max_send_wr = ipoib_sendq_size, |
151 | .max_recv_wr = ipoib_recvq_size, | |
1da177e4 LT |
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 | ||
839fcaba MT |
159 | int ret, size; |
160 | ||
1da177e4 LT |
161 | priv->pd = ib_alloc_pd(priv->ca); |
162 | if (IS_ERR(priv->pd)) { | |
163 | printk(KERN_WARNING "%s: failed to allocate PD\n", ca->name); | |
164 | return -ENODEV; | |
165 | } | |
166 | ||
839fcaba MT |
167 | priv->mr = ib_get_dma_mr(priv->pd, IB_ACCESS_LOCAL_WRITE); |
168 | if (IS_ERR(priv->mr)) { | |
169 | printk(KERN_WARNING "%s: ib_get_dma_mr failed\n", ca->name); | |
170 | goto out_free_pd; | |
171 | } | |
172 | ||
173 | size = ipoib_sendq_size + ipoib_recvq_size + 1; | |
174 | ret = ipoib_cm_dev_init(dev); | |
68e995a2 PS |
175 | if (!ret) { |
176 | if (ipoib_cm_has_srq(dev)) | |
177 | size += ipoib_recvq_size + 1; /* 1 extra for rx_drain_qp */ | |
178 | else | |
179 | size += ipoib_recvq_size * ipoib_max_conn_qp; | |
180 | } | |
839fcaba | 181 | |
f4fd0b22 | 182 | priv->cq = ib_create_cq(priv->ca, ipoib_ib_completion, NULL, dev, size, 0); |
1da177e4 LT |
183 | if (IS_ERR(priv->cq)) { |
184 | printk(KERN_WARNING "%s: failed to create CQ\n", ca->name); | |
839fcaba | 185 | goto out_free_mr; |
1da177e4 LT |
186 | } |
187 | ||
188 | if (ib_req_notify_cq(priv->cq, IB_CQ_NEXT_COMP)) | |
189 | goto out_free_cq; | |
190 | ||
1da177e4 | 191 | init_attr.send_cq = priv->cq; |
b3ac60fc | 192 | init_attr.recv_cq = priv->cq; |
1da177e4 LT |
193 | |
194 | priv->qp = ib_create_qp(priv->pd, &init_attr); | |
195 | if (IS_ERR(priv->qp)) { | |
196 | printk(KERN_WARNING "%s: failed to create QP\n", ca->name); | |
839fcaba | 197 | goto out_free_cq; |
1da177e4 LT |
198 | } |
199 | ||
200 | priv->dev->dev_addr[1] = (priv->qp->qp_num >> 16) & 0xff; | |
201 | priv->dev->dev_addr[2] = (priv->qp->qp_num >> 8) & 0xff; | |
202 | priv->dev->dev_addr[3] = (priv->qp->qp_num ) & 0xff; | |
203 | ||
2337f809 | 204 | priv->tx_sge.lkey = priv->mr->lkey; |
1da177e4 | 205 | |
2337f809 RD |
206 | priv->tx_wr.opcode = IB_WR_SEND; |
207 | priv->tx_wr.sg_list = &priv->tx_sge; | |
208 | priv->tx_wr.num_sge = 1; | |
209 | priv->tx_wr.send_flags = IB_SEND_SIGNALED; | |
1da177e4 LT |
210 | |
211 | return 0; | |
212 | ||
1da177e4 LT |
213 | out_free_cq: |
214 | ib_destroy_cq(priv->cq); | |
215 | ||
839fcaba MT |
216 | out_free_mr: |
217 | ib_dereg_mr(priv->mr); | |
6958e827 | 218 | ipoib_cm_dev_cleanup(dev); |
839fcaba | 219 | |
1da177e4 LT |
220 | out_free_pd: |
221 | ib_dealloc_pd(priv->pd); | |
222 | return -ENODEV; | |
223 | } | |
224 | ||
225 | void ipoib_transport_dev_cleanup(struct net_device *dev) | |
226 | { | |
227 | struct ipoib_dev_priv *priv = netdev_priv(dev); | |
228 | ||
229 | if (priv->qp) { | |
230 | if (ib_destroy_qp(priv->qp)) | |
231 | ipoib_warn(priv, "ib_qp_destroy failed\n"); | |
232 | ||
233 | priv->qp = NULL; | |
234 | clear_bit(IPOIB_PKEY_ASSIGNED, &priv->flags); | |
235 | } | |
236 | ||
1da177e4 LT |
237 | if (ib_destroy_cq(priv->cq)) |
238 | ipoib_warn(priv, "ib_cq_destroy failed\n"); | |
239 | ||
839fcaba MT |
240 | ipoib_cm_dev_cleanup(dev); |
241 | ||
242 | if (ib_dereg_mr(priv->mr)) | |
243 | ipoib_warn(priv, "ib_dereg_mr failed\n"); | |
244 | ||
1da177e4 LT |
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 | ||
26bbf13c YE |
255 | if (record->element.port_num != priv->port) |
256 | return; | |
257 | ||
258 | if (record->event == IB_EVENT_PORT_ERR || | |
259 | record->event == IB_EVENT_PORT_ACTIVE || | |
260 | record->event == IB_EVENT_LID_CHANGE || | |
261 | record->event == IB_EVENT_SM_CHANGE || | |
262 | record->event == IB_EVENT_CLIENT_REREGISTER) { | |
4e37b956 | 263 | ipoib_dbg(priv, "Port state change event\n"); |
0b3ea082 | 264 | queue_work(ipoib_workqueue, &priv->flush_task); |
26bbf13c YE |
265 | } else if (record->event == IB_EVENT_PKEY_CHANGE) { |
266 | ipoib_dbg(priv, "P_Key change event on port:%d\n", priv->port); | |
267 | queue_work(ipoib_workqueue, &priv->pkey_event_task); | |
1da177e4 LT |
268 | } |
269 | } |