xref: /openbmc/linux/drivers/nvme/host/tcp.c (revision 88eaba80)
13f2304f8SSagi Grimberg // SPDX-License-Identifier: GPL-2.0
23f2304f8SSagi Grimberg /*
33f2304f8SSagi Grimberg  * NVMe over Fabrics TCP host.
43f2304f8SSagi Grimberg  * Copyright (c) 2018 Lightbits Labs. All rights reserved.
53f2304f8SSagi Grimberg  */
63f2304f8SSagi Grimberg #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
73f2304f8SSagi Grimberg #include <linux/module.h>
83f2304f8SSagi Grimberg #include <linux/init.h>
93f2304f8SSagi Grimberg #include <linux/slab.h>
103f2304f8SSagi Grimberg #include <linux/err.h>
113f2304f8SSagi Grimberg #include <linux/nvme-tcp.h>
123f2304f8SSagi Grimberg #include <net/sock.h>
133f2304f8SSagi Grimberg #include <net/tcp.h>
143f2304f8SSagi Grimberg #include <linux/blk-mq.h>
153f2304f8SSagi Grimberg #include <crypto/hash.h>
161a9460ceSSagi Grimberg #include <net/busy_poll.h>
1740e0b090SPeilin Ye #include <trace/events/sock.h>
183f2304f8SSagi Grimberg 
193f2304f8SSagi Grimberg #include "nvme.h"
203f2304f8SSagi Grimberg #include "fabrics.h"
213f2304f8SSagi Grimberg 
223f2304f8SSagi Grimberg struct nvme_tcp_queue;
233f2304f8SSagi Grimberg 
249912ade3SWunderlich, Mark /* Define the socket priority to use for connections were it is desirable
259912ade3SWunderlich, Mark  * that the NIC consider performing optimized packet processing or filtering.
269912ade3SWunderlich, Mark  * A non-zero value being sufficient to indicate general consideration of any
279912ade3SWunderlich, Mark  * possible optimization.  Making it a module param allows for alternative
289912ade3SWunderlich, Mark  * values that may be unique for some NIC implementations.
299912ade3SWunderlich, Mark  */
309912ade3SWunderlich, Mark static int so_priority;
319912ade3SWunderlich, Mark module_param(so_priority, int, 0644);
329912ade3SWunderlich, Mark MODULE_PARM_DESC(so_priority, "nvme tcp socket optimize priority");
339912ade3SWunderlich, Mark 
34841aee4dSChris Leech #ifdef CONFIG_DEBUG_LOCK_ALLOC
35841aee4dSChris Leech /* lockdep can detect a circular dependency of the form
36841aee4dSChris Leech  *   sk_lock -> mmap_lock (page fault) -> fs locks -> sk_lock
37841aee4dSChris Leech  * because dependencies are tracked for both nvme-tcp and user contexts. Using
38841aee4dSChris Leech  * a separate class prevents lockdep from conflating nvme-tcp socket use with
39841aee4dSChris Leech  * user-space socket API use.
40841aee4dSChris Leech  */
41841aee4dSChris Leech static struct lock_class_key nvme_tcp_sk_key[2];
42841aee4dSChris Leech static struct lock_class_key nvme_tcp_slock_key[2];
43841aee4dSChris Leech 
44841aee4dSChris Leech static void nvme_tcp_reclassify_socket(struct socket *sock)
45841aee4dSChris Leech {
46841aee4dSChris Leech 	struct sock *sk = sock->sk;
47841aee4dSChris Leech 
48841aee4dSChris Leech 	if (WARN_ON_ONCE(!sock_allow_reclassification(sk)))
49841aee4dSChris Leech 		return;
50841aee4dSChris Leech 
51841aee4dSChris Leech 	switch (sk->sk_family) {
52841aee4dSChris Leech 	case AF_INET:
53841aee4dSChris Leech 		sock_lock_init_class_and_name(sk, "slock-AF_INET-NVME",
54841aee4dSChris Leech 					      &nvme_tcp_slock_key[0],
55841aee4dSChris Leech 					      "sk_lock-AF_INET-NVME",
56841aee4dSChris Leech 					      &nvme_tcp_sk_key[0]);
57841aee4dSChris Leech 		break;
58841aee4dSChris Leech 	case AF_INET6:
59841aee4dSChris Leech 		sock_lock_init_class_and_name(sk, "slock-AF_INET6-NVME",
60841aee4dSChris Leech 					      &nvme_tcp_slock_key[1],
61841aee4dSChris Leech 					      "sk_lock-AF_INET6-NVME",
62841aee4dSChris Leech 					      &nvme_tcp_sk_key[1]);
63841aee4dSChris Leech 		break;
64841aee4dSChris Leech 	default:
65841aee4dSChris Leech 		WARN_ON_ONCE(1);
66841aee4dSChris Leech 	}
67841aee4dSChris Leech }
68841aee4dSChris Leech #else
69841aee4dSChris Leech static void nvme_tcp_reclassify_socket(struct socket *sock) { }
70841aee4dSChris Leech #endif
71841aee4dSChris Leech 
723f2304f8SSagi Grimberg enum nvme_tcp_send_state {
733f2304f8SSagi Grimberg 	NVME_TCP_SEND_CMD_PDU = 0,
743f2304f8SSagi Grimberg 	NVME_TCP_SEND_H2C_PDU,
753f2304f8SSagi Grimberg 	NVME_TCP_SEND_DATA,
763f2304f8SSagi Grimberg 	NVME_TCP_SEND_DDGST,
773f2304f8SSagi Grimberg };
783f2304f8SSagi Grimberg 
793f2304f8SSagi Grimberg struct nvme_tcp_request {
803f2304f8SSagi Grimberg 	struct nvme_request	req;
813f2304f8SSagi Grimberg 	void			*pdu;
823f2304f8SSagi Grimberg 	struct nvme_tcp_queue	*queue;
833f2304f8SSagi Grimberg 	u32			data_len;
843f2304f8SSagi Grimberg 	u32			pdu_len;
853f2304f8SSagi Grimberg 	u32			pdu_sent;
86c2700d28SVarun Prakash 	u32			h2cdata_left;
87c2700d28SVarun Prakash 	u32			h2cdata_offset;
883f2304f8SSagi Grimberg 	u16			ttag;
891ba2e507SDaniel Wagner 	__le16			status;
903f2304f8SSagi Grimberg 	struct list_head	entry;
9115ec928aSSagi Grimberg 	struct llist_node	lentry;
92a7273d40SChristoph Hellwig 	__le32			ddgst;
933f2304f8SSagi Grimberg 
943f2304f8SSagi Grimberg 	struct bio		*curr_bio;
953f2304f8SSagi Grimberg 	struct iov_iter		iter;
963f2304f8SSagi Grimberg 
973f2304f8SSagi Grimberg 	/* send state */
983f2304f8SSagi Grimberg 	size_t			offset;
993f2304f8SSagi Grimberg 	size_t			data_sent;
1003f2304f8SSagi Grimberg 	enum nvme_tcp_send_state state;
1013f2304f8SSagi Grimberg };
1023f2304f8SSagi Grimberg 
1033f2304f8SSagi Grimberg enum nvme_tcp_queue_flags {
1043f2304f8SSagi Grimberg 	NVME_TCP_Q_ALLOCATED	= 0,
1053f2304f8SSagi Grimberg 	NVME_TCP_Q_LIVE		= 1,
10672e5d757SSagi Grimberg 	NVME_TCP_Q_POLLING	= 2,
1073f2304f8SSagi Grimberg };
1083f2304f8SSagi Grimberg 
1093f2304f8SSagi Grimberg enum nvme_tcp_recv_state {
1103f2304f8SSagi Grimberg 	NVME_TCP_RECV_PDU = 0,
1113f2304f8SSagi Grimberg 	NVME_TCP_RECV_DATA,
1123f2304f8SSagi Grimberg 	NVME_TCP_RECV_DDGST,
1133f2304f8SSagi Grimberg };
1143f2304f8SSagi Grimberg 
1153f2304f8SSagi Grimberg struct nvme_tcp_ctrl;
1163f2304f8SSagi Grimberg struct nvme_tcp_queue {
1173f2304f8SSagi Grimberg 	struct socket		*sock;
1183f2304f8SSagi Grimberg 	struct work_struct	io_work;
1193f2304f8SSagi Grimberg 	int			io_cpu;
1203f2304f8SSagi Grimberg 
1219ebbfe49SChao Leng 	struct mutex		queue_lock;
122db5ad6b7SSagi Grimberg 	struct mutex		send_mutex;
12315ec928aSSagi Grimberg 	struct llist_head	req_list;
1243f2304f8SSagi Grimberg 	struct list_head	send_list;
1253f2304f8SSagi Grimberg 
1263f2304f8SSagi Grimberg 	/* recv state */
1273f2304f8SSagi Grimberg 	void			*pdu;
1283f2304f8SSagi Grimberg 	int			pdu_remaining;
1293f2304f8SSagi Grimberg 	int			pdu_offset;
1303f2304f8SSagi Grimberg 	size_t			data_remaining;
1313f2304f8SSagi Grimberg 	size_t			ddgst_remaining;
1321a9460ceSSagi Grimberg 	unsigned int		nr_cqe;
1333f2304f8SSagi Grimberg 
1343f2304f8SSagi Grimberg 	/* send state */
1353f2304f8SSagi Grimberg 	struct nvme_tcp_request *request;
1363f2304f8SSagi Grimberg 
137c2700d28SVarun Prakash 	u32			maxh2cdata;
1383f2304f8SSagi Grimberg 	size_t			cmnd_capsule_len;
1393f2304f8SSagi Grimberg 	struct nvme_tcp_ctrl	*ctrl;
1403f2304f8SSagi Grimberg 	unsigned long		flags;
1413f2304f8SSagi Grimberg 	bool			rd_enabled;
1423f2304f8SSagi Grimberg 
1433f2304f8SSagi Grimberg 	bool			hdr_digest;
1443f2304f8SSagi Grimberg 	bool			data_digest;
1453f2304f8SSagi Grimberg 	struct ahash_request	*rcv_hash;
1463f2304f8SSagi Grimberg 	struct ahash_request	*snd_hash;
1473f2304f8SSagi Grimberg 	__le32			exp_ddgst;
1483f2304f8SSagi Grimberg 	__le32			recv_ddgst;
1493f2304f8SSagi Grimberg 
1503f2304f8SSagi Grimberg 	struct page_frag_cache	pf_cache;
1513f2304f8SSagi Grimberg 
1523f2304f8SSagi Grimberg 	void (*state_change)(struct sock *);
1533f2304f8SSagi Grimberg 	void (*data_ready)(struct sock *);
1543f2304f8SSagi Grimberg 	void (*write_space)(struct sock *);
1553f2304f8SSagi Grimberg };
1563f2304f8SSagi Grimberg 
1573f2304f8SSagi Grimberg struct nvme_tcp_ctrl {
1583f2304f8SSagi Grimberg 	/* read only in the hot path */
1593f2304f8SSagi Grimberg 	struct nvme_tcp_queue	*queues;
1603f2304f8SSagi Grimberg 	struct blk_mq_tag_set	tag_set;
1613f2304f8SSagi Grimberg 
1623f2304f8SSagi Grimberg 	/* other member variables */
1633f2304f8SSagi Grimberg 	struct list_head	list;
1643f2304f8SSagi Grimberg 	struct blk_mq_tag_set	admin_tag_set;
1653f2304f8SSagi Grimberg 	struct sockaddr_storage addr;
1663f2304f8SSagi Grimberg 	struct sockaddr_storage src_addr;
1673f2304f8SSagi Grimberg 	struct nvme_ctrl	ctrl;
1683f2304f8SSagi Grimberg 
1693f2304f8SSagi Grimberg 	struct work_struct	err_work;
1703f2304f8SSagi Grimberg 	struct delayed_work	connect_work;
1713f2304f8SSagi Grimberg 	struct nvme_tcp_request async_req;
17264861993SSagi Grimberg 	u32			io_queues[HCTX_MAX_TYPES];
1733f2304f8SSagi Grimberg };
1743f2304f8SSagi Grimberg 
1753f2304f8SSagi Grimberg static LIST_HEAD(nvme_tcp_ctrl_list);
1763f2304f8SSagi Grimberg static DEFINE_MUTEX(nvme_tcp_ctrl_mutex);
1773f2304f8SSagi Grimberg static struct workqueue_struct *nvme_tcp_wq;
1786acbd961SRikard Falkeborn static const struct blk_mq_ops nvme_tcp_mq_ops;
1796acbd961SRikard Falkeborn static const struct blk_mq_ops nvme_tcp_admin_mq_ops;
180db5ad6b7SSagi Grimberg static int nvme_tcp_try_send(struct nvme_tcp_queue *queue);
1813f2304f8SSagi Grimberg 
1823f2304f8SSagi Grimberg static inline struct nvme_tcp_ctrl *to_tcp_ctrl(struct nvme_ctrl *ctrl)
1833f2304f8SSagi Grimberg {
1843f2304f8SSagi Grimberg 	return container_of(ctrl, struct nvme_tcp_ctrl, ctrl);
1853f2304f8SSagi Grimberg }
1863f2304f8SSagi Grimberg 
1873f2304f8SSagi Grimberg static inline int nvme_tcp_queue_id(struct nvme_tcp_queue *queue)
1883f2304f8SSagi Grimberg {
1893f2304f8SSagi Grimberg 	return queue - queue->ctrl->queues;
1903f2304f8SSagi Grimberg }
1913f2304f8SSagi Grimberg 
1923f2304f8SSagi Grimberg static inline struct blk_mq_tags *nvme_tcp_tagset(struct nvme_tcp_queue *queue)
1933f2304f8SSagi Grimberg {
1943f2304f8SSagi Grimberg 	u32 queue_idx = nvme_tcp_queue_id(queue);
1953f2304f8SSagi Grimberg 
1963f2304f8SSagi Grimberg 	if (queue_idx == 0)
1973f2304f8SSagi Grimberg 		return queue->ctrl->admin_tag_set.tags[queue_idx];
1983f2304f8SSagi Grimberg 	return queue->ctrl->tag_set.tags[queue_idx - 1];
1993f2304f8SSagi Grimberg }
2003f2304f8SSagi Grimberg 
2013f2304f8SSagi Grimberg static inline u8 nvme_tcp_hdgst_len(struct nvme_tcp_queue *queue)
2023f2304f8SSagi Grimberg {
2033f2304f8SSagi Grimberg 	return queue->hdr_digest ? NVME_TCP_DIGEST_LENGTH : 0;
2043f2304f8SSagi Grimberg }
2053f2304f8SSagi Grimberg 
2063f2304f8SSagi Grimberg static inline u8 nvme_tcp_ddgst_len(struct nvme_tcp_queue *queue)
2073f2304f8SSagi Grimberg {
2083f2304f8SSagi Grimberg 	return queue->data_digest ? NVME_TCP_DIGEST_LENGTH : 0;
2093f2304f8SSagi Grimberg }
2103f2304f8SSagi Grimberg 
211a3406352SSagi Grimberg static inline void *nvme_tcp_req_cmd_pdu(struct nvme_tcp_request *req)
212a3406352SSagi Grimberg {
213a3406352SSagi Grimberg 	return req->pdu;
214a3406352SSagi Grimberg }
215a3406352SSagi Grimberg 
216a3406352SSagi Grimberg static inline void *nvme_tcp_req_data_pdu(struct nvme_tcp_request *req)
217a3406352SSagi Grimberg {
218a3406352SSagi Grimberg 	/* use the pdu space in the back for the data pdu */
219a3406352SSagi Grimberg 	return req->pdu + sizeof(struct nvme_tcp_cmd_pdu) -
220a3406352SSagi Grimberg 		sizeof(struct nvme_tcp_data_pdu);
221a3406352SSagi Grimberg }
222a3406352SSagi Grimberg 
22353ee9e29SCaleb Sander static inline size_t nvme_tcp_inline_data_size(struct nvme_tcp_request *req)
2243f2304f8SSagi Grimberg {
22553ee9e29SCaleb Sander 	if (nvme_is_fabrics(req->req.cmd))
22653ee9e29SCaleb Sander 		return NVME_TCP_ADMIN_CCSZ;
22753ee9e29SCaleb Sander 	return req->queue->cmnd_capsule_len - sizeof(struct nvme_command);
2283f2304f8SSagi Grimberg }
2293f2304f8SSagi Grimberg 
2303f2304f8SSagi Grimberg static inline bool nvme_tcp_async_req(struct nvme_tcp_request *req)
2313f2304f8SSagi Grimberg {
2323f2304f8SSagi Grimberg 	return req == &req->queue->ctrl->async_req;
2333f2304f8SSagi Grimberg }
2343f2304f8SSagi Grimberg 
2353f2304f8SSagi Grimberg static inline bool nvme_tcp_has_inline_data(struct nvme_tcp_request *req)
2363f2304f8SSagi Grimberg {
2373f2304f8SSagi Grimberg 	struct request *rq;
2383f2304f8SSagi Grimberg 
2393f2304f8SSagi Grimberg 	if (unlikely(nvme_tcp_async_req(req)))
2403f2304f8SSagi Grimberg 		return false; /* async events don't have a request */
2413f2304f8SSagi Grimberg 
2423f2304f8SSagi Grimberg 	rq = blk_mq_rq_from_pdu(req);
2433f2304f8SSagi Grimberg 
24425e5cb78SSagi Grimberg 	return rq_data_dir(rq) == WRITE && req->data_len &&
24553ee9e29SCaleb Sander 		req->data_len <= nvme_tcp_inline_data_size(req);
2463f2304f8SSagi Grimberg }
2473f2304f8SSagi Grimberg 
2483f2304f8SSagi Grimberg static inline struct page *nvme_tcp_req_cur_page(struct nvme_tcp_request *req)
2493f2304f8SSagi Grimberg {
2503f2304f8SSagi Grimberg 	return req->iter.bvec->bv_page;
2513f2304f8SSagi Grimberg }
2523f2304f8SSagi Grimberg 
2533f2304f8SSagi Grimberg static inline size_t nvme_tcp_req_cur_offset(struct nvme_tcp_request *req)
2543f2304f8SSagi Grimberg {
2553f2304f8SSagi Grimberg 	return req->iter.bvec->bv_offset + req->iter.iov_offset;
2563f2304f8SSagi Grimberg }
2573f2304f8SSagi Grimberg 
2583f2304f8SSagi Grimberg static inline size_t nvme_tcp_req_cur_length(struct nvme_tcp_request *req)
2593f2304f8SSagi Grimberg {
260ca1ff67dSSagi Grimberg 	return min_t(size_t, iov_iter_single_seg_count(&req->iter),
2613f2304f8SSagi Grimberg 			req->pdu_len - req->pdu_sent);
2623f2304f8SSagi Grimberg }
2633f2304f8SSagi Grimberg 
2643f2304f8SSagi Grimberg static inline size_t nvme_tcp_pdu_data_left(struct nvme_tcp_request *req)
2653f2304f8SSagi Grimberg {
2663f2304f8SSagi Grimberg 	return rq_data_dir(blk_mq_rq_from_pdu(req)) == WRITE ?
2673f2304f8SSagi Grimberg 			req->pdu_len - req->pdu_sent : 0;
2683f2304f8SSagi Grimberg }
2693f2304f8SSagi Grimberg 
2703f2304f8SSagi Grimberg static inline size_t nvme_tcp_pdu_last_send(struct nvme_tcp_request *req,
2713f2304f8SSagi Grimberg 		int len)
2723f2304f8SSagi Grimberg {
2733f2304f8SSagi Grimberg 	return nvme_tcp_pdu_data_left(req) <= len;
2743f2304f8SSagi Grimberg }
2753f2304f8SSagi Grimberg 
2763f2304f8SSagi Grimberg static void nvme_tcp_init_iter(struct nvme_tcp_request *req,
2773f2304f8SSagi Grimberg 		unsigned int dir)
2783f2304f8SSagi Grimberg {
2793f2304f8SSagi Grimberg 	struct request *rq = blk_mq_rq_from_pdu(req);
2803f2304f8SSagi Grimberg 	struct bio_vec *vec;
2813f2304f8SSagi Grimberg 	unsigned int size;
2820dc9edafSSagi Grimberg 	int nr_bvec;
2833f2304f8SSagi Grimberg 	size_t offset;
2843f2304f8SSagi Grimberg 
2853f2304f8SSagi Grimberg 	if (rq->rq_flags & RQF_SPECIAL_PAYLOAD) {
2863f2304f8SSagi Grimberg 		vec = &rq->special_vec;
2870dc9edafSSagi Grimberg 		nr_bvec = 1;
2883f2304f8SSagi Grimberg 		size = blk_rq_payload_bytes(rq);
2893f2304f8SSagi Grimberg 		offset = 0;
2903f2304f8SSagi Grimberg 	} else {
2913f2304f8SSagi Grimberg 		struct bio *bio = req->curr_bio;
2920dc9edafSSagi Grimberg 		struct bvec_iter bi;
2930dc9edafSSagi Grimberg 		struct bio_vec bv;
2943f2304f8SSagi Grimberg 
2953f2304f8SSagi Grimberg 		vec = __bvec_iter_bvec(bio->bi_io_vec, bio->bi_iter);
2960dc9edafSSagi Grimberg 		nr_bvec = 0;
2970dc9edafSSagi Grimberg 		bio_for_each_bvec(bv, bio, bi) {
2980dc9edafSSagi Grimberg 			nr_bvec++;
2990dc9edafSSagi Grimberg 		}
3003f2304f8SSagi Grimberg 		size = bio->bi_iter.bi_size;
3013f2304f8SSagi Grimberg 		offset = bio->bi_iter.bi_bvec_done;
3023f2304f8SSagi Grimberg 	}
3033f2304f8SSagi Grimberg 
3040dc9edafSSagi Grimberg 	iov_iter_bvec(&req->iter, dir, vec, nr_bvec, size);
3053f2304f8SSagi Grimberg 	req->iter.iov_offset = offset;
3063f2304f8SSagi Grimberg }
3073f2304f8SSagi Grimberg 
3083f2304f8SSagi Grimberg static inline void nvme_tcp_advance_req(struct nvme_tcp_request *req,
3093f2304f8SSagi Grimberg 		int len)
3103f2304f8SSagi Grimberg {
3113f2304f8SSagi Grimberg 	req->data_sent += len;
3123f2304f8SSagi Grimberg 	req->pdu_sent += len;
3133f2304f8SSagi Grimberg 	iov_iter_advance(&req->iter, len);
3143f2304f8SSagi Grimberg 	if (!iov_iter_count(&req->iter) &&
3153f2304f8SSagi Grimberg 	    req->data_sent < req->data_len) {
3163f2304f8SSagi Grimberg 		req->curr_bio = req->curr_bio->bi_next;
317de4eda9dSAl Viro 		nvme_tcp_init_iter(req, ITER_SOURCE);
3183f2304f8SSagi Grimberg 	}
3193f2304f8SSagi Grimberg }
3203f2304f8SSagi Grimberg 
3215c11f7d9SSagi Grimberg static inline void nvme_tcp_send_all(struct nvme_tcp_queue *queue)
3225c11f7d9SSagi Grimberg {
3235c11f7d9SSagi Grimberg 	int ret;
3245c11f7d9SSagi Grimberg 
3255c11f7d9SSagi Grimberg 	/* drain the send queue as much as we can... */
3265c11f7d9SSagi Grimberg 	do {
3275c11f7d9SSagi Grimberg 		ret = nvme_tcp_try_send(queue);
3285c11f7d9SSagi Grimberg 	} while (ret > 0);
3295c11f7d9SSagi Grimberg }
3305c11f7d9SSagi Grimberg 
33170f437fbSKeith Busch static inline bool nvme_tcp_queue_more(struct nvme_tcp_queue *queue)
33270f437fbSKeith Busch {
33370f437fbSKeith Busch 	return !list_empty(&queue->send_list) ||
3343770a42bSSagi Grimberg 		!llist_empty(&queue->req_list);
33570f437fbSKeith Busch }
33670f437fbSKeith Busch 
337db5ad6b7SSagi Grimberg static inline void nvme_tcp_queue_request(struct nvme_tcp_request *req,
33886f0348aSSagi Grimberg 		bool sync, bool last)
3393f2304f8SSagi Grimberg {
3403f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = req->queue;
341db5ad6b7SSagi Grimberg 	bool empty;
3423f2304f8SSagi Grimberg 
34315ec928aSSagi Grimberg 	empty = llist_add(&req->lentry, &queue->req_list) &&
34415ec928aSSagi Grimberg 		list_empty(&queue->send_list) && !queue->request;
3453f2304f8SSagi Grimberg 
346db5ad6b7SSagi Grimberg 	/*
347db5ad6b7SSagi Grimberg 	 * if we're the first on the send_list and we can try to send
348db5ad6b7SSagi Grimberg 	 * directly, otherwise queue io_work. Also, only do that if we
349db5ad6b7SSagi Grimberg 	 * are on the same cpu, so we don't introduce contention.
350db5ad6b7SSagi Grimberg 	 */
351bb833370SSagi Grimberg 	if (queue->io_cpu == raw_smp_processor_id() &&
352db5ad6b7SSagi Grimberg 	    sync && empty && mutex_trylock(&queue->send_mutex)) {
3535c11f7d9SSagi Grimberg 		nvme_tcp_send_all(queue);
354db5ad6b7SSagi Grimberg 		mutex_unlock(&queue->send_mutex);
3553f2304f8SSagi Grimberg 	}
35670f437fbSKeith Busch 
35770f437fbSKeith Busch 	if (last && nvme_tcp_queue_more(queue))
35870f437fbSKeith Busch 		queue_work_on(queue->io_cpu, nvme_tcp_wq, &queue->io_work);
359db5ad6b7SSagi Grimberg }
3603f2304f8SSagi Grimberg 
36115ec928aSSagi Grimberg static void nvme_tcp_process_req_list(struct nvme_tcp_queue *queue)
36215ec928aSSagi Grimberg {
36315ec928aSSagi Grimberg 	struct nvme_tcp_request *req;
36415ec928aSSagi Grimberg 	struct llist_node *node;
36515ec928aSSagi Grimberg 
36615ec928aSSagi Grimberg 	for (node = llist_del_all(&queue->req_list); node; node = node->next) {
36715ec928aSSagi Grimberg 		req = llist_entry(node, struct nvme_tcp_request, lentry);
36815ec928aSSagi Grimberg 		list_add(&req->entry, &queue->send_list);
36915ec928aSSagi Grimberg 	}
37015ec928aSSagi Grimberg }
37115ec928aSSagi Grimberg 
3723f2304f8SSagi Grimberg static inline struct nvme_tcp_request *
3733f2304f8SSagi Grimberg nvme_tcp_fetch_request(struct nvme_tcp_queue *queue)
3743f2304f8SSagi Grimberg {
3753f2304f8SSagi Grimberg 	struct nvme_tcp_request *req;
3763f2304f8SSagi Grimberg 
3773f2304f8SSagi Grimberg 	req = list_first_entry_or_null(&queue->send_list,
3783f2304f8SSagi Grimberg 			struct nvme_tcp_request, entry);
37915ec928aSSagi Grimberg 	if (!req) {
38015ec928aSSagi Grimberg 		nvme_tcp_process_req_list(queue);
38115ec928aSSagi Grimberg 		req = list_first_entry_or_null(&queue->send_list,
38215ec928aSSagi Grimberg 				struct nvme_tcp_request, entry);
38315ec928aSSagi Grimberg 		if (unlikely(!req))
38415ec928aSSagi Grimberg 			return NULL;
38515ec928aSSagi Grimberg 	}
3863f2304f8SSagi Grimberg 
38715ec928aSSagi Grimberg 	list_del(&req->entry);
3883f2304f8SSagi Grimberg 	return req;
3893f2304f8SSagi Grimberg }
3903f2304f8SSagi Grimberg 
391a7273d40SChristoph Hellwig static inline void nvme_tcp_ddgst_final(struct ahash_request *hash,
392a7273d40SChristoph Hellwig 		__le32 *dgst)
3933f2304f8SSagi Grimberg {
3943f2304f8SSagi Grimberg 	ahash_request_set_crypt(hash, NULL, (u8 *)dgst, 0);
3953f2304f8SSagi Grimberg 	crypto_ahash_final(hash);
3963f2304f8SSagi Grimberg }
3973f2304f8SSagi Grimberg 
3983f2304f8SSagi Grimberg static inline void nvme_tcp_ddgst_update(struct ahash_request *hash,
3993f2304f8SSagi Grimberg 		struct page *page, off_t off, size_t len)
4003f2304f8SSagi Grimberg {
4013f2304f8SSagi Grimberg 	struct scatterlist sg;
4023f2304f8SSagi Grimberg 
4035fa9add6SNam Cao 	sg_init_table(&sg, 1);
4043f2304f8SSagi Grimberg 	sg_set_page(&sg, page, len, off);
4053f2304f8SSagi Grimberg 	ahash_request_set_crypt(hash, &sg, NULL, len);
4063f2304f8SSagi Grimberg 	crypto_ahash_update(hash);
4073f2304f8SSagi Grimberg }
4083f2304f8SSagi Grimberg 
4093f2304f8SSagi Grimberg static inline void nvme_tcp_hdgst(struct ahash_request *hash,
4103f2304f8SSagi Grimberg 		void *pdu, size_t len)
4113f2304f8SSagi Grimberg {
4123f2304f8SSagi Grimberg 	struct scatterlist sg;
4133f2304f8SSagi Grimberg 
4143f2304f8SSagi Grimberg 	sg_init_one(&sg, pdu, len);
4153f2304f8SSagi Grimberg 	ahash_request_set_crypt(hash, &sg, pdu + len, len);
4163f2304f8SSagi Grimberg 	crypto_ahash_digest(hash);
4173f2304f8SSagi Grimberg }
4183f2304f8SSagi Grimberg 
4193f2304f8SSagi Grimberg static int nvme_tcp_verify_hdgst(struct nvme_tcp_queue *queue,
4203f2304f8SSagi Grimberg 		void *pdu, size_t pdu_len)
4213f2304f8SSagi Grimberg {
4223f2304f8SSagi Grimberg 	struct nvme_tcp_hdr *hdr = pdu;
4233f2304f8SSagi Grimberg 	__le32 recv_digest;
4243f2304f8SSagi Grimberg 	__le32 exp_digest;
4253f2304f8SSagi Grimberg 
4263f2304f8SSagi Grimberg 	if (unlikely(!(hdr->flags & NVME_TCP_F_HDGST))) {
4273f2304f8SSagi Grimberg 		dev_err(queue->ctrl->ctrl.device,
4283f2304f8SSagi Grimberg 			"queue %d: header digest flag is cleared\n",
4293f2304f8SSagi Grimberg 			nvme_tcp_queue_id(queue));
4303f2304f8SSagi Grimberg 		return -EPROTO;
4313f2304f8SSagi Grimberg 	}
4323f2304f8SSagi Grimberg 
4333f2304f8SSagi Grimberg 	recv_digest = *(__le32 *)(pdu + hdr->hlen);
4343f2304f8SSagi Grimberg 	nvme_tcp_hdgst(queue->rcv_hash, pdu, pdu_len);
4353f2304f8SSagi Grimberg 	exp_digest = *(__le32 *)(pdu + hdr->hlen);
4363f2304f8SSagi Grimberg 	if (recv_digest != exp_digest) {
4373f2304f8SSagi Grimberg 		dev_err(queue->ctrl->ctrl.device,
4383f2304f8SSagi Grimberg 			"header digest error: recv %#x expected %#x\n",
4393f2304f8SSagi Grimberg 			le32_to_cpu(recv_digest), le32_to_cpu(exp_digest));
4403f2304f8SSagi Grimberg 		return -EIO;
4413f2304f8SSagi Grimberg 	}
4423f2304f8SSagi Grimberg 
4433f2304f8SSagi Grimberg 	return 0;
4443f2304f8SSagi Grimberg }
4453f2304f8SSagi Grimberg 
4463f2304f8SSagi Grimberg static int nvme_tcp_check_ddgst(struct nvme_tcp_queue *queue, void *pdu)
4473f2304f8SSagi Grimberg {
4483f2304f8SSagi Grimberg 	struct nvme_tcp_hdr *hdr = pdu;
4493f2304f8SSagi Grimberg 	u8 digest_len = nvme_tcp_hdgst_len(queue);
4503f2304f8SSagi Grimberg 	u32 len;
4513f2304f8SSagi Grimberg 
4523f2304f8SSagi Grimberg 	len = le32_to_cpu(hdr->plen) - hdr->hlen -
4533f2304f8SSagi Grimberg 		((hdr->flags & NVME_TCP_F_HDGST) ? digest_len : 0);
4543f2304f8SSagi Grimberg 
4553f2304f8SSagi Grimberg 	if (unlikely(len && !(hdr->flags & NVME_TCP_F_DDGST))) {
4563f2304f8SSagi Grimberg 		dev_err(queue->ctrl->ctrl.device,
4573f2304f8SSagi Grimberg 			"queue %d: data digest flag is cleared\n",
4583f2304f8SSagi Grimberg 		nvme_tcp_queue_id(queue));
4593f2304f8SSagi Grimberg 		return -EPROTO;
4603f2304f8SSagi Grimberg 	}
4613f2304f8SSagi Grimberg 	crypto_ahash_init(queue->rcv_hash);
4623f2304f8SSagi Grimberg 
4633f2304f8SSagi Grimberg 	return 0;
4643f2304f8SSagi Grimberg }
4653f2304f8SSagi Grimberg 
4663f2304f8SSagi Grimberg static void nvme_tcp_exit_request(struct blk_mq_tag_set *set,
4673f2304f8SSagi Grimberg 		struct request *rq, unsigned int hctx_idx)
4683f2304f8SSagi Grimberg {
4693f2304f8SSagi Grimberg 	struct nvme_tcp_request *req = blk_mq_rq_to_pdu(rq);
4703f2304f8SSagi Grimberg 
4713f2304f8SSagi Grimberg 	page_frag_free(req->pdu);
4723f2304f8SSagi Grimberg }
4733f2304f8SSagi Grimberg 
4743f2304f8SSagi Grimberg static int nvme_tcp_init_request(struct blk_mq_tag_set *set,
4753f2304f8SSagi Grimberg 		struct request *rq, unsigned int hctx_idx,
4763f2304f8SSagi Grimberg 		unsigned int numa_node)
4773f2304f8SSagi Grimberg {
47806427ca0SChristoph Hellwig 	struct nvme_tcp_ctrl *ctrl = to_tcp_ctrl(set->driver_data);
4793f2304f8SSagi Grimberg 	struct nvme_tcp_request *req = blk_mq_rq_to_pdu(rq);
480f4b9e6c9SKeith Busch 	struct nvme_tcp_cmd_pdu *pdu;
4813f2304f8SSagi Grimberg 	int queue_idx = (set == &ctrl->tag_set) ? hctx_idx + 1 : 0;
4823f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = &ctrl->queues[queue_idx];
4833f2304f8SSagi Grimberg 	u8 hdgst = nvme_tcp_hdgst_len(queue);
4843f2304f8SSagi Grimberg 
4853f2304f8SSagi Grimberg 	req->pdu = page_frag_alloc(&queue->pf_cache,
4863f2304f8SSagi Grimberg 		sizeof(struct nvme_tcp_cmd_pdu) + hdgst,
4873f2304f8SSagi Grimberg 		GFP_KERNEL | __GFP_ZERO);
4883f2304f8SSagi Grimberg 	if (!req->pdu)
4893f2304f8SSagi Grimberg 		return -ENOMEM;
4903f2304f8SSagi Grimberg 
491f4b9e6c9SKeith Busch 	pdu = req->pdu;
4923f2304f8SSagi Grimberg 	req->queue = queue;
4933f2304f8SSagi Grimberg 	nvme_req(rq)->ctrl = &ctrl->ctrl;
494f4b9e6c9SKeith Busch 	nvme_req(rq)->cmd = &pdu->cmd;
4953f2304f8SSagi Grimberg 
4963f2304f8SSagi Grimberg 	return 0;
4973f2304f8SSagi Grimberg }
4983f2304f8SSagi Grimberg 
4993f2304f8SSagi Grimberg static int nvme_tcp_init_hctx(struct blk_mq_hw_ctx *hctx, void *data,
5003f2304f8SSagi Grimberg 		unsigned int hctx_idx)
5013f2304f8SSagi Grimberg {
50206427ca0SChristoph Hellwig 	struct nvme_tcp_ctrl *ctrl = to_tcp_ctrl(data);
5033f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = &ctrl->queues[hctx_idx + 1];
5043f2304f8SSagi Grimberg 
5053f2304f8SSagi Grimberg 	hctx->driver_data = queue;
5063f2304f8SSagi Grimberg 	return 0;
5073f2304f8SSagi Grimberg }
5083f2304f8SSagi Grimberg 
5093f2304f8SSagi Grimberg static int nvme_tcp_init_admin_hctx(struct blk_mq_hw_ctx *hctx, void *data,
5103f2304f8SSagi Grimberg 		unsigned int hctx_idx)
5113f2304f8SSagi Grimberg {
51206427ca0SChristoph Hellwig 	struct nvme_tcp_ctrl *ctrl = to_tcp_ctrl(data);
5133f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = &ctrl->queues[0];
5143f2304f8SSagi Grimberg 
5153f2304f8SSagi Grimberg 	hctx->driver_data = queue;
5163f2304f8SSagi Grimberg 	return 0;
5173f2304f8SSagi Grimberg }
5183f2304f8SSagi Grimberg 
5193f2304f8SSagi Grimberg static enum nvme_tcp_recv_state
5203f2304f8SSagi Grimberg nvme_tcp_recv_state(struct nvme_tcp_queue *queue)
5213f2304f8SSagi Grimberg {
5223f2304f8SSagi Grimberg 	return  (queue->pdu_remaining) ? NVME_TCP_RECV_PDU :
5233f2304f8SSagi Grimberg 		(queue->ddgst_remaining) ? NVME_TCP_RECV_DDGST :
5243f2304f8SSagi Grimberg 		NVME_TCP_RECV_DATA;
5253f2304f8SSagi Grimberg }
5263f2304f8SSagi Grimberg 
5273f2304f8SSagi Grimberg static void nvme_tcp_init_recv_ctx(struct nvme_tcp_queue *queue)
5283f2304f8SSagi Grimberg {
5293f2304f8SSagi Grimberg 	queue->pdu_remaining = sizeof(struct nvme_tcp_rsp_pdu) +
5303f2304f8SSagi Grimberg 				nvme_tcp_hdgst_len(queue);
5313f2304f8SSagi Grimberg 	queue->pdu_offset = 0;
5323f2304f8SSagi Grimberg 	queue->data_remaining = -1;
5333f2304f8SSagi Grimberg 	queue->ddgst_remaining = 0;
5343f2304f8SSagi Grimberg }
5353f2304f8SSagi Grimberg 
5363f2304f8SSagi Grimberg static void nvme_tcp_error_recovery(struct nvme_ctrl *ctrl)
5373f2304f8SSagi Grimberg {
5383f2304f8SSagi Grimberg 	if (!nvme_change_ctrl_state(ctrl, NVME_CTRL_RESETTING))
5393f2304f8SSagi Grimberg 		return;
5403f2304f8SSagi Grimberg 
541236187c4SSagi Grimberg 	dev_warn(ctrl->device, "starting error recovery\n");
54297b2512aSNigel Kirkland 	queue_work(nvme_reset_wq, &to_tcp_ctrl(ctrl)->err_work);
5433f2304f8SSagi Grimberg }
5443f2304f8SSagi Grimberg 
5453f2304f8SSagi Grimberg static int nvme_tcp_process_nvme_cqe(struct nvme_tcp_queue *queue,
5463f2304f8SSagi Grimberg 		struct nvme_completion *cqe)
5473f2304f8SSagi Grimberg {
5481ba2e507SDaniel Wagner 	struct nvme_tcp_request *req;
5493f2304f8SSagi Grimberg 	struct request *rq;
5503f2304f8SSagi Grimberg 
551e7006de6SSagi Grimberg 	rq = nvme_find_rq(nvme_tcp_tagset(queue), cqe->command_id);
5523f2304f8SSagi Grimberg 	if (!rq) {
5533f2304f8SSagi Grimberg 		dev_err(queue->ctrl->ctrl.device,
554e7006de6SSagi Grimberg 			"got bad cqe.command_id %#x on queue %d\n",
555e7006de6SSagi Grimberg 			cqe->command_id, nvme_tcp_queue_id(queue));
5563f2304f8SSagi Grimberg 		nvme_tcp_error_recovery(&queue->ctrl->ctrl);
5573f2304f8SSagi Grimberg 		return -EINVAL;
5583f2304f8SSagi Grimberg 	}
5593f2304f8SSagi Grimberg 
5601ba2e507SDaniel Wagner 	req = blk_mq_rq_to_pdu(rq);
5611ba2e507SDaniel Wagner 	if (req->status == cpu_to_le16(NVME_SC_SUCCESS))
5621ba2e507SDaniel Wagner 		req->status = cqe->status;
5631ba2e507SDaniel Wagner 
5641ba2e507SDaniel Wagner 	if (!nvme_try_complete_req(rq, req->status, cqe->result))
565ff029451SChristoph Hellwig 		nvme_complete_rq(rq);
5661a9460ceSSagi Grimberg 	queue->nr_cqe++;
5673f2304f8SSagi Grimberg 
5683f2304f8SSagi Grimberg 	return 0;
5693f2304f8SSagi Grimberg }
5703f2304f8SSagi Grimberg 
5713f2304f8SSagi Grimberg static int nvme_tcp_handle_c2h_data(struct nvme_tcp_queue *queue,
5723f2304f8SSagi Grimberg 		struct nvme_tcp_data_pdu *pdu)
5733f2304f8SSagi Grimberg {
5743f2304f8SSagi Grimberg 	struct request *rq;
5753f2304f8SSagi Grimberg 
576e7006de6SSagi Grimberg 	rq = nvme_find_rq(nvme_tcp_tagset(queue), pdu->command_id);
5773f2304f8SSagi Grimberg 	if (!rq) {
5783f2304f8SSagi Grimberg 		dev_err(queue->ctrl->ctrl.device,
579e7006de6SSagi Grimberg 			"got bad c2hdata.command_id %#x on queue %d\n",
580e7006de6SSagi Grimberg 			pdu->command_id, nvme_tcp_queue_id(queue));
5813f2304f8SSagi Grimberg 		return -ENOENT;
5823f2304f8SSagi Grimberg 	}
5833f2304f8SSagi Grimberg 
5843f2304f8SSagi Grimberg 	if (!blk_rq_payload_bytes(rq)) {
5853f2304f8SSagi Grimberg 		dev_err(queue->ctrl->ctrl.device,
5863f2304f8SSagi Grimberg 			"queue %d tag %#x unexpected data\n",
5873f2304f8SSagi Grimberg 			nvme_tcp_queue_id(queue), rq->tag);
5883f2304f8SSagi Grimberg 		return -EIO;
5893f2304f8SSagi Grimberg 	}
5903f2304f8SSagi Grimberg 
5913f2304f8SSagi Grimberg 	queue->data_remaining = le32_to_cpu(pdu->data_length);
5923f2304f8SSagi Grimberg 
593602d674cSSagi Grimberg 	if (pdu->hdr.flags & NVME_TCP_F_DATA_SUCCESS &&
594602d674cSSagi Grimberg 	    unlikely(!(pdu->hdr.flags & NVME_TCP_F_DATA_LAST))) {
595602d674cSSagi Grimberg 		dev_err(queue->ctrl->ctrl.device,
596602d674cSSagi Grimberg 			"queue %d tag %#x SUCCESS set but not last PDU\n",
597602d674cSSagi Grimberg 			nvme_tcp_queue_id(queue), rq->tag);
598602d674cSSagi Grimberg 		nvme_tcp_error_recovery(&queue->ctrl->ctrl);
599602d674cSSagi Grimberg 		return -EPROTO;
600602d674cSSagi Grimberg 	}
601602d674cSSagi Grimberg 
6023f2304f8SSagi Grimberg 	return 0;
6033f2304f8SSagi Grimberg }
6043f2304f8SSagi Grimberg 
6053f2304f8SSagi Grimberg static int nvme_tcp_handle_comp(struct nvme_tcp_queue *queue,
6063f2304f8SSagi Grimberg 		struct nvme_tcp_rsp_pdu *pdu)
6073f2304f8SSagi Grimberg {
6083f2304f8SSagi Grimberg 	struct nvme_completion *cqe = &pdu->cqe;
6093f2304f8SSagi Grimberg 	int ret = 0;
6103f2304f8SSagi Grimberg 
6113f2304f8SSagi Grimberg 	/*
6123f2304f8SSagi Grimberg 	 * AEN requests are special as they don't time out and can
6133f2304f8SSagi Grimberg 	 * survive any kind of queue freeze and often don't respond to
6143f2304f8SSagi Grimberg 	 * aborts.  We don't even bother to allocate a struct request
6153f2304f8SSagi Grimberg 	 * for them but rather special case them here.
6163f2304f8SSagi Grimberg 	 */
61758a8df67SIsrael Rukshin 	if (unlikely(nvme_is_aen_req(nvme_tcp_queue_id(queue),
61858a8df67SIsrael Rukshin 				     cqe->command_id)))
6193f2304f8SSagi Grimberg 		nvme_complete_async_event(&queue->ctrl->ctrl, cqe->status,
6203f2304f8SSagi Grimberg 				&cqe->result);
6213f2304f8SSagi Grimberg 	else
6223f2304f8SSagi Grimberg 		ret = nvme_tcp_process_nvme_cqe(queue, cqe);
6233f2304f8SSagi Grimberg 
6243f2304f8SSagi Grimberg 	return ret;
6253f2304f8SSagi Grimberg }
6263f2304f8SSagi Grimberg 
627c2700d28SVarun Prakash static void nvme_tcp_setup_h2c_data_pdu(struct nvme_tcp_request *req)
6283f2304f8SSagi Grimberg {
629a3406352SSagi Grimberg 	struct nvme_tcp_data_pdu *data = nvme_tcp_req_data_pdu(req);
6303f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = req->queue;
6313f2304f8SSagi Grimberg 	struct request *rq = blk_mq_rq_from_pdu(req);
632c2700d28SVarun Prakash 	u32 h2cdata_sent = req->pdu_len;
6333f2304f8SSagi Grimberg 	u8 hdgst = nvme_tcp_hdgst_len(queue);
6343f2304f8SSagi Grimberg 	u8 ddgst = nvme_tcp_ddgst_len(queue);
6353f2304f8SSagi Grimberg 
6361d3ef9c3SVarun Prakash 	req->state = NVME_TCP_SEND_H2C_PDU;
6371d3ef9c3SVarun Prakash 	req->offset = 0;
638c2700d28SVarun Prakash 	req->pdu_len = min(req->h2cdata_left, queue->maxh2cdata);
6393f2304f8SSagi Grimberg 	req->pdu_sent = 0;
640c2700d28SVarun Prakash 	req->h2cdata_left -= req->pdu_len;
641c2700d28SVarun Prakash 	req->h2cdata_offset += h2cdata_sent;
6423f2304f8SSagi Grimberg 
6433f2304f8SSagi Grimberg 	memset(data, 0, sizeof(*data));
6443f2304f8SSagi Grimberg 	data->hdr.type = nvme_tcp_h2c_data;
645c2700d28SVarun Prakash 	if (!req->h2cdata_left)
6463f2304f8SSagi Grimberg 		data->hdr.flags = NVME_TCP_F_DATA_LAST;
6473f2304f8SSagi Grimberg 	if (queue->hdr_digest)
6483f2304f8SSagi Grimberg 		data->hdr.flags |= NVME_TCP_F_HDGST;
6493f2304f8SSagi Grimberg 	if (queue->data_digest)
6503f2304f8SSagi Grimberg 		data->hdr.flags |= NVME_TCP_F_DDGST;
6513f2304f8SSagi Grimberg 	data->hdr.hlen = sizeof(*data);
6523f2304f8SSagi Grimberg 	data->hdr.pdo = data->hdr.hlen + hdgst;
6533f2304f8SSagi Grimberg 	data->hdr.plen =
6543f2304f8SSagi Grimberg 		cpu_to_le32(data->hdr.hlen + hdgst + req->pdu_len + ddgst);
655c2700d28SVarun Prakash 	data->ttag = req->ttag;
656e7006de6SSagi Grimberg 	data->command_id = nvme_cid(rq);
657c2700d28SVarun Prakash 	data->data_offset = cpu_to_le32(req->h2cdata_offset);
6583f2304f8SSagi Grimberg 	data->data_length = cpu_to_le32(req->pdu_len);
6593f2304f8SSagi Grimberg }
6603f2304f8SSagi Grimberg 
6613f2304f8SSagi Grimberg static int nvme_tcp_handle_r2t(struct nvme_tcp_queue *queue,
6623f2304f8SSagi Grimberg 		struct nvme_tcp_r2t_pdu *pdu)
6633f2304f8SSagi Grimberg {
6643f2304f8SSagi Grimberg 	struct nvme_tcp_request *req;
6653f2304f8SSagi Grimberg 	struct request *rq;
6661d3ef9c3SVarun Prakash 	u32 r2t_length = le32_to_cpu(pdu->r2t_length);
667c2700d28SVarun Prakash 	u32 r2t_offset = le32_to_cpu(pdu->r2t_offset);
6683f2304f8SSagi Grimberg 
669e7006de6SSagi Grimberg 	rq = nvme_find_rq(nvme_tcp_tagset(queue), pdu->command_id);
6703f2304f8SSagi Grimberg 	if (!rq) {
6713f2304f8SSagi Grimberg 		dev_err(queue->ctrl->ctrl.device,
672e7006de6SSagi Grimberg 			"got bad r2t.command_id %#x on queue %d\n",
673e7006de6SSagi Grimberg 			pdu->command_id, nvme_tcp_queue_id(queue));
6743f2304f8SSagi Grimberg 		return -ENOENT;
6753f2304f8SSagi Grimberg 	}
6763f2304f8SSagi Grimberg 	req = blk_mq_rq_to_pdu(rq);
6773f2304f8SSagi Grimberg 
6781d3ef9c3SVarun Prakash 	if (unlikely(!r2t_length)) {
6791d3ef9c3SVarun Prakash 		dev_err(queue->ctrl->ctrl.device,
6801d3ef9c3SVarun Prakash 			"req %d r2t len is %u, probably a bug...\n",
6811d3ef9c3SVarun Prakash 			rq->tag, r2t_length);
6821d3ef9c3SVarun Prakash 		return -EPROTO;
6831d3ef9c3SVarun Prakash 	}
6843f2304f8SSagi Grimberg 
6851d3ef9c3SVarun Prakash 	if (unlikely(req->data_sent + r2t_length > req->data_len)) {
6861d3ef9c3SVarun Prakash 		dev_err(queue->ctrl->ctrl.device,
6871d3ef9c3SVarun Prakash 			"req %d r2t len %u exceeded data len %u (%zu sent)\n",
6881d3ef9c3SVarun Prakash 			rq->tag, r2t_length, req->data_len, req->data_sent);
6891d3ef9c3SVarun Prakash 		return -EPROTO;
6901d3ef9c3SVarun Prakash 	}
6913f2304f8SSagi Grimberg 
692c2700d28SVarun Prakash 	if (unlikely(r2t_offset < req->data_sent)) {
6931d3ef9c3SVarun Prakash 		dev_err(queue->ctrl->ctrl.device,
6941d3ef9c3SVarun Prakash 			"req %d unexpected r2t offset %u (expected %zu)\n",
695c2700d28SVarun Prakash 			rq->tag, r2t_offset, req->data_sent);
6961d3ef9c3SVarun Prakash 		return -EPROTO;
6971d3ef9c3SVarun Prakash 	}
6981d3ef9c3SVarun Prakash 
699c2700d28SVarun Prakash 	req->pdu_len = 0;
700c2700d28SVarun Prakash 	req->h2cdata_left = r2t_length;
701c2700d28SVarun Prakash 	req->h2cdata_offset = r2t_offset;
702c2700d28SVarun Prakash 	req->ttag = pdu->ttag;
703c2700d28SVarun Prakash 
704c2700d28SVarun Prakash 	nvme_tcp_setup_h2c_data_pdu(req);
70586f0348aSSagi Grimberg 	nvme_tcp_queue_request(req, false, true);
7063f2304f8SSagi Grimberg 
7073f2304f8SSagi Grimberg 	return 0;
7083f2304f8SSagi Grimberg }
7093f2304f8SSagi Grimberg 
7103f2304f8SSagi Grimberg static int nvme_tcp_recv_pdu(struct nvme_tcp_queue *queue, struct sk_buff *skb,
7113f2304f8SSagi Grimberg 		unsigned int *offset, size_t *len)
7123f2304f8SSagi Grimberg {
7133f2304f8SSagi Grimberg 	struct nvme_tcp_hdr *hdr;
7143f2304f8SSagi Grimberg 	char *pdu = queue->pdu;
7153f2304f8SSagi Grimberg 	size_t rcv_len = min_t(size_t, *len, queue->pdu_remaining);
7163f2304f8SSagi Grimberg 	int ret;
7173f2304f8SSagi Grimberg 
7183f2304f8SSagi Grimberg 	ret = skb_copy_bits(skb, *offset,
7193f2304f8SSagi Grimberg 		&pdu[queue->pdu_offset], rcv_len);
7203f2304f8SSagi Grimberg 	if (unlikely(ret))
7213f2304f8SSagi Grimberg 		return ret;
7223f2304f8SSagi Grimberg 
7233f2304f8SSagi Grimberg 	queue->pdu_remaining -= rcv_len;
7243f2304f8SSagi Grimberg 	queue->pdu_offset += rcv_len;
7253f2304f8SSagi Grimberg 	*offset += rcv_len;
7263f2304f8SSagi Grimberg 	*len -= rcv_len;
7273f2304f8SSagi Grimberg 	if (queue->pdu_remaining)
7283f2304f8SSagi Grimberg 		return 0;
7293f2304f8SSagi Grimberg 
7303f2304f8SSagi Grimberg 	hdr = queue->pdu;
7313f2304f8SSagi Grimberg 	if (queue->hdr_digest) {
7323f2304f8SSagi Grimberg 		ret = nvme_tcp_verify_hdgst(queue, queue->pdu, hdr->hlen);
7333f2304f8SSagi Grimberg 		if (unlikely(ret))
7343f2304f8SSagi Grimberg 			return ret;
7353f2304f8SSagi Grimberg 	}
7363f2304f8SSagi Grimberg 
7373f2304f8SSagi Grimberg 
7383f2304f8SSagi Grimberg 	if (queue->data_digest) {
7393f2304f8SSagi Grimberg 		ret = nvme_tcp_check_ddgst(queue, queue->pdu);
7403f2304f8SSagi Grimberg 		if (unlikely(ret))
7413f2304f8SSagi Grimberg 			return ret;
7423f2304f8SSagi Grimberg 	}
7433f2304f8SSagi Grimberg 
7443f2304f8SSagi Grimberg 	switch (hdr->type) {
7453f2304f8SSagi Grimberg 	case nvme_tcp_c2h_data:
7466be18260SSagi Grimberg 		return nvme_tcp_handle_c2h_data(queue, (void *)queue->pdu);
7473f2304f8SSagi Grimberg 	case nvme_tcp_rsp:
7483f2304f8SSagi Grimberg 		nvme_tcp_init_recv_ctx(queue);
7496be18260SSagi Grimberg 		return nvme_tcp_handle_comp(queue, (void *)queue->pdu);
7503f2304f8SSagi Grimberg 	case nvme_tcp_r2t:
7513f2304f8SSagi Grimberg 		nvme_tcp_init_recv_ctx(queue);
7526be18260SSagi Grimberg 		return nvme_tcp_handle_r2t(queue, (void *)queue->pdu);
7533f2304f8SSagi Grimberg 	default:
7543f2304f8SSagi Grimberg 		dev_err(queue->ctrl->ctrl.device,
7553f2304f8SSagi Grimberg 			"unsupported pdu type (%d)\n", hdr->type);
7563f2304f8SSagi Grimberg 		return -EINVAL;
7573f2304f8SSagi Grimberg 	}
7583f2304f8SSagi Grimberg }
7593f2304f8SSagi Grimberg 
760988aef9eSChristoph Hellwig static inline void nvme_tcp_end_request(struct request *rq, u16 status)
761602d674cSSagi Grimberg {
762602d674cSSagi Grimberg 	union nvme_result res = {};
763602d674cSSagi Grimberg 
7642eb81a33SChristoph Hellwig 	if (!nvme_try_complete_req(rq, cpu_to_le16(status << 1), res))
765ff029451SChristoph Hellwig 		nvme_complete_rq(rq);
766602d674cSSagi Grimberg }
767602d674cSSagi Grimberg 
7683f2304f8SSagi Grimberg static int nvme_tcp_recv_data(struct nvme_tcp_queue *queue, struct sk_buff *skb,
7693f2304f8SSagi Grimberg 			      unsigned int *offset, size_t *len)
7703f2304f8SSagi Grimberg {
7713f2304f8SSagi Grimberg 	struct nvme_tcp_data_pdu *pdu = (void *)queue->pdu;
7723b01a9d0SSagi Grimberg 	struct request *rq =
773e7006de6SSagi Grimberg 		nvme_cid_to_rq(nvme_tcp_tagset(queue), pdu->command_id);
7743b01a9d0SSagi Grimberg 	struct nvme_tcp_request *req = blk_mq_rq_to_pdu(rq);
7753f2304f8SSagi Grimberg 
7763f2304f8SSagi Grimberg 	while (true) {
7773f2304f8SSagi Grimberg 		int recv_len, ret;
7783f2304f8SSagi Grimberg 
7793f2304f8SSagi Grimberg 		recv_len = min_t(size_t, *len, queue->data_remaining);
7803f2304f8SSagi Grimberg 		if (!recv_len)
7813f2304f8SSagi Grimberg 			break;
7823f2304f8SSagi Grimberg 
7833f2304f8SSagi Grimberg 		if (!iov_iter_count(&req->iter)) {
7843f2304f8SSagi Grimberg 			req->curr_bio = req->curr_bio->bi_next;
7853f2304f8SSagi Grimberg 
7863f2304f8SSagi Grimberg 			/*
7873f2304f8SSagi Grimberg 			 * If we don`t have any bios it means that controller
7883f2304f8SSagi Grimberg 			 * sent more data than we requested, hence error
7893f2304f8SSagi Grimberg 			 */
7903f2304f8SSagi Grimberg 			if (!req->curr_bio) {
7913f2304f8SSagi Grimberg 				dev_err(queue->ctrl->ctrl.device,
7923f2304f8SSagi Grimberg 					"queue %d no space in request %#x",
7933f2304f8SSagi Grimberg 					nvme_tcp_queue_id(queue), rq->tag);
7943f2304f8SSagi Grimberg 				nvme_tcp_init_recv_ctx(queue);
7953f2304f8SSagi Grimberg 				return -EIO;
7963f2304f8SSagi Grimberg 			}
797de4eda9dSAl Viro 			nvme_tcp_init_iter(req, ITER_DEST);
7983f2304f8SSagi Grimberg 		}
7993f2304f8SSagi Grimberg 
8003f2304f8SSagi Grimberg 		/* we can read only from what is left in this bio */
8013f2304f8SSagi Grimberg 		recv_len = min_t(size_t, recv_len,
8023f2304f8SSagi Grimberg 				iov_iter_count(&req->iter));
8033f2304f8SSagi Grimberg 
8043f2304f8SSagi Grimberg 		if (queue->data_digest)
8053f2304f8SSagi Grimberg 			ret = skb_copy_and_hash_datagram_iter(skb, *offset,
8063f2304f8SSagi Grimberg 				&req->iter, recv_len, queue->rcv_hash);
8073f2304f8SSagi Grimberg 		else
8083f2304f8SSagi Grimberg 			ret = skb_copy_datagram_iter(skb, *offset,
8093f2304f8SSagi Grimberg 					&req->iter, recv_len);
8103f2304f8SSagi Grimberg 		if (ret) {
8113f2304f8SSagi Grimberg 			dev_err(queue->ctrl->ctrl.device,
8123f2304f8SSagi Grimberg 				"queue %d failed to copy request %#x data",
8133f2304f8SSagi Grimberg 				nvme_tcp_queue_id(queue), rq->tag);
8143f2304f8SSagi Grimberg 			return ret;
8153f2304f8SSagi Grimberg 		}
8163f2304f8SSagi Grimberg 
8173f2304f8SSagi Grimberg 		*len -= recv_len;
8183f2304f8SSagi Grimberg 		*offset += recv_len;
8193f2304f8SSagi Grimberg 		queue->data_remaining -= recv_len;
8203f2304f8SSagi Grimberg 	}
8213f2304f8SSagi Grimberg 
8223f2304f8SSagi Grimberg 	if (!queue->data_remaining) {
8233f2304f8SSagi Grimberg 		if (queue->data_digest) {
8243f2304f8SSagi Grimberg 			nvme_tcp_ddgst_final(queue->rcv_hash, &queue->exp_ddgst);
8253f2304f8SSagi Grimberg 			queue->ddgst_remaining = NVME_TCP_DIGEST_LENGTH;
8263f2304f8SSagi Grimberg 		} else {
8271a9460ceSSagi Grimberg 			if (pdu->hdr.flags & NVME_TCP_F_DATA_SUCCESS) {
8281ba2e507SDaniel Wagner 				nvme_tcp_end_request(rq,
8291ba2e507SDaniel Wagner 						le16_to_cpu(req->status));
8301a9460ceSSagi Grimberg 				queue->nr_cqe++;
8311a9460ceSSagi Grimberg 			}
8323f2304f8SSagi Grimberg 			nvme_tcp_init_recv_ctx(queue);
8333f2304f8SSagi Grimberg 		}
8343f2304f8SSagi Grimberg 	}
8353f2304f8SSagi Grimberg 
8363f2304f8SSagi Grimberg 	return 0;
8373f2304f8SSagi Grimberg }
8383f2304f8SSagi Grimberg 
8393f2304f8SSagi Grimberg static int nvme_tcp_recv_ddgst(struct nvme_tcp_queue *queue,
8403f2304f8SSagi Grimberg 		struct sk_buff *skb, unsigned int *offset, size_t *len)
8413f2304f8SSagi Grimberg {
842602d674cSSagi Grimberg 	struct nvme_tcp_data_pdu *pdu = (void *)queue->pdu;
8433f2304f8SSagi Grimberg 	char *ddgst = (char *)&queue->recv_ddgst;
8443f2304f8SSagi Grimberg 	size_t recv_len = min_t(size_t, *len, queue->ddgst_remaining);
8453f2304f8SSagi Grimberg 	off_t off = NVME_TCP_DIGEST_LENGTH - queue->ddgst_remaining;
8463f2304f8SSagi Grimberg 	int ret;
8473f2304f8SSagi Grimberg 
8483f2304f8SSagi Grimberg 	ret = skb_copy_bits(skb, *offset, &ddgst[off], recv_len);
8493f2304f8SSagi Grimberg 	if (unlikely(ret))
8503f2304f8SSagi Grimberg 		return ret;
8513f2304f8SSagi Grimberg 
8523f2304f8SSagi Grimberg 	queue->ddgst_remaining -= recv_len;
8533f2304f8SSagi Grimberg 	*offset += recv_len;
8543f2304f8SSagi Grimberg 	*len -= recv_len;
8553f2304f8SSagi Grimberg 	if (queue->ddgst_remaining)
8563f2304f8SSagi Grimberg 		return 0;
8573f2304f8SSagi Grimberg 
8583f2304f8SSagi Grimberg 	if (queue->recv_ddgst != queue->exp_ddgst) {
8591ba2e507SDaniel Wagner 		struct request *rq = nvme_cid_to_rq(nvme_tcp_tagset(queue),
8601ba2e507SDaniel Wagner 					pdu->command_id);
8611ba2e507SDaniel Wagner 		struct nvme_tcp_request *req = blk_mq_rq_to_pdu(rq);
8621ba2e507SDaniel Wagner 
8631ba2e507SDaniel Wagner 		req->status = cpu_to_le16(NVME_SC_DATA_XFER_ERROR);
8641ba2e507SDaniel Wagner 
8653f2304f8SSagi Grimberg 		dev_err(queue->ctrl->ctrl.device,
8663f2304f8SSagi Grimberg 			"data digest error: recv %#x expected %#x\n",
8673f2304f8SSagi Grimberg 			le32_to_cpu(queue->recv_ddgst),
8683f2304f8SSagi Grimberg 			le32_to_cpu(queue->exp_ddgst));
8693f2304f8SSagi Grimberg 	}
8703f2304f8SSagi Grimberg 
871602d674cSSagi Grimberg 	if (pdu->hdr.flags & NVME_TCP_F_DATA_SUCCESS) {
872e7006de6SSagi Grimberg 		struct request *rq = nvme_cid_to_rq(nvme_tcp_tagset(queue),
873602d674cSSagi Grimberg 					pdu->command_id);
8741ba2e507SDaniel Wagner 		struct nvme_tcp_request *req = blk_mq_rq_to_pdu(rq);
875602d674cSSagi Grimberg 
8761ba2e507SDaniel Wagner 		nvme_tcp_end_request(rq, le16_to_cpu(req->status));
8771a9460ceSSagi Grimberg 		queue->nr_cqe++;
878602d674cSSagi Grimberg 	}
879602d674cSSagi Grimberg 
8803f2304f8SSagi Grimberg 	nvme_tcp_init_recv_ctx(queue);
8813f2304f8SSagi Grimberg 	return 0;
8823f2304f8SSagi Grimberg }
8833f2304f8SSagi Grimberg 
8843f2304f8SSagi Grimberg static int nvme_tcp_recv_skb(read_descriptor_t *desc, struct sk_buff *skb,
8853f2304f8SSagi Grimberg 			     unsigned int offset, size_t len)
8863f2304f8SSagi Grimberg {
8873f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = desc->arg.data;
8883f2304f8SSagi Grimberg 	size_t consumed = len;
8893f2304f8SSagi Grimberg 	int result;
8903f2304f8SSagi Grimberg 
8913f2304f8SSagi Grimberg 	while (len) {
8923f2304f8SSagi Grimberg 		switch (nvme_tcp_recv_state(queue)) {
8933f2304f8SSagi Grimberg 		case NVME_TCP_RECV_PDU:
8943f2304f8SSagi Grimberg 			result = nvme_tcp_recv_pdu(queue, skb, &offset, &len);
8953f2304f8SSagi Grimberg 			break;
8963f2304f8SSagi Grimberg 		case NVME_TCP_RECV_DATA:
8973f2304f8SSagi Grimberg 			result = nvme_tcp_recv_data(queue, skb, &offset, &len);
8983f2304f8SSagi Grimberg 			break;
8993f2304f8SSagi Grimberg 		case NVME_TCP_RECV_DDGST:
9003f2304f8SSagi Grimberg 			result = nvme_tcp_recv_ddgst(queue, skb, &offset, &len);
9013f2304f8SSagi Grimberg 			break;
9023f2304f8SSagi Grimberg 		default:
9033f2304f8SSagi Grimberg 			result = -EFAULT;
9043f2304f8SSagi Grimberg 		}
9053f2304f8SSagi Grimberg 		if (result) {
9063f2304f8SSagi Grimberg 			dev_err(queue->ctrl->ctrl.device,
9073f2304f8SSagi Grimberg 				"receive failed:  %d\n", result);
9083f2304f8SSagi Grimberg 			queue->rd_enabled = false;
9093f2304f8SSagi Grimberg 			nvme_tcp_error_recovery(&queue->ctrl->ctrl);
9103f2304f8SSagi Grimberg 			return result;
9113f2304f8SSagi Grimberg 		}
9123f2304f8SSagi Grimberg 	}
9133f2304f8SSagi Grimberg 
9143f2304f8SSagi Grimberg 	return consumed;
9153f2304f8SSagi Grimberg }
9163f2304f8SSagi Grimberg 
9173f2304f8SSagi Grimberg static void nvme_tcp_data_ready(struct sock *sk)
9183f2304f8SSagi Grimberg {
9193f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue;
9203f2304f8SSagi Grimberg 
92140e0b090SPeilin Ye 	trace_sk_data_ready(sk);
92240e0b090SPeilin Ye 
923386e5e6eSSagi Grimberg 	read_lock_bh(&sk->sk_callback_lock);
9243f2304f8SSagi Grimberg 	queue = sk->sk_user_data;
92572e5d757SSagi Grimberg 	if (likely(queue && queue->rd_enabled) &&
92672e5d757SSagi Grimberg 	    !test_bit(NVME_TCP_Q_POLLING, &queue->flags))
9273f2304f8SSagi Grimberg 		queue_work_on(queue->io_cpu, nvme_tcp_wq, &queue->io_work);
928386e5e6eSSagi Grimberg 	read_unlock_bh(&sk->sk_callback_lock);
9293f2304f8SSagi Grimberg }
9303f2304f8SSagi Grimberg 
9313f2304f8SSagi Grimberg static void nvme_tcp_write_space(struct sock *sk)
9323f2304f8SSagi Grimberg {
9333f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue;
9343f2304f8SSagi Grimberg 
9353f2304f8SSagi Grimberg 	read_lock_bh(&sk->sk_callback_lock);
9363f2304f8SSagi Grimberg 	queue = sk->sk_user_data;
9373f2304f8SSagi Grimberg 	if (likely(queue && sk_stream_is_writeable(sk))) {
9383f2304f8SSagi Grimberg 		clear_bit(SOCK_NOSPACE, &sk->sk_socket->flags);
9393f2304f8SSagi Grimberg 		queue_work_on(queue->io_cpu, nvme_tcp_wq, &queue->io_work);
9403f2304f8SSagi Grimberg 	}
9413f2304f8SSagi Grimberg 	read_unlock_bh(&sk->sk_callback_lock);
9423f2304f8SSagi Grimberg }
9433f2304f8SSagi Grimberg 
9443f2304f8SSagi Grimberg static void nvme_tcp_state_change(struct sock *sk)
9453f2304f8SSagi Grimberg {
9463f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue;
9473f2304f8SSagi Grimberg 
9488b73b45dSSagi Grimberg 	read_lock_bh(&sk->sk_callback_lock);
9493f2304f8SSagi Grimberg 	queue = sk->sk_user_data;
9503f2304f8SSagi Grimberg 	if (!queue)
9513f2304f8SSagi Grimberg 		goto done;
9523f2304f8SSagi Grimberg 
9533f2304f8SSagi Grimberg 	switch (sk->sk_state) {
9543f2304f8SSagi Grimberg 	case TCP_CLOSE:
9553f2304f8SSagi Grimberg 	case TCP_CLOSE_WAIT:
9563f2304f8SSagi Grimberg 	case TCP_LAST_ACK:
9573f2304f8SSagi Grimberg 	case TCP_FIN_WAIT1:
9583f2304f8SSagi Grimberg 	case TCP_FIN_WAIT2:
9593f2304f8SSagi Grimberg 		nvme_tcp_error_recovery(&queue->ctrl->ctrl);
9603f2304f8SSagi Grimberg 		break;
9613f2304f8SSagi Grimberg 	default:
9623f2304f8SSagi Grimberg 		dev_info(queue->ctrl->ctrl.device,
9633f2304f8SSagi Grimberg 			"queue %d socket state %d\n",
9643f2304f8SSagi Grimberg 			nvme_tcp_queue_id(queue), sk->sk_state);
9653f2304f8SSagi Grimberg 	}
9663f2304f8SSagi Grimberg 
9673f2304f8SSagi Grimberg 	queue->state_change(sk);
9683f2304f8SSagi Grimberg done:
9698b73b45dSSagi Grimberg 	read_unlock_bh(&sk->sk_callback_lock);
9703f2304f8SSagi Grimberg }
9713f2304f8SSagi Grimberg 
9723f2304f8SSagi Grimberg static inline void nvme_tcp_done_send_req(struct nvme_tcp_queue *queue)
9733f2304f8SSagi Grimberg {
9743f2304f8SSagi Grimberg 	queue->request = NULL;
9753f2304f8SSagi Grimberg }
9763f2304f8SSagi Grimberg 
9773f2304f8SSagi Grimberg static void nvme_tcp_fail_request(struct nvme_tcp_request *req)
9783f2304f8SSagi Grimberg {
97963573807SSagi Grimberg 	if (nvme_tcp_async_req(req)) {
98063573807SSagi Grimberg 		union nvme_result res = {};
98163573807SSagi Grimberg 
98263573807SSagi Grimberg 		nvme_complete_async_event(&req->queue->ctrl->ctrl,
98363573807SSagi Grimberg 				cpu_to_le16(NVME_SC_HOST_PATH_ERROR), &res);
98463573807SSagi Grimberg 	} else {
98563573807SSagi Grimberg 		nvme_tcp_end_request(blk_mq_rq_from_pdu(req),
98663573807SSagi Grimberg 				NVME_SC_HOST_PATH_ERROR);
98763573807SSagi Grimberg 	}
9883f2304f8SSagi Grimberg }
9893f2304f8SSagi Grimberg 
9903f2304f8SSagi Grimberg static int nvme_tcp_try_send_data(struct nvme_tcp_request *req)
9913f2304f8SSagi Grimberg {
9923f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = req->queue;
99325e1f67eSSagi Grimberg 	int req_data_len = req->data_len;
994c2700d28SVarun Prakash 	u32 h2cdata_left = req->h2cdata_left;
9953f2304f8SSagi Grimberg 
9963f2304f8SSagi Grimberg 	while (true) {
9973f2304f8SSagi Grimberg 		struct page *page = nvme_tcp_req_cur_page(req);
9983f2304f8SSagi Grimberg 		size_t offset = nvme_tcp_req_cur_offset(req);
9993f2304f8SSagi Grimberg 		size_t len = nvme_tcp_req_cur_length(req);
10003f2304f8SSagi Grimberg 		bool last = nvme_tcp_pdu_last_send(req, len);
100125e1f67eSSagi Grimberg 		int req_data_sent = req->data_sent;
10023f2304f8SSagi Grimberg 		int ret, flags = MSG_DONTWAIT;
10033f2304f8SSagi Grimberg 
1004122e5b9fSSagi Grimberg 		if (last && !queue->data_digest && !nvme_tcp_queue_more(queue))
10053f2304f8SSagi Grimberg 			flags |= MSG_EOR;
10063f2304f8SSagi Grimberg 		else
10075bb052d7SSagi Grimberg 			flags |= MSG_MORE | MSG_SENDPAGE_NOTLAST;
10083f2304f8SSagi Grimberg 
10097d4194abSColy Li 		if (sendpage_ok(page)) {
10107d4194abSColy Li 			ret = kernel_sendpage(queue->sock, page, offset, len,
101137c15219SMikhail Skorzhinskii 					flags);
101237c15219SMikhail Skorzhinskii 		} else {
10137d4194abSColy Li 			ret = sock_no_sendpage(queue->sock, page, offset, len,
101437c15219SMikhail Skorzhinskii 					flags);
101537c15219SMikhail Skorzhinskii 		}
10163f2304f8SSagi Grimberg 		if (ret <= 0)
10173f2304f8SSagi Grimberg 			return ret;
10183f2304f8SSagi Grimberg 
10193f2304f8SSagi Grimberg 		if (queue->data_digest)
10203f2304f8SSagi Grimberg 			nvme_tcp_ddgst_update(queue->snd_hash, page,
10213f2304f8SSagi Grimberg 					offset, ret);
10223f2304f8SSagi Grimberg 
1023e371af03SSagi Grimberg 		/*
1024e371af03SSagi Grimberg 		 * update the request iterator except for the last payload send
1025e371af03SSagi Grimberg 		 * in the request where we don't want to modify it as we may
1026e371af03SSagi Grimberg 		 * compete with the RX path completing the request.
1027e371af03SSagi Grimberg 		 */
102825e1f67eSSagi Grimberg 		if (req_data_sent + ret < req_data_len)
1029e371af03SSagi Grimberg 			nvme_tcp_advance_req(req, ret);
1030e371af03SSagi Grimberg 
1031e371af03SSagi Grimberg 		/* fully successful last send in current PDU */
10323f2304f8SSagi Grimberg 		if (last && ret == len) {
10333f2304f8SSagi Grimberg 			if (queue->data_digest) {
10343f2304f8SSagi Grimberg 				nvme_tcp_ddgst_final(queue->snd_hash,
10353f2304f8SSagi Grimberg 					&req->ddgst);
10363f2304f8SSagi Grimberg 				req->state = NVME_TCP_SEND_DDGST;
10373f2304f8SSagi Grimberg 				req->offset = 0;
10383f2304f8SSagi Grimberg 			} else {
1039c2700d28SVarun Prakash 				if (h2cdata_left)
1040c2700d28SVarun Prakash 					nvme_tcp_setup_h2c_data_pdu(req);
1041c2700d28SVarun Prakash 				else
10423f2304f8SSagi Grimberg 					nvme_tcp_done_send_req(queue);
10433f2304f8SSagi Grimberg 			}
10443f2304f8SSagi Grimberg 			return 1;
10453f2304f8SSagi Grimberg 		}
10463f2304f8SSagi Grimberg 	}
10473f2304f8SSagi Grimberg 	return -EAGAIN;
10483f2304f8SSagi Grimberg }
10493f2304f8SSagi Grimberg 
10503f2304f8SSagi Grimberg static int nvme_tcp_try_send_cmd_pdu(struct nvme_tcp_request *req)
10513f2304f8SSagi Grimberg {
10523f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = req->queue;
1053a3406352SSagi Grimberg 	struct nvme_tcp_cmd_pdu *pdu = nvme_tcp_req_cmd_pdu(req);
10543f2304f8SSagi Grimberg 	bool inline_data = nvme_tcp_has_inline_data(req);
10553f2304f8SSagi Grimberg 	u8 hdgst = nvme_tcp_hdgst_len(queue);
10563f2304f8SSagi Grimberg 	int len = sizeof(*pdu) + hdgst - req->offset;
10575bb052d7SSagi Grimberg 	int flags = MSG_DONTWAIT;
10583f2304f8SSagi Grimberg 	int ret;
10593f2304f8SSagi Grimberg 
1060122e5b9fSSagi Grimberg 	if (inline_data || nvme_tcp_queue_more(queue))
10615bb052d7SSagi Grimberg 		flags |= MSG_MORE | MSG_SENDPAGE_NOTLAST;
10625bb052d7SSagi Grimberg 	else
10635bb052d7SSagi Grimberg 		flags |= MSG_EOR;
10645bb052d7SSagi Grimberg 
10653f2304f8SSagi Grimberg 	if (queue->hdr_digest && !req->offset)
10663f2304f8SSagi Grimberg 		nvme_tcp_hdgst(queue->snd_hash, pdu, sizeof(*pdu));
10673f2304f8SSagi Grimberg 
10683f2304f8SSagi Grimberg 	ret = kernel_sendpage(queue->sock, virt_to_page(pdu),
10693f2304f8SSagi Grimberg 			offset_in_page(pdu) + req->offset, len,  flags);
10703f2304f8SSagi Grimberg 	if (unlikely(ret <= 0))
10713f2304f8SSagi Grimberg 		return ret;
10723f2304f8SSagi Grimberg 
10733f2304f8SSagi Grimberg 	len -= ret;
10743f2304f8SSagi Grimberg 	if (!len) {
10753f2304f8SSagi Grimberg 		if (inline_data) {
10763f2304f8SSagi Grimberg 			req->state = NVME_TCP_SEND_DATA;
10773f2304f8SSagi Grimberg 			if (queue->data_digest)
10783f2304f8SSagi Grimberg 				crypto_ahash_init(queue->snd_hash);
10793f2304f8SSagi Grimberg 		} else {
10803f2304f8SSagi Grimberg 			nvme_tcp_done_send_req(queue);
10813f2304f8SSagi Grimberg 		}
10823f2304f8SSagi Grimberg 		return 1;
10833f2304f8SSagi Grimberg 	}
10843f2304f8SSagi Grimberg 	req->offset += ret;
10853f2304f8SSagi Grimberg 
10863f2304f8SSagi Grimberg 	return -EAGAIN;
10873f2304f8SSagi Grimberg }
10883f2304f8SSagi Grimberg 
10893f2304f8SSagi Grimberg static int nvme_tcp_try_send_data_pdu(struct nvme_tcp_request *req)
10903f2304f8SSagi Grimberg {
10913f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = req->queue;
1092a3406352SSagi Grimberg 	struct nvme_tcp_data_pdu *pdu = nvme_tcp_req_data_pdu(req);
10933f2304f8SSagi Grimberg 	u8 hdgst = nvme_tcp_hdgst_len(queue);
10943f2304f8SSagi Grimberg 	int len = sizeof(*pdu) - req->offset + hdgst;
10953f2304f8SSagi Grimberg 	int ret;
10963f2304f8SSagi Grimberg 
10973f2304f8SSagi Grimberg 	if (queue->hdr_digest && !req->offset)
10983f2304f8SSagi Grimberg 		nvme_tcp_hdgst(queue->snd_hash, pdu, sizeof(*pdu));
10993f2304f8SSagi Grimberg 
1100c2700d28SVarun Prakash 	if (!req->h2cdata_left)
11013f2304f8SSagi Grimberg 		ret = kernel_sendpage(queue->sock, virt_to_page(pdu),
11023f2304f8SSagi Grimberg 				offset_in_page(pdu) + req->offset, len,
11035bb052d7SSagi Grimberg 				MSG_DONTWAIT | MSG_MORE | MSG_SENDPAGE_NOTLAST);
1104c2700d28SVarun Prakash 	else
1105c2700d28SVarun Prakash 		ret = sock_no_sendpage(queue->sock, virt_to_page(pdu),
1106c2700d28SVarun Prakash 				offset_in_page(pdu) + req->offset, len,
1107c2700d28SVarun Prakash 				MSG_DONTWAIT | MSG_MORE);
11083f2304f8SSagi Grimberg 	if (unlikely(ret <= 0))
11093f2304f8SSagi Grimberg 		return ret;
11103f2304f8SSagi Grimberg 
11113f2304f8SSagi Grimberg 	len -= ret;
11123f2304f8SSagi Grimberg 	if (!len) {
11133f2304f8SSagi Grimberg 		req->state = NVME_TCP_SEND_DATA;
11143f2304f8SSagi Grimberg 		if (queue->data_digest)
11153f2304f8SSagi Grimberg 			crypto_ahash_init(queue->snd_hash);
11163f2304f8SSagi Grimberg 		return 1;
11173f2304f8SSagi Grimberg 	}
11183f2304f8SSagi Grimberg 	req->offset += ret;
11193f2304f8SSagi Grimberg 
11203f2304f8SSagi Grimberg 	return -EAGAIN;
11213f2304f8SSagi Grimberg }
11223f2304f8SSagi Grimberg 
11233f2304f8SSagi Grimberg static int nvme_tcp_try_send_ddgst(struct nvme_tcp_request *req)
11243f2304f8SSagi Grimberg {
11253f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = req->queue;
1126ce7723e9SVarun Prakash 	size_t offset = req->offset;
1127c2700d28SVarun Prakash 	u32 h2cdata_left = req->h2cdata_left;
11283f2304f8SSagi Grimberg 	int ret;
1129122e5b9fSSagi Grimberg 	struct msghdr msg = { .msg_flags = MSG_DONTWAIT };
11303f2304f8SSagi Grimberg 	struct kvec iov = {
1131d89b9f3bSVarun Prakash 		.iov_base = (u8 *)&req->ddgst + req->offset,
11323f2304f8SSagi Grimberg 		.iov_len = NVME_TCP_DIGEST_LENGTH - req->offset
11333f2304f8SSagi Grimberg 	};
11343f2304f8SSagi Grimberg 
1135122e5b9fSSagi Grimberg 	if (nvme_tcp_queue_more(queue))
1136122e5b9fSSagi Grimberg 		msg.msg_flags |= MSG_MORE;
1137122e5b9fSSagi Grimberg 	else
1138122e5b9fSSagi Grimberg 		msg.msg_flags |= MSG_EOR;
1139122e5b9fSSagi Grimberg 
11403f2304f8SSagi Grimberg 	ret = kernel_sendmsg(queue->sock, &msg, &iov, 1, iov.iov_len);
11413f2304f8SSagi Grimberg 	if (unlikely(ret <= 0))
11423f2304f8SSagi Grimberg 		return ret;
11433f2304f8SSagi Grimberg 
1144ce7723e9SVarun Prakash 	if (offset + ret == NVME_TCP_DIGEST_LENGTH) {
1145c2700d28SVarun Prakash 		if (h2cdata_left)
1146c2700d28SVarun Prakash 			nvme_tcp_setup_h2c_data_pdu(req);
1147c2700d28SVarun Prakash 		else
11483f2304f8SSagi Grimberg 			nvme_tcp_done_send_req(queue);
11493f2304f8SSagi Grimberg 		return 1;
11503f2304f8SSagi Grimberg 	}
11513f2304f8SSagi Grimberg 
11523f2304f8SSagi Grimberg 	req->offset += ret;
11533f2304f8SSagi Grimberg 	return -EAGAIN;
11543f2304f8SSagi Grimberg }
11553f2304f8SSagi Grimberg 
11563f2304f8SSagi Grimberg static int nvme_tcp_try_send(struct nvme_tcp_queue *queue)
11573f2304f8SSagi Grimberg {
11583f2304f8SSagi Grimberg 	struct nvme_tcp_request *req;
115983e1226bSSagi Grimberg 	unsigned int noreclaim_flag;
11603f2304f8SSagi Grimberg 	int ret = 1;
11613f2304f8SSagi Grimberg 
11623f2304f8SSagi Grimberg 	if (!queue->request) {
11633f2304f8SSagi Grimberg 		queue->request = nvme_tcp_fetch_request(queue);
11643f2304f8SSagi Grimberg 		if (!queue->request)
11653f2304f8SSagi Grimberg 			return 0;
11663f2304f8SSagi Grimberg 	}
11673f2304f8SSagi Grimberg 	req = queue->request;
11683f2304f8SSagi Grimberg 
116983e1226bSSagi Grimberg 	noreclaim_flag = memalloc_noreclaim_save();
11703f2304f8SSagi Grimberg 	if (req->state == NVME_TCP_SEND_CMD_PDU) {
11713f2304f8SSagi Grimberg 		ret = nvme_tcp_try_send_cmd_pdu(req);
11723f2304f8SSagi Grimberg 		if (ret <= 0)
11733f2304f8SSagi Grimberg 			goto done;
11743f2304f8SSagi Grimberg 		if (!nvme_tcp_has_inline_data(req))
117583e1226bSSagi Grimberg 			goto out;
11763f2304f8SSagi Grimberg 	}
11773f2304f8SSagi Grimberg 
11783f2304f8SSagi Grimberg 	if (req->state == NVME_TCP_SEND_H2C_PDU) {
11793f2304f8SSagi Grimberg 		ret = nvme_tcp_try_send_data_pdu(req);
11803f2304f8SSagi Grimberg 		if (ret <= 0)
11813f2304f8SSagi Grimberg 			goto done;
11823f2304f8SSagi Grimberg 	}
11833f2304f8SSagi Grimberg 
11843f2304f8SSagi Grimberg 	if (req->state == NVME_TCP_SEND_DATA) {
11853f2304f8SSagi Grimberg 		ret = nvme_tcp_try_send_data(req);
11863f2304f8SSagi Grimberg 		if (ret <= 0)
11873f2304f8SSagi Grimberg 			goto done;
11883f2304f8SSagi Grimberg 	}
11893f2304f8SSagi Grimberg 
11903f2304f8SSagi Grimberg 	if (req->state == NVME_TCP_SEND_DDGST)
11913f2304f8SSagi Grimberg 		ret = nvme_tcp_try_send_ddgst(req);
11923f2304f8SSagi Grimberg done:
11935ff4e112SSagi Grimberg 	if (ret == -EAGAIN) {
11943f2304f8SSagi Grimberg 		ret = 0;
11955ff4e112SSagi Grimberg 	} else if (ret < 0) {
11965ff4e112SSagi Grimberg 		dev_err(queue->ctrl->ctrl.device,
11975ff4e112SSagi Grimberg 			"failed to send request %d\n", ret);
11985ff4e112SSagi Grimberg 		nvme_tcp_fail_request(queue->request);
11995ff4e112SSagi Grimberg 		nvme_tcp_done_send_req(queue);
12005ff4e112SSagi Grimberg 	}
120183e1226bSSagi Grimberg out:
120283e1226bSSagi Grimberg 	memalloc_noreclaim_restore(noreclaim_flag);
12033f2304f8SSagi Grimberg 	return ret;
12043f2304f8SSagi Grimberg }
12053f2304f8SSagi Grimberg 
12063f2304f8SSagi Grimberg static int nvme_tcp_try_recv(struct nvme_tcp_queue *queue)
12073f2304f8SSagi Grimberg {
120810407ec9SPotnuri Bharat Teja 	struct socket *sock = queue->sock;
120910407ec9SPotnuri Bharat Teja 	struct sock *sk = sock->sk;
12103f2304f8SSagi Grimberg 	read_descriptor_t rd_desc;
12113f2304f8SSagi Grimberg 	int consumed;
12123f2304f8SSagi Grimberg 
12133f2304f8SSagi Grimberg 	rd_desc.arg.data = queue;
12143f2304f8SSagi Grimberg 	rd_desc.count = 1;
12153f2304f8SSagi Grimberg 	lock_sock(sk);
12161a9460ceSSagi Grimberg 	queue->nr_cqe = 0;
121710407ec9SPotnuri Bharat Teja 	consumed = sock->ops->read_sock(sk, &rd_desc, nvme_tcp_recv_skb);
12183f2304f8SSagi Grimberg 	release_sock(sk);
12193f2304f8SSagi Grimberg 	return consumed;
12203f2304f8SSagi Grimberg }
12213f2304f8SSagi Grimberg 
12223f2304f8SSagi Grimberg static void nvme_tcp_io_work(struct work_struct *w)
12233f2304f8SSagi Grimberg {
12243f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue =
12253f2304f8SSagi Grimberg 		container_of(w, struct nvme_tcp_queue, io_work);
1226ddef2957SWunderlich, Mark 	unsigned long deadline = jiffies + msecs_to_jiffies(1);
12273f2304f8SSagi Grimberg 
12283f2304f8SSagi Grimberg 	do {
12293f2304f8SSagi Grimberg 		bool pending = false;
12303f2304f8SSagi Grimberg 		int result;
12313f2304f8SSagi Grimberg 
1232db5ad6b7SSagi Grimberg 		if (mutex_trylock(&queue->send_mutex)) {
12333f2304f8SSagi Grimberg 			result = nvme_tcp_try_send(queue);
1234db5ad6b7SSagi Grimberg 			mutex_unlock(&queue->send_mutex);
12355ff4e112SSagi Grimberg 			if (result > 0)
12363f2304f8SSagi Grimberg 				pending = true;
12375ff4e112SSagi Grimberg 			else if (unlikely(result < 0))
12385ff4e112SSagi Grimberg 				break;
123970f437fbSKeith Busch 		}
12403f2304f8SSagi Grimberg 
12413f2304f8SSagi Grimberg 		result = nvme_tcp_try_recv(queue);
12423f2304f8SSagi Grimberg 		if (result > 0)
12433f2304f8SSagi Grimberg 			pending = true;
1244761ad26cSSagi Grimberg 		else if (unlikely(result < 0))
124539d06079SSagi Grimberg 			return;
12463f2304f8SSagi Grimberg 
1247160f3549SSagi Grimberg 		if (!pending || !queue->rd_enabled)
12483f2304f8SSagi Grimberg 			return;
12493f2304f8SSagi Grimberg 
1250ddef2957SWunderlich, Mark 	} while (!time_after(jiffies, deadline)); /* quota is exhausted */
12513f2304f8SSagi Grimberg 
12523f2304f8SSagi Grimberg 	queue_work_on(queue->io_cpu, nvme_tcp_wq, &queue->io_work);
12533f2304f8SSagi Grimberg }
12543f2304f8SSagi Grimberg 
12553f2304f8SSagi Grimberg static void nvme_tcp_free_crypto(struct nvme_tcp_queue *queue)
12563f2304f8SSagi Grimberg {
12573f2304f8SSagi Grimberg 	struct crypto_ahash *tfm = crypto_ahash_reqtfm(queue->rcv_hash);
12583f2304f8SSagi Grimberg 
12593f2304f8SSagi Grimberg 	ahash_request_free(queue->rcv_hash);
12603f2304f8SSagi Grimberg 	ahash_request_free(queue->snd_hash);
12613f2304f8SSagi Grimberg 	crypto_free_ahash(tfm);
12623f2304f8SSagi Grimberg }
12633f2304f8SSagi Grimberg 
12643f2304f8SSagi Grimberg static int nvme_tcp_alloc_crypto(struct nvme_tcp_queue *queue)
12653f2304f8SSagi Grimberg {
12663f2304f8SSagi Grimberg 	struct crypto_ahash *tfm;
12673f2304f8SSagi Grimberg 
12683f2304f8SSagi Grimberg 	tfm = crypto_alloc_ahash("crc32c", 0, CRYPTO_ALG_ASYNC);
12693f2304f8SSagi Grimberg 	if (IS_ERR(tfm))
12703f2304f8SSagi Grimberg 		return PTR_ERR(tfm);
12713f2304f8SSagi Grimberg 
12723f2304f8SSagi Grimberg 	queue->snd_hash = ahash_request_alloc(tfm, GFP_KERNEL);
12733f2304f8SSagi Grimberg 	if (!queue->snd_hash)
12743f2304f8SSagi Grimberg 		goto free_tfm;
12753f2304f8SSagi Grimberg 	ahash_request_set_callback(queue->snd_hash, 0, NULL, NULL);
12763f2304f8SSagi Grimberg 
12773f2304f8SSagi Grimberg 	queue->rcv_hash = ahash_request_alloc(tfm, GFP_KERNEL);
12783f2304f8SSagi Grimberg 	if (!queue->rcv_hash)
12793f2304f8SSagi Grimberg 		goto free_snd_hash;
12803f2304f8SSagi Grimberg 	ahash_request_set_callback(queue->rcv_hash, 0, NULL, NULL);
12813f2304f8SSagi Grimberg 
12823f2304f8SSagi Grimberg 	return 0;
12833f2304f8SSagi Grimberg free_snd_hash:
12843f2304f8SSagi Grimberg 	ahash_request_free(queue->snd_hash);
12853f2304f8SSagi Grimberg free_tfm:
12863f2304f8SSagi Grimberg 	crypto_free_ahash(tfm);
12873f2304f8SSagi Grimberg 	return -ENOMEM;
12883f2304f8SSagi Grimberg }
12893f2304f8SSagi Grimberg 
12903f2304f8SSagi Grimberg static void nvme_tcp_free_async_req(struct nvme_tcp_ctrl *ctrl)
12913f2304f8SSagi Grimberg {
12923f2304f8SSagi Grimberg 	struct nvme_tcp_request *async = &ctrl->async_req;
12933f2304f8SSagi Grimberg 
12943f2304f8SSagi Grimberg 	page_frag_free(async->pdu);
12953f2304f8SSagi Grimberg }
12963f2304f8SSagi Grimberg 
12973f2304f8SSagi Grimberg static int nvme_tcp_alloc_async_req(struct nvme_tcp_ctrl *ctrl)
12983f2304f8SSagi Grimberg {
12993f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = &ctrl->queues[0];
13003f2304f8SSagi Grimberg 	struct nvme_tcp_request *async = &ctrl->async_req;
13013f2304f8SSagi Grimberg 	u8 hdgst = nvme_tcp_hdgst_len(queue);
13023f2304f8SSagi Grimberg 
13033f2304f8SSagi Grimberg 	async->pdu = page_frag_alloc(&queue->pf_cache,
13043f2304f8SSagi Grimberg 		sizeof(struct nvme_tcp_cmd_pdu) + hdgst,
13053f2304f8SSagi Grimberg 		GFP_KERNEL | __GFP_ZERO);
13063f2304f8SSagi Grimberg 	if (!async->pdu)
13073f2304f8SSagi Grimberg 		return -ENOMEM;
13083f2304f8SSagi Grimberg 
13093f2304f8SSagi Grimberg 	async->queue = &ctrl->queues[0];
13103f2304f8SSagi Grimberg 	return 0;
13113f2304f8SSagi Grimberg }
13123f2304f8SSagi Grimberg 
13133f2304f8SSagi Grimberg static void nvme_tcp_free_queue(struct nvme_ctrl *nctrl, int qid)
13143f2304f8SSagi Grimberg {
1315a5053c92SMaurizio Lombardi 	struct page *page;
13163f2304f8SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl = to_tcp_ctrl(nctrl);
13173f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = &ctrl->queues[qid];
131883e1226bSSagi Grimberg 	unsigned int noreclaim_flag;
13193f2304f8SSagi Grimberg 
13203f2304f8SSagi Grimberg 	if (!test_and_clear_bit(NVME_TCP_Q_ALLOCATED, &queue->flags))
13213f2304f8SSagi Grimberg 		return;
13223f2304f8SSagi Grimberg 
13233f2304f8SSagi Grimberg 	if (queue->hdr_digest || queue->data_digest)
13243f2304f8SSagi Grimberg 		nvme_tcp_free_crypto(queue);
13253f2304f8SSagi Grimberg 
1326a5053c92SMaurizio Lombardi 	if (queue->pf_cache.va) {
1327a5053c92SMaurizio Lombardi 		page = virt_to_head_page(queue->pf_cache.va);
1328a5053c92SMaurizio Lombardi 		__page_frag_cache_drain(page, queue->pf_cache.pagecnt_bias);
1329a5053c92SMaurizio Lombardi 		queue->pf_cache.va = NULL;
1330a5053c92SMaurizio Lombardi 	}
133183e1226bSSagi Grimberg 
133283e1226bSSagi Grimberg 	noreclaim_flag = memalloc_noreclaim_save();
13333f2304f8SSagi Grimberg 	sock_release(queue->sock);
133483e1226bSSagi Grimberg 	memalloc_noreclaim_restore(noreclaim_flag);
133583e1226bSSagi Grimberg 
13363f2304f8SSagi Grimberg 	kfree(queue->pdu);
1337d48f92cdSKeith Busch 	mutex_destroy(&queue->send_mutex);
13389ebbfe49SChao Leng 	mutex_destroy(&queue->queue_lock);
13393f2304f8SSagi Grimberg }
13403f2304f8SSagi Grimberg 
13413f2304f8SSagi Grimberg static int nvme_tcp_init_connection(struct nvme_tcp_queue *queue)
13423f2304f8SSagi Grimberg {
13433f2304f8SSagi Grimberg 	struct nvme_tcp_icreq_pdu *icreq;
13443f2304f8SSagi Grimberg 	struct nvme_tcp_icresp_pdu *icresp;
13453f2304f8SSagi Grimberg 	struct msghdr msg = {};
13463f2304f8SSagi Grimberg 	struct kvec iov;
13473f2304f8SSagi Grimberg 	bool ctrl_hdgst, ctrl_ddgst;
1348c2700d28SVarun Prakash 	u32 maxh2cdata;
13493f2304f8SSagi Grimberg 	int ret;
13503f2304f8SSagi Grimberg 
13513f2304f8SSagi Grimberg 	icreq = kzalloc(sizeof(*icreq), GFP_KERNEL);
13523f2304f8SSagi Grimberg 	if (!icreq)
13533f2304f8SSagi Grimberg 		return -ENOMEM;
13543f2304f8SSagi Grimberg 
13553f2304f8SSagi Grimberg 	icresp = kzalloc(sizeof(*icresp), GFP_KERNEL);
13563f2304f8SSagi Grimberg 	if (!icresp) {
13573f2304f8SSagi Grimberg 		ret = -ENOMEM;
13583f2304f8SSagi Grimberg 		goto free_icreq;
13593f2304f8SSagi Grimberg 	}
13603f2304f8SSagi Grimberg 
13613f2304f8SSagi Grimberg 	icreq->hdr.type = nvme_tcp_icreq;
13623f2304f8SSagi Grimberg 	icreq->hdr.hlen = sizeof(*icreq);
13633f2304f8SSagi Grimberg 	icreq->hdr.pdo = 0;
13643f2304f8SSagi Grimberg 	icreq->hdr.plen = cpu_to_le32(icreq->hdr.hlen);
13653f2304f8SSagi Grimberg 	icreq->pfv = cpu_to_le16(NVME_TCP_PFV_1_0);
13663f2304f8SSagi Grimberg 	icreq->maxr2t = 0; /* single inflight r2t supported */
13673f2304f8SSagi Grimberg 	icreq->hpda = 0; /* no alignment constraint */
13683f2304f8SSagi Grimberg 	if (queue->hdr_digest)
13693f2304f8SSagi Grimberg 		icreq->digest |= NVME_TCP_HDR_DIGEST_ENABLE;
13703f2304f8SSagi Grimberg 	if (queue->data_digest)
13713f2304f8SSagi Grimberg 		icreq->digest |= NVME_TCP_DATA_DIGEST_ENABLE;
13723f2304f8SSagi Grimberg 
13733f2304f8SSagi Grimberg 	iov.iov_base = icreq;
13743f2304f8SSagi Grimberg 	iov.iov_len = sizeof(*icreq);
13753f2304f8SSagi Grimberg 	ret = kernel_sendmsg(queue->sock, &msg, &iov, 1, iov.iov_len);
13763f2304f8SSagi Grimberg 	if (ret < 0)
13773f2304f8SSagi Grimberg 		goto free_icresp;
13783f2304f8SSagi Grimberg 
13793f2304f8SSagi Grimberg 	memset(&msg, 0, sizeof(msg));
13803f2304f8SSagi Grimberg 	iov.iov_base = icresp;
13813f2304f8SSagi Grimberg 	iov.iov_len = sizeof(*icresp);
13823f2304f8SSagi Grimberg 	ret = kernel_recvmsg(queue->sock, &msg, &iov, 1,
13833f2304f8SSagi Grimberg 			iov.iov_len, msg.msg_flags);
13843f2304f8SSagi Grimberg 	if (ret < 0)
13853f2304f8SSagi Grimberg 		goto free_icresp;
13863f2304f8SSagi Grimberg 
13873f2304f8SSagi Grimberg 	ret = -EINVAL;
13883f2304f8SSagi Grimberg 	if (icresp->hdr.type != nvme_tcp_icresp) {
13893f2304f8SSagi Grimberg 		pr_err("queue %d: bad type returned %d\n",
13903f2304f8SSagi Grimberg 			nvme_tcp_queue_id(queue), icresp->hdr.type);
13913f2304f8SSagi Grimberg 		goto free_icresp;
13923f2304f8SSagi Grimberg 	}
13933f2304f8SSagi Grimberg 
13943f2304f8SSagi Grimberg 	if (le32_to_cpu(icresp->hdr.plen) != sizeof(*icresp)) {
13953f2304f8SSagi Grimberg 		pr_err("queue %d: bad pdu length returned %d\n",
13963f2304f8SSagi Grimberg 			nvme_tcp_queue_id(queue), icresp->hdr.plen);
13973f2304f8SSagi Grimberg 		goto free_icresp;
13983f2304f8SSagi Grimberg 	}
13993f2304f8SSagi Grimberg 
14003f2304f8SSagi Grimberg 	if (icresp->pfv != NVME_TCP_PFV_1_0) {
14013f2304f8SSagi Grimberg 		pr_err("queue %d: bad pfv returned %d\n",
14023f2304f8SSagi Grimberg 			nvme_tcp_queue_id(queue), icresp->pfv);
14033f2304f8SSagi Grimberg 		goto free_icresp;
14043f2304f8SSagi Grimberg 	}
14053f2304f8SSagi Grimberg 
14063f2304f8SSagi Grimberg 	ctrl_ddgst = !!(icresp->digest & NVME_TCP_DATA_DIGEST_ENABLE);
14073f2304f8SSagi Grimberg 	if ((queue->data_digest && !ctrl_ddgst) ||
14083f2304f8SSagi Grimberg 	    (!queue->data_digest && ctrl_ddgst)) {
14093f2304f8SSagi Grimberg 		pr_err("queue %d: data digest mismatch host: %s ctrl: %s\n",
14103f2304f8SSagi Grimberg 			nvme_tcp_queue_id(queue),
14113f2304f8SSagi Grimberg 			queue->data_digest ? "enabled" : "disabled",
14123f2304f8SSagi Grimberg 			ctrl_ddgst ? "enabled" : "disabled");
14133f2304f8SSagi Grimberg 		goto free_icresp;
14143f2304f8SSagi Grimberg 	}
14153f2304f8SSagi Grimberg 
14163f2304f8SSagi Grimberg 	ctrl_hdgst = !!(icresp->digest & NVME_TCP_HDR_DIGEST_ENABLE);
14173f2304f8SSagi Grimberg 	if ((queue->hdr_digest && !ctrl_hdgst) ||
14183f2304f8SSagi Grimberg 	    (!queue->hdr_digest && ctrl_hdgst)) {
14193f2304f8SSagi Grimberg 		pr_err("queue %d: header digest mismatch host: %s ctrl: %s\n",
14203f2304f8SSagi Grimberg 			nvme_tcp_queue_id(queue),
14213f2304f8SSagi Grimberg 			queue->hdr_digest ? "enabled" : "disabled",
14223f2304f8SSagi Grimberg 			ctrl_hdgst ? "enabled" : "disabled");
14233f2304f8SSagi Grimberg 		goto free_icresp;
14243f2304f8SSagi Grimberg 	}
14253f2304f8SSagi Grimberg 
14263f2304f8SSagi Grimberg 	if (icresp->cpda != 0) {
14273f2304f8SSagi Grimberg 		pr_err("queue %d: unsupported cpda returned %d\n",
14283f2304f8SSagi Grimberg 			nvme_tcp_queue_id(queue), icresp->cpda);
14293f2304f8SSagi Grimberg 		goto free_icresp;
14303f2304f8SSagi Grimberg 	}
14313f2304f8SSagi Grimberg 
1432c2700d28SVarun Prakash 	maxh2cdata = le32_to_cpu(icresp->maxdata);
1433c2700d28SVarun Prakash 	if ((maxh2cdata % 4) || (maxh2cdata < NVME_TCP_MIN_MAXH2CDATA)) {
1434c2700d28SVarun Prakash 		pr_err("queue %d: invalid maxh2cdata returned %u\n",
1435c2700d28SVarun Prakash 		       nvme_tcp_queue_id(queue), maxh2cdata);
1436c2700d28SVarun Prakash 		goto free_icresp;
1437c2700d28SVarun Prakash 	}
1438c2700d28SVarun Prakash 	queue->maxh2cdata = maxh2cdata;
1439c2700d28SVarun Prakash 
14403f2304f8SSagi Grimberg 	ret = 0;
14413f2304f8SSagi Grimberg free_icresp:
14423f2304f8SSagi Grimberg 	kfree(icresp);
14433f2304f8SSagi Grimberg free_icreq:
14443f2304f8SSagi Grimberg 	kfree(icreq);
14453f2304f8SSagi Grimberg 	return ret;
14463f2304f8SSagi Grimberg }
14473f2304f8SSagi Grimberg 
144840510a63SSagi Grimberg static bool nvme_tcp_admin_queue(struct nvme_tcp_queue *queue)
144940510a63SSagi Grimberg {
145040510a63SSagi Grimberg 	return nvme_tcp_queue_id(queue) == 0;
145140510a63SSagi Grimberg }
145240510a63SSagi Grimberg 
145340510a63SSagi Grimberg static bool nvme_tcp_default_queue(struct nvme_tcp_queue *queue)
145440510a63SSagi Grimberg {
145540510a63SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl = queue->ctrl;
145640510a63SSagi Grimberg 	int qid = nvme_tcp_queue_id(queue);
145740510a63SSagi Grimberg 
145840510a63SSagi Grimberg 	return !nvme_tcp_admin_queue(queue) &&
145940510a63SSagi Grimberg 		qid < 1 + ctrl->io_queues[HCTX_TYPE_DEFAULT];
146040510a63SSagi Grimberg }
146140510a63SSagi Grimberg 
146240510a63SSagi Grimberg static bool nvme_tcp_read_queue(struct nvme_tcp_queue *queue)
146340510a63SSagi Grimberg {
146440510a63SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl = queue->ctrl;
146540510a63SSagi Grimberg 	int qid = nvme_tcp_queue_id(queue);
146640510a63SSagi Grimberg 
146740510a63SSagi Grimberg 	return !nvme_tcp_admin_queue(queue) &&
146840510a63SSagi Grimberg 		!nvme_tcp_default_queue(queue) &&
146940510a63SSagi Grimberg 		qid < 1 + ctrl->io_queues[HCTX_TYPE_DEFAULT] +
147040510a63SSagi Grimberg 			  ctrl->io_queues[HCTX_TYPE_READ];
147140510a63SSagi Grimberg }
147240510a63SSagi Grimberg 
147340510a63SSagi Grimberg static bool nvme_tcp_poll_queue(struct nvme_tcp_queue *queue)
147440510a63SSagi Grimberg {
147540510a63SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl = queue->ctrl;
147640510a63SSagi Grimberg 	int qid = nvme_tcp_queue_id(queue);
147740510a63SSagi Grimberg 
147840510a63SSagi Grimberg 	return !nvme_tcp_admin_queue(queue) &&
147940510a63SSagi Grimberg 		!nvme_tcp_default_queue(queue) &&
148040510a63SSagi Grimberg 		!nvme_tcp_read_queue(queue) &&
148140510a63SSagi Grimberg 		qid < 1 + ctrl->io_queues[HCTX_TYPE_DEFAULT] +
148240510a63SSagi Grimberg 			  ctrl->io_queues[HCTX_TYPE_READ] +
148340510a63SSagi Grimberg 			  ctrl->io_queues[HCTX_TYPE_POLL];
148440510a63SSagi Grimberg }
148540510a63SSagi Grimberg 
148640510a63SSagi Grimberg static void nvme_tcp_set_queue_io_cpu(struct nvme_tcp_queue *queue)
148740510a63SSagi Grimberg {
148840510a63SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl = queue->ctrl;
148940510a63SSagi Grimberg 	int qid = nvme_tcp_queue_id(queue);
149040510a63SSagi Grimberg 	int n = 0;
149140510a63SSagi Grimberg 
149240510a63SSagi Grimberg 	if (nvme_tcp_default_queue(queue))
149340510a63SSagi Grimberg 		n = qid - 1;
149440510a63SSagi Grimberg 	else if (nvme_tcp_read_queue(queue))
149540510a63SSagi Grimberg 		n = qid - ctrl->io_queues[HCTX_TYPE_DEFAULT] - 1;
149640510a63SSagi Grimberg 	else if (nvme_tcp_poll_queue(queue))
149740510a63SSagi Grimberg 		n = qid - ctrl->io_queues[HCTX_TYPE_DEFAULT] -
149840510a63SSagi Grimberg 				ctrl->io_queues[HCTX_TYPE_READ] - 1;
149940510a63SSagi Grimberg 	queue->io_cpu = cpumask_next_wrap(n - 1, cpu_online_mask, -1, false);
150040510a63SSagi Grimberg }
150140510a63SSagi Grimberg 
1502fb8745d0SChristoph Hellwig static int nvme_tcp_alloc_queue(struct nvme_ctrl *nctrl, int qid)
15033f2304f8SSagi Grimberg {
15043f2304f8SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl = to_tcp_ctrl(nctrl);
15053f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = &ctrl->queues[qid];
15066ebf71baSChristoph Hellwig 	int ret, rcv_pdu_size;
15073f2304f8SSagi Grimberg 
15089ebbfe49SChao Leng 	mutex_init(&queue->queue_lock);
15093f2304f8SSagi Grimberg 	queue->ctrl = ctrl;
151015ec928aSSagi Grimberg 	init_llist_head(&queue->req_list);
15113f2304f8SSagi Grimberg 	INIT_LIST_HEAD(&queue->send_list);
1512db5ad6b7SSagi Grimberg 	mutex_init(&queue->send_mutex);
15133f2304f8SSagi Grimberg 	INIT_WORK(&queue->io_work, nvme_tcp_io_work);
15143f2304f8SSagi Grimberg 
15153f2304f8SSagi Grimberg 	if (qid > 0)
15169924b030SIsrael Rukshin 		queue->cmnd_capsule_len = nctrl->ioccsz * 16;
15173f2304f8SSagi Grimberg 	else
15183f2304f8SSagi Grimberg 		queue->cmnd_capsule_len = sizeof(struct nvme_command) +
15193f2304f8SSagi Grimberg 						NVME_TCP_ADMIN_CCSZ;
15203f2304f8SSagi Grimberg 
15213f2304f8SSagi Grimberg 	ret = sock_create(ctrl->addr.ss_family, SOCK_STREAM,
15223f2304f8SSagi Grimberg 			IPPROTO_TCP, &queue->sock);
15233f2304f8SSagi Grimberg 	if (ret) {
15249924b030SIsrael Rukshin 		dev_err(nctrl->device,
15253f2304f8SSagi Grimberg 			"failed to create socket: %d\n", ret);
15269ebbfe49SChao Leng 		goto err_destroy_mutex;
15273f2304f8SSagi Grimberg 	}
15283f2304f8SSagi Grimberg 
1529841aee4dSChris Leech 	nvme_tcp_reclassify_socket(queue->sock);
1530841aee4dSChris Leech 
15313f2304f8SSagi Grimberg 	/* Single syn retry */
1532557eadfcSChristoph Hellwig 	tcp_sock_set_syncnt(queue->sock->sk, 1);
15333f2304f8SSagi Grimberg 
15343f2304f8SSagi Grimberg 	/* Set TCP no delay */
153512abc5eeSChristoph Hellwig 	tcp_sock_set_nodelay(queue->sock->sk);
15363f2304f8SSagi Grimberg 
15373f2304f8SSagi Grimberg 	/*
15383f2304f8SSagi Grimberg 	 * Cleanup whatever is sitting in the TCP transmit queue on socket
15393f2304f8SSagi Grimberg 	 * close. This is done to prevent stale data from being sent should
15403f2304f8SSagi Grimberg 	 * the network connection be restored before TCP times out.
15413f2304f8SSagi Grimberg 	 */
1542c433594cSChristoph Hellwig 	sock_no_linger(queue->sock->sk);
15433f2304f8SSagi Grimberg 
15446e434967SChristoph Hellwig 	if (so_priority > 0)
15456e434967SChristoph Hellwig 		sock_set_priority(queue->sock->sk, so_priority);
15469912ade3SWunderlich, Mark 
1547bb13985dSIsrael Rukshin 	/* Set socket type of service */
15486ebf71baSChristoph Hellwig 	if (nctrl->opts->tos >= 0)
15496ebf71baSChristoph Hellwig 		ip_sock_set_tos(queue->sock->sk, nctrl->opts->tos);
1550bb13985dSIsrael Rukshin 
1551adc99fd3SSagi Grimberg 	/* Set 10 seconds timeout for icresp recvmsg */
1552adc99fd3SSagi Grimberg 	queue->sock->sk->sk_rcvtimeo = 10 * HZ;
1553adc99fd3SSagi Grimberg 
15543f2304f8SSagi Grimberg 	queue->sock->sk->sk_allocation = GFP_ATOMIC;
155598123866SBenjamin Coddington 	queue->sock->sk->sk_use_task_frag = false;
155640510a63SSagi Grimberg 	nvme_tcp_set_queue_io_cpu(queue);
15573f2304f8SSagi Grimberg 	queue->request = NULL;
15583f2304f8SSagi Grimberg 	queue->data_remaining = 0;
15593f2304f8SSagi Grimberg 	queue->ddgst_remaining = 0;
15603f2304f8SSagi Grimberg 	queue->pdu_remaining = 0;
15613f2304f8SSagi Grimberg 	queue->pdu_offset = 0;
15623f2304f8SSagi Grimberg 	sk_set_memalloc(queue->sock->sk);
15633f2304f8SSagi Grimberg 
15649924b030SIsrael Rukshin 	if (nctrl->opts->mask & NVMF_OPT_HOST_TRADDR) {
15653f2304f8SSagi Grimberg 		ret = kernel_bind(queue->sock, (struct sockaddr *)&ctrl->src_addr,
15663f2304f8SSagi Grimberg 			sizeof(ctrl->src_addr));
15673f2304f8SSagi Grimberg 		if (ret) {
15689924b030SIsrael Rukshin 			dev_err(nctrl->device,
15693f2304f8SSagi Grimberg 				"failed to bind queue %d socket %d\n",
15703f2304f8SSagi Grimberg 				qid, ret);
15713f2304f8SSagi Grimberg 			goto err_sock;
15723f2304f8SSagi Grimberg 		}
15733f2304f8SSagi Grimberg 	}
15743f2304f8SSagi Grimberg 
15753ede8f72SMartin Belanger 	if (nctrl->opts->mask & NVMF_OPT_HOST_IFACE) {
15763ede8f72SMartin Belanger 		char *iface = nctrl->opts->host_iface;
15773ede8f72SMartin Belanger 		sockptr_t optval = KERNEL_SOCKPTR(iface);
15783ede8f72SMartin Belanger 
15793ede8f72SMartin Belanger 		ret = sock_setsockopt(queue->sock, SOL_SOCKET, SO_BINDTODEVICE,
15803ede8f72SMartin Belanger 				      optval, strlen(iface));
15813ede8f72SMartin Belanger 		if (ret) {
15823ede8f72SMartin Belanger 			dev_err(nctrl->device,
15833ede8f72SMartin Belanger 			  "failed to bind to interface %s queue %d err %d\n",
15843ede8f72SMartin Belanger 			  iface, qid, ret);
15853ede8f72SMartin Belanger 			goto err_sock;
15863ede8f72SMartin Belanger 		}
15873ede8f72SMartin Belanger 	}
15883ede8f72SMartin Belanger 
15893f2304f8SSagi Grimberg 	queue->hdr_digest = nctrl->opts->hdr_digest;
15903f2304f8SSagi Grimberg 	queue->data_digest = nctrl->opts->data_digest;
15913f2304f8SSagi Grimberg 	if (queue->hdr_digest || queue->data_digest) {
15923f2304f8SSagi Grimberg 		ret = nvme_tcp_alloc_crypto(queue);
15933f2304f8SSagi Grimberg 		if (ret) {
15949924b030SIsrael Rukshin 			dev_err(nctrl->device,
15953f2304f8SSagi Grimberg 				"failed to allocate queue %d crypto\n", qid);
15963f2304f8SSagi Grimberg 			goto err_sock;
15973f2304f8SSagi Grimberg 		}
15983f2304f8SSagi Grimberg 	}
15993f2304f8SSagi Grimberg 
16003f2304f8SSagi Grimberg 	rcv_pdu_size = sizeof(struct nvme_tcp_rsp_pdu) +
16013f2304f8SSagi Grimberg 			nvme_tcp_hdgst_len(queue);
16023f2304f8SSagi Grimberg 	queue->pdu = kmalloc(rcv_pdu_size, GFP_KERNEL);
16033f2304f8SSagi Grimberg 	if (!queue->pdu) {
16043f2304f8SSagi Grimberg 		ret = -ENOMEM;
16053f2304f8SSagi Grimberg 		goto err_crypto;
16063f2304f8SSagi Grimberg 	}
16073f2304f8SSagi Grimberg 
16089924b030SIsrael Rukshin 	dev_dbg(nctrl->device, "connecting queue %d\n",
16093f2304f8SSagi Grimberg 			nvme_tcp_queue_id(queue));
16103f2304f8SSagi Grimberg 
16113f2304f8SSagi Grimberg 	ret = kernel_connect(queue->sock, (struct sockaddr *)&ctrl->addr,
16123f2304f8SSagi Grimberg 		sizeof(ctrl->addr), 0);
16133f2304f8SSagi Grimberg 	if (ret) {
16149924b030SIsrael Rukshin 		dev_err(nctrl->device,
16153f2304f8SSagi Grimberg 			"failed to connect socket: %d\n", ret);
16163f2304f8SSagi Grimberg 		goto err_rcv_pdu;
16173f2304f8SSagi Grimberg 	}
16183f2304f8SSagi Grimberg 
16193f2304f8SSagi Grimberg 	ret = nvme_tcp_init_connection(queue);
16203f2304f8SSagi Grimberg 	if (ret)
16213f2304f8SSagi Grimberg 		goto err_init_connect;
16223f2304f8SSagi Grimberg 
16233f2304f8SSagi Grimberg 	set_bit(NVME_TCP_Q_ALLOCATED, &queue->flags);
16243f2304f8SSagi Grimberg 
16253f2304f8SSagi Grimberg 	return 0;
16263f2304f8SSagi Grimberg 
16273f2304f8SSagi Grimberg err_init_connect:
16283f2304f8SSagi Grimberg 	kernel_sock_shutdown(queue->sock, SHUT_RDWR);
16293f2304f8SSagi Grimberg err_rcv_pdu:
16303f2304f8SSagi Grimberg 	kfree(queue->pdu);
16313f2304f8SSagi Grimberg err_crypto:
16323f2304f8SSagi Grimberg 	if (queue->hdr_digest || queue->data_digest)
16333f2304f8SSagi Grimberg 		nvme_tcp_free_crypto(queue);
16343f2304f8SSagi Grimberg err_sock:
16353f2304f8SSagi Grimberg 	sock_release(queue->sock);
16363f2304f8SSagi Grimberg 	queue->sock = NULL;
16379ebbfe49SChao Leng err_destroy_mutex:
1638d48f92cdSKeith Busch 	mutex_destroy(&queue->send_mutex);
16399ebbfe49SChao Leng 	mutex_destroy(&queue->queue_lock);
16403f2304f8SSagi Grimberg 	return ret;
16413f2304f8SSagi Grimberg }
16423f2304f8SSagi Grimberg 
1643*88eaba80SSagi Grimberg static void nvme_tcp_restore_sock_ops(struct nvme_tcp_queue *queue)
16443f2304f8SSagi Grimberg {
16453f2304f8SSagi Grimberg 	struct socket *sock = queue->sock;
16463f2304f8SSagi Grimberg 
16473f2304f8SSagi Grimberg 	write_lock_bh(&sock->sk->sk_callback_lock);
16483f2304f8SSagi Grimberg 	sock->sk->sk_user_data  = NULL;
16493f2304f8SSagi Grimberg 	sock->sk->sk_data_ready = queue->data_ready;
16503f2304f8SSagi Grimberg 	sock->sk->sk_state_change = queue->state_change;
16513f2304f8SSagi Grimberg 	sock->sk->sk_write_space  = queue->write_space;
16523f2304f8SSagi Grimberg 	write_unlock_bh(&sock->sk->sk_callback_lock);
16533f2304f8SSagi Grimberg }
16543f2304f8SSagi Grimberg 
16553f2304f8SSagi Grimberg static void __nvme_tcp_stop_queue(struct nvme_tcp_queue *queue)
16563f2304f8SSagi Grimberg {
16573f2304f8SSagi Grimberg 	kernel_sock_shutdown(queue->sock, SHUT_RDWR);
1658*88eaba80SSagi Grimberg 	nvme_tcp_restore_sock_ops(queue);
16593f2304f8SSagi Grimberg 	cancel_work_sync(&queue->io_work);
16603f2304f8SSagi Grimberg }
16613f2304f8SSagi Grimberg 
16623f2304f8SSagi Grimberg static void nvme_tcp_stop_queue(struct nvme_ctrl *nctrl, int qid)
16633f2304f8SSagi Grimberg {
16643f2304f8SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl = to_tcp_ctrl(nctrl);
16653f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = &ctrl->queues[qid];
16663f2304f8SSagi Grimberg 
16672bff487fSMaurizio Lombardi 	if (!test_bit(NVME_TCP_Q_ALLOCATED, &queue->flags))
16682bff487fSMaurizio Lombardi 		return;
16692bff487fSMaurizio Lombardi 
16709ebbfe49SChao Leng 	mutex_lock(&queue->queue_lock);
16719ebbfe49SChao Leng 	if (test_and_clear_bit(NVME_TCP_Q_LIVE, &queue->flags))
16723f2304f8SSagi Grimberg 		__nvme_tcp_stop_queue(queue);
16739ebbfe49SChao Leng 	mutex_unlock(&queue->queue_lock);
16743f2304f8SSagi Grimberg }
16753f2304f8SSagi Grimberg 
1676*88eaba80SSagi Grimberg static void nvme_tcp_setup_sock_ops(struct nvme_tcp_queue *queue)
1677*88eaba80SSagi Grimberg {
1678*88eaba80SSagi Grimberg 	write_lock_bh(&queue->sock->sk->sk_callback_lock);
1679*88eaba80SSagi Grimberg 	queue->sock->sk->sk_user_data = queue;
1680*88eaba80SSagi Grimberg 	queue->state_change = queue->sock->sk->sk_state_change;
1681*88eaba80SSagi Grimberg 	queue->data_ready = queue->sock->sk->sk_data_ready;
1682*88eaba80SSagi Grimberg 	queue->write_space = queue->sock->sk->sk_write_space;
1683*88eaba80SSagi Grimberg 	queue->sock->sk->sk_data_ready = nvme_tcp_data_ready;
1684*88eaba80SSagi Grimberg 	queue->sock->sk->sk_state_change = nvme_tcp_state_change;
1685*88eaba80SSagi Grimberg 	queue->sock->sk->sk_write_space = nvme_tcp_write_space;
1686*88eaba80SSagi Grimberg #ifdef CONFIG_NET_RX_BUSY_POLL
1687*88eaba80SSagi Grimberg 	queue->sock->sk->sk_ll_usec = 1;
1688*88eaba80SSagi Grimberg #endif
1689*88eaba80SSagi Grimberg 	write_unlock_bh(&queue->sock->sk->sk_callback_lock);
1690*88eaba80SSagi Grimberg }
1691*88eaba80SSagi Grimberg 
16923f2304f8SSagi Grimberg static int nvme_tcp_start_queue(struct nvme_ctrl *nctrl, int idx)
16933f2304f8SSagi Grimberg {
16943f2304f8SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl = to_tcp_ctrl(nctrl);
1695*88eaba80SSagi Grimberg 	struct nvme_tcp_queue *queue = &ctrl->queues[idx];
16963f2304f8SSagi Grimberg 	int ret;
16973f2304f8SSagi Grimberg 
1698*88eaba80SSagi Grimberg 	queue->rd_enabled = true;
1699*88eaba80SSagi Grimberg 	nvme_tcp_init_recv_ctx(queue);
1700*88eaba80SSagi Grimberg 	nvme_tcp_setup_sock_ops(queue);
1701*88eaba80SSagi Grimberg 
17023f2304f8SSagi Grimberg 	if (idx)
1703be42a33bSKeith Busch 		ret = nvmf_connect_io_queue(nctrl, idx);
17043f2304f8SSagi Grimberg 	else
17053f2304f8SSagi Grimberg 		ret = nvmf_connect_admin_queue(nctrl);
17063f2304f8SSagi Grimberg 
17073f2304f8SSagi Grimberg 	if (!ret) {
1708*88eaba80SSagi Grimberg 		set_bit(NVME_TCP_Q_LIVE, &queue->flags);
17093f2304f8SSagi Grimberg 	} else {
1710*88eaba80SSagi Grimberg 		if (test_bit(NVME_TCP_Q_ALLOCATED, &queue->flags))
1711*88eaba80SSagi Grimberg 			__nvme_tcp_stop_queue(queue);
17123f2304f8SSagi Grimberg 		dev_err(nctrl->device,
17133f2304f8SSagi Grimberg 			"failed to connect queue: %d ret=%d\n", idx, ret);
17143f2304f8SSagi Grimberg 	}
17153f2304f8SSagi Grimberg 	return ret;
17163f2304f8SSagi Grimberg }
17173f2304f8SSagi Grimberg 
17183f2304f8SSagi Grimberg static void nvme_tcp_free_admin_queue(struct nvme_ctrl *ctrl)
17193f2304f8SSagi Grimberg {
17203f2304f8SSagi Grimberg 	if (to_tcp_ctrl(ctrl)->async_req.pdu) {
1721ceb1e087SDavid Milburn 		cancel_work_sync(&ctrl->async_event_work);
17223f2304f8SSagi Grimberg 		nvme_tcp_free_async_req(to_tcp_ctrl(ctrl));
17233f2304f8SSagi Grimberg 		to_tcp_ctrl(ctrl)->async_req.pdu = NULL;
17243f2304f8SSagi Grimberg 	}
17253f2304f8SSagi Grimberg 
17263f2304f8SSagi Grimberg 	nvme_tcp_free_queue(ctrl, 0);
17273f2304f8SSagi Grimberg }
17283f2304f8SSagi Grimberg 
17293f2304f8SSagi Grimberg static void nvme_tcp_free_io_queues(struct nvme_ctrl *ctrl)
17303f2304f8SSagi Grimberg {
17313f2304f8SSagi Grimberg 	int i;
17323f2304f8SSagi Grimberg 
17333f2304f8SSagi Grimberg 	for (i = 1; i < ctrl->queue_count; i++)
17343f2304f8SSagi Grimberg 		nvme_tcp_free_queue(ctrl, i);
17353f2304f8SSagi Grimberg }
17363f2304f8SSagi Grimberg 
17373f2304f8SSagi Grimberg static void nvme_tcp_stop_io_queues(struct nvme_ctrl *ctrl)
17383f2304f8SSagi Grimberg {
17393f2304f8SSagi Grimberg 	int i;
17403f2304f8SSagi Grimberg 
17413f2304f8SSagi Grimberg 	for (i = 1; i < ctrl->queue_count; i++)
17423f2304f8SSagi Grimberg 		nvme_tcp_stop_queue(ctrl, i);
17433f2304f8SSagi Grimberg }
17443f2304f8SSagi Grimberg 
174509035f86SDaniel Wagner static int nvme_tcp_start_io_queues(struct nvme_ctrl *ctrl,
174609035f86SDaniel Wagner 				    int first, int last)
17473f2304f8SSagi Grimberg {
1748462b8b2dSChaitanya Kulkarni 	int i, ret;
17493f2304f8SSagi Grimberg 
175009035f86SDaniel Wagner 	for (i = first; i < last; i++) {
17513f2304f8SSagi Grimberg 		ret = nvme_tcp_start_queue(ctrl, i);
17523f2304f8SSagi Grimberg 		if (ret)
17533f2304f8SSagi Grimberg 			goto out_stop_queues;
17543f2304f8SSagi Grimberg 	}
17553f2304f8SSagi Grimberg 
17563f2304f8SSagi Grimberg 	return 0;
17573f2304f8SSagi Grimberg 
17583f2304f8SSagi Grimberg out_stop_queues:
175909035f86SDaniel Wagner 	for (i--; i >= first; i--)
17603f2304f8SSagi Grimberg 		nvme_tcp_stop_queue(ctrl, i);
17613f2304f8SSagi Grimberg 	return ret;
17623f2304f8SSagi Grimberg }
17633f2304f8SSagi Grimberg 
17643f2304f8SSagi Grimberg static int nvme_tcp_alloc_admin_queue(struct nvme_ctrl *ctrl)
17653f2304f8SSagi Grimberg {
17663f2304f8SSagi Grimberg 	int ret;
17673f2304f8SSagi Grimberg 
1768fb8745d0SChristoph Hellwig 	ret = nvme_tcp_alloc_queue(ctrl, 0);
17693f2304f8SSagi Grimberg 	if (ret)
17703f2304f8SSagi Grimberg 		return ret;
17713f2304f8SSagi Grimberg 
17723f2304f8SSagi Grimberg 	ret = nvme_tcp_alloc_async_req(to_tcp_ctrl(ctrl));
17733f2304f8SSagi Grimberg 	if (ret)
17743f2304f8SSagi Grimberg 		goto out_free_queue;
17753f2304f8SSagi Grimberg 
17763f2304f8SSagi Grimberg 	return 0;
17773f2304f8SSagi Grimberg 
17783f2304f8SSagi Grimberg out_free_queue:
17793f2304f8SSagi Grimberg 	nvme_tcp_free_queue(ctrl, 0);
17803f2304f8SSagi Grimberg 	return ret;
17813f2304f8SSagi Grimberg }
17823f2304f8SSagi Grimberg 
1783efb973b1SSagi Grimberg static int __nvme_tcp_alloc_io_queues(struct nvme_ctrl *ctrl)
17843f2304f8SSagi Grimberg {
17853f2304f8SSagi Grimberg 	int i, ret;
17863f2304f8SSagi Grimberg 
17873f2304f8SSagi Grimberg 	for (i = 1; i < ctrl->queue_count; i++) {
1788fb8745d0SChristoph Hellwig 		ret = nvme_tcp_alloc_queue(ctrl, i);
17893f2304f8SSagi Grimberg 		if (ret)
17903f2304f8SSagi Grimberg 			goto out_free_queues;
17913f2304f8SSagi Grimberg 	}
17923f2304f8SSagi Grimberg 
17933f2304f8SSagi Grimberg 	return 0;
17943f2304f8SSagi Grimberg 
17953f2304f8SSagi Grimberg out_free_queues:
17963f2304f8SSagi Grimberg 	for (i--; i >= 1; i--)
17973f2304f8SSagi Grimberg 		nvme_tcp_free_queue(ctrl, i);
17983f2304f8SSagi Grimberg 
17993f2304f8SSagi Grimberg 	return ret;
18003f2304f8SSagi Grimberg }
18013f2304f8SSagi Grimberg 
18023f2304f8SSagi Grimberg static unsigned int nvme_tcp_nr_io_queues(struct nvme_ctrl *ctrl)
18033f2304f8SSagi Grimberg {
1804873946f4SSagi Grimberg 	unsigned int nr_io_queues;
1805873946f4SSagi Grimberg 
1806873946f4SSagi Grimberg 	nr_io_queues = min(ctrl->opts->nr_io_queues, num_online_cpus());
1807873946f4SSagi Grimberg 	nr_io_queues += min(ctrl->opts->nr_write_queues, num_online_cpus());
18081a9460ceSSagi Grimberg 	nr_io_queues += min(ctrl->opts->nr_poll_queues, num_online_cpus());
1809873946f4SSagi Grimberg 
1810873946f4SSagi Grimberg 	return nr_io_queues;
18113f2304f8SSagi Grimberg }
18123f2304f8SSagi Grimberg 
181364861993SSagi Grimberg static void nvme_tcp_set_io_queues(struct nvme_ctrl *nctrl,
181464861993SSagi Grimberg 		unsigned int nr_io_queues)
181564861993SSagi Grimberg {
181664861993SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl = to_tcp_ctrl(nctrl);
181764861993SSagi Grimberg 	struct nvmf_ctrl_options *opts = nctrl->opts;
181864861993SSagi Grimberg 
181964861993SSagi Grimberg 	if (opts->nr_write_queues && opts->nr_io_queues < nr_io_queues) {
182064861993SSagi Grimberg 		/*
182164861993SSagi Grimberg 		 * separate read/write queues
182264861993SSagi Grimberg 		 * hand out dedicated default queues only after we have
182364861993SSagi Grimberg 		 * sufficient read queues.
182464861993SSagi Grimberg 		 */
182564861993SSagi Grimberg 		ctrl->io_queues[HCTX_TYPE_READ] = opts->nr_io_queues;
182664861993SSagi Grimberg 		nr_io_queues -= ctrl->io_queues[HCTX_TYPE_READ];
182764861993SSagi Grimberg 		ctrl->io_queues[HCTX_TYPE_DEFAULT] =
182864861993SSagi Grimberg 			min(opts->nr_write_queues, nr_io_queues);
182964861993SSagi Grimberg 		nr_io_queues -= ctrl->io_queues[HCTX_TYPE_DEFAULT];
183064861993SSagi Grimberg 	} else {
183164861993SSagi Grimberg 		/*
183264861993SSagi Grimberg 		 * shared read/write queues
183364861993SSagi Grimberg 		 * either no write queues were requested, or we don't have
183464861993SSagi Grimberg 		 * sufficient queue count to have dedicated default queues.
183564861993SSagi Grimberg 		 */
183664861993SSagi Grimberg 		ctrl->io_queues[HCTX_TYPE_DEFAULT] =
183764861993SSagi Grimberg 			min(opts->nr_io_queues, nr_io_queues);
183864861993SSagi Grimberg 		nr_io_queues -= ctrl->io_queues[HCTX_TYPE_DEFAULT];
183964861993SSagi Grimberg 	}
18401a9460ceSSagi Grimberg 
18411a9460ceSSagi Grimberg 	if (opts->nr_poll_queues && nr_io_queues) {
18421a9460ceSSagi Grimberg 		/* map dedicated poll queues only if we have queues left */
18431a9460ceSSagi Grimberg 		ctrl->io_queues[HCTX_TYPE_POLL] =
18441a9460ceSSagi Grimberg 			min(opts->nr_poll_queues, nr_io_queues);
18451a9460ceSSagi Grimberg 	}
184664861993SSagi Grimberg }
184764861993SSagi Grimberg 
1848efb973b1SSagi Grimberg static int nvme_tcp_alloc_io_queues(struct nvme_ctrl *ctrl)
18493f2304f8SSagi Grimberg {
18503f2304f8SSagi Grimberg 	unsigned int nr_io_queues;
18513f2304f8SSagi Grimberg 	int ret;
18523f2304f8SSagi Grimberg 
18533f2304f8SSagi Grimberg 	nr_io_queues = nvme_tcp_nr_io_queues(ctrl);
18543f2304f8SSagi Grimberg 	ret = nvme_set_queue_count(ctrl, &nr_io_queues);
18553f2304f8SSagi Grimberg 	if (ret)
18563f2304f8SSagi Grimberg 		return ret;
18573f2304f8SSagi Grimberg 
1858664227fdSRuozhu Li 	if (nr_io_queues == 0) {
185972f57242SSagi Grimberg 		dev_err(ctrl->device,
186072f57242SSagi Grimberg 			"unable to set any I/O queues\n");
186172f57242SSagi Grimberg 		return -ENOMEM;
186272f57242SSagi Grimberg 	}
18633f2304f8SSagi Grimberg 
1864664227fdSRuozhu Li 	ctrl->queue_count = nr_io_queues + 1;
18653f2304f8SSagi Grimberg 	dev_info(ctrl->device,
18663f2304f8SSagi Grimberg 		"creating %d I/O queues.\n", nr_io_queues);
18673f2304f8SSagi Grimberg 
186864861993SSagi Grimberg 	nvme_tcp_set_io_queues(ctrl, nr_io_queues);
186964861993SSagi Grimberg 
1870efb973b1SSagi Grimberg 	return __nvme_tcp_alloc_io_queues(ctrl);
18713f2304f8SSagi Grimberg }
18723f2304f8SSagi Grimberg 
18733f2304f8SSagi Grimberg static void nvme_tcp_destroy_io_queues(struct nvme_ctrl *ctrl, bool remove)
18743f2304f8SSagi Grimberg {
18753f2304f8SSagi Grimberg 	nvme_tcp_stop_io_queues(ctrl);
1876de777825SChristoph Hellwig 	if (remove)
1877de777825SChristoph Hellwig 		nvme_remove_io_tag_set(ctrl);
18783f2304f8SSagi Grimberg 	nvme_tcp_free_io_queues(ctrl);
18793f2304f8SSagi Grimberg }
18803f2304f8SSagi Grimberg 
18813f2304f8SSagi Grimberg static int nvme_tcp_configure_io_queues(struct nvme_ctrl *ctrl, bool new)
18823f2304f8SSagi Grimberg {
188309035f86SDaniel Wagner 	int ret, nr_queues;
18843f2304f8SSagi Grimberg 
1885efb973b1SSagi Grimberg 	ret = nvme_tcp_alloc_io_queues(ctrl);
18863f2304f8SSagi Grimberg 	if (ret)
18873f2304f8SSagi Grimberg 		return ret;
18883f2304f8SSagi Grimberg 
18893f2304f8SSagi Grimberg 	if (new) {
1890de777825SChristoph Hellwig 		ret = nvme_alloc_io_tag_set(ctrl, &to_tcp_ctrl(ctrl)->tag_set,
1891de777825SChristoph Hellwig 				&nvme_tcp_mq_ops,
1892dcef7727SChristoph Hellwig 				ctrl->opts->nr_poll_queues ? HCTX_MAX_TYPES : 2,
1893de777825SChristoph Hellwig 				sizeof(struct nvme_tcp_request));
18942f7a7e5dSChristoph Hellwig 		if (ret)
18953f2304f8SSagi Grimberg 			goto out_free_io_queues;
18963f2304f8SSagi Grimberg 	}
18973f2304f8SSagi Grimberg 
189809035f86SDaniel Wagner 	/*
189909035f86SDaniel Wagner 	 * Only start IO queues for which we have allocated the tagset
190009035f86SDaniel Wagner 	 * and limitted it to the available queues. On reconnects, the
190109035f86SDaniel Wagner 	 * queue number might have changed.
190209035f86SDaniel Wagner 	 */
190309035f86SDaniel Wagner 	nr_queues = min(ctrl->tagset->nr_hw_queues + 1, ctrl->queue_count);
190409035f86SDaniel Wagner 	ret = nvme_tcp_start_io_queues(ctrl, 1, nr_queues);
19053f2304f8SSagi Grimberg 	if (ret)
19063f2304f8SSagi Grimberg 		goto out_cleanup_connect_q;
19073f2304f8SSagi Grimberg 
19082875b0aeSSagi Grimberg 	if (!new) {
19099f27bd70SChristoph Hellwig 		nvme_unquiesce_io_queues(ctrl);
1910e5c01f4fSSagi Grimberg 		if (!nvme_wait_freeze_timeout(ctrl, NVME_IO_TIMEOUT)) {
1911e5c01f4fSSagi Grimberg 			/*
1912e5c01f4fSSagi Grimberg 			 * If we timed out waiting for freeze we are likely to
1913e5c01f4fSSagi Grimberg 			 * be stuck.  Fail the controller initialization just
1914e5c01f4fSSagi Grimberg 			 * to be safe.
1915e5c01f4fSSagi Grimberg 			 */
1916e5c01f4fSSagi Grimberg 			ret = -ENODEV;
1917e5c01f4fSSagi Grimberg 			goto out_wait_freeze_timed_out;
1918e5c01f4fSSagi Grimberg 		}
19192875b0aeSSagi Grimberg 		blk_mq_update_nr_hw_queues(ctrl->tagset,
19202875b0aeSSagi Grimberg 			ctrl->queue_count - 1);
19212875b0aeSSagi Grimberg 		nvme_unfreeze(ctrl);
19222875b0aeSSagi Grimberg 	}
19232875b0aeSSagi Grimberg 
192409035f86SDaniel Wagner 	/*
192509035f86SDaniel Wagner 	 * If the number of queues has increased (reconnect case)
192609035f86SDaniel Wagner 	 * start all new queues now.
192709035f86SDaniel Wagner 	 */
192809035f86SDaniel Wagner 	ret = nvme_tcp_start_io_queues(ctrl, nr_queues,
192909035f86SDaniel Wagner 				       ctrl->tagset->nr_hw_queues + 1);
193009035f86SDaniel Wagner 	if (ret)
193109035f86SDaniel Wagner 		goto out_wait_freeze_timed_out;
193209035f86SDaniel Wagner 
19333f2304f8SSagi Grimberg 	return 0;
19343f2304f8SSagi Grimberg 
1935e5c01f4fSSagi Grimberg out_wait_freeze_timed_out:
19369f27bd70SChristoph Hellwig 	nvme_quiesce_io_queues(ctrl);
193770a99574SChao Leng 	nvme_sync_io_queues(ctrl);
1938e5c01f4fSSagi Grimberg 	nvme_tcp_stop_io_queues(ctrl);
19393f2304f8SSagi Grimberg out_cleanup_connect_q:
194070a99574SChao Leng 	nvme_cancel_tagset(ctrl);
1941e85037a2SSagi Grimberg 	if (new)
1942de777825SChristoph Hellwig 		nvme_remove_io_tag_set(ctrl);
19433f2304f8SSagi Grimberg out_free_io_queues:
19443f2304f8SSagi Grimberg 	nvme_tcp_free_io_queues(ctrl);
19453f2304f8SSagi Grimberg 	return ret;
19463f2304f8SSagi Grimberg }
19473f2304f8SSagi Grimberg 
19483f2304f8SSagi Grimberg static void nvme_tcp_destroy_admin_queue(struct nvme_ctrl *ctrl, bool remove)
19493f2304f8SSagi Grimberg {
19503f2304f8SSagi Grimberg 	nvme_tcp_stop_queue(ctrl, 0);
1951de777825SChristoph Hellwig 	if (remove)
1952de777825SChristoph Hellwig 		nvme_remove_admin_tag_set(ctrl);
19533f2304f8SSagi Grimberg 	nvme_tcp_free_admin_queue(ctrl);
19543f2304f8SSagi Grimberg }
19553f2304f8SSagi Grimberg 
19563f2304f8SSagi Grimberg static int nvme_tcp_configure_admin_queue(struct nvme_ctrl *ctrl, bool new)
19573f2304f8SSagi Grimberg {
19583f2304f8SSagi Grimberg 	int error;
19593f2304f8SSagi Grimberg 
19603f2304f8SSagi Grimberg 	error = nvme_tcp_alloc_admin_queue(ctrl);
19613f2304f8SSagi Grimberg 	if (error)
19623f2304f8SSagi Grimberg 		return error;
19633f2304f8SSagi Grimberg 
19643f2304f8SSagi Grimberg 	if (new) {
1965de777825SChristoph Hellwig 		error = nvme_alloc_admin_tag_set(ctrl,
1966de777825SChristoph Hellwig 				&to_tcp_ctrl(ctrl)->admin_tag_set,
1967db45e1a5SChristoph Hellwig 				&nvme_tcp_admin_mq_ops,
1968de777825SChristoph Hellwig 				sizeof(struct nvme_tcp_request));
19692f7a7e5dSChristoph Hellwig 		if (error)
19703f2304f8SSagi Grimberg 			goto out_free_queue;
19713f2304f8SSagi Grimberg 	}
19723f2304f8SSagi Grimberg 
19733f2304f8SSagi Grimberg 	error = nvme_tcp_start_queue(ctrl, 0);
19743f2304f8SSagi Grimberg 	if (error)
1975de777825SChristoph Hellwig 		goto out_cleanup_tagset;
19763f2304f8SSagi Grimberg 
1977c0f2f45bSSagi Grimberg 	error = nvme_enable_ctrl(ctrl);
19783f2304f8SSagi Grimberg 	if (error)
19793f2304f8SSagi Grimberg 		goto out_stop_queue;
19803f2304f8SSagi Grimberg 
19819f27bd70SChristoph Hellwig 	nvme_unquiesce_admin_queue(ctrl);
1982e7832cb4SSagi Grimberg 
198394cc781fSChristoph Hellwig 	error = nvme_init_ctrl_finish(ctrl, false);
19843f2304f8SSagi Grimberg 	if (error)
198570a99574SChao Leng 		goto out_quiesce_queue;
19863f2304f8SSagi Grimberg 
19873f2304f8SSagi Grimberg 	return 0;
19883f2304f8SSagi Grimberg 
198970a99574SChao Leng out_quiesce_queue:
19909f27bd70SChristoph Hellwig 	nvme_quiesce_admin_queue(ctrl);
199170a99574SChao Leng 	blk_sync_queue(ctrl->admin_q);
19923f2304f8SSagi Grimberg out_stop_queue:
19933f2304f8SSagi Grimberg 	nvme_tcp_stop_queue(ctrl, 0);
199470a99574SChao Leng 	nvme_cancel_admin_tagset(ctrl);
1995de777825SChristoph Hellwig out_cleanup_tagset:
19963f2304f8SSagi Grimberg 	if (new)
1997de777825SChristoph Hellwig 		nvme_remove_admin_tag_set(ctrl);
19983f2304f8SSagi Grimberg out_free_queue:
19993f2304f8SSagi Grimberg 	nvme_tcp_free_admin_queue(ctrl);
20003f2304f8SSagi Grimberg 	return error;
20013f2304f8SSagi Grimberg }
20023f2304f8SSagi Grimberg 
20033f2304f8SSagi Grimberg static void nvme_tcp_teardown_admin_queue(struct nvme_ctrl *ctrl,
20043f2304f8SSagi Grimberg 		bool remove)
20053f2304f8SSagi Grimberg {
20069f27bd70SChristoph Hellwig 	nvme_quiesce_admin_queue(ctrl);
2007d6f66210SChao Leng 	blk_sync_queue(ctrl->admin_q);
20083f2304f8SSagi Grimberg 	nvme_tcp_stop_queue(ctrl, 0);
2009563c8158SChao Leng 	nvme_cancel_admin_tagset(ctrl);
2010e7832cb4SSagi Grimberg 	if (remove)
20119f27bd70SChristoph Hellwig 		nvme_unquiesce_admin_queue(ctrl);
20123f2304f8SSagi Grimberg 	nvme_tcp_destroy_admin_queue(ctrl, remove);
20133f2304f8SSagi Grimberg }
20143f2304f8SSagi Grimberg 
20153f2304f8SSagi Grimberg static void nvme_tcp_teardown_io_queues(struct nvme_ctrl *ctrl,
20163f2304f8SSagi Grimberg 		bool remove)
20173f2304f8SSagi Grimberg {
20183f2304f8SSagi Grimberg 	if (ctrl->queue_count <= 1)
2019d6f66210SChao Leng 		return;
20209f27bd70SChristoph Hellwig 	nvme_quiesce_admin_queue(ctrl);
20212875b0aeSSagi Grimberg 	nvme_start_freeze(ctrl);
20229f27bd70SChristoph Hellwig 	nvme_quiesce_io_queues(ctrl);
2023d6f66210SChao Leng 	nvme_sync_io_queues(ctrl);
20243f2304f8SSagi Grimberg 	nvme_tcp_stop_io_queues(ctrl);
2025563c8158SChao Leng 	nvme_cancel_tagset(ctrl);
20263f2304f8SSagi Grimberg 	if (remove)
20279f27bd70SChristoph Hellwig 		nvme_unquiesce_io_queues(ctrl);
20283f2304f8SSagi Grimberg 	nvme_tcp_destroy_io_queues(ctrl, remove);
20293f2304f8SSagi Grimberg }
20303f2304f8SSagi Grimberg 
20313f2304f8SSagi Grimberg static void nvme_tcp_reconnect_or_remove(struct nvme_ctrl *ctrl)
20323f2304f8SSagi Grimberg {
20333f2304f8SSagi Grimberg 	/* If we are resetting/deleting then do nothing */
20343f2304f8SSagi Grimberg 	if (ctrl->state != NVME_CTRL_CONNECTING) {
20353f2304f8SSagi Grimberg 		WARN_ON_ONCE(ctrl->state == NVME_CTRL_NEW ||
20363f2304f8SSagi Grimberg 			ctrl->state == NVME_CTRL_LIVE);
20373f2304f8SSagi Grimberg 		return;
20383f2304f8SSagi Grimberg 	}
20393f2304f8SSagi Grimberg 
20403f2304f8SSagi Grimberg 	if (nvmf_should_reconnect(ctrl)) {
20413f2304f8SSagi Grimberg 		dev_info(ctrl->device, "Reconnecting in %d seconds...\n",
20423f2304f8SSagi Grimberg 			ctrl->opts->reconnect_delay);
20433f2304f8SSagi Grimberg 		queue_delayed_work(nvme_wq, &to_tcp_ctrl(ctrl)->connect_work,
20443f2304f8SSagi Grimberg 				ctrl->opts->reconnect_delay * HZ);
20453f2304f8SSagi Grimberg 	} else {
20463f2304f8SSagi Grimberg 		dev_info(ctrl->device, "Removing controller...\n");
20473f2304f8SSagi Grimberg 		nvme_delete_ctrl(ctrl);
20483f2304f8SSagi Grimberg 	}
20493f2304f8SSagi Grimberg }
20503f2304f8SSagi Grimberg 
20513f2304f8SSagi Grimberg static int nvme_tcp_setup_ctrl(struct nvme_ctrl *ctrl, bool new)
20523f2304f8SSagi Grimberg {
20533f2304f8SSagi Grimberg 	struct nvmf_ctrl_options *opts = ctrl->opts;
2054312910f4SColin Ian King 	int ret;
20553f2304f8SSagi Grimberg 
20563f2304f8SSagi Grimberg 	ret = nvme_tcp_configure_admin_queue(ctrl, new);
20573f2304f8SSagi Grimberg 	if (ret)
20583f2304f8SSagi Grimberg 		return ret;
20593f2304f8SSagi Grimberg 
20603f2304f8SSagi Grimberg 	if (ctrl->icdoff) {
2061522af60cSDan Carpenter 		ret = -EOPNOTSUPP;
20623f2304f8SSagi Grimberg 		dev_err(ctrl->device, "icdoff is not supported!\n");
20633f2304f8SSagi Grimberg 		goto destroy_admin;
20643f2304f8SSagi Grimberg 	}
20653f2304f8SSagi Grimberg 
20663b54064fSChaitanya Kulkarni 	if (!nvme_ctrl_sgl_supported(ctrl)) {
2067522af60cSDan Carpenter 		ret = -EOPNOTSUPP;
206873ffcefcSMax Gurtovoy 		dev_err(ctrl->device, "Mandatory sgls are not supported!\n");
206973ffcefcSMax Gurtovoy 		goto destroy_admin;
207073ffcefcSMax Gurtovoy 	}
207173ffcefcSMax Gurtovoy 
20723f2304f8SSagi Grimberg 	if (opts->queue_size > ctrl->sqsize + 1)
20733f2304f8SSagi Grimberg 		dev_warn(ctrl->device,
20743f2304f8SSagi Grimberg 			"queue_size %zu > ctrl sqsize %u, clamping down\n",
20753f2304f8SSagi Grimberg 			opts->queue_size, ctrl->sqsize + 1);
20763f2304f8SSagi Grimberg 
20773f2304f8SSagi Grimberg 	if (ctrl->sqsize + 1 > ctrl->maxcmd) {
20783f2304f8SSagi Grimberg 		dev_warn(ctrl->device,
20793f2304f8SSagi Grimberg 			"sqsize %u > ctrl maxcmd %u, clamping down\n",
20803f2304f8SSagi Grimberg 			ctrl->sqsize + 1, ctrl->maxcmd);
20813f2304f8SSagi Grimberg 		ctrl->sqsize = ctrl->maxcmd - 1;
20823f2304f8SSagi Grimberg 	}
20833f2304f8SSagi Grimberg 
20843f2304f8SSagi Grimberg 	if (ctrl->queue_count > 1) {
20853f2304f8SSagi Grimberg 		ret = nvme_tcp_configure_io_queues(ctrl, new);
20863f2304f8SSagi Grimberg 		if (ret)
20873f2304f8SSagi Grimberg 			goto destroy_admin;
20883f2304f8SSagi Grimberg 	}
20893f2304f8SSagi Grimberg 
20903f2304f8SSagi Grimberg 	if (!nvme_change_ctrl_state(ctrl, NVME_CTRL_LIVE)) {
2091bea54ef5SIsrael Rukshin 		/*
2092ecca390eSSagi Grimberg 		 * state change failure is ok if we started ctrl delete,
2093bea54ef5SIsrael Rukshin 		 * unless we're during creation of a new controller to
2094bea54ef5SIsrael Rukshin 		 * avoid races with teardown flow.
2095bea54ef5SIsrael Rukshin 		 */
2096ecca390eSSagi Grimberg 		WARN_ON_ONCE(ctrl->state != NVME_CTRL_DELETING &&
2097ecca390eSSagi Grimberg 			     ctrl->state != NVME_CTRL_DELETING_NOIO);
2098bea54ef5SIsrael Rukshin 		WARN_ON_ONCE(new);
20993f2304f8SSagi Grimberg 		ret = -EINVAL;
21003f2304f8SSagi Grimberg 		goto destroy_io;
21013f2304f8SSagi Grimberg 	}
21023f2304f8SSagi Grimberg 
21033f2304f8SSagi Grimberg 	nvme_start_ctrl(ctrl);
21043f2304f8SSagi Grimberg 	return 0;
21053f2304f8SSagi Grimberg 
21063f2304f8SSagi Grimberg destroy_io:
210770a99574SChao Leng 	if (ctrl->queue_count > 1) {
21089f27bd70SChristoph Hellwig 		nvme_quiesce_io_queues(ctrl);
210970a99574SChao Leng 		nvme_sync_io_queues(ctrl);
211070a99574SChao Leng 		nvme_tcp_stop_io_queues(ctrl);
211170a99574SChao Leng 		nvme_cancel_tagset(ctrl);
21123f2304f8SSagi Grimberg 		nvme_tcp_destroy_io_queues(ctrl, new);
211370a99574SChao Leng 	}
21143f2304f8SSagi Grimberg destroy_admin:
21159f27bd70SChristoph Hellwig 	nvme_quiesce_admin_queue(ctrl);
211670a99574SChao Leng 	blk_sync_queue(ctrl->admin_q);
21173f2304f8SSagi Grimberg 	nvme_tcp_stop_queue(ctrl, 0);
211870a99574SChao Leng 	nvme_cancel_admin_tagset(ctrl);
21193f2304f8SSagi Grimberg 	nvme_tcp_destroy_admin_queue(ctrl, new);
21203f2304f8SSagi Grimberg 	return ret;
21213f2304f8SSagi Grimberg }
21223f2304f8SSagi Grimberg 
21233f2304f8SSagi Grimberg static void nvme_tcp_reconnect_ctrl_work(struct work_struct *work)
21243f2304f8SSagi Grimberg {
21253f2304f8SSagi Grimberg 	struct nvme_tcp_ctrl *tcp_ctrl = container_of(to_delayed_work(work),
21263f2304f8SSagi Grimberg 			struct nvme_tcp_ctrl, connect_work);
21273f2304f8SSagi Grimberg 	struct nvme_ctrl *ctrl = &tcp_ctrl->ctrl;
21283f2304f8SSagi Grimberg 
21293f2304f8SSagi Grimberg 	++ctrl->nr_reconnects;
21303f2304f8SSagi Grimberg 
21313f2304f8SSagi Grimberg 	if (nvme_tcp_setup_ctrl(ctrl, false))
21323f2304f8SSagi Grimberg 		goto requeue;
21333f2304f8SSagi Grimberg 
213456a77d26SColin Ian King 	dev_info(ctrl->device, "Successfully reconnected (%d attempt)\n",
21353f2304f8SSagi Grimberg 			ctrl->nr_reconnects);
21363f2304f8SSagi Grimberg 
21373f2304f8SSagi Grimberg 	ctrl->nr_reconnects = 0;
21383f2304f8SSagi Grimberg 
21393f2304f8SSagi Grimberg 	return;
21403f2304f8SSagi Grimberg 
21413f2304f8SSagi Grimberg requeue:
21423f2304f8SSagi Grimberg 	dev_info(ctrl->device, "Failed reconnect attempt %d\n",
21433f2304f8SSagi Grimberg 			ctrl->nr_reconnects);
21443f2304f8SSagi Grimberg 	nvme_tcp_reconnect_or_remove(ctrl);
21453f2304f8SSagi Grimberg }
21463f2304f8SSagi Grimberg 
21473f2304f8SSagi Grimberg static void nvme_tcp_error_recovery_work(struct work_struct *work)
21483f2304f8SSagi Grimberg {
21493f2304f8SSagi Grimberg 	struct nvme_tcp_ctrl *tcp_ctrl = container_of(work,
21503f2304f8SSagi Grimberg 				struct nvme_tcp_ctrl, err_work);
21513f2304f8SSagi Grimberg 	struct nvme_ctrl *ctrl = &tcp_ctrl->ctrl;
21523f2304f8SSagi Grimberg 
21533f2304f8SSagi Grimberg 	nvme_stop_keep_alive(ctrl);
2154ff9fc7ebSSagi Grimberg 	flush_work(&ctrl->async_event_work);
21553f2304f8SSagi Grimberg 	nvme_tcp_teardown_io_queues(ctrl, false);
21563f2304f8SSagi Grimberg 	/* unquiesce to fail fast pending requests */
21579f27bd70SChristoph Hellwig 	nvme_unquiesce_io_queues(ctrl);
21583f2304f8SSagi Grimberg 	nvme_tcp_teardown_admin_queue(ctrl, false);
21599f27bd70SChristoph Hellwig 	nvme_unquiesce_admin_queue(ctrl);
21601f1a4f89SSagi Grimberg 	nvme_auth_stop(ctrl);
21613f2304f8SSagi Grimberg 
21623f2304f8SSagi Grimberg 	if (!nvme_change_ctrl_state(ctrl, NVME_CTRL_CONNECTING)) {
2163ecca390eSSagi Grimberg 		/* state change failure is ok if we started ctrl delete */
2164ecca390eSSagi Grimberg 		WARN_ON_ONCE(ctrl->state != NVME_CTRL_DELETING &&
2165ecca390eSSagi Grimberg 			     ctrl->state != NVME_CTRL_DELETING_NOIO);
21663f2304f8SSagi Grimberg 		return;
21673f2304f8SSagi Grimberg 	}
21683f2304f8SSagi Grimberg 
21693f2304f8SSagi Grimberg 	nvme_tcp_reconnect_or_remove(ctrl);
21703f2304f8SSagi Grimberg }
21713f2304f8SSagi Grimberg 
21723f2304f8SSagi Grimberg static void nvme_tcp_teardown_ctrl(struct nvme_ctrl *ctrl, bool shutdown)
21733f2304f8SSagi Grimberg {
21743f2304f8SSagi Grimberg 	nvme_tcp_teardown_io_queues(ctrl, shutdown);
21759f27bd70SChristoph Hellwig 	nvme_quiesce_admin_queue(ctrl);
2176285b6e9bSChristoph Hellwig 	nvme_disable_ctrl(ctrl, shutdown);
21773f2304f8SSagi Grimberg 	nvme_tcp_teardown_admin_queue(ctrl, shutdown);
21783f2304f8SSagi Grimberg }
21793f2304f8SSagi Grimberg 
21803f2304f8SSagi Grimberg static void nvme_tcp_delete_ctrl(struct nvme_ctrl *ctrl)
21813f2304f8SSagi Grimberg {
21823f2304f8SSagi Grimberg 	nvme_tcp_teardown_ctrl(ctrl, true);
21833f2304f8SSagi Grimberg }
21843f2304f8SSagi Grimberg 
21853f2304f8SSagi Grimberg static void nvme_reset_ctrl_work(struct work_struct *work)
21863f2304f8SSagi Grimberg {
21873f2304f8SSagi Grimberg 	struct nvme_ctrl *ctrl =
21883f2304f8SSagi Grimberg 		container_of(work, struct nvme_ctrl, reset_work);
21893f2304f8SSagi Grimberg 
21903f2304f8SSagi Grimberg 	nvme_stop_ctrl(ctrl);
21913f2304f8SSagi Grimberg 	nvme_tcp_teardown_ctrl(ctrl, false);
21923f2304f8SSagi Grimberg 
21933f2304f8SSagi Grimberg 	if (!nvme_change_ctrl_state(ctrl, NVME_CTRL_CONNECTING)) {
2194ecca390eSSagi Grimberg 		/* state change failure is ok if we started ctrl delete */
2195ecca390eSSagi Grimberg 		WARN_ON_ONCE(ctrl->state != NVME_CTRL_DELETING &&
2196ecca390eSSagi Grimberg 			     ctrl->state != NVME_CTRL_DELETING_NOIO);
21973f2304f8SSagi Grimberg 		return;
21983f2304f8SSagi Grimberg 	}
21993f2304f8SSagi Grimberg 
22003f2304f8SSagi Grimberg 	if (nvme_tcp_setup_ctrl(ctrl, false))
22013f2304f8SSagi Grimberg 		goto out_fail;
22023f2304f8SSagi Grimberg 
22033f2304f8SSagi Grimberg 	return;
22043f2304f8SSagi Grimberg 
22053f2304f8SSagi Grimberg out_fail:
22063f2304f8SSagi Grimberg 	++ctrl->nr_reconnects;
22073f2304f8SSagi Grimberg 	nvme_tcp_reconnect_or_remove(ctrl);
22083f2304f8SSagi Grimberg }
22093f2304f8SSagi Grimberg 
2210f7f70f4aSRuozhu Li static void nvme_tcp_stop_ctrl(struct nvme_ctrl *ctrl)
2211f7f70f4aSRuozhu Li {
2212c4abd875SSagi Grimberg 	flush_work(&to_tcp_ctrl(ctrl)->err_work);
2213f7f70f4aSRuozhu Li 	cancel_delayed_work_sync(&to_tcp_ctrl(ctrl)->connect_work);
2214f7f70f4aSRuozhu Li }
2215f7f70f4aSRuozhu Li 
22163f2304f8SSagi Grimberg static void nvme_tcp_free_ctrl(struct nvme_ctrl *nctrl)
22173f2304f8SSagi Grimberg {
22183f2304f8SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl = to_tcp_ctrl(nctrl);
22193f2304f8SSagi Grimberg 
22203f2304f8SSagi Grimberg 	if (list_empty(&ctrl->list))
22213f2304f8SSagi Grimberg 		goto free_ctrl;
22223f2304f8SSagi Grimberg 
22233f2304f8SSagi Grimberg 	mutex_lock(&nvme_tcp_ctrl_mutex);
22243f2304f8SSagi Grimberg 	list_del(&ctrl->list);
22253f2304f8SSagi Grimberg 	mutex_unlock(&nvme_tcp_ctrl_mutex);
22263f2304f8SSagi Grimberg 
22273f2304f8SSagi Grimberg 	nvmf_free_options(nctrl->opts);
22283f2304f8SSagi Grimberg free_ctrl:
22293f2304f8SSagi Grimberg 	kfree(ctrl->queues);
22303f2304f8SSagi Grimberg 	kfree(ctrl);
22313f2304f8SSagi Grimberg }
22323f2304f8SSagi Grimberg 
22333f2304f8SSagi Grimberg static void nvme_tcp_set_sg_null(struct nvme_command *c)
22343f2304f8SSagi Grimberg {
22353f2304f8SSagi Grimberg 	struct nvme_sgl_desc *sg = &c->common.dptr.sgl;
22363f2304f8SSagi Grimberg 
22373f2304f8SSagi Grimberg 	sg->addr = 0;
22383f2304f8SSagi Grimberg 	sg->length = 0;
22393f2304f8SSagi Grimberg 	sg->type = (NVME_TRANSPORT_SGL_DATA_DESC << 4) |
22403f2304f8SSagi Grimberg 			NVME_SGL_FMT_TRANSPORT_A;
22413f2304f8SSagi Grimberg }
22423f2304f8SSagi Grimberg 
22433f2304f8SSagi Grimberg static void nvme_tcp_set_sg_inline(struct nvme_tcp_queue *queue,
22443f2304f8SSagi Grimberg 		struct nvme_command *c, u32 data_len)
22453f2304f8SSagi Grimberg {
22463f2304f8SSagi Grimberg 	struct nvme_sgl_desc *sg = &c->common.dptr.sgl;
22473f2304f8SSagi Grimberg 
22483f2304f8SSagi Grimberg 	sg->addr = cpu_to_le64(queue->ctrl->ctrl.icdoff);
22493f2304f8SSagi Grimberg 	sg->length = cpu_to_le32(data_len);
22503f2304f8SSagi Grimberg 	sg->type = (NVME_SGL_FMT_DATA_DESC << 4) | NVME_SGL_FMT_OFFSET;
22513f2304f8SSagi Grimberg }
22523f2304f8SSagi Grimberg 
22533f2304f8SSagi Grimberg static void nvme_tcp_set_sg_host_data(struct nvme_command *c,
22543f2304f8SSagi Grimberg 		u32 data_len)
22553f2304f8SSagi Grimberg {
22563f2304f8SSagi Grimberg 	struct nvme_sgl_desc *sg = &c->common.dptr.sgl;
22573f2304f8SSagi Grimberg 
22583f2304f8SSagi Grimberg 	sg->addr = 0;
22593f2304f8SSagi Grimberg 	sg->length = cpu_to_le32(data_len);
22603f2304f8SSagi Grimberg 	sg->type = (NVME_TRANSPORT_SGL_DATA_DESC << 4) |
22613f2304f8SSagi Grimberg 			NVME_SGL_FMT_TRANSPORT_A;
22623f2304f8SSagi Grimberg }
22633f2304f8SSagi Grimberg 
22643f2304f8SSagi Grimberg static void nvme_tcp_submit_async_event(struct nvme_ctrl *arg)
22653f2304f8SSagi Grimberg {
22663f2304f8SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl = to_tcp_ctrl(arg);
22673f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = &ctrl->queues[0];
22683f2304f8SSagi Grimberg 	struct nvme_tcp_cmd_pdu *pdu = ctrl->async_req.pdu;
22693f2304f8SSagi Grimberg 	struct nvme_command *cmd = &pdu->cmd;
22703f2304f8SSagi Grimberg 	u8 hdgst = nvme_tcp_hdgst_len(queue);
22713f2304f8SSagi Grimberg 
22723f2304f8SSagi Grimberg 	memset(pdu, 0, sizeof(*pdu));
22733f2304f8SSagi Grimberg 	pdu->hdr.type = nvme_tcp_cmd;
22743f2304f8SSagi Grimberg 	if (queue->hdr_digest)
22753f2304f8SSagi Grimberg 		pdu->hdr.flags |= NVME_TCP_F_HDGST;
22763f2304f8SSagi Grimberg 	pdu->hdr.hlen = sizeof(*pdu);
22773f2304f8SSagi Grimberg 	pdu->hdr.plen = cpu_to_le32(pdu->hdr.hlen + hdgst);
22783f2304f8SSagi Grimberg 
22793f2304f8SSagi Grimberg 	cmd->common.opcode = nvme_admin_async_event;
22803f2304f8SSagi Grimberg 	cmd->common.command_id = NVME_AQ_BLK_MQ_DEPTH;
22813f2304f8SSagi Grimberg 	cmd->common.flags |= NVME_CMD_SGL_METABUF;
22823f2304f8SSagi Grimberg 	nvme_tcp_set_sg_null(cmd);
22833f2304f8SSagi Grimberg 
22843f2304f8SSagi Grimberg 	ctrl->async_req.state = NVME_TCP_SEND_CMD_PDU;
22853f2304f8SSagi Grimberg 	ctrl->async_req.offset = 0;
22863f2304f8SSagi Grimberg 	ctrl->async_req.curr_bio = NULL;
22873f2304f8SSagi Grimberg 	ctrl->async_req.data_len = 0;
22883f2304f8SSagi Grimberg 
228986f0348aSSagi Grimberg 	nvme_tcp_queue_request(&ctrl->async_req, true, true);
22903f2304f8SSagi Grimberg }
22913f2304f8SSagi Grimberg 
2292236187c4SSagi Grimberg static void nvme_tcp_complete_timed_out(struct request *rq)
2293236187c4SSagi Grimberg {
2294236187c4SSagi Grimberg 	struct nvme_tcp_request *req = blk_mq_rq_to_pdu(rq);
2295236187c4SSagi Grimberg 	struct nvme_ctrl *ctrl = &req->queue->ctrl->ctrl;
2296236187c4SSagi Grimberg 
2297236187c4SSagi Grimberg 	nvme_tcp_stop_queue(ctrl, nvme_tcp_queue_id(req->queue));
229893ba75c9SChaitanya Kulkarni 	nvmf_complete_timed_out_request(rq);
2299236187c4SSagi Grimberg }
2300236187c4SSagi Grimberg 
23019bdb4833SJohn Garry static enum blk_eh_timer_return nvme_tcp_timeout(struct request *rq)
23023f2304f8SSagi Grimberg {
23033f2304f8SSagi Grimberg 	struct nvme_tcp_request *req = blk_mq_rq_to_pdu(rq);
2304236187c4SSagi Grimberg 	struct nvme_ctrl *ctrl = &req->queue->ctrl->ctrl;
2305a3406352SSagi Grimberg 	struct nvme_tcp_cmd_pdu *pdu = nvme_tcp_req_cmd_pdu(req);
230699607843SAmit Engel 	u8 opc = pdu->cmd.common.opcode, fctype = pdu->cmd.fabrics.fctype;
230799607843SAmit Engel 	int qid = nvme_tcp_queue_id(req->queue);
23083f2304f8SSagi Grimberg 
2309236187c4SSagi Grimberg 	dev_warn(ctrl->device,
231099607843SAmit Engel 		"queue %d: timeout cid %#x type %d opcode %#x (%s)\n",
231199607843SAmit Engel 		nvme_tcp_queue_id(req->queue), nvme_cid(rq), pdu->hdr.type,
231299607843SAmit Engel 		opc, nvme_opcode_str(qid, opc, fctype));
23133f2304f8SSagi Grimberg 
2314236187c4SSagi Grimberg 	if (ctrl->state != NVME_CTRL_LIVE) {
231539d57757SSagi Grimberg 		/*
2316236187c4SSagi Grimberg 		 * If we are resetting, connecting or deleting we should
2317236187c4SSagi Grimberg 		 * complete immediately because we may block controller
2318236187c4SSagi Grimberg 		 * teardown or setup sequence
2319236187c4SSagi Grimberg 		 * - ctrl disable/shutdown fabrics requests
2320236187c4SSagi Grimberg 		 * - connect requests
2321236187c4SSagi Grimberg 		 * - initialization admin requests
2322236187c4SSagi Grimberg 		 * - I/O requests that entered after unquiescing and
2323236187c4SSagi Grimberg 		 *   the controller stopped responding
2324236187c4SSagi Grimberg 		 *
2325236187c4SSagi Grimberg 		 * All other requests should be cancelled by the error
2326236187c4SSagi Grimberg 		 * recovery work, so it's fine that we fail it here.
232739d57757SSagi Grimberg 		 */
2328236187c4SSagi Grimberg 		nvme_tcp_complete_timed_out(rq);
23293f2304f8SSagi Grimberg 		return BLK_EH_DONE;
23303f2304f8SSagi Grimberg 	}
23313f2304f8SSagi Grimberg 
2332236187c4SSagi Grimberg 	/*
2333236187c4SSagi Grimberg 	 * LIVE state should trigger the normal error recovery which will
2334236187c4SSagi Grimberg 	 * handle completing this request.
2335236187c4SSagi Grimberg 	 */
2336236187c4SSagi Grimberg 	nvme_tcp_error_recovery(ctrl);
23373f2304f8SSagi Grimberg 	return BLK_EH_RESET_TIMER;
23383f2304f8SSagi Grimberg }
23393f2304f8SSagi Grimberg 
23403f2304f8SSagi Grimberg static blk_status_t nvme_tcp_map_data(struct nvme_tcp_queue *queue,
23413f2304f8SSagi Grimberg 			struct request *rq)
23423f2304f8SSagi Grimberg {
23433f2304f8SSagi Grimberg 	struct nvme_tcp_request *req = blk_mq_rq_to_pdu(rq);
2344a3406352SSagi Grimberg 	struct nvme_tcp_cmd_pdu *pdu = nvme_tcp_req_cmd_pdu(req);
23453f2304f8SSagi Grimberg 	struct nvme_command *c = &pdu->cmd;
23463f2304f8SSagi Grimberg 
23473f2304f8SSagi Grimberg 	c->common.flags |= NVME_CMD_SGL_METABUF;
23483f2304f8SSagi Grimberg 
234925e5cb78SSagi Grimberg 	if (!blk_rq_nr_phys_segments(rq))
235025e5cb78SSagi Grimberg 		nvme_tcp_set_sg_null(c);
235125e5cb78SSagi Grimberg 	else if (rq_data_dir(rq) == WRITE &&
235253ee9e29SCaleb Sander 	    req->data_len <= nvme_tcp_inline_data_size(req))
23533f2304f8SSagi Grimberg 		nvme_tcp_set_sg_inline(queue, c, req->data_len);
23543f2304f8SSagi Grimberg 	else
23553f2304f8SSagi Grimberg 		nvme_tcp_set_sg_host_data(c, req->data_len);
23563f2304f8SSagi Grimberg 
23573f2304f8SSagi Grimberg 	return 0;
23583f2304f8SSagi Grimberg }
23593f2304f8SSagi Grimberg 
23603f2304f8SSagi Grimberg static blk_status_t nvme_tcp_setup_cmd_pdu(struct nvme_ns *ns,
23613f2304f8SSagi Grimberg 		struct request *rq)
23623f2304f8SSagi Grimberg {
23633f2304f8SSagi Grimberg 	struct nvme_tcp_request *req = blk_mq_rq_to_pdu(rq);
2364a3406352SSagi Grimberg 	struct nvme_tcp_cmd_pdu *pdu = nvme_tcp_req_cmd_pdu(req);
23653f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = req->queue;
23663f2304f8SSagi Grimberg 	u8 hdgst = nvme_tcp_hdgst_len(queue), ddgst = 0;
23673f2304f8SSagi Grimberg 	blk_status_t ret;
23683f2304f8SSagi Grimberg 
2369f4b9e6c9SKeith Busch 	ret = nvme_setup_cmd(ns, rq);
23703f2304f8SSagi Grimberg 	if (ret)
23713f2304f8SSagi Grimberg 		return ret;
23723f2304f8SSagi Grimberg 
23733f2304f8SSagi Grimberg 	req->state = NVME_TCP_SEND_CMD_PDU;
23741ba2e507SDaniel Wagner 	req->status = cpu_to_le16(NVME_SC_SUCCESS);
23753f2304f8SSagi Grimberg 	req->offset = 0;
23763f2304f8SSagi Grimberg 	req->data_sent = 0;
23773f2304f8SSagi Grimberg 	req->pdu_len = 0;
23783f2304f8SSagi Grimberg 	req->pdu_sent = 0;
2379c2700d28SVarun Prakash 	req->h2cdata_left = 0;
238025e5cb78SSagi Grimberg 	req->data_len = blk_rq_nr_phys_segments(rq) ?
238125e5cb78SSagi Grimberg 				blk_rq_payload_bytes(rq) : 0;
23823f2304f8SSagi Grimberg 	req->curr_bio = rq->bio;
2383e11e5116SSagi Grimberg 	if (req->curr_bio && req->data_len)
2384cb9b870fSSagi Grimberg 		nvme_tcp_init_iter(req, rq_data_dir(rq));
23853f2304f8SSagi Grimberg 
23863f2304f8SSagi Grimberg 	if (rq_data_dir(rq) == WRITE &&
238753ee9e29SCaleb Sander 	    req->data_len <= nvme_tcp_inline_data_size(req))
23883f2304f8SSagi Grimberg 		req->pdu_len = req->data_len;
23893f2304f8SSagi Grimberg 
23903f2304f8SSagi Grimberg 	pdu->hdr.type = nvme_tcp_cmd;
23913f2304f8SSagi Grimberg 	pdu->hdr.flags = 0;
23923f2304f8SSagi Grimberg 	if (queue->hdr_digest)
23933f2304f8SSagi Grimberg 		pdu->hdr.flags |= NVME_TCP_F_HDGST;
23943f2304f8SSagi Grimberg 	if (queue->data_digest && req->pdu_len) {
23953f2304f8SSagi Grimberg 		pdu->hdr.flags |= NVME_TCP_F_DDGST;
23963f2304f8SSagi Grimberg 		ddgst = nvme_tcp_ddgst_len(queue);
23973f2304f8SSagi Grimberg 	}
23983f2304f8SSagi Grimberg 	pdu->hdr.hlen = sizeof(*pdu);
23993f2304f8SSagi Grimberg 	pdu->hdr.pdo = req->pdu_len ? pdu->hdr.hlen + hdgst : 0;
24003f2304f8SSagi Grimberg 	pdu->hdr.plen =
24013f2304f8SSagi Grimberg 		cpu_to_le32(pdu->hdr.hlen + hdgst + req->pdu_len + ddgst);
24023f2304f8SSagi Grimberg 
24033f2304f8SSagi Grimberg 	ret = nvme_tcp_map_data(queue, rq);
24043f2304f8SSagi Grimberg 	if (unlikely(ret)) {
240528a4cac4SMax Gurtovoy 		nvme_cleanup_cmd(rq);
24063f2304f8SSagi Grimberg 		dev_err(queue->ctrl->ctrl.device,
24073f2304f8SSagi Grimberg 			"Failed to map data (%d)\n", ret);
24083f2304f8SSagi Grimberg 		return ret;
24093f2304f8SSagi Grimberg 	}
24103f2304f8SSagi Grimberg 
24113f2304f8SSagi Grimberg 	return 0;
24123f2304f8SSagi Grimberg }
24133f2304f8SSagi Grimberg 
241486f0348aSSagi Grimberg static void nvme_tcp_commit_rqs(struct blk_mq_hw_ctx *hctx)
241586f0348aSSagi Grimberg {
241686f0348aSSagi Grimberg 	struct nvme_tcp_queue *queue = hctx->driver_data;
241786f0348aSSagi Grimberg 
241886f0348aSSagi Grimberg 	if (!llist_empty(&queue->req_list))
241986f0348aSSagi Grimberg 		queue_work_on(queue->io_cpu, nvme_tcp_wq, &queue->io_work);
242086f0348aSSagi Grimberg }
242186f0348aSSagi Grimberg 
24223f2304f8SSagi Grimberg static blk_status_t nvme_tcp_queue_rq(struct blk_mq_hw_ctx *hctx,
24233f2304f8SSagi Grimberg 		const struct blk_mq_queue_data *bd)
24243f2304f8SSagi Grimberg {
24253f2304f8SSagi Grimberg 	struct nvme_ns *ns = hctx->queue->queuedata;
24263f2304f8SSagi Grimberg 	struct nvme_tcp_queue *queue = hctx->driver_data;
24273f2304f8SSagi Grimberg 	struct request *rq = bd->rq;
24283f2304f8SSagi Grimberg 	struct nvme_tcp_request *req = blk_mq_rq_to_pdu(rq);
24293f2304f8SSagi Grimberg 	bool queue_ready = test_bit(NVME_TCP_Q_LIVE, &queue->flags);
24303f2304f8SSagi Grimberg 	blk_status_t ret;
24313f2304f8SSagi Grimberg 
2432a9715744STao Chiu 	if (!nvme_check_ready(&queue->ctrl->ctrl, rq, queue_ready))
2433a9715744STao Chiu 		return nvme_fail_nonready_command(&queue->ctrl->ctrl, rq);
24343f2304f8SSagi Grimberg 
24353f2304f8SSagi Grimberg 	ret = nvme_tcp_setup_cmd_pdu(ns, rq);
24363f2304f8SSagi Grimberg 	if (unlikely(ret))
24373f2304f8SSagi Grimberg 		return ret;
24383f2304f8SSagi Grimberg 
24396887fc64SSagi Grimberg 	nvme_start_request(rq);
24403f2304f8SSagi Grimberg 
244186f0348aSSagi Grimberg 	nvme_tcp_queue_request(req, true, bd->last);
24423f2304f8SSagi Grimberg 
24433f2304f8SSagi Grimberg 	return BLK_STS_OK;
24443f2304f8SSagi Grimberg }
24453f2304f8SSagi Grimberg 
2446a4e1d0b7SBart Van Assche static void nvme_tcp_map_queues(struct blk_mq_tag_set *set)
2447873946f4SSagi Grimberg {
244806427ca0SChristoph Hellwig 	struct nvme_tcp_ctrl *ctrl = to_tcp_ctrl(set->driver_data);
244964861993SSagi Grimberg 	struct nvmf_ctrl_options *opts = ctrl->ctrl.opts;
2450873946f4SSagi Grimberg 
245164861993SSagi Grimberg 	if (opts->nr_write_queues && ctrl->io_queues[HCTX_TYPE_READ]) {
2452873946f4SSagi Grimberg 		/* separate read/write queues */
2453873946f4SSagi Grimberg 		set->map[HCTX_TYPE_DEFAULT].nr_queues =
245464861993SSagi Grimberg 			ctrl->io_queues[HCTX_TYPE_DEFAULT];
245564861993SSagi Grimberg 		set->map[HCTX_TYPE_DEFAULT].queue_offset = 0;
245664861993SSagi Grimberg 		set->map[HCTX_TYPE_READ].nr_queues =
245764861993SSagi Grimberg 			ctrl->io_queues[HCTX_TYPE_READ];
2458873946f4SSagi Grimberg 		set->map[HCTX_TYPE_READ].queue_offset =
245964861993SSagi Grimberg 			ctrl->io_queues[HCTX_TYPE_DEFAULT];
2460873946f4SSagi Grimberg 	} else {
246164861993SSagi Grimberg 		/* shared read/write queues */
2462873946f4SSagi Grimberg 		set->map[HCTX_TYPE_DEFAULT].nr_queues =
246364861993SSagi Grimberg 			ctrl->io_queues[HCTX_TYPE_DEFAULT];
246464861993SSagi Grimberg 		set->map[HCTX_TYPE_DEFAULT].queue_offset = 0;
246564861993SSagi Grimberg 		set->map[HCTX_TYPE_READ].nr_queues =
246664861993SSagi Grimberg 			ctrl->io_queues[HCTX_TYPE_DEFAULT];
2467873946f4SSagi Grimberg 		set->map[HCTX_TYPE_READ].queue_offset = 0;
2468873946f4SSagi Grimberg 	}
2469873946f4SSagi Grimberg 	blk_mq_map_queues(&set->map[HCTX_TYPE_DEFAULT]);
2470873946f4SSagi Grimberg 	blk_mq_map_queues(&set->map[HCTX_TYPE_READ]);
247164861993SSagi Grimberg 
24721a9460ceSSagi Grimberg 	if (opts->nr_poll_queues && ctrl->io_queues[HCTX_TYPE_POLL]) {
24731a9460ceSSagi Grimberg 		/* map dedicated poll queues only if we have queues left */
24741a9460ceSSagi Grimberg 		set->map[HCTX_TYPE_POLL].nr_queues =
24751a9460ceSSagi Grimberg 				ctrl->io_queues[HCTX_TYPE_POLL];
24761a9460ceSSagi Grimberg 		set->map[HCTX_TYPE_POLL].queue_offset =
24771a9460ceSSagi Grimberg 			ctrl->io_queues[HCTX_TYPE_DEFAULT] +
24781a9460ceSSagi Grimberg 			ctrl->io_queues[HCTX_TYPE_READ];
24791a9460ceSSagi Grimberg 		blk_mq_map_queues(&set->map[HCTX_TYPE_POLL]);
24801a9460ceSSagi Grimberg 	}
24811a9460ceSSagi Grimberg 
248264861993SSagi Grimberg 	dev_info(ctrl->ctrl.device,
24831a9460ceSSagi Grimberg 		"mapped %d/%d/%d default/read/poll queues.\n",
248464861993SSagi Grimberg 		ctrl->io_queues[HCTX_TYPE_DEFAULT],
24851a9460ceSSagi Grimberg 		ctrl->io_queues[HCTX_TYPE_READ],
24861a9460ceSSagi Grimberg 		ctrl->io_queues[HCTX_TYPE_POLL]);
2487873946f4SSagi Grimberg }
2488873946f4SSagi Grimberg 
24895a72e899SJens Axboe static int nvme_tcp_poll(struct blk_mq_hw_ctx *hctx, struct io_comp_batch *iob)
24901a9460ceSSagi Grimberg {
24911a9460ceSSagi Grimberg 	struct nvme_tcp_queue *queue = hctx->driver_data;
24921a9460ceSSagi Grimberg 	struct sock *sk = queue->sock->sk;
24931a9460ceSSagi Grimberg 
2494f86e5bf8SSagi Grimberg 	if (!test_bit(NVME_TCP_Q_LIVE, &queue->flags))
2495f86e5bf8SSagi Grimberg 		return 0;
2496f86e5bf8SSagi Grimberg 
249772e5d757SSagi Grimberg 	set_bit(NVME_TCP_Q_POLLING, &queue->flags);
24983f926af3SEric Dumazet 	if (sk_can_busy_loop(sk) && skb_queue_empty_lockless(&sk->sk_receive_queue))
24991a9460ceSSagi Grimberg 		sk_busy_loop(sk, true);
25001a9460ceSSagi Grimberg 	nvme_tcp_try_recv(queue);
250172e5d757SSagi Grimberg 	clear_bit(NVME_TCP_Q_POLLING, &queue->flags);
25021a9460ceSSagi Grimberg 	return queue->nr_cqe;
25031a9460ceSSagi Grimberg }
25041a9460ceSSagi Grimberg 
250502c57a82SMartin Belanger static int nvme_tcp_get_address(struct nvme_ctrl *ctrl, char *buf, int size)
250602c57a82SMartin Belanger {
250702c57a82SMartin Belanger 	struct nvme_tcp_queue *queue = &to_tcp_ctrl(ctrl)->queues[0];
250802c57a82SMartin Belanger 	struct sockaddr_storage src_addr;
250902c57a82SMartin Belanger 	int ret, len;
251002c57a82SMartin Belanger 
251102c57a82SMartin Belanger 	len = nvmf_get_address(ctrl, buf, size);
251202c57a82SMartin Belanger 
251376d54bf2SAkinobu Mita 	mutex_lock(&queue->queue_lock);
251476d54bf2SAkinobu Mita 
251576d54bf2SAkinobu Mita 	if (!test_bit(NVME_TCP_Q_LIVE, &queue->flags))
251676d54bf2SAkinobu Mita 		goto done;
251702c57a82SMartin Belanger 	ret = kernel_getsockname(queue->sock, (struct sockaddr *)&src_addr);
251802c57a82SMartin Belanger 	if (ret > 0) {
251902c57a82SMartin Belanger 		if (len > 0)
252002c57a82SMartin Belanger 			len--; /* strip trailing newline */
252102c57a82SMartin Belanger 		len += scnprintf(buf + len, size - len, "%ssrc_addr=%pISc\n",
252202c57a82SMartin Belanger 				(len) ? "," : "", &src_addr);
252302c57a82SMartin Belanger 	}
252476d54bf2SAkinobu Mita done:
252576d54bf2SAkinobu Mita 	mutex_unlock(&queue->queue_lock);
252602c57a82SMartin Belanger 
252702c57a82SMartin Belanger 	return len;
252802c57a82SMartin Belanger }
252902c57a82SMartin Belanger 
25306acbd961SRikard Falkeborn static const struct blk_mq_ops nvme_tcp_mq_ops = {
25313f2304f8SSagi Grimberg 	.queue_rq	= nvme_tcp_queue_rq,
253286f0348aSSagi Grimberg 	.commit_rqs	= nvme_tcp_commit_rqs,
25333f2304f8SSagi Grimberg 	.complete	= nvme_complete_rq,
25343f2304f8SSagi Grimberg 	.init_request	= nvme_tcp_init_request,
25353f2304f8SSagi Grimberg 	.exit_request	= nvme_tcp_exit_request,
25363f2304f8SSagi Grimberg 	.init_hctx	= nvme_tcp_init_hctx,
25373f2304f8SSagi Grimberg 	.timeout	= nvme_tcp_timeout,
2538873946f4SSagi Grimberg 	.map_queues	= nvme_tcp_map_queues,
25391a9460ceSSagi Grimberg 	.poll		= nvme_tcp_poll,
25403f2304f8SSagi Grimberg };
25413f2304f8SSagi Grimberg 
25426acbd961SRikard Falkeborn static const struct blk_mq_ops nvme_tcp_admin_mq_ops = {
25433f2304f8SSagi Grimberg 	.queue_rq	= nvme_tcp_queue_rq,
25443f2304f8SSagi Grimberg 	.complete	= nvme_complete_rq,
25453f2304f8SSagi Grimberg 	.init_request	= nvme_tcp_init_request,
25463f2304f8SSagi Grimberg 	.exit_request	= nvme_tcp_exit_request,
25473f2304f8SSagi Grimberg 	.init_hctx	= nvme_tcp_init_admin_hctx,
25483f2304f8SSagi Grimberg 	.timeout	= nvme_tcp_timeout,
25493f2304f8SSagi Grimberg };
25503f2304f8SSagi Grimberg 
25513f2304f8SSagi Grimberg static const struct nvme_ctrl_ops nvme_tcp_ctrl_ops = {
25523f2304f8SSagi Grimberg 	.name			= "tcp",
25533f2304f8SSagi Grimberg 	.module			= THIS_MODULE,
2554db45e1a5SChristoph Hellwig 	.flags			= NVME_F_FABRICS | NVME_F_BLOCKING,
25553f2304f8SSagi Grimberg 	.reg_read32		= nvmf_reg_read32,
25563f2304f8SSagi Grimberg 	.reg_read64		= nvmf_reg_read64,
25573f2304f8SSagi Grimberg 	.reg_write32		= nvmf_reg_write32,
25583f2304f8SSagi Grimberg 	.free_ctrl		= nvme_tcp_free_ctrl,
25593f2304f8SSagi Grimberg 	.submit_async_event	= nvme_tcp_submit_async_event,
25603f2304f8SSagi Grimberg 	.delete_ctrl		= nvme_tcp_delete_ctrl,
256102c57a82SMartin Belanger 	.get_address		= nvme_tcp_get_address,
2562f7f70f4aSRuozhu Li 	.stop_ctrl		= nvme_tcp_stop_ctrl,
25633f2304f8SSagi Grimberg };
25643f2304f8SSagi Grimberg 
25653f2304f8SSagi Grimberg static bool
25663f2304f8SSagi Grimberg nvme_tcp_existing_controller(struct nvmf_ctrl_options *opts)
25673f2304f8SSagi Grimberg {
25683f2304f8SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl;
25693f2304f8SSagi Grimberg 	bool found = false;
25703f2304f8SSagi Grimberg 
25713f2304f8SSagi Grimberg 	mutex_lock(&nvme_tcp_ctrl_mutex);
25723f2304f8SSagi Grimberg 	list_for_each_entry(ctrl, &nvme_tcp_ctrl_list, list) {
25733f2304f8SSagi Grimberg 		found = nvmf_ip_options_match(&ctrl->ctrl, opts);
25743f2304f8SSagi Grimberg 		if (found)
25753f2304f8SSagi Grimberg 			break;
25763f2304f8SSagi Grimberg 	}
25773f2304f8SSagi Grimberg 	mutex_unlock(&nvme_tcp_ctrl_mutex);
25783f2304f8SSagi Grimberg 
25793f2304f8SSagi Grimberg 	return found;
25803f2304f8SSagi Grimberg }
25813f2304f8SSagi Grimberg 
25823f2304f8SSagi Grimberg static struct nvme_ctrl *nvme_tcp_create_ctrl(struct device *dev,
25833f2304f8SSagi Grimberg 		struct nvmf_ctrl_options *opts)
25843f2304f8SSagi Grimberg {
25853f2304f8SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl;
25863f2304f8SSagi Grimberg 	int ret;
25873f2304f8SSagi Grimberg 
25883f2304f8SSagi Grimberg 	ctrl = kzalloc(sizeof(*ctrl), GFP_KERNEL);
25893f2304f8SSagi Grimberg 	if (!ctrl)
25903f2304f8SSagi Grimberg 		return ERR_PTR(-ENOMEM);
25913f2304f8SSagi Grimberg 
25923f2304f8SSagi Grimberg 	INIT_LIST_HEAD(&ctrl->list);
25933f2304f8SSagi Grimberg 	ctrl->ctrl.opts = opts;
25941a9460ceSSagi Grimberg 	ctrl->ctrl.queue_count = opts->nr_io_queues + opts->nr_write_queues +
25951a9460ceSSagi Grimberg 				opts->nr_poll_queues + 1;
25963f2304f8SSagi Grimberg 	ctrl->ctrl.sqsize = opts->queue_size - 1;
25973f2304f8SSagi Grimberg 	ctrl->ctrl.kato = opts->kato;
25983f2304f8SSagi Grimberg 
25993f2304f8SSagi Grimberg 	INIT_DELAYED_WORK(&ctrl->connect_work,
26003f2304f8SSagi Grimberg 			nvme_tcp_reconnect_ctrl_work);
26013f2304f8SSagi Grimberg 	INIT_WORK(&ctrl->err_work, nvme_tcp_error_recovery_work);
26023f2304f8SSagi Grimberg 	INIT_WORK(&ctrl->ctrl.reset_work, nvme_reset_ctrl_work);
26033f2304f8SSagi Grimberg 
26043f2304f8SSagi Grimberg 	if (!(opts->mask & NVMF_OPT_TRSVCID)) {
26053f2304f8SSagi Grimberg 		opts->trsvcid =
26063f2304f8SSagi Grimberg 			kstrdup(__stringify(NVME_TCP_DISC_PORT), GFP_KERNEL);
26073f2304f8SSagi Grimberg 		if (!opts->trsvcid) {
26083f2304f8SSagi Grimberg 			ret = -ENOMEM;
26093f2304f8SSagi Grimberg 			goto out_free_ctrl;
26103f2304f8SSagi Grimberg 		}
26113f2304f8SSagi Grimberg 		opts->mask |= NVMF_OPT_TRSVCID;
26123f2304f8SSagi Grimberg 	}
26133f2304f8SSagi Grimberg 
26143f2304f8SSagi Grimberg 	ret = inet_pton_with_scope(&init_net, AF_UNSPEC,
26153f2304f8SSagi Grimberg 			opts->traddr, opts->trsvcid, &ctrl->addr);
26163f2304f8SSagi Grimberg 	if (ret) {
26173f2304f8SSagi Grimberg 		pr_err("malformed address passed: %s:%s\n",
26183f2304f8SSagi Grimberg 			opts->traddr, opts->trsvcid);
26193f2304f8SSagi Grimberg 		goto out_free_ctrl;
26203f2304f8SSagi Grimberg 	}
26213f2304f8SSagi Grimberg 
26223f2304f8SSagi Grimberg 	if (opts->mask & NVMF_OPT_HOST_TRADDR) {
26233f2304f8SSagi Grimberg 		ret = inet_pton_with_scope(&init_net, AF_UNSPEC,
26243f2304f8SSagi Grimberg 			opts->host_traddr, NULL, &ctrl->src_addr);
26253f2304f8SSagi Grimberg 		if (ret) {
26263f2304f8SSagi Grimberg 			pr_err("malformed src address passed: %s\n",
26273f2304f8SSagi Grimberg 			       opts->host_traddr);
26283f2304f8SSagi Grimberg 			goto out_free_ctrl;
26293f2304f8SSagi Grimberg 		}
26303f2304f8SSagi Grimberg 	}
26313f2304f8SSagi Grimberg 
26323ede8f72SMartin Belanger 	if (opts->mask & NVMF_OPT_HOST_IFACE) {
26338b43ced6SPrabhakar Kushwaha 		if (!__dev_get_by_name(&init_net, opts->host_iface)) {
26343ede8f72SMartin Belanger 			pr_err("invalid interface passed: %s\n",
26353ede8f72SMartin Belanger 			       opts->host_iface);
26363ede8f72SMartin Belanger 			ret = -ENODEV;
26373ede8f72SMartin Belanger 			goto out_free_ctrl;
26383ede8f72SMartin Belanger 		}
26393ede8f72SMartin Belanger 	}
26403ede8f72SMartin Belanger 
26413f2304f8SSagi Grimberg 	if (!opts->duplicate_connect && nvme_tcp_existing_controller(opts)) {
26423f2304f8SSagi Grimberg 		ret = -EALREADY;
26433f2304f8SSagi Grimberg 		goto out_free_ctrl;
26443f2304f8SSagi Grimberg 	}
26453f2304f8SSagi Grimberg 
2646873946f4SSagi Grimberg 	ctrl->queues = kcalloc(ctrl->ctrl.queue_count, sizeof(*ctrl->queues),
26473f2304f8SSagi Grimberg 				GFP_KERNEL);
26483f2304f8SSagi Grimberg 	if (!ctrl->queues) {
26493f2304f8SSagi Grimberg 		ret = -ENOMEM;
26503f2304f8SSagi Grimberg 		goto out_free_ctrl;
26513f2304f8SSagi Grimberg 	}
26523f2304f8SSagi Grimberg 
26533f2304f8SSagi Grimberg 	ret = nvme_init_ctrl(&ctrl->ctrl, dev, &nvme_tcp_ctrl_ops, 0);
26543f2304f8SSagi Grimberg 	if (ret)
26553f2304f8SSagi Grimberg 		goto out_kfree_queues;
26563f2304f8SSagi Grimberg 
26573f2304f8SSagi Grimberg 	if (!nvme_change_ctrl_state(&ctrl->ctrl, NVME_CTRL_CONNECTING)) {
26583f2304f8SSagi Grimberg 		WARN_ON_ONCE(1);
26593f2304f8SSagi Grimberg 		ret = -EINTR;
26603f2304f8SSagi Grimberg 		goto out_uninit_ctrl;
26613f2304f8SSagi Grimberg 	}
26623f2304f8SSagi Grimberg 
26633f2304f8SSagi Grimberg 	ret = nvme_tcp_setup_ctrl(&ctrl->ctrl, true);
26643f2304f8SSagi Grimberg 	if (ret)
26653f2304f8SSagi Grimberg 		goto out_uninit_ctrl;
26663f2304f8SSagi Grimberg 
26673f2304f8SSagi Grimberg 	dev_info(ctrl->ctrl.device, "new ctrl: NQN \"%s\", addr %pISp\n",
2668e5ea42faSHannes Reinecke 		nvmf_ctrl_subsysnqn(&ctrl->ctrl), &ctrl->addr);
26693f2304f8SSagi Grimberg 
26703f2304f8SSagi Grimberg 	mutex_lock(&nvme_tcp_ctrl_mutex);
26713f2304f8SSagi Grimberg 	list_add_tail(&ctrl->list, &nvme_tcp_ctrl_list);
26723f2304f8SSagi Grimberg 	mutex_unlock(&nvme_tcp_ctrl_mutex);
26733f2304f8SSagi Grimberg 
26743f2304f8SSagi Grimberg 	return &ctrl->ctrl;
26753f2304f8SSagi Grimberg 
26763f2304f8SSagi Grimberg out_uninit_ctrl:
26773f2304f8SSagi Grimberg 	nvme_uninit_ctrl(&ctrl->ctrl);
26783f2304f8SSagi Grimberg 	nvme_put_ctrl(&ctrl->ctrl);
26793f2304f8SSagi Grimberg 	if (ret > 0)
26803f2304f8SSagi Grimberg 		ret = -EIO;
26813f2304f8SSagi Grimberg 	return ERR_PTR(ret);
26823f2304f8SSagi Grimberg out_kfree_queues:
26833f2304f8SSagi Grimberg 	kfree(ctrl->queues);
26843f2304f8SSagi Grimberg out_free_ctrl:
26853f2304f8SSagi Grimberg 	kfree(ctrl);
26863f2304f8SSagi Grimberg 	return ERR_PTR(ret);
26873f2304f8SSagi Grimberg }
26883f2304f8SSagi Grimberg 
26893f2304f8SSagi Grimberg static struct nvmf_transport_ops nvme_tcp_transport = {
26903f2304f8SSagi Grimberg 	.name		= "tcp",
26913f2304f8SSagi Grimberg 	.module		= THIS_MODULE,
26923f2304f8SSagi Grimberg 	.required_opts	= NVMF_OPT_TRADDR,
26933f2304f8SSagi Grimberg 	.allowed_opts	= NVMF_OPT_TRSVCID | NVMF_OPT_RECONNECT_DELAY |
26943f2304f8SSagi Grimberg 			  NVMF_OPT_HOST_TRADDR | NVMF_OPT_CTRL_LOSS_TMO |
2695873946f4SSagi Grimberg 			  NVMF_OPT_HDR_DIGEST | NVMF_OPT_DATA_DIGEST |
2696bb13985dSIsrael Rukshin 			  NVMF_OPT_NR_WRITE_QUEUES | NVMF_OPT_NR_POLL_QUEUES |
26973ede8f72SMartin Belanger 			  NVMF_OPT_TOS | NVMF_OPT_HOST_IFACE,
26983f2304f8SSagi Grimberg 	.create_ctrl	= nvme_tcp_create_ctrl,
26993f2304f8SSagi Grimberg };
27003f2304f8SSagi Grimberg 
27013f2304f8SSagi Grimberg static int __init nvme_tcp_init_module(void)
27023f2304f8SSagi Grimberg {
27037e87965dSSagi Grimberg 	BUILD_BUG_ON(sizeof(struct nvme_tcp_hdr) != 8);
27047e87965dSSagi Grimberg 	BUILD_BUG_ON(sizeof(struct nvme_tcp_cmd_pdu) != 72);
27057e87965dSSagi Grimberg 	BUILD_BUG_ON(sizeof(struct nvme_tcp_data_pdu) != 24);
27067e87965dSSagi Grimberg 	BUILD_BUG_ON(sizeof(struct nvme_tcp_rsp_pdu) != 24);
27077e87965dSSagi Grimberg 	BUILD_BUG_ON(sizeof(struct nvme_tcp_r2t_pdu) != 24);
27087e87965dSSagi Grimberg 	BUILD_BUG_ON(sizeof(struct nvme_tcp_icreq_pdu) != 128);
27097e87965dSSagi Grimberg 	BUILD_BUG_ON(sizeof(struct nvme_tcp_icresp_pdu) != 128);
27107e87965dSSagi Grimberg 	BUILD_BUG_ON(sizeof(struct nvme_tcp_term_pdu) != 24);
27117e87965dSSagi Grimberg 
27123f2304f8SSagi Grimberg 	nvme_tcp_wq = alloc_workqueue("nvme_tcp_wq",
27133f2304f8SSagi Grimberg 			WQ_MEM_RECLAIM | WQ_HIGHPRI, 0);
27143f2304f8SSagi Grimberg 	if (!nvme_tcp_wq)
27153f2304f8SSagi Grimberg 		return -ENOMEM;
27163f2304f8SSagi Grimberg 
27173f2304f8SSagi Grimberg 	nvmf_register_transport(&nvme_tcp_transport);
27183f2304f8SSagi Grimberg 	return 0;
27193f2304f8SSagi Grimberg }
27203f2304f8SSagi Grimberg 
27213f2304f8SSagi Grimberg static void __exit nvme_tcp_cleanup_module(void)
27223f2304f8SSagi Grimberg {
27233f2304f8SSagi Grimberg 	struct nvme_tcp_ctrl *ctrl;
27243f2304f8SSagi Grimberg 
27253f2304f8SSagi Grimberg 	nvmf_unregister_transport(&nvme_tcp_transport);
27263f2304f8SSagi Grimberg 
27273f2304f8SSagi Grimberg 	mutex_lock(&nvme_tcp_ctrl_mutex);
27283f2304f8SSagi Grimberg 	list_for_each_entry(ctrl, &nvme_tcp_ctrl_list, list)
27293f2304f8SSagi Grimberg 		nvme_delete_ctrl(&ctrl->ctrl);
27303f2304f8SSagi Grimberg 	mutex_unlock(&nvme_tcp_ctrl_mutex);
27313f2304f8SSagi Grimberg 	flush_workqueue(nvme_delete_wq);
27323f2304f8SSagi Grimberg 
27333f2304f8SSagi Grimberg 	destroy_workqueue(nvme_tcp_wq);
27343f2304f8SSagi Grimberg }
27353f2304f8SSagi Grimberg 
27363f2304f8SSagi Grimberg module_init(nvme_tcp_init_module);
27373f2304f8SSagi Grimberg module_exit(nvme_tcp_cleanup_module);
27383f2304f8SSagi Grimberg 
27393f2304f8SSagi Grimberg MODULE_LICENSE("GPL v2");
2740