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. | |
1da177e4 LT |
32 | */ |
33 | ||
1da177e4 LT |
34 | #include "ipoib.h" |
35 | ||
36 | int ipoib_mcast_attach(struct net_device *dev, u16 mlid, union ib_gid *mgid) | |
37 | { | |
38 | struct ipoib_dev_priv *priv = netdev_priv(dev); | |
39 | struct ib_qp_attr *qp_attr; | |
1da177e4 LT |
40 | int ret; |
41 | u16 pkey_index; | |
42 | ||
43 | ret = -ENOMEM; | |
44 | qp_attr = kmalloc(sizeof *qp_attr, GFP_KERNEL); | |
45 | if (!qp_attr) | |
46 | goto out; | |
47 | ||
26bbf13c | 48 | if (ib_find_pkey(priv->ca, priv->port, priv->pkey, &pkey_index)) { |
1da177e4 LT |
49 | clear_bit(IPOIB_PKEY_ASSIGNED, &priv->flags); |
50 | ret = -ENXIO; | |
51 | goto out; | |
52 | } | |
53 | set_bit(IPOIB_PKEY_ASSIGNED, &priv->flags); | |
54 | ||
55 | /* set correct QKey for QP */ | |
56 | qp_attr->qkey = priv->qkey; | |
3bc12e75 | 57 | ret = ib_modify_qp(priv->qp, qp_attr, IB_QP_QKEY); |
1da177e4 LT |
58 | if (ret) { |
59 | ipoib_warn(priv, "failed to modify QP, ret = %d\n", ret); | |
60 | goto out; | |
61 | } | |
62 | ||
63 | /* attach QP to multicast group */ | |
1da177e4 | 64 | ret = ib_attach_mcast(priv->qp, mgid, mlid); |
1da177e4 LT |
65 | if (ret) |
66 | ipoib_warn(priv, "failed to attach to multicast group, ret = %d\n", ret); | |
67 | ||
68 | out: | |
69 | kfree(qp_attr); | |
70 | return ret; | |
71 | } | |
72 | ||
73 | int ipoib_mcast_detach(struct net_device *dev, u16 mlid, union ib_gid *mgid) | |
74 | { | |
75 | struct ipoib_dev_priv *priv = netdev_priv(dev); | |
76 | int ret; | |
77 | ||
1da177e4 | 78 | ret = ib_detach_mcast(priv->qp, mgid, mlid); |
1da177e4 LT |
79 | if (ret) |
80 | ipoib_warn(priv, "ib_detach_mcast failed (result = %d)\n", ret); | |
81 | ||
82 | return ret; | |
83 | } | |
84 | ||
5b6810e0 | 85 | int ipoib_init_qp(struct net_device *dev) |
1da177e4 LT |
86 | { |
87 | struct ipoib_dev_priv *priv = netdev_priv(dev); | |
88 | int ret; | |
1da177e4 LT |
89 | struct ib_qp_attr qp_attr; |
90 | int attr_mask; | |
91 | ||
26bbf13c YE |
92 | if (!test_bit(IPOIB_PKEY_ASSIGNED, &priv->flags)) |
93 | return -1; | |
1da177e4 LT |
94 | |
95 | qp_attr.qp_state = IB_QPS_INIT; | |
96 | qp_attr.qkey = 0; | |
97 | qp_attr.port_num = priv->port; | |
26bbf13c | 98 | qp_attr.pkey_index = priv->pkey_index; |
1da177e4 LT |
99 | attr_mask = |
100 | IB_QP_QKEY | | |
101 | IB_QP_PORT | | |
102 | IB_QP_PKEY_INDEX | | |
103 | IB_QP_STATE; | |
104 | ret = ib_modify_qp(priv->qp, &qp_attr, attr_mask); | |
105 | if (ret) { | |
106 | ipoib_warn(priv, "failed to modify QP to init, ret = %d\n", ret); | |
107 | goto out_fail; | |
108 | } | |
109 | ||
110 | qp_attr.qp_state = IB_QPS_RTR; | |
111 | /* Can't set this in a INIT->RTR transition */ | |
112 | attr_mask &= ~IB_QP_PORT; | |
113 | ret = ib_modify_qp(priv->qp, &qp_attr, attr_mask); | |
114 | if (ret) { | |
115 | ipoib_warn(priv, "failed to modify QP to RTR, ret = %d\n", ret); | |
116 | goto out_fail; | |
117 | } | |
118 | ||
119 | qp_attr.qp_state = IB_QPS_RTS; | |
120 | qp_attr.sq_psn = 0; | |
121 | attr_mask |= IB_QP_SQ_PSN; | |
122 | attr_mask &= ~IB_QP_PKEY_INDEX; | |
123 | ret = ib_modify_qp(priv->qp, &qp_attr, attr_mask); | |
124 | if (ret) { | |
125 | ipoib_warn(priv, "failed to modify QP to RTS, ret = %d\n", ret); | |
126 | goto out_fail; | |
127 | } | |
128 | ||
129 | return 0; | |
130 | ||
131 | out_fail: | |
5b6810e0 RD |
132 | qp_attr.qp_state = IB_QPS_RESET; |
133 | if (ib_modify_qp(priv->qp, &qp_attr, IB_QP_STATE)) | |
134 | ipoib_warn(priv, "Failed to modify QP to RESET state\n"); | |
1da177e4 | 135 | |
5b6810e0 | 136 | return ret; |
1da177e4 LT |
137 | } |
138 | ||
139 | int ipoib_transport_dev_init(struct net_device *dev, struct ib_device *ca) | |
140 | { | |
141 | struct ipoib_dev_priv *priv = netdev_priv(dev); | |
142 | struct ib_qp_init_attr init_attr = { | |
143 | .cap = { | |
0f485251 SM |
144 | .max_send_wr = ipoib_sendq_size, |
145 | .max_recv_wr = ipoib_recvq_size, | |
1da177e4 | 146 | .max_send_sge = 1, |
bc7b3a36 | 147 | .max_recv_sge = IPOIB_UD_RX_SG |
1da177e4 LT |
148 | }, |
149 | .sq_sig_type = IB_SIGNAL_ALL_WR, | |
150 | .qp_type = IB_QPT_UD | |
151 | }; | |
152 | ||
839fcaba | 153 | int ret, size; |
7143740d | 154 | int i; |
839fcaba | 155 | |
1da177e4 LT |
156 | priv->pd = ib_alloc_pd(priv->ca); |
157 | if (IS_ERR(priv->pd)) { | |
158 | printk(KERN_WARNING "%s: failed to allocate PD\n", ca->name); | |
159 | return -ENODEV; | |
160 | } | |
161 | ||
839fcaba MT |
162 | priv->mr = ib_get_dma_mr(priv->pd, IB_ACCESS_LOCAL_WRITE); |
163 | if (IS_ERR(priv->mr)) { | |
164 | printk(KERN_WARNING "%s: ib_get_dma_mr failed\n", ca->name); | |
165 | goto out_free_pd; | |
166 | } | |
167 | ||
f56bcd80 | 168 | size = ipoib_recvq_size + 1; |
839fcaba | 169 | ret = ipoib_cm_dev_init(dev); |
68e995a2 | 170 | if (!ret) { |
f56bcd80 | 171 | size += ipoib_sendq_size; |
68e995a2 PS |
172 | if (ipoib_cm_has_srq(dev)) |
173 | size += ipoib_recvq_size + 1; /* 1 extra for rx_drain_qp */ | |
174 | else | |
175 | size += ipoib_recvq_size * ipoib_max_conn_qp; | |
176 | } | |
839fcaba | 177 | |
f56bcd80 EC |
178 | priv->recv_cq = ib_create_cq(priv->ca, ipoib_ib_completion, NULL, dev, size, 0); |
179 | if (IS_ERR(priv->recv_cq)) { | |
180 | printk(KERN_WARNING "%s: failed to create receive CQ\n", ca->name); | |
839fcaba | 181 | goto out_free_mr; |
1da177e4 LT |
182 | } |
183 | ||
57ce41d1 EC |
184 | priv->send_cq = ib_create_cq(priv->ca, ipoib_send_comp_handler, NULL, |
185 | dev, ipoib_sendq_size, 0); | |
f56bcd80 EC |
186 | if (IS_ERR(priv->send_cq)) { |
187 | printk(KERN_WARNING "%s: failed to create send CQ\n", ca->name); | |
188 | goto out_free_recv_cq; | |
189 | } | |
190 | ||
191 | if (ib_req_notify_cq(priv->recv_cq, IB_CQ_NEXT_COMP)) | |
192 | goto out_free_send_cq; | |
1da177e4 | 193 | |
f56bcd80 EC |
194 | init_attr.send_cq = priv->send_cq; |
195 | init_attr.recv_cq = priv->recv_cq; | |
1da177e4 | 196 | |
40ca1988 | 197 | if (priv->hca_caps & IB_DEVICE_UD_TSO) |
12406734 RL |
198 | init_attr.create_flags |= IB_QP_CREATE_IPOIB_UD_LSO; |
199 | ||
200 | if (priv->hca_caps & IB_DEVICE_BLOCK_MULTICAST_LOOPBACK) | |
201 | init_attr.create_flags |= IB_QP_CREATE_BLOCK_MULTICAST_LOOPBACK; | |
40ca1988 | 202 | |
7143740d EC |
203 | if (dev->features & NETIF_F_SG) |
204 | init_attr.cap.max_send_sge = MAX_SKB_FRAGS + 1; | |
205 | ||
1da177e4 LT |
206 | priv->qp = ib_create_qp(priv->pd, &init_attr); |
207 | if (IS_ERR(priv->qp)) { | |
208 | printk(KERN_WARNING "%s: failed to create QP\n", ca->name); | |
f56bcd80 | 209 | goto out_free_send_cq; |
1da177e4 LT |
210 | } |
211 | ||
212 | priv->dev->dev_addr[1] = (priv->qp->qp_num >> 16) & 0xff; | |
213 | priv->dev->dev_addr[2] = (priv->qp->qp_num >> 8) & 0xff; | |
214 | priv->dev->dev_addr[3] = (priv->qp->qp_num ) & 0xff; | |
215 | ||
7143740d EC |
216 | for (i = 0; i < MAX_SKB_FRAGS + 1; ++i) |
217 | priv->tx_sge[i].lkey = priv->mr->lkey; | |
1da177e4 | 218 | |
2337f809 | 219 | priv->tx_wr.opcode = IB_WR_SEND; |
7143740d | 220 | priv->tx_wr.sg_list = priv->tx_sge; |
2337f809 | 221 | priv->tx_wr.send_flags = IB_SEND_SIGNALED; |
1da177e4 | 222 | |
bc7b3a36 SM |
223 | priv->rx_sge[0].lkey = priv->mr->lkey; |
224 | if (ipoib_ud_need_sg(priv->max_ib_mtu)) { | |
225 | priv->rx_sge[0].length = IPOIB_UD_HEAD_SIZE; | |
226 | priv->rx_sge[1].length = PAGE_SIZE; | |
227 | priv->rx_sge[1].lkey = priv->mr->lkey; | |
228 | priv->rx_wr.num_sge = IPOIB_UD_RX_SG; | |
229 | } else { | |
230 | priv->rx_sge[0].length = IPOIB_UD_BUF_SIZE(priv->max_ib_mtu); | |
231 | priv->rx_wr.num_sge = 1; | |
232 | } | |
233 | priv->rx_wr.next = NULL; | |
234 | priv->rx_wr.sg_list = priv->rx_sge; | |
235 | ||
1da177e4 LT |
236 | return 0; |
237 | ||
f56bcd80 EC |
238 | out_free_send_cq: |
239 | ib_destroy_cq(priv->send_cq); | |
240 | ||
241 | out_free_recv_cq: | |
242 | ib_destroy_cq(priv->recv_cq); | |
1da177e4 | 243 | |
839fcaba MT |
244 | out_free_mr: |
245 | ib_dereg_mr(priv->mr); | |
6958e827 | 246 | ipoib_cm_dev_cleanup(dev); |
839fcaba | 247 | |
1da177e4 LT |
248 | out_free_pd: |
249 | ib_dealloc_pd(priv->pd); | |
250 | return -ENODEV; | |
251 | } | |
252 | ||
253 | void ipoib_transport_dev_cleanup(struct net_device *dev) | |
254 | { | |
255 | struct ipoib_dev_priv *priv = netdev_priv(dev); | |
256 | ||
257 | if (priv->qp) { | |
258 | if (ib_destroy_qp(priv->qp)) | |
259 | ipoib_warn(priv, "ib_qp_destroy failed\n"); | |
260 | ||
261 | priv->qp = NULL; | |
262 | clear_bit(IPOIB_PKEY_ASSIGNED, &priv->flags); | |
263 | } | |
264 | ||
f56bcd80 EC |
265 | if (ib_destroy_cq(priv->send_cq)) |
266 | ipoib_warn(priv, "ib_cq_destroy (send) failed\n"); | |
267 | ||
268 | if (ib_destroy_cq(priv->recv_cq)) | |
269 | ipoib_warn(priv, "ib_cq_destroy (recv) failed\n"); | |
1da177e4 | 270 | |
839fcaba MT |
271 | ipoib_cm_dev_cleanup(dev); |
272 | ||
273 | if (ib_dereg_mr(priv->mr)) | |
274 | ipoib_warn(priv, "ib_dereg_mr failed\n"); | |
275 | ||
1da177e4 LT |
276 | if (ib_dealloc_pd(priv->pd)) |
277 | ipoib_warn(priv, "ib_dealloc_pd failed\n"); | |
278 | } | |
279 | ||
280 | void ipoib_event(struct ib_event_handler *handler, | |
281 | struct ib_event *record) | |
282 | { | |
283 | struct ipoib_dev_priv *priv = | |
284 | container_of(handler, struct ipoib_dev_priv, event_handler); | |
285 | ||
26bbf13c YE |
286 | if (record->element.port_num != priv->port) |
287 | return; | |
288 | ||
ee1e2c82 MS |
289 | ipoib_dbg(priv, "Event %d on device %s port %d\n", record->event, |
290 | record->device->name, record->element.port_num); | |
291 | ||
292 | if (record->event == IB_EVENT_SM_CHANGE || | |
26bbf13c | 293 | record->event == IB_EVENT_CLIENT_REREGISTER) { |
ee1e2c82 MS |
294 | queue_work(ipoib_workqueue, &priv->flush_light); |
295 | } else if (record->event == IB_EVENT_PORT_ERR || | |
296 | record->event == IB_EVENT_PORT_ACTIVE || | |
297 | record->event == IB_EVENT_LID_CHANGE) { | |
298 | queue_work(ipoib_workqueue, &priv->flush_normal); | |
26bbf13c | 299 | } else if (record->event == IB_EVENT_PKEY_CHANGE) { |
ee1e2c82 | 300 | queue_work(ipoib_workqueue, &priv->flush_heavy); |
1da177e4 LT |
301 | } |
302 | } |