| // SPDX-License-Identifier: GPL-2.0 | 
 | /* | 
 |  *  Shared Memory Communications over RDMA (SMC-R) and RoCE | 
 |  * | 
 |  *  Link Layer Control (LLC) | 
 |  * | 
 |  *  Copyright IBM Corp. 2016 | 
 |  * | 
 |  *  Author(s):  Klaus Wacker <Klaus.Wacker@de.ibm.com> | 
 |  *              Ursula Braun <ubraun@linux.vnet.ibm.com> | 
 |  */ | 
 |  | 
 | #include <net/tcp.h> | 
 | #include <rdma/ib_verbs.h> | 
 |  | 
 | #include "smc.h" | 
 | #include "smc_core.h" | 
 | #include "smc_clc.h" | 
 | #include "smc_llc.h" | 
 |  | 
 | #define SMC_LLC_DATA_LEN		40 | 
 |  | 
 | struct smc_llc_hdr { | 
 | 	struct smc_wr_rx_hdr common; | 
 | 	u8 length;	/* 44 */ | 
 | #if defined(__BIG_ENDIAN_BITFIELD) | 
 | 	u8 reserved:4, | 
 | 	   add_link_rej_rsn:4; | 
 | #elif defined(__LITTLE_ENDIAN_BITFIELD) | 
 | 	u8 add_link_rej_rsn:4, | 
 | 	   reserved:4; | 
 | #endif | 
 | 	u8 flags; | 
 | }; | 
 |  | 
 | #define SMC_LLC_FLAG_NO_RMBE_EYEC	0x03 | 
 |  | 
 | struct smc_llc_msg_confirm_link {	/* type 0x01 */ | 
 | 	struct smc_llc_hdr hd; | 
 | 	u8 sender_mac[ETH_ALEN]; | 
 | 	u8 sender_gid[SMC_GID_SIZE]; | 
 | 	u8 sender_qp_num[3]; | 
 | 	u8 link_num; | 
 | 	u8 link_uid[SMC_LGR_ID_SIZE]; | 
 | 	u8 max_links; | 
 | 	u8 reserved[9]; | 
 | }; | 
 |  | 
 | #define SMC_LLC_FLAG_ADD_LNK_REJ	0x40 | 
 | #define SMC_LLC_REJ_RSN_NO_ALT_PATH	1 | 
 |  | 
 | #define SMC_LLC_ADD_LNK_MAX_LINKS	2 | 
 |  | 
 | struct smc_llc_msg_add_link {		/* type 0x02 */ | 
 | 	struct smc_llc_hdr hd; | 
 | 	u8 sender_mac[ETH_ALEN]; | 
 | 	u8 reserved2[2]; | 
 | 	u8 sender_gid[SMC_GID_SIZE]; | 
 | 	u8 sender_qp_num[3]; | 
 | 	u8 link_num; | 
 | 	u8 flags2;	/* QP mtu */ | 
 | 	u8 initial_psn[3]; | 
 | 	u8 reserved[8]; | 
 | }; | 
 |  | 
 | #define SMC_LLC_FLAG_DEL_LINK_ALL	0x40 | 
 | #define SMC_LLC_FLAG_DEL_LINK_ORDERLY	0x20 | 
 |  | 
 | struct smc_llc_msg_del_link {		/* type 0x04 */ | 
 | 	struct smc_llc_hdr hd; | 
 | 	u8 link_num; | 
 | 	__be32 reason; | 
 | 	u8 reserved[35]; | 
 | } __packed;			/* format defined in RFC7609 */ | 
 |  | 
 | struct smc_llc_msg_test_link {		/* type 0x07 */ | 
 | 	struct smc_llc_hdr hd; | 
 | 	u8 user_data[16]; | 
 | 	u8 reserved[24]; | 
 | }; | 
 |  | 
 | struct smc_rmb_rtoken { | 
 | 	union { | 
 | 		u8 num_rkeys;	/* first rtoken byte of CONFIRM LINK msg */ | 
 | 				/* is actually the num of rtokens, first */ | 
 | 				/* rtoken is always for the current link */ | 
 | 		u8 link_id;	/* link id of the rtoken */ | 
 | 	}; | 
 | 	__be32 rmb_key; | 
 | 	__be64 rmb_vaddr; | 
 | } __packed;			/* format defined in RFC7609 */ | 
 |  | 
 | #define SMC_LLC_RKEYS_PER_MSG	3 | 
 |  | 
 | struct smc_llc_msg_confirm_rkey {	/* type 0x06 */ | 
 | 	struct smc_llc_hdr hd; | 
 | 	struct smc_rmb_rtoken rtoken[SMC_LLC_RKEYS_PER_MSG]; | 
 | 	u8 reserved; | 
 | }; | 
 |  | 
 | struct smc_llc_msg_confirm_rkey_cont {	/* type 0x08 */ | 
 | 	struct smc_llc_hdr hd; | 
 | 	u8 num_rkeys; | 
 | 	struct smc_rmb_rtoken rtoken[SMC_LLC_RKEYS_PER_MSG]; | 
 | }; | 
 |  | 
 | #define SMC_LLC_DEL_RKEY_MAX	8 | 
 | #define SMC_LLC_FLAG_RKEY_NEG	0x20 | 
 |  | 
 | struct smc_llc_msg_delete_rkey {	/* type 0x09 */ | 
 | 	struct smc_llc_hdr hd; | 
 | 	u8 num_rkeys; | 
 | 	u8 err_mask; | 
 | 	u8 reserved[2]; | 
 | 	__be32 rkey[8]; | 
 | 	u8 reserved2[4]; | 
 | }; | 
 |  | 
 | union smc_llc_msg { | 
 | 	struct smc_llc_msg_confirm_link confirm_link; | 
 | 	struct smc_llc_msg_add_link add_link; | 
 | 	struct smc_llc_msg_del_link delete_link; | 
 |  | 
 | 	struct smc_llc_msg_confirm_rkey confirm_rkey; | 
 | 	struct smc_llc_msg_confirm_rkey_cont confirm_rkey_cont; | 
 | 	struct smc_llc_msg_delete_rkey delete_rkey; | 
 |  | 
 | 	struct smc_llc_msg_test_link test_link; | 
 | 	struct { | 
 | 		struct smc_llc_hdr hdr; | 
 | 		u8 data[SMC_LLC_DATA_LEN]; | 
 | 	} raw; | 
 | }; | 
 |  | 
 | #define SMC_LLC_FLAG_RESP		0x80 | 
 |  | 
 | /********************************** send *************************************/ | 
 |  | 
 | struct smc_llc_tx_pend { | 
 | }; | 
 |  | 
 | /* handler for send/transmission completion of an LLC msg */ | 
 | static void smc_llc_tx_handler(struct smc_wr_tx_pend_priv *pend, | 
 | 			       struct smc_link *link, | 
 | 			       enum ib_wc_status wc_status) | 
 | { | 
 | 	/* future work: handle wc_status error for recovery and failover */ | 
 | } | 
 |  | 
 | /** | 
 |  * smc_llc_add_pending_send() - add LLC control message to pending WQE transmits | 
 |  * @link: Pointer to SMC link used for sending LLC control message. | 
 |  * @wr_buf: Out variable returning pointer to work request payload buffer. | 
 |  * @pend: Out variable returning pointer to private pending WR tracking. | 
 |  *	  It's the context the transmit complete handler will get. | 
 |  * | 
 |  * Reserves and pre-fills an entry for a pending work request send/tx. | 
 |  * Used by mid-level smc_llc_send_msg() to prepare for later actual send/tx. | 
 |  * Can sleep due to smc_get_ctrl_buf (if not in softirq context). | 
 |  * | 
 |  * Return: 0 on success, otherwise an error value. | 
 |  */ | 
 | static int smc_llc_add_pending_send(struct smc_link *link, | 
 | 				    struct smc_wr_buf **wr_buf, | 
 | 				    struct smc_wr_tx_pend_priv **pend) | 
 | { | 
 | 	int rc; | 
 |  | 
 | 	rc = smc_wr_tx_get_free_slot(link, smc_llc_tx_handler, wr_buf, pend); | 
 | 	if (rc < 0) | 
 | 		return rc; | 
 | 	BUILD_BUG_ON_MSG( | 
 | 		sizeof(union smc_llc_msg) > SMC_WR_BUF_SIZE, | 
 | 		"must increase SMC_WR_BUF_SIZE to at least sizeof(struct smc_llc_msg)"); | 
 | 	BUILD_BUG_ON_MSG( | 
 | 		sizeof(union smc_llc_msg) != SMC_WR_TX_SIZE, | 
 | 		"must adapt SMC_WR_TX_SIZE to sizeof(struct smc_llc_msg); if not all smc_wr upper layer protocols use the same message size any more, must start to set link->wr_tx_sges[i].length on each individual smc_wr_tx_send()"); | 
 | 	BUILD_BUG_ON_MSG( | 
 | 		sizeof(struct smc_llc_tx_pend) > SMC_WR_TX_PEND_PRIV_SIZE, | 
 | 		"must increase SMC_WR_TX_PEND_PRIV_SIZE to at least sizeof(struct smc_llc_tx_pend)"); | 
 | 	return 0; | 
 | } | 
 |  | 
 | /* high-level API to send LLC confirm link */ | 
 | int smc_llc_send_confirm_link(struct smc_link *link, | 
 | 			      enum smc_llc_reqresp reqresp) | 
 | { | 
 | 	struct smc_link_group *lgr = smc_get_lgr(link); | 
 | 	struct smc_llc_msg_confirm_link *confllc; | 
 | 	struct smc_wr_tx_pend_priv *pend; | 
 | 	struct smc_wr_buf *wr_buf; | 
 | 	int rc; | 
 |  | 
 | 	rc = smc_llc_add_pending_send(link, &wr_buf, &pend); | 
 | 	if (rc) | 
 | 		return rc; | 
 | 	confllc = (struct smc_llc_msg_confirm_link *)wr_buf; | 
 | 	memset(confllc, 0, sizeof(*confllc)); | 
 | 	confllc->hd.common.type = SMC_LLC_CONFIRM_LINK; | 
 | 	confllc->hd.length = sizeof(struct smc_llc_msg_confirm_link); | 
 | 	confllc->hd.flags |= SMC_LLC_FLAG_NO_RMBE_EYEC; | 
 | 	if (reqresp == SMC_LLC_RESP) | 
 | 		confllc->hd.flags |= SMC_LLC_FLAG_RESP; | 
 | 	memcpy(confllc->sender_mac, link->smcibdev->mac[link->ibport - 1], | 
 | 	       ETH_ALEN); | 
 | 	memcpy(confllc->sender_gid, link->gid, SMC_GID_SIZE); | 
 | 	hton24(confllc->sender_qp_num, link->roce_qp->qp_num); | 
 | 	confllc->link_num = link->link_id; | 
 | 	memcpy(confllc->link_uid, lgr->id, SMC_LGR_ID_SIZE); | 
 | 	confllc->max_links = SMC_LLC_ADD_LNK_MAX_LINKS; /* enforce peer resp. */ | 
 | 	/* send llc message */ | 
 | 	rc = smc_wr_tx_send(link, pend); | 
 | 	return rc; | 
 | } | 
 |  | 
 | /* send LLC confirm rkey request */ | 
 | static int smc_llc_send_confirm_rkey(struct smc_link *link, | 
 | 				     struct smc_buf_desc *rmb_desc) | 
 | { | 
 | 	struct smc_llc_msg_confirm_rkey *rkeyllc; | 
 | 	struct smc_wr_tx_pend_priv *pend; | 
 | 	struct smc_wr_buf *wr_buf; | 
 | 	int rc; | 
 |  | 
 | 	rc = smc_llc_add_pending_send(link, &wr_buf, &pend); | 
 | 	if (rc) | 
 | 		return rc; | 
 | 	rkeyllc = (struct smc_llc_msg_confirm_rkey *)wr_buf; | 
 | 	memset(rkeyllc, 0, sizeof(*rkeyllc)); | 
 | 	rkeyllc->hd.common.type = SMC_LLC_CONFIRM_RKEY; | 
 | 	rkeyllc->hd.length = sizeof(struct smc_llc_msg_confirm_rkey); | 
 | 	rkeyllc->rtoken[0].rmb_key = | 
 | 		htonl(rmb_desc->mr_rx[SMC_SINGLE_LINK]->rkey); | 
 | 	rkeyllc->rtoken[0].rmb_vaddr = cpu_to_be64( | 
 | 		(u64)sg_dma_address(rmb_desc->sgt[SMC_SINGLE_LINK].sgl)); | 
 | 	/* send llc message */ | 
 | 	rc = smc_wr_tx_send(link, pend); | 
 | 	return rc; | 
 | } | 
 |  | 
 | /* prepare an add link message */ | 
 | static void smc_llc_prep_add_link(struct smc_llc_msg_add_link *addllc, | 
 | 				  struct smc_link *link, u8 mac[], u8 gid[], | 
 | 				  enum smc_llc_reqresp reqresp) | 
 | { | 
 | 	memset(addllc, 0, sizeof(*addllc)); | 
 | 	addllc->hd.common.type = SMC_LLC_ADD_LINK; | 
 | 	addllc->hd.length = sizeof(struct smc_llc_msg_add_link); | 
 | 	if (reqresp == SMC_LLC_RESP) { | 
 | 		addllc->hd.flags |= SMC_LLC_FLAG_RESP; | 
 | 		/* always reject more links for now */ | 
 | 		addllc->hd.flags |= SMC_LLC_FLAG_ADD_LNK_REJ; | 
 | 		addllc->hd.add_link_rej_rsn = SMC_LLC_REJ_RSN_NO_ALT_PATH; | 
 | 	} | 
 | 	memcpy(addllc->sender_mac, mac, ETH_ALEN); | 
 | 	memcpy(addllc->sender_gid, gid, SMC_GID_SIZE); | 
 | } | 
 |  | 
 | /* send ADD LINK request or response */ | 
 | int smc_llc_send_add_link(struct smc_link *link, u8 mac[], u8 gid[], | 
 | 			  enum smc_llc_reqresp reqresp) | 
 | { | 
 | 	struct smc_llc_msg_add_link *addllc; | 
 | 	struct smc_wr_tx_pend_priv *pend; | 
 | 	struct smc_wr_buf *wr_buf; | 
 | 	int rc; | 
 |  | 
 | 	rc = smc_llc_add_pending_send(link, &wr_buf, &pend); | 
 | 	if (rc) | 
 | 		return rc; | 
 | 	addllc = (struct smc_llc_msg_add_link *)wr_buf; | 
 | 	smc_llc_prep_add_link(addllc, link, mac, gid, reqresp); | 
 | 	/* send llc message */ | 
 | 	rc = smc_wr_tx_send(link, pend); | 
 | 	return rc; | 
 | } | 
 |  | 
 | /* prepare a delete link message */ | 
 | static void smc_llc_prep_delete_link(struct smc_llc_msg_del_link *delllc, | 
 | 				     struct smc_link *link, | 
 | 				     enum smc_llc_reqresp reqresp, bool orderly) | 
 | { | 
 | 	memset(delllc, 0, sizeof(*delllc)); | 
 | 	delllc->hd.common.type = SMC_LLC_DELETE_LINK; | 
 | 	delllc->hd.length = sizeof(struct smc_llc_msg_add_link); | 
 | 	if (reqresp == SMC_LLC_RESP) | 
 | 		delllc->hd.flags |= SMC_LLC_FLAG_RESP; | 
 | 	/* DEL_LINK_ALL because only 1 link supported */ | 
 | 	delllc->hd.flags |= SMC_LLC_FLAG_DEL_LINK_ALL; | 
 | 	if (orderly) | 
 | 		delllc->hd.flags |= SMC_LLC_FLAG_DEL_LINK_ORDERLY; | 
 | 	delllc->link_num = link->link_id; | 
 | } | 
 |  | 
 | /* send DELETE LINK request or response */ | 
 | int smc_llc_send_delete_link(struct smc_link *link, | 
 | 			     enum smc_llc_reqresp reqresp, bool orderly) | 
 | { | 
 | 	struct smc_llc_msg_del_link *delllc; | 
 | 	struct smc_wr_tx_pend_priv *pend; | 
 | 	struct smc_wr_buf *wr_buf; | 
 | 	int rc; | 
 |  | 
 | 	rc = smc_llc_add_pending_send(link, &wr_buf, &pend); | 
 | 	if (rc) | 
 | 		return rc; | 
 | 	delllc = (struct smc_llc_msg_del_link *)wr_buf; | 
 | 	smc_llc_prep_delete_link(delllc, link, reqresp, orderly); | 
 | 	/* send llc message */ | 
 | 	rc = smc_wr_tx_send(link, pend); | 
 | 	return rc; | 
 | } | 
 |  | 
 | /* send LLC test link request */ | 
 | static int smc_llc_send_test_link(struct smc_link *link, u8 user_data[16]) | 
 | { | 
 | 	struct smc_llc_msg_test_link *testllc; | 
 | 	struct smc_wr_tx_pend_priv *pend; | 
 | 	struct smc_wr_buf *wr_buf; | 
 | 	int rc; | 
 |  | 
 | 	rc = smc_llc_add_pending_send(link, &wr_buf, &pend); | 
 | 	if (rc) | 
 | 		return rc; | 
 | 	testllc = (struct smc_llc_msg_test_link *)wr_buf; | 
 | 	memset(testllc, 0, sizeof(*testllc)); | 
 | 	testllc->hd.common.type = SMC_LLC_TEST_LINK; | 
 | 	testllc->hd.length = sizeof(struct smc_llc_msg_test_link); | 
 | 	memcpy(testllc->user_data, user_data, sizeof(testllc->user_data)); | 
 | 	/* send llc message */ | 
 | 	rc = smc_wr_tx_send(link, pend); | 
 | 	return rc; | 
 | } | 
 |  | 
 | struct smc_llc_send_work { | 
 | 	struct work_struct work; | 
 | 	struct smc_link *link; | 
 | 	int llclen; | 
 | 	union smc_llc_msg llcbuf; | 
 | }; | 
 |  | 
 | /* worker that sends a prepared message */ | 
 | static void smc_llc_send_message_work(struct work_struct *work) | 
 | { | 
 | 	struct smc_llc_send_work *llcwrk = container_of(work, | 
 | 						struct smc_llc_send_work, work); | 
 | 	struct smc_wr_tx_pend_priv *pend; | 
 | 	struct smc_wr_buf *wr_buf; | 
 | 	int rc; | 
 |  | 
 | 	if (llcwrk->link->state == SMC_LNK_INACTIVE) | 
 | 		goto out; | 
 | 	rc = smc_llc_add_pending_send(llcwrk->link, &wr_buf, &pend); | 
 | 	if (rc) | 
 | 		goto out; | 
 | 	memcpy(wr_buf, &llcwrk->llcbuf, llcwrk->llclen); | 
 | 	smc_wr_tx_send(llcwrk->link, pend); | 
 | out: | 
 | 	kfree(llcwrk); | 
 | } | 
 |  | 
 | /* copy llcbuf and schedule an llc send on link */ | 
 | static int smc_llc_send_message(struct smc_link *link, void *llcbuf, int llclen) | 
 | { | 
 | 	struct smc_llc_send_work *wrk = kmalloc(sizeof(*wrk), GFP_ATOMIC); | 
 |  | 
 | 	if (!wrk) | 
 | 		return -ENOMEM; | 
 | 	INIT_WORK(&wrk->work, smc_llc_send_message_work); | 
 | 	wrk->link = link; | 
 | 	wrk->llclen = llclen; | 
 | 	memcpy(&wrk->llcbuf, llcbuf, llclen); | 
 | 	queue_work(link->llc_wq, &wrk->work); | 
 | 	return 0; | 
 | } | 
 |  | 
 | /********************************* receive ***********************************/ | 
 |  | 
 | static void smc_llc_rx_confirm_link(struct smc_link *link, | 
 | 				    struct smc_llc_msg_confirm_link *llc) | 
 | { | 
 | 	struct smc_link_group *lgr = smc_get_lgr(link); | 
 | 	int conf_rc; | 
 |  | 
 | 	/* RMBE eyecatchers are not supported */ | 
 | 	if (llc->hd.flags & SMC_LLC_FLAG_NO_RMBE_EYEC) | 
 | 		conf_rc = 0; | 
 | 	else | 
 | 		conf_rc = ENOTSUPP; | 
 |  | 
 | 	if (llc->hd.flags & SMC_LLC_FLAG_RESP) { | 
 | 		if (lgr->role == SMC_SERV && | 
 | 		    link->state == SMC_LNK_ACTIVATING) { | 
 | 			link->llc_confirm_resp_rc = conf_rc; | 
 | 			complete(&link->llc_confirm_resp); | 
 | 		} | 
 | 	} else { | 
 | 		if (lgr->role == SMC_CLNT && | 
 | 		    link->state == SMC_LNK_ACTIVATING) { | 
 | 			link->llc_confirm_rc = conf_rc; | 
 | 			link->link_id = llc->link_num; | 
 | 			complete(&link->llc_confirm); | 
 | 		} | 
 | 	} | 
 | } | 
 |  | 
 | static void smc_llc_rx_add_link(struct smc_link *link, | 
 | 				struct smc_llc_msg_add_link *llc) | 
 | { | 
 | 	struct smc_link_group *lgr = smc_get_lgr(link); | 
 |  | 
 | 	if (llc->hd.flags & SMC_LLC_FLAG_RESP) { | 
 | 		if (link->state == SMC_LNK_ACTIVATING) | 
 | 			complete(&link->llc_add_resp); | 
 | 	} else { | 
 | 		if (link->state == SMC_LNK_ACTIVATING) { | 
 | 			complete(&link->llc_add); | 
 | 			return; | 
 | 		} | 
 |  | 
 | 		if (lgr->role == SMC_SERV) { | 
 | 			smc_llc_prep_add_link(llc, link, | 
 | 					link->smcibdev->mac[link->ibport - 1], | 
 | 					link->gid, SMC_LLC_REQ); | 
 |  | 
 | 		} else { | 
 | 			smc_llc_prep_add_link(llc, link, | 
 | 					link->smcibdev->mac[link->ibport - 1], | 
 | 					link->gid, SMC_LLC_RESP); | 
 | 		} | 
 | 		smc_llc_send_message(link, llc, sizeof(*llc)); | 
 | 	} | 
 | } | 
 |  | 
 | static void smc_llc_rx_delete_link(struct smc_link *link, | 
 | 				   struct smc_llc_msg_del_link *llc) | 
 | { | 
 | 	struct smc_link_group *lgr = smc_get_lgr(link); | 
 |  | 
 | 	if (llc->hd.flags & SMC_LLC_FLAG_RESP) { | 
 | 		if (lgr->role == SMC_SERV) | 
 | 			smc_lgr_schedule_free_work_fast(lgr); | 
 | 	} else { | 
 | 		smc_lgr_forget(lgr); | 
 | 		smc_llc_link_deleting(link); | 
 | 		if (lgr->role == SMC_SERV) { | 
 | 			/* client asks to delete this link, send request */ | 
 | 			smc_llc_prep_delete_link(llc, link, SMC_LLC_REQ, true); | 
 | 		} else { | 
 | 			/* server requests to delete this link, send response */ | 
 | 			smc_llc_prep_delete_link(llc, link, SMC_LLC_RESP, true); | 
 | 		} | 
 | 		smc_llc_send_message(link, llc, sizeof(*llc)); | 
 | 		smc_lgr_schedule_free_work_fast(lgr); | 
 | 	} | 
 | } | 
 |  | 
 | static void smc_llc_rx_test_link(struct smc_link *link, | 
 | 				 struct smc_llc_msg_test_link *llc) | 
 | { | 
 | 	if (llc->hd.flags & SMC_LLC_FLAG_RESP) { | 
 | 		if (link->state == SMC_LNK_ACTIVE) | 
 | 			complete(&link->llc_testlink_resp); | 
 | 	} else { | 
 | 		llc->hd.flags |= SMC_LLC_FLAG_RESP; | 
 | 		smc_llc_send_message(link, llc, sizeof(*llc)); | 
 | 	} | 
 | } | 
 |  | 
 | static void smc_llc_rx_confirm_rkey(struct smc_link *link, | 
 | 				    struct smc_llc_msg_confirm_rkey *llc) | 
 | { | 
 | 	int rc; | 
 |  | 
 | 	if (llc->hd.flags & SMC_LLC_FLAG_RESP) { | 
 | 		link->llc_confirm_rkey_rc = llc->hd.flags & | 
 | 					    SMC_LLC_FLAG_RKEY_NEG; | 
 | 		complete(&link->llc_confirm_rkey); | 
 | 	} else { | 
 | 		rc = smc_rtoken_add(smc_get_lgr(link), | 
 | 				    llc->rtoken[0].rmb_vaddr, | 
 | 				    llc->rtoken[0].rmb_key); | 
 |  | 
 | 		/* ignore rtokens for other links, we have only one link */ | 
 |  | 
 | 		llc->hd.flags |= SMC_LLC_FLAG_RESP; | 
 | 		if (rc < 0) | 
 | 			llc->hd.flags |= SMC_LLC_FLAG_RKEY_NEG; | 
 | 		smc_llc_send_message(link, llc, sizeof(*llc)); | 
 | 	} | 
 | } | 
 |  | 
 | static void smc_llc_rx_confirm_rkey_cont(struct smc_link *link, | 
 | 				      struct smc_llc_msg_confirm_rkey_cont *llc) | 
 | { | 
 | 	if (llc->hd.flags & SMC_LLC_FLAG_RESP) { | 
 | 		/* unused as long as we don't send this type of msg */ | 
 | 	} else { | 
 | 		/* ignore rtokens for other links, we have only one link */ | 
 | 		llc->hd.flags |= SMC_LLC_FLAG_RESP; | 
 | 		smc_llc_send_message(link, llc, sizeof(*llc)); | 
 | 	} | 
 | } | 
 |  | 
 | static void smc_llc_rx_delete_rkey(struct smc_link *link, | 
 | 				   struct smc_llc_msg_delete_rkey *llc) | 
 | { | 
 | 	u8 err_mask = 0; | 
 | 	int i, max; | 
 |  | 
 | 	if (llc->hd.flags & SMC_LLC_FLAG_RESP) { | 
 | 		/* unused as long as we don't send this type of msg */ | 
 | 	} else { | 
 | 		max = min_t(u8, llc->num_rkeys, SMC_LLC_DEL_RKEY_MAX); | 
 | 		for (i = 0; i < max; i++) { | 
 | 			if (smc_rtoken_delete(smc_get_lgr(link), llc->rkey[i])) | 
 | 				err_mask |= 1 << (SMC_LLC_DEL_RKEY_MAX - 1 - i); | 
 | 		} | 
 |  | 
 | 		if (err_mask) { | 
 | 			llc->hd.flags |= SMC_LLC_FLAG_RKEY_NEG; | 
 | 			llc->err_mask = err_mask; | 
 | 		} | 
 |  | 
 | 		llc->hd.flags |= SMC_LLC_FLAG_RESP; | 
 | 		smc_llc_send_message(link, llc, sizeof(*llc)); | 
 | 	} | 
 | } | 
 |  | 
 | static void smc_llc_rx_handler(struct ib_wc *wc, void *buf) | 
 | { | 
 | 	struct smc_link *link = (struct smc_link *)wc->qp->qp_context; | 
 | 	union smc_llc_msg *llc = buf; | 
 |  | 
 | 	if (wc->byte_len < sizeof(*llc)) | 
 | 		return; /* short message */ | 
 | 	if (llc->raw.hdr.length != sizeof(*llc)) | 
 | 		return; /* invalid message */ | 
 | 	if (link->state == SMC_LNK_INACTIVE) | 
 | 		return; /* link not active, drop msg */ | 
 |  | 
 | 	switch (llc->raw.hdr.common.type) { | 
 | 	case SMC_LLC_TEST_LINK: | 
 | 		smc_llc_rx_test_link(link, &llc->test_link); | 
 | 		break; | 
 | 	case SMC_LLC_CONFIRM_LINK: | 
 | 		smc_llc_rx_confirm_link(link, &llc->confirm_link); | 
 | 		break; | 
 | 	case SMC_LLC_ADD_LINK: | 
 | 		smc_llc_rx_add_link(link, &llc->add_link); | 
 | 		break; | 
 | 	case SMC_LLC_DELETE_LINK: | 
 | 		smc_llc_rx_delete_link(link, &llc->delete_link); | 
 | 		break; | 
 | 	case SMC_LLC_CONFIRM_RKEY: | 
 | 		smc_llc_rx_confirm_rkey(link, &llc->confirm_rkey); | 
 | 		break; | 
 | 	case SMC_LLC_CONFIRM_RKEY_CONT: | 
 | 		smc_llc_rx_confirm_rkey_cont(link, &llc->confirm_rkey_cont); | 
 | 		break; | 
 | 	case SMC_LLC_DELETE_RKEY: | 
 | 		smc_llc_rx_delete_rkey(link, &llc->delete_rkey); | 
 | 		break; | 
 | 	} | 
 | } | 
 |  | 
 | /***************************** worker, utils *********************************/ | 
 |  | 
 | static void smc_llc_testlink_work(struct work_struct *work) | 
 | { | 
 | 	struct smc_link *link = container_of(to_delayed_work(work), | 
 | 					     struct smc_link, llc_testlink_wrk); | 
 | 	unsigned long next_interval; | 
 | 	unsigned long expire_time; | 
 | 	u8 user_data[16] = { 0 }; | 
 | 	int rc; | 
 |  | 
 | 	if (link->state != SMC_LNK_ACTIVE) | 
 | 		return;		/* don't reschedule worker */ | 
 | 	expire_time = link->wr_rx_tstamp + link->llc_testlink_time; | 
 | 	if (time_is_after_jiffies(expire_time)) { | 
 | 		next_interval = expire_time - jiffies; | 
 | 		goto out; | 
 | 	} | 
 | 	reinit_completion(&link->llc_testlink_resp); | 
 | 	smc_llc_send_test_link(link, user_data); | 
 | 	/* receive TEST LINK response over RoCE fabric */ | 
 | 	rc = wait_for_completion_interruptible_timeout(&link->llc_testlink_resp, | 
 | 						       SMC_LLC_WAIT_TIME); | 
 | 	if (rc <= 0) { | 
 | 		smc_lgr_terminate(smc_get_lgr(link)); | 
 | 		return; | 
 | 	} | 
 | 	next_interval = link->llc_testlink_time; | 
 | out: | 
 | 	queue_delayed_work(link->llc_wq, &link->llc_testlink_wrk, | 
 | 			   next_interval); | 
 | } | 
 |  | 
 | int smc_llc_link_init(struct smc_link *link) | 
 | { | 
 | 	struct smc_link_group *lgr = smc_get_lgr(link); | 
 | 	link->llc_wq = alloc_ordered_workqueue("llc_wq-%x:%x)", WQ_MEM_RECLAIM, | 
 | 					       *((u32 *)lgr->id), | 
 | 					       link->link_id); | 
 | 	if (!link->llc_wq) | 
 | 		return -ENOMEM; | 
 | 	init_completion(&link->llc_confirm); | 
 | 	init_completion(&link->llc_confirm_resp); | 
 | 	init_completion(&link->llc_add); | 
 | 	init_completion(&link->llc_add_resp); | 
 | 	init_completion(&link->llc_confirm_rkey); | 
 | 	init_completion(&link->llc_testlink_resp); | 
 | 	INIT_DELAYED_WORK(&link->llc_testlink_wrk, smc_llc_testlink_work); | 
 | 	return 0; | 
 | } | 
 |  | 
 | void smc_llc_link_active(struct smc_link *link, int testlink_time) | 
 | { | 
 | 	link->state = SMC_LNK_ACTIVE; | 
 | 	if (testlink_time) { | 
 | 		link->llc_testlink_time = testlink_time * HZ; | 
 | 		queue_delayed_work(link->llc_wq, &link->llc_testlink_wrk, | 
 | 				   link->llc_testlink_time); | 
 | 	} | 
 | } | 
 |  | 
 | void smc_llc_link_deleting(struct smc_link *link) | 
 | { | 
 | 	link->state = SMC_LNK_DELETING; | 
 | } | 
 |  | 
 | /* called in tasklet context */ | 
 | void smc_llc_link_inactive(struct smc_link *link) | 
 | { | 
 | 	link->state = SMC_LNK_INACTIVE; | 
 | 	cancel_delayed_work(&link->llc_testlink_wrk); | 
 | } | 
 |  | 
 | /* called in worker context */ | 
 | void smc_llc_link_clear(struct smc_link *link) | 
 | { | 
 | 	flush_workqueue(link->llc_wq); | 
 | 	destroy_workqueue(link->llc_wq); | 
 | } | 
 |  | 
 | /* register a new rtoken at the remote peer */ | 
 | int smc_llc_do_confirm_rkey(struct smc_link *link, | 
 | 			    struct smc_buf_desc *rmb_desc) | 
 | { | 
 | 	int rc; | 
 |  | 
 | 	reinit_completion(&link->llc_confirm_rkey); | 
 | 	smc_llc_send_confirm_rkey(link, rmb_desc); | 
 | 	/* receive CONFIRM RKEY response from server over RoCE fabric */ | 
 | 	rc = wait_for_completion_interruptible_timeout(&link->llc_confirm_rkey, | 
 | 						       SMC_LLC_WAIT_TIME); | 
 | 	if (rc <= 0 || link->llc_confirm_rkey_rc) | 
 | 		return -EFAULT; | 
 | 	return 0; | 
 | } | 
 |  | 
 | /***************************** init, exit, misc ******************************/ | 
 |  | 
 | static struct smc_wr_rx_handler smc_llc_rx_handlers[] = { | 
 | 	{ | 
 | 		.handler	= smc_llc_rx_handler, | 
 | 		.type		= SMC_LLC_CONFIRM_LINK | 
 | 	}, | 
 | 	{ | 
 | 		.handler	= smc_llc_rx_handler, | 
 | 		.type		= SMC_LLC_TEST_LINK | 
 | 	}, | 
 | 	{ | 
 | 		.handler	= smc_llc_rx_handler, | 
 | 		.type		= SMC_LLC_ADD_LINK | 
 | 	}, | 
 | 	{ | 
 | 		.handler	= smc_llc_rx_handler, | 
 | 		.type		= SMC_LLC_DELETE_LINK | 
 | 	}, | 
 | 	{ | 
 | 		.handler	= smc_llc_rx_handler, | 
 | 		.type		= SMC_LLC_CONFIRM_RKEY | 
 | 	}, | 
 | 	{ | 
 | 		.handler	= smc_llc_rx_handler, | 
 | 		.type		= SMC_LLC_CONFIRM_RKEY_CONT | 
 | 	}, | 
 | 	{ | 
 | 		.handler	= smc_llc_rx_handler, | 
 | 		.type		= SMC_LLC_DELETE_RKEY | 
 | 	}, | 
 | 	{ | 
 | 		.handler	= NULL, | 
 | 	} | 
 | }; | 
 |  | 
 | int __init smc_llc_init(void) | 
 | { | 
 | 	struct smc_wr_rx_handler *handler; | 
 | 	int rc = 0; | 
 |  | 
 | 	for (handler = smc_llc_rx_handlers; handler->handler; handler++) { | 
 | 		INIT_HLIST_NODE(&handler->list); | 
 | 		rc = smc_wr_rx_register_handler(handler); | 
 | 		if (rc) | 
 | 			break; | 
 | 	} | 
 | 	return rc; | 
 | } |