xref: /openbmc/linux/drivers/scsi/cxgbi/cxgb4i/cxgb4i.c (revision 7b36b6e0)
1 /*
2  * cxgb4i.c: Chelsio T4 iSCSI driver.
3  *
4  * Copyright (c) 2010 Chelsio Communications, Inc.
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation.
9  *
10  * Written by:	Karen Xie (kxie@chelsio.com)
11  *		Rakesh Ranjan (rranjan@chelsio.com)
12  */
13 
14 #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
15 
16 #include <linux/version.h>
17 #include <linux/module.h>
18 #include <linux/moduleparam.h>
19 #include <scsi/scsi_host.h>
20 #include <net/tcp.h>
21 #include <net/dst.h>
22 #include <linux/netdevice.h>
23 
24 #include "t4_msg.h"
25 #include "cxgb4.h"
26 #include "cxgb4_uld.h"
27 #include "t4fw_api.h"
28 #include "l2t.h"
29 #include "cxgb4i.h"
30 
31 static unsigned int dbg_level;
32 
33 #include "../libcxgbi.h"
34 
35 #define	DRV_MODULE_NAME		"cxgb4i"
36 #define DRV_MODULE_DESC		"Chelsio T4 iSCSI Driver"
37 #define	DRV_MODULE_VERSION	"0.9.0"
38 #define	DRV_MODULE_RELDATE	"May 2010"
39 
40 static char version[] =
41 	DRV_MODULE_DESC " " DRV_MODULE_NAME
42 	" v" DRV_MODULE_VERSION " (" DRV_MODULE_RELDATE ")\n";
43 
44 MODULE_AUTHOR("Chelsio Communications, Inc.");
45 MODULE_DESCRIPTION(DRV_MODULE_DESC);
46 MODULE_VERSION(DRV_MODULE_VERSION);
47 MODULE_LICENSE("GPL");
48 
49 module_param(dbg_level, uint, 0644);
50 MODULE_PARM_DESC(dbg_level, "Debug flag (default=0)");
51 
52 static int cxgb4i_rcv_win = 256 * 1024;
53 module_param(cxgb4i_rcv_win, int, 0644);
54 MODULE_PARM_DESC(cxgb4i_rcv_win, "TCP reveive window in bytes");
55 
56 static int cxgb4i_snd_win = 128 * 1024;
57 module_param(cxgb4i_snd_win, int, 0644);
58 MODULE_PARM_DESC(cxgb4i_snd_win, "TCP send window in bytes");
59 
60 static int cxgb4i_rx_credit_thres = 10 * 1024;
61 module_param(cxgb4i_rx_credit_thres, int, 0644);
62 MODULE_PARM_DESC(cxgb4i_rx_credit_thres,
63 		"RX credits return threshold in bytes (default=10KB)");
64 
65 static unsigned int cxgb4i_max_connect = (8 * 1024);
66 module_param(cxgb4i_max_connect, uint, 0644);
67 MODULE_PARM_DESC(cxgb4i_max_connect, "Maximum number of connections");
68 
69 static unsigned short cxgb4i_sport_base = 20000;
70 module_param(cxgb4i_sport_base, ushort, 0644);
71 MODULE_PARM_DESC(cxgb4i_sport_base, "Starting port number (default 20000)");
72 
73 typedef void (*cxgb4i_cplhandler_func)(struct cxgbi_device *, struct sk_buff *);
74 
75 static void *t4_uld_add(const struct cxgb4_lld_info *);
76 static int t4_uld_rx_handler(void *, const __be64 *, const struct pkt_gl *);
77 static int t4_uld_state_change(void *, enum cxgb4_state state);
78 
79 static const struct cxgb4_uld_info cxgb4i_uld_info = {
80 	.name = DRV_MODULE_NAME,
81 	.add = t4_uld_add,
82 	.rx_handler = t4_uld_rx_handler,
83 	.state_change = t4_uld_state_change,
84 };
85 
86 static struct scsi_host_template cxgb4i_host_template = {
87 	.module		= THIS_MODULE,
88 	.name		= DRV_MODULE_NAME,
89 	.proc_name	= DRV_MODULE_NAME,
90 	.can_queue	= CXGB4I_SCSI_HOST_QDEPTH,
91 	.queuecommand	= iscsi_queuecommand,
92 	.change_queue_depth = iscsi_change_queue_depth,
93 	.sg_tablesize	= SG_ALL,
94 	.max_sectors	= 0xFFFF,
95 	.cmd_per_lun	= ISCSI_DEF_CMD_PER_LUN,
96 	.eh_abort_handler = iscsi_eh_abort,
97 	.eh_device_reset_handler = iscsi_eh_device_reset,
98 	.eh_target_reset_handler = iscsi_eh_recover_target,
99 	.target_alloc	= iscsi_target_alloc,
100 	.use_clustering	= DISABLE_CLUSTERING,
101 	.this_id	= -1,
102 };
103 
104 static struct iscsi_transport cxgb4i_iscsi_transport = {
105 	.owner		= THIS_MODULE,
106 	.name		= DRV_MODULE_NAME,
107 	.caps		= CAP_RECOVERY_L0 | CAP_MULTI_R2T | CAP_HDRDGST |
108 				CAP_DATADGST | CAP_DIGEST_OFFLOAD |
109 				CAP_PADDING_OFFLOAD,
110 	.param_mask	= ISCSI_MAX_RECV_DLENGTH | ISCSI_MAX_XMIT_DLENGTH |
111 				ISCSI_HDRDGST_EN | ISCSI_DATADGST_EN |
112 				ISCSI_INITIAL_R2T_EN | ISCSI_MAX_R2T |
113 				ISCSI_IMM_DATA_EN | ISCSI_FIRST_BURST |
114 				ISCSI_MAX_BURST | ISCSI_PDU_INORDER_EN |
115 				ISCSI_DATASEQ_INORDER_EN | ISCSI_ERL |
116 				ISCSI_CONN_PORT | ISCSI_CONN_ADDRESS |
117 				ISCSI_EXP_STATSN | ISCSI_PERSISTENT_PORT |
118 				ISCSI_PERSISTENT_ADDRESS |
119 				ISCSI_TARGET_NAME | ISCSI_TPGT |
120 				ISCSI_USERNAME | ISCSI_PASSWORD |
121 				ISCSI_USERNAME_IN | ISCSI_PASSWORD_IN |
122 				ISCSI_FAST_ABORT | ISCSI_ABORT_TMO |
123 				ISCSI_LU_RESET_TMO | ISCSI_TGT_RESET_TMO |
124 				ISCSI_PING_TMO | ISCSI_RECV_TMO |
125 				ISCSI_IFACE_NAME | ISCSI_INITIATOR_NAME,
126 	.host_param_mask	= ISCSI_HOST_HWADDRESS | ISCSI_HOST_IPADDRESS |
127 				ISCSI_HOST_INITIATOR_NAME |
128 				ISCSI_HOST_NETDEV_NAME,
129 	.get_host_param	= cxgbi_get_host_param,
130 	.set_host_param	= cxgbi_set_host_param,
131 	/* session management */
132 	.create_session	= cxgbi_create_session,
133 	.destroy_session	= cxgbi_destroy_session,
134 	.get_session_param = iscsi_session_get_param,
135 	/* connection management */
136 	.create_conn	= cxgbi_create_conn,
137 	.bind_conn		= cxgbi_bind_conn,
138 	.destroy_conn	= iscsi_tcp_conn_teardown,
139 	.start_conn		= iscsi_conn_start,
140 	.stop_conn		= iscsi_conn_stop,
141 	.get_conn_param	= cxgbi_get_conn_param,
142 	.set_param	= cxgbi_set_conn_param,
143 	.get_stats	= cxgbi_get_conn_stats,
144 	/* pdu xmit req from user space */
145 	.send_pdu	= iscsi_conn_send_pdu,
146 	/* task */
147 	.init_task	= iscsi_tcp_task_init,
148 	.xmit_task	= iscsi_tcp_task_xmit,
149 	.cleanup_task	= cxgbi_cleanup_task,
150 	/* pdu */
151 	.alloc_pdu	= cxgbi_conn_alloc_pdu,
152 	.init_pdu	= cxgbi_conn_init_pdu,
153 	.xmit_pdu	= cxgbi_conn_xmit_pdu,
154 	.parse_pdu_itt	= cxgbi_parse_pdu_itt,
155 	/* TCP connect/disconnect */
156 	.ep_connect	= cxgbi_ep_connect,
157 	.ep_poll	= cxgbi_ep_poll,
158 	.ep_disconnect	= cxgbi_ep_disconnect,
159 	/* Error recovery timeout call */
160 	.session_recovery_timedout = iscsi_session_recovery_timedout,
161 };
162 
163 static struct scsi_transport_template *cxgb4i_stt;
164 
165 /*
166  * CPL (Chelsio Protocol Language) defines a message passing interface between
167  * the host driver and Chelsio asic.
168  * The section below implments CPLs that related to iscsi tcp connection
169  * open/close/abort and data send/receive.
170  */
171 #define DIV_ROUND_UP(n, d)	(((n) + (d) - 1) / (d))
172 #define RCV_BUFSIZ_MASK		0x3FFU
173 #define MAX_IMM_TX_PKT_LEN	128
174 
175 static inline void set_queue(struct sk_buff *skb, unsigned int queue,
176 				const struct cxgbi_sock *csk)
177 {
178 	skb->queue_mapping = queue;
179 }
180 
181 static int push_tx_frames(struct cxgbi_sock *, int);
182 
183 /*
184  * is_ofld_imm - check whether a packet can be sent as immediate data
185  * @skb: the packet
186  *
187  * Returns true if a packet can be sent as an offload WR with immediate
188  * data.  We currently use the same limit as for Ethernet packets.
189  */
190 static inline int is_ofld_imm(const struct sk_buff *skb)
191 {
192 	return skb->len <= (MAX_IMM_TX_PKT_LEN -
193 			sizeof(struct fw_ofld_tx_data_wr));
194 }
195 
196 static void send_act_open_req(struct cxgbi_sock *csk, struct sk_buff *skb,
197 				struct l2t_entry *e)
198 {
199 	struct cpl_act_open_req *req;
200 	int wscale = cxgbi_sock_compute_wscale(csk->mss_idx);
201 	unsigned long long opt0;
202 	unsigned int opt2;
203 	unsigned int qid_atid = ((unsigned int)csk->atid) |
204 				 (((unsigned int)csk->rss_qid) << 14);
205 
206 	opt0 = KEEP_ALIVE(1) |
207 		WND_SCALE(wscale) |
208 		MSS_IDX(csk->mss_idx) |
209 		L2T_IDX(((struct l2t_entry *)csk->l2t)->idx) |
210 		TX_CHAN(csk->tx_chan) |
211 		SMAC_SEL(csk->smac_idx) |
212 		ULP_MODE(ULP_MODE_ISCSI) |
213 		RCV_BUFSIZ(cxgb4i_rcv_win >> 10);
214 	opt2 = RX_CHANNEL(0) |
215 		RSS_QUEUE_VALID |
216 		(1 << 20) | (1 << 22) |
217 		RSS_QUEUE(csk->rss_qid);
218 
219 	set_wr_txq(skb, CPL_PRIORITY_SETUP, csk->port_id);
220 	req = (struct cpl_act_open_req *)skb->head;
221 
222 	INIT_TP_WR(req, 0);
223 	OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_ACT_OPEN_REQ,
224 					qid_atid));
225 	req->local_port = csk->saddr.sin_port;
226 	req->peer_port = csk->daddr.sin_port;
227 	req->local_ip = csk->saddr.sin_addr.s_addr;
228 	req->peer_ip = csk->daddr.sin_addr.s_addr;
229 	req->opt0 = cpu_to_be64(opt0);
230 	req->params = 0;
231 	req->opt2 = cpu_to_be32(opt2);
232 
233 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
234 		"csk 0x%p, %pI4:%u-%pI4:%u, atid %d, qid %u.\n",
235 		csk, &req->local_ip, ntohs(req->local_port),
236 		&req->peer_ip, ntohs(req->peer_port),
237 		csk->atid, csk->rss_qid);
238 
239 	cxgb4_l2t_send(csk->cdev->ports[csk->port_id], skb, csk->l2t);
240 }
241 
242 static void send_close_req(struct cxgbi_sock *csk)
243 {
244 	struct sk_buff *skb = csk->cpl_close;
245 	struct cpl_close_con_req *req = (struct cpl_close_con_req *)skb->head;
246 	unsigned int tid = csk->tid;
247 
248 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
249 		"csk 0x%p,%u,0x%lx, tid %u.\n",
250 		csk, csk->state, csk->flags, csk->tid);
251 	csk->cpl_close = NULL;
252 	set_wr_txq(skb, CPL_PRIORITY_DATA, csk->port_id);
253 	INIT_TP_WR(req, tid);
254 	OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_CLOSE_CON_REQ, tid));
255 	req->rsvd = 0;
256 
257 	cxgbi_sock_skb_entail(csk, skb);
258 	if (csk->state >= CTP_ESTABLISHED)
259 		push_tx_frames(csk, 1);
260 }
261 
262 static void abort_arp_failure(void *handle, struct sk_buff *skb)
263 {
264 	struct cxgbi_sock *csk = (struct cxgbi_sock *)handle;
265 	struct cpl_abort_req *req;
266 
267 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
268 		"csk 0x%p,%u,0x%lx, tid %u, abort.\n",
269 		csk, csk->state, csk->flags, csk->tid);
270 	req = (struct cpl_abort_req *)skb->data;
271 	req->cmd = CPL_ABORT_NO_RST;
272 	cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb);
273 }
274 
275 static void send_abort_req(struct cxgbi_sock *csk)
276 {
277 	struct cpl_abort_req *req;
278 	struct sk_buff *skb = csk->cpl_abort_req;
279 
280 	if (unlikely(csk->state == CTP_ABORTING) || !skb || !csk->cdev)
281 		return;
282 	cxgbi_sock_set_state(csk, CTP_ABORTING);
283 	cxgbi_sock_set_flag(csk, CTPF_ABORT_RPL_PENDING);
284 	cxgbi_sock_purge_write_queue(csk);
285 
286 	csk->cpl_abort_req = NULL;
287 	req = (struct cpl_abort_req *)skb->head;
288 	set_queue(skb, CPL_PRIORITY_DATA, csk);
289 	req->cmd = CPL_ABORT_SEND_RST;
290 	t4_set_arp_err_handler(skb, csk, abort_arp_failure);
291 	INIT_TP_WR(req, csk->tid);
292 	OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_ABORT_REQ, csk->tid));
293 	req->rsvd0 = htonl(csk->snd_nxt);
294 	req->rsvd1 = !cxgbi_sock_flag(csk, CTPF_TX_DATA_SENT);
295 
296 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
297 		"csk 0x%p,%u,0x%lx,%u, snd_nxt %u, 0x%x.\n",
298 		csk, csk->state, csk->flags, csk->tid, csk->snd_nxt,
299 		req->rsvd1);
300 
301 	cxgb4_l2t_send(csk->cdev->ports[csk->port_id], skb, csk->l2t);
302 }
303 
304 static void send_abort_rpl(struct cxgbi_sock *csk, int rst_status)
305 {
306 	struct sk_buff *skb = csk->cpl_abort_rpl;
307 	struct cpl_abort_rpl *rpl = (struct cpl_abort_rpl *)skb->head;
308 
309 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
310 		"csk 0x%p,%u,0x%lx,%u, status %d.\n",
311 		csk, csk->state, csk->flags, csk->tid, rst_status);
312 
313 	csk->cpl_abort_rpl = NULL;
314 	set_queue(skb, CPL_PRIORITY_DATA, csk);
315 	INIT_TP_WR(rpl, csk->tid);
316 	OPCODE_TID(rpl) = cpu_to_be32(MK_OPCODE_TID(CPL_ABORT_RPL, csk->tid));
317 	rpl->cmd = rst_status;
318 	cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb);
319 }
320 
321 /*
322  * CPL connection rx data ack: host ->
323  * Send RX credits through an RX_DATA_ACK CPL message. Returns the number of
324  * credits sent.
325  */
326 static u32 send_rx_credits(struct cxgbi_sock *csk, u32 credits)
327 {
328 	struct sk_buff *skb;
329 	struct cpl_rx_data_ack *req;
330 
331 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX,
332 		"csk 0x%p,%u,0x%lx,%u, credit %u.\n",
333 		csk, csk->state, csk->flags, csk->tid, credits);
334 
335 	skb = alloc_cpl(sizeof(*req), 0, GFP_ATOMIC);
336 	if (!skb) {
337 		pr_info("csk 0x%p, credit %u, OOM.\n", csk, credits);
338 		return 0;
339 	}
340 	req = (struct cpl_rx_data_ack *)skb->head;
341 
342 	set_wr_txq(skb, CPL_PRIORITY_ACK, csk->port_id);
343 	INIT_TP_WR(req, csk->tid);
344 	OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_RX_DATA_ACK,
345 				      csk->tid));
346 	req->credit_dack = cpu_to_be32(RX_CREDITS(credits) | RX_FORCE_ACK(1));
347 	cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb);
348 	return credits;
349 }
350 
351 /*
352  * sgl_len - calculates the size of an SGL of the given capacity
353  * @n: the number of SGL entries
354  * Calculates the number of flits needed for a scatter/gather list that
355  * can hold the given number of entries.
356  */
357 static inline unsigned int sgl_len(unsigned int n)
358 {
359 	n--;
360 	return (3 * n) / 2 + (n & 1) + 2;
361 }
362 
363 /*
364  * calc_tx_flits_ofld - calculate # of flits for an offload packet
365  * @skb: the packet
366  *
367  * Returns the number of flits needed for the given offload packet.
368  * These packets are already fully constructed and no additional headers
369  * will be added.
370  */
371 static inline unsigned int calc_tx_flits_ofld(const struct sk_buff *skb)
372 {
373 	unsigned int flits, cnt;
374 
375 	if (is_ofld_imm(skb))
376 		return DIV_ROUND_UP(skb->len, 8);
377 	flits = skb_transport_offset(skb) / 8;
378 	cnt = skb_shinfo(skb)->nr_frags;
379 	if (skb->tail != skb->transport_header)
380 		cnt++;
381 	return flits + sgl_len(cnt);
382 }
383 
384 static inline void send_tx_flowc_wr(struct cxgbi_sock *csk)
385 {
386 	struct sk_buff *skb;
387 	struct fw_flowc_wr *flowc;
388 	int flowclen, i;
389 
390 	flowclen = 80;
391 	skb = alloc_cpl(flowclen, 0, GFP_ATOMIC);
392 	flowc = (struct fw_flowc_wr *)skb->head;
393 	flowc->op_to_nparams =
394 		htonl(FW_WR_OP(FW_FLOWC_WR) | FW_FLOWC_WR_NPARAMS(8));
395 	flowc->flowid_len16 =
396 		htonl(FW_WR_LEN16(DIV_ROUND_UP(72, 16)) |
397 				FW_WR_FLOWID(csk->tid));
398 	flowc->mnemval[0].mnemonic = FW_FLOWC_MNEM_PFNVFN;
399 	flowc->mnemval[0].val = htonl(0);
400 	flowc->mnemval[1].mnemonic = FW_FLOWC_MNEM_CH;
401 	flowc->mnemval[1].val = htonl(csk->tx_chan);
402 	flowc->mnemval[2].mnemonic = FW_FLOWC_MNEM_PORT;
403 	flowc->mnemval[2].val = htonl(csk->tx_chan);
404 	flowc->mnemval[3].mnemonic = FW_FLOWC_MNEM_IQID;
405 	flowc->mnemval[3].val = htonl(csk->rss_qid);
406 	flowc->mnemval[4].mnemonic = FW_FLOWC_MNEM_SNDNXT;
407 	flowc->mnemval[4].val = htonl(csk->snd_nxt);
408 	flowc->mnemval[5].mnemonic = FW_FLOWC_MNEM_RCVNXT;
409 	flowc->mnemval[5].val = htonl(csk->rcv_nxt);
410 	flowc->mnemval[6].mnemonic = FW_FLOWC_MNEM_SNDBUF;
411 	flowc->mnemval[6].val = htonl(cxgb4i_snd_win);
412 	flowc->mnemval[7].mnemonic = FW_FLOWC_MNEM_MSS;
413 	flowc->mnemval[7].val = htonl(csk->advmss);
414 	flowc->mnemval[8].mnemonic = 0;
415 	flowc->mnemval[8].val = 0;
416 	for (i = 0; i < 9; i++) {
417 		flowc->mnemval[i].r4[0] = 0;
418 		flowc->mnemval[i].r4[1] = 0;
419 		flowc->mnemval[i].r4[2] = 0;
420 	}
421 	set_queue(skb, CPL_PRIORITY_DATA, csk);
422 
423 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
424 		"csk 0x%p, tid 0x%x, %u,%u,%u,%u,%u,%u,%u.\n",
425 		csk, csk->tid, 0, csk->tx_chan, csk->rss_qid,
426 		csk->snd_nxt, csk->rcv_nxt, cxgb4i_snd_win,
427 		csk->advmss);
428 
429 	cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb);
430 }
431 
432 static inline void make_tx_data_wr(struct cxgbi_sock *csk, struct sk_buff *skb,
433 				   int dlen, int len, u32 credits, int compl)
434 {
435 	struct fw_ofld_tx_data_wr *req;
436 	unsigned int submode = cxgbi_skcb_ulp_mode(skb) & 3;
437 	unsigned int wr_ulp_mode = 0;
438 
439 	req = (struct fw_ofld_tx_data_wr *)__skb_push(skb, sizeof(*req));
440 
441 	if (is_ofld_imm(skb)) {
442 		req->op_to_immdlen = htonl(FW_WR_OP(FW_OFLD_TX_DATA_WR) |
443 					FW_WR_COMPL(1) |
444 					FW_WR_IMMDLEN(dlen));
445 		req->flowid_len16 = htonl(FW_WR_FLOWID(csk->tid) |
446 						FW_WR_LEN16(credits));
447 	} else {
448 		req->op_to_immdlen =
449 			cpu_to_be32(FW_WR_OP(FW_OFLD_TX_DATA_WR) |
450 					FW_WR_COMPL(1) |
451 					FW_WR_IMMDLEN(0));
452 		req->flowid_len16 =
453 			cpu_to_be32(FW_WR_FLOWID(csk->tid) |
454 					FW_WR_LEN16(credits));
455 	}
456 	if (submode)
457 		wr_ulp_mode = FW_OFLD_TX_DATA_WR_ULPMODE(ULP2_MODE_ISCSI) |
458 				FW_OFLD_TX_DATA_WR_ULPSUBMODE(submode);
459 	req->tunnel_to_proxy = htonl(wr_ulp_mode) |
460 		 FW_OFLD_TX_DATA_WR_SHOVE(skb_peek(&csk->write_queue) ? 0 : 1);
461 	req->plen = htonl(len);
462 	if (!cxgbi_sock_flag(csk, CTPF_TX_DATA_SENT))
463 		cxgbi_sock_set_flag(csk, CTPF_TX_DATA_SENT);
464 }
465 
466 static void arp_failure_skb_discard(void *handle, struct sk_buff *skb)
467 {
468 	kfree_skb(skb);
469 }
470 
471 static int push_tx_frames(struct cxgbi_sock *csk, int req_completion)
472 {
473 	int total_size = 0;
474 	struct sk_buff *skb;
475 
476 	if (unlikely(csk->state < CTP_ESTABLISHED ||
477 		csk->state == CTP_CLOSE_WAIT_1 || csk->state >= CTP_ABORTING)) {
478 		log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK |
479 			 1 << CXGBI_DBG_PDU_TX,
480 			"csk 0x%p,%u,0x%lx,%u, in closing state.\n",
481 			csk, csk->state, csk->flags, csk->tid);
482 		return 0;
483 	}
484 
485 	while (csk->wr_cred && (skb = skb_peek(&csk->write_queue)) != NULL) {
486 		int dlen = skb->len;
487 		int len = skb->len;
488 		unsigned int credits_needed;
489 
490 		skb_reset_transport_header(skb);
491 		if (is_ofld_imm(skb))
492 			credits_needed = DIV_ROUND_UP(dlen +
493 					sizeof(struct fw_ofld_tx_data_wr), 16);
494 		else
495 			credits_needed = DIV_ROUND_UP(8*calc_tx_flits_ofld(skb)
496 					+ sizeof(struct fw_ofld_tx_data_wr),
497 					16);
498 
499 		if (csk->wr_cred < credits_needed) {
500 			log_debug(1 << CXGBI_DBG_PDU_TX,
501 				"csk 0x%p, skb %u/%u, wr %d < %u.\n",
502 				csk, skb->len, skb->data_len,
503 				credits_needed, csk->wr_cred);
504 			break;
505 		}
506 		__skb_unlink(skb, &csk->write_queue);
507 		set_queue(skb, CPL_PRIORITY_DATA, csk);
508 		skb->csum = credits_needed;
509 		csk->wr_cred -= credits_needed;
510 		csk->wr_una_cred += credits_needed;
511 		cxgbi_sock_enqueue_wr(csk, skb);
512 
513 		log_debug(1 << CXGBI_DBG_PDU_TX,
514 			"csk 0x%p, skb %u/%u, wr %d, left %u, unack %u.\n",
515 			csk, skb->len, skb->data_len, credits_needed,
516 			csk->wr_cred, csk->wr_una_cred);
517 
518 		if (likely(cxgbi_skcb_test_flag(skb, SKCBF_TX_NEED_HDR))) {
519 			if (!cxgbi_sock_flag(csk, CTPF_TX_DATA_SENT)) {
520 				send_tx_flowc_wr(csk);
521 				skb->csum += 5;
522 				csk->wr_cred -= 5;
523 				csk->wr_una_cred += 5;
524 			}
525 			len += cxgbi_ulp_extra_len(cxgbi_skcb_ulp_mode(skb));
526 			make_tx_data_wr(csk, skb, dlen, len, credits_needed,
527 					req_completion);
528 			csk->snd_nxt += len;
529 			cxgbi_skcb_clear_flag(skb, SKCBF_TX_NEED_HDR);
530 		}
531 		total_size += skb->truesize;
532 		t4_set_arp_err_handler(skb, csk, arp_failure_skb_discard);
533 
534 		log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_TX,
535 			"csk 0x%p,%u,0x%lx,%u, skb 0x%p, %u.\n",
536 			csk, csk->state, csk->flags, csk->tid, skb, len);
537 
538 		cxgb4_l2t_send(csk->cdev->ports[csk->port_id], skb, csk->l2t);
539 	}
540 	return total_size;
541 }
542 
543 static inline void free_atid(struct cxgbi_sock *csk)
544 {
545 	struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(csk->cdev);
546 
547 	if (cxgbi_sock_flag(csk, CTPF_HAS_ATID)) {
548 		cxgb4_free_atid(lldi->tids, csk->atid);
549 		cxgbi_sock_clear_flag(csk, CTPF_HAS_ATID);
550 		cxgbi_sock_put(csk);
551 	}
552 }
553 
554 static void do_act_establish(struct cxgbi_device *cdev, struct sk_buff *skb)
555 {
556 	struct cxgbi_sock *csk;
557 	struct cpl_act_establish *req = (struct cpl_act_establish *)skb->data;
558 	unsigned short tcp_opt = ntohs(req->tcp_opt);
559 	unsigned int tid = GET_TID(req);
560 	unsigned int atid = GET_TID_TID(ntohl(req->tos_atid));
561 	struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev);
562 	struct tid_info *t = lldi->tids;
563 	u32 rcv_isn = be32_to_cpu(req->rcv_isn);
564 
565 	csk = lookup_atid(t, atid);
566 	if (unlikely(!csk)) {
567 		pr_err("NO conn. for atid %u, cdev 0x%p.\n", atid, cdev);
568 		goto rel_skb;
569 	}
570 
571 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
572 		"csk 0x%p,%u,0x%lx, tid %u, atid %u, rseq %u.\n",
573 		csk, csk->state, csk->flags, tid, atid, rcv_isn);
574 
575 	cxgbi_sock_get(csk);
576 	csk->tid = tid;
577 	cxgb4_insert_tid(lldi->tids, csk, tid);
578 	cxgbi_sock_set_flag(csk, CTPF_HAS_TID);
579 
580 	free_atid(csk);
581 
582 	spin_lock_bh(&csk->lock);
583 	if (unlikely(csk->state != CTP_ACTIVE_OPEN))
584 		pr_info("csk 0x%p,%u,0x%lx,%u, got EST.\n",
585 			csk, csk->state, csk->flags, csk->tid);
586 
587 	if (csk->retry_timer.function) {
588 		del_timer(&csk->retry_timer);
589 		csk->retry_timer.function = NULL;
590 	}
591 
592 	csk->copied_seq = csk->rcv_wup = csk->rcv_nxt = rcv_isn;
593 	/*
594 	 * Causes the first RX_DATA_ACK to supply any Rx credits we couldn't
595 	 * pass through opt0.
596 	 */
597 	if (cxgb4i_rcv_win > (RCV_BUFSIZ_MASK << 10))
598 		csk->rcv_wup -= cxgb4i_rcv_win - (RCV_BUFSIZ_MASK << 10);
599 
600 	csk->advmss = lldi->mtus[GET_TCPOPT_MSS(tcp_opt)] - 40;
601 	if (GET_TCPOPT_TSTAMP(tcp_opt))
602 		csk->advmss -= 12;
603 	if (csk->advmss < 128)
604 		csk->advmss = 128;
605 
606 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
607 		"csk 0x%p, mss_idx %u, advmss %u.\n",
608 			csk, GET_TCPOPT_MSS(tcp_opt), csk->advmss);
609 
610 	cxgbi_sock_established(csk, ntohl(req->snd_isn), ntohs(req->tcp_opt));
611 
612 	if (unlikely(cxgbi_sock_flag(csk, CTPF_ACTIVE_CLOSE_NEEDED)))
613 		send_abort_req(csk);
614 	else {
615 		if (skb_queue_len(&csk->write_queue))
616 			push_tx_frames(csk, 0);
617 		cxgbi_conn_tx_open(csk);
618 	}
619 	spin_unlock_bh(&csk->lock);
620 
621 rel_skb:
622 	__kfree_skb(skb);
623 }
624 
625 static int act_open_rpl_status_to_errno(int status)
626 {
627 	switch (status) {
628 	case CPL_ERR_CONN_RESET:
629 		return -ECONNREFUSED;
630 	case CPL_ERR_ARP_MISS:
631 		return -EHOSTUNREACH;
632 	case CPL_ERR_CONN_TIMEDOUT:
633 		return -ETIMEDOUT;
634 	case CPL_ERR_TCAM_FULL:
635 		return -ENOMEM;
636 	case CPL_ERR_CONN_EXIST:
637 		return -EADDRINUSE;
638 	default:
639 		return -EIO;
640 	}
641 }
642 
643 static void csk_act_open_retry_timer(unsigned long data)
644 {
645 	struct sk_buff *skb;
646 	struct cxgbi_sock *csk = (struct cxgbi_sock *)data;
647 
648 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
649 		"csk 0x%p,%u,0x%lx,%u.\n",
650 		csk, csk->state, csk->flags, csk->tid);
651 
652 	cxgbi_sock_get(csk);
653 	spin_lock_bh(&csk->lock);
654 	skb = alloc_cpl(sizeof(struct cpl_act_open_req), 0, GFP_ATOMIC);
655 	if (!skb)
656 		cxgbi_sock_fail_act_open(csk, -ENOMEM);
657 	else {
658 		skb->sk = (struct sock *)csk;
659 		t4_set_arp_err_handler(skb, csk,
660 					cxgbi_sock_act_open_req_arp_failure);
661 		send_act_open_req(csk, skb, csk->l2t);
662 	}
663 	spin_unlock_bh(&csk->lock);
664 	cxgbi_sock_put(csk);
665 }
666 
667 static void do_act_open_rpl(struct cxgbi_device *cdev, struct sk_buff *skb)
668 {
669 	struct cxgbi_sock *csk;
670 	struct cpl_act_open_rpl *rpl = (struct cpl_act_open_rpl *)skb->data;
671 	unsigned int tid = GET_TID(rpl);
672 	unsigned int atid =
673 		GET_TID_TID(GET_AOPEN_ATID(be32_to_cpu(rpl->atid_status)));
674 	unsigned int status = GET_AOPEN_STATUS(be32_to_cpu(rpl->atid_status));
675 	struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev);
676 	struct tid_info *t = lldi->tids;
677 
678 	csk = lookup_atid(t, atid);
679 	if (unlikely(!csk)) {
680 		pr_err("NO matching conn. atid %u, tid %u.\n", atid, tid);
681 		goto rel_skb;
682 	}
683 
684 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
685 		"csk 0x%p,%u,0x%lx, status %u, atid %u, tid %u.\n",
686 			csk, csk->state, csk->flags, status, atid, tid);
687 
688 	if (status && status != CPL_ERR_TCAM_FULL &&
689 	    status != CPL_ERR_CONN_EXIST &&
690 	    status != CPL_ERR_ARP_MISS)
691 		cxgb4_remove_tid(lldi->tids, csk->port_id, GET_TID(rpl));
692 
693 	cxgbi_sock_get(csk);
694 	spin_lock_bh(&csk->lock);
695 
696 	if (status == CPL_ERR_CONN_EXIST &&
697 	    csk->retry_timer.function != csk_act_open_retry_timer) {
698 		csk->retry_timer.function = csk_act_open_retry_timer;
699 		mod_timer(&csk->retry_timer, jiffies + HZ / 2);
700 	} else
701 		cxgbi_sock_fail_act_open(csk,
702 					act_open_rpl_status_to_errno(status));
703 
704 	spin_unlock_bh(&csk->lock);
705 	cxgbi_sock_put(csk);
706 rel_skb:
707 	__kfree_skb(skb);
708 }
709 
710 static void do_peer_close(struct cxgbi_device *cdev, struct sk_buff *skb)
711 {
712 	struct cxgbi_sock *csk;
713 	struct cpl_peer_close *req = (struct cpl_peer_close *)skb->data;
714 	unsigned int tid = GET_TID(req);
715 	struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev);
716 	struct tid_info *t = lldi->tids;
717 
718 	csk = lookup_tid(t, tid);
719 	if (unlikely(!csk)) {
720 		pr_err("can't find connection for tid %u.\n", tid);
721 		goto rel_skb;
722 	}
723 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
724 		"csk 0x%p,%u,0x%lx,%u.\n",
725 		csk, csk->state, csk->flags, csk->tid);
726 	cxgbi_sock_rcv_peer_close(csk);
727 rel_skb:
728 	__kfree_skb(skb);
729 }
730 
731 static void do_close_con_rpl(struct cxgbi_device *cdev, struct sk_buff *skb)
732 {
733 	struct cxgbi_sock *csk;
734 	struct cpl_close_con_rpl *rpl = (struct cpl_close_con_rpl *)skb->data;
735 	unsigned int tid = GET_TID(rpl);
736 	struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev);
737 	struct tid_info *t = lldi->tids;
738 
739 	csk = lookup_tid(t, tid);
740 	if (unlikely(!csk)) {
741 		pr_err("can't find connection for tid %u.\n", tid);
742 		goto rel_skb;
743 	}
744 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
745 		"csk 0x%p,%u,0x%lx,%u.\n",
746 		csk, csk->state, csk->flags, csk->tid);
747 	cxgbi_sock_rcv_close_conn_rpl(csk, ntohl(rpl->snd_nxt));
748 rel_skb:
749 	__kfree_skb(skb);
750 }
751 
752 static int abort_status_to_errno(struct cxgbi_sock *csk, int abort_reason,
753 								int *need_rst)
754 {
755 	switch (abort_reason) {
756 	case CPL_ERR_BAD_SYN: /* fall through */
757 	case CPL_ERR_CONN_RESET:
758 		return csk->state > CTP_ESTABLISHED ?
759 			-EPIPE : -ECONNRESET;
760 	case CPL_ERR_XMIT_TIMEDOUT:
761 	case CPL_ERR_PERSIST_TIMEDOUT:
762 	case CPL_ERR_FINWAIT2_TIMEDOUT:
763 	case CPL_ERR_KEEPALIVE_TIMEDOUT:
764 		return -ETIMEDOUT;
765 	default:
766 		return -EIO;
767 	}
768 }
769 
770 static void do_abort_req_rss(struct cxgbi_device *cdev, struct sk_buff *skb)
771 {
772 	struct cxgbi_sock *csk;
773 	struct cpl_abort_req_rss *req = (struct cpl_abort_req_rss *)skb->data;
774 	unsigned int tid = GET_TID(req);
775 	struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev);
776 	struct tid_info *t = lldi->tids;
777 	int rst_status = CPL_ABORT_NO_RST;
778 
779 	csk = lookup_tid(t, tid);
780 	if (unlikely(!csk)) {
781 		pr_err("can't find connection for tid %u.\n", tid);
782 		goto rel_skb;
783 	}
784 
785 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
786 		"csk 0x%p,%u,0x%lx, tid %u, status 0x%x.\n",
787 		csk, csk->state, csk->flags, csk->tid, req->status);
788 
789 	if (req->status == CPL_ERR_RTX_NEG_ADVICE ||
790 	    req->status == CPL_ERR_PERSIST_NEG_ADVICE)
791 		goto rel_skb;
792 
793 	cxgbi_sock_get(csk);
794 	spin_lock_bh(&csk->lock);
795 
796 	if (!cxgbi_sock_flag(csk, CTPF_ABORT_REQ_RCVD)) {
797 		cxgbi_sock_set_flag(csk, CTPF_ABORT_REQ_RCVD);
798 		cxgbi_sock_set_state(csk, CTP_ABORTING);
799 		goto done;
800 	}
801 
802 	cxgbi_sock_clear_flag(csk, CTPF_ABORT_REQ_RCVD);
803 	send_abort_rpl(csk, rst_status);
804 
805 	if (!cxgbi_sock_flag(csk, CTPF_ABORT_RPL_PENDING)) {
806 		csk->err = abort_status_to_errno(csk, req->status, &rst_status);
807 		cxgbi_sock_closed(csk);
808 	}
809 done:
810 	spin_unlock_bh(&csk->lock);
811 	cxgbi_sock_put(csk);
812 rel_skb:
813 	__kfree_skb(skb);
814 }
815 
816 static void do_abort_rpl_rss(struct cxgbi_device *cdev, struct sk_buff *skb)
817 {
818 	struct cxgbi_sock *csk;
819 	struct cpl_abort_rpl_rss *rpl = (struct cpl_abort_rpl_rss *)skb->data;
820 	unsigned int tid = GET_TID(rpl);
821 	struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev);
822 	struct tid_info *t = lldi->tids;
823 
824 	csk = lookup_tid(t, tid);
825 	if (!csk)
826 		goto rel_skb;
827 
828 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
829 		"status 0x%x, csk 0x%p, s %u, 0x%lx.\n",
830 		rpl->status, csk, csk ? csk->state : 0,
831 		csk ? csk->flags : 0UL);
832 
833 	if (rpl->status == CPL_ERR_ABORT_FAILED)
834 		goto rel_skb;
835 
836 	cxgbi_sock_rcv_abort_rpl(csk);
837 rel_skb:
838 	__kfree_skb(skb);
839 }
840 
841 static void do_rx_iscsi_hdr(struct cxgbi_device *cdev, struct sk_buff *skb)
842 {
843 	struct cxgbi_sock *csk;
844 	struct cpl_iscsi_hdr *cpl = (struct cpl_iscsi_hdr *)skb->data;
845 	unsigned short pdu_len_ddp = be16_to_cpu(cpl->pdu_len_ddp);
846 	unsigned int tid = GET_TID(cpl);
847 	struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev);
848 	struct tid_info *t = lldi->tids;
849 	struct sk_buff *lskb;
850 
851 	csk = lookup_tid(t, tid);
852 	if (unlikely(!csk)) {
853 		pr_err("can't find conn. for tid %u.\n", tid);
854 		goto rel_skb;
855 	}
856 
857 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX,
858 		"csk 0x%p,%u,0x%lx, tid %u, skb 0x%p,%u, 0x%x.\n",
859 		csk, csk->state, csk->flags, csk->tid, skb, skb->len,
860 		pdu_len_ddp);
861 
862 	spin_lock_bh(&csk->lock);
863 
864 	if (unlikely(csk->state >= CTP_PASSIVE_CLOSE)) {
865 		log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
866 			"csk 0x%p,%u,0x%lx,%u, bad state.\n",
867 			csk, csk->state, csk->flags, csk->tid);
868 		if (csk->state != CTP_ABORTING)
869 			goto abort_conn;
870 		else
871 			goto discard;
872 	}
873 
874 	cxgbi_skcb_tcp_seq(skb) = ntohl(cpl->seq);
875 	skb_reset_transport_header(skb);
876 	__skb_pull(skb, sizeof(*cpl));
877 	__pskb_trim(skb, ntohs(cpl->len));
878 
879 	if (!csk->skb_ulp_lhdr) {
880 		unsigned char *bhs;
881 		unsigned int hlen, dlen;
882 
883 		log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX,
884 			"csk 0x%p,%u,0x%lx, tid %u, skb 0x%p header.\n",
885 			csk, csk->state, csk->flags, csk->tid, skb);
886 		csk->skb_ulp_lhdr = skb;
887 		lskb = csk->skb_ulp_lhdr;
888 		cxgbi_skcb_set_flag(lskb, SKCBF_RX_HDR);
889 
890 		if (cxgbi_skcb_tcp_seq(lskb) != csk->rcv_nxt) {
891 			pr_info("tid %u, CPL_ISCSI_HDR, bad seq, 0x%x/0x%x.\n",
892 				csk->tid, cxgbi_skcb_tcp_seq(lskb),
893 				csk->rcv_nxt);
894 			goto abort_conn;
895 		}
896 
897 		bhs = lskb->data;
898 		hlen = ntohs(cpl->len);
899 		dlen = ntohl(*(unsigned int *)(bhs + 4)) & 0xFFFFFF;
900 
901 		if ((hlen + dlen) != ISCSI_PDU_LEN(pdu_len_ddp) - 40) {
902 			pr_info("tid 0x%x, CPL_ISCSI_HDR, pdu len "
903 				"mismatch %u != %u + %u, seq 0x%x.\n",
904 				csk->tid, ISCSI_PDU_LEN(pdu_len_ddp) - 40,
905 				hlen, dlen, cxgbi_skcb_tcp_seq(skb));
906 			goto abort_conn;
907 		}
908 
909 		cxgbi_skcb_rx_pdulen(skb) = (hlen + dlen + 3) & (~0x3);
910 		if (dlen)
911 			cxgbi_skcb_rx_pdulen(skb) += csk->dcrc_len;
912 		csk->rcv_nxt += cxgbi_skcb_rx_pdulen(skb);
913 
914 		log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX,
915 			"csk 0x%p, skb 0x%p, 0x%x,%u+%u,0x%x,0x%x.\n",
916 			csk, skb, *bhs, hlen, dlen,
917 			ntohl(*((unsigned int *)(bhs + 16))),
918 			ntohl(*((unsigned int *)(bhs + 24))));
919 
920 	} else {
921 		lskb = csk->skb_ulp_lhdr;
922 		cxgbi_skcb_set_flag(lskb, SKCBF_RX_DATA);
923 
924 		log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX,
925 			"csk 0x%p,%u,0x%lx, skb 0x%p data, 0x%p.\n",
926 			csk, csk->state, csk->flags, skb, lskb);
927 	}
928 
929 	__skb_queue_tail(&csk->receive_queue, skb);
930 	spin_unlock_bh(&csk->lock);
931 	return;
932 
933 abort_conn:
934 	send_abort_req(csk);
935 discard:
936 	spin_unlock_bh(&csk->lock);
937 rel_skb:
938 	__kfree_skb(skb);
939 }
940 
941 static void do_rx_data_ddp(struct cxgbi_device *cdev,
942 				  struct sk_buff *skb)
943 {
944 	struct cxgbi_sock *csk;
945 	struct sk_buff *lskb;
946 	struct cpl_rx_data_ddp *rpl = (struct cpl_rx_data_ddp *)skb->data;
947 	unsigned int tid = GET_TID(rpl);
948 	struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev);
949 	struct tid_info *t = lldi->tids;
950 	unsigned int status = ntohl(rpl->ddpvld);
951 
952 	csk = lookup_tid(t, tid);
953 	if (unlikely(!csk)) {
954 		pr_err("can't find connection for tid %u.\n", tid);
955 		goto rel_skb;
956 	}
957 
958 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX,
959 		"csk 0x%p,%u,0x%lx, skb 0x%p,0x%x, lhdr 0x%p.\n",
960 		csk, csk->state, csk->flags, skb, status, csk->skb_ulp_lhdr);
961 
962 	spin_lock_bh(&csk->lock);
963 
964 	if (unlikely(csk->state >= CTP_PASSIVE_CLOSE)) {
965 		log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
966 			"csk 0x%p,%u,0x%lx,%u, bad state.\n",
967 			csk, csk->state, csk->flags, csk->tid);
968 		if (csk->state != CTP_ABORTING)
969 			goto abort_conn;
970 		else
971 			goto discard;
972 	}
973 
974 	if (!csk->skb_ulp_lhdr) {
975 		pr_err("tid 0x%x, rcv RX_DATA_DDP w/o pdu bhs.\n", csk->tid);
976 		goto abort_conn;
977 	}
978 
979 	lskb = csk->skb_ulp_lhdr;
980 	csk->skb_ulp_lhdr = NULL;
981 
982 	cxgbi_skcb_set_flag(lskb, SKCBF_RX_STATUS);
983 	cxgbi_skcb_rx_ddigest(lskb) = ntohl(rpl->ulp_crc);
984 
985 	if (ntohs(rpl->len) != cxgbi_skcb_rx_pdulen(lskb))
986 		pr_info("tid 0x%x, RX_DATA_DDP pdulen %u != %u.\n",
987 			csk->tid, ntohs(rpl->len), cxgbi_skcb_rx_pdulen(lskb));
988 
989 	if (status & (1 << CPL_RX_DDP_STATUS_HCRC_SHIFT)) {
990 		log_debug(1 << CXGBI_DBG_PDU_RX,
991 			"csk 0x%p, lhdr 0x%p, status 0x%x, hcrc bad.\n",
992 			csk, lskb, status);
993 		cxgbi_skcb_set_flag(lskb, SKCBF_RX_HCRC_ERR);
994 	}
995 	if (status & (1 << CPL_RX_DDP_STATUS_DCRC_SHIFT)) {
996 		log_debug(1 << CXGBI_DBG_PDU_RX,
997 			"csk 0x%p, lhdr 0x%p, status 0x%x, dcrc bad.\n",
998 			csk, lskb, status);
999 		cxgbi_skcb_set_flag(lskb, SKCBF_RX_DCRC_ERR);
1000 	}
1001 	if (status & (1 << CPL_RX_DDP_STATUS_PAD_SHIFT)) {
1002 		log_debug(1 << CXGBI_DBG_PDU_RX,
1003 			"csk 0x%p, lhdr 0x%p, status 0x%x, pad bad.\n",
1004 			csk, lskb, status);
1005 		cxgbi_skcb_set_flag(lskb, SKCBF_RX_PAD_ERR);
1006 	}
1007 	if ((status & (1 << CPL_RX_DDP_STATUS_DDP_SHIFT)) &&
1008 		!cxgbi_skcb_test_flag(lskb, SKCBF_RX_DATA)) {
1009 		log_debug(1 << CXGBI_DBG_PDU_RX,
1010 			"csk 0x%p, lhdr 0x%p, 0x%x, data ddp'ed.\n",
1011 			csk, lskb, status);
1012 		cxgbi_skcb_set_flag(lskb, SKCBF_RX_DATA_DDPD);
1013 	}
1014 	log_debug(1 << CXGBI_DBG_PDU_RX,
1015 		"csk 0x%p, lskb 0x%p, f 0x%lx.\n",
1016 		csk, lskb, cxgbi_skcb_flags(lskb));
1017 
1018 	cxgbi_conn_pdu_ready(csk);
1019 	spin_unlock_bh(&csk->lock);
1020 	goto rel_skb;
1021 
1022 abort_conn:
1023 	send_abort_req(csk);
1024 discard:
1025 	spin_unlock_bh(&csk->lock);
1026 rel_skb:
1027 	__kfree_skb(skb);
1028 }
1029 
1030 static void do_fw4_ack(struct cxgbi_device *cdev, struct sk_buff *skb)
1031 {
1032 	struct cxgbi_sock *csk;
1033 	struct cpl_fw4_ack *rpl = (struct cpl_fw4_ack *)skb->data;
1034 	unsigned int tid = GET_TID(rpl);
1035 	struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev);
1036 	struct tid_info *t = lldi->tids;
1037 
1038 	csk = lookup_tid(t, tid);
1039 	if (unlikely(!csk))
1040 		pr_err("can't find connection for tid %u.\n", tid);
1041 	else {
1042 		log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
1043 			"csk 0x%p,%u,0x%lx,%u.\n",
1044 			csk, csk->state, csk->flags, csk->tid);
1045 		cxgbi_sock_rcv_wr_ack(csk, rpl->credits, ntohl(rpl->snd_una),
1046 					rpl->seq_vld);
1047 	}
1048 	__kfree_skb(skb);
1049 }
1050 
1051 static void do_set_tcb_rpl(struct cxgbi_device *cdev, struct sk_buff *skb)
1052 {
1053 	struct cpl_set_tcb_rpl *rpl = (struct cpl_set_tcb_rpl *)skb->data;
1054 	unsigned int tid = GET_TID(rpl);
1055 	struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev);
1056 	struct tid_info *t = lldi->tids;
1057 	struct cxgbi_sock *csk;
1058 
1059 	csk = lookup_tid(t, tid);
1060 	if (!csk)
1061 		pr_err("can't find conn. for tid %u.\n", tid);
1062 
1063 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
1064 		"csk 0x%p,%u,%lx,%u, status 0x%x.\n",
1065 		csk, csk->state, csk->flags, csk->tid, rpl->status);
1066 
1067 	if (rpl->status != CPL_ERR_NONE)
1068 		pr_err("csk 0x%p,%u, SET_TCB_RPL status %u.\n",
1069 			csk, tid, rpl->status);
1070 
1071 	__kfree_skb(skb);
1072 }
1073 
1074 static int alloc_cpls(struct cxgbi_sock *csk)
1075 {
1076 	csk->cpl_close = alloc_cpl(sizeof(struct cpl_close_con_req),
1077 					0, GFP_NOIO);
1078 	if (!csk->cpl_close)
1079 		return -ENOMEM;
1080 
1081 	csk->cpl_abort_req = alloc_cpl(sizeof(struct cpl_abort_req),
1082 					0, GFP_NOIO);
1083 	if (!csk->cpl_abort_req)
1084 		goto free_cpls;
1085 
1086 	csk->cpl_abort_rpl = alloc_cpl(sizeof(struct cpl_abort_rpl),
1087 					0, GFP_NOIO);
1088 	if (!csk->cpl_abort_rpl)
1089 		goto free_cpls;
1090 	return 0;
1091 
1092 free_cpls:
1093 	cxgbi_sock_free_cpl_skbs(csk);
1094 	return -ENOMEM;
1095 }
1096 
1097 static inline void l2t_put(struct cxgbi_sock *csk)
1098 {
1099 	if (csk->l2t) {
1100 		cxgb4_l2t_release(csk->l2t);
1101 		csk->l2t = NULL;
1102 		cxgbi_sock_put(csk);
1103 	}
1104 }
1105 
1106 static void release_offload_resources(struct cxgbi_sock *csk)
1107 {
1108 	struct cxgb4_lld_info *lldi;
1109 
1110 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
1111 		"csk 0x%p,%u,0x%lx,%u.\n",
1112 		csk, csk->state, csk->flags, csk->tid);
1113 
1114 	cxgbi_sock_free_cpl_skbs(csk);
1115 	if (csk->wr_cred != csk->wr_max_cred) {
1116 		cxgbi_sock_purge_wr_queue(csk);
1117 		cxgbi_sock_reset_wr_list(csk);
1118 	}
1119 
1120 	l2t_put(csk);
1121 	if (cxgbi_sock_flag(csk, CTPF_HAS_ATID))
1122 		free_atid(csk);
1123 	else if (cxgbi_sock_flag(csk, CTPF_HAS_TID)) {
1124 		lldi = cxgbi_cdev_priv(csk->cdev);
1125 		cxgb4_remove_tid(lldi->tids, 0, csk->tid);
1126 		cxgbi_sock_clear_flag(csk, CTPF_HAS_TID);
1127 		cxgbi_sock_put(csk);
1128 	}
1129 	csk->dst = NULL;
1130 	csk->cdev = NULL;
1131 }
1132 
1133 static int init_act_open(struct cxgbi_sock *csk)
1134 {
1135 	struct cxgbi_device *cdev = csk->cdev;
1136 	struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev);
1137 	struct net_device *ndev = cdev->ports[csk->port_id];
1138 	struct port_info *pi = netdev_priv(ndev);
1139 	struct sk_buff *skb = NULL;
1140 	unsigned int step;
1141 
1142 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
1143 		"csk 0x%p,%u,0x%lx,%u.\n",
1144 		csk, csk->state, csk->flags, csk->tid);
1145 
1146 	csk->atid = cxgb4_alloc_atid(lldi->tids, csk);
1147 	if (csk->atid < 0) {
1148 		pr_err("%s, NO atid available.\n", ndev->name);
1149 		return -EINVAL;
1150 	}
1151 	cxgbi_sock_set_flag(csk, CTPF_HAS_ATID);
1152 	cxgbi_sock_get(csk);
1153 
1154 	csk->l2t = cxgb4_l2t_get(lldi->l2t, csk->dst->neighbour, ndev, 0);
1155 	if (!csk->l2t) {
1156 		pr_err("%s, cannot alloc l2t.\n", ndev->name);
1157 		goto rel_resource;
1158 	}
1159 	cxgbi_sock_get(csk);
1160 
1161 	skb = alloc_cpl(sizeof(struct cpl_act_open_req), 0, GFP_NOIO);
1162 	if (!skb)
1163 		goto rel_resource;
1164 	skb->sk = (struct sock *)csk;
1165 	t4_set_arp_err_handler(skb, csk, cxgbi_sock_act_open_req_arp_failure);
1166 
1167 	if (!csk->mtu)
1168 		csk->mtu = dst_mtu(csk->dst);
1169 	cxgb4_best_mtu(lldi->mtus, csk->mtu, &csk->mss_idx);
1170 	csk->tx_chan = cxgb4_port_chan(ndev);
1171 	/* SMT two entries per row */
1172 	csk->smac_idx = ((cxgb4_port_viid(ndev) & 0x7F)) << 1;
1173 	step = lldi->ntxq / lldi->nchan;
1174 	csk->txq_idx = cxgb4_port_idx(ndev) * step;
1175 	step = lldi->nrxq / lldi->nchan;
1176 	csk->rss_qid = lldi->rxq_ids[cxgb4_port_idx(ndev) * step];
1177 	csk->wr_max_cred = csk->wr_cred = lldi->wr_cred;
1178 	csk->wr_una_cred = 0;
1179 	cxgbi_sock_reset_wr_list(csk);
1180 	csk->err = 0;
1181 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
1182 		"csk 0x%p,p%d,%s, %u,%u,%u, mss %u,%u, smac %u.\n",
1183 		csk, pi->port_id, ndev->name, csk->tx_chan,
1184 		csk->txq_idx, csk->rss_qid, csk->mtu, csk->mss_idx,
1185 		csk->smac_idx);
1186 
1187 	cxgbi_sock_set_state(csk, CTP_ACTIVE_OPEN);
1188 	send_act_open_req(csk, skb, csk->l2t);
1189 	return 0;
1190 
1191 rel_resource:
1192 	if (skb)
1193 		__kfree_skb(skb);
1194 	return -EINVAL;
1195 }
1196 
1197 cxgb4i_cplhandler_func cxgb4i_cplhandlers[NUM_CPL_CMDS] = {
1198 	[CPL_ACT_ESTABLISH] = do_act_establish,
1199 	[CPL_ACT_OPEN_RPL] = do_act_open_rpl,
1200 	[CPL_PEER_CLOSE] = do_peer_close,
1201 	[CPL_ABORT_REQ_RSS] = do_abort_req_rss,
1202 	[CPL_ABORT_RPL_RSS] = do_abort_rpl_rss,
1203 	[CPL_CLOSE_CON_RPL] = do_close_con_rpl,
1204 	[CPL_FW4_ACK] = do_fw4_ack,
1205 	[CPL_ISCSI_HDR] = do_rx_iscsi_hdr,
1206 	[CPL_SET_TCB_RPL] = do_set_tcb_rpl,
1207 	[CPL_RX_DATA_DDP] = do_rx_data_ddp,
1208 };
1209 
1210 int cxgb4i_ofld_init(struct cxgbi_device *cdev)
1211 {
1212 	int rc;
1213 
1214 	if (cxgb4i_max_connect > CXGB4I_MAX_CONN)
1215 		cxgb4i_max_connect = CXGB4I_MAX_CONN;
1216 
1217 	rc = cxgbi_device_portmap_create(cdev, cxgb4i_sport_base,
1218 					cxgb4i_max_connect);
1219 	if (rc < 0)
1220 		return rc;
1221 
1222 	cdev->csk_release_offload_resources = release_offload_resources;
1223 	cdev->csk_push_tx_frames = push_tx_frames;
1224 	cdev->csk_send_abort_req = send_abort_req;
1225 	cdev->csk_send_close_req = send_close_req;
1226 	cdev->csk_send_rx_credits = send_rx_credits;
1227 	cdev->csk_alloc_cpls = alloc_cpls;
1228 	cdev->csk_init_act_open = init_act_open;
1229 
1230 	pr_info("cdev 0x%p, offload up, added.\n", cdev);
1231 	return 0;
1232 }
1233 
1234 /*
1235  * functions to program the pagepod in h/w
1236  */
1237 static inline void ulp_mem_io_set_hdr(struct ulp_mem_io *req,
1238 				unsigned int dlen, unsigned int pm_addr)
1239 {
1240 	struct ulptx_sgl *sgl;
1241 	unsigned int wr_len = roundup(sizeof(struct ulp_mem_io) +
1242 					sizeof(struct ulptx_sgl), 16);
1243 
1244 	INIT_ULPTX_WR(req, wr_len, 0, 0);
1245 	req->cmd = htonl(ULPTX_CMD(ULP_TX_MEM_WRITE));
1246 	req->dlen = htonl(ULP_MEMIO_DATA_LEN(dlen >> 5));
1247 	req->lock_addr = htonl(ULP_MEMIO_ADDR(pm_addr >> 5));
1248 	req->len16 = htonl(DIV_ROUND_UP(wr_len - sizeof(req->wr), 16));
1249 	sgl = (struct ulptx_sgl *)(req + 1);
1250 	sgl->cmd_nsge = htonl(ULPTX_CMD(ULP_TX_SC_DSGL) | ULPTX_NSGE(1));
1251 	sgl->len0 = htonl(dlen);
1252 }
1253 
1254 static int ddp_ppod_write_sgl(struct cxgbi_device *cdev, unsigned int port_id,
1255 				struct cxgbi_pagepod_hdr *hdr, unsigned int idx,
1256 				unsigned int npods,
1257 				struct cxgbi_gather_list *gl,
1258 				unsigned int gl_pidx)
1259 {
1260 	struct cxgbi_ddp_info *ddp = cdev->ddp;
1261 	unsigned int dlen, pm_addr;
1262 	struct sk_buff *skb;
1263 	struct ulp_mem_io *req;
1264 	struct ulptx_sgl *sgl;
1265 	struct cxgbi_pagepod *ppod;
1266 	unsigned int i;
1267 
1268 	dlen = PPOD_SIZE * npods;
1269 	pm_addr = idx * PPOD_SIZE + ddp->llimit;
1270 
1271 	skb = alloc_cpl(sizeof(*req) + sizeof(*sgl), dlen, GFP_ATOMIC);
1272 	if (!skb) {
1273 		pr_err("cdev 0x%p, idx %u, npods %u, OOM.\n",
1274 			cdev, idx, npods);
1275 		return -ENOMEM;
1276 	}
1277 	req = (struct ulp_mem_io *)skb->head;
1278 	set_queue(skb, CPL_PRIORITY_CONTROL, NULL);
1279 
1280 	ulp_mem_io_set_hdr(req, dlen, pm_addr);
1281 	sgl = (struct ulptx_sgl *)(req + 1);
1282 	ppod = (struct cxgbi_pagepod *)(sgl + 1);
1283 	sgl->addr0 = cpu_to_be64(virt_to_phys(ppod));
1284 
1285 	for (i = 0; i < npods; i++, ppod++, gl_pidx += PPOD_PAGES_MAX) {
1286 		if (!hdr && !gl)
1287 			cxgbi_ddp_ppod_clear(ppod);
1288 		else
1289 			cxgbi_ddp_ppod_set(ppod, hdr, gl, gl_pidx);
1290 	}
1291 
1292 	cxgb4_ofld_send(cdev->ports[port_id], skb);
1293 	return 0;
1294 }
1295 
1296 static int ddp_set_map(struct cxgbi_sock *csk, struct cxgbi_pagepod_hdr *hdr,
1297 			unsigned int idx, unsigned int npods,
1298 			struct cxgbi_gather_list *gl)
1299 {
1300 	unsigned int i, cnt;
1301 	int err = 0;
1302 
1303 	for (i = 0; i < npods; i += cnt, idx += cnt) {
1304 		cnt = npods - i;
1305 		if (cnt > ULPMEM_DSGL_MAX_NPPODS)
1306 			cnt = ULPMEM_DSGL_MAX_NPPODS;
1307 		err = ddp_ppod_write_sgl(csk->cdev, csk->port_id, hdr,
1308 					idx, cnt, gl, 4 * i);
1309 		if (err < 0)
1310 			break;
1311 	}
1312 	return err;
1313 }
1314 
1315 static void ddp_clear_map(struct cxgbi_hba *chba, unsigned int tag,
1316 			  unsigned int idx, unsigned int npods)
1317 {
1318 	unsigned int i, cnt;
1319 	int err;
1320 
1321 	for (i = 0; i < npods; i += cnt, idx += cnt) {
1322 		cnt = npods - i;
1323 		if (cnt > ULPMEM_DSGL_MAX_NPPODS)
1324 			cnt = ULPMEM_DSGL_MAX_NPPODS;
1325 		err = ddp_ppod_write_sgl(chba->cdev, chba->port_id, NULL,
1326 					idx, cnt, NULL, 0);
1327 		if (err < 0)
1328 			break;
1329 	}
1330 }
1331 
1332 static int ddp_setup_conn_pgidx(struct cxgbi_sock *csk, unsigned int tid,
1333 				int pg_idx, bool reply)
1334 {
1335 	struct sk_buff *skb;
1336 	struct cpl_set_tcb_field *req;
1337 	u64 val = pg_idx < DDP_PGIDX_MAX ? pg_idx : 0;
1338 
1339 	if (!pg_idx)
1340 		return 0;
1341 
1342 	skb = alloc_cpl(sizeof(*req), 0, GFP_KERNEL);
1343 	if (!skb)
1344 		return -ENOMEM;
1345 
1346 	/*  set up ulp submode and page size */
1347 	val = (val & 0x03) << 2;
1348 	val |= TCB_ULP_TYPE(ULP2_MODE_ISCSI);
1349 
1350 	req = (struct cpl_set_tcb_field *)skb->head;
1351 	INIT_TP_WR(req, csk->tid);
1352 	OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_SET_TCB_FIELD, csk->tid));
1353 	req->reply_ctrl = htons(NO_REPLY(reply) | QUEUENO(csk->rss_qid));
1354 	req->word_cookie = htons(TCB_WORD(W_TCB_ULP_RAW));
1355 	req->mask = cpu_to_be64(TCB_ULP_TYPE(TCB_ULP_TYPE_MASK));
1356 	req->val = cpu_to_be64(val);
1357 	set_wr_txq(skb, CPL_PRIORITY_CONTROL, csk->port_id);
1358 
1359 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
1360 		"csk 0x%p, tid 0x%x, pg_idx %u.\n", csk, csk->tid, pg_idx);
1361 
1362 	cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb);
1363 	return 0;
1364 }
1365 
1366 static int ddp_setup_conn_digest(struct cxgbi_sock *csk, unsigned int tid,
1367 				 int hcrc, int dcrc, int reply)
1368 {
1369 	struct sk_buff *skb;
1370 	struct cpl_set_tcb_field *req;
1371 	u64 val = (hcrc ? ULP_CRC_HEADER : 0) | (dcrc ? ULP_CRC_DATA : 0);
1372 
1373 	val = TCB_ULP_RAW(val);
1374 	val |= TCB_ULP_TYPE(ULP2_MODE_ISCSI);
1375 
1376 	skb = alloc_cpl(sizeof(*req), 0, GFP_KERNEL);
1377 	if (!skb)
1378 		return -ENOMEM;
1379 
1380 	csk->hcrc_len = (hcrc ? 4 : 0);
1381 	csk->dcrc_len = (dcrc ? 4 : 0);
1382 	/*  set up ulp submode and page size */
1383 	req = (struct cpl_set_tcb_field *)skb->head;
1384 	INIT_TP_WR(req, tid);
1385 	OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_SET_TCB_FIELD, tid));
1386 	req->reply_ctrl = htons(NO_REPLY(reply) | QUEUENO(csk->rss_qid));
1387 	req->word_cookie = htons(TCB_WORD(W_TCB_ULP_RAW));
1388 	req->mask = cpu_to_be64(TCB_ULP_RAW(TCB_ULP_RAW_MASK));
1389 	req->val = cpu_to_be64(val);
1390 	set_wr_txq(skb, CPL_PRIORITY_CONTROL, csk->port_id);
1391 
1392 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
1393 		"csk 0x%p, tid 0x%x, crc %d,%d.\n", csk, csk->tid, hcrc, dcrc);
1394 
1395 	cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb);
1396 	return 0;
1397 }
1398 
1399 static int cxgb4i_ddp_init(struct cxgbi_device *cdev)
1400 {
1401 	struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev);
1402 	struct cxgbi_ddp_info *ddp = cdev->ddp;
1403 	unsigned int tagmask, pgsz_factor[4];
1404 	int err;
1405 
1406 	if (ddp) {
1407 		kref_get(&ddp->refcnt);
1408 		pr_warn("cdev 0x%p, ddp 0x%p already set up.\n",
1409 			cdev, cdev->ddp);
1410 		return -EALREADY;
1411 	}
1412 
1413 	err = cxgbi_ddp_init(cdev, lldi->vr->iscsi.start,
1414 			lldi->vr->iscsi.start + lldi->vr->iscsi.size - 1,
1415 			lldi->iscsi_iolen, lldi->iscsi_iolen);
1416 	if (err < 0)
1417 		return err;
1418 
1419 	ddp = cdev->ddp;
1420 
1421 	tagmask = ddp->idx_mask << PPOD_IDX_SHIFT;
1422 	cxgbi_ddp_page_size_factor(pgsz_factor);
1423 	cxgb4_iscsi_init(lldi->ports[0], tagmask, pgsz_factor);
1424 
1425 	cdev->csk_ddp_free_gl_skb = NULL;
1426 	cdev->csk_ddp_alloc_gl_skb = NULL;
1427 	cdev->csk_ddp_setup_digest = ddp_setup_conn_digest;
1428 	cdev->csk_ddp_setup_pgidx = ddp_setup_conn_pgidx;
1429 	cdev->csk_ddp_set = ddp_set_map;
1430 	cdev->csk_ddp_clear = ddp_clear_map;
1431 
1432 	pr_info("cxgb4i 0x%p tag: sw %u, rsvd %u,%u, mask 0x%x.\n",
1433 		cdev, cdev->tag_format.sw_bits, cdev->tag_format.rsvd_bits,
1434 		cdev->tag_format.rsvd_shift, cdev->tag_format.rsvd_mask);
1435 	pr_info("cxgb4i 0x%p, nppods %u, bits %u, mask 0x%x,0x%x pkt %u/%u, "
1436 		" %u/%u.\n",
1437 		cdev, ddp->nppods, ddp->idx_bits, ddp->idx_mask,
1438 		ddp->rsvd_tag_mask, ddp->max_txsz, lldi->iscsi_iolen,
1439 		ddp->max_rxsz, lldi->iscsi_iolen);
1440 	pr_info("cxgb4i 0x%p max payload size: %u/%u, %u/%u.\n",
1441 		cdev, cdev->tx_max_size, ddp->max_txsz, cdev->rx_max_size,
1442 		ddp->max_rxsz);
1443 	return 0;
1444 }
1445 
1446 static void *t4_uld_add(const struct cxgb4_lld_info *lldi)
1447 {
1448 	struct cxgbi_device *cdev;
1449 	struct port_info *pi;
1450 	int i, rc;
1451 
1452 	cdev = cxgbi_device_register(sizeof(*lldi), lldi->nports);
1453 	if (!cdev) {
1454 		pr_info("t4 device 0x%p, register failed.\n", lldi);
1455 		return NULL;
1456 	}
1457 	pr_info("0x%p,0x%x, ports %u,%s, chan %u, q %u,%u, wr %u.\n",
1458 		cdev, lldi->adapter_type, lldi->nports,
1459 		lldi->ports[0]->name, lldi->nchan, lldi->ntxq,
1460 		lldi->nrxq, lldi->wr_cred);
1461 	for (i = 0; i < lldi->nrxq; i++)
1462 		log_debug(1 << CXGBI_DBG_DEV,
1463 			"t4 0x%p, rxq id #%d: %u.\n",
1464 			cdev, i, lldi->rxq_ids[i]);
1465 
1466 	memcpy(cxgbi_cdev_priv(cdev), lldi, sizeof(*lldi));
1467 	cdev->flags = CXGBI_FLAG_DEV_T4;
1468 	cdev->pdev = lldi->pdev;
1469 	cdev->ports = lldi->ports;
1470 	cdev->nports = lldi->nports;
1471 	cdev->mtus = lldi->mtus;
1472 	cdev->nmtus = NMTUS;
1473 	cdev->snd_win = cxgb4i_snd_win;
1474 	cdev->rcv_win = cxgb4i_rcv_win;
1475 	cdev->rx_credit_thres = cxgb4i_rx_credit_thres;
1476 	cdev->skb_tx_rsvd = CXGB4I_TX_HEADER_LEN;
1477 	cdev->skb_rx_extra = sizeof(struct cpl_iscsi_hdr);
1478 	cdev->itp = &cxgb4i_iscsi_transport;
1479 
1480 	rc = cxgb4i_ddp_init(cdev);
1481 	if (rc) {
1482 		pr_info("t4 0x%p ddp init failed.\n", cdev);
1483 		goto err_out;
1484 	}
1485 	rc = cxgb4i_ofld_init(cdev);
1486 	if (rc) {
1487 		pr_info("t4 0x%p ofld init failed.\n", cdev);
1488 		goto err_out;
1489 	}
1490 
1491 	rc = cxgbi_hbas_add(cdev, CXGB4I_MAX_LUN, CXGBI_MAX_CONN,
1492 				&cxgb4i_host_template, cxgb4i_stt);
1493 	if (rc)
1494 		goto err_out;
1495 
1496 	for (i = 0; i < cdev->nports; i++) {
1497 		pi = netdev_priv(lldi->ports[i]);
1498 		cdev->hbas[i]->port_id = pi->port_id;
1499 	}
1500 	return cdev;
1501 
1502 err_out:
1503 	cxgbi_device_unregister(cdev);
1504 	return ERR_PTR(-ENOMEM);
1505 }
1506 
1507 #define RX_PULL_LEN	128
1508 static int t4_uld_rx_handler(void *handle, const __be64 *rsp,
1509 				const struct pkt_gl *pgl)
1510 {
1511 	const struct cpl_act_establish *rpl;
1512 	struct sk_buff *skb;
1513 	unsigned int opc;
1514 	struct cxgbi_device *cdev = handle;
1515 
1516 	if (pgl == NULL) {
1517 		unsigned int len = 64 - sizeof(struct rsp_ctrl) - 8;
1518 
1519 		skb = alloc_cpl(len, 0, GFP_ATOMIC);
1520 		if (!skb)
1521 			goto nomem;
1522 		skb_copy_to_linear_data(skb, &rsp[1], len);
1523 	} else {
1524 		if (unlikely(*(u8 *)rsp != *(u8 *)pgl->va)) {
1525 			pr_info("? FL 0x%p,RSS%#llx,FL %#llx,len %u.\n",
1526 				pgl->va, be64_to_cpu(*rsp),
1527 				be64_to_cpu(*(u64 *)pgl->va),
1528 				pgl->tot_len);
1529 			return 0;
1530 		}
1531 		skb = cxgb4_pktgl_to_skb(pgl, RX_PULL_LEN, RX_PULL_LEN);
1532 		if (unlikely(!skb))
1533 			goto nomem;
1534 	}
1535 
1536 	rpl = (struct cpl_act_establish *)skb->data;
1537 	opc = rpl->ot.opcode;
1538 	log_debug(1 << CXGBI_DBG_TOE,
1539 		"cdev %p, opcode 0x%x(0x%x,0x%x), skb %p.\n",
1540 		 cdev, opc, rpl->ot.opcode_tid, ntohl(rpl->ot.opcode_tid), skb);
1541 	if (cxgb4i_cplhandlers[opc])
1542 		cxgb4i_cplhandlers[opc](cdev, skb);
1543 	else {
1544 		pr_err("No handler for opcode 0x%x.\n", opc);
1545 		__kfree_skb(skb);
1546 	}
1547 	return 0;
1548 nomem:
1549 	log_debug(1 << CXGBI_DBG_TOE, "OOM bailing out.\n");
1550 	return 1;
1551 }
1552 
1553 static int t4_uld_state_change(void *handle, enum cxgb4_state state)
1554 {
1555 	struct cxgbi_device *cdev = handle;
1556 
1557 	switch (state) {
1558 	case CXGB4_STATE_UP:
1559 		pr_info("cdev 0x%p, UP.\n", cdev);
1560 		/* re-initialize */
1561 		break;
1562 	case CXGB4_STATE_START_RECOVERY:
1563 		pr_info("cdev 0x%p, RECOVERY.\n", cdev);
1564 		/* close all connections */
1565 		break;
1566 	case CXGB4_STATE_DOWN:
1567 		pr_info("cdev 0x%p, DOWN.\n", cdev);
1568 		break;
1569 	case CXGB4_STATE_DETACH:
1570 		pr_info("cdev 0x%p, DETACH.\n", cdev);
1571 		break;
1572 	default:
1573 		pr_info("cdev 0x%p, unknown state %d.\n", cdev, state);
1574 		break;
1575 	}
1576 	return 0;
1577 }
1578 
1579 static int __init cxgb4i_init_module(void)
1580 {
1581 	int rc;
1582 
1583 	printk(KERN_INFO "%s", version);
1584 
1585 	rc = cxgbi_iscsi_init(&cxgb4i_iscsi_transport, &cxgb4i_stt);
1586 	if (rc < 0)
1587 		return rc;
1588 	cxgb4_register_uld(CXGB4_ULD_ISCSI, &cxgb4i_uld_info);
1589 	return 0;
1590 }
1591 
1592 static void __exit cxgb4i_exit_module(void)
1593 {
1594 	cxgb4_unregister_uld(CXGB4_ULD_ISCSI);
1595 	cxgbi_device_unregister_all(CXGBI_FLAG_DEV_T4);
1596 	cxgbi_iscsi_cleanup(&cxgb4i_iscsi_transport, &cxgb4i_stt);
1597 }
1598 
1599 module_init(cxgb4i_init_module);
1600 module_exit(cxgb4i_exit_module);
1601