xref: /freebsd/contrib/ofed/libcxgb4/cq.c (revision 87181516ef48be852d5e5fee53c6e0dbfc62f21e)
1d6b92ffaSHans Petter Selasky /*
2d6b92ffaSHans Petter Selasky  * Copyright (c) 2006-2016 Chelsio, Inc. All rights reserved.
3d6b92ffaSHans Petter Selasky  *
4d6b92ffaSHans Petter Selasky  * This software is available to you under a choice of one of two
5d6b92ffaSHans Petter Selasky  * licenses.  You may choose to be licensed under the terms of the GNU
6d6b92ffaSHans Petter Selasky  * General Public License (GPL) Version 2, available from the file
7d6b92ffaSHans Petter Selasky  * COPYING in the main directory of this source tree, or the
8d6b92ffaSHans Petter Selasky  * OpenIB.org BSD license below:
9d6b92ffaSHans Petter Selasky  *
10d6b92ffaSHans Petter Selasky  *     Redistribution and use in source and binary forms, with or
11d6b92ffaSHans Petter Selasky  *     without modification, are permitted provided that the following
12d6b92ffaSHans Petter Selasky  *     conditions are met:
13d6b92ffaSHans Petter Selasky  *
14d6b92ffaSHans Petter Selasky  *      - Redistributions of source code must retain the above
15d6b92ffaSHans Petter Selasky  *        copyright notice, this list of conditions and the following
16d6b92ffaSHans Petter Selasky  *        disclaimer.
17d6b92ffaSHans Petter Selasky  *
18d6b92ffaSHans Petter Selasky  *      - Redistributions in binary form must reproduce the above
19d6b92ffaSHans Petter Selasky  *        copyright notice, this list of conditions and the following
20d6b92ffaSHans Petter Selasky  *        disclaimer in the documentation and/or other materials
21d6b92ffaSHans Petter Selasky  *        provided with the distribution.
22d6b92ffaSHans Petter Selasky  *
23d6b92ffaSHans Petter Selasky  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24d6b92ffaSHans Petter Selasky  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25d6b92ffaSHans Petter Selasky  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26d6b92ffaSHans Petter Selasky  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27d6b92ffaSHans Petter Selasky  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28d6b92ffaSHans Petter Selasky  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29d6b92ffaSHans Petter Selasky  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30d6b92ffaSHans Petter Selasky  * SOFTWARE.
31d6b92ffaSHans Petter Selasky  */
32d6b92ffaSHans Petter Selasky #include <config.h>
33d6b92ffaSHans Petter Selasky 
34d6b92ffaSHans Petter Selasky #include <stdio.h>
35d6b92ffaSHans Petter Selasky #include <syslog.h>
36d6b92ffaSHans Petter Selasky #include <pthread.h>
37d6b92ffaSHans Petter Selasky #include <sys/errno.h>
38d6b92ffaSHans Petter Selasky #include <infiniband/opcode.h>
39d6b92ffaSHans Petter Selasky #include "libcxgb4.h"
40d6b92ffaSHans Petter Selasky #include "cxgb4-abi.h"
41d6b92ffaSHans Petter Selasky 
insert_recv_cqe(struct t4_wq * wq,struct t4_cq * cq)42d6b92ffaSHans Petter Selasky static void insert_recv_cqe(struct t4_wq *wq, struct t4_cq *cq)
43d6b92ffaSHans Petter Selasky {
44d6b92ffaSHans Petter Selasky 	struct t4_cqe cqe;
45d6b92ffaSHans Petter Selasky 
46d6b92ffaSHans Petter Selasky 	PDBG("%s wq %p cq %p sw_cidx %u sw_pidx %u\n", __func__,
47d6b92ffaSHans Petter Selasky 	     wq, cq, cq->sw_cidx, cq->sw_pidx);
48d6b92ffaSHans Petter Selasky 	memset(&cqe, 0, sizeof(cqe));
49d6b92ffaSHans Petter Selasky 	cqe.header = htobe32(V_CQE_STATUS(T4_ERR_SWFLUSH) |
50d6b92ffaSHans Petter Selasky 			         V_CQE_OPCODE(FW_RI_SEND) |
51d6b92ffaSHans Petter Selasky 				 V_CQE_TYPE(0) |
52d6b92ffaSHans Petter Selasky 				 V_CQE_SWCQE(1) |
53d6b92ffaSHans Petter Selasky 				 V_CQE_QPID(wq->sq.qid));
54d6b92ffaSHans Petter Selasky 	cqe.bits_type_ts = htobe64(V_CQE_GENBIT((u64)cq->gen));
55d6b92ffaSHans Petter Selasky 	cq->sw_queue[cq->sw_pidx] = cqe;
56d6b92ffaSHans Petter Selasky 	t4_swcq_produce(cq);
57d6b92ffaSHans Petter Selasky }
58d6b92ffaSHans Petter Selasky 
c4iw_flush_rq(struct t4_wq * wq,struct t4_cq * cq,int count)59d6b92ffaSHans Petter Selasky int c4iw_flush_rq(struct t4_wq *wq, struct t4_cq *cq, int count)
60d6b92ffaSHans Petter Selasky {
61d6b92ffaSHans Petter Selasky 	int flushed = 0;
62d6b92ffaSHans Petter Selasky 	int in_use = wq->rq.in_use - count;
63d6b92ffaSHans Petter Selasky 
64d6b92ffaSHans Petter Selasky 	BUG_ON(in_use < 0);
65d6b92ffaSHans Petter Selasky 	PDBG("%s wq %p cq %p rq.in_use %u skip count %u\n", __func__,
66d6b92ffaSHans Petter Selasky 	     wq, cq, wq->rq.in_use, count);
67d6b92ffaSHans Petter Selasky 	while (in_use--) {
68d6b92ffaSHans Petter Selasky 		insert_recv_cqe(wq, cq);
69d6b92ffaSHans Petter Selasky 		flushed++;
70d6b92ffaSHans Petter Selasky 	}
71d6b92ffaSHans Petter Selasky 	return flushed;
72d6b92ffaSHans Petter Selasky }
73d6b92ffaSHans Petter Selasky 
insert_sq_cqe(struct t4_wq * wq,struct t4_cq * cq,struct t4_swsqe * swcqe)74d6b92ffaSHans Petter Selasky static void insert_sq_cqe(struct t4_wq *wq, struct t4_cq *cq,
75d6b92ffaSHans Petter Selasky 		          struct t4_swsqe *swcqe)
76d6b92ffaSHans Petter Selasky {
77d6b92ffaSHans Petter Selasky 	struct t4_cqe cqe;
78d6b92ffaSHans Petter Selasky 
79d6b92ffaSHans Petter Selasky 	PDBG("%s wq %p cq %p sw_cidx %u sw_pidx %u\n", __func__,
80d6b92ffaSHans Petter Selasky 	     wq, cq, cq->sw_cidx, cq->sw_pidx);
81d6b92ffaSHans Petter Selasky 	memset(&cqe, 0, sizeof(cqe));
82d6b92ffaSHans Petter Selasky 	cqe.header = htobe32(V_CQE_STATUS(T4_ERR_SWFLUSH) |
83d6b92ffaSHans Petter Selasky 			         V_CQE_OPCODE(swcqe->opcode) |
84d6b92ffaSHans Petter Selasky 			         V_CQE_TYPE(1) |
85d6b92ffaSHans Petter Selasky 			         V_CQE_SWCQE(1) |
86d6b92ffaSHans Petter Selasky 			         V_CQE_QPID(wq->sq.qid));
87d6b92ffaSHans Petter Selasky 	CQE_WRID_SQ_IDX(&cqe) = swcqe->idx;
88d6b92ffaSHans Petter Selasky 	cqe.bits_type_ts = htobe64(V_CQE_GENBIT((u64)cq->gen));
89d6b92ffaSHans Petter Selasky 	cq->sw_queue[cq->sw_pidx] = cqe;
90d6b92ffaSHans Petter Selasky 	t4_swcq_produce(cq);
91d6b92ffaSHans Petter Selasky }
92d6b92ffaSHans Petter Selasky 
93d6b92ffaSHans Petter Selasky static void advance_oldest_read(struct t4_wq *wq);
94d6b92ffaSHans Petter Selasky 
c4iw_flush_sq(struct c4iw_qp * qhp)95d6b92ffaSHans Petter Selasky void c4iw_flush_sq(struct c4iw_qp *qhp)
96d6b92ffaSHans Petter Selasky {
97d6b92ffaSHans Petter Selasky 	unsigned short flushed = 0;
98d6b92ffaSHans Petter Selasky 	struct t4_wq *wq = &qhp->wq;
99d6b92ffaSHans Petter Selasky 	struct c4iw_cq *chp = to_c4iw_cq(qhp->ibv_qp.send_cq);
100d6b92ffaSHans Petter Selasky 	struct t4_cq *cq = &chp->cq;
101d6b92ffaSHans Petter Selasky 	int idx;
102d6b92ffaSHans Petter Selasky 	struct t4_swsqe *swsqe;
103d6b92ffaSHans Petter Selasky 
104d6b92ffaSHans Petter Selasky 	if (wq->sq.flush_cidx == -1)
105d6b92ffaSHans Petter Selasky 		wq->sq.flush_cidx = wq->sq.cidx;
106d6b92ffaSHans Petter Selasky 	idx = wq->sq.flush_cidx;
107d6b92ffaSHans Petter Selasky 	BUG_ON(idx >= wq->sq.size);
108d6b92ffaSHans Petter Selasky 	while (idx != wq->sq.pidx) {
109d6b92ffaSHans Petter Selasky 		swsqe = &wq->sq.sw_sq[idx];
110d6b92ffaSHans Petter Selasky 		BUG_ON(swsqe->flushed);
111d6b92ffaSHans Petter Selasky 		swsqe->flushed = 1;
112d6b92ffaSHans Petter Selasky 		insert_sq_cqe(wq, cq, swsqe);
113d6b92ffaSHans Petter Selasky 		if (wq->sq.oldest_read == swsqe) {
114d6b92ffaSHans Petter Selasky 			BUG_ON(swsqe->opcode != FW_RI_READ_REQ);
115d6b92ffaSHans Petter Selasky 			advance_oldest_read(wq);
116d6b92ffaSHans Petter Selasky 		}
117d6b92ffaSHans Petter Selasky 		flushed++;
118d6b92ffaSHans Petter Selasky 		if (++idx == wq->sq.size)
119d6b92ffaSHans Petter Selasky 			idx = 0;
120d6b92ffaSHans Petter Selasky 	}
121d6b92ffaSHans Petter Selasky 	wq->sq.flush_cidx += flushed;
122d6b92ffaSHans Petter Selasky 	if (wq->sq.flush_cidx >= wq->sq.size)
123d6b92ffaSHans Petter Selasky 		wq->sq.flush_cidx -= wq->sq.size;
124d6b92ffaSHans Petter Selasky }
125d6b92ffaSHans Petter Selasky 
flush_completed_wrs(struct t4_wq * wq,struct t4_cq * cq)126d6b92ffaSHans Petter Selasky static void flush_completed_wrs(struct t4_wq *wq, struct t4_cq *cq)
127d6b92ffaSHans Petter Selasky {
128d6b92ffaSHans Petter Selasky 	struct t4_swsqe *swsqe;
129d6b92ffaSHans Petter Selasky 	unsigned short cidx;
130d6b92ffaSHans Petter Selasky 
131d6b92ffaSHans Petter Selasky 	if (wq->sq.flush_cidx == -1)
132d6b92ffaSHans Petter Selasky 		wq->sq.flush_cidx = wq->sq.cidx;
133d6b92ffaSHans Petter Selasky 	cidx = wq->sq.flush_cidx;
134d6b92ffaSHans Petter Selasky 	BUG_ON(cidx >= wq->sq.size);
135d6b92ffaSHans Petter Selasky 
136d6b92ffaSHans Petter Selasky 	while (cidx != wq->sq.pidx) {
137d6b92ffaSHans Petter Selasky 		swsqe = &wq->sq.sw_sq[cidx];
138d6b92ffaSHans Petter Selasky 		if (!swsqe->signaled) {
139d6b92ffaSHans Petter Selasky 			if (++cidx == wq->sq.size)
140d6b92ffaSHans Petter Selasky 				cidx = 0;
141d6b92ffaSHans Petter Selasky 		} else if (swsqe->complete) {
142d6b92ffaSHans Petter Selasky 
143d6b92ffaSHans Petter Selasky 			BUG_ON(swsqe->flushed);
144d6b92ffaSHans Petter Selasky 
145d6b92ffaSHans Petter Selasky 			/*
146d6b92ffaSHans Petter Selasky 			 * Insert this completed cqe into the swcq.
147d6b92ffaSHans Petter Selasky 			 */
148d6b92ffaSHans Petter Selasky 			PDBG("%s moving cqe into swcq sq idx %u cq idx %u\n",
149d6b92ffaSHans Petter Selasky 			     __func__, cidx, cq->sw_pidx);
150d6b92ffaSHans Petter Selasky 
151d6b92ffaSHans Petter Selasky 			swsqe->cqe.header |= htobe32(V_CQE_SWCQE(1));
152d6b92ffaSHans Petter Selasky 			cq->sw_queue[cq->sw_pidx] = swsqe->cqe;
153d6b92ffaSHans Petter Selasky 			t4_swcq_produce(cq);
154d6b92ffaSHans Petter Selasky 			swsqe->flushed = 1;
155d6b92ffaSHans Petter Selasky 			if (++cidx == wq->sq.size)
156d6b92ffaSHans Petter Selasky 				cidx = 0;
157d6b92ffaSHans Petter Selasky 			wq->sq.flush_cidx = cidx;
158d6b92ffaSHans Petter Selasky 		} else
159d6b92ffaSHans Petter Selasky 			break;
160d6b92ffaSHans Petter Selasky 	}
161d6b92ffaSHans Petter Selasky }
162d6b92ffaSHans Petter Selasky 
create_read_req_cqe(struct t4_wq * wq,struct t4_cqe * hw_cqe,struct t4_cqe * read_cqe)163d6b92ffaSHans Petter Selasky static void create_read_req_cqe(struct t4_wq *wq, struct t4_cqe *hw_cqe,
164d6b92ffaSHans Petter Selasky 				struct t4_cqe *read_cqe)
165d6b92ffaSHans Petter Selasky {
166d6b92ffaSHans Petter Selasky 	read_cqe->u.scqe.cidx = wq->sq.oldest_read->idx;
167d6b92ffaSHans Petter Selasky 	read_cqe->len = be32toh(wq->sq.oldest_read->read_len);
168d6b92ffaSHans Petter Selasky 	read_cqe->header = htobe32(V_CQE_QPID(CQE_QPID(hw_cqe)) |
169d6b92ffaSHans Petter Selasky 				 V_CQE_SWCQE(SW_CQE(hw_cqe)) |
170d6b92ffaSHans Petter Selasky 				 V_CQE_OPCODE(FW_RI_READ_REQ) |
171d6b92ffaSHans Petter Selasky 				 V_CQE_TYPE(1));
172d6b92ffaSHans Petter Selasky 	read_cqe->bits_type_ts = hw_cqe->bits_type_ts;
173d6b92ffaSHans Petter Selasky }
174d6b92ffaSHans Petter Selasky 
advance_oldest_read(struct t4_wq * wq)175d6b92ffaSHans Petter Selasky static void advance_oldest_read(struct t4_wq *wq)
176d6b92ffaSHans Petter Selasky {
177d6b92ffaSHans Petter Selasky 
178d6b92ffaSHans Petter Selasky 	u32 rptr = wq->sq.oldest_read - wq->sq.sw_sq + 1;
179d6b92ffaSHans Petter Selasky 
180d6b92ffaSHans Petter Selasky 	if (rptr == wq->sq.size)
181d6b92ffaSHans Petter Selasky 		rptr = 0;
182d6b92ffaSHans Petter Selasky 	while (rptr != wq->sq.pidx) {
183d6b92ffaSHans Petter Selasky 		wq->sq.oldest_read = &wq->sq.sw_sq[rptr];
184d6b92ffaSHans Petter Selasky 
185d6b92ffaSHans Petter Selasky 		if (wq->sq.oldest_read->opcode == FW_RI_READ_REQ)
186d6b92ffaSHans Petter Selasky 			return;
187d6b92ffaSHans Petter Selasky 		if (++rptr == wq->sq.size)
188d6b92ffaSHans Petter Selasky 			rptr = 0;
189d6b92ffaSHans Petter Selasky 	}
190d6b92ffaSHans Petter Selasky 	wq->sq.oldest_read = NULL;
191d6b92ffaSHans Petter Selasky }
192d6b92ffaSHans Petter Selasky 
193d6b92ffaSHans Petter Selasky /*
194d6b92ffaSHans Petter Selasky  * Move all CQEs from the HWCQ into the SWCQ.
195d6b92ffaSHans Petter Selasky  * Deal with out-of-order and/or completions that complete
196d6b92ffaSHans Petter Selasky  * prior unsignalled WRs.
197d6b92ffaSHans Petter Selasky  */
c4iw_flush_hw_cq(struct c4iw_cq * chp)198d6b92ffaSHans Petter Selasky void c4iw_flush_hw_cq(struct c4iw_cq *chp)
199d6b92ffaSHans Petter Selasky {
200d6b92ffaSHans Petter Selasky 	struct t4_cqe *hw_cqe, *swcqe, read_cqe;
201d6b92ffaSHans Petter Selasky 	struct c4iw_qp *qhp;
202d6b92ffaSHans Petter Selasky 	struct t4_swsqe *swsqe;
203d6b92ffaSHans Petter Selasky 	int ret;
204d6b92ffaSHans Petter Selasky 
205d6b92ffaSHans Petter Selasky 	PDBG("%s  cqid 0x%x\n", __func__, chp->cq.cqid);
206d6b92ffaSHans Petter Selasky 	ret = t4_next_hw_cqe(&chp->cq, &hw_cqe);
207d6b92ffaSHans Petter Selasky 
208d6b92ffaSHans Petter Selasky 	/*
209d6b92ffaSHans Petter Selasky 	 * This logic is similar to poll_cq(), but not quite the same
210d6b92ffaSHans Petter Selasky 	 * unfortunately.  Need to move pertinent HW CQEs to the SW CQ but
211d6b92ffaSHans Petter Selasky 	 * also do any translation magic that poll_cq() normally does.
212d6b92ffaSHans Petter Selasky 	 */
213d6b92ffaSHans Petter Selasky 	while (!ret) {
214d6b92ffaSHans Petter Selasky 		qhp = get_qhp(chp->rhp, CQE_QPID(hw_cqe));
215d6b92ffaSHans Petter Selasky 
216d6b92ffaSHans Petter Selasky 		/*
217d6b92ffaSHans Petter Selasky 		 * drop CQEs with no associated QP
218d6b92ffaSHans Petter Selasky 		 */
219d6b92ffaSHans Petter Selasky 		if (qhp == NULL)
220d6b92ffaSHans Petter Selasky 			goto next_cqe;
221d6b92ffaSHans Petter Selasky 
222d6b92ffaSHans Petter Selasky 		if (CQE_OPCODE(hw_cqe) == FW_RI_TERMINATE)
223d6b92ffaSHans Petter Selasky 			goto next_cqe;
224d6b92ffaSHans Petter Selasky 
225d6b92ffaSHans Petter Selasky 		if (CQE_OPCODE(hw_cqe) == FW_RI_READ_RESP) {
226d6b92ffaSHans Petter Selasky 
227d6b92ffaSHans Petter Selasky 			/*
228d6b92ffaSHans Petter Selasky 			 * If we have reached here because of async
229d6b92ffaSHans Petter Selasky 			 * event or other error, and have egress error
230d6b92ffaSHans Petter Selasky 			 * then drop
231d6b92ffaSHans Petter Selasky 			 */
232d6b92ffaSHans Petter Selasky 			if (CQE_TYPE(hw_cqe) == 1) {
233d6b92ffaSHans Petter Selasky 				syslog(LOG_CRIT, "%s: got egress error in \
234d6b92ffaSHans Petter Selasky 					read-response, dropping!\n", __func__);
235d6b92ffaSHans Petter Selasky 				goto next_cqe;
236d6b92ffaSHans Petter Selasky 			}
237d6b92ffaSHans Petter Selasky 
238d6b92ffaSHans Petter Selasky 			/*
239d6b92ffaSHans Petter Selasky 			 * drop peer2peer RTR reads.
240d6b92ffaSHans Petter Selasky 			 */
241d6b92ffaSHans Petter Selasky 			if (CQE_WRID_STAG(hw_cqe) == 1)
242d6b92ffaSHans Petter Selasky 				goto next_cqe;
243d6b92ffaSHans Petter Selasky 
244d6b92ffaSHans Petter Selasky 			/*
245d6b92ffaSHans Petter Selasky 			 * Eat completions for unsignaled read WRs.
246d6b92ffaSHans Petter Selasky 			 */
247d6b92ffaSHans Petter Selasky 			if (!qhp->wq.sq.oldest_read->signaled) {
248d6b92ffaSHans Petter Selasky 				advance_oldest_read(&qhp->wq);
249d6b92ffaSHans Petter Selasky 				goto next_cqe;
250d6b92ffaSHans Petter Selasky 			}
251d6b92ffaSHans Petter Selasky 
252d6b92ffaSHans Petter Selasky 			/*
253d6b92ffaSHans Petter Selasky 			 * Don't write to the HWCQ, create a new read req CQE
254d6b92ffaSHans Petter Selasky 			 * in local memory and move it into the swcq.
255d6b92ffaSHans Petter Selasky 			 */
256d6b92ffaSHans Petter Selasky 			create_read_req_cqe(&qhp->wq, hw_cqe, &read_cqe);
257d6b92ffaSHans Petter Selasky 			hw_cqe = &read_cqe;
258d6b92ffaSHans Petter Selasky 			advance_oldest_read(&qhp->wq);
259d6b92ffaSHans Petter Selasky 		}
260d6b92ffaSHans Petter Selasky 
261d6b92ffaSHans Petter Selasky 		/* if its a SQ completion, then do the magic to move all the
262d6b92ffaSHans Petter Selasky 		 * unsignaled and now in-order completions into the swcq.
263d6b92ffaSHans Petter Selasky 		 */
264d6b92ffaSHans Petter Selasky 		if (SQ_TYPE(hw_cqe)) {
265d6b92ffaSHans Petter Selasky 			int idx = CQE_WRID_SQ_IDX(hw_cqe);
266d6b92ffaSHans Petter Selasky 
267d6b92ffaSHans Petter Selasky 			BUG_ON(idx >= qhp->wq.sq.size);
268d6b92ffaSHans Petter Selasky 			swsqe = &qhp->wq.sq.sw_sq[idx];
269d6b92ffaSHans Petter Selasky 			swsqe->cqe = *hw_cqe;
270d6b92ffaSHans Petter Selasky 			swsqe->complete = 1;
271d6b92ffaSHans Petter Selasky 			flush_completed_wrs(&qhp->wq, &chp->cq);
272d6b92ffaSHans Petter Selasky 		} else {
273d6b92ffaSHans Petter Selasky 			swcqe = &chp->cq.sw_queue[chp->cq.sw_pidx];
274d6b92ffaSHans Petter Selasky 			*swcqe = *hw_cqe;
275d6b92ffaSHans Petter Selasky 			swcqe->header |= htobe32(V_CQE_SWCQE(1));
276d6b92ffaSHans Petter Selasky 			t4_swcq_produce(&chp->cq);
277d6b92ffaSHans Petter Selasky 		}
278d6b92ffaSHans Petter Selasky next_cqe:
279d6b92ffaSHans Petter Selasky 		t4_hwcq_consume(&chp->cq);
280d6b92ffaSHans Petter Selasky 		ret = t4_next_hw_cqe(&chp->cq, &hw_cqe);
281d6b92ffaSHans Petter Selasky 	}
282d6b92ffaSHans Petter Selasky }
283d6b92ffaSHans Petter Selasky 
cqe_completes_wr(struct t4_cqe * cqe,struct t4_wq * wq)284d6b92ffaSHans Petter Selasky static int cqe_completes_wr(struct t4_cqe *cqe, struct t4_wq *wq)
285d6b92ffaSHans Petter Selasky {
286d6b92ffaSHans Petter Selasky 	if (CQE_OPCODE(cqe) == FW_RI_TERMINATE)
287d6b92ffaSHans Petter Selasky 		return 0;
288d6b92ffaSHans Petter Selasky 
289d6b92ffaSHans Petter Selasky 	if ((CQE_OPCODE(cqe) == FW_RI_RDMA_WRITE) && RQ_TYPE(cqe))
290d6b92ffaSHans Petter Selasky 		return 0;
291d6b92ffaSHans Petter Selasky 
292d6b92ffaSHans Petter Selasky 	if ((CQE_OPCODE(cqe) == FW_RI_READ_RESP) && SQ_TYPE(cqe))
293d6b92ffaSHans Petter Selasky 		return 0;
294d6b92ffaSHans Petter Selasky 
295d6b92ffaSHans Petter Selasky 	if (CQE_SEND_OPCODE(cqe) && RQ_TYPE(cqe) && t4_rq_empty(wq))
296d6b92ffaSHans Petter Selasky 		return 0;
297d6b92ffaSHans Petter Selasky 	return 1;
298d6b92ffaSHans Petter Selasky }
299d6b92ffaSHans Petter Selasky 
c4iw_count_rcqes(struct t4_cq * cq,struct t4_wq * wq,int * count)300d6b92ffaSHans Petter Selasky void c4iw_count_rcqes(struct t4_cq *cq, struct t4_wq *wq, int *count)
301d6b92ffaSHans Petter Selasky {
302d6b92ffaSHans Petter Selasky 	struct t4_cqe *cqe;
303d6b92ffaSHans Petter Selasky 	u32 ptr;
304d6b92ffaSHans Petter Selasky 
305d6b92ffaSHans Petter Selasky 	*count = 0;
306d6b92ffaSHans Petter Selasky 	ptr = cq->sw_cidx;
307d6b92ffaSHans Petter Selasky 	BUG_ON(ptr >= cq->size);
308d6b92ffaSHans Petter Selasky 	while (ptr != cq->sw_pidx) {
309d6b92ffaSHans Petter Selasky 		cqe = &cq->sw_queue[ptr];
310d6b92ffaSHans Petter Selasky 		if (RQ_TYPE(cqe) && (CQE_OPCODE(cqe) != FW_RI_READ_RESP) &&
311d6b92ffaSHans Petter Selasky 		    (CQE_QPID(cqe) == wq->sq.qid) && cqe_completes_wr(cqe, wq))
312d6b92ffaSHans Petter Selasky 			(*count)++;
313d6b92ffaSHans Petter Selasky 		if (++ptr == cq->size)
314d6b92ffaSHans Petter Selasky 			ptr = 0;
315d6b92ffaSHans Petter Selasky 	}
316d6b92ffaSHans Petter Selasky 	PDBG("%s cq %p count %d\n", __func__, cq, *count);
317d6b92ffaSHans Petter Selasky }
318d6b92ffaSHans Petter Selasky 
dump_cqe(void * arg)319d6b92ffaSHans Petter Selasky static void dump_cqe(void *arg)
320d6b92ffaSHans Petter Selasky {
321d6b92ffaSHans Petter Selasky 	u64 *p = arg;
322d6b92ffaSHans Petter Selasky 	syslog(LOG_NOTICE, "cxgb4 err cqe %016llx %016llx %016llx %016llx\n",
323d6b92ffaSHans Petter Selasky 	       (long long)be64toh(p[0]),
324d6b92ffaSHans Petter Selasky 	       (long long)be64toh(p[1]),
325d6b92ffaSHans Petter Selasky 	       (long long)be64toh(p[2]),
326d6b92ffaSHans Petter Selasky 	       (long long)be64toh(p[3]));
327d6b92ffaSHans Petter Selasky }
328d6b92ffaSHans Petter Selasky 
329d6b92ffaSHans Petter Selasky /*
330d6b92ffaSHans Petter Selasky  * poll_cq
331d6b92ffaSHans Petter Selasky  *
332d6b92ffaSHans Petter Selasky  * Caller must:
333d6b92ffaSHans Petter Selasky  *     check the validity of the first CQE,
334d6b92ffaSHans Petter Selasky  *     supply the wq assicated with the qpid.
335d6b92ffaSHans Petter Selasky  *
336d6b92ffaSHans Petter Selasky  * credit: cq credit to return to sge.
337d6b92ffaSHans Petter Selasky  * cqe_flushed: 1 iff the CQE is flushed.
338d6b92ffaSHans Petter Selasky  * cqe: copy of the polled CQE.
339d6b92ffaSHans Petter Selasky  *
340d6b92ffaSHans Petter Selasky  * return value:
341d6b92ffaSHans Petter Selasky  *    0		    CQE returned ok.
342d6b92ffaSHans Petter Selasky  *    -EAGAIN       CQE skipped, try again.
343d6b92ffaSHans Petter Selasky  *    -EOVERFLOW    CQ overflow detected.
344d6b92ffaSHans Petter Selasky  */
poll_cq(struct t4_wq * wq,struct t4_cq * cq,struct t4_cqe * cqe,u8 * cqe_flushed,u64 * cookie,u32 * credit)345d6b92ffaSHans Petter Selasky static int poll_cq(struct t4_wq *wq, struct t4_cq *cq, struct t4_cqe *cqe,
346d6b92ffaSHans Petter Selasky 	           u8 *cqe_flushed, u64 *cookie, u32 *credit)
347d6b92ffaSHans Petter Selasky {
348d6b92ffaSHans Petter Selasky 	int ret = 0;
349d6b92ffaSHans Petter Selasky 	struct t4_cqe *hw_cqe, read_cqe;
350d6b92ffaSHans Petter Selasky 
351d6b92ffaSHans Petter Selasky 	*cqe_flushed = 0;
352d6b92ffaSHans Petter Selasky 	*credit = 0;
353d6b92ffaSHans Petter Selasky 
354d6b92ffaSHans Petter Selasky 	ret = t4_next_cqe(cq, &hw_cqe);
355d6b92ffaSHans Petter Selasky 	if (ret)
356d6b92ffaSHans Petter Selasky 		return ret;
357d6b92ffaSHans Petter Selasky 
358d6b92ffaSHans Petter Selasky 	PDBG("%s CQE OVF %u qpid 0x%0x genbit %u type %u status 0x%0x"
359d6b92ffaSHans Petter Selasky 	     " opcode 0x%0x len 0x%0x wrid_hi_stag 0x%x wrid_low_msn 0x%x\n",
360d6b92ffaSHans Petter Selasky 	     __func__, CQE_OVFBIT(hw_cqe), CQE_QPID(hw_cqe),
361d6b92ffaSHans Petter Selasky 	     CQE_GENBIT(hw_cqe), CQE_TYPE(hw_cqe), CQE_STATUS(hw_cqe),
362d6b92ffaSHans Petter Selasky 	     CQE_OPCODE(hw_cqe), CQE_LEN(hw_cqe), CQE_WRID_HI(hw_cqe),
363d6b92ffaSHans Petter Selasky 	     CQE_WRID_LOW(hw_cqe));
364d6b92ffaSHans Petter Selasky 
365d6b92ffaSHans Petter Selasky 	/*
366d6b92ffaSHans Petter Selasky 	 * skip cqe's not affiliated with a QP.
367d6b92ffaSHans Petter Selasky 	 */
368d6b92ffaSHans Petter Selasky 	if (wq == NULL) {
369d6b92ffaSHans Petter Selasky 		ret = -EAGAIN;
370d6b92ffaSHans Petter Selasky 		goto skip_cqe;
371d6b92ffaSHans Petter Selasky 	}
372d6b92ffaSHans Petter Selasky 
373d6b92ffaSHans Petter Selasky 	/*
374d6b92ffaSHans Petter Selasky 	 * Gotta tweak READ completions:
375d6b92ffaSHans Petter Selasky 	 *	1) the cqe doesn't contain the sq_wptr from the wr.
376d6b92ffaSHans Petter Selasky 	 *	2) opcode not reflected from the wr.
377d6b92ffaSHans Petter Selasky 	 *	3) read_len not reflected from the wr.
378d6b92ffaSHans Petter Selasky 	 *	4) T4 HW (for now) inserts target read response failures which
379d6b92ffaSHans Petter Selasky 	 * 	   need to be skipped.
380d6b92ffaSHans Petter Selasky 	 */
381d6b92ffaSHans Petter Selasky 	if (CQE_OPCODE(hw_cqe) == FW_RI_READ_RESP) {
382d6b92ffaSHans Petter Selasky 
383d6b92ffaSHans Petter Selasky 		/*
384d6b92ffaSHans Petter Selasky 		 * If we have reached here because of async
385d6b92ffaSHans Petter Selasky 		 * event or other error, and have egress error
386d6b92ffaSHans Petter Selasky 		 * then drop
387d6b92ffaSHans Petter Selasky 		 */
388d6b92ffaSHans Petter Selasky 		if (CQE_TYPE(hw_cqe) == 1) {
389d6b92ffaSHans Petter Selasky 			syslog(LOG_CRIT, "%s: got egress error in \
390d6b92ffaSHans Petter Selasky 				read-response, dropping!\n", __func__);
391d6b92ffaSHans Petter Selasky 			if (CQE_STATUS(hw_cqe))
392d6b92ffaSHans Petter Selasky 				t4_set_wq_in_error(wq);
393d6b92ffaSHans Petter Selasky 			ret = -EAGAIN;
394d6b92ffaSHans Petter Selasky 			goto skip_cqe;
395d6b92ffaSHans Petter Selasky 		}
396d6b92ffaSHans Petter Selasky 
397d6b92ffaSHans Petter Selasky 		/*
398d6b92ffaSHans Petter Selasky 		 * If this is an unsolicited read response, then the read
399d6b92ffaSHans Petter Selasky 		 * was generated by the kernel driver as part of peer-2-peer
400d6b92ffaSHans Petter Selasky 		 * connection setup, or a target read response failure.
401d6b92ffaSHans Petter Selasky 		 * So skip the completion.
402d6b92ffaSHans Petter Selasky 		 */
403d6b92ffaSHans Petter Selasky 		if (CQE_WRID_STAG(hw_cqe) == 1) {
404d6b92ffaSHans Petter Selasky 			if (CQE_STATUS(hw_cqe))
405d6b92ffaSHans Petter Selasky 				t4_set_wq_in_error(wq);
406d6b92ffaSHans Petter Selasky 			ret = -EAGAIN;
407d6b92ffaSHans Petter Selasky 			goto skip_cqe;
408d6b92ffaSHans Petter Selasky 		}
409d6b92ffaSHans Petter Selasky 
410d6b92ffaSHans Petter Selasky 		/*
411d6b92ffaSHans Petter Selasky 		 * Eat completions for unsignaled read WRs.
412d6b92ffaSHans Petter Selasky 		 */
413d6b92ffaSHans Petter Selasky 		if (!wq->sq.oldest_read->signaled) {
414d6b92ffaSHans Petter Selasky 			advance_oldest_read(wq);
415d6b92ffaSHans Petter Selasky 			ret = -EAGAIN;
416d6b92ffaSHans Petter Selasky 			goto skip_cqe;
417d6b92ffaSHans Petter Selasky 		}
418d6b92ffaSHans Petter Selasky 
419d6b92ffaSHans Petter Selasky 		/*
420d6b92ffaSHans Petter Selasky 		 * Don't write to the HWCQ, so create a new read req CQE
421d6b92ffaSHans Petter Selasky 		 * in local memory.
422d6b92ffaSHans Petter Selasky 		 */
423d6b92ffaSHans Petter Selasky 		create_read_req_cqe(wq, hw_cqe, &read_cqe);
424d6b92ffaSHans Petter Selasky 		hw_cqe = &read_cqe;
425d6b92ffaSHans Petter Selasky 		advance_oldest_read(wq);
426d6b92ffaSHans Petter Selasky 	}
427d6b92ffaSHans Petter Selasky 
428d6b92ffaSHans Petter Selasky 	if (CQE_OPCODE(hw_cqe) == FW_RI_TERMINATE) {
429d6b92ffaSHans Petter Selasky 		ret = -EAGAIN;
430d6b92ffaSHans Petter Selasky 		goto skip_cqe;
431d6b92ffaSHans Petter Selasky 	}
432d6b92ffaSHans Petter Selasky 
433d6b92ffaSHans Petter Selasky 	if (CQE_STATUS(hw_cqe) || t4_wq_in_error(wq)) {
434d6b92ffaSHans Petter Selasky 		*cqe_flushed = (CQE_STATUS(hw_cqe) == T4_ERR_SWFLUSH);
435d6b92ffaSHans Petter Selasky 		wq->error = 1;
436d6b92ffaSHans Petter Selasky 
437d6b92ffaSHans Petter Selasky 		if (!*cqe_flushed && CQE_STATUS(hw_cqe))
438d6b92ffaSHans Petter Selasky 			dump_cqe(hw_cqe);
439d6b92ffaSHans Petter Selasky 
440*5c2bacdeSNavdeep Parhar 		BUG_ON((cqe_flushed == 0) && !SW_CQE(hw_cqe));
441d6b92ffaSHans Petter Selasky 		goto proc_cqe;
442d6b92ffaSHans Petter Selasky 	}
443d6b92ffaSHans Petter Selasky 
444d6b92ffaSHans Petter Selasky 	/*
445d6b92ffaSHans Petter Selasky 	 * RECV completion.
446d6b92ffaSHans Petter Selasky 	 */
447d6b92ffaSHans Petter Selasky 	if (RQ_TYPE(hw_cqe)) {
448d6b92ffaSHans Petter Selasky 
449d6b92ffaSHans Petter Selasky 		/*
450d6b92ffaSHans Petter Selasky 		 * HW only validates 4 bits of MSN.  So we must validate that
451d6b92ffaSHans Petter Selasky 		 * the MSN in the SEND is the next expected MSN.  If its not,
452d6b92ffaSHans Petter Selasky 		 * then we complete this with T4_ERR_MSN and mark the wq in
453d6b92ffaSHans Petter Selasky 		 * error.
454d6b92ffaSHans Petter Selasky 		 */
455d6b92ffaSHans Petter Selasky 
456d6b92ffaSHans Petter Selasky 		if (t4_rq_empty(wq)) {
457d6b92ffaSHans Petter Selasky 			t4_set_wq_in_error(wq);
458d6b92ffaSHans Petter Selasky 			ret = -EAGAIN;
459d6b92ffaSHans Petter Selasky 			goto skip_cqe;
460d6b92ffaSHans Petter Selasky 		}
461d6b92ffaSHans Petter Selasky 		if (unlikely((CQE_WRID_MSN(hw_cqe) != (wq->rq.msn)))) {
462d6b92ffaSHans Petter Selasky 			t4_set_wq_in_error(wq);
463d6b92ffaSHans Petter Selasky 			hw_cqe->header |= htobe32(V_CQE_STATUS(T4_ERR_MSN));
464d6b92ffaSHans Petter Selasky 			goto proc_cqe;
465d6b92ffaSHans Petter Selasky 		}
466d6b92ffaSHans Petter Selasky 		goto proc_cqe;
467d6b92ffaSHans Petter Selasky 	}
468d6b92ffaSHans Petter Selasky 
469d6b92ffaSHans Petter Selasky 	/*
470d6b92ffaSHans Petter Selasky 	 * If we get here its a send completion.
471d6b92ffaSHans Petter Selasky 	 *
472d6b92ffaSHans Petter Selasky 	 * Handle out of order completion. These get stuffed
473d6b92ffaSHans Petter Selasky 	 * in the SW SQ. Then the SW SQ is walked to move any
474d6b92ffaSHans Petter Selasky 	 * now in-order completions into the SW CQ.  This handles
475d6b92ffaSHans Petter Selasky 	 * 2 cases:
476d6b92ffaSHans Petter Selasky 	 *	1) reaping unsignaled WRs when the first subsequent
477d6b92ffaSHans Petter Selasky 	 *	   signaled WR is completed.
478d6b92ffaSHans Petter Selasky 	 *	2) out of order read completions.
479d6b92ffaSHans Petter Selasky 	 */
480d6b92ffaSHans Petter Selasky 	if (!SW_CQE(hw_cqe) && (CQE_WRID_SQ_IDX(hw_cqe) != wq->sq.cidx)) {
481d6b92ffaSHans Petter Selasky 		struct t4_swsqe *swsqe;
482d6b92ffaSHans Petter Selasky 		int idx =  CQE_WRID_SQ_IDX(hw_cqe);
483d6b92ffaSHans Petter Selasky 
484d6b92ffaSHans Petter Selasky 		PDBG("%s out of order completion going in sw_sq at idx %u\n",
485d6b92ffaSHans Petter Selasky 		     __func__, idx);
486d6b92ffaSHans Petter Selasky 		BUG_ON(idx >= wq->sq.size);
487d6b92ffaSHans Petter Selasky 		swsqe = &wq->sq.sw_sq[idx];
488d6b92ffaSHans Petter Selasky 		swsqe->cqe = *hw_cqe;
489d6b92ffaSHans Petter Selasky 		swsqe->complete = 1;
490d6b92ffaSHans Petter Selasky 		ret = -EAGAIN;
491d6b92ffaSHans Petter Selasky 		goto flush_wq;
492d6b92ffaSHans Petter Selasky 	}
493d6b92ffaSHans Petter Selasky 
494d6b92ffaSHans Petter Selasky proc_cqe:
495d6b92ffaSHans Petter Selasky 	*cqe = *hw_cqe;
496d6b92ffaSHans Petter Selasky 
497d6b92ffaSHans Petter Selasky 	/*
498d6b92ffaSHans Petter Selasky 	 * Reap the associated WR(s) that are freed up with this
499d6b92ffaSHans Petter Selasky 	 * completion.
500d6b92ffaSHans Petter Selasky 	 */
501d6b92ffaSHans Petter Selasky 	if (SQ_TYPE(hw_cqe)) {
502d6b92ffaSHans Petter Selasky 		int idx = CQE_WRID_SQ_IDX(hw_cqe);
503d6b92ffaSHans Petter Selasky 		BUG_ON(idx >= wq->sq.size);
504d6b92ffaSHans Petter Selasky 
505d6b92ffaSHans Petter Selasky 		/*
506d6b92ffaSHans Petter Selasky 		 * Account for any unsignaled completions completed by
507d6b92ffaSHans Petter Selasky 		 * this signaled completion.  In this case, cidx points
508d6b92ffaSHans Petter Selasky 		 * to the first unsignaled one, and idx points to the
509d6b92ffaSHans Petter Selasky 		 * signaled one.  So adjust in_use based on this delta.
510d6b92ffaSHans Petter Selasky 		 * if this is not completing any unsigned wrs, then the
511d6b92ffaSHans Petter Selasky 		 * delta will be 0. Handle wrapping also!
512d6b92ffaSHans Petter Selasky 		 */
513d6b92ffaSHans Petter Selasky 		if (idx < wq->sq.cidx)
514d6b92ffaSHans Petter Selasky 			wq->sq.in_use -= wq->sq.size + idx - wq->sq.cidx;
515d6b92ffaSHans Petter Selasky 		else
516d6b92ffaSHans Petter Selasky 			wq->sq.in_use -= idx - wq->sq.cidx;
517d6b92ffaSHans Petter Selasky 		BUG_ON(wq->sq.in_use <= 0 || wq->sq.in_use >= wq->sq.size);
518d6b92ffaSHans Petter Selasky 
519d6b92ffaSHans Petter Selasky 		wq->sq.cidx = (u16)idx;
520d6b92ffaSHans Petter Selasky 		PDBG("%s completing sq idx %u\n", __func__, wq->sq.cidx);
521d6b92ffaSHans Petter Selasky 		*cookie = wq->sq.sw_sq[wq->sq.cidx].wr_id;
522d6b92ffaSHans Petter Selasky 		t4_sq_consume(wq);
523d6b92ffaSHans Petter Selasky 	} else {
524d6b92ffaSHans Petter Selasky 		PDBG("%s completing rq idx %u\n", __func__, wq->rq.cidx);
525d6b92ffaSHans Petter Selasky 		BUG_ON(wq->rq.cidx >= wq->rq.size);
526d6b92ffaSHans Petter Selasky 		*cookie = wq->rq.sw_rq[wq->rq.cidx].wr_id;
527d6b92ffaSHans Petter Selasky 		BUG_ON(t4_rq_empty(wq));
528d6b92ffaSHans Petter Selasky 		t4_rq_consume(wq);
529d6b92ffaSHans Petter Selasky 		goto skip_cqe;
530d6b92ffaSHans Petter Selasky 	}
531d6b92ffaSHans Petter Selasky 
532d6b92ffaSHans Petter Selasky flush_wq:
533d6b92ffaSHans Petter Selasky 	/*
534d6b92ffaSHans Petter Selasky 	 * Flush any completed cqes that are now in-order.
535d6b92ffaSHans Petter Selasky 	 */
536d6b92ffaSHans Petter Selasky 	flush_completed_wrs(wq, cq);
537d6b92ffaSHans Petter Selasky 
538d6b92ffaSHans Petter Selasky skip_cqe:
539d6b92ffaSHans Petter Selasky 	if (SW_CQE(hw_cqe)) {
540d6b92ffaSHans Petter Selasky 		PDBG("%s cq %p cqid 0x%x skip sw cqe cidx %u\n",
541d6b92ffaSHans Petter Selasky 		     __func__, cq, cq->cqid, cq->sw_cidx);
542d6b92ffaSHans Petter Selasky 		t4_swcq_consume(cq);
543d6b92ffaSHans Petter Selasky 	} else {
544d6b92ffaSHans Petter Selasky 		PDBG("%s cq %p cqid 0x%x skip hw cqe cidx %u\n",
545d6b92ffaSHans Petter Selasky 		     __func__, cq, cq->cqid, cq->cidx);
546d6b92ffaSHans Petter Selasky 		t4_hwcq_consume(cq);
547d6b92ffaSHans Petter Selasky 	}
548d6b92ffaSHans Petter Selasky 	return ret;
549d6b92ffaSHans Petter Selasky }
550d6b92ffaSHans Petter Selasky 
551d6b92ffaSHans Petter Selasky /*
552d6b92ffaSHans Petter Selasky  * Get one cq entry from c4iw and map it to openib.
553d6b92ffaSHans Petter Selasky  *
554d6b92ffaSHans Petter Selasky  * Returns:
555d6b92ffaSHans Petter Selasky  *	0			cqe returned
556d6b92ffaSHans Petter Selasky  *	-ENODATA		EMPTY;
557d6b92ffaSHans Petter Selasky  *	-EAGAIN			caller must try again
558d6b92ffaSHans Petter Selasky  *	any other -errno	fatal error
559d6b92ffaSHans Petter Selasky  */
c4iw_poll_cq_one(struct c4iw_cq * chp,struct ibv_wc * wc)560d6b92ffaSHans Petter Selasky static int c4iw_poll_cq_one(struct c4iw_cq *chp, struct ibv_wc *wc)
561d6b92ffaSHans Petter Selasky {
562d6b92ffaSHans Petter Selasky 	struct c4iw_qp *qhp = NULL;
563d6b92ffaSHans Petter Selasky 	struct t4_cqe cqe, *rd_cqe;
564d6b92ffaSHans Petter Selasky 	struct t4_wq *wq;
565d6b92ffaSHans Petter Selasky 	u32 credit = 0;
566d6b92ffaSHans Petter Selasky 	u8 cqe_flushed;
567d6b92ffaSHans Petter Selasky 	u64 cookie = 0;
568d6b92ffaSHans Petter Selasky 	int ret;
569d6b92ffaSHans Petter Selasky 
570d6b92ffaSHans Petter Selasky 	ret = t4_next_cqe(&chp->cq, &rd_cqe);
571d6b92ffaSHans Petter Selasky 
572d6b92ffaSHans Petter Selasky 	if (ret) {
573d6b92ffaSHans Petter Selasky #ifdef STALL_DETECTION
574d6b92ffaSHans Petter Selasky 		if (ret == -ENODATA && stall_to && !chp->dumped) {
575d6b92ffaSHans Petter Selasky 			struct timeval t;
576d6b92ffaSHans Petter Selasky 
577d6b92ffaSHans Petter Selasky 			gettimeofday(&t, NULL);
578d6b92ffaSHans Petter Selasky 			if ((t.tv_sec - chp->time.tv_sec) > stall_to) {
579d6b92ffaSHans Petter Selasky 				dump_state();
580d6b92ffaSHans Petter Selasky 				chp->dumped = 1;
581d6b92ffaSHans Petter Selasky 			}
582d6b92ffaSHans Petter Selasky 		}
583d6b92ffaSHans Petter Selasky #endif
584d6b92ffaSHans Petter Selasky 		return ret;
585d6b92ffaSHans Petter Selasky 	}
586d6b92ffaSHans Petter Selasky 
587d6b92ffaSHans Petter Selasky #ifdef STALL_DETECTION
588d6b92ffaSHans Petter Selasky 	gettimeofday(&chp->time, NULL);
589d6b92ffaSHans Petter Selasky #endif
590d6b92ffaSHans Petter Selasky 
591d6b92ffaSHans Petter Selasky 	qhp = get_qhp(chp->rhp, CQE_QPID(rd_cqe));
592d6b92ffaSHans Petter Selasky 	if (!qhp)
593d6b92ffaSHans Petter Selasky 		wq = NULL;
594d6b92ffaSHans Petter Selasky 	else {
595d6b92ffaSHans Petter Selasky 		pthread_spin_lock(&qhp->lock);
596d6b92ffaSHans Petter Selasky 		wq = &(qhp->wq);
597d6b92ffaSHans Petter Selasky 	}
598d6b92ffaSHans Petter Selasky 	ret = poll_cq(wq, &(chp->cq), &cqe, &cqe_flushed, &cookie, &credit);
599d6b92ffaSHans Petter Selasky 	if (ret)
600d6b92ffaSHans Petter Selasky 		goto out;
601d6b92ffaSHans Petter Selasky 
602d6b92ffaSHans Petter Selasky 	INC_STAT(cqe);
603d6b92ffaSHans Petter Selasky 	wc->wr_id = cookie;
604d6b92ffaSHans Petter Selasky 	wc->qp_num = qhp->wq.sq.qid;
605d6b92ffaSHans Petter Selasky 	wc->vendor_err = CQE_STATUS(&cqe);
606d6b92ffaSHans Petter Selasky 	wc->wc_flags = 0;
607d6b92ffaSHans Petter Selasky 
608d6b92ffaSHans Petter Selasky 	PDBG("%s qpid 0x%x type %d opcode %d status 0x%x wrid hi 0x%x "
609d6b92ffaSHans Petter Selasky 	     "lo 0x%x cookie 0x%llx\n", __func__,
610d6b92ffaSHans Petter Selasky 	     CQE_QPID(&cqe), CQE_TYPE(&cqe),
611d6b92ffaSHans Petter Selasky 	     CQE_OPCODE(&cqe), CQE_STATUS(&cqe), CQE_WRID_HI(&cqe),
612d6b92ffaSHans Petter Selasky 	     CQE_WRID_LOW(&cqe), (unsigned long long)cookie);
613d6b92ffaSHans Petter Selasky 
614d6b92ffaSHans Petter Selasky 	if (CQE_TYPE(&cqe) == 0) {
615d6b92ffaSHans Petter Selasky 		if (!CQE_STATUS(&cqe))
616d6b92ffaSHans Petter Selasky 			wc->byte_len = CQE_LEN(&cqe);
617d6b92ffaSHans Petter Selasky 		else
618d6b92ffaSHans Petter Selasky 			wc->byte_len = 0;
619d6b92ffaSHans Petter Selasky 		wc->opcode = IBV_WC_RECV;
620d6b92ffaSHans Petter Selasky 	} else {
621d6b92ffaSHans Petter Selasky 		switch (CQE_OPCODE(&cqe)) {
622d6b92ffaSHans Petter Selasky 		case FW_RI_RDMA_WRITE:
623d6b92ffaSHans Petter Selasky 			wc->opcode = IBV_WC_RDMA_WRITE;
624d6b92ffaSHans Petter Selasky 			break;
625d6b92ffaSHans Petter Selasky 		case FW_RI_READ_REQ:
626d6b92ffaSHans Petter Selasky 			wc->opcode = IBV_WC_RDMA_READ;
627d6b92ffaSHans Petter Selasky 			wc->byte_len = CQE_LEN(&cqe);
628d6b92ffaSHans Petter Selasky 			break;
629d6b92ffaSHans Petter Selasky 		case FW_RI_SEND:
630d6b92ffaSHans Petter Selasky 		case FW_RI_SEND_WITH_SE:
631d6b92ffaSHans Petter Selasky 		case FW_RI_SEND_WITH_INV:
632d6b92ffaSHans Petter Selasky 		case FW_RI_SEND_WITH_SE_INV:
633d6b92ffaSHans Petter Selasky 			wc->opcode = IBV_WC_SEND;
634d6b92ffaSHans Petter Selasky 			break;
635d6b92ffaSHans Petter Selasky 		case FW_RI_BIND_MW:
636d6b92ffaSHans Petter Selasky 			wc->opcode = IBV_WC_BIND_MW;
637d6b92ffaSHans Petter Selasky 			break;
638d6b92ffaSHans Petter Selasky 		default:
639d6b92ffaSHans Petter Selasky 			PDBG("Unexpected opcode %d "
640d6b92ffaSHans Petter Selasky 			     "in the CQE received for QPID=0x%0x\n",
641d6b92ffaSHans Petter Selasky 			     CQE_OPCODE(&cqe), CQE_QPID(&cqe));
642d6b92ffaSHans Petter Selasky 			ret = -EINVAL;
643d6b92ffaSHans Petter Selasky 			goto out;
644d6b92ffaSHans Petter Selasky 		}
645d6b92ffaSHans Petter Selasky 	}
646d6b92ffaSHans Petter Selasky 
647d6b92ffaSHans Petter Selasky 	if (cqe_flushed)
648d6b92ffaSHans Petter Selasky 		wc->status = IBV_WC_WR_FLUSH_ERR;
649d6b92ffaSHans Petter Selasky 	else {
650d6b92ffaSHans Petter Selasky 
651d6b92ffaSHans Petter Selasky 		switch (CQE_STATUS(&cqe)) {
652d6b92ffaSHans Petter Selasky 		case T4_ERR_SUCCESS:
653d6b92ffaSHans Petter Selasky 			wc->status = IBV_WC_SUCCESS;
654d6b92ffaSHans Petter Selasky 			break;
655d6b92ffaSHans Petter Selasky 		case T4_ERR_STAG:
656d6b92ffaSHans Petter Selasky 			wc->status = IBV_WC_LOC_ACCESS_ERR;
657d6b92ffaSHans Petter Selasky 			break;
658d6b92ffaSHans Petter Selasky 		case T4_ERR_PDID:
659d6b92ffaSHans Petter Selasky 			wc->status = IBV_WC_LOC_PROT_ERR;
660d6b92ffaSHans Petter Selasky 			break;
661d6b92ffaSHans Petter Selasky 		case T4_ERR_QPID:
662d6b92ffaSHans Petter Selasky 		case T4_ERR_ACCESS:
663d6b92ffaSHans Petter Selasky 			wc->status = IBV_WC_LOC_ACCESS_ERR;
664d6b92ffaSHans Petter Selasky 			break;
665d6b92ffaSHans Petter Selasky 		case T4_ERR_WRAP:
666d6b92ffaSHans Petter Selasky 			wc->status = IBV_WC_GENERAL_ERR;
667d6b92ffaSHans Petter Selasky 			break;
668d6b92ffaSHans Petter Selasky 		case T4_ERR_BOUND:
669d6b92ffaSHans Petter Selasky 			wc->status = IBV_WC_LOC_LEN_ERR;
670d6b92ffaSHans Petter Selasky 			break;
671d6b92ffaSHans Petter Selasky 		case T4_ERR_INVALIDATE_SHARED_MR:
672d6b92ffaSHans Petter Selasky 		case T4_ERR_INVALIDATE_MR_WITH_MW_BOUND:
673d6b92ffaSHans Petter Selasky 			wc->status = IBV_WC_MW_BIND_ERR;
674d6b92ffaSHans Petter Selasky 			break;
675d6b92ffaSHans Petter Selasky 		case T4_ERR_CRC:
676d6b92ffaSHans Petter Selasky 		case T4_ERR_MARKER:
677d6b92ffaSHans Petter Selasky 		case T4_ERR_PDU_LEN_ERR:
678d6b92ffaSHans Petter Selasky 		case T4_ERR_OUT_OF_RQE:
679d6b92ffaSHans Petter Selasky 		case T4_ERR_DDP_VERSION:
680d6b92ffaSHans Petter Selasky 		case T4_ERR_RDMA_VERSION:
681d6b92ffaSHans Petter Selasky 		case T4_ERR_DDP_QUEUE_NUM:
682d6b92ffaSHans Petter Selasky 		case T4_ERR_MSN:
683d6b92ffaSHans Petter Selasky 		case T4_ERR_TBIT:
684d6b92ffaSHans Petter Selasky 		case T4_ERR_MO:
685d6b92ffaSHans Petter Selasky 		case T4_ERR_MSN_RANGE:
686d6b92ffaSHans Petter Selasky 		case T4_ERR_IRD_OVERFLOW:
687d6b92ffaSHans Petter Selasky 		case T4_ERR_OPCODE:
688d6b92ffaSHans Petter Selasky 		case T4_ERR_INTERNAL_ERR:
689d6b92ffaSHans Petter Selasky 			wc->status = IBV_WC_FATAL_ERR;
690d6b92ffaSHans Petter Selasky 			break;
691d6b92ffaSHans Petter Selasky 		case T4_ERR_SWFLUSH:
692d6b92ffaSHans Petter Selasky 			wc->status = IBV_WC_WR_FLUSH_ERR;
693d6b92ffaSHans Petter Selasky 			break;
694d6b92ffaSHans Petter Selasky 		default:
695d6b92ffaSHans Petter Selasky 			PDBG("Unexpected cqe_status 0x%x for QPID=0x%0x\n",
696d6b92ffaSHans Petter Selasky 			     CQE_STATUS(&cqe), CQE_QPID(&cqe));
697d6b92ffaSHans Petter Selasky 			wc->status = IBV_WC_FATAL_ERR;
698d6b92ffaSHans Petter Selasky 		}
699d6b92ffaSHans Petter Selasky 	}
700d6b92ffaSHans Petter Selasky 	if (wc->status && wc->status != IBV_WC_WR_FLUSH_ERR)
701d6b92ffaSHans Petter Selasky 		syslog(LOG_NOTICE, "cxgb4 app err cqid %u qpid %u "
702d6b92ffaSHans Petter Selasky 			"type %u opcode %u status 0x%x\n",
703d6b92ffaSHans Petter Selasky 			chp->cq.cqid, CQE_QPID(&cqe), CQE_TYPE(&cqe),
704d6b92ffaSHans Petter Selasky 			CQE_OPCODE(&cqe), CQE_STATUS(&cqe));
705d6b92ffaSHans Petter Selasky out:
706d6b92ffaSHans Petter Selasky 	if (wq)
707d6b92ffaSHans Petter Selasky 		pthread_spin_unlock(&qhp->lock);
708d6b92ffaSHans Petter Selasky 	return ret;
709d6b92ffaSHans Petter Selasky }
710d6b92ffaSHans Petter Selasky 
c4iw_poll_cq(struct ibv_cq * ibcq,int num_entries,struct ibv_wc * wc)711d6b92ffaSHans Petter Selasky int c4iw_poll_cq(struct ibv_cq *ibcq, int num_entries, struct ibv_wc *wc)
712d6b92ffaSHans Petter Selasky {
713d6b92ffaSHans Petter Selasky 	struct c4iw_cq *chp;
714d6b92ffaSHans Petter Selasky 	int npolled;
715d6b92ffaSHans Petter Selasky 	int err = 0;
716d6b92ffaSHans Petter Selasky 
717d6b92ffaSHans Petter Selasky 	chp = to_c4iw_cq(ibcq);
718d6b92ffaSHans Petter Selasky 
719d6b92ffaSHans Petter Selasky 	if (t4_cq_in_error(&chp->cq)) {
720d6b92ffaSHans Petter Selasky 		t4_reset_cq_in_error(&chp->cq);
721d6b92ffaSHans Petter Selasky 		c4iw_flush_qps(chp->rhp);
722d6b92ffaSHans Petter Selasky 	}
723d6b92ffaSHans Petter Selasky 
724d6b92ffaSHans Petter Selasky 	if (!num_entries)
725d6b92ffaSHans Petter Selasky 		return t4_cq_notempty(&chp->cq);
726d6b92ffaSHans Petter Selasky 
727d6b92ffaSHans Petter Selasky 	pthread_spin_lock(&chp->lock);
728d6b92ffaSHans Petter Selasky 	for (npolled = 0; npolled < num_entries; ++npolled) {
729d6b92ffaSHans Petter Selasky 		do {
730d6b92ffaSHans Petter Selasky 			err = c4iw_poll_cq_one(chp, wc + npolled);
731d6b92ffaSHans Petter Selasky 		} while (err == -EAGAIN);
732d6b92ffaSHans Petter Selasky 		if (err)
733d6b92ffaSHans Petter Selasky 			break;
734d6b92ffaSHans Petter Selasky 	}
735d6b92ffaSHans Petter Selasky 	pthread_spin_unlock(&chp->lock);
736d6b92ffaSHans Petter Selasky 	return !err || err == -ENODATA ? npolled : err;
737d6b92ffaSHans Petter Selasky }
738d6b92ffaSHans Petter Selasky 
c4iw_arm_cq(struct ibv_cq * ibcq,int solicited)739d6b92ffaSHans Petter Selasky int c4iw_arm_cq(struct ibv_cq *ibcq, int solicited)
740d6b92ffaSHans Petter Selasky {
741d6b92ffaSHans Petter Selasky 	struct c4iw_cq *chp;
742d6b92ffaSHans Petter Selasky 	int ret;
743d6b92ffaSHans Petter Selasky 
744d6b92ffaSHans Petter Selasky 	INC_STAT(arm);
745d6b92ffaSHans Petter Selasky 	chp = to_c4iw_cq(ibcq);
746d6b92ffaSHans Petter Selasky 	pthread_spin_lock(&chp->lock);
747d6b92ffaSHans Petter Selasky 	ret = t4_arm_cq(&chp->cq, solicited);
748d6b92ffaSHans Petter Selasky 	pthread_spin_unlock(&chp->lock);
749d6b92ffaSHans Petter Selasky 	return ret;
750d6b92ffaSHans Petter Selasky }
751