]>
Commit | Line | Data |
---|---|---|
77241056 | 1 | /* |
05d6ac1d | 2 | * Copyright(c) 2015, 2016 Intel Corporation. |
77241056 MM |
3 | * |
4 | * This file is provided under a dual BSD/GPLv2 license. When using or | |
5 | * redistributing this file, you may do so under either license. | |
6 | * | |
7 | * GPL LICENSE SUMMARY | |
8 | * | |
77241056 MM |
9 | * This program is free software; you can redistribute it and/or modify |
10 | * it under the terms of version 2 of the GNU General Public License as | |
11 | * published by the Free Software Foundation. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, but | |
14 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
16 | * General Public License for more details. | |
17 | * | |
18 | * BSD LICENSE | |
19 | * | |
77241056 MM |
20 | * Redistribution and use in source and binary forms, with or without |
21 | * modification, are permitted provided that the following conditions | |
22 | * are met: | |
23 | * | |
24 | * - Redistributions of source code must retain the above copyright | |
25 | * notice, this list of conditions and the following disclaimer. | |
26 | * - Redistributions in binary form must reproduce the above copyright | |
27 | * notice, this list of conditions and the following disclaimer in | |
28 | * the documentation and/or other materials provided with the | |
29 | * distribution. | |
30 | * - Neither the name of Intel Corporation nor the names of its | |
31 | * contributors may be used to endorse or promote products derived | |
32 | * from this software without specific prior written permission. | |
33 | * | |
34 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | |
35 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT | |
36 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR | |
37 | * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT | |
38 | * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, | |
39 | * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT | |
40 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, | |
41 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY | |
42 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | |
43 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE | |
44 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | |
45 | * | |
46 | */ | |
47 | ||
48 | #include <linux/io.h> | |
ec4274f1 DD |
49 | #include <rdma/rdma_vt.h> |
50 | #include <rdma/rdmavt_qp.h> | |
77241056 MM |
51 | |
52 | #include "hfi.h" | |
53 | #include "qp.h" | |
bb5df5f9 | 54 | #include "verbs_txreq.h" |
77241056 MM |
55 | #include "trace.h" |
56 | ||
57 | /* cut down ridiculously long IB macro names */ | |
58 | #define OP(x) IB_OPCODE_RC_##x | |
59 | ||
9171bfdd MM |
60 | /** |
61 | * hfi1_add_retry_timer - add/start a retry timer | |
62 | * @qp - the QP | |
63 | * | |
64 | * add a retry timer on the QP | |
65 | */ | |
66 | static inline void hfi1_add_retry_timer(struct rvt_qp *qp) | |
67 | { | |
bfee5e32 VM |
68 | struct ib_qp *ibqp = &qp->ibqp; |
69 | struct rvt_dev_info *rdi = ib_to_rvt(ibqp->device); | |
70 | ||
9171bfdd | 71 | qp->s_flags |= RVT_S_TIMER; |
9171bfdd | 72 | /* 4.096 usec. * (1 << qp->timeout) */ |
bfee5e32 VM |
73 | qp->s_timer.expires = jiffies + qp->timeout_jiffies + |
74 | rdi->busy_jiffies; | |
9171bfdd MM |
75 | add_timer(&qp->s_timer); |
76 | } | |
77 | ||
78 | /** | |
79 | * hfi1_add_rnr_timer - add/start an rnr timer | |
80 | * @qp - the QP | |
81 | * @to - timeout in usecs | |
82 | * | |
83 | * add an rnr timer on the QP | |
84 | */ | |
34cee28f | 85 | void hfi1_add_rnr_timer(struct rvt_qp *qp, u32 to) |
9171bfdd | 86 | { |
08279d5c MM |
87 | struct hfi1_qp_priv *priv = qp->priv; |
88 | ||
9171bfdd | 89 | qp->s_flags |= RVT_S_WAIT_RNR; |
9171bfdd | 90 | qp->s_timer.expires = jiffies + usecs_to_jiffies(to); |
08279d5c | 91 | add_timer(&priv->s_rnr_timer); |
9171bfdd MM |
92 | } |
93 | ||
94 | /** | |
95 | * hfi1_mod_retry_timer - mod a retry timer | |
96 | * @qp - the QP | |
97 | * | |
98 | * Modify a potentially already running retry | |
99 | * timer | |
100 | */ | |
101 | static inline void hfi1_mod_retry_timer(struct rvt_qp *qp) | |
102 | { | |
bfee5e32 VM |
103 | struct ib_qp *ibqp = &qp->ibqp; |
104 | struct rvt_dev_info *rdi = ib_to_rvt(ibqp->device); | |
105 | ||
9171bfdd | 106 | qp->s_flags |= RVT_S_TIMER; |
9171bfdd | 107 | /* 4.096 usec. * (1 << qp->timeout) */ |
bfee5e32 VM |
108 | mod_timer(&qp->s_timer, jiffies + qp->timeout_jiffies + |
109 | rdi->busy_jiffies); | |
9171bfdd MM |
110 | } |
111 | ||
112 | /** | |
113 | * hfi1_stop_retry_timer - stop a retry timer | |
114 | * @qp - the QP | |
115 | * | |
116 | * stop a retry timer and return if the timer | |
117 | * had been pending. | |
118 | */ | |
119 | static inline int hfi1_stop_retry_timer(struct rvt_qp *qp) | |
120 | { | |
121 | int rval = 0; | |
122 | ||
123 | /* Remove QP from retry */ | |
124 | if (qp->s_flags & RVT_S_TIMER) { | |
125 | qp->s_flags &= ~RVT_S_TIMER; | |
126 | rval = del_timer(&qp->s_timer); | |
127 | } | |
128 | return rval; | |
129 | } | |
130 | ||
131 | /** | |
132 | * hfi1_stop_rc_timers - stop all timers | |
133 | * @qp - the QP | |
134 | * | |
135 | * stop any pending timers | |
136 | */ | |
08279d5c | 137 | void hfi1_stop_rc_timers(struct rvt_qp *qp) |
9171bfdd | 138 | { |
08279d5c MM |
139 | struct hfi1_qp_priv *priv = qp->priv; |
140 | ||
9171bfdd MM |
141 | /* Remove QP from all timers */ |
142 | if (qp->s_flags & (RVT_S_TIMER | RVT_S_WAIT_RNR)) { | |
143 | qp->s_flags &= ~(RVT_S_TIMER | RVT_S_WAIT_RNR); | |
144 | del_timer(&qp->s_timer); | |
08279d5c | 145 | del_timer(&priv->s_rnr_timer); |
9171bfdd MM |
146 | } |
147 | } | |
148 | ||
149 | /** | |
150 | * hfi1_stop_rnr_timer - stop an rnr timer | |
151 | * @qp - the QP | |
152 | * | |
153 | * stop an rnr timer and return if the timer | |
154 | * had been pending. | |
155 | */ | |
156 | static inline int hfi1_stop_rnr_timer(struct rvt_qp *qp) | |
157 | { | |
158 | int rval = 0; | |
08279d5c | 159 | struct hfi1_qp_priv *priv = qp->priv; |
9171bfdd MM |
160 | |
161 | /* Remove QP from rnr timer */ | |
162 | if (qp->s_flags & RVT_S_WAIT_RNR) { | |
163 | qp->s_flags &= ~RVT_S_WAIT_RNR; | |
08279d5c | 164 | rval = del_timer(&priv->s_rnr_timer); |
9171bfdd MM |
165 | } |
166 | return rval; | |
167 | } | |
168 | ||
169 | /** | |
170 | * hfi1_del_timers_sync - wait for any timeout routines to exit | |
171 | * @qp - the QP | |
172 | */ | |
3c9d149b | 173 | void hfi1_del_timers_sync(struct rvt_qp *qp) |
9171bfdd | 174 | { |
08279d5c MM |
175 | struct hfi1_qp_priv *priv = qp->priv; |
176 | ||
9171bfdd | 177 | del_timer_sync(&qp->s_timer); |
08279d5c | 178 | del_timer_sync(&priv->s_rnr_timer); |
9171bfdd MM |
179 | } |
180 | ||
14553ca1 MM |
181 | /* only opcode mask for adaptive pio */ |
182 | const u32 rc_only_opcode = | |
183 | BIT(OP(SEND_ONLY) & 0x1f) | | |
184 | BIT(OP(SEND_ONLY_WITH_IMMEDIATE & 0x1f)) | | |
185 | BIT(OP(RDMA_WRITE_ONLY & 0x1f)) | | |
186 | BIT(OP(RDMA_WRITE_ONLY_WITH_IMMEDIATE & 0x1f)) | | |
187 | BIT(OP(RDMA_READ_REQUEST & 0x1f)) | | |
188 | BIT(OP(ACKNOWLEDGE & 0x1f)) | | |
189 | BIT(OP(ATOMIC_ACKNOWLEDGE & 0x1f)) | | |
190 | BIT(OP(COMPARE_SWAP & 0x1f)) | | |
191 | BIT(OP(FETCH_ADD & 0x1f)); | |
192 | ||
895420dd | 193 | static u32 restart_sge(struct rvt_sge_state *ss, struct rvt_swqe *wqe, |
77241056 MM |
194 | u32 psn, u32 pmtu) |
195 | { | |
196 | u32 len; | |
197 | ||
198 | len = delta_psn(psn, wqe->psn) * pmtu; | |
199 | ss->sge = wqe->sg_list[0]; | |
200 | ss->sg_list = wqe->sg_list + 1; | |
201 | ss->num_sge = wqe->wr.num_sge; | |
202 | ss->total_len = wqe->length; | |
203 | hfi1_skip_sge(ss, len, 0); | |
204 | return wqe->length - len; | |
205 | } | |
206 | ||
77241056 MM |
207 | /** |
208 | * make_rc_ack - construct a response packet (ACK, NAK, or RDMA read) | |
209 | * @dev: the device for this QP | |
210 | * @qp: a pointer to the QP | |
211 | * @ohdr: a pointer to the IB header being constructed | |
bb5df5f9 | 212 | * @ps: the xmit packet state |
77241056 MM |
213 | * |
214 | * Return 1 if constructed; otherwise, return 0. | |
215 | * Note that we are in the responder's side of the QP context. | |
216 | * Note the QP s_lock must be held. | |
217 | */ | |
895420dd | 218 | static int make_rc_ack(struct hfi1_ibdev *dev, struct rvt_qp *qp, |
1235bef8 | 219 | struct hfi1_other_headers *ohdr, |
bb5df5f9 | 220 | struct hfi1_pkt_state *ps) |
77241056 | 221 | { |
895420dd | 222 | struct rvt_ack_entry *e; |
77241056 MM |
223 | u32 hwords; |
224 | u32 len; | |
225 | u32 bth0; | |
226 | u32 bth2; | |
227 | int middle = 0; | |
1235bef8 | 228 | u32 pmtu = qp->pmtu; |
14553ca1 | 229 | struct hfi1_qp_priv *priv = qp->priv; |
77241056 MM |
230 | |
231 | /* Don't send an ACK if we aren't supposed to. */ | |
83693bd1 | 232 | if (!(ib_rvt_state_ops[qp->state] & RVT_PROCESS_RECV_OK)) |
77241056 MM |
233 | goto bail; |
234 | ||
235 | /* header size in 32-bit words LRH+BTH = (8+12)/4. */ | |
236 | hwords = 5; | |
237 | ||
238 | switch (qp->s_ack_state) { | |
239 | case OP(RDMA_READ_RESPONSE_LAST): | |
240 | case OP(RDMA_READ_RESPONSE_ONLY): | |
241 | e = &qp->s_ack_queue[qp->s_tail_ack_queue]; | |
242 | if (e->rdma_sge.mr) { | |
895420dd | 243 | rvt_put_mr(e->rdma_sge.mr); |
77241056 MM |
244 | e->rdma_sge.mr = NULL; |
245 | } | |
246 | /* FALLTHROUGH */ | |
247 | case OP(ATOMIC_ACKNOWLEDGE): | |
248 | /* | |
249 | * We can increment the tail pointer now that the last | |
250 | * response has been sent instead of only being | |
251 | * constructed. | |
252 | */ | |
253 | if (++qp->s_tail_ack_queue > HFI1_MAX_RDMA_ATOMIC) | |
254 | qp->s_tail_ack_queue = 0; | |
255 | /* FALLTHROUGH */ | |
256 | case OP(SEND_ONLY): | |
257 | case OP(ACKNOWLEDGE): | |
258 | /* Check for no next entry in the queue. */ | |
259 | if (qp->r_head_ack_queue == qp->s_tail_ack_queue) { | |
54d10c1e | 260 | if (qp->s_flags & RVT_S_ACK_PENDING) |
77241056 MM |
261 | goto normal; |
262 | goto bail; | |
263 | } | |
264 | ||
265 | e = &qp->s_ack_queue[qp->s_tail_ack_queue]; | |
266 | if (e->opcode == OP(RDMA_READ_REQUEST)) { | |
267 | /* | |
268 | * If a RDMA read response is being resent and | |
269 | * we haven't seen the duplicate request yet, | |
270 | * then stop sending the remaining responses the | |
271 | * responder has seen until the requester re-sends it. | |
272 | */ | |
273 | len = e->rdma_sge.sge_length; | |
274 | if (len && !e->rdma_sge.mr) { | |
275 | qp->s_tail_ack_queue = qp->r_head_ack_queue; | |
276 | goto bail; | |
277 | } | |
278 | /* Copy SGE state in case we need to resend */ | |
c239a5b5 MM |
279 | ps->s_txreq->mr = e->rdma_sge.mr; |
280 | if (ps->s_txreq->mr) | |
281 | rvt_get_mr(ps->s_txreq->mr); | |
77241056 MM |
282 | qp->s_ack_rdma_sge.sge = e->rdma_sge; |
283 | qp->s_ack_rdma_sge.num_sge = 1; | |
284 | qp->s_cur_sge = &qp->s_ack_rdma_sge; | |
285 | if (len > pmtu) { | |
286 | len = pmtu; | |
287 | qp->s_ack_state = OP(RDMA_READ_RESPONSE_FIRST); | |
288 | } else { | |
289 | qp->s_ack_state = OP(RDMA_READ_RESPONSE_ONLY); | |
290 | e->sent = 1; | |
291 | } | |
292 | ohdr->u.aeth = hfi1_compute_aeth(qp); | |
293 | hwords++; | |
294 | qp->s_ack_rdma_psn = e->psn; | |
295 | bth2 = mask_psn(qp->s_ack_rdma_psn++); | |
296 | } else { | |
297 | /* COMPARE_SWAP or FETCH_ADD */ | |
298 | qp->s_cur_sge = NULL; | |
299 | len = 0; | |
300 | qp->s_ack_state = OP(ATOMIC_ACKNOWLEDGE); | |
301 | ohdr->u.at.aeth = hfi1_compute_aeth(qp); | |
302 | ohdr->u.at.atomic_ack_eth[0] = | |
303 | cpu_to_be32(e->atomic_data >> 32); | |
304 | ohdr->u.at.atomic_ack_eth[1] = | |
305 | cpu_to_be32(e->atomic_data); | |
306 | hwords += sizeof(ohdr->u.at) / sizeof(u32); | |
307 | bth2 = mask_psn(e->psn); | |
308 | e->sent = 1; | |
309 | } | |
310 | bth0 = qp->s_ack_state << 24; | |
311 | break; | |
312 | ||
313 | case OP(RDMA_READ_RESPONSE_FIRST): | |
314 | qp->s_ack_state = OP(RDMA_READ_RESPONSE_MIDDLE); | |
315 | /* FALLTHROUGH */ | |
316 | case OP(RDMA_READ_RESPONSE_MIDDLE): | |
317 | qp->s_cur_sge = &qp->s_ack_rdma_sge; | |
c239a5b5 MM |
318 | ps->s_txreq->mr = qp->s_ack_rdma_sge.sge.mr; |
319 | if (ps->s_txreq->mr) | |
320 | rvt_get_mr(ps->s_txreq->mr); | |
77241056 MM |
321 | len = qp->s_ack_rdma_sge.sge.sge_length; |
322 | if (len > pmtu) { | |
323 | len = pmtu; | |
324 | middle = HFI1_CAP_IS_KSET(SDMA_AHG); | |
325 | } else { | |
326 | ohdr->u.aeth = hfi1_compute_aeth(qp); | |
327 | hwords++; | |
328 | qp->s_ack_state = OP(RDMA_READ_RESPONSE_LAST); | |
329 | e = &qp->s_ack_queue[qp->s_tail_ack_queue]; | |
330 | e->sent = 1; | |
331 | } | |
332 | bth0 = qp->s_ack_state << 24; | |
333 | bth2 = mask_psn(qp->s_ack_rdma_psn++); | |
334 | break; | |
335 | ||
336 | default: | |
337 | normal: | |
338 | /* | |
339 | * Send a regular ACK. | |
340 | * Set the s_ack_state so we wait until after sending | |
341 | * the ACK before setting s_ack_state to ACKNOWLEDGE | |
342 | * (see above). | |
343 | */ | |
344 | qp->s_ack_state = OP(SEND_ONLY); | |
54d10c1e | 345 | qp->s_flags &= ~RVT_S_ACK_PENDING; |
77241056 MM |
346 | qp->s_cur_sge = NULL; |
347 | if (qp->s_nak_state) | |
348 | ohdr->u.aeth = | |
349 | cpu_to_be32((qp->r_msn & HFI1_MSN_MASK) | | |
350 | (qp->s_nak_state << | |
351 | HFI1_AETH_CREDIT_SHIFT)); | |
352 | else | |
353 | ohdr->u.aeth = hfi1_compute_aeth(qp); | |
354 | hwords++; | |
355 | len = 0; | |
356 | bth0 = OP(ACKNOWLEDGE) << 24; | |
357 | bth2 = mask_psn(qp->s_ack_psn); | |
358 | } | |
359 | qp->s_rdma_ack_cnt++; | |
360 | qp->s_hdrwords = hwords; | |
14553ca1 | 361 | ps->s_txreq->sde = priv->s_sde; |
77241056 | 362 | qp->s_cur_size = len; |
bb5df5f9 | 363 | hfi1_make_ruc_header(qp, ohdr, bth0, bth2, middle, ps); |
aa0ad411 JX |
364 | /* pbc */ |
365 | ps->s_txreq->hdr_dwords = qp->s_hdrwords + 2; | |
77241056 MM |
366 | return 1; |
367 | ||
368 | bail: | |
369 | qp->s_ack_state = OP(ACKNOWLEDGE); | |
370 | /* | |
371 | * Ensure s_rdma_ack_cnt changes are committed prior to resetting | |
54d10c1e | 372 | * RVT_S_RESP_PENDING |
77241056 MM |
373 | */ |
374 | smp_wmb(); | |
54d10c1e DD |
375 | qp->s_flags &= ~(RVT_S_RESP_PENDING |
376 | | RVT_S_ACK_PENDING | |
377 | | RVT_S_AHG_VALID); | |
77241056 MM |
378 | return 0; |
379 | } | |
380 | ||
381 | /** | |
382 | * hfi1_make_rc_req - construct a request packet (SEND, RDMA r/w, ATOMIC) | |
383 | * @qp: a pointer to the QP | |
384 | * | |
46a80d62 MM |
385 | * Assumes s_lock is held. |
386 | * | |
77241056 MM |
387 | * Return 1 if constructed; otherwise, return 0. |
388 | */ | |
bb5df5f9 | 389 | int hfi1_make_rc_req(struct rvt_qp *qp, struct hfi1_pkt_state *ps) |
77241056 | 390 | { |
4c6829c5 | 391 | struct hfi1_qp_priv *priv = qp->priv; |
77241056 MM |
392 | struct hfi1_ibdev *dev = to_idev(qp->ibqp.device); |
393 | struct hfi1_other_headers *ohdr; | |
895420dd DD |
394 | struct rvt_sge_state *ss; |
395 | struct rvt_swqe *wqe; | |
77241056 MM |
396 | /* header size in 32-bit words LRH+BTH = (8+12)/4. */ |
397 | u32 hwords = 5; | |
398 | u32 len; | |
399 | u32 bth0 = 0; | |
400 | u32 bth2; | |
401 | u32 pmtu = qp->pmtu; | |
402 | char newreq; | |
77241056 MM |
403 | int middle = 0; |
404 | int delta; | |
405 | ||
bb5df5f9 DD |
406 | ps->s_txreq = get_txreq(ps->dev, qp); |
407 | if (IS_ERR(ps->s_txreq)) | |
408 | goto bail_no_tx; | |
409 | ||
410 | ohdr = &ps->s_txreq->phdr.hdr.u.oth; | |
77241056 | 411 | if (qp->remote_ah_attr.ah_flags & IB_AH_GRH) |
bb5df5f9 | 412 | ohdr = &ps->s_txreq->phdr.hdr.u.l.oth; |
77241056 | 413 | |
77241056 | 414 | /* Sending responses has higher priority over sending requests. */ |
54d10c1e | 415 | if ((qp->s_flags & RVT_S_RESP_PENDING) && |
1235bef8 | 416 | make_rc_ack(dev, qp, ohdr, ps)) |
bb5df5f9 | 417 | return 1; |
77241056 | 418 | |
83693bd1 DD |
419 | if (!(ib_rvt_state_ops[qp->state] & RVT_PROCESS_SEND_OK)) { |
420 | if (!(ib_rvt_state_ops[qp->state] & RVT_FLUSH_SEND)) | |
77241056 MM |
421 | goto bail; |
422 | /* We are in the error state, flush the work request. */ | |
46a80d62 MM |
423 | smp_read_barrier_depends(); /* see post_one_send() */ |
424 | if (qp->s_last == ACCESS_ONCE(qp->s_head)) | |
77241056 MM |
425 | goto bail; |
426 | /* If DMAs are in progress, we can't flush immediately. */ | |
14553ca1 | 427 | if (iowait_sdma_pending(&priv->s_iowait)) { |
54d10c1e | 428 | qp->s_flags |= RVT_S_WAIT_DMA; |
77241056 MM |
429 | goto bail; |
430 | } | |
431 | clear_ahg(qp); | |
83693bd1 | 432 | wqe = rvt_get_swqe_ptr(qp, qp->s_last); |
77241056 MM |
433 | hfi1_send_complete(qp, wqe, qp->s_last != qp->s_acked ? |
434 | IB_WC_SUCCESS : IB_WC_WR_FLUSH_ERR); | |
435 | /* will get called again */ | |
bb5df5f9 | 436 | goto done_free_tx; |
77241056 MM |
437 | } |
438 | ||
54d10c1e | 439 | if (qp->s_flags & (RVT_S_WAIT_RNR | RVT_S_WAIT_ACK)) |
77241056 MM |
440 | goto bail; |
441 | ||
442 | if (cmp_psn(qp->s_psn, qp->s_sending_hpsn) <= 0) { | |
443 | if (cmp_psn(qp->s_sending_psn, qp->s_sending_hpsn) <= 0) { | |
54d10c1e | 444 | qp->s_flags |= RVT_S_WAIT_PSN; |
77241056 MM |
445 | goto bail; |
446 | } | |
447 | qp->s_sending_psn = qp->s_psn; | |
448 | qp->s_sending_hpsn = qp->s_psn - 1; | |
449 | } | |
450 | ||
451 | /* Send a request. */ | |
83693bd1 | 452 | wqe = rvt_get_swqe_ptr(qp, qp->s_cur); |
77241056 MM |
453 | switch (qp->s_state) { |
454 | default: | |
83693bd1 | 455 | if (!(ib_rvt_state_ops[qp->state] & RVT_PROCESS_NEXT_SEND_OK)) |
77241056 MM |
456 | goto bail; |
457 | /* | |
458 | * Resend an old request or start a new one. | |
459 | * | |
460 | * We keep track of the current SWQE so that | |
461 | * we don't reset the "furthest progress" state | |
462 | * if we need to back up. | |
463 | */ | |
464 | newreq = 0; | |
465 | if (qp->s_cur == qp->s_tail) { | |
466 | /* Check if send work queue is empty. */ | |
467 | if (qp->s_tail == qp->s_head) { | |
468 | clear_ahg(qp); | |
469 | goto bail; | |
470 | } | |
471 | /* | |
472 | * If a fence is requested, wait for previous | |
473 | * RDMA read and atomic operations to finish. | |
474 | */ | |
475 | if ((wqe->wr.send_flags & IB_SEND_FENCE) && | |
476 | qp->s_num_rd_atomic) { | |
54d10c1e | 477 | qp->s_flags |= RVT_S_WAIT_FENCE; |
77241056 MM |
478 | goto bail; |
479 | } | |
77241056 | 480 | newreq = 1; |
46a80d62 | 481 | qp->s_psn = wqe->psn; |
77241056 MM |
482 | } |
483 | /* | |
484 | * Note that we have to be careful not to modify the | |
485 | * original work request since we may need to resend | |
486 | * it. | |
487 | */ | |
488 | len = wqe->length; | |
489 | ss = &qp->s_sge; | |
490 | bth2 = mask_psn(qp->s_psn); | |
491 | switch (wqe->wr.opcode) { | |
492 | case IB_WR_SEND: | |
493 | case IB_WR_SEND_WITH_IMM: | |
494 | /* If no credit, return. */ | |
54d10c1e | 495 | if (!(qp->s_flags & RVT_S_UNLIMITED_CREDIT) && |
77241056 | 496 | cmp_msn(wqe->ssn, qp->s_lsn + 1) > 0) { |
54d10c1e | 497 | qp->s_flags |= RVT_S_WAIT_SSN_CREDIT; |
77241056 MM |
498 | goto bail; |
499 | } | |
77241056 | 500 | if (len > pmtu) { |
77241056 MM |
501 | qp->s_state = OP(SEND_FIRST); |
502 | len = pmtu; | |
503 | break; | |
504 | } | |
e490974e | 505 | if (wqe->wr.opcode == IB_WR_SEND) { |
77241056 | 506 | qp->s_state = OP(SEND_ONLY); |
e490974e | 507 | } else { |
77241056 MM |
508 | qp->s_state = OP(SEND_ONLY_WITH_IMMEDIATE); |
509 | /* Immediate data comes after the BTH */ | |
510 | ohdr->u.imm_data = wqe->wr.ex.imm_data; | |
511 | hwords += 1; | |
512 | } | |
513 | if (wqe->wr.send_flags & IB_SEND_SOLICITED) | |
514 | bth0 |= IB_BTH_SOLICITED; | |
515 | bth2 |= IB_BTH_REQ_ACK; | |
516 | if (++qp->s_cur == qp->s_size) | |
517 | qp->s_cur = 0; | |
518 | break; | |
519 | ||
520 | case IB_WR_RDMA_WRITE: | |
54d10c1e | 521 | if (newreq && !(qp->s_flags & RVT_S_UNLIMITED_CREDIT)) |
77241056 MM |
522 | qp->s_lsn++; |
523 | /* FALLTHROUGH */ | |
524 | case IB_WR_RDMA_WRITE_WITH_IMM: | |
525 | /* If no credit, return. */ | |
54d10c1e | 526 | if (!(qp->s_flags & RVT_S_UNLIMITED_CREDIT) && |
77241056 | 527 | cmp_msn(wqe->ssn, qp->s_lsn + 1) > 0) { |
54d10c1e | 528 | qp->s_flags |= RVT_S_WAIT_SSN_CREDIT; |
77241056 MM |
529 | goto bail; |
530 | } | |
531 | ohdr->u.rc.reth.vaddr = | |
e622f2f4 | 532 | cpu_to_be64(wqe->rdma_wr.remote_addr); |
77241056 | 533 | ohdr->u.rc.reth.rkey = |
e622f2f4 | 534 | cpu_to_be32(wqe->rdma_wr.rkey); |
77241056 MM |
535 | ohdr->u.rc.reth.length = cpu_to_be32(len); |
536 | hwords += sizeof(struct ib_reth) / sizeof(u32); | |
77241056 | 537 | if (len > pmtu) { |
77241056 MM |
538 | qp->s_state = OP(RDMA_WRITE_FIRST); |
539 | len = pmtu; | |
540 | break; | |
541 | } | |
e490974e | 542 | if (wqe->wr.opcode == IB_WR_RDMA_WRITE) { |
77241056 | 543 | qp->s_state = OP(RDMA_WRITE_ONLY); |
e490974e | 544 | } else { |
77241056 MM |
545 | qp->s_state = |
546 | OP(RDMA_WRITE_ONLY_WITH_IMMEDIATE); | |
547 | /* Immediate data comes after RETH */ | |
548 | ohdr->u.rc.imm_data = wqe->wr.ex.imm_data; | |
549 | hwords += 1; | |
550 | if (wqe->wr.send_flags & IB_SEND_SOLICITED) | |
551 | bth0 |= IB_BTH_SOLICITED; | |
552 | } | |
553 | bth2 |= IB_BTH_REQ_ACK; | |
554 | if (++qp->s_cur == qp->s_size) | |
555 | qp->s_cur = 0; | |
556 | break; | |
557 | ||
558 | case IB_WR_RDMA_READ: | |
559 | /* | |
560 | * Don't allow more operations to be started | |
561 | * than the QP limits allow. | |
562 | */ | |
563 | if (newreq) { | |
564 | if (qp->s_num_rd_atomic >= | |
565 | qp->s_max_rd_atomic) { | |
54d10c1e | 566 | qp->s_flags |= RVT_S_WAIT_RDMAR; |
77241056 MM |
567 | goto bail; |
568 | } | |
569 | qp->s_num_rd_atomic++; | |
54d10c1e | 570 | if (!(qp->s_flags & RVT_S_UNLIMITED_CREDIT)) |
77241056 | 571 | qp->s_lsn++; |
77241056 MM |
572 | } |
573 | ohdr->u.rc.reth.vaddr = | |
e622f2f4 | 574 | cpu_to_be64(wqe->rdma_wr.remote_addr); |
77241056 | 575 | ohdr->u.rc.reth.rkey = |
e622f2f4 | 576 | cpu_to_be32(wqe->rdma_wr.rkey); |
77241056 MM |
577 | ohdr->u.rc.reth.length = cpu_to_be32(len); |
578 | qp->s_state = OP(RDMA_READ_REQUEST); | |
579 | hwords += sizeof(ohdr->u.rc.reth) / sizeof(u32); | |
580 | ss = NULL; | |
581 | len = 0; | |
582 | bth2 |= IB_BTH_REQ_ACK; | |
583 | if (++qp->s_cur == qp->s_size) | |
584 | qp->s_cur = 0; | |
585 | break; | |
586 | ||
587 | case IB_WR_ATOMIC_CMP_AND_SWP: | |
588 | case IB_WR_ATOMIC_FETCH_AND_ADD: | |
589 | /* | |
590 | * Don't allow more operations to be started | |
591 | * than the QP limits allow. | |
592 | */ | |
593 | if (newreq) { | |
594 | if (qp->s_num_rd_atomic >= | |
595 | qp->s_max_rd_atomic) { | |
54d10c1e | 596 | qp->s_flags |= RVT_S_WAIT_RDMAR; |
77241056 MM |
597 | goto bail; |
598 | } | |
599 | qp->s_num_rd_atomic++; | |
54d10c1e | 600 | if (!(qp->s_flags & RVT_S_UNLIMITED_CREDIT)) |
77241056 | 601 | qp->s_lsn++; |
77241056 MM |
602 | } |
603 | if (wqe->wr.opcode == IB_WR_ATOMIC_CMP_AND_SWP) { | |
604 | qp->s_state = OP(COMPARE_SWAP); | |
605 | ohdr->u.atomic_eth.swap_data = cpu_to_be64( | |
e622f2f4 | 606 | wqe->atomic_wr.swap); |
77241056 | 607 | ohdr->u.atomic_eth.compare_data = cpu_to_be64( |
e622f2f4 | 608 | wqe->atomic_wr.compare_add); |
77241056 MM |
609 | } else { |
610 | qp->s_state = OP(FETCH_ADD); | |
611 | ohdr->u.atomic_eth.swap_data = cpu_to_be64( | |
e622f2f4 | 612 | wqe->atomic_wr.compare_add); |
77241056 MM |
613 | ohdr->u.atomic_eth.compare_data = 0; |
614 | } | |
615 | ohdr->u.atomic_eth.vaddr[0] = cpu_to_be32( | |
e622f2f4 | 616 | wqe->atomic_wr.remote_addr >> 32); |
77241056 | 617 | ohdr->u.atomic_eth.vaddr[1] = cpu_to_be32( |
e622f2f4 | 618 | wqe->atomic_wr.remote_addr); |
77241056 | 619 | ohdr->u.atomic_eth.rkey = cpu_to_be32( |
e622f2f4 | 620 | wqe->atomic_wr.rkey); |
77241056 MM |
621 | hwords += sizeof(struct ib_atomic_eth) / sizeof(u32); |
622 | ss = NULL; | |
623 | len = 0; | |
624 | bth2 |= IB_BTH_REQ_ACK; | |
625 | if (++qp->s_cur == qp->s_size) | |
626 | qp->s_cur = 0; | |
627 | break; | |
628 | ||
629 | default: | |
630 | goto bail; | |
631 | } | |
632 | qp->s_sge.sge = wqe->sg_list[0]; | |
633 | qp->s_sge.sg_list = wqe->sg_list + 1; | |
634 | qp->s_sge.num_sge = wqe->wr.num_sge; | |
635 | qp->s_sge.total_len = wqe->length; | |
636 | qp->s_len = wqe->length; | |
637 | if (newreq) { | |
638 | qp->s_tail++; | |
639 | if (qp->s_tail >= qp->s_size) | |
640 | qp->s_tail = 0; | |
641 | } | |
642 | if (wqe->wr.opcode == IB_WR_RDMA_READ) | |
643 | qp->s_psn = wqe->lpsn + 1; | |
46a80d62 | 644 | else |
77241056 | 645 | qp->s_psn++; |
77241056 MM |
646 | break; |
647 | ||
648 | case OP(RDMA_READ_RESPONSE_FIRST): | |
649 | /* | |
650 | * qp->s_state is normally set to the opcode of the | |
651 | * last packet constructed for new requests and therefore | |
652 | * is never set to RDMA read response. | |
653 | * RDMA_READ_RESPONSE_FIRST is used by the ACK processing | |
654 | * thread to indicate a SEND needs to be restarted from an | |
655 | * earlier PSN without interfering with the sending thread. | |
656 | * See restart_rc(). | |
657 | */ | |
658 | qp->s_len = restart_sge(&qp->s_sge, wqe, qp->s_psn, pmtu); | |
659 | /* FALLTHROUGH */ | |
660 | case OP(SEND_FIRST): | |
661 | qp->s_state = OP(SEND_MIDDLE); | |
662 | /* FALLTHROUGH */ | |
663 | case OP(SEND_MIDDLE): | |
664 | bth2 = mask_psn(qp->s_psn++); | |
77241056 MM |
665 | ss = &qp->s_sge; |
666 | len = qp->s_len; | |
667 | if (len > pmtu) { | |
668 | len = pmtu; | |
669 | middle = HFI1_CAP_IS_KSET(SDMA_AHG); | |
670 | break; | |
671 | } | |
e490974e | 672 | if (wqe->wr.opcode == IB_WR_SEND) { |
77241056 | 673 | qp->s_state = OP(SEND_LAST); |
e490974e | 674 | } else { |
77241056 MM |
675 | qp->s_state = OP(SEND_LAST_WITH_IMMEDIATE); |
676 | /* Immediate data comes after the BTH */ | |
677 | ohdr->u.imm_data = wqe->wr.ex.imm_data; | |
678 | hwords += 1; | |
679 | } | |
680 | if (wqe->wr.send_flags & IB_SEND_SOLICITED) | |
681 | bth0 |= IB_BTH_SOLICITED; | |
682 | bth2 |= IB_BTH_REQ_ACK; | |
683 | qp->s_cur++; | |
684 | if (qp->s_cur >= qp->s_size) | |
685 | qp->s_cur = 0; | |
686 | break; | |
687 | ||
688 | case OP(RDMA_READ_RESPONSE_LAST): | |
689 | /* | |
690 | * qp->s_state is normally set to the opcode of the | |
691 | * last packet constructed for new requests and therefore | |
692 | * is never set to RDMA read response. | |
693 | * RDMA_READ_RESPONSE_LAST is used by the ACK processing | |
694 | * thread to indicate a RDMA write needs to be restarted from | |
695 | * an earlier PSN without interfering with the sending thread. | |
696 | * See restart_rc(). | |
697 | */ | |
698 | qp->s_len = restart_sge(&qp->s_sge, wqe, qp->s_psn, pmtu); | |
699 | /* FALLTHROUGH */ | |
700 | case OP(RDMA_WRITE_FIRST): | |
701 | qp->s_state = OP(RDMA_WRITE_MIDDLE); | |
702 | /* FALLTHROUGH */ | |
703 | case OP(RDMA_WRITE_MIDDLE): | |
704 | bth2 = mask_psn(qp->s_psn++); | |
77241056 MM |
705 | ss = &qp->s_sge; |
706 | len = qp->s_len; | |
707 | if (len > pmtu) { | |
708 | len = pmtu; | |
709 | middle = HFI1_CAP_IS_KSET(SDMA_AHG); | |
710 | break; | |
711 | } | |
e490974e | 712 | if (wqe->wr.opcode == IB_WR_RDMA_WRITE) { |
77241056 | 713 | qp->s_state = OP(RDMA_WRITE_LAST); |
e490974e | 714 | } else { |
77241056 MM |
715 | qp->s_state = OP(RDMA_WRITE_LAST_WITH_IMMEDIATE); |
716 | /* Immediate data comes after the BTH */ | |
717 | ohdr->u.imm_data = wqe->wr.ex.imm_data; | |
718 | hwords += 1; | |
719 | if (wqe->wr.send_flags & IB_SEND_SOLICITED) | |
720 | bth0 |= IB_BTH_SOLICITED; | |
721 | } | |
722 | bth2 |= IB_BTH_REQ_ACK; | |
723 | qp->s_cur++; | |
724 | if (qp->s_cur >= qp->s_size) | |
725 | qp->s_cur = 0; | |
726 | break; | |
727 | ||
728 | case OP(RDMA_READ_RESPONSE_MIDDLE): | |
729 | /* | |
730 | * qp->s_state is normally set to the opcode of the | |
731 | * last packet constructed for new requests and therefore | |
732 | * is never set to RDMA read response. | |
733 | * RDMA_READ_RESPONSE_MIDDLE is used by the ACK processing | |
734 | * thread to indicate a RDMA read needs to be restarted from | |
735 | * an earlier PSN without interfering with the sending thread. | |
736 | * See restart_rc(). | |
737 | */ | |
738 | len = (delta_psn(qp->s_psn, wqe->psn)) * pmtu; | |
739 | ohdr->u.rc.reth.vaddr = | |
e622f2f4 | 740 | cpu_to_be64(wqe->rdma_wr.remote_addr + len); |
77241056 | 741 | ohdr->u.rc.reth.rkey = |
e622f2f4 | 742 | cpu_to_be32(wqe->rdma_wr.rkey); |
77241056 MM |
743 | ohdr->u.rc.reth.length = cpu_to_be32(wqe->length - len); |
744 | qp->s_state = OP(RDMA_READ_REQUEST); | |
745 | hwords += sizeof(ohdr->u.rc.reth) / sizeof(u32); | |
746 | bth2 = mask_psn(qp->s_psn) | IB_BTH_REQ_ACK; | |
747 | qp->s_psn = wqe->lpsn + 1; | |
748 | ss = NULL; | |
749 | len = 0; | |
750 | qp->s_cur++; | |
751 | if (qp->s_cur == qp->s_size) | |
752 | qp->s_cur = 0; | |
753 | break; | |
754 | } | |
755 | qp->s_sending_hpsn = bth2; | |
756 | delta = delta_psn(bth2, wqe->psn); | |
757 | if (delta && delta % HFI1_PSN_CREDIT == 0) | |
758 | bth2 |= IB_BTH_REQ_ACK; | |
54d10c1e DD |
759 | if (qp->s_flags & RVT_S_SEND_ONE) { |
760 | qp->s_flags &= ~RVT_S_SEND_ONE; | |
761 | qp->s_flags |= RVT_S_WAIT_ACK; | |
77241056 MM |
762 | bth2 |= IB_BTH_REQ_ACK; |
763 | } | |
764 | qp->s_len -= len; | |
765 | qp->s_hdrwords = hwords; | |
14553ca1 | 766 | ps->s_txreq->sde = priv->s_sde; |
77241056 MM |
767 | qp->s_cur_sge = ss; |
768 | qp->s_cur_size = len; | |
769 | hfi1_make_ruc_header( | |
770 | qp, | |
771 | ohdr, | |
772 | bth0 | (qp->s_state << 24), | |
773 | bth2, | |
bb5df5f9 DD |
774 | middle, |
775 | ps); | |
aa0ad411 JX |
776 | /* pbc */ |
777 | ps->s_txreq->hdr_dwords = qp->s_hdrwords + 2; | |
bb5df5f9 DD |
778 | return 1; |
779 | ||
780 | done_free_tx: | |
781 | hfi1_put_txreq(ps->s_txreq); | |
782 | ps->s_txreq = NULL; | |
46a80d62 | 783 | return 1; |
bb5df5f9 | 784 | |
77241056 | 785 | bail: |
bb5df5f9 DD |
786 | hfi1_put_txreq(ps->s_txreq); |
787 | ||
788 | bail_no_tx: | |
789 | ps->s_txreq = NULL; | |
54d10c1e | 790 | qp->s_flags &= ~RVT_S_BUSY; |
bb5df5f9 DD |
791 | qp->s_hdrwords = 0; |
792 | return 0; | |
77241056 MM |
793 | } |
794 | ||
795 | /** | |
796 | * hfi1_send_rc_ack - Construct an ACK packet and send it | |
797 | * @qp: a pointer to the QP | |
798 | * | |
799 | * This is called from hfi1_rc_rcv() and handle_receive_interrupt(). | |
800 | * Note that RDMA reads and atomics are handled in the | |
801 | * send side QP state and tasklet. | |
802 | */ | |
895420dd | 803 | void hfi1_send_rc_ack(struct hfi1_ctxtdata *rcd, struct rvt_qp *qp, |
77241056 MM |
804 | int is_fecn) |
805 | { | |
806 | struct hfi1_ibport *ibp = to_iport(qp->ibqp.device, qp->port_num); | |
807 | struct hfi1_pportdata *ppd = ppd_from_ibp(ibp); | |
808 | u64 pbc, pbc_flags = 0; | |
809 | u16 lrh0; | |
810 | u16 sc5; | |
811 | u32 bth0; | |
812 | u32 hwords; | |
813 | u32 vl, plen; | |
814 | struct send_context *sc; | |
815 | struct pio_buf *pbuf; | |
816 | struct hfi1_ib_header hdr; | |
817 | struct hfi1_other_headers *ohdr; | |
b77d713a | 818 | unsigned long flags; |
77241056 MM |
819 | |
820 | /* Don't send ACK or NAK if a RDMA read or atomic is pending. */ | |
54d10c1e | 821 | if (qp->s_flags & RVT_S_RESP_PENDING) |
77241056 MM |
822 | goto queue_ack; |
823 | ||
824 | /* Ensure s_rdma_ack_cnt changes are committed */ | |
825 | smp_read_barrier_depends(); | |
826 | if (qp->s_rdma_ack_cnt) | |
827 | goto queue_ack; | |
828 | ||
829 | /* Construct the header */ | |
830 | /* header size in 32-bit words LRH+BTH+AETH = (8+12+4)/4 */ | |
831 | hwords = 6; | |
832 | if (unlikely(qp->remote_ah_attr.ah_flags & IB_AH_GRH)) { | |
833 | hwords += hfi1_make_grh(ibp, &hdr.u.l.grh, | |
834 | &qp->remote_ah_attr.grh, hwords, 0); | |
835 | ohdr = &hdr.u.l.oth; | |
836 | lrh0 = HFI1_LRH_GRH; | |
837 | } else { | |
838 | ohdr = &hdr.u.oth; | |
839 | lrh0 = HFI1_LRH_BTH; | |
840 | } | |
841 | /* read pkey_index w/o lock (its atomic) */ | |
842 | bth0 = hfi1_get_pkey(ibp, qp->s_pkey_index) | (OP(ACKNOWLEDGE) << 24); | |
843 | if (qp->s_mig_state == IB_MIG_MIGRATED) | |
844 | bth0 |= IB_BTH_MIG_REQ; | |
845 | if (qp->r_nak_state) | |
846 | ohdr->u.aeth = cpu_to_be32((qp->r_msn & HFI1_MSN_MASK) | | |
847 | (qp->r_nak_state << | |
848 | HFI1_AETH_CREDIT_SHIFT)); | |
849 | else | |
850 | ohdr->u.aeth = hfi1_compute_aeth(qp); | |
851 | sc5 = ibp->sl_to_sc[qp->remote_ah_attr.sl]; | |
852 | /* set PBC_DC_INFO bit (aka SC[4]) in pbc_flags */ | |
853 | pbc_flags |= ((!!(sc5 & 0x10)) << PBC_DC_INFO_SHIFT); | |
854 | lrh0 |= (sc5 & 0xf) << 12 | (qp->remote_ah_attr.sl & 0xf) << 4; | |
855 | hdr.lrh[0] = cpu_to_be16(lrh0); | |
856 | hdr.lrh[1] = cpu_to_be16(qp->remote_ah_attr.dlid); | |
857 | hdr.lrh[2] = cpu_to_be16(hwords + SIZE_OF_CRC); | |
858 | hdr.lrh[3] = cpu_to_be16(ppd->lid | qp->remote_ah_attr.src_path_bits); | |
859 | ohdr->bth[0] = cpu_to_be32(bth0); | |
860 | ohdr->bth[1] = cpu_to_be32(qp->remote_qpn); | |
861 | ohdr->bth[1] |= cpu_to_be32((!!is_fecn) << HFI1_BECN_SHIFT); | |
862 | ohdr->bth[2] = cpu_to_be32(mask_psn(qp->r_ack_psn)); | |
863 | ||
864 | /* Don't try to send ACKs if the link isn't ACTIVE */ | |
865 | if (driver_lstate(ppd) != IB_PORT_ACTIVE) | |
866 | return; | |
867 | ||
868 | sc = rcd->sc; | |
869 | plen = 2 /* PBC */ + hwords; | |
870 | vl = sc_to_vlt(ppd->dd, sc5); | |
871 | pbc = create_pbc(ppd, pbc_flags, qp->srate_mbps, vl, plen); | |
872 | ||
873 | pbuf = sc_buffer_alloc(sc, plen, NULL, NULL); | |
874 | if (!pbuf) { | |
875 | /* | |
876 | * We have no room to send at the moment. Pass | |
877 | * responsibility for sending the ACK to the send tasklet | |
878 | * so that when enough buffer space becomes available, | |
879 | * the ACK is sent ahead of other outgoing packets. | |
880 | */ | |
881 | goto queue_ack; | |
882 | } | |
883 | ||
1db78eee | 884 | trace_ack_output_ibhdr(dd_from_ibdev(qp->ibqp.device), &hdr); |
77241056 MM |
885 | |
886 | /* write the pbc and data */ | |
887 | ppd->dd->pio_inline_send(ppd->dd, pbuf, pbc, &hdr, hwords); | |
888 | ||
889 | return; | |
890 | ||
891 | queue_ack: | |
4eb06882 | 892 | this_cpu_inc(*ibp->rvp.rc_qacks); |
b77d713a | 893 | spin_lock_irqsave(&qp->s_lock, flags); |
54d10c1e | 894 | qp->s_flags |= RVT_S_ACK_PENDING | RVT_S_RESP_PENDING; |
77241056 MM |
895 | qp->s_nak_state = qp->r_nak_state; |
896 | qp->s_ack_psn = qp->r_ack_psn; | |
897 | if (is_fecn) | |
54d10c1e | 898 | qp->s_flags |= RVT_S_ECN; |
77241056 MM |
899 | |
900 | /* Schedule the send tasklet. */ | |
901 | hfi1_schedule_send(qp); | |
b77d713a | 902 | spin_unlock_irqrestore(&qp->s_lock, flags); |
77241056 MM |
903 | } |
904 | ||
905 | /** | |
906 | * reset_psn - reset the QP state to send starting from PSN | |
907 | * @qp: the QP | |
908 | * @psn: the packet sequence number to restart at | |
909 | * | |
910 | * This is called from hfi1_rc_rcv() to process an incoming RC ACK | |
911 | * for the given QP. | |
912 | * Called at interrupt level with the QP s_lock held. | |
913 | */ | |
895420dd | 914 | static void reset_psn(struct rvt_qp *qp, u32 psn) |
77241056 MM |
915 | { |
916 | u32 n = qp->s_acked; | |
83693bd1 | 917 | struct rvt_swqe *wqe = rvt_get_swqe_ptr(qp, n); |
77241056 MM |
918 | u32 opcode; |
919 | ||
920 | qp->s_cur = n; | |
921 | ||
922 | /* | |
923 | * If we are starting the request from the beginning, | |
924 | * let the normal send code handle initialization. | |
925 | */ | |
926 | if (cmp_psn(psn, wqe->psn) <= 0) { | |
927 | qp->s_state = OP(SEND_LAST); | |
928 | goto done; | |
929 | } | |
930 | ||
931 | /* Find the work request opcode corresponding to the given PSN. */ | |
932 | opcode = wqe->wr.opcode; | |
933 | for (;;) { | |
934 | int diff; | |
935 | ||
936 | if (++n == qp->s_size) | |
937 | n = 0; | |
938 | if (n == qp->s_tail) | |
939 | break; | |
83693bd1 | 940 | wqe = rvt_get_swqe_ptr(qp, n); |
77241056 MM |
941 | diff = cmp_psn(psn, wqe->psn); |
942 | if (diff < 0) | |
943 | break; | |
944 | qp->s_cur = n; | |
945 | /* | |
946 | * If we are starting the request from the beginning, | |
947 | * let the normal send code handle initialization. | |
948 | */ | |
949 | if (diff == 0) { | |
950 | qp->s_state = OP(SEND_LAST); | |
951 | goto done; | |
952 | } | |
953 | opcode = wqe->wr.opcode; | |
954 | } | |
955 | ||
956 | /* | |
957 | * Set the state to restart in the middle of a request. | |
958 | * Don't change the s_sge, s_cur_sge, or s_cur_size. | |
959 | * See hfi1_make_rc_req(). | |
960 | */ | |
961 | switch (opcode) { | |
962 | case IB_WR_SEND: | |
963 | case IB_WR_SEND_WITH_IMM: | |
964 | qp->s_state = OP(RDMA_READ_RESPONSE_FIRST); | |
965 | break; | |
966 | ||
967 | case IB_WR_RDMA_WRITE: | |
968 | case IB_WR_RDMA_WRITE_WITH_IMM: | |
969 | qp->s_state = OP(RDMA_READ_RESPONSE_LAST); | |
970 | break; | |
971 | ||
972 | case IB_WR_RDMA_READ: | |
973 | qp->s_state = OP(RDMA_READ_RESPONSE_MIDDLE); | |
974 | break; | |
975 | ||
976 | default: | |
977 | /* | |
978 | * This case shouldn't happen since its only | |
979 | * one PSN per req. | |
980 | */ | |
981 | qp->s_state = OP(SEND_LAST); | |
982 | } | |
983 | done: | |
984 | qp->s_psn = psn; | |
985 | /* | |
54d10c1e | 986 | * Set RVT_S_WAIT_PSN as rc_complete() may start the timer |
77241056 MM |
987 | * asynchronously before the send tasklet can get scheduled. |
988 | * Doing it in hfi1_make_rc_req() is too late. | |
989 | */ | |
990 | if ((cmp_psn(qp->s_psn, qp->s_sending_hpsn) <= 0) && | |
991 | (cmp_psn(qp->s_sending_psn, qp->s_sending_hpsn) <= 0)) | |
54d10c1e DD |
992 | qp->s_flags |= RVT_S_WAIT_PSN; |
993 | qp->s_flags &= ~RVT_S_AHG_VALID; | |
77241056 MM |
994 | } |
995 | ||
996 | /* | |
997 | * Back up requester to resend the last un-ACKed request. | |
998 | * The QP r_lock and s_lock should be held and interrupts disabled. | |
999 | */ | |
895420dd | 1000 | static void restart_rc(struct rvt_qp *qp, u32 psn, int wait) |
77241056 | 1001 | { |
83693bd1 | 1002 | struct rvt_swqe *wqe = rvt_get_swqe_ptr(qp, qp->s_acked); |
77241056 MM |
1003 | struct hfi1_ibport *ibp; |
1004 | ||
1005 | if (qp->s_retry == 0) { | |
1006 | if (qp->s_mig_state == IB_MIG_ARMED) { | |
1007 | hfi1_migrate_qp(qp); | |
1008 | qp->s_retry = qp->s_retry_cnt; | |
1009 | } else if (qp->s_last == qp->s_acked) { | |
1010 | hfi1_send_complete(qp, wqe, IB_WC_RETRY_EXC_ERR); | |
ec4274f1 | 1011 | rvt_error_qp(qp, IB_WC_WR_FLUSH_ERR); |
77241056 | 1012 | return; |
e490974e | 1013 | } else { /* need to handle delayed completion */ |
77241056 | 1014 | return; |
e490974e JJ |
1015 | } |
1016 | } else { | |
77241056 | 1017 | qp->s_retry--; |
e490974e | 1018 | } |
77241056 MM |
1019 | |
1020 | ibp = to_iport(qp->ibqp.device, qp->port_num); | |
1021 | if (wqe->wr.opcode == IB_WR_RDMA_READ) | |
4eb06882 | 1022 | ibp->rvp.n_rc_resends++; |
77241056 | 1023 | else |
4eb06882 | 1024 | ibp->rvp.n_rc_resends += delta_psn(qp->s_psn, psn); |
77241056 | 1025 | |
54d10c1e DD |
1026 | qp->s_flags &= ~(RVT_S_WAIT_FENCE | RVT_S_WAIT_RDMAR | |
1027 | RVT_S_WAIT_SSN_CREDIT | RVT_S_WAIT_PSN | | |
1028 | RVT_S_WAIT_ACK); | |
77241056 | 1029 | if (wait) |
54d10c1e | 1030 | qp->s_flags |= RVT_S_SEND_ONE; |
77241056 MM |
1031 | reset_psn(qp, psn); |
1032 | } | |
1033 | ||
1034 | /* | |
1035 | * This is called from s_timer for missing responses. | |
1036 | */ | |
08279d5c | 1037 | void hfi1_rc_timeout(unsigned long arg) |
77241056 | 1038 | { |
895420dd | 1039 | struct rvt_qp *qp = (struct rvt_qp *)arg; |
77241056 MM |
1040 | struct hfi1_ibport *ibp; |
1041 | unsigned long flags; | |
1042 | ||
1043 | spin_lock_irqsave(&qp->r_lock, flags); | |
1044 | spin_lock(&qp->s_lock); | |
54d10c1e | 1045 | if (qp->s_flags & RVT_S_TIMER) { |
77241056 | 1046 | ibp = to_iport(qp->ibqp.device, qp->port_num); |
4eb06882 | 1047 | ibp->rvp.n_rc_timeouts++; |
54d10c1e | 1048 | qp->s_flags &= ~RVT_S_TIMER; |
77241056 | 1049 | del_timer(&qp->s_timer); |
83525b61 | 1050 | trace_hfi1_rc_timeout(qp, qp->s_last_psn + 1); |
77241056 MM |
1051 | restart_rc(qp, qp->s_last_psn + 1, 1); |
1052 | hfi1_schedule_send(qp); | |
1053 | } | |
1054 | spin_unlock(&qp->s_lock); | |
1055 | spin_unlock_irqrestore(&qp->r_lock, flags); | |
1056 | } | |
1057 | ||
1058 | /* | |
1059 | * This is called from s_timer for RNR timeouts. | |
1060 | */ | |
1061 | void hfi1_rc_rnr_retry(unsigned long arg) | |
1062 | { | |
895420dd | 1063 | struct rvt_qp *qp = (struct rvt_qp *)arg; |
77241056 MM |
1064 | unsigned long flags; |
1065 | ||
1066 | spin_lock_irqsave(&qp->s_lock, flags); | |
e6f8c2b3 MM |
1067 | hfi1_stop_rnr_timer(qp); |
1068 | hfi1_schedule_send(qp); | |
77241056 MM |
1069 | spin_unlock_irqrestore(&qp->s_lock, flags); |
1070 | } | |
1071 | ||
1072 | /* | |
1073 | * Set qp->s_sending_psn to the next PSN after the given one. | |
1074 | * This would be psn+1 except when RDMA reads are present. | |
1075 | */ | |
895420dd | 1076 | static void reset_sending_psn(struct rvt_qp *qp, u32 psn) |
77241056 | 1077 | { |
895420dd | 1078 | struct rvt_swqe *wqe; |
77241056 MM |
1079 | u32 n = qp->s_last; |
1080 | ||
1081 | /* Find the work request corresponding to the given PSN. */ | |
1082 | for (;;) { | |
83693bd1 | 1083 | wqe = rvt_get_swqe_ptr(qp, n); |
77241056 MM |
1084 | if (cmp_psn(psn, wqe->lpsn) <= 0) { |
1085 | if (wqe->wr.opcode == IB_WR_RDMA_READ) | |
1086 | qp->s_sending_psn = wqe->lpsn + 1; | |
1087 | else | |
1088 | qp->s_sending_psn = psn + 1; | |
1089 | break; | |
1090 | } | |
1091 | if (++n == qp->s_size) | |
1092 | n = 0; | |
1093 | if (n == qp->s_tail) | |
1094 | break; | |
1095 | } | |
1096 | } | |
1097 | ||
1098 | /* | |
1099 | * This should be called with the QP s_lock held and interrupts disabled. | |
1100 | */ | |
895420dd | 1101 | void hfi1_rc_send_complete(struct rvt_qp *qp, struct hfi1_ib_header *hdr) |
77241056 MM |
1102 | { |
1103 | struct hfi1_other_headers *ohdr; | |
895420dd | 1104 | struct rvt_swqe *wqe; |
77241056 MM |
1105 | struct ib_wc wc; |
1106 | unsigned i; | |
1107 | u32 opcode; | |
1108 | u32 psn; | |
1109 | ||
83693bd1 | 1110 | if (!(ib_rvt_state_ops[qp->state] & RVT_PROCESS_OR_FLUSH_SEND)) |
77241056 MM |
1111 | return; |
1112 | ||
1113 | /* Find out where the BTH is */ | |
1114 | if ((be16_to_cpu(hdr->lrh[0]) & 3) == HFI1_LRH_BTH) | |
1115 | ohdr = &hdr->u.oth; | |
1116 | else | |
1117 | ohdr = &hdr->u.l.oth; | |
1118 | ||
1119 | opcode = be32_to_cpu(ohdr->bth[0]) >> 24; | |
1120 | if (opcode >= OP(RDMA_READ_RESPONSE_FIRST) && | |
1121 | opcode <= OP(ATOMIC_ACKNOWLEDGE)) { | |
1122 | WARN_ON(!qp->s_rdma_ack_cnt); | |
1123 | qp->s_rdma_ack_cnt--; | |
1124 | return; | |
1125 | } | |
1126 | ||
1127 | psn = be32_to_cpu(ohdr->bth[2]); | |
1128 | reset_sending_psn(qp, psn); | |
1129 | ||
1130 | /* | |
1131 | * Start timer after a packet requesting an ACK has been sent and | |
1132 | * there are still requests that haven't been acked. | |
1133 | */ | |
1134 | if ((psn & IB_BTH_REQ_ACK) && qp->s_acked != qp->s_tail && | |
1135 | !(qp->s_flags & | |
54d10c1e | 1136 | (RVT_S_TIMER | RVT_S_WAIT_RNR | RVT_S_WAIT_PSN)) && |
83693bd1 | 1137 | (ib_rvt_state_ops[qp->state] & RVT_PROCESS_RECV_OK)) |
e6f8c2b3 | 1138 | hfi1_add_retry_timer(qp); |
77241056 MM |
1139 | |
1140 | while (qp->s_last != qp->s_acked) { | |
6c2ab0b8 MM |
1141 | u32 s_last; |
1142 | ||
83693bd1 | 1143 | wqe = rvt_get_swqe_ptr(qp, qp->s_last); |
77241056 MM |
1144 | if (cmp_psn(wqe->lpsn, qp->s_sending_psn) >= 0 && |
1145 | cmp_psn(qp->s_sending_psn, qp->s_sending_hpsn) <= 0) | |
1146 | break; | |
6c2ab0b8 MM |
1147 | s_last = qp->s_last; |
1148 | if (++s_last >= qp->s_size) | |
1149 | s_last = 0; | |
1150 | qp->s_last = s_last; | |
1151 | /* see post_send() */ | |
1152 | barrier(); | |
77241056 | 1153 | for (i = 0; i < wqe->wr.num_sge; i++) { |
895420dd | 1154 | struct rvt_sge *sge = &wqe->sg_list[i]; |
77241056 | 1155 | |
895420dd | 1156 | rvt_put_mr(sge->mr); |
77241056 MM |
1157 | } |
1158 | /* Post a send completion queue entry if requested. */ | |
54d10c1e | 1159 | if (!(qp->s_flags & RVT_S_SIGNAL_REQ_WR) || |
77241056 MM |
1160 | (wqe->wr.send_flags & IB_SEND_SIGNALED)) { |
1161 | memset(&wc, 0, sizeof(wc)); | |
1162 | wc.wr_id = wqe->wr.wr_id; | |
1163 | wc.status = IB_WC_SUCCESS; | |
1164 | wc.opcode = ib_hfi1_wc_opcode[wqe->wr.opcode]; | |
1165 | wc.byte_len = wqe->length; | |
1166 | wc.qp = &qp->ibqp; | |
abd712da | 1167 | rvt_cq_enter(ibcq_to_rvtcq(qp->ibqp.send_cq), &wc, 0); |
77241056 | 1168 | } |
77241056 MM |
1169 | } |
1170 | /* | |
1171 | * If we were waiting for sends to complete before re-sending, | |
1172 | * and they are now complete, restart sending. | |
1173 | */ | |
1174 | trace_hfi1_rc_sendcomplete(qp, psn); | |
54d10c1e | 1175 | if (qp->s_flags & RVT_S_WAIT_PSN && |
77241056 | 1176 | cmp_psn(qp->s_sending_psn, qp->s_sending_hpsn) > 0) { |
54d10c1e | 1177 | qp->s_flags &= ~RVT_S_WAIT_PSN; |
77241056 MM |
1178 | qp->s_sending_psn = qp->s_psn; |
1179 | qp->s_sending_hpsn = qp->s_psn - 1; | |
1180 | hfi1_schedule_send(qp); | |
1181 | } | |
1182 | } | |
1183 | ||
895420dd | 1184 | static inline void update_last_psn(struct rvt_qp *qp, u32 psn) |
77241056 MM |
1185 | { |
1186 | qp->s_last_psn = psn; | |
1187 | } | |
1188 | ||
1189 | /* | |
1190 | * Generate a SWQE completion. | |
1191 | * This is similar to hfi1_send_complete but has to check to be sure | |
1192 | * that the SGEs are not being referenced if the SWQE is being resent. | |
1193 | */ | |
895420dd DD |
1194 | static struct rvt_swqe *do_rc_completion(struct rvt_qp *qp, |
1195 | struct rvt_swqe *wqe, | |
1196 | struct hfi1_ibport *ibp) | |
77241056 MM |
1197 | { |
1198 | struct ib_wc wc; | |
1199 | unsigned i; | |
1200 | ||
1201 | /* | |
1202 | * Don't decrement refcount and don't generate a | |
1203 | * completion if the SWQE is being resent until the send | |
1204 | * is finished. | |
1205 | */ | |
1206 | if (cmp_psn(wqe->lpsn, qp->s_sending_psn) < 0 || | |
1207 | cmp_psn(qp->s_sending_psn, qp->s_sending_hpsn) > 0) { | |
6c2ab0b8 MM |
1208 | u32 s_last; |
1209 | ||
77241056 | 1210 | for (i = 0; i < wqe->wr.num_sge; i++) { |
895420dd | 1211 | struct rvt_sge *sge = &wqe->sg_list[i]; |
77241056 | 1212 | |
895420dd | 1213 | rvt_put_mr(sge->mr); |
77241056 | 1214 | } |
6c2ab0b8 MM |
1215 | s_last = qp->s_last; |
1216 | if (++s_last >= qp->s_size) | |
1217 | s_last = 0; | |
1218 | qp->s_last = s_last; | |
1219 | /* see post_send() */ | |
1220 | barrier(); | |
77241056 | 1221 | /* Post a send completion queue entry if requested. */ |
54d10c1e | 1222 | if (!(qp->s_flags & RVT_S_SIGNAL_REQ_WR) || |
77241056 MM |
1223 | (wqe->wr.send_flags & IB_SEND_SIGNALED)) { |
1224 | memset(&wc, 0, sizeof(wc)); | |
1225 | wc.wr_id = wqe->wr.wr_id; | |
1226 | wc.status = IB_WC_SUCCESS; | |
1227 | wc.opcode = ib_hfi1_wc_opcode[wqe->wr.opcode]; | |
1228 | wc.byte_len = wqe->length; | |
1229 | wc.qp = &qp->ibqp; | |
abd712da | 1230 | rvt_cq_enter(ibcq_to_rvtcq(qp->ibqp.send_cq), &wc, 0); |
77241056 | 1231 | } |
77241056 MM |
1232 | } else { |
1233 | struct hfi1_pportdata *ppd = ppd_from_ibp(ibp); | |
1234 | ||
4eb06882 | 1235 | this_cpu_inc(*ibp->rvp.rc_delayed_comp); |
77241056 MM |
1236 | /* |
1237 | * If send progress not running attempt to progress | |
1238 | * SDMA queue. | |
1239 | */ | |
1240 | if (ppd->dd->flags & HFI1_HAS_SEND_DMA) { | |
1241 | struct sdma_engine *engine; | |
1242 | u8 sc5; | |
1243 | ||
1244 | /* For now use sc to find engine */ | |
1245 | sc5 = ibp->sl_to_sc[qp->remote_ah_attr.sl]; | |
1246 | engine = qp_to_sdma_engine(qp, sc5); | |
1247 | sdma_engine_progress_schedule(engine); | |
1248 | } | |
1249 | } | |
1250 | ||
1251 | qp->s_retry = qp->s_retry_cnt; | |
1252 | update_last_psn(qp, wqe->lpsn); | |
1253 | ||
1254 | /* | |
1255 | * If we are completing a request which is in the process of | |
1256 | * being resent, we can stop re-sending it since we know the | |
1257 | * responder has already seen it. | |
1258 | */ | |
1259 | if (qp->s_acked == qp->s_cur) { | |
1260 | if (++qp->s_cur >= qp->s_size) | |
1261 | qp->s_cur = 0; | |
1262 | qp->s_acked = qp->s_cur; | |
83693bd1 | 1263 | wqe = rvt_get_swqe_ptr(qp, qp->s_cur); |
77241056 MM |
1264 | if (qp->s_acked != qp->s_tail) { |
1265 | qp->s_state = OP(SEND_LAST); | |
1266 | qp->s_psn = wqe->psn; | |
1267 | } | |
1268 | } else { | |
1269 | if (++qp->s_acked >= qp->s_size) | |
1270 | qp->s_acked = 0; | |
1271 | if (qp->state == IB_QPS_SQD && qp->s_acked == qp->s_cur) | |
1272 | qp->s_draining = 0; | |
83693bd1 | 1273 | wqe = rvt_get_swqe_ptr(qp, qp->s_acked); |
77241056 MM |
1274 | } |
1275 | return wqe; | |
1276 | } | |
1277 | ||
1278 | /** | |
1279 | * do_rc_ack - process an incoming RC ACK | |
1280 | * @qp: the QP the ACK came in on | |
1281 | * @psn: the packet sequence number of the ACK | |
1282 | * @opcode: the opcode of the request that resulted in the ACK | |
1283 | * | |
1284 | * This is called from rc_rcv_resp() to process an incoming RC ACK | |
1285 | * for the given QP. | |
b77d713a | 1286 | * May be called at interrupt level, with the QP s_lock held. |
77241056 MM |
1287 | * Returns 1 if OK, 0 if current operation should be aborted (NAK). |
1288 | */ | |
895420dd | 1289 | static int do_rc_ack(struct rvt_qp *qp, u32 aeth, u32 psn, int opcode, |
77241056 MM |
1290 | u64 val, struct hfi1_ctxtdata *rcd) |
1291 | { | |
1292 | struct hfi1_ibport *ibp; | |
1293 | enum ib_wc_status status; | |
895420dd | 1294 | struct rvt_swqe *wqe; |
77241056 MM |
1295 | int ret = 0; |
1296 | u32 ack_psn; | |
1297 | int diff; | |
e6f8c2b3 | 1298 | unsigned long to; |
77241056 | 1299 | |
77241056 MM |
1300 | /* |
1301 | * Note that NAKs implicitly ACK outstanding SEND and RDMA write | |
1302 | * requests and implicitly NAK RDMA read and atomic requests issued | |
1303 | * before the NAK'ed request. The MSN won't include the NAK'ed | |
1304 | * request but will include an ACK'ed request(s). | |
1305 | */ | |
1306 | ack_psn = psn; | |
1307 | if (aeth >> 29) | |
1308 | ack_psn--; | |
83693bd1 | 1309 | wqe = rvt_get_swqe_ptr(qp, qp->s_acked); |
77241056 MM |
1310 | ibp = to_iport(qp->ibqp.device, qp->port_num); |
1311 | ||
1312 | /* | |
1313 | * The MSN might be for a later WQE than the PSN indicates so | |
1314 | * only complete WQEs that the PSN finishes. | |
1315 | */ | |
1316 | while ((diff = delta_psn(ack_psn, wqe->lpsn)) >= 0) { | |
1317 | /* | |
1318 | * RDMA_READ_RESPONSE_ONLY is a special case since | |
1319 | * we want to generate completion events for everything | |
1320 | * before the RDMA read, copy the data, then generate | |
1321 | * the completion for the read. | |
1322 | */ | |
1323 | if (wqe->wr.opcode == IB_WR_RDMA_READ && | |
1324 | opcode == OP(RDMA_READ_RESPONSE_ONLY) && | |
1325 | diff == 0) { | |
1326 | ret = 1; | |
633d2739 | 1327 | goto bail_stop; |
77241056 MM |
1328 | } |
1329 | /* | |
1330 | * If this request is a RDMA read or atomic, and the ACK is | |
1331 | * for a later operation, this ACK NAKs the RDMA read or | |
1332 | * atomic. In other words, only a RDMA_READ_LAST or ONLY | |
1333 | * can ACK a RDMA read and likewise for atomic ops. Note | |
1334 | * that the NAK case can only happen if relaxed ordering is | |
1335 | * used and requests are sent after an RDMA read or atomic | |
1336 | * is sent but before the response is received. | |
1337 | */ | |
1338 | if ((wqe->wr.opcode == IB_WR_RDMA_READ && | |
1339 | (opcode != OP(RDMA_READ_RESPONSE_LAST) || diff != 0)) || | |
1340 | ((wqe->wr.opcode == IB_WR_ATOMIC_CMP_AND_SWP || | |
1341 | wqe->wr.opcode == IB_WR_ATOMIC_FETCH_AND_ADD) && | |
1342 | (opcode != OP(ATOMIC_ACKNOWLEDGE) || diff != 0))) { | |
1343 | /* Retry this request. */ | |
54d10c1e DD |
1344 | if (!(qp->r_flags & RVT_R_RDMAR_SEQ)) { |
1345 | qp->r_flags |= RVT_R_RDMAR_SEQ; | |
77241056 MM |
1346 | restart_rc(qp, qp->s_last_psn + 1, 0); |
1347 | if (list_empty(&qp->rspwait)) { | |
54d10c1e | 1348 | qp->r_flags |= RVT_R_RSP_SEND; |
77241056 MM |
1349 | atomic_inc(&qp->refcount); |
1350 | list_add_tail(&qp->rspwait, | |
1351 | &rcd->qp_wait_list); | |
1352 | } | |
1353 | } | |
1354 | /* | |
1355 | * No need to process the ACK/NAK since we are | |
1356 | * restarting an earlier request. | |
1357 | */ | |
633d2739 | 1358 | goto bail_stop; |
77241056 MM |
1359 | } |
1360 | if (wqe->wr.opcode == IB_WR_ATOMIC_CMP_AND_SWP || | |
1361 | wqe->wr.opcode == IB_WR_ATOMIC_FETCH_AND_ADD) { | |
1362 | u64 *vaddr = wqe->sg_list[0].vaddr; | |
1363 | *vaddr = val; | |
1364 | } | |
1365 | if (qp->s_num_rd_atomic && | |
1366 | (wqe->wr.opcode == IB_WR_RDMA_READ || | |
1367 | wqe->wr.opcode == IB_WR_ATOMIC_CMP_AND_SWP || | |
1368 | wqe->wr.opcode == IB_WR_ATOMIC_FETCH_AND_ADD)) { | |
1369 | qp->s_num_rd_atomic--; | |
1370 | /* Restart sending task if fence is complete */ | |
54d10c1e | 1371 | if ((qp->s_flags & RVT_S_WAIT_FENCE) && |
77241056 | 1372 | !qp->s_num_rd_atomic) { |
54d10c1e DD |
1373 | qp->s_flags &= ~(RVT_S_WAIT_FENCE | |
1374 | RVT_S_WAIT_ACK); | |
77241056 | 1375 | hfi1_schedule_send(qp); |
54d10c1e DD |
1376 | } else if (qp->s_flags & RVT_S_WAIT_RDMAR) { |
1377 | qp->s_flags &= ~(RVT_S_WAIT_RDMAR | | |
1378 | RVT_S_WAIT_ACK); | |
77241056 MM |
1379 | hfi1_schedule_send(qp); |
1380 | } | |
1381 | } | |
1382 | wqe = do_rc_completion(qp, wqe, ibp); | |
1383 | if (qp->s_acked == qp->s_tail) | |
1384 | break; | |
1385 | } | |
1386 | ||
1387 | switch (aeth >> 29) { | |
1388 | case 0: /* ACK */ | |
4eb06882 | 1389 | this_cpu_inc(*ibp->rvp.rc_acks); |
77241056 MM |
1390 | if (qp->s_acked != qp->s_tail) { |
1391 | /* | |
1392 | * We are expecting more ACKs so | |
633d2739 | 1393 | * mod the retry timer. |
77241056 | 1394 | */ |
633d2739 | 1395 | hfi1_mod_retry_timer(qp); |
77241056 MM |
1396 | /* |
1397 | * We can stop re-sending the earlier packets and | |
1398 | * continue with the next packet the receiver wants. | |
1399 | */ | |
1400 | if (cmp_psn(qp->s_psn, psn) <= 0) | |
1401 | reset_psn(qp, psn + 1); | |
633d2739 MM |
1402 | } else { |
1403 | /* No more acks - kill all timers */ | |
1404 | hfi1_stop_rc_timers(qp); | |
1405 | if (cmp_psn(qp->s_psn, psn) <= 0) { | |
1406 | qp->s_state = OP(SEND_LAST); | |
1407 | qp->s_psn = psn + 1; | |
1408 | } | |
77241056 | 1409 | } |
54d10c1e DD |
1410 | if (qp->s_flags & RVT_S_WAIT_ACK) { |
1411 | qp->s_flags &= ~RVT_S_WAIT_ACK; | |
77241056 MM |
1412 | hfi1_schedule_send(qp); |
1413 | } | |
1414 | hfi1_get_credit(qp, aeth); | |
1415 | qp->s_rnr_retry = qp->s_rnr_retry_cnt; | |
1416 | qp->s_retry = qp->s_retry_cnt; | |
1417 | update_last_psn(qp, psn); | |
633d2739 | 1418 | return 1; |
77241056 MM |
1419 | |
1420 | case 1: /* RNR NAK */ | |
4eb06882 | 1421 | ibp->rvp.n_rnr_naks++; |
77241056 | 1422 | if (qp->s_acked == qp->s_tail) |
633d2739 | 1423 | goto bail_stop; |
54d10c1e | 1424 | if (qp->s_flags & RVT_S_WAIT_RNR) |
633d2739 | 1425 | goto bail_stop; |
77241056 MM |
1426 | if (qp->s_rnr_retry == 0) { |
1427 | status = IB_WC_RNR_RETRY_EXC_ERR; | |
1428 | goto class_b; | |
1429 | } | |
1430 | if (qp->s_rnr_retry_cnt < 7) | |
1431 | qp->s_rnr_retry--; | |
1432 | ||
1433 | /* The last valid PSN is the previous PSN. */ | |
1434 | update_last_psn(qp, psn - 1); | |
1435 | ||
4eb06882 | 1436 | ibp->rvp.n_rc_resends += delta_psn(qp->s_psn, psn); |
77241056 MM |
1437 | |
1438 | reset_psn(qp, psn); | |
1439 | ||
54d10c1e | 1440 | qp->s_flags &= ~(RVT_S_WAIT_SSN_CREDIT | RVT_S_WAIT_ACK); |
633d2739 | 1441 | hfi1_stop_rc_timers(qp); |
e6f8c2b3 | 1442 | to = |
77241056 | 1443 | ib_hfi1_rnr_table[(aeth >> HFI1_AETH_CREDIT_SHIFT) & |
e6f8c2b3 MM |
1444 | HFI1_AETH_CREDIT_MASK]; |
1445 | hfi1_add_rnr_timer(qp, to); | |
633d2739 | 1446 | return 0; |
77241056 MM |
1447 | |
1448 | case 3: /* NAK */ | |
1449 | if (qp->s_acked == qp->s_tail) | |
633d2739 | 1450 | goto bail_stop; |
77241056 MM |
1451 | /* The last valid PSN is the previous PSN. */ |
1452 | update_last_psn(qp, psn - 1); | |
1453 | switch ((aeth >> HFI1_AETH_CREDIT_SHIFT) & | |
1454 | HFI1_AETH_CREDIT_MASK) { | |
1455 | case 0: /* PSN sequence error */ | |
4eb06882 | 1456 | ibp->rvp.n_seq_naks++; |
77241056 MM |
1457 | /* |
1458 | * Back up to the responder's expected PSN. | |
1459 | * Note that we might get a NAK in the middle of an | |
1460 | * RDMA READ response which terminates the RDMA | |
1461 | * READ. | |
1462 | */ | |
1463 | restart_rc(qp, psn, 0); | |
1464 | hfi1_schedule_send(qp); | |
1465 | break; | |
1466 | ||
1467 | case 1: /* Invalid Request */ | |
1468 | status = IB_WC_REM_INV_REQ_ERR; | |
4eb06882 | 1469 | ibp->rvp.n_other_naks++; |
77241056 MM |
1470 | goto class_b; |
1471 | ||
1472 | case 2: /* Remote Access Error */ | |
1473 | status = IB_WC_REM_ACCESS_ERR; | |
4eb06882 | 1474 | ibp->rvp.n_other_naks++; |
77241056 MM |
1475 | goto class_b; |
1476 | ||
1477 | case 3: /* Remote Operation Error */ | |
1478 | status = IB_WC_REM_OP_ERR; | |
4eb06882 | 1479 | ibp->rvp.n_other_naks++; |
77241056 MM |
1480 | class_b: |
1481 | if (qp->s_last == qp->s_acked) { | |
1482 | hfi1_send_complete(qp, wqe, status); | |
ec4274f1 | 1483 | rvt_error_qp(qp, IB_WC_WR_FLUSH_ERR); |
77241056 MM |
1484 | } |
1485 | break; | |
1486 | ||
1487 | default: | |
1488 | /* Ignore other reserved NAK error codes */ | |
1489 | goto reserved; | |
1490 | } | |
1491 | qp->s_retry = qp->s_retry_cnt; | |
1492 | qp->s_rnr_retry = qp->s_rnr_retry_cnt; | |
633d2739 | 1493 | goto bail_stop; |
77241056 MM |
1494 | |
1495 | default: /* 2: reserved */ | |
1496 | reserved: | |
1497 | /* Ignore reserved NAK codes. */ | |
633d2739 | 1498 | goto bail_stop; |
77241056 | 1499 | } |
87717f0a | 1500 | /* cannot be reached */ |
633d2739 MM |
1501 | bail_stop: |
1502 | hfi1_stop_rc_timers(qp); | |
77241056 MM |
1503 | return ret; |
1504 | } | |
1505 | ||
1506 | /* | |
1507 | * We have seen an out of sequence RDMA read middle or last packet. | |
1508 | * This ACKs SENDs and RDMA writes up to the first RDMA read or atomic SWQE. | |
1509 | */ | |
895420dd | 1510 | static void rdma_seq_err(struct rvt_qp *qp, struct hfi1_ibport *ibp, u32 psn, |
77241056 MM |
1511 | struct hfi1_ctxtdata *rcd) |
1512 | { | |
895420dd | 1513 | struct rvt_swqe *wqe; |
77241056 MM |
1514 | |
1515 | /* Remove QP from retry timer */ | |
e6f8c2b3 | 1516 | hfi1_stop_rc_timers(qp); |
77241056 | 1517 | |
83693bd1 | 1518 | wqe = rvt_get_swqe_ptr(qp, qp->s_acked); |
77241056 MM |
1519 | |
1520 | while (cmp_psn(psn, wqe->lpsn) > 0) { | |
1521 | if (wqe->wr.opcode == IB_WR_RDMA_READ || | |
1522 | wqe->wr.opcode == IB_WR_ATOMIC_CMP_AND_SWP || | |
1523 | wqe->wr.opcode == IB_WR_ATOMIC_FETCH_AND_ADD) | |
1524 | break; | |
1525 | wqe = do_rc_completion(qp, wqe, ibp); | |
1526 | } | |
1527 | ||
4eb06882 | 1528 | ibp->rvp.n_rdma_seq++; |
54d10c1e | 1529 | qp->r_flags |= RVT_R_RDMAR_SEQ; |
77241056 MM |
1530 | restart_rc(qp, qp->s_last_psn + 1, 0); |
1531 | if (list_empty(&qp->rspwait)) { | |
54d10c1e | 1532 | qp->r_flags |= RVT_R_RSP_SEND; |
77241056 MM |
1533 | atomic_inc(&qp->refcount); |
1534 | list_add_tail(&qp->rspwait, &rcd->qp_wait_list); | |
1535 | } | |
1536 | } | |
1537 | ||
1538 | /** | |
1539 | * rc_rcv_resp - process an incoming RC response packet | |
1540 | * @ibp: the port this packet came in on | |
1541 | * @ohdr: the other headers for this packet | |
1542 | * @data: the packet data | |
1543 | * @tlen: the packet length | |
1544 | * @qp: the QP for this packet | |
1545 | * @opcode: the opcode for this packet | |
1546 | * @psn: the packet sequence number for this packet | |
1547 | * @hdrsize: the header length | |
1548 | * @pmtu: the path MTU | |
1549 | * | |
1550 | * This is called from hfi1_rc_rcv() to process an incoming RC response | |
1551 | * packet for the given QP. | |
1552 | * Called at interrupt level. | |
1553 | */ | |
1554 | static void rc_rcv_resp(struct hfi1_ibport *ibp, | |
1555 | struct hfi1_other_headers *ohdr, | |
895420dd | 1556 | void *data, u32 tlen, struct rvt_qp *qp, |
77241056 MM |
1557 | u32 opcode, u32 psn, u32 hdrsize, u32 pmtu, |
1558 | struct hfi1_ctxtdata *rcd) | |
1559 | { | |
895420dd | 1560 | struct rvt_swqe *wqe; |
77241056 MM |
1561 | enum ib_wc_status status; |
1562 | unsigned long flags; | |
1563 | int diff; | |
1564 | u32 pad; | |
1565 | u32 aeth; | |
1566 | u64 val; | |
1567 | ||
1568 | spin_lock_irqsave(&qp->s_lock, flags); | |
1569 | ||
83525b61 MM |
1570 | trace_hfi1_rc_ack(qp, psn); |
1571 | ||
77241056 | 1572 | /* Ignore invalid responses. */ |
46a80d62 MM |
1573 | smp_read_barrier_depends(); /* see post_one_send */ |
1574 | if (cmp_psn(psn, ACCESS_ONCE(qp->s_next_psn)) >= 0) | |
77241056 MM |
1575 | goto ack_done; |
1576 | ||
1577 | /* Ignore duplicate responses. */ | |
1578 | diff = cmp_psn(psn, qp->s_last_psn); | |
1579 | if (unlikely(diff <= 0)) { | |
1580 | /* Update credits for "ghost" ACKs */ | |
1581 | if (diff == 0 && opcode == OP(ACKNOWLEDGE)) { | |
1582 | aeth = be32_to_cpu(ohdr->u.aeth); | |
1583 | if ((aeth >> 29) == 0) | |
1584 | hfi1_get_credit(qp, aeth); | |
1585 | } | |
1586 | goto ack_done; | |
1587 | } | |
1588 | ||
1589 | /* | |
1590 | * Skip everything other than the PSN we expect, if we are waiting | |
1591 | * for a reply to a restarted RDMA read or atomic op. | |
1592 | */ | |
54d10c1e | 1593 | if (qp->r_flags & RVT_R_RDMAR_SEQ) { |
77241056 MM |
1594 | if (cmp_psn(psn, qp->s_last_psn + 1) != 0) |
1595 | goto ack_done; | |
54d10c1e | 1596 | qp->r_flags &= ~RVT_R_RDMAR_SEQ; |
77241056 MM |
1597 | } |
1598 | ||
1599 | if (unlikely(qp->s_acked == qp->s_tail)) | |
1600 | goto ack_done; | |
83693bd1 | 1601 | wqe = rvt_get_swqe_ptr(qp, qp->s_acked); |
77241056 MM |
1602 | status = IB_WC_SUCCESS; |
1603 | ||
1604 | switch (opcode) { | |
1605 | case OP(ACKNOWLEDGE): | |
1606 | case OP(ATOMIC_ACKNOWLEDGE): | |
1607 | case OP(RDMA_READ_RESPONSE_FIRST): | |
1608 | aeth = be32_to_cpu(ohdr->u.aeth); | |
1609 | if (opcode == OP(ATOMIC_ACKNOWLEDGE)) { | |
1610 | __be32 *p = ohdr->u.at.atomic_ack_eth; | |
1611 | ||
50e5dcbe | 1612 | val = ((u64)be32_to_cpu(p[0]) << 32) | |
77241056 | 1613 | be32_to_cpu(p[1]); |
e490974e | 1614 | } else { |
77241056 | 1615 | val = 0; |
e490974e | 1616 | } |
77241056 MM |
1617 | if (!do_rc_ack(qp, aeth, psn, opcode, val, rcd) || |
1618 | opcode != OP(RDMA_READ_RESPONSE_FIRST)) | |
1619 | goto ack_done; | |
83693bd1 | 1620 | wqe = rvt_get_swqe_ptr(qp, qp->s_acked); |
77241056 MM |
1621 | if (unlikely(wqe->wr.opcode != IB_WR_RDMA_READ)) |
1622 | goto ack_op_err; | |
1623 | /* | |
1624 | * If this is a response to a resent RDMA read, we | |
1625 | * have to be careful to copy the data to the right | |
1626 | * location. | |
1627 | */ | |
1628 | qp->s_rdma_read_len = restart_sge(&qp->s_rdma_read_sge, | |
1629 | wqe, psn, pmtu); | |
1630 | goto read_middle; | |
1631 | ||
1632 | case OP(RDMA_READ_RESPONSE_MIDDLE): | |
1633 | /* no AETH, no ACK */ | |
1634 | if (unlikely(cmp_psn(psn, qp->s_last_psn + 1))) | |
1635 | goto ack_seq_err; | |
1636 | if (unlikely(wqe->wr.opcode != IB_WR_RDMA_READ)) | |
1637 | goto ack_op_err; | |
1638 | read_middle: | |
1639 | if (unlikely(tlen != (hdrsize + pmtu + 4))) | |
1640 | goto ack_len_err; | |
1641 | if (unlikely(pmtu >= qp->s_rdma_read_len)) | |
1642 | goto ack_len_err; | |
1643 | ||
1644 | /* | |
1645 | * We got a response so update the timeout. | |
1646 | * 4.096 usec. * (1 << qp->timeout) | |
1647 | */ | |
54d10c1e | 1648 | qp->s_flags |= RVT_S_TIMER; |
77241056 | 1649 | mod_timer(&qp->s_timer, jiffies + qp->timeout_jiffies); |
54d10c1e DD |
1650 | if (qp->s_flags & RVT_S_WAIT_ACK) { |
1651 | qp->s_flags &= ~RVT_S_WAIT_ACK; | |
77241056 MM |
1652 | hfi1_schedule_send(qp); |
1653 | } | |
1654 | ||
1655 | if (opcode == OP(RDMA_READ_RESPONSE_MIDDLE)) | |
1656 | qp->s_retry = qp->s_retry_cnt; | |
1657 | ||
1658 | /* | |
1659 | * Update the RDMA receive state but do the copy w/o | |
1660 | * holding the locks and blocking interrupts. | |
1661 | */ | |
1662 | qp->s_rdma_read_len -= pmtu; | |
1663 | update_last_psn(qp, psn); | |
1664 | spin_unlock_irqrestore(&qp->s_lock, flags); | |
7b0b01aa | 1665 | hfi1_copy_sge(&qp->s_rdma_read_sge, data, pmtu, 0, 0); |
77241056 MM |
1666 | goto bail; |
1667 | ||
1668 | case OP(RDMA_READ_RESPONSE_ONLY): | |
1669 | aeth = be32_to_cpu(ohdr->u.aeth); | |
1670 | if (!do_rc_ack(qp, aeth, psn, opcode, 0, rcd)) | |
1671 | goto ack_done; | |
1672 | /* Get the number of bytes the message was padded by. */ | |
1673 | pad = (be32_to_cpu(ohdr->bth[0]) >> 20) & 3; | |
1674 | /* | |
1675 | * Check that the data size is >= 0 && <= pmtu. | |
1676 | * Remember to account for ICRC (4). | |
1677 | */ | |
1678 | if (unlikely(tlen < (hdrsize + pad + 4))) | |
1679 | goto ack_len_err; | |
1680 | /* | |
1681 | * If this is a response to a resent RDMA read, we | |
1682 | * have to be careful to copy the data to the right | |
1683 | * location. | |
1684 | */ | |
83693bd1 | 1685 | wqe = rvt_get_swqe_ptr(qp, qp->s_acked); |
77241056 MM |
1686 | qp->s_rdma_read_len = restart_sge(&qp->s_rdma_read_sge, |
1687 | wqe, psn, pmtu); | |
1688 | goto read_last; | |
1689 | ||
1690 | case OP(RDMA_READ_RESPONSE_LAST): | |
1691 | /* ACKs READ req. */ | |
1692 | if (unlikely(cmp_psn(psn, qp->s_last_psn + 1))) | |
1693 | goto ack_seq_err; | |
1694 | if (unlikely(wqe->wr.opcode != IB_WR_RDMA_READ)) | |
1695 | goto ack_op_err; | |
1696 | /* Get the number of bytes the message was padded by. */ | |
1697 | pad = (be32_to_cpu(ohdr->bth[0]) >> 20) & 3; | |
1698 | /* | |
1699 | * Check that the data size is >= 1 && <= pmtu. | |
1700 | * Remember to account for ICRC (4). | |
1701 | */ | |
1702 | if (unlikely(tlen <= (hdrsize + pad + 4))) | |
1703 | goto ack_len_err; | |
1704 | read_last: | |
1705 | tlen -= hdrsize + pad + 4; | |
1706 | if (unlikely(tlen != qp->s_rdma_read_len)) | |
1707 | goto ack_len_err; | |
1708 | aeth = be32_to_cpu(ohdr->u.aeth); | |
7b0b01aa | 1709 | hfi1_copy_sge(&qp->s_rdma_read_sge, data, tlen, 0, 0); |
77241056 | 1710 | WARN_ON(qp->s_rdma_read_sge.num_sge); |
50e5dcbe | 1711 | (void)do_rc_ack(qp, aeth, psn, |
77241056 MM |
1712 | OP(RDMA_READ_RESPONSE_LAST), 0, rcd); |
1713 | goto ack_done; | |
1714 | } | |
1715 | ||
1716 | ack_op_err: | |
1717 | status = IB_WC_LOC_QP_OP_ERR; | |
1718 | goto ack_err; | |
1719 | ||
1720 | ack_seq_err: | |
1721 | rdma_seq_err(qp, ibp, psn, rcd); | |
1722 | goto ack_done; | |
1723 | ||
1724 | ack_len_err: | |
1725 | status = IB_WC_LOC_LEN_ERR; | |
1726 | ack_err: | |
1727 | if (qp->s_last == qp->s_acked) { | |
1728 | hfi1_send_complete(qp, wqe, status); | |
ec4274f1 | 1729 | rvt_error_qp(qp, IB_WC_WR_FLUSH_ERR); |
77241056 MM |
1730 | } |
1731 | ack_done: | |
1732 | spin_unlock_irqrestore(&qp->s_lock, flags); | |
1733 | bail: | |
1734 | return; | |
1735 | } | |
1736 | ||
2fd36865 | 1737 | static inline void rc_defered_ack(struct hfi1_ctxtdata *rcd, |
895420dd | 1738 | struct rvt_qp *qp) |
2fd36865 MM |
1739 | { |
1740 | if (list_empty(&qp->rspwait)) { | |
54d10c1e | 1741 | qp->r_flags |= RVT_R_RSP_NAK; |
2fd36865 MM |
1742 | atomic_inc(&qp->refcount); |
1743 | list_add_tail(&qp->rspwait, &rcd->qp_wait_list); | |
1744 | } | |
1745 | } | |
1746 | ||
895420dd | 1747 | static inline void rc_cancel_ack(struct rvt_qp *qp) |
7c091e5c | 1748 | { |
4c6829c5 DD |
1749 | struct hfi1_qp_priv *priv = qp->priv; |
1750 | ||
1751 | priv->r_adefered = 0; | |
7c091e5c MM |
1752 | if (list_empty(&qp->rspwait)) |
1753 | return; | |
1754 | list_del_init(&qp->rspwait); | |
54d10c1e | 1755 | qp->r_flags &= ~RVT_R_RSP_NAK; |
7c091e5c MM |
1756 | if (atomic_dec_and_test(&qp->refcount)) |
1757 | wake_up(&qp->wait); | |
1758 | } | |
1759 | ||
77241056 MM |
1760 | /** |
1761 | * rc_rcv_error - process an incoming duplicate or error RC packet | |
1762 | * @ohdr: the other headers for this packet | |
1763 | * @data: the packet data | |
1764 | * @qp: the QP for this packet | |
1765 | * @opcode: the opcode for this packet | |
1766 | * @psn: the packet sequence number for this packet | |
1767 | * @diff: the difference between the PSN and the expected PSN | |
1768 | * | |
1769 | * This is called from hfi1_rc_rcv() to process an unexpected | |
1770 | * incoming RC packet for the given QP. | |
1771 | * Called at interrupt level. | |
1772 | * Return 1 if no more processing is needed; otherwise return 0 to | |
1773 | * schedule a response to be sent. | |
1774 | */ | |
1775 | static noinline int rc_rcv_error(struct hfi1_other_headers *ohdr, void *data, | |
17fb4f29 JJ |
1776 | struct rvt_qp *qp, u32 opcode, u32 psn, |
1777 | int diff, struct hfi1_ctxtdata *rcd) | |
77241056 MM |
1778 | { |
1779 | struct hfi1_ibport *ibp = to_iport(qp->ibqp.device, qp->port_num); | |
895420dd | 1780 | struct rvt_ack_entry *e; |
77241056 MM |
1781 | unsigned long flags; |
1782 | u8 i, prev; | |
1783 | int old_req; | |
1784 | ||
83525b61 | 1785 | trace_hfi1_rc_rcv_error(qp, psn); |
77241056 MM |
1786 | if (diff > 0) { |
1787 | /* | |
1788 | * Packet sequence error. | |
1789 | * A NAK will ACK earlier sends and RDMA writes. | |
1790 | * Don't queue the NAK if we already sent one. | |
1791 | */ | |
1792 | if (!qp->r_nak_state) { | |
4eb06882 | 1793 | ibp->rvp.n_rc_seqnak++; |
77241056 MM |
1794 | qp->r_nak_state = IB_NAK_PSN_ERROR; |
1795 | /* Use the expected PSN. */ | |
1796 | qp->r_ack_psn = qp->r_psn; | |
1797 | /* | |
1798 | * Wait to send the sequence NAK until all packets | |
1799 | * in the receive queue have been processed. | |
1800 | * Otherwise, we end up propagating congestion. | |
1801 | */ | |
2fd36865 | 1802 | rc_defered_ack(rcd, qp); |
77241056 MM |
1803 | } |
1804 | goto done; | |
1805 | } | |
1806 | ||
1807 | /* | |
1808 | * Handle a duplicate request. Don't re-execute SEND, RDMA | |
1809 | * write or atomic op. Don't NAK errors, just silently drop | |
1810 | * the duplicate request. Note that r_sge, r_len, and | |
1811 | * r_rcv_len may be in use so don't modify them. | |
1812 | * | |
1813 | * We are supposed to ACK the earliest duplicate PSN but we | |
1814 | * can coalesce an outstanding duplicate ACK. We have to | |
1815 | * send the earliest so that RDMA reads can be restarted at | |
1816 | * the requester's expected PSN. | |
1817 | * | |
1818 | * First, find where this duplicate PSN falls within the | |
1819 | * ACKs previously sent. | |
1820 | * old_req is true if there is an older response that is scheduled | |
1821 | * to be sent before sending this one. | |
1822 | */ | |
1823 | e = NULL; | |
1824 | old_req = 1; | |
4eb06882 | 1825 | ibp->rvp.n_rc_dupreq++; |
77241056 MM |
1826 | |
1827 | spin_lock_irqsave(&qp->s_lock, flags); | |
1828 | ||
1829 | for (i = qp->r_head_ack_queue; ; i = prev) { | |
1830 | if (i == qp->s_tail_ack_queue) | |
1831 | old_req = 0; | |
1832 | if (i) | |
1833 | prev = i - 1; | |
1834 | else | |
1835 | prev = HFI1_MAX_RDMA_ATOMIC; | |
1836 | if (prev == qp->r_head_ack_queue) { | |
1837 | e = NULL; | |
1838 | break; | |
1839 | } | |
1840 | e = &qp->s_ack_queue[prev]; | |
1841 | if (!e->opcode) { | |
1842 | e = NULL; | |
1843 | break; | |
1844 | } | |
1845 | if (cmp_psn(psn, e->psn) >= 0) { | |
1846 | if (prev == qp->s_tail_ack_queue && | |
1847 | cmp_psn(psn, e->lpsn) <= 0) | |
1848 | old_req = 0; | |
1849 | break; | |
1850 | } | |
1851 | } | |
1852 | switch (opcode) { | |
1853 | case OP(RDMA_READ_REQUEST): { | |
1854 | struct ib_reth *reth; | |
1855 | u32 offset; | |
1856 | u32 len; | |
1857 | ||
1858 | /* | |
1859 | * If we didn't find the RDMA read request in the ack queue, | |
1860 | * we can ignore this request. | |
1861 | */ | |
1862 | if (!e || e->opcode != OP(RDMA_READ_REQUEST)) | |
1863 | goto unlock_done; | |
1864 | /* RETH comes after BTH */ | |
1865 | reth = &ohdr->u.rc.reth; | |
1866 | /* | |
1867 | * Address range must be a subset of the original | |
1868 | * request and start on pmtu boundaries. | |
1869 | * We reuse the old ack_queue slot since the requester | |
1870 | * should not back up and request an earlier PSN for the | |
1871 | * same request. | |
1872 | */ | |
1873 | offset = delta_psn(psn, e->psn) * qp->pmtu; | |
1874 | len = be32_to_cpu(reth->length); | |
1875 | if (unlikely(offset + len != e->rdma_sge.sge_length)) | |
1876 | goto unlock_done; | |
1877 | if (e->rdma_sge.mr) { | |
895420dd | 1878 | rvt_put_mr(e->rdma_sge.mr); |
77241056 MM |
1879 | e->rdma_sge.mr = NULL; |
1880 | } | |
1881 | if (len != 0) { | |
1882 | u32 rkey = be32_to_cpu(reth->rkey); | |
1883 | u64 vaddr = be64_to_cpu(reth->vaddr); | |
1884 | int ok; | |
1885 | ||
895420dd DD |
1886 | ok = rvt_rkey_ok(qp, &e->rdma_sge, len, vaddr, rkey, |
1887 | IB_ACCESS_REMOTE_READ); | |
77241056 MM |
1888 | if (unlikely(!ok)) |
1889 | goto unlock_done; | |
1890 | } else { | |
1891 | e->rdma_sge.vaddr = NULL; | |
1892 | e->rdma_sge.length = 0; | |
1893 | e->rdma_sge.sge_length = 0; | |
1894 | } | |
1895 | e->psn = psn; | |
1896 | if (old_req) | |
1897 | goto unlock_done; | |
1898 | qp->s_tail_ack_queue = prev; | |
1899 | break; | |
1900 | } | |
1901 | ||
1902 | case OP(COMPARE_SWAP): | |
1903 | case OP(FETCH_ADD): { | |
1904 | /* | |
1905 | * If we didn't find the atomic request in the ack queue | |
1906 | * or the send tasklet is already backed up to send an | |
1907 | * earlier entry, we can ignore this request. | |
1908 | */ | |
50e5dcbe | 1909 | if (!e || e->opcode != (u8)opcode || old_req) |
77241056 MM |
1910 | goto unlock_done; |
1911 | qp->s_tail_ack_queue = prev; | |
1912 | break; | |
1913 | } | |
1914 | ||
1915 | default: | |
1916 | /* | |
1917 | * Ignore this operation if it doesn't request an ACK | |
1918 | * or an earlier RDMA read or atomic is going to be resent. | |
1919 | */ | |
1920 | if (!(psn & IB_BTH_REQ_ACK) || old_req) | |
1921 | goto unlock_done; | |
1922 | /* | |
1923 | * Resend the most recent ACK if this request is | |
1924 | * after all the previous RDMA reads and atomics. | |
1925 | */ | |
1926 | if (i == qp->r_head_ack_queue) { | |
1927 | spin_unlock_irqrestore(&qp->s_lock, flags); | |
1928 | qp->r_nak_state = 0; | |
1929 | qp->r_ack_psn = qp->r_psn - 1; | |
1930 | goto send_ack; | |
1931 | } | |
1932 | ||
1933 | /* | |
1934 | * Resend the RDMA read or atomic op which | |
1935 | * ACKs this duplicate request. | |
1936 | */ | |
1937 | qp->s_tail_ack_queue = i; | |
1938 | break; | |
1939 | } | |
1940 | qp->s_ack_state = OP(ACKNOWLEDGE); | |
54d10c1e | 1941 | qp->s_flags |= RVT_S_RESP_PENDING; |
77241056 MM |
1942 | qp->r_nak_state = 0; |
1943 | hfi1_schedule_send(qp); | |
1944 | ||
1945 | unlock_done: | |
1946 | spin_unlock_irqrestore(&qp->s_lock, flags); | |
1947 | done: | |
1948 | return 1; | |
1949 | ||
1950 | send_ack: | |
1951 | return 0; | |
1952 | } | |
1953 | ||
895420dd | 1954 | void hfi1_rc_error(struct rvt_qp *qp, enum ib_wc_status err) |
77241056 MM |
1955 | { |
1956 | unsigned long flags; | |
1957 | int lastwqe; | |
1958 | ||
1959 | spin_lock_irqsave(&qp->s_lock, flags); | |
ec4274f1 | 1960 | lastwqe = rvt_error_qp(qp, err); |
77241056 MM |
1961 | spin_unlock_irqrestore(&qp->s_lock, flags); |
1962 | ||
1963 | if (lastwqe) { | |
1964 | struct ib_event ev; | |
1965 | ||
1966 | ev.device = qp->ibqp.device; | |
1967 | ev.element.qp = &qp->ibqp; | |
1968 | ev.event = IB_EVENT_QP_LAST_WQE_REACHED; | |
1969 | qp->ibqp.event_handler(&ev, qp->ibqp.qp_context); | |
1970 | } | |
1971 | } | |
1972 | ||
895420dd | 1973 | static inline void update_ack_queue(struct rvt_qp *qp, unsigned n) |
77241056 MM |
1974 | { |
1975 | unsigned next; | |
1976 | ||
1977 | next = n + 1; | |
1978 | if (next > HFI1_MAX_RDMA_ATOMIC) | |
1979 | next = 0; | |
1980 | qp->s_tail_ack_queue = next; | |
1981 | qp->s_ack_state = OP(ACKNOWLEDGE); | |
1982 | } | |
1983 | ||
1984 | static void log_cca_event(struct hfi1_pportdata *ppd, u8 sl, u32 rlid, | |
1985 | u32 lqpn, u32 rqpn, u8 svc_type) | |
1986 | { | |
1987 | struct opa_hfi1_cong_log_event_internal *cc_event; | |
b77d713a | 1988 | unsigned long flags; |
77241056 MM |
1989 | |
1990 | if (sl >= OPA_MAX_SLS) | |
1991 | return; | |
1992 | ||
b77d713a | 1993 | spin_lock_irqsave(&ppd->cc_log_lock, flags); |
77241056 | 1994 | |
8638b77f | 1995 | ppd->threshold_cong_event_map[sl / 8] |= 1 << (sl % 8); |
77241056 MM |
1996 | ppd->threshold_event_counter++; |
1997 | ||
1998 | cc_event = &ppd->cc_events[ppd->cc_log_idx++]; | |
1999 | if (ppd->cc_log_idx == OPA_CONG_LOG_ELEMS) | |
2000 | ppd->cc_log_idx = 0; | |
ec4274f1 DD |
2001 | cc_event->lqpn = lqpn & RVT_QPN_MASK; |
2002 | cc_event->rqpn = rqpn & RVT_QPN_MASK; | |
77241056 MM |
2003 | cc_event->sl = sl; |
2004 | cc_event->svc_type = svc_type; | |
2005 | cc_event->rlid = rlid; | |
2006 | /* keep timestamp in units of 1.024 usec */ | |
2007 | cc_event->timestamp = ktime_to_ns(ktime_get()) / 1024; | |
2008 | ||
b77d713a | 2009 | spin_unlock_irqrestore(&ppd->cc_log_lock, flags); |
77241056 MM |
2010 | } |
2011 | ||
2012 | void process_becn(struct hfi1_pportdata *ppd, u8 sl, u16 rlid, u32 lqpn, | |
2013 | u32 rqpn, u8 svc_type) | |
2014 | { | |
2015 | struct cca_timer *cca_timer; | |
2016 | u16 ccti, ccti_incr, ccti_timer, ccti_limit; | |
2017 | u8 trigger_threshold; | |
2018 | struct cc_state *cc_state; | |
b77d713a | 2019 | unsigned long flags; |
77241056 MM |
2020 | |
2021 | if (sl >= OPA_MAX_SLS) | |
2022 | return; | |
2023 | ||
77241056 MM |
2024 | cc_state = get_cc_state(ppd); |
2025 | ||
d125a6c6 | 2026 | if (!cc_state) |
77241056 MM |
2027 | return; |
2028 | ||
2029 | /* | |
2030 | * 1) increase CCTI (for this SL) | |
2031 | * 2) select IPG (i.e., call set_link_ipg()) | |
2032 | * 3) start timer | |
2033 | */ | |
2034 | ccti_limit = cc_state->cct.ccti_limit; | |
2035 | ccti_incr = cc_state->cong_setting.entries[sl].ccti_increase; | |
2036 | ccti_timer = cc_state->cong_setting.entries[sl].ccti_timer; | |
2037 | trigger_threshold = | |
2038 | cc_state->cong_setting.entries[sl].trigger_threshold; | |
2039 | ||
b77d713a | 2040 | spin_lock_irqsave(&ppd->cca_timer_lock, flags); |
77241056 | 2041 | |
d35cf744 | 2042 | cca_timer = &ppd->cca_timer[sl]; |
77241056 MM |
2043 | if (cca_timer->ccti < ccti_limit) { |
2044 | if (cca_timer->ccti + ccti_incr <= ccti_limit) | |
2045 | cca_timer->ccti += ccti_incr; | |
2046 | else | |
2047 | cca_timer->ccti = ccti_limit; | |
2048 | set_link_ipg(ppd); | |
2049 | } | |
2050 | ||
77241056 MM |
2051 | ccti = cca_timer->ccti; |
2052 | ||
2053 | if (!hrtimer_active(&cca_timer->hrtimer)) { | |
2054 | /* ccti_timer is in units of 1.024 usec */ | |
2055 | unsigned long nsec = 1024 * ccti_timer; | |
2056 | ||
2057 | hrtimer_start(&cca_timer->hrtimer, ns_to_ktime(nsec), | |
2058 | HRTIMER_MODE_REL); | |
2059 | } | |
2060 | ||
d35cf744 JJ |
2061 | spin_unlock_irqrestore(&ppd->cca_timer_lock, flags); |
2062 | ||
77241056 MM |
2063 | if ((trigger_threshold != 0) && (ccti >= trigger_threshold)) |
2064 | log_cca_event(ppd, sl, rlid, lqpn, rqpn, svc_type); | |
2065 | } | |
2066 | ||
2067 | /** | |
2068 | * hfi1_rc_rcv - process an incoming RC packet | |
2069 | * @rcd: the context pointer | |
2070 | * @hdr: the header of this packet | |
2071 | * @rcv_flags: flags relevant to rcv processing | |
2072 | * @data: the packet data | |
2073 | * @tlen: the packet length | |
2074 | * @qp: the QP for this packet | |
2075 | * | |
2076 | * This is called from qp_rcv() to process an incoming RC packet | |
2077 | * for the given QP. | |
b77d713a | 2078 | * May be called at interrupt level. |
77241056 MM |
2079 | */ |
2080 | void hfi1_rc_rcv(struct hfi1_packet *packet) | |
2081 | { | |
2082 | struct hfi1_ctxtdata *rcd = packet->rcd; | |
2083 | struct hfi1_ib_header *hdr = packet->hdr; | |
2084 | u32 rcv_flags = packet->rcv_flags; | |
2085 | void *data = packet->ebuf; | |
2086 | u32 tlen = packet->tlen; | |
895420dd | 2087 | struct rvt_qp *qp = packet->qp; |
77241056 MM |
2088 | struct hfi1_ibport *ibp = to_iport(qp->ibqp.device, qp->port_num); |
2089 | struct hfi1_pportdata *ppd = ppd_from_ibp(ibp); | |
2090 | struct hfi1_other_headers *ohdr = packet->ohdr; | |
2091 | u32 bth0, opcode; | |
2092 | u32 hdrsize = packet->hlen; | |
2093 | u32 psn; | |
2094 | u32 pad; | |
2095 | struct ib_wc wc; | |
2096 | u32 pmtu = qp->pmtu; | |
2097 | int diff; | |
2098 | struct ib_reth *reth; | |
2099 | unsigned long flags; | |
2100 | u32 bth1; | |
2101 | int ret, is_fecn = 0; | |
7b0b01aa | 2102 | int copy_last = 0; |
77241056 MM |
2103 | |
2104 | bth0 = be32_to_cpu(ohdr->bth[0]); | |
2105 | if (hfi1_ruc_check_hdr(ibp, hdr, rcv_flags & HFI1_HAS_GRH, qp, bth0)) | |
2106 | return; | |
2107 | ||
2108 | bth1 = be32_to_cpu(ohdr->bth[1]); | |
2109 | if (unlikely(bth1 & (HFI1_BECN_SMASK | HFI1_FECN_SMASK))) { | |
2110 | if (bth1 & HFI1_BECN_SMASK) { | |
2111 | u16 rlid = qp->remote_ah_attr.dlid; | |
2112 | u32 lqpn, rqpn; | |
2113 | ||
2114 | lqpn = qp->ibqp.qp_num; | |
2115 | rqpn = qp->remote_qpn; | |
2116 | process_becn( | |
2117 | ppd, | |
2118 | qp->remote_ah_attr.sl, | |
2119 | rlid, lqpn, rqpn, | |
2120 | IB_CC_SVCTYPE_RC); | |
2121 | } | |
2122 | is_fecn = bth1 & HFI1_FECN_SMASK; | |
2123 | } | |
2124 | ||
2125 | psn = be32_to_cpu(ohdr->bth[2]); | |
977940b8 | 2126 | opcode = (bth0 >> 24) & 0xff; |
77241056 MM |
2127 | |
2128 | /* | |
2129 | * Process responses (ACKs) before anything else. Note that the | |
2130 | * packet sequence number will be for something in the send work | |
2131 | * queue rather than the expected receive packet sequence number. | |
2132 | * In other words, this QP is the requester. | |
2133 | */ | |
2134 | if (opcode >= OP(RDMA_READ_RESPONSE_FIRST) && | |
2135 | opcode <= OP(ATOMIC_ACKNOWLEDGE)) { | |
2136 | rc_rcv_resp(ibp, ohdr, data, tlen, qp, opcode, psn, | |
2137 | hdrsize, pmtu, rcd); | |
2138 | if (is_fecn) | |
2139 | goto send_ack; | |
2140 | return; | |
2141 | } | |
2142 | ||
2143 | /* Compute 24 bits worth of difference. */ | |
2144 | diff = delta_psn(psn, qp->r_psn); | |
2145 | if (unlikely(diff)) { | |
2146 | if (rc_rcv_error(ohdr, data, qp, opcode, psn, diff, rcd)) | |
2147 | return; | |
2148 | goto send_ack; | |
2149 | } | |
2150 | ||
2151 | /* Check for opcode sequence errors. */ | |
2152 | switch (qp->r_state) { | |
2153 | case OP(SEND_FIRST): | |
2154 | case OP(SEND_MIDDLE): | |
2155 | if (opcode == OP(SEND_MIDDLE) || | |
2156 | opcode == OP(SEND_LAST) || | |
2157 | opcode == OP(SEND_LAST_WITH_IMMEDIATE)) | |
2158 | break; | |
2159 | goto nack_inv; | |
2160 | ||
2161 | case OP(RDMA_WRITE_FIRST): | |
2162 | case OP(RDMA_WRITE_MIDDLE): | |
2163 | if (opcode == OP(RDMA_WRITE_MIDDLE) || | |
2164 | opcode == OP(RDMA_WRITE_LAST) || | |
2165 | opcode == OP(RDMA_WRITE_LAST_WITH_IMMEDIATE)) | |
2166 | break; | |
2167 | goto nack_inv; | |
2168 | ||
2169 | default: | |
2170 | if (opcode == OP(SEND_MIDDLE) || | |
2171 | opcode == OP(SEND_LAST) || | |
2172 | opcode == OP(SEND_LAST_WITH_IMMEDIATE) || | |
2173 | opcode == OP(RDMA_WRITE_MIDDLE) || | |
2174 | opcode == OP(RDMA_WRITE_LAST) || | |
2175 | opcode == OP(RDMA_WRITE_LAST_WITH_IMMEDIATE)) | |
2176 | goto nack_inv; | |
2177 | /* | |
2178 | * Note that it is up to the requester to not send a new | |
2179 | * RDMA read or atomic operation before receiving an ACK | |
2180 | * for the previous operation. | |
2181 | */ | |
2182 | break; | |
2183 | } | |
2184 | ||
54d10c1e | 2185 | if (qp->state == IB_QPS_RTR && !(qp->r_flags & RVT_R_COMM_EST)) |
77241056 MM |
2186 | qp_comm_est(qp); |
2187 | ||
2188 | /* OK, process the packet. */ | |
2189 | switch (opcode) { | |
2190 | case OP(SEND_FIRST): | |
ec4274f1 | 2191 | ret = hfi1_rvt_get_rwqe(qp, 0); |
77241056 MM |
2192 | if (ret < 0) |
2193 | goto nack_op_err; | |
2194 | if (!ret) | |
2195 | goto rnr_nak; | |
2196 | qp->r_rcv_len = 0; | |
2197 | /* FALLTHROUGH */ | |
2198 | case OP(SEND_MIDDLE): | |
2199 | case OP(RDMA_WRITE_MIDDLE): | |
2200 | send_middle: | |
2201 | /* Check for invalid length PMTU or posted rwqe len. */ | |
2202 | if (unlikely(tlen != (hdrsize + pmtu + 4))) | |
2203 | goto nack_inv; | |
2204 | qp->r_rcv_len += pmtu; | |
2205 | if (unlikely(qp->r_rcv_len > qp->r_len)) | |
2206 | goto nack_inv; | |
7b0b01aa | 2207 | hfi1_copy_sge(&qp->r_sge, data, pmtu, 1, 0); |
77241056 MM |
2208 | break; |
2209 | ||
2210 | case OP(RDMA_WRITE_LAST_WITH_IMMEDIATE): | |
2211 | /* consume RWQE */ | |
ec4274f1 | 2212 | ret = hfi1_rvt_get_rwqe(qp, 1); |
77241056 MM |
2213 | if (ret < 0) |
2214 | goto nack_op_err; | |
2215 | if (!ret) | |
2216 | goto rnr_nak; | |
2217 | goto send_last_imm; | |
2218 | ||
2219 | case OP(SEND_ONLY): | |
2220 | case OP(SEND_ONLY_WITH_IMMEDIATE): | |
ec4274f1 | 2221 | ret = hfi1_rvt_get_rwqe(qp, 0); |
77241056 MM |
2222 | if (ret < 0) |
2223 | goto nack_op_err; | |
2224 | if (!ret) | |
2225 | goto rnr_nak; | |
2226 | qp->r_rcv_len = 0; | |
2227 | if (opcode == OP(SEND_ONLY)) | |
2228 | goto no_immediate_data; | |
2229 | /* FALLTHROUGH for SEND_ONLY_WITH_IMMEDIATE */ | |
2230 | case OP(SEND_LAST_WITH_IMMEDIATE): | |
2231 | send_last_imm: | |
2232 | wc.ex.imm_data = ohdr->u.imm_data; | |
2233 | wc.wc_flags = IB_WC_WITH_IMM; | |
2234 | goto send_last; | |
77241056 | 2235 | case OP(RDMA_WRITE_LAST): |
7b0b01aa DL |
2236 | copy_last = ibpd_to_rvtpd(qp->ibqp.pd)->user; |
2237 | /* fall through */ | |
2238 | case OP(SEND_LAST): | |
77241056 MM |
2239 | no_immediate_data: |
2240 | wc.wc_flags = 0; | |
2241 | wc.ex.imm_data = 0; | |
2242 | send_last: | |
2243 | /* Get the number of bytes the message was padded by. */ | |
2244 | pad = (bth0 >> 20) & 3; | |
2245 | /* Check for invalid length. */ | |
2246 | /* LAST len should be >= 1 */ | |
2247 | if (unlikely(tlen < (hdrsize + pad + 4))) | |
2248 | goto nack_inv; | |
2249 | /* Don't count the CRC. */ | |
2250 | tlen -= (hdrsize + pad + 4); | |
2251 | wc.byte_len = tlen + qp->r_rcv_len; | |
2252 | if (unlikely(wc.byte_len > qp->r_len)) | |
2253 | goto nack_inv; | |
7b0b01aa | 2254 | hfi1_copy_sge(&qp->r_sge, data, tlen, 1, copy_last); |
ec4274f1 | 2255 | rvt_put_ss(&qp->r_sge); |
77241056 | 2256 | qp->r_msn++; |
54d10c1e | 2257 | if (!test_and_clear_bit(RVT_R_WRID_VALID, &qp->r_aflags)) |
77241056 MM |
2258 | break; |
2259 | wc.wr_id = qp->r_wr_id; | |
2260 | wc.status = IB_WC_SUCCESS; | |
2261 | if (opcode == OP(RDMA_WRITE_LAST_WITH_IMMEDIATE) || | |
2262 | opcode == OP(RDMA_WRITE_ONLY_WITH_IMMEDIATE)) | |
2263 | wc.opcode = IB_WC_RECV_RDMA_WITH_IMM; | |
2264 | else | |
2265 | wc.opcode = IB_WC_RECV; | |
2266 | wc.qp = &qp->ibqp; | |
2267 | wc.src_qp = qp->remote_qpn; | |
2268 | wc.slid = qp->remote_ah_attr.dlid; | |
2269 | /* | |
2270 | * It seems that IB mandates the presence of an SL in a | |
2271 | * work completion only for the UD transport (see section | |
2272 | * 11.4.2 of IBTA Vol. 1). | |
2273 | * | |
2274 | * However, the way the SL is chosen below is consistent | |
2275 | * with the way that IB/qib works and is trying avoid | |
2276 | * introducing incompatibilities. | |
2277 | * | |
2278 | * See also OPA Vol. 1, section 9.7.6, and table 9-17. | |
2279 | */ | |
2280 | wc.sl = qp->remote_ah_attr.sl; | |
2281 | /* zero fields that are N/A */ | |
2282 | wc.vendor_err = 0; | |
2283 | wc.pkey_index = 0; | |
2284 | wc.dlid_path_bits = 0; | |
2285 | wc.port_num = 0; | |
2286 | /* Signal completion event if the solicited bit is set. */ | |
abd712da DD |
2287 | rvt_cq_enter(ibcq_to_rvtcq(qp->ibqp.recv_cq), &wc, |
2288 | (bth0 & IB_BTH_SOLICITED) != 0); | |
77241056 MM |
2289 | break; |
2290 | ||
77241056 | 2291 | case OP(RDMA_WRITE_ONLY): |
7b0b01aa DL |
2292 | copy_last = 1; |
2293 | /* fall through */ | |
2294 | case OP(RDMA_WRITE_FIRST): | |
77241056 MM |
2295 | case OP(RDMA_WRITE_ONLY_WITH_IMMEDIATE): |
2296 | if (unlikely(!(qp->qp_access_flags & IB_ACCESS_REMOTE_WRITE))) | |
2297 | goto nack_inv; | |
2298 | /* consume RWQE */ | |
2299 | reth = &ohdr->u.rc.reth; | |
2300 | qp->r_len = be32_to_cpu(reth->length); | |
2301 | qp->r_rcv_len = 0; | |
2302 | qp->r_sge.sg_list = NULL; | |
2303 | if (qp->r_len != 0) { | |
2304 | u32 rkey = be32_to_cpu(reth->rkey); | |
2305 | u64 vaddr = be64_to_cpu(reth->vaddr); | |
2306 | int ok; | |
2307 | ||
2308 | /* Check rkey & NAK */ | |
895420dd DD |
2309 | ok = rvt_rkey_ok(qp, &qp->r_sge.sge, qp->r_len, vaddr, |
2310 | rkey, IB_ACCESS_REMOTE_WRITE); | |
77241056 MM |
2311 | if (unlikely(!ok)) |
2312 | goto nack_acc; | |
2313 | qp->r_sge.num_sge = 1; | |
2314 | } else { | |
2315 | qp->r_sge.num_sge = 0; | |
2316 | qp->r_sge.sge.mr = NULL; | |
2317 | qp->r_sge.sge.vaddr = NULL; | |
2318 | qp->r_sge.sge.length = 0; | |
2319 | qp->r_sge.sge.sge_length = 0; | |
2320 | } | |
2321 | if (opcode == OP(RDMA_WRITE_FIRST)) | |
2322 | goto send_middle; | |
2323 | else if (opcode == OP(RDMA_WRITE_ONLY)) | |
2324 | goto no_immediate_data; | |
ec4274f1 | 2325 | ret = hfi1_rvt_get_rwqe(qp, 1); |
77241056 MM |
2326 | if (ret < 0) |
2327 | goto nack_op_err; | |
2328 | if (!ret) | |
2329 | goto rnr_nak; | |
2330 | wc.ex.imm_data = ohdr->u.rc.imm_data; | |
2331 | wc.wc_flags = IB_WC_WITH_IMM; | |
2332 | goto send_last; | |
2333 | ||
2334 | case OP(RDMA_READ_REQUEST): { | |
895420dd | 2335 | struct rvt_ack_entry *e; |
77241056 MM |
2336 | u32 len; |
2337 | u8 next; | |
2338 | ||
2339 | if (unlikely(!(qp->qp_access_flags & IB_ACCESS_REMOTE_READ))) | |
2340 | goto nack_inv; | |
2341 | next = qp->r_head_ack_queue + 1; | |
2342 | /* s_ack_queue is size HFI1_MAX_RDMA_ATOMIC+1 so use > not >= */ | |
2343 | if (next > HFI1_MAX_RDMA_ATOMIC) | |
2344 | next = 0; | |
2345 | spin_lock_irqsave(&qp->s_lock, flags); | |
2346 | if (unlikely(next == qp->s_tail_ack_queue)) { | |
2347 | if (!qp->s_ack_queue[next].sent) | |
2348 | goto nack_inv_unlck; | |
2349 | update_ack_queue(qp, next); | |
2350 | } | |
2351 | e = &qp->s_ack_queue[qp->r_head_ack_queue]; | |
2352 | if (e->opcode == OP(RDMA_READ_REQUEST) && e->rdma_sge.mr) { | |
895420dd | 2353 | rvt_put_mr(e->rdma_sge.mr); |
77241056 MM |
2354 | e->rdma_sge.mr = NULL; |
2355 | } | |
2356 | reth = &ohdr->u.rc.reth; | |
2357 | len = be32_to_cpu(reth->length); | |
2358 | if (len) { | |
2359 | u32 rkey = be32_to_cpu(reth->rkey); | |
2360 | u64 vaddr = be64_to_cpu(reth->vaddr); | |
2361 | int ok; | |
2362 | ||
2363 | /* Check rkey & NAK */ | |
895420dd DD |
2364 | ok = rvt_rkey_ok(qp, &e->rdma_sge, len, vaddr, |
2365 | rkey, IB_ACCESS_REMOTE_READ); | |
77241056 MM |
2366 | if (unlikely(!ok)) |
2367 | goto nack_acc_unlck; | |
2368 | /* | |
2369 | * Update the next expected PSN. We add 1 later | |
2370 | * below, so only add the remainder here. | |
2371 | */ | |
2372 | if (len > pmtu) | |
2373 | qp->r_psn += (len - 1) / pmtu; | |
2374 | } else { | |
2375 | e->rdma_sge.mr = NULL; | |
2376 | e->rdma_sge.vaddr = NULL; | |
2377 | e->rdma_sge.length = 0; | |
2378 | e->rdma_sge.sge_length = 0; | |
2379 | } | |
2380 | e->opcode = opcode; | |
2381 | e->sent = 0; | |
2382 | e->psn = psn; | |
2383 | e->lpsn = qp->r_psn; | |
2384 | /* | |
2385 | * We need to increment the MSN here instead of when we | |
2386 | * finish sending the result since a duplicate request would | |
2387 | * increment it more than once. | |
2388 | */ | |
2389 | qp->r_msn++; | |
2390 | qp->r_psn++; | |
2391 | qp->r_state = opcode; | |
2392 | qp->r_nak_state = 0; | |
2393 | qp->r_head_ack_queue = next; | |
2394 | ||
2395 | /* Schedule the send tasklet. */ | |
54d10c1e | 2396 | qp->s_flags |= RVT_S_RESP_PENDING; |
77241056 MM |
2397 | hfi1_schedule_send(qp); |
2398 | ||
2399 | spin_unlock_irqrestore(&qp->s_lock, flags); | |
2400 | if (is_fecn) | |
2401 | goto send_ack; | |
2402 | return; | |
2403 | } | |
2404 | ||
2405 | case OP(COMPARE_SWAP): | |
2406 | case OP(FETCH_ADD): { | |
2407 | struct ib_atomic_eth *ateth; | |
895420dd | 2408 | struct rvt_ack_entry *e; |
77241056 MM |
2409 | u64 vaddr; |
2410 | atomic64_t *maddr; | |
2411 | u64 sdata; | |
2412 | u32 rkey; | |
2413 | u8 next; | |
2414 | ||
2415 | if (unlikely(!(qp->qp_access_flags & IB_ACCESS_REMOTE_ATOMIC))) | |
2416 | goto nack_inv; | |
2417 | next = qp->r_head_ack_queue + 1; | |
2418 | if (next > HFI1_MAX_RDMA_ATOMIC) | |
2419 | next = 0; | |
2420 | spin_lock_irqsave(&qp->s_lock, flags); | |
2421 | if (unlikely(next == qp->s_tail_ack_queue)) { | |
2422 | if (!qp->s_ack_queue[next].sent) | |
2423 | goto nack_inv_unlck; | |
2424 | update_ack_queue(qp, next); | |
2425 | } | |
2426 | e = &qp->s_ack_queue[qp->r_head_ack_queue]; | |
2427 | if (e->opcode == OP(RDMA_READ_REQUEST) && e->rdma_sge.mr) { | |
895420dd | 2428 | rvt_put_mr(e->rdma_sge.mr); |
77241056 MM |
2429 | e->rdma_sge.mr = NULL; |
2430 | } | |
2431 | ateth = &ohdr->u.atomic_eth; | |
50e5dcbe | 2432 | vaddr = ((u64)be32_to_cpu(ateth->vaddr[0]) << 32) | |
77241056 MM |
2433 | be32_to_cpu(ateth->vaddr[1]); |
2434 | if (unlikely(vaddr & (sizeof(u64) - 1))) | |
2435 | goto nack_inv_unlck; | |
2436 | rkey = be32_to_cpu(ateth->rkey); | |
2437 | /* Check rkey & NAK */ | |
895420dd DD |
2438 | if (unlikely(!rvt_rkey_ok(qp, &qp->r_sge.sge, sizeof(u64), |
2439 | vaddr, rkey, | |
2440 | IB_ACCESS_REMOTE_ATOMIC))) | |
77241056 MM |
2441 | goto nack_acc_unlck; |
2442 | /* Perform atomic OP and save result. */ | |
50e5dcbe | 2443 | maddr = (atomic64_t *)qp->r_sge.sge.vaddr; |
77241056 MM |
2444 | sdata = be64_to_cpu(ateth->swap_data); |
2445 | e->atomic_data = (opcode == OP(FETCH_ADD)) ? | |
50e5dcbe JJ |
2446 | (u64)atomic64_add_return(sdata, maddr) - sdata : |
2447 | (u64)cmpxchg((u64 *)qp->r_sge.sge.vaddr, | |
77241056 MM |
2448 | be64_to_cpu(ateth->compare_data), |
2449 | sdata); | |
895420dd | 2450 | rvt_put_mr(qp->r_sge.sge.mr); |
77241056 MM |
2451 | qp->r_sge.num_sge = 0; |
2452 | e->opcode = opcode; | |
2453 | e->sent = 0; | |
2454 | e->psn = psn; | |
2455 | e->lpsn = psn; | |
2456 | qp->r_msn++; | |
2457 | qp->r_psn++; | |
2458 | qp->r_state = opcode; | |
2459 | qp->r_nak_state = 0; | |
2460 | qp->r_head_ack_queue = next; | |
2461 | ||
2462 | /* Schedule the send tasklet. */ | |
54d10c1e | 2463 | qp->s_flags |= RVT_S_RESP_PENDING; |
77241056 MM |
2464 | hfi1_schedule_send(qp); |
2465 | ||
2466 | spin_unlock_irqrestore(&qp->s_lock, flags); | |
2467 | if (is_fecn) | |
2468 | goto send_ack; | |
2469 | return; | |
2470 | } | |
2471 | ||
2472 | default: | |
2473 | /* NAK unknown opcodes. */ | |
2474 | goto nack_inv; | |
2475 | } | |
2476 | qp->r_psn++; | |
2477 | qp->r_state = opcode; | |
2478 | qp->r_ack_psn = psn; | |
2479 | qp->r_nak_state = 0; | |
2480 | /* Send an ACK if requested or required. */ | |
7c091e5c | 2481 | if (psn & IB_BTH_REQ_ACK) { |
4c6829c5 DD |
2482 | struct hfi1_qp_priv *priv = qp->priv; |
2483 | ||
7c091e5c MM |
2484 | if (packet->numpkt == 0) { |
2485 | rc_cancel_ack(qp); | |
2486 | goto send_ack; | |
2487 | } | |
4c6829c5 | 2488 | if (priv->r_adefered >= HFI1_PSN_CREDIT) { |
7c091e5c MM |
2489 | rc_cancel_ack(qp); |
2490 | goto send_ack; | |
2491 | } | |
2492 | if (unlikely(is_fecn)) { | |
2493 | rc_cancel_ack(qp); | |
2494 | goto send_ack; | |
2495 | } | |
4c6829c5 | 2496 | priv->r_adefered++; |
7c091e5c MM |
2497 | rc_defered_ack(rcd, qp); |
2498 | } | |
77241056 MM |
2499 | return; |
2500 | ||
2501 | rnr_nak: | |
bf640096 | 2502 | qp->r_nak_state = qp->r_min_rnr_timer | IB_RNR_NAK; |
77241056 MM |
2503 | qp->r_ack_psn = qp->r_psn; |
2504 | /* Queue RNR NAK for later */ | |
2fd36865 | 2505 | rc_defered_ack(rcd, qp); |
77241056 MM |
2506 | return; |
2507 | ||
2508 | nack_op_err: | |
2509 | hfi1_rc_error(qp, IB_WC_LOC_QP_OP_ERR); | |
2510 | qp->r_nak_state = IB_NAK_REMOTE_OPERATIONAL_ERROR; | |
2511 | qp->r_ack_psn = qp->r_psn; | |
2512 | /* Queue NAK for later */ | |
2fd36865 | 2513 | rc_defered_ack(rcd, qp); |
77241056 MM |
2514 | return; |
2515 | ||
2516 | nack_inv_unlck: | |
2517 | spin_unlock_irqrestore(&qp->s_lock, flags); | |
2518 | nack_inv: | |
2519 | hfi1_rc_error(qp, IB_WC_LOC_QP_OP_ERR); | |
2520 | qp->r_nak_state = IB_NAK_INVALID_REQUEST; | |
2521 | qp->r_ack_psn = qp->r_psn; | |
2522 | /* Queue NAK for later */ | |
2fd36865 | 2523 | rc_defered_ack(rcd, qp); |
77241056 MM |
2524 | return; |
2525 | ||
2526 | nack_acc_unlck: | |
2527 | spin_unlock_irqrestore(&qp->s_lock, flags); | |
2528 | nack_acc: | |
2529 | hfi1_rc_error(qp, IB_WC_LOC_PROT_ERR); | |
2530 | qp->r_nak_state = IB_NAK_REMOTE_ACCESS_ERROR; | |
2531 | qp->r_ack_psn = qp->r_psn; | |
2532 | send_ack: | |
2533 | hfi1_send_rc_ack(rcd, qp, is_fecn); | |
2534 | } | |
2535 | ||
2536 | void hfi1_rc_hdrerr( | |
2537 | struct hfi1_ctxtdata *rcd, | |
2538 | struct hfi1_ib_header *hdr, | |
2539 | u32 rcv_flags, | |
895420dd | 2540 | struct rvt_qp *qp) |
77241056 MM |
2541 | { |
2542 | int has_grh = rcv_flags & HFI1_HAS_GRH; | |
2543 | struct hfi1_other_headers *ohdr; | |
2544 | struct hfi1_ibport *ibp = to_iport(qp->ibqp.device, qp->port_num); | |
2545 | int diff; | |
49c32037 | 2546 | u32 opcode; |
977940b8 | 2547 | u32 psn, bth0; |
77241056 MM |
2548 | |
2549 | /* Check for GRH */ | |
2550 | ohdr = &hdr->u.oth; | |
2551 | if (has_grh) | |
2552 | ohdr = &hdr->u.l.oth; | |
2553 | ||
977940b8 AK |
2554 | bth0 = be32_to_cpu(ohdr->bth[0]); |
2555 | if (hfi1_ruc_check_hdr(ibp, hdr, has_grh, qp, bth0)) | |
77241056 MM |
2556 | return; |
2557 | ||
2558 | psn = be32_to_cpu(ohdr->bth[2]); | |
977940b8 | 2559 | opcode = (bth0 >> 24) & 0xff; |
77241056 MM |
2560 | |
2561 | /* Only deal with RDMA Writes for now */ | |
2562 | if (opcode < IB_OPCODE_RC_RDMA_READ_RESPONSE_FIRST) { | |
2563 | diff = delta_psn(psn, qp->r_psn); | |
2564 | if (!qp->r_nak_state && diff >= 0) { | |
4eb06882 | 2565 | ibp->rvp.n_rc_seqnak++; |
77241056 MM |
2566 | qp->r_nak_state = IB_NAK_PSN_ERROR; |
2567 | /* Use the expected PSN. */ | |
2568 | qp->r_ack_psn = qp->r_psn; | |
2569 | /* | |
2570 | * Wait to send the sequence | |
2571 | * NAK until all packets | |
2572 | * in the receive queue have | |
2573 | * been processed. | |
2574 | * Otherwise, we end up | |
2575 | * propagating congestion. | |
2576 | */ | |
2fd36865 | 2577 | rc_defered_ack(rcd, qp); |
77241056 MM |
2578 | } /* Out of sequence NAK */ |
2579 | } /* QP Request NAKs */ | |
2580 | } |