162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright (c) 2016 Mellanox Technologies Ltd. All rights reserved.
462306a36Sopenharmony_ci * Copyright (c) 2015 System Fabric Works, Inc. All rights reserved.
562306a36Sopenharmony_ci */
662306a36Sopenharmony_ci
762306a36Sopenharmony_ci#include <linux/skbuff.h>
862306a36Sopenharmony_ci
962306a36Sopenharmony_ci#include "rxe.h"
1062306a36Sopenharmony_ci#include "rxe_loc.h"
1162306a36Sopenharmony_ci#include "rxe_queue.h"
1262306a36Sopenharmony_ci#include "rxe_task.h"
1362306a36Sopenharmony_ci
1462306a36Sopenharmony_cienum comp_state {
1562306a36Sopenharmony_ci	COMPST_GET_ACK,
1662306a36Sopenharmony_ci	COMPST_GET_WQE,
1762306a36Sopenharmony_ci	COMPST_COMP_WQE,
1862306a36Sopenharmony_ci	COMPST_COMP_ACK,
1962306a36Sopenharmony_ci	COMPST_CHECK_PSN,
2062306a36Sopenharmony_ci	COMPST_CHECK_ACK,
2162306a36Sopenharmony_ci	COMPST_READ,
2262306a36Sopenharmony_ci	COMPST_ATOMIC,
2362306a36Sopenharmony_ci	COMPST_WRITE_SEND,
2462306a36Sopenharmony_ci	COMPST_UPDATE_COMP,
2562306a36Sopenharmony_ci	COMPST_ERROR_RETRY,
2662306a36Sopenharmony_ci	COMPST_RNR_RETRY,
2762306a36Sopenharmony_ci	COMPST_ERROR,
2862306a36Sopenharmony_ci	COMPST_EXIT, /* We have an issue, and we want to rerun the completer */
2962306a36Sopenharmony_ci	COMPST_DONE, /* The completer finished successflly */
3062306a36Sopenharmony_ci};
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_cistatic char *comp_state_name[] =  {
3362306a36Sopenharmony_ci	[COMPST_GET_ACK]		= "GET ACK",
3462306a36Sopenharmony_ci	[COMPST_GET_WQE]		= "GET WQE",
3562306a36Sopenharmony_ci	[COMPST_COMP_WQE]		= "COMP WQE",
3662306a36Sopenharmony_ci	[COMPST_COMP_ACK]		= "COMP ACK",
3762306a36Sopenharmony_ci	[COMPST_CHECK_PSN]		= "CHECK PSN",
3862306a36Sopenharmony_ci	[COMPST_CHECK_ACK]		= "CHECK ACK",
3962306a36Sopenharmony_ci	[COMPST_READ]			= "READ",
4062306a36Sopenharmony_ci	[COMPST_ATOMIC]			= "ATOMIC",
4162306a36Sopenharmony_ci	[COMPST_WRITE_SEND]		= "WRITE/SEND",
4262306a36Sopenharmony_ci	[COMPST_UPDATE_COMP]		= "UPDATE COMP",
4362306a36Sopenharmony_ci	[COMPST_ERROR_RETRY]		= "ERROR RETRY",
4462306a36Sopenharmony_ci	[COMPST_RNR_RETRY]		= "RNR RETRY",
4562306a36Sopenharmony_ci	[COMPST_ERROR]			= "ERROR",
4662306a36Sopenharmony_ci	[COMPST_EXIT]			= "EXIT",
4762306a36Sopenharmony_ci	[COMPST_DONE]			= "DONE",
4862306a36Sopenharmony_ci};
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_cistatic unsigned long rnrnak_usec[32] = {
5162306a36Sopenharmony_ci	[IB_RNR_TIMER_655_36] = 655360,
5262306a36Sopenharmony_ci	[IB_RNR_TIMER_000_01] = 10,
5362306a36Sopenharmony_ci	[IB_RNR_TIMER_000_02] = 20,
5462306a36Sopenharmony_ci	[IB_RNR_TIMER_000_03] = 30,
5562306a36Sopenharmony_ci	[IB_RNR_TIMER_000_04] = 40,
5662306a36Sopenharmony_ci	[IB_RNR_TIMER_000_06] = 60,
5762306a36Sopenharmony_ci	[IB_RNR_TIMER_000_08] = 80,
5862306a36Sopenharmony_ci	[IB_RNR_TIMER_000_12] = 120,
5962306a36Sopenharmony_ci	[IB_RNR_TIMER_000_16] = 160,
6062306a36Sopenharmony_ci	[IB_RNR_TIMER_000_24] = 240,
6162306a36Sopenharmony_ci	[IB_RNR_TIMER_000_32] = 320,
6262306a36Sopenharmony_ci	[IB_RNR_TIMER_000_48] = 480,
6362306a36Sopenharmony_ci	[IB_RNR_TIMER_000_64] = 640,
6462306a36Sopenharmony_ci	[IB_RNR_TIMER_000_96] = 960,
6562306a36Sopenharmony_ci	[IB_RNR_TIMER_001_28] = 1280,
6662306a36Sopenharmony_ci	[IB_RNR_TIMER_001_92] = 1920,
6762306a36Sopenharmony_ci	[IB_RNR_TIMER_002_56] = 2560,
6862306a36Sopenharmony_ci	[IB_RNR_TIMER_003_84] = 3840,
6962306a36Sopenharmony_ci	[IB_RNR_TIMER_005_12] = 5120,
7062306a36Sopenharmony_ci	[IB_RNR_TIMER_007_68] = 7680,
7162306a36Sopenharmony_ci	[IB_RNR_TIMER_010_24] = 10240,
7262306a36Sopenharmony_ci	[IB_RNR_TIMER_015_36] = 15360,
7362306a36Sopenharmony_ci	[IB_RNR_TIMER_020_48] = 20480,
7462306a36Sopenharmony_ci	[IB_RNR_TIMER_030_72] = 30720,
7562306a36Sopenharmony_ci	[IB_RNR_TIMER_040_96] = 40960,
7662306a36Sopenharmony_ci	[IB_RNR_TIMER_061_44] = 61410,
7762306a36Sopenharmony_ci	[IB_RNR_TIMER_081_92] = 81920,
7862306a36Sopenharmony_ci	[IB_RNR_TIMER_122_88] = 122880,
7962306a36Sopenharmony_ci	[IB_RNR_TIMER_163_84] = 163840,
8062306a36Sopenharmony_ci	[IB_RNR_TIMER_245_76] = 245760,
8162306a36Sopenharmony_ci	[IB_RNR_TIMER_327_68] = 327680,
8262306a36Sopenharmony_ci	[IB_RNR_TIMER_491_52] = 491520,
8362306a36Sopenharmony_ci};
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_cistatic inline unsigned long rnrnak_jiffies(u8 timeout)
8662306a36Sopenharmony_ci{
8762306a36Sopenharmony_ci	return max_t(unsigned long,
8862306a36Sopenharmony_ci		usecs_to_jiffies(rnrnak_usec[timeout]), 1);
8962306a36Sopenharmony_ci}
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_cistatic enum ib_wc_opcode wr_to_wc_opcode(enum ib_wr_opcode opcode)
9262306a36Sopenharmony_ci{
9362306a36Sopenharmony_ci	switch (opcode) {
9462306a36Sopenharmony_ci	case IB_WR_RDMA_WRITE:			return IB_WC_RDMA_WRITE;
9562306a36Sopenharmony_ci	case IB_WR_RDMA_WRITE_WITH_IMM:		return IB_WC_RDMA_WRITE;
9662306a36Sopenharmony_ci	case IB_WR_SEND:			return IB_WC_SEND;
9762306a36Sopenharmony_ci	case IB_WR_SEND_WITH_IMM:		return IB_WC_SEND;
9862306a36Sopenharmony_ci	case IB_WR_RDMA_READ:			return IB_WC_RDMA_READ;
9962306a36Sopenharmony_ci	case IB_WR_ATOMIC_CMP_AND_SWP:		return IB_WC_COMP_SWAP;
10062306a36Sopenharmony_ci	case IB_WR_ATOMIC_FETCH_AND_ADD:	return IB_WC_FETCH_ADD;
10162306a36Sopenharmony_ci	case IB_WR_LSO:				return IB_WC_LSO;
10262306a36Sopenharmony_ci	case IB_WR_SEND_WITH_INV:		return IB_WC_SEND;
10362306a36Sopenharmony_ci	case IB_WR_RDMA_READ_WITH_INV:		return IB_WC_RDMA_READ;
10462306a36Sopenharmony_ci	case IB_WR_LOCAL_INV:			return IB_WC_LOCAL_INV;
10562306a36Sopenharmony_ci	case IB_WR_REG_MR:			return IB_WC_REG_MR;
10662306a36Sopenharmony_ci	case IB_WR_BIND_MW:			return IB_WC_BIND_MW;
10762306a36Sopenharmony_ci	case IB_WR_ATOMIC_WRITE:		return IB_WC_ATOMIC_WRITE;
10862306a36Sopenharmony_ci	case IB_WR_FLUSH:			return IB_WC_FLUSH;
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_ci	default:
11162306a36Sopenharmony_ci		return 0xff;
11262306a36Sopenharmony_ci	}
11362306a36Sopenharmony_ci}
11462306a36Sopenharmony_ci
11562306a36Sopenharmony_civoid retransmit_timer(struct timer_list *t)
11662306a36Sopenharmony_ci{
11762306a36Sopenharmony_ci	struct rxe_qp *qp = from_timer(qp, t, retrans_timer);
11862306a36Sopenharmony_ci	unsigned long flags;
11962306a36Sopenharmony_ci
12062306a36Sopenharmony_ci	rxe_dbg_qp(qp, "retransmit timer fired\n");
12162306a36Sopenharmony_ci
12262306a36Sopenharmony_ci	spin_lock_irqsave(&qp->state_lock, flags);
12362306a36Sopenharmony_ci	if (qp->valid) {
12462306a36Sopenharmony_ci		qp->comp.timeout = 1;
12562306a36Sopenharmony_ci		rxe_sched_task(&qp->comp.task);
12662306a36Sopenharmony_ci	}
12762306a36Sopenharmony_ci	spin_unlock_irqrestore(&qp->state_lock, flags);
12862306a36Sopenharmony_ci}
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_civoid rxe_comp_queue_pkt(struct rxe_qp *qp, struct sk_buff *skb)
13162306a36Sopenharmony_ci{
13262306a36Sopenharmony_ci	int must_sched;
13362306a36Sopenharmony_ci
13462306a36Sopenharmony_ci	skb_queue_tail(&qp->resp_pkts, skb);
13562306a36Sopenharmony_ci
13662306a36Sopenharmony_ci	must_sched = skb_queue_len(&qp->resp_pkts) > 1;
13762306a36Sopenharmony_ci	if (must_sched != 0)
13862306a36Sopenharmony_ci		rxe_counter_inc(SKB_TO_PKT(skb)->rxe, RXE_CNT_COMPLETER_SCHED);
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_ci	if (must_sched)
14162306a36Sopenharmony_ci		rxe_sched_task(&qp->comp.task);
14262306a36Sopenharmony_ci	else
14362306a36Sopenharmony_ci		rxe_run_task(&qp->comp.task);
14462306a36Sopenharmony_ci}
14562306a36Sopenharmony_ci
14662306a36Sopenharmony_cistatic inline enum comp_state get_wqe(struct rxe_qp *qp,
14762306a36Sopenharmony_ci				      struct rxe_pkt_info *pkt,
14862306a36Sopenharmony_ci				      struct rxe_send_wqe **wqe_p)
14962306a36Sopenharmony_ci{
15062306a36Sopenharmony_ci	struct rxe_send_wqe *wqe;
15162306a36Sopenharmony_ci
15262306a36Sopenharmony_ci	/* we come here whether or not we found a response packet to see if
15362306a36Sopenharmony_ci	 * there are any posted WQEs
15462306a36Sopenharmony_ci	 */
15562306a36Sopenharmony_ci	wqe = queue_head(qp->sq.queue, QUEUE_TYPE_FROM_CLIENT);
15662306a36Sopenharmony_ci	*wqe_p = wqe;
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_ci	/* no WQE or requester has not started it yet */
15962306a36Sopenharmony_ci	if (!wqe || wqe->state == wqe_state_posted)
16062306a36Sopenharmony_ci		return pkt ? COMPST_DONE : COMPST_EXIT;
16162306a36Sopenharmony_ci
16262306a36Sopenharmony_ci	/* WQE does not require an ack */
16362306a36Sopenharmony_ci	if (wqe->state == wqe_state_done)
16462306a36Sopenharmony_ci		return COMPST_COMP_WQE;
16562306a36Sopenharmony_ci
16662306a36Sopenharmony_ci	/* WQE caused an error */
16762306a36Sopenharmony_ci	if (wqe->state == wqe_state_error)
16862306a36Sopenharmony_ci		return COMPST_ERROR;
16962306a36Sopenharmony_ci
17062306a36Sopenharmony_ci	/* we have a WQE, if we also have an ack check its PSN */
17162306a36Sopenharmony_ci	return pkt ? COMPST_CHECK_PSN : COMPST_EXIT;
17262306a36Sopenharmony_ci}
17362306a36Sopenharmony_ci
17462306a36Sopenharmony_cistatic inline void reset_retry_counters(struct rxe_qp *qp)
17562306a36Sopenharmony_ci{
17662306a36Sopenharmony_ci	qp->comp.retry_cnt = qp->attr.retry_cnt;
17762306a36Sopenharmony_ci	qp->comp.rnr_retry = qp->attr.rnr_retry;
17862306a36Sopenharmony_ci	qp->comp.started_retry = 0;
17962306a36Sopenharmony_ci}
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_cistatic inline enum comp_state check_psn(struct rxe_qp *qp,
18262306a36Sopenharmony_ci					struct rxe_pkt_info *pkt,
18362306a36Sopenharmony_ci					struct rxe_send_wqe *wqe)
18462306a36Sopenharmony_ci{
18562306a36Sopenharmony_ci	s32 diff;
18662306a36Sopenharmony_ci
18762306a36Sopenharmony_ci	/* check to see if response is past the oldest WQE. if it is, complete
18862306a36Sopenharmony_ci	 * send/write or error read/atomic
18962306a36Sopenharmony_ci	 */
19062306a36Sopenharmony_ci	diff = psn_compare(pkt->psn, wqe->last_psn);
19162306a36Sopenharmony_ci	if (diff > 0) {
19262306a36Sopenharmony_ci		if (wqe->state == wqe_state_pending) {
19362306a36Sopenharmony_ci			if (wqe->mask & WR_ATOMIC_OR_READ_MASK)
19462306a36Sopenharmony_ci				return COMPST_ERROR_RETRY;
19562306a36Sopenharmony_ci
19662306a36Sopenharmony_ci			reset_retry_counters(qp);
19762306a36Sopenharmony_ci			return COMPST_COMP_WQE;
19862306a36Sopenharmony_ci		} else {
19962306a36Sopenharmony_ci			return COMPST_DONE;
20062306a36Sopenharmony_ci		}
20162306a36Sopenharmony_ci	}
20262306a36Sopenharmony_ci
20362306a36Sopenharmony_ci	/* compare response packet to expected response */
20462306a36Sopenharmony_ci	diff = psn_compare(pkt->psn, qp->comp.psn);
20562306a36Sopenharmony_ci	if (diff < 0) {
20662306a36Sopenharmony_ci		/* response is most likely a retried packet if it matches an
20762306a36Sopenharmony_ci		 * uncompleted WQE go complete it else ignore it
20862306a36Sopenharmony_ci		 */
20962306a36Sopenharmony_ci		if (pkt->psn == wqe->last_psn)
21062306a36Sopenharmony_ci			return COMPST_COMP_ACK;
21162306a36Sopenharmony_ci		else if (pkt->opcode == IB_OPCODE_RC_ACKNOWLEDGE &&
21262306a36Sopenharmony_ci			 (qp->comp.opcode == IB_OPCODE_RC_RDMA_READ_RESPONSE_FIRST ||
21362306a36Sopenharmony_ci			  qp->comp.opcode == IB_OPCODE_RC_RDMA_READ_RESPONSE_MIDDLE))
21462306a36Sopenharmony_ci			return COMPST_CHECK_ACK;
21562306a36Sopenharmony_ci		else
21662306a36Sopenharmony_ci			return COMPST_DONE;
21762306a36Sopenharmony_ci	} else if ((diff > 0) && (wqe->mask & WR_ATOMIC_OR_READ_MASK)) {
21862306a36Sopenharmony_ci		return COMPST_DONE;
21962306a36Sopenharmony_ci	} else {
22062306a36Sopenharmony_ci		return COMPST_CHECK_ACK;
22162306a36Sopenharmony_ci	}
22262306a36Sopenharmony_ci}
22362306a36Sopenharmony_ci
22462306a36Sopenharmony_cistatic inline enum comp_state check_ack(struct rxe_qp *qp,
22562306a36Sopenharmony_ci					struct rxe_pkt_info *pkt,
22662306a36Sopenharmony_ci					struct rxe_send_wqe *wqe)
22762306a36Sopenharmony_ci{
22862306a36Sopenharmony_ci	unsigned int mask = pkt->mask;
22962306a36Sopenharmony_ci	u8 syn;
23062306a36Sopenharmony_ci	struct rxe_dev *rxe = to_rdev(qp->ibqp.device);
23162306a36Sopenharmony_ci
23262306a36Sopenharmony_ci	/* Check the sequence only */
23362306a36Sopenharmony_ci	switch (qp->comp.opcode) {
23462306a36Sopenharmony_ci	case -1:
23562306a36Sopenharmony_ci		/* Will catch all *_ONLY cases. */
23662306a36Sopenharmony_ci		if (!(mask & RXE_START_MASK))
23762306a36Sopenharmony_ci			return COMPST_ERROR;
23862306a36Sopenharmony_ci
23962306a36Sopenharmony_ci		break;
24062306a36Sopenharmony_ci
24162306a36Sopenharmony_ci	case IB_OPCODE_RC_RDMA_READ_RESPONSE_FIRST:
24262306a36Sopenharmony_ci	case IB_OPCODE_RC_RDMA_READ_RESPONSE_MIDDLE:
24362306a36Sopenharmony_ci		/* Check NAK code to handle a remote error */
24462306a36Sopenharmony_ci		if (pkt->opcode == IB_OPCODE_RC_ACKNOWLEDGE)
24562306a36Sopenharmony_ci			break;
24662306a36Sopenharmony_ci
24762306a36Sopenharmony_ci		if (pkt->opcode != IB_OPCODE_RC_RDMA_READ_RESPONSE_MIDDLE &&
24862306a36Sopenharmony_ci		    pkt->opcode != IB_OPCODE_RC_RDMA_READ_RESPONSE_LAST) {
24962306a36Sopenharmony_ci			/* read retries of partial data may restart from
25062306a36Sopenharmony_ci			 * read response first or response only.
25162306a36Sopenharmony_ci			 */
25262306a36Sopenharmony_ci			if ((pkt->psn == wqe->first_psn &&
25362306a36Sopenharmony_ci			     pkt->opcode ==
25462306a36Sopenharmony_ci			     IB_OPCODE_RC_RDMA_READ_RESPONSE_FIRST) ||
25562306a36Sopenharmony_ci			    (wqe->first_psn == wqe->last_psn &&
25662306a36Sopenharmony_ci			     pkt->opcode ==
25762306a36Sopenharmony_ci			     IB_OPCODE_RC_RDMA_READ_RESPONSE_ONLY))
25862306a36Sopenharmony_ci				break;
25962306a36Sopenharmony_ci
26062306a36Sopenharmony_ci			return COMPST_ERROR;
26162306a36Sopenharmony_ci		}
26262306a36Sopenharmony_ci		break;
26362306a36Sopenharmony_ci	default:
26462306a36Sopenharmony_ci		WARN_ON_ONCE(1);
26562306a36Sopenharmony_ci	}
26662306a36Sopenharmony_ci
26762306a36Sopenharmony_ci	/* Check operation validity. */
26862306a36Sopenharmony_ci	switch (pkt->opcode) {
26962306a36Sopenharmony_ci	case IB_OPCODE_RC_RDMA_READ_RESPONSE_FIRST:
27062306a36Sopenharmony_ci	case IB_OPCODE_RC_RDMA_READ_RESPONSE_LAST:
27162306a36Sopenharmony_ci	case IB_OPCODE_RC_RDMA_READ_RESPONSE_ONLY:
27262306a36Sopenharmony_ci		syn = aeth_syn(pkt);
27362306a36Sopenharmony_ci
27462306a36Sopenharmony_ci		if ((syn & AETH_TYPE_MASK) != AETH_ACK)
27562306a36Sopenharmony_ci			return COMPST_ERROR;
27662306a36Sopenharmony_ci
27762306a36Sopenharmony_ci		if (wqe->wr.opcode == IB_WR_ATOMIC_WRITE)
27862306a36Sopenharmony_ci			return COMPST_WRITE_SEND;
27962306a36Sopenharmony_ci
28062306a36Sopenharmony_ci		fallthrough;
28162306a36Sopenharmony_ci		/* (IB_OPCODE_RC_RDMA_READ_RESPONSE_MIDDLE doesn't have an AETH)
28262306a36Sopenharmony_ci		 */
28362306a36Sopenharmony_ci	case IB_OPCODE_RC_RDMA_READ_RESPONSE_MIDDLE:
28462306a36Sopenharmony_ci		if (wqe->wr.opcode != IB_WR_RDMA_READ &&
28562306a36Sopenharmony_ci		    wqe->wr.opcode != IB_WR_RDMA_READ_WITH_INV &&
28662306a36Sopenharmony_ci		    wqe->wr.opcode != IB_WR_FLUSH) {
28762306a36Sopenharmony_ci			wqe->status = IB_WC_FATAL_ERR;
28862306a36Sopenharmony_ci			return COMPST_ERROR;
28962306a36Sopenharmony_ci		}
29062306a36Sopenharmony_ci		reset_retry_counters(qp);
29162306a36Sopenharmony_ci		return COMPST_READ;
29262306a36Sopenharmony_ci
29362306a36Sopenharmony_ci	case IB_OPCODE_RC_ATOMIC_ACKNOWLEDGE:
29462306a36Sopenharmony_ci		syn = aeth_syn(pkt);
29562306a36Sopenharmony_ci
29662306a36Sopenharmony_ci		if ((syn & AETH_TYPE_MASK) != AETH_ACK)
29762306a36Sopenharmony_ci			return COMPST_ERROR;
29862306a36Sopenharmony_ci
29962306a36Sopenharmony_ci		if (wqe->wr.opcode != IB_WR_ATOMIC_CMP_AND_SWP &&
30062306a36Sopenharmony_ci		    wqe->wr.opcode != IB_WR_ATOMIC_FETCH_AND_ADD)
30162306a36Sopenharmony_ci			return COMPST_ERROR;
30262306a36Sopenharmony_ci		reset_retry_counters(qp);
30362306a36Sopenharmony_ci		return COMPST_ATOMIC;
30462306a36Sopenharmony_ci
30562306a36Sopenharmony_ci	case IB_OPCODE_RC_ACKNOWLEDGE:
30662306a36Sopenharmony_ci		syn = aeth_syn(pkt);
30762306a36Sopenharmony_ci		switch (syn & AETH_TYPE_MASK) {
30862306a36Sopenharmony_ci		case AETH_ACK:
30962306a36Sopenharmony_ci			reset_retry_counters(qp);
31062306a36Sopenharmony_ci			return COMPST_WRITE_SEND;
31162306a36Sopenharmony_ci
31262306a36Sopenharmony_ci		case AETH_RNR_NAK:
31362306a36Sopenharmony_ci			rxe_counter_inc(rxe, RXE_CNT_RCV_RNR);
31462306a36Sopenharmony_ci			return COMPST_RNR_RETRY;
31562306a36Sopenharmony_ci
31662306a36Sopenharmony_ci		case AETH_NAK:
31762306a36Sopenharmony_ci			switch (syn) {
31862306a36Sopenharmony_ci			case AETH_NAK_PSN_SEQ_ERROR:
31962306a36Sopenharmony_ci				/* a nak implicitly acks all packets with psns
32062306a36Sopenharmony_ci				 * before
32162306a36Sopenharmony_ci				 */
32262306a36Sopenharmony_ci				if (psn_compare(pkt->psn, qp->comp.psn) > 0) {
32362306a36Sopenharmony_ci					rxe_counter_inc(rxe,
32462306a36Sopenharmony_ci							RXE_CNT_RCV_SEQ_ERR);
32562306a36Sopenharmony_ci					qp->comp.psn = pkt->psn;
32662306a36Sopenharmony_ci					if (qp->req.wait_psn) {
32762306a36Sopenharmony_ci						qp->req.wait_psn = 0;
32862306a36Sopenharmony_ci						rxe_sched_task(&qp->req.task);
32962306a36Sopenharmony_ci					}
33062306a36Sopenharmony_ci				}
33162306a36Sopenharmony_ci				return COMPST_ERROR_RETRY;
33262306a36Sopenharmony_ci
33362306a36Sopenharmony_ci			case AETH_NAK_INVALID_REQ:
33462306a36Sopenharmony_ci				wqe->status = IB_WC_REM_INV_REQ_ERR;
33562306a36Sopenharmony_ci				return COMPST_ERROR;
33662306a36Sopenharmony_ci
33762306a36Sopenharmony_ci			case AETH_NAK_REM_ACC_ERR:
33862306a36Sopenharmony_ci				wqe->status = IB_WC_REM_ACCESS_ERR;
33962306a36Sopenharmony_ci				return COMPST_ERROR;
34062306a36Sopenharmony_ci
34162306a36Sopenharmony_ci			case AETH_NAK_REM_OP_ERR:
34262306a36Sopenharmony_ci				wqe->status = IB_WC_REM_OP_ERR;
34362306a36Sopenharmony_ci				return COMPST_ERROR;
34462306a36Sopenharmony_ci
34562306a36Sopenharmony_ci			default:
34662306a36Sopenharmony_ci				rxe_dbg_qp(qp, "unexpected nak %x\n", syn);
34762306a36Sopenharmony_ci				wqe->status = IB_WC_REM_OP_ERR;
34862306a36Sopenharmony_ci				return COMPST_ERROR;
34962306a36Sopenharmony_ci			}
35062306a36Sopenharmony_ci
35162306a36Sopenharmony_ci		default:
35262306a36Sopenharmony_ci			return COMPST_ERROR;
35362306a36Sopenharmony_ci		}
35462306a36Sopenharmony_ci		break;
35562306a36Sopenharmony_ci
35662306a36Sopenharmony_ci	default:
35762306a36Sopenharmony_ci		rxe_dbg_qp(qp, "unexpected opcode\n");
35862306a36Sopenharmony_ci	}
35962306a36Sopenharmony_ci
36062306a36Sopenharmony_ci	return COMPST_ERROR;
36162306a36Sopenharmony_ci}
36262306a36Sopenharmony_ci
36362306a36Sopenharmony_cistatic inline enum comp_state do_read(struct rxe_qp *qp,
36462306a36Sopenharmony_ci				      struct rxe_pkt_info *pkt,
36562306a36Sopenharmony_ci				      struct rxe_send_wqe *wqe)
36662306a36Sopenharmony_ci{
36762306a36Sopenharmony_ci	int ret;
36862306a36Sopenharmony_ci
36962306a36Sopenharmony_ci	ret = copy_data(qp->pd, IB_ACCESS_LOCAL_WRITE,
37062306a36Sopenharmony_ci			&wqe->dma, payload_addr(pkt),
37162306a36Sopenharmony_ci			payload_size(pkt), RXE_TO_MR_OBJ);
37262306a36Sopenharmony_ci	if (ret) {
37362306a36Sopenharmony_ci		wqe->status = IB_WC_LOC_PROT_ERR;
37462306a36Sopenharmony_ci		return COMPST_ERROR;
37562306a36Sopenharmony_ci	}
37662306a36Sopenharmony_ci
37762306a36Sopenharmony_ci	if (wqe->dma.resid == 0 && (pkt->mask & RXE_END_MASK))
37862306a36Sopenharmony_ci		return COMPST_COMP_ACK;
37962306a36Sopenharmony_ci
38062306a36Sopenharmony_ci	return COMPST_UPDATE_COMP;
38162306a36Sopenharmony_ci}
38262306a36Sopenharmony_ci
38362306a36Sopenharmony_cistatic inline enum comp_state do_atomic(struct rxe_qp *qp,
38462306a36Sopenharmony_ci					struct rxe_pkt_info *pkt,
38562306a36Sopenharmony_ci					struct rxe_send_wqe *wqe)
38662306a36Sopenharmony_ci{
38762306a36Sopenharmony_ci	int ret;
38862306a36Sopenharmony_ci
38962306a36Sopenharmony_ci	u64 atomic_orig = atmack_orig(pkt);
39062306a36Sopenharmony_ci
39162306a36Sopenharmony_ci	ret = copy_data(qp->pd, IB_ACCESS_LOCAL_WRITE,
39262306a36Sopenharmony_ci			&wqe->dma, &atomic_orig,
39362306a36Sopenharmony_ci			sizeof(u64), RXE_TO_MR_OBJ);
39462306a36Sopenharmony_ci	if (ret) {
39562306a36Sopenharmony_ci		wqe->status = IB_WC_LOC_PROT_ERR;
39662306a36Sopenharmony_ci		return COMPST_ERROR;
39762306a36Sopenharmony_ci	}
39862306a36Sopenharmony_ci
39962306a36Sopenharmony_ci	return COMPST_COMP_ACK;
40062306a36Sopenharmony_ci}
40162306a36Sopenharmony_ci
40262306a36Sopenharmony_cistatic void make_send_cqe(struct rxe_qp *qp, struct rxe_send_wqe *wqe,
40362306a36Sopenharmony_ci			  struct rxe_cqe *cqe)
40462306a36Sopenharmony_ci{
40562306a36Sopenharmony_ci	struct ib_wc *wc = &cqe->ibwc;
40662306a36Sopenharmony_ci	struct ib_uverbs_wc *uwc = &cqe->uibwc;
40762306a36Sopenharmony_ci
40862306a36Sopenharmony_ci	memset(cqe, 0, sizeof(*cqe));
40962306a36Sopenharmony_ci
41062306a36Sopenharmony_ci	if (!qp->is_user) {
41162306a36Sopenharmony_ci		wc->wr_id = wqe->wr.wr_id;
41262306a36Sopenharmony_ci		wc->status = wqe->status;
41362306a36Sopenharmony_ci		wc->qp = &qp->ibqp;
41462306a36Sopenharmony_ci	} else {
41562306a36Sopenharmony_ci		uwc->wr_id = wqe->wr.wr_id;
41662306a36Sopenharmony_ci		uwc->status = wqe->status;
41762306a36Sopenharmony_ci		uwc->qp_num = qp->ibqp.qp_num;
41862306a36Sopenharmony_ci	}
41962306a36Sopenharmony_ci
42062306a36Sopenharmony_ci	if (wqe->status == IB_WC_SUCCESS) {
42162306a36Sopenharmony_ci		if (!qp->is_user) {
42262306a36Sopenharmony_ci			wc->opcode = wr_to_wc_opcode(wqe->wr.opcode);
42362306a36Sopenharmony_ci			if (wqe->wr.opcode == IB_WR_RDMA_WRITE_WITH_IMM ||
42462306a36Sopenharmony_ci			    wqe->wr.opcode == IB_WR_SEND_WITH_IMM)
42562306a36Sopenharmony_ci				wc->wc_flags = IB_WC_WITH_IMM;
42662306a36Sopenharmony_ci			wc->byte_len = wqe->dma.length;
42762306a36Sopenharmony_ci		} else {
42862306a36Sopenharmony_ci			uwc->opcode = wr_to_wc_opcode(wqe->wr.opcode);
42962306a36Sopenharmony_ci			if (wqe->wr.opcode == IB_WR_RDMA_WRITE_WITH_IMM ||
43062306a36Sopenharmony_ci			    wqe->wr.opcode == IB_WR_SEND_WITH_IMM)
43162306a36Sopenharmony_ci				uwc->wc_flags = IB_WC_WITH_IMM;
43262306a36Sopenharmony_ci			uwc->byte_len = wqe->dma.length;
43362306a36Sopenharmony_ci		}
43462306a36Sopenharmony_ci	} else {
43562306a36Sopenharmony_ci		if (wqe->status != IB_WC_WR_FLUSH_ERR)
43662306a36Sopenharmony_ci			rxe_err_qp(qp, "non-flush error status = %d",
43762306a36Sopenharmony_ci				wqe->status);
43862306a36Sopenharmony_ci	}
43962306a36Sopenharmony_ci}
44062306a36Sopenharmony_ci
44162306a36Sopenharmony_ci/*
44262306a36Sopenharmony_ci * IBA Spec. Section 10.7.3.1 SIGNALED COMPLETIONS
44362306a36Sopenharmony_ci * ---------8<---------8<-------------
44462306a36Sopenharmony_ci * ...Note that if a completion error occurs, a Work Completion
44562306a36Sopenharmony_ci * will always be generated, even if the signaling
44662306a36Sopenharmony_ci * indicator requests an Unsignaled Completion.
44762306a36Sopenharmony_ci * ---------8<---------8<-------------
44862306a36Sopenharmony_ci */
44962306a36Sopenharmony_cistatic void do_complete(struct rxe_qp *qp, struct rxe_send_wqe *wqe)
45062306a36Sopenharmony_ci{
45162306a36Sopenharmony_ci	struct rxe_dev *rxe = to_rdev(qp->ibqp.device);
45262306a36Sopenharmony_ci	struct rxe_cqe cqe;
45362306a36Sopenharmony_ci	bool post;
45462306a36Sopenharmony_ci
45562306a36Sopenharmony_ci	/* do we need to post a completion */
45662306a36Sopenharmony_ci	post = ((qp->sq_sig_type == IB_SIGNAL_ALL_WR) ||
45762306a36Sopenharmony_ci			(wqe->wr.send_flags & IB_SEND_SIGNALED) ||
45862306a36Sopenharmony_ci			wqe->status != IB_WC_SUCCESS);
45962306a36Sopenharmony_ci
46062306a36Sopenharmony_ci	if (post)
46162306a36Sopenharmony_ci		make_send_cqe(qp, wqe, &cqe);
46262306a36Sopenharmony_ci
46362306a36Sopenharmony_ci	queue_advance_consumer(qp->sq.queue, QUEUE_TYPE_FROM_CLIENT);
46462306a36Sopenharmony_ci
46562306a36Sopenharmony_ci	if (post)
46662306a36Sopenharmony_ci		rxe_cq_post(qp->scq, &cqe, 0);
46762306a36Sopenharmony_ci
46862306a36Sopenharmony_ci	if (wqe->wr.opcode == IB_WR_SEND ||
46962306a36Sopenharmony_ci	    wqe->wr.opcode == IB_WR_SEND_WITH_IMM ||
47062306a36Sopenharmony_ci	    wqe->wr.opcode == IB_WR_SEND_WITH_INV)
47162306a36Sopenharmony_ci		rxe_counter_inc(rxe, RXE_CNT_RDMA_SEND);
47262306a36Sopenharmony_ci
47362306a36Sopenharmony_ci	/*
47462306a36Sopenharmony_ci	 * we completed something so let req run again
47562306a36Sopenharmony_ci	 * if it is trying to fence
47662306a36Sopenharmony_ci	 */
47762306a36Sopenharmony_ci	if (qp->req.wait_fence) {
47862306a36Sopenharmony_ci		qp->req.wait_fence = 0;
47962306a36Sopenharmony_ci		rxe_sched_task(&qp->req.task);
48062306a36Sopenharmony_ci	}
48162306a36Sopenharmony_ci}
48262306a36Sopenharmony_ci
48362306a36Sopenharmony_cistatic void comp_check_sq_drain_done(struct rxe_qp *qp)
48462306a36Sopenharmony_ci{
48562306a36Sopenharmony_ci	unsigned long flags;
48662306a36Sopenharmony_ci
48762306a36Sopenharmony_ci	spin_lock_irqsave(&qp->state_lock, flags);
48862306a36Sopenharmony_ci	if (unlikely(qp_state(qp) == IB_QPS_SQD)) {
48962306a36Sopenharmony_ci		if (qp->attr.sq_draining && qp->comp.psn == qp->req.psn) {
49062306a36Sopenharmony_ci			qp->attr.sq_draining = 0;
49162306a36Sopenharmony_ci			spin_unlock_irqrestore(&qp->state_lock, flags);
49262306a36Sopenharmony_ci
49362306a36Sopenharmony_ci			if (qp->ibqp.event_handler) {
49462306a36Sopenharmony_ci				struct ib_event ev;
49562306a36Sopenharmony_ci
49662306a36Sopenharmony_ci				ev.device = qp->ibqp.device;
49762306a36Sopenharmony_ci				ev.element.qp = &qp->ibqp;
49862306a36Sopenharmony_ci				ev.event = IB_EVENT_SQ_DRAINED;
49962306a36Sopenharmony_ci				qp->ibqp.event_handler(&ev,
50062306a36Sopenharmony_ci					qp->ibqp.qp_context);
50162306a36Sopenharmony_ci			}
50262306a36Sopenharmony_ci			return;
50362306a36Sopenharmony_ci		}
50462306a36Sopenharmony_ci	}
50562306a36Sopenharmony_ci	spin_unlock_irqrestore(&qp->state_lock, flags);
50662306a36Sopenharmony_ci}
50762306a36Sopenharmony_ci
50862306a36Sopenharmony_cistatic inline enum comp_state complete_ack(struct rxe_qp *qp,
50962306a36Sopenharmony_ci					   struct rxe_pkt_info *pkt,
51062306a36Sopenharmony_ci					   struct rxe_send_wqe *wqe)
51162306a36Sopenharmony_ci{
51262306a36Sopenharmony_ci	if (wqe->has_rd_atomic) {
51362306a36Sopenharmony_ci		wqe->has_rd_atomic = 0;
51462306a36Sopenharmony_ci		atomic_inc(&qp->req.rd_atomic);
51562306a36Sopenharmony_ci		if (qp->req.need_rd_atomic) {
51662306a36Sopenharmony_ci			qp->comp.timeout_retry = 0;
51762306a36Sopenharmony_ci			qp->req.need_rd_atomic = 0;
51862306a36Sopenharmony_ci			rxe_sched_task(&qp->req.task);
51962306a36Sopenharmony_ci		}
52062306a36Sopenharmony_ci	}
52162306a36Sopenharmony_ci
52262306a36Sopenharmony_ci	comp_check_sq_drain_done(qp);
52362306a36Sopenharmony_ci
52462306a36Sopenharmony_ci	do_complete(qp, wqe);
52562306a36Sopenharmony_ci
52662306a36Sopenharmony_ci	if (psn_compare(pkt->psn, qp->comp.psn) >= 0)
52762306a36Sopenharmony_ci		return COMPST_UPDATE_COMP;
52862306a36Sopenharmony_ci	else
52962306a36Sopenharmony_ci		return COMPST_DONE;
53062306a36Sopenharmony_ci}
53162306a36Sopenharmony_ci
53262306a36Sopenharmony_cistatic inline enum comp_state complete_wqe(struct rxe_qp *qp,
53362306a36Sopenharmony_ci					   struct rxe_pkt_info *pkt,
53462306a36Sopenharmony_ci					   struct rxe_send_wqe *wqe)
53562306a36Sopenharmony_ci{
53662306a36Sopenharmony_ci	if (pkt && wqe->state == wqe_state_pending) {
53762306a36Sopenharmony_ci		if (psn_compare(wqe->last_psn, qp->comp.psn) >= 0) {
53862306a36Sopenharmony_ci			qp->comp.psn = (wqe->last_psn + 1) & BTH_PSN_MASK;
53962306a36Sopenharmony_ci			qp->comp.opcode = -1;
54062306a36Sopenharmony_ci		}
54162306a36Sopenharmony_ci
54262306a36Sopenharmony_ci		if (qp->req.wait_psn) {
54362306a36Sopenharmony_ci			qp->req.wait_psn = 0;
54462306a36Sopenharmony_ci			rxe_sched_task(&qp->req.task);
54562306a36Sopenharmony_ci		}
54662306a36Sopenharmony_ci	}
54762306a36Sopenharmony_ci
54862306a36Sopenharmony_ci	do_complete(qp, wqe);
54962306a36Sopenharmony_ci
55062306a36Sopenharmony_ci	return COMPST_GET_WQE;
55162306a36Sopenharmony_ci}
55262306a36Sopenharmony_ci
55362306a36Sopenharmony_ci/* drain incoming response packet queue */
55462306a36Sopenharmony_cistatic void drain_resp_pkts(struct rxe_qp *qp)
55562306a36Sopenharmony_ci{
55662306a36Sopenharmony_ci	struct sk_buff *skb;
55762306a36Sopenharmony_ci
55862306a36Sopenharmony_ci	while ((skb = skb_dequeue(&qp->resp_pkts))) {
55962306a36Sopenharmony_ci		rxe_put(qp);
56062306a36Sopenharmony_ci		kfree_skb(skb);
56162306a36Sopenharmony_ci		ib_device_put(qp->ibqp.device);
56262306a36Sopenharmony_ci	}
56362306a36Sopenharmony_ci}
56462306a36Sopenharmony_ci
56562306a36Sopenharmony_ci/* complete send wqe with flush error */
56662306a36Sopenharmony_cistatic int flush_send_wqe(struct rxe_qp *qp, struct rxe_send_wqe *wqe)
56762306a36Sopenharmony_ci{
56862306a36Sopenharmony_ci	struct rxe_cqe cqe = {};
56962306a36Sopenharmony_ci	struct ib_wc *wc = &cqe.ibwc;
57062306a36Sopenharmony_ci	struct ib_uverbs_wc *uwc = &cqe.uibwc;
57162306a36Sopenharmony_ci	int err;
57262306a36Sopenharmony_ci
57362306a36Sopenharmony_ci	if (qp->is_user) {
57462306a36Sopenharmony_ci		uwc->wr_id = wqe->wr.wr_id;
57562306a36Sopenharmony_ci		uwc->status = IB_WC_WR_FLUSH_ERR;
57662306a36Sopenharmony_ci		uwc->qp_num = qp->ibqp.qp_num;
57762306a36Sopenharmony_ci	} else {
57862306a36Sopenharmony_ci		wc->wr_id = wqe->wr.wr_id;
57962306a36Sopenharmony_ci		wc->status = IB_WC_WR_FLUSH_ERR;
58062306a36Sopenharmony_ci		wc->qp = &qp->ibqp;
58162306a36Sopenharmony_ci	}
58262306a36Sopenharmony_ci
58362306a36Sopenharmony_ci	err = rxe_cq_post(qp->scq, &cqe, 0);
58462306a36Sopenharmony_ci	if (err)
58562306a36Sopenharmony_ci		rxe_dbg_cq(qp->scq, "post cq failed, err = %d", err);
58662306a36Sopenharmony_ci
58762306a36Sopenharmony_ci	return err;
58862306a36Sopenharmony_ci}
58962306a36Sopenharmony_ci
59062306a36Sopenharmony_ci/* drain and optionally complete the send queue
59162306a36Sopenharmony_ci * if unable to complete a wqe, i.e. cq is full, stop
59262306a36Sopenharmony_ci * completing and flush the remaining wqes
59362306a36Sopenharmony_ci */
59462306a36Sopenharmony_cistatic void flush_send_queue(struct rxe_qp *qp, bool notify)
59562306a36Sopenharmony_ci{
59662306a36Sopenharmony_ci	struct rxe_send_wqe *wqe;
59762306a36Sopenharmony_ci	struct rxe_queue *q = qp->sq.queue;
59862306a36Sopenharmony_ci	int err;
59962306a36Sopenharmony_ci
60062306a36Sopenharmony_ci	/* send queue never got created. nothing to do. */
60162306a36Sopenharmony_ci	if (!qp->sq.queue)
60262306a36Sopenharmony_ci		return;
60362306a36Sopenharmony_ci
60462306a36Sopenharmony_ci	while ((wqe = queue_head(q, q->type))) {
60562306a36Sopenharmony_ci		if (notify) {
60662306a36Sopenharmony_ci			err = flush_send_wqe(qp, wqe);
60762306a36Sopenharmony_ci			if (err)
60862306a36Sopenharmony_ci				notify = 0;
60962306a36Sopenharmony_ci		}
61062306a36Sopenharmony_ci		queue_advance_consumer(q, q->type);
61162306a36Sopenharmony_ci	}
61262306a36Sopenharmony_ci}
61362306a36Sopenharmony_ci
61462306a36Sopenharmony_cistatic void free_pkt(struct rxe_pkt_info *pkt)
61562306a36Sopenharmony_ci{
61662306a36Sopenharmony_ci	struct sk_buff *skb = PKT_TO_SKB(pkt);
61762306a36Sopenharmony_ci	struct rxe_qp *qp = pkt->qp;
61862306a36Sopenharmony_ci	struct ib_device *dev = qp->ibqp.device;
61962306a36Sopenharmony_ci
62062306a36Sopenharmony_ci	kfree_skb(skb);
62162306a36Sopenharmony_ci	rxe_put(qp);
62262306a36Sopenharmony_ci	ib_device_put(dev);
62362306a36Sopenharmony_ci}
62462306a36Sopenharmony_ci
62562306a36Sopenharmony_ci/* reset the retry timer if
62662306a36Sopenharmony_ci * - QP is type RC
62762306a36Sopenharmony_ci * - there is a packet sent by the requester that
62862306a36Sopenharmony_ci *   might be acked (we still might get spurious
62962306a36Sopenharmony_ci *   timeouts but try to keep them as few as possible)
63062306a36Sopenharmony_ci * - the timeout parameter is set
63162306a36Sopenharmony_ci * - the QP is alive
63262306a36Sopenharmony_ci */
63362306a36Sopenharmony_cistatic void reset_retry_timer(struct rxe_qp *qp)
63462306a36Sopenharmony_ci{
63562306a36Sopenharmony_ci	unsigned long flags;
63662306a36Sopenharmony_ci
63762306a36Sopenharmony_ci	if (qp_type(qp) == IB_QPT_RC && qp->qp_timeout_jiffies) {
63862306a36Sopenharmony_ci		spin_lock_irqsave(&qp->state_lock, flags);
63962306a36Sopenharmony_ci		if (qp_state(qp) >= IB_QPS_RTS &&
64062306a36Sopenharmony_ci		    psn_compare(qp->req.psn, qp->comp.psn) > 0)
64162306a36Sopenharmony_ci			mod_timer(&qp->retrans_timer,
64262306a36Sopenharmony_ci				  jiffies + qp->qp_timeout_jiffies);
64362306a36Sopenharmony_ci		spin_unlock_irqrestore(&qp->state_lock, flags);
64462306a36Sopenharmony_ci	}
64562306a36Sopenharmony_ci}
64662306a36Sopenharmony_ci
64762306a36Sopenharmony_ciint rxe_completer(struct rxe_qp *qp)
64862306a36Sopenharmony_ci{
64962306a36Sopenharmony_ci	struct rxe_dev *rxe = to_rdev(qp->ibqp.device);
65062306a36Sopenharmony_ci	struct rxe_send_wqe *wqe = NULL;
65162306a36Sopenharmony_ci	struct sk_buff *skb = NULL;
65262306a36Sopenharmony_ci	struct rxe_pkt_info *pkt = NULL;
65362306a36Sopenharmony_ci	enum comp_state state;
65462306a36Sopenharmony_ci	int ret;
65562306a36Sopenharmony_ci	unsigned long flags;
65662306a36Sopenharmony_ci
65762306a36Sopenharmony_ci	spin_lock_irqsave(&qp->state_lock, flags);
65862306a36Sopenharmony_ci	if (!qp->valid || qp_state(qp) == IB_QPS_ERR ||
65962306a36Sopenharmony_ci			  qp_state(qp) == IB_QPS_RESET) {
66062306a36Sopenharmony_ci		bool notify = qp->valid && (qp_state(qp) == IB_QPS_ERR);
66162306a36Sopenharmony_ci
66262306a36Sopenharmony_ci		drain_resp_pkts(qp);
66362306a36Sopenharmony_ci		flush_send_queue(qp, notify);
66462306a36Sopenharmony_ci		spin_unlock_irqrestore(&qp->state_lock, flags);
66562306a36Sopenharmony_ci		goto exit;
66662306a36Sopenharmony_ci	}
66762306a36Sopenharmony_ci	spin_unlock_irqrestore(&qp->state_lock, flags);
66862306a36Sopenharmony_ci
66962306a36Sopenharmony_ci	if (qp->comp.timeout) {
67062306a36Sopenharmony_ci		qp->comp.timeout_retry = 1;
67162306a36Sopenharmony_ci		qp->comp.timeout = 0;
67262306a36Sopenharmony_ci	} else {
67362306a36Sopenharmony_ci		qp->comp.timeout_retry = 0;
67462306a36Sopenharmony_ci	}
67562306a36Sopenharmony_ci
67662306a36Sopenharmony_ci	if (qp->req.need_retry)
67762306a36Sopenharmony_ci		goto exit;
67862306a36Sopenharmony_ci
67962306a36Sopenharmony_ci	state = COMPST_GET_ACK;
68062306a36Sopenharmony_ci
68162306a36Sopenharmony_ci	while (1) {
68262306a36Sopenharmony_ci		rxe_dbg_qp(qp, "state = %s\n", comp_state_name[state]);
68362306a36Sopenharmony_ci		switch (state) {
68462306a36Sopenharmony_ci		case COMPST_GET_ACK:
68562306a36Sopenharmony_ci			skb = skb_dequeue(&qp->resp_pkts);
68662306a36Sopenharmony_ci			if (skb) {
68762306a36Sopenharmony_ci				pkt = SKB_TO_PKT(skb);
68862306a36Sopenharmony_ci				qp->comp.timeout_retry = 0;
68962306a36Sopenharmony_ci			}
69062306a36Sopenharmony_ci			state = COMPST_GET_WQE;
69162306a36Sopenharmony_ci			break;
69262306a36Sopenharmony_ci
69362306a36Sopenharmony_ci		case COMPST_GET_WQE:
69462306a36Sopenharmony_ci			state = get_wqe(qp, pkt, &wqe);
69562306a36Sopenharmony_ci			break;
69662306a36Sopenharmony_ci
69762306a36Sopenharmony_ci		case COMPST_CHECK_PSN:
69862306a36Sopenharmony_ci			state = check_psn(qp, pkt, wqe);
69962306a36Sopenharmony_ci			break;
70062306a36Sopenharmony_ci
70162306a36Sopenharmony_ci		case COMPST_CHECK_ACK:
70262306a36Sopenharmony_ci			state = check_ack(qp, pkt, wqe);
70362306a36Sopenharmony_ci			break;
70462306a36Sopenharmony_ci
70562306a36Sopenharmony_ci		case COMPST_READ:
70662306a36Sopenharmony_ci			state = do_read(qp, pkt, wqe);
70762306a36Sopenharmony_ci			break;
70862306a36Sopenharmony_ci
70962306a36Sopenharmony_ci		case COMPST_ATOMIC:
71062306a36Sopenharmony_ci			state = do_atomic(qp, pkt, wqe);
71162306a36Sopenharmony_ci			break;
71262306a36Sopenharmony_ci
71362306a36Sopenharmony_ci		case COMPST_WRITE_SEND:
71462306a36Sopenharmony_ci			if (wqe->state == wqe_state_pending &&
71562306a36Sopenharmony_ci			    wqe->last_psn == pkt->psn)
71662306a36Sopenharmony_ci				state = COMPST_COMP_ACK;
71762306a36Sopenharmony_ci			else
71862306a36Sopenharmony_ci				state = COMPST_UPDATE_COMP;
71962306a36Sopenharmony_ci			break;
72062306a36Sopenharmony_ci
72162306a36Sopenharmony_ci		case COMPST_COMP_ACK:
72262306a36Sopenharmony_ci			state = complete_ack(qp, pkt, wqe);
72362306a36Sopenharmony_ci			break;
72462306a36Sopenharmony_ci
72562306a36Sopenharmony_ci		case COMPST_COMP_WQE:
72662306a36Sopenharmony_ci			state = complete_wqe(qp, pkt, wqe);
72762306a36Sopenharmony_ci			break;
72862306a36Sopenharmony_ci
72962306a36Sopenharmony_ci		case COMPST_UPDATE_COMP:
73062306a36Sopenharmony_ci			if (pkt->mask & RXE_END_MASK)
73162306a36Sopenharmony_ci				qp->comp.opcode = -1;
73262306a36Sopenharmony_ci			else
73362306a36Sopenharmony_ci				qp->comp.opcode = pkt->opcode;
73462306a36Sopenharmony_ci
73562306a36Sopenharmony_ci			if (psn_compare(pkt->psn, qp->comp.psn) >= 0)
73662306a36Sopenharmony_ci				qp->comp.psn = (pkt->psn + 1) & BTH_PSN_MASK;
73762306a36Sopenharmony_ci
73862306a36Sopenharmony_ci			if (qp->req.wait_psn) {
73962306a36Sopenharmony_ci				qp->req.wait_psn = 0;
74062306a36Sopenharmony_ci				rxe_sched_task(&qp->req.task);
74162306a36Sopenharmony_ci			}
74262306a36Sopenharmony_ci
74362306a36Sopenharmony_ci			state = COMPST_DONE;
74462306a36Sopenharmony_ci			break;
74562306a36Sopenharmony_ci
74662306a36Sopenharmony_ci		case COMPST_DONE:
74762306a36Sopenharmony_ci			goto done;
74862306a36Sopenharmony_ci
74962306a36Sopenharmony_ci		case COMPST_EXIT:
75062306a36Sopenharmony_ci			if (qp->comp.timeout_retry && wqe) {
75162306a36Sopenharmony_ci				state = COMPST_ERROR_RETRY;
75262306a36Sopenharmony_ci				break;
75362306a36Sopenharmony_ci			}
75462306a36Sopenharmony_ci
75562306a36Sopenharmony_ci			reset_retry_timer(qp);
75662306a36Sopenharmony_ci			goto exit;
75762306a36Sopenharmony_ci
75862306a36Sopenharmony_ci		case COMPST_ERROR_RETRY:
75962306a36Sopenharmony_ci			/* we come here if the retry timer fired and we did
76062306a36Sopenharmony_ci			 * not receive a response packet. try to retry the send
76162306a36Sopenharmony_ci			 * queue if that makes sense and the limits have not
76262306a36Sopenharmony_ci			 * been exceeded. remember that some timeouts are
76362306a36Sopenharmony_ci			 * spurious since we do not reset the timer but kick
76462306a36Sopenharmony_ci			 * it down the road or let it expire
76562306a36Sopenharmony_ci			 */
76662306a36Sopenharmony_ci
76762306a36Sopenharmony_ci			/* there is nothing to retry in this case */
76862306a36Sopenharmony_ci			if (!wqe || (wqe->state == wqe_state_posted))
76962306a36Sopenharmony_ci				goto exit;
77062306a36Sopenharmony_ci
77162306a36Sopenharmony_ci			/* if we've started a retry, don't start another
77262306a36Sopenharmony_ci			 * retry sequence, unless this is a timeout.
77362306a36Sopenharmony_ci			 */
77462306a36Sopenharmony_ci			if (qp->comp.started_retry &&
77562306a36Sopenharmony_ci			    !qp->comp.timeout_retry)
77662306a36Sopenharmony_ci				goto done;
77762306a36Sopenharmony_ci
77862306a36Sopenharmony_ci			if (qp->comp.retry_cnt > 0) {
77962306a36Sopenharmony_ci				if (qp->comp.retry_cnt != 7)
78062306a36Sopenharmony_ci					qp->comp.retry_cnt--;
78162306a36Sopenharmony_ci
78262306a36Sopenharmony_ci				/* no point in retrying if we have already
78362306a36Sopenharmony_ci				 * seen the last ack that the requester could
78462306a36Sopenharmony_ci				 * have caused
78562306a36Sopenharmony_ci				 */
78662306a36Sopenharmony_ci				if (psn_compare(qp->req.psn,
78762306a36Sopenharmony_ci						qp->comp.psn) > 0) {
78862306a36Sopenharmony_ci					/* tell the requester to retry the
78962306a36Sopenharmony_ci					 * send queue next time around
79062306a36Sopenharmony_ci					 */
79162306a36Sopenharmony_ci					rxe_counter_inc(rxe,
79262306a36Sopenharmony_ci							RXE_CNT_COMP_RETRY);
79362306a36Sopenharmony_ci					qp->req.need_retry = 1;
79462306a36Sopenharmony_ci					qp->comp.started_retry = 1;
79562306a36Sopenharmony_ci					rxe_sched_task(&qp->req.task);
79662306a36Sopenharmony_ci				}
79762306a36Sopenharmony_ci				goto done;
79862306a36Sopenharmony_ci
79962306a36Sopenharmony_ci			} else {
80062306a36Sopenharmony_ci				rxe_counter_inc(rxe, RXE_CNT_RETRY_EXCEEDED);
80162306a36Sopenharmony_ci				wqe->status = IB_WC_RETRY_EXC_ERR;
80262306a36Sopenharmony_ci				state = COMPST_ERROR;
80362306a36Sopenharmony_ci			}
80462306a36Sopenharmony_ci			break;
80562306a36Sopenharmony_ci
80662306a36Sopenharmony_ci		case COMPST_RNR_RETRY:
80762306a36Sopenharmony_ci			/* we come here if we received an RNR NAK */
80862306a36Sopenharmony_ci			if (qp->comp.rnr_retry > 0) {
80962306a36Sopenharmony_ci				if (qp->comp.rnr_retry != 7)
81062306a36Sopenharmony_ci					qp->comp.rnr_retry--;
81162306a36Sopenharmony_ci
81262306a36Sopenharmony_ci				/* don't start a retry flow until the
81362306a36Sopenharmony_ci				 * rnr timer has fired
81462306a36Sopenharmony_ci				 */
81562306a36Sopenharmony_ci				qp->req.wait_for_rnr_timer = 1;
81662306a36Sopenharmony_ci				rxe_dbg_qp(qp, "set rnr nak timer\n");
81762306a36Sopenharmony_ci				// TODO who protects from destroy_qp??
81862306a36Sopenharmony_ci				mod_timer(&qp->rnr_nak_timer,
81962306a36Sopenharmony_ci					  jiffies + rnrnak_jiffies(aeth_syn(pkt)
82062306a36Sopenharmony_ci						& ~AETH_TYPE_MASK));
82162306a36Sopenharmony_ci				goto exit;
82262306a36Sopenharmony_ci			} else {
82362306a36Sopenharmony_ci				rxe_counter_inc(rxe,
82462306a36Sopenharmony_ci						RXE_CNT_RNR_RETRY_EXCEEDED);
82562306a36Sopenharmony_ci				wqe->status = IB_WC_RNR_RETRY_EXC_ERR;
82662306a36Sopenharmony_ci				state = COMPST_ERROR;
82762306a36Sopenharmony_ci			}
82862306a36Sopenharmony_ci			break;
82962306a36Sopenharmony_ci
83062306a36Sopenharmony_ci		case COMPST_ERROR:
83162306a36Sopenharmony_ci			WARN_ON_ONCE(wqe->status == IB_WC_SUCCESS);
83262306a36Sopenharmony_ci			do_complete(qp, wqe);
83362306a36Sopenharmony_ci			rxe_qp_error(qp);
83462306a36Sopenharmony_ci			goto exit;
83562306a36Sopenharmony_ci		}
83662306a36Sopenharmony_ci	}
83762306a36Sopenharmony_ci
83862306a36Sopenharmony_ci	/* A non-zero return value will cause rxe_do_task to
83962306a36Sopenharmony_ci	 * exit its loop and end the work item. A zero return
84062306a36Sopenharmony_ci	 * will continue looping and return to rxe_completer
84162306a36Sopenharmony_ci	 */
84262306a36Sopenharmony_cidone:
84362306a36Sopenharmony_ci	ret = 0;
84462306a36Sopenharmony_ci	goto out;
84562306a36Sopenharmony_ciexit:
84662306a36Sopenharmony_ci	ret = -EAGAIN;
84762306a36Sopenharmony_ciout:
84862306a36Sopenharmony_ci	if (pkt)
84962306a36Sopenharmony_ci		free_pkt(pkt);
85062306a36Sopenharmony_ci	return ret;
85162306a36Sopenharmony_ci}
852