2 * cxgb4i.c: Chelsio T4 iSCSI driver.
4 * Copyright (c) 2010 Chelsio Communications, Inc.
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.
10 * Written by: Karen Xie (kxie@chelsio.com)
11 * Rakesh Ranjan (rranjan@chelsio.com)
14 #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
16 #include <linux/module.h>
17 #include <linux/moduleparam.h>
18 #include <scsi/scsi_host.h>
21 #include <linux/netdevice.h>
25 #include "cxgb4_uld.h"
30 static unsigned int dbg_level
;
32 #include "../libcxgbi.h"
34 #define DRV_MODULE_NAME "cxgb4i"
35 #define DRV_MODULE_DESC "Chelsio T4 iSCSI Driver"
36 #define DRV_MODULE_VERSION "0.9.1"
37 #define DRV_MODULE_RELDATE "Aug. 2010"
39 static char version
[] =
40 DRV_MODULE_DESC
" " DRV_MODULE_NAME
41 " v" DRV_MODULE_VERSION
" (" DRV_MODULE_RELDATE
")\n";
43 MODULE_AUTHOR("Chelsio Communications, Inc.");
44 MODULE_DESCRIPTION(DRV_MODULE_DESC
);
45 MODULE_VERSION(DRV_MODULE_VERSION
);
46 MODULE_LICENSE("GPL");
48 module_param(dbg_level
, uint
, 0644);
49 MODULE_PARM_DESC(dbg_level
, "Debug flag (default=0)");
51 static int cxgb4i_rcv_win
= 256 * 1024;
52 module_param(cxgb4i_rcv_win
, int, 0644);
53 MODULE_PARM_DESC(cxgb4i_rcv_win
, "TCP reveive window in bytes");
55 static int cxgb4i_snd_win
= 128 * 1024;
56 module_param(cxgb4i_snd_win
, int, 0644);
57 MODULE_PARM_DESC(cxgb4i_snd_win
, "TCP send window in bytes");
59 static int cxgb4i_rx_credit_thres
= 10 * 1024;
60 module_param(cxgb4i_rx_credit_thres
, int, 0644);
61 MODULE_PARM_DESC(cxgb4i_rx_credit_thres
,
62 "RX credits return threshold in bytes (default=10KB)");
64 static unsigned int cxgb4i_max_connect
= (8 * 1024);
65 module_param(cxgb4i_max_connect
, uint
, 0644);
66 MODULE_PARM_DESC(cxgb4i_max_connect
, "Maximum number of connections");
68 static unsigned short cxgb4i_sport_base
= 20000;
69 module_param(cxgb4i_sport_base
, ushort
, 0644);
70 MODULE_PARM_DESC(cxgb4i_sport_base
, "Starting port number (default 20000)");
72 typedef void (*cxgb4i_cplhandler_func
)(struct cxgbi_device
*, struct sk_buff
*);
74 static void *t4_uld_add(const struct cxgb4_lld_info
*);
75 static int t4_uld_rx_handler(void *, const __be64
*, const struct pkt_gl
*);
76 static int t4_uld_state_change(void *, enum cxgb4_state state
);
78 static const struct cxgb4_uld_info cxgb4i_uld_info
= {
79 .name
= DRV_MODULE_NAME
,
81 .rx_handler
= t4_uld_rx_handler
,
82 .state_change
= t4_uld_state_change
,
85 static struct scsi_host_template cxgb4i_host_template
= {
86 .module
= THIS_MODULE
,
87 .name
= DRV_MODULE_NAME
,
88 .proc_name
= DRV_MODULE_NAME
,
89 .can_queue
= CXGB4I_SCSI_HOST_QDEPTH
,
90 .queuecommand
= iscsi_queuecommand
,
91 .change_queue_depth
= iscsi_change_queue_depth
,
92 .sg_tablesize
= SG_ALL
,
93 .max_sectors
= 0xFFFF,
94 .cmd_per_lun
= ISCSI_DEF_CMD_PER_LUN
,
95 .eh_abort_handler
= iscsi_eh_abort
,
96 .eh_device_reset_handler
= iscsi_eh_device_reset
,
97 .eh_target_reset_handler
= iscsi_eh_recover_target
,
98 .target_alloc
= iscsi_target_alloc
,
99 .use_clustering
= DISABLE_CLUSTERING
,
103 static struct iscsi_transport cxgb4i_iscsi_transport
= {
104 .owner
= THIS_MODULE
,
105 .name
= DRV_MODULE_NAME
,
106 .caps
= CAP_RECOVERY_L0
| CAP_MULTI_R2T
| CAP_HDRDGST
|
107 CAP_DATADGST
| CAP_DIGEST_OFFLOAD
|
108 CAP_PADDING_OFFLOAD
| CAP_TEXT_NEGO
,
109 .attr_is_visible
= cxgbi_attr_is_visible
,
110 .get_host_param
= cxgbi_get_host_param
,
111 .set_host_param
= cxgbi_set_host_param
,
112 /* session management */
113 .create_session
= cxgbi_create_session
,
114 .destroy_session
= cxgbi_destroy_session
,
115 .get_session_param
= iscsi_session_get_param
,
116 /* connection management */
117 .create_conn
= cxgbi_create_conn
,
118 .bind_conn
= cxgbi_bind_conn
,
119 .destroy_conn
= iscsi_tcp_conn_teardown
,
120 .start_conn
= iscsi_conn_start
,
121 .stop_conn
= iscsi_conn_stop
,
122 .get_conn_param
= iscsi_conn_get_param
,
123 .set_param
= cxgbi_set_conn_param
,
124 .get_stats
= cxgbi_get_conn_stats
,
125 /* pdu xmit req from user space */
126 .send_pdu
= iscsi_conn_send_pdu
,
128 .init_task
= iscsi_tcp_task_init
,
129 .xmit_task
= iscsi_tcp_task_xmit
,
130 .cleanup_task
= cxgbi_cleanup_task
,
132 .alloc_pdu
= cxgbi_conn_alloc_pdu
,
133 .init_pdu
= cxgbi_conn_init_pdu
,
134 .xmit_pdu
= cxgbi_conn_xmit_pdu
,
135 .parse_pdu_itt
= cxgbi_parse_pdu_itt
,
136 /* TCP connect/disconnect */
137 .get_ep_param
= cxgbi_get_ep_param
,
138 .ep_connect
= cxgbi_ep_connect
,
139 .ep_poll
= cxgbi_ep_poll
,
140 .ep_disconnect
= cxgbi_ep_disconnect
,
141 /* Error recovery timeout call */
142 .session_recovery_timedout
= iscsi_session_recovery_timedout
,
145 static struct scsi_transport_template
*cxgb4i_stt
;
148 * CPL (Chelsio Protocol Language) defines a message passing interface between
149 * the host driver and Chelsio asic.
150 * The section below implments CPLs that related to iscsi tcp connection
151 * open/close/abort and data send/receive.
153 #define DIV_ROUND_UP(n, d) (((n) + (d) - 1) / (d))
154 #define RCV_BUFSIZ_MASK 0x3FFU
155 #define MAX_IMM_TX_PKT_LEN 128
157 static inline void set_queue(struct sk_buff
*skb
, unsigned int queue
,
158 const struct cxgbi_sock
*csk
)
160 skb
->queue_mapping
= queue
;
163 static int push_tx_frames(struct cxgbi_sock
*, int);
166 * is_ofld_imm - check whether a packet can be sent as immediate data
169 * Returns true if a packet can be sent as an offload WR with immediate
170 * data. We currently use the same limit as for Ethernet packets.
172 static inline int is_ofld_imm(const struct sk_buff
*skb
)
174 return skb
->len
<= (MAX_IMM_TX_PKT_LEN
-
175 sizeof(struct fw_ofld_tx_data_wr
));
178 static void send_act_open_req(struct cxgbi_sock
*csk
, struct sk_buff
*skb
,
181 struct cpl_act_open_req
*req
;
182 int wscale
= cxgbi_sock_compute_wscale(csk
->mss_idx
);
183 unsigned long long opt0
;
185 unsigned int qid_atid
= ((unsigned int)csk
->atid
) |
186 (((unsigned int)csk
->rss_qid
) << 14);
188 opt0
= KEEP_ALIVE(1) |
190 MSS_IDX(csk
->mss_idx
) |
191 L2T_IDX(((struct l2t_entry
*)csk
->l2t
)->idx
) |
192 TX_CHAN(csk
->tx_chan
) |
193 SMAC_SEL(csk
->smac_idx
) |
194 ULP_MODE(ULP_MODE_ISCSI
) |
195 RCV_BUFSIZ(cxgb4i_rcv_win
>> 10);
196 opt2
= RX_CHANNEL(0) |
198 (1 << 20) | (1 << 22) |
199 RSS_QUEUE(csk
->rss_qid
);
201 set_wr_txq(skb
, CPL_PRIORITY_SETUP
, csk
->port_id
);
202 req
= (struct cpl_act_open_req
*)skb
->head
;
205 OPCODE_TID(req
) = cpu_to_be32(MK_OPCODE_TID(CPL_ACT_OPEN_REQ
,
207 req
->local_port
= csk
->saddr
.sin_port
;
208 req
->peer_port
= csk
->daddr
.sin_port
;
209 req
->local_ip
= csk
->saddr
.sin_addr
.s_addr
;
210 req
->peer_ip
= csk
->daddr
.sin_addr
.s_addr
;
211 req
->opt0
= cpu_to_be64(opt0
);
213 req
->opt2
= cpu_to_be32(opt2
);
215 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
216 "csk 0x%p, %pI4:%u-%pI4:%u, atid %d, qid %u.\n",
217 csk
, &req
->local_ip
, ntohs(req
->local_port
),
218 &req
->peer_ip
, ntohs(req
->peer_port
),
219 csk
->atid
, csk
->rss_qid
);
221 cxgb4_l2t_send(csk
->cdev
->ports
[csk
->port_id
], skb
, csk
->l2t
);
224 static void send_close_req(struct cxgbi_sock
*csk
)
226 struct sk_buff
*skb
= csk
->cpl_close
;
227 struct cpl_close_con_req
*req
= (struct cpl_close_con_req
*)skb
->head
;
228 unsigned int tid
= csk
->tid
;
230 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
231 "csk 0x%p,%u,0x%lx, tid %u.\n",
232 csk
, csk
->state
, csk
->flags
, csk
->tid
);
233 csk
->cpl_close
= NULL
;
234 set_wr_txq(skb
, CPL_PRIORITY_DATA
, csk
->port_id
);
235 INIT_TP_WR(req
, tid
);
236 OPCODE_TID(req
) = cpu_to_be32(MK_OPCODE_TID(CPL_CLOSE_CON_REQ
, tid
));
239 cxgbi_sock_skb_entail(csk
, skb
);
240 if (csk
->state
>= CTP_ESTABLISHED
)
241 push_tx_frames(csk
, 1);
244 static void abort_arp_failure(void *handle
, struct sk_buff
*skb
)
246 struct cxgbi_sock
*csk
= (struct cxgbi_sock
*)handle
;
247 struct cpl_abort_req
*req
;
249 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
250 "csk 0x%p,%u,0x%lx, tid %u, abort.\n",
251 csk
, csk
->state
, csk
->flags
, csk
->tid
);
252 req
= (struct cpl_abort_req
*)skb
->data
;
253 req
->cmd
= CPL_ABORT_NO_RST
;
254 cxgb4_ofld_send(csk
->cdev
->ports
[csk
->port_id
], skb
);
257 static void send_abort_req(struct cxgbi_sock
*csk
)
259 struct cpl_abort_req
*req
;
260 struct sk_buff
*skb
= csk
->cpl_abort_req
;
262 if (unlikely(csk
->state
== CTP_ABORTING
) || !skb
|| !csk
->cdev
)
264 cxgbi_sock_set_state(csk
, CTP_ABORTING
);
265 cxgbi_sock_set_flag(csk
, CTPF_ABORT_RPL_PENDING
);
266 cxgbi_sock_purge_write_queue(csk
);
268 csk
->cpl_abort_req
= NULL
;
269 req
= (struct cpl_abort_req
*)skb
->head
;
270 set_queue(skb
, CPL_PRIORITY_DATA
, csk
);
271 req
->cmd
= CPL_ABORT_SEND_RST
;
272 t4_set_arp_err_handler(skb
, csk
, abort_arp_failure
);
273 INIT_TP_WR(req
, csk
->tid
);
274 OPCODE_TID(req
) = cpu_to_be32(MK_OPCODE_TID(CPL_ABORT_REQ
, csk
->tid
));
275 req
->rsvd0
= htonl(csk
->snd_nxt
);
276 req
->rsvd1
= !cxgbi_sock_flag(csk
, CTPF_TX_DATA_SENT
);
278 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
279 "csk 0x%p,%u,0x%lx,%u, snd_nxt %u, 0x%x.\n",
280 csk
, csk
->state
, csk
->flags
, csk
->tid
, csk
->snd_nxt
,
283 cxgb4_l2t_send(csk
->cdev
->ports
[csk
->port_id
], skb
, csk
->l2t
);
286 static void send_abort_rpl(struct cxgbi_sock
*csk
, int rst_status
)
288 struct sk_buff
*skb
= csk
->cpl_abort_rpl
;
289 struct cpl_abort_rpl
*rpl
= (struct cpl_abort_rpl
*)skb
->head
;
291 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
292 "csk 0x%p,%u,0x%lx,%u, status %d.\n",
293 csk
, csk
->state
, csk
->flags
, csk
->tid
, rst_status
);
295 csk
->cpl_abort_rpl
= NULL
;
296 set_queue(skb
, CPL_PRIORITY_DATA
, csk
);
297 INIT_TP_WR(rpl
, csk
->tid
);
298 OPCODE_TID(rpl
) = cpu_to_be32(MK_OPCODE_TID(CPL_ABORT_RPL
, csk
->tid
));
299 rpl
->cmd
= rst_status
;
300 cxgb4_ofld_send(csk
->cdev
->ports
[csk
->port_id
], skb
);
304 * CPL connection rx data ack: host ->
305 * Send RX credits through an RX_DATA_ACK CPL message. Returns the number of
308 static u32
send_rx_credits(struct cxgbi_sock
*csk
, u32 credits
)
311 struct cpl_rx_data_ack
*req
;
313 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_PDU_RX
,
314 "csk 0x%p,%u,0x%lx,%u, credit %u.\n",
315 csk
, csk
->state
, csk
->flags
, csk
->tid
, credits
);
317 skb
= alloc_wr(sizeof(*req
), 0, GFP_ATOMIC
);
319 pr_info("csk 0x%p, credit %u, OOM.\n", csk
, credits
);
322 req
= (struct cpl_rx_data_ack
*)skb
->head
;
324 set_wr_txq(skb
, CPL_PRIORITY_ACK
, csk
->port_id
);
325 INIT_TP_WR(req
, csk
->tid
);
326 OPCODE_TID(req
) = cpu_to_be32(MK_OPCODE_TID(CPL_RX_DATA_ACK
,
328 req
->credit_dack
= cpu_to_be32(RX_CREDITS(credits
) | RX_FORCE_ACK(1));
329 cxgb4_ofld_send(csk
->cdev
->ports
[csk
->port_id
], skb
);
334 * sgl_len - calculates the size of an SGL of the given capacity
335 * @n: the number of SGL entries
336 * Calculates the number of flits needed for a scatter/gather list that
337 * can hold the given number of entries.
339 static inline unsigned int sgl_len(unsigned int n
)
342 return (3 * n
) / 2 + (n
& 1) + 2;
346 * calc_tx_flits_ofld - calculate # of flits for an offload packet
349 * Returns the number of flits needed for the given offload packet.
350 * These packets are already fully constructed and no additional headers
353 static inline unsigned int calc_tx_flits_ofld(const struct sk_buff
*skb
)
355 unsigned int flits
, cnt
;
357 if (is_ofld_imm(skb
))
358 return DIV_ROUND_UP(skb
->len
, 8);
359 flits
= skb_transport_offset(skb
) / 8;
360 cnt
= skb_shinfo(skb
)->nr_frags
;
361 if (skb
->tail
!= skb
->transport_header
)
363 return flits
+ sgl_len(cnt
);
366 static inline void send_tx_flowc_wr(struct cxgbi_sock
*csk
)
369 struct fw_flowc_wr
*flowc
;
373 skb
= alloc_wr(flowclen
, 0, GFP_ATOMIC
);
374 flowc
= (struct fw_flowc_wr
*)skb
->head
;
375 flowc
->op_to_nparams
=
376 htonl(FW_WR_OP(FW_FLOWC_WR
) | FW_FLOWC_WR_NPARAMS(8));
377 flowc
->flowid_len16
=
378 htonl(FW_WR_LEN16(DIV_ROUND_UP(72, 16)) |
379 FW_WR_FLOWID(csk
->tid
));
380 flowc
->mnemval
[0].mnemonic
= FW_FLOWC_MNEM_PFNVFN
;
381 flowc
->mnemval
[0].val
= htonl(csk
->cdev
->pfvf
);
382 flowc
->mnemval
[1].mnemonic
= FW_FLOWC_MNEM_CH
;
383 flowc
->mnemval
[1].val
= htonl(csk
->tx_chan
);
384 flowc
->mnemval
[2].mnemonic
= FW_FLOWC_MNEM_PORT
;
385 flowc
->mnemval
[2].val
= htonl(csk
->tx_chan
);
386 flowc
->mnemval
[3].mnemonic
= FW_FLOWC_MNEM_IQID
;
387 flowc
->mnemval
[3].val
= htonl(csk
->rss_qid
);
388 flowc
->mnemval
[4].mnemonic
= FW_FLOWC_MNEM_SNDNXT
;
389 flowc
->mnemval
[4].val
= htonl(csk
->snd_nxt
);
390 flowc
->mnemval
[5].mnemonic
= FW_FLOWC_MNEM_RCVNXT
;
391 flowc
->mnemval
[5].val
= htonl(csk
->rcv_nxt
);
392 flowc
->mnemval
[6].mnemonic
= FW_FLOWC_MNEM_SNDBUF
;
393 flowc
->mnemval
[6].val
= htonl(cxgb4i_snd_win
);
394 flowc
->mnemval
[7].mnemonic
= FW_FLOWC_MNEM_MSS
;
395 flowc
->mnemval
[7].val
= htonl(csk
->advmss
);
396 flowc
->mnemval
[8].mnemonic
= 0;
397 flowc
->mnemval
[8].val
= 0;
398 for (i
= 0; i
< 9; i
++) {
399 flowc
->mnemval
[i
].r4
[0] = 0;
400 flowc
->mnemval
[i
].r4
[1] = 0;
401 flowc
->mnemval
[i
].r4
[2] = 0;
403 set_queue(skb
, CPL_PRIORITY_DATA
, csk
);
405 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
406 "csk 0x%p, tid 0x%x, %u,%u,%u,%u,%u,%u,%u.\n",
407 csk
, csk
->tid
, 0, csk
->tx_chan
, csk
->rss_qid
,
408 csk
->snd_nxt
, csk
->rcv_nxt
, cxgb4i_snd_win
,
411 cxgb4_ofld_send(csk
->cdev
->ports
[csk
->port_id
], skb
);
414 static inline void make_tx_data_wr(struct cxgbi_sock
*csk
, struct sk_buff
*skb
,
415 int dlen
, int len
, u32 credits
, int compl)
417 struct fw_ofld_tx_data_wr
*req
;
418 unsigned int submode
= cxgbi_skcb_ulp_mode(skb
) & 3;
419 unsigned int wr_ulp_mode
= 0;
421 req
= (struct fw_ofld_tx_data_wr
*)__skb_push(skb
, sizeof(*req
));
423 if (is_ofld_imm(skb
)) {
424 req
->op_to_immdlen
= htonl(FW_WR_OP(FW_OFLD_TX_DATA_WR
) |
426 FW_WR_IMMDLEN(dlen
));
427 req
->flowid_len16
= htonl(FW_WR_FLOWID(csk
->tid
) |
428 FW_WR_LEN16(credits
));
431 cpu_to_be32(FW_WR_OP(FW_OFLD_TX_DATA_WR
) |
435 cpu_to_be32(FW_WR_FLOWID(csk
->tid
) |
436 FW_WR_LEN16(credits
));
439 wr_ulp_mode
= FW_OFLD_TX_DATA_WR_ULPMODE(ULP2_MODE_ISCSI
) |
440 FW_OFLD_TX_DATA_WR_ULPSUBMODE(submode
);
441 req
->tunnel_to_proxy
= htonl(wr_ulp_mode
) |
442 FW_OFLD_TX_DATA_WR_SHOVE(skb_peek(&csk
->write_queue
) ? 0 : 1);
443 req
->plen
= htonl(len
);
444 if (!cxgbi_sock_flag(csk
, CTPF_TX_DATA_SENT
))
445 cxgbi_sock_set_flag(csk
, CTPF_TX_DATA_SENT
);
448 static void arp_failure_skb_discard(void *handle
, struct sk_buff
*skb
)
453 static int push_tx_frames(struct cxgbi_sock
*csk
, int req_completion
)
458 if (unlikely(csk
->state
< CTP_ESTABLISHED
||
459 csk
->state
== CTP_CLOSE_WAIT_1
|| csk
->state
>= CTP_ABORTING
)) {
460 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
|
461 1 << CXGBI_DBG_PDU_TX
,
462 "csk 0x%p,%u,0x%lx,%u, in closing state.\n",
463 csk
, csk
->state
, csk
->flags
, csk
->tid
);
467 while (csk
->wr_cred
&& (skb
= skb_peek(&csk
->write_queue
)) != NULL
) {
470 unsigned int credits_needed
;
472 skb_reset_transport_header(skb
);
473 if (is_ofld_imm(skb
))
474 credits_needed
= DIV_ROUND_UP(dlen
+
475 sizeof(struct fw_ofld_tx_data_wr
), 16);
477 credits_needed
= DIV_ROUND_UP(8*calc_tx_flits_ofld(skb
)
478 + sizeof(struct fw_ofld_tx_data_wr
),
481 if (csk
->wr_cred
< credits_needed
) {
482 log_debug(1 << CXGBI_DBG_PDU_TX
,
483 "csk 0x%p, skb %u/%u, wr %d < %u.\n",
484 csk
, skb
->len
, skb
->data_len
,
485 credits_needed
, csk
->wr_cred
);
488 __skb_unlink(skb
, &csk
->write_queue
);
489 set_queue(skb
, CPL_PRIORITY_DATA
, csk
);
490 skb
->csum
= credits_needed
;
491 csk
->wr_cred
-= credits_needed
;
492 csk
->wr_una_cred
+= credits_needed
;
493 cxgbi_sock_enqueue_wr(csk
, skb
);
495 log_debug(1 << CXGBI_DBG_PDU_TX
,
496 "csk 0x%p, skb %u/%u, wr %d, left %u, unack %u.\n",
497 csk
, skb
->len
, skb
->data_len
, credits_needed
,
498 csk
->wr_cred
, csk
->wr_una_cred
);
500 if (likely(cxgbi_skcb_test_flag(skb
, SKCBF_TX_NEED_HDR
))) {
501 if (!cxgbi_sock_flag(csk
, CTPF_TX_DATA_SENT
)) {
502 send_tx_flowc_wr(csk
);
505 csk
->wr_una_cred
+= 5;
507 len
+= cxgbi_ulp_extra_len(cxgbi_skcb_ulp_mode(skb
));
508 make_tx_data_wr(csk
, skb
, dlen
, len
, credits_needed
,
511 cxgbi_skcb_clear_flag(skb
, SKCBF_TX_NEED_HDR
);
513 total_size
+= skb
->truesize
;
514 t4_set_arp_err_handler(skb
, csk
, arp_failure_skb_discard
);
516 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_PDU_TX
,
517 "csk 0x%p,%u,0x%lx,%u, skb 0x%p, %u.\n",
518 csk
, csk
->state
, csk
->flags
, csk
->tid
, skb
, len
);
520 cxgb4_l2t_send(csk
->cdev
->ports
[csk
->port_id
], skb
, csk
->l2t
);
525 static inline void free_atid(struct cxgbi_sock
*csk
)
527 struct cxgb4_lld_info
*lldi
= cxgbi_cdev_priv(csk
->cdev
);
529 if (cxgbi_sock_flag(csk
, CTPF_HAS_ATID
)) {
530 cxgb4_free_atid(lldi
->tids
, csk
->atid
);
531 cxgbi_sock_clear_flag(csk
, CTPF_HAS_ATID
);
536 static void do_act_establish(struct cxgbi_device
*cdev
, struct sk_buff
*skb
)
538 struct cxgbi_sock
*csk
;
539 struct cpl_act_establish
*req
= (struct cpl_act_establish
*)skb
->data
;
540 unsigned short tcp_opt
= ntohs(req
->tcp_opt
);
541 unsigned int tid
= GET_TID(req
);
542 unsigned int atid
= GET_TID_TID(ntohl(req
->tos_atid
));
543 struct cxgb4_lld_info
*lldi
= cxgbi_cdev_priv(cdev
);
544 struct tid_info
*t
= lldi
->tids
;
545 u32 rcv_isn
= be32_to_cpu(req
->rcv_isn
);
547 csk
= lookup_atid(t
, atid
);
548 if (unlikely(!csk
)) {
549 pr_err("NO conn. for atid %u, cdev 0x%p.\n", atid
, cdev
);
553 if (csk
->atid
!= atid
) {
554 pr_err("bad conn atid %u, csk 0x%p,%u,0x%lx,tid %u, atid %u.\n",
555 atid
, csk
, csk
->state
, csk
->flags
, csk
->tid
, csk
->atid
);
559 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
560 "csk 0x%p,%u,0x%lx, tid %u, atid %u, rseq %u.\n",
561 csk
, csk
->state
, csk
->flags
, tid
, atid
, rcv_isn
);
565 cxgb4_insert_tid(lldi
->tids
, csk
, tid
);
566 cxgbi_sock_set_flag(csk
, CTPF_HAS_TID
);
570 spin_lock_bh(&csk
->lock
);
571 if (unlikely(csk
->state
!= CTP_ACTIVE_OPEN
))
572 pr_info("csk 0x%p,%u,0x%lx,%u, got EST.\n",
573 csk
, csk
->state
, csk
->flags
, csk
->tid
);
575 if (csk
->retry_timer
.function
) {
576 del_timer(&csk
->retry_timer
);
577 csk
->retry_timer
.function
= NULL
;
580 csk
->copied_seq
= csk
->rcv_wup
= csk
->rcv_nxt
= rcv_isn
;
582 * Causes the first RX_DATA_ACK to supply any Rx credits we couldn't
585 if (cxgb4i_rcv_win
> (RCV_BUFSIZ_MASK
<< 10))
586 csk
->rcv_wup
-= cxgb4i_rcv_win
- (RCV_BUFSIZ_MASK
<< 10);
588 csk
->advmss
= lldi
->mtus
[GET_TCPOPT_MSS(tcp_opt
)] - 40;
589 if (GET_TCPOPT_TSTAMP(tcp_opt
))
591 if (csk
->advmss
< 128)
594 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
595 "csk 0x%p, mss_idx %u, advmss %u.\n",
596 csk
, GET_TCPOPT_MSS(tcp_opt
), csk
->advmss
);
598 cxgbi_sock_established(csk
, ntohl(req
->snd_isn
), ntohs(req
->tcp_opt
));
600 if (unlikely(cxgbi_sock_flag(csk
, CTPF_ACTIVE_CLOSE_NEEDED
)))
603 if (skb_queue_len(&csk
->write_queue
))
604 push_tx_frames(csk
, 0);
605 cxgbi_conn_tx_open(csk
);
607 spin_unlock_bh(&csk
->lock
);
613 static int act_open_rpl_status_to_errno(int status
)
616 case CPL_ERR_CONN_RESET
:
617 return -ECONNREFUSED
;
618 case CPL_ERR_ARP_MISS
:
619 return -EHOSTUNREACH
;
620 case CPL_ERR_CONN_TIMEDOUT
:
622 case CPL_ERR_TCAM_FULL
:
624 case CPL_ERR_CONN_EXIST
:
631 static void csk_act_open_retry_timer(unsigned long data
)
634 struct cxgbi_sock
*csk
= (struct cxgbi_sock
*)data
;
636 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
637 "csk 0x%p,%u,0x%lx,%u.\n",
638 csk
, csk
->state
, csk
->flags
, csk
->tid
);
641 spin_lock_bh(&csk
->lock
);
642 skb
= alloc_wr(sizeof(struct cpl_act_open_req
), 0, GFP_ATOMIC
);
644 cxgbi_sock_fail_act_open(csk
, -ENOMEM
);
646 skb
->sk
= (struct sock
*)csk
;
647 t4_set_arp_err_handler(skb
, csk
,
648 cxgbi_sock_act_open_req_arp_failure
);
649 send_act_open_req(csk
, skb
, csk
->l2t
);
651 spin_unlock_bh(&csk
->lock
);
655 static void do_act_open_rpl(struct cxgbi_device
*cdev
, struct sk_buff
*skb
)
657 struct cxgbi_sock
*csk
;
658 struct cpl_act_open_rpl
*rpl
= (struct cpl_act_open_rpl
*)skb
->data
;
659 unsigned int tid
= GET_TID(rpl
);
661 GET_TID_TID(GET_AOPEN_ATID(be32_to_cpu(rpl
->atid_status
)));
662 unsigned int status
= GET_AOPEN_STATUS(be32_to_cpu(rpl
->atid_status
));
663 struct cxgb4_lld_info
*lldi
= cxgbi_cdev_priv(cdev
);
664 struct tid_info
*t
= lldi
->tids
;
666 csk
= lookup_atid(t
, atid
);
667 if (unlikely(!csk
)) {
668 pr_err("NO matching conn. atid %u, tid %u.\n", atid
, tid
);
672 pr_info("%pI4:%u-%pI4:%u, atid %u,%u, status %u, csk 0x%p,%u,0x%lx.\n",
673 &csk
->saddr
.sin_addr
.s_addr
, ntohs(csk
->saddr
.sin_port
),
674 &csk
->daddr
.sin_addr
.s_addr
, ntohs(csk
->daddr
.sin_port
),
675 atid
, tid
, status
, csk
, csk
->state
, csk
->flags
);
677 if (status
== CPL_ERR_RTX_NEG_ADVICE
)
680 if (status
&& status
!= CPL_ERR_TCAM_FULL
&&
681 status
!= CPL_ERR_CONN_EXIST
&&
682 status
!= CPL_ERR_ARP_MISS
)
683 cxgb4_remove_tid(lldi
->tids
, csk
->port_id
, GET_TID(rpl
));
686 spin_lock_bh(&csk
->lock
);
688 if (status
== CPL_ERR_CONN_EXIST
&&
689 csk
->retry_timer
.function
!= csk_act_open_retry_timer
) {
690 csk
->retry_timer
.function
= csk_act_open_retry_timer
;
691 mod_timer(&csk
->retry_timer
, jiffies
+ HZ
/ 2);
693 cxgbi_sock_fail_act_open(csk
,
694 act_open_rpl_status_to_errno(status
));
696 spin_unlock_bh(&csk
->lock
);
702 static void do_peer_close(struct cxgbi_device
*cdev
, struct sk_buff
*skb
)
704 struct cxgbi_sock
*csk
;
705 struct cpl_peer_close
*req
= (struct cpl_peer_close
*)skb
->data
;
706 unsigned int tid
= GET_TID(req
);
707 struct cxgb4_lld_info
*lldi
= cxgbi_cdev_priv(cdev
);
708 struct tid_info
*t
= lldi
->tids
;
710 csk
= lookup_tid(t
, tid
);
711 if (unlikely(!csk
)) {
712 pr_err("can't find connection for tid %u.\n", tid
);
715 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
716 "csk 0x%p,%u,0x%lx,%u.\n",
717 csk
, csk
->state
, csk
->flags
, csk
->tid
);
718 cxgbi_sock_rcv_peer_close(csk
);
723 static void do_close_con_rpl(struct cxgbi_device
*cdev
, struct sk_buff
*skb
)
725 struct cxgbi_sock
*csk
;
726 struct cpl_close_con_rpl
*rpl
= (struct cpl_close_con_rpl
*)skb
->data
;
727 unsigned int tid
= GET_TID(rpl
);
728 struct cxgb4_lld_info
*lldi
= cxgbi_cdev_priv(cdev
);
729 struct tid_info
*t
= lldi
->tids
;
731 csk
= lookup_tid(t
, tid
);
732 if (unlikely(!csk
)) {
733 pr_err("can't find connection for tid %u.\n", tid
);
736 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
737 "csk 0x%p,%u,0x%lx,%u.\n",
738 csk
, csk
->state
, csk
->flags
, csk
->tid
);
739 cxgbi_sock_rcv_close_conn_rpl(csk
, ntohl(rpl
->snd_nxt
));
744 static int abort_status_to_errno(struct cxgbi_sock
*csk
, int abort_reason
,
747 switch (abort_reason
) {
748 case CPL_ERR_BAD_SYN
: /* fall through */
749 case CPL_ERR_CONN_RESET
:
750 return csk
->state
> CTP_ESTABLISHED
?
751 -EPIPE
: -ECONNRESET
;
752 case CPL_ERR_XMIT_TIMEDOUT
:
753 case CPL_ERR_PERSIST_TIMEDOUT
:
754 case CPL_ERR_FINWAIT2_TIMEDOUT
:
755 case CPL_ERR_KEEPALIVE_TIMEDOUT
:
762 static void do_abort_req_rss(struct cxgbi_device
*cdev
, struct sk_buff
*skb
)
764 struct cxgbi_sock
*csk
;
765 struct cpl_abort_req_rss
*req
= (struct cpl_abort_req_rss
*)skb
->data
;
766 unsigned int tid
= GET_TID(req
);
767 struct cxgb4_lld_info
*lldi
= cxgbi_cdev_priv(cdev
);
768 struct tid_info
*t
= lldi
->tids
;
769 int rst_status
= CPL_ABORT_NO_RST
;
771 csk
= lookup_tid(t
, tid
);
772 if (unlikely(!csk
)) {
773 pr_err("can't find connection for tid %u.\n", tid
);
777 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
778 "csk 0x%p,%u,0x%lx, tid %u, status 0x%x.\n",
779 csk
, csk
->state
, csk
->flags
, csk
->tid
, req
->status
);
781 if (req
->status
== CPL_ERR_RTX_NEG_ADVICE
||
782 req
->status
== CPL_ERR_PERSIST_NEG_ADVICE
)
786 spin_lock_bh(&csk
->lock
);
788 if (!cxgbi_sock_flag(csk
, CTPF_ABORT_REQ_RCVD
)) {
789 cxgbi_sock_set_flag(csk
, CTPF_ABORT_REQ_RCVD
);
790 cxgbi_sock_set_state(csk
, CTP_ABORTING
);
794 cxgbi_sock_clear_flag(csk
, CTPF_ABORT_REQ_RCVD
);
795 send_abort_rpl(csk
, rst_status
);
797 if (!cxgbi_sock_flag(csk
, CTPF_ABORT_RPL_PENDING
)) {
798 csk
->err
= abort_status_to_errno(csk
, req
->status
, &rst_status
);
799 cxgbi_sock_closed(csk
);
802 spin_unlock_bh(&csk
->lock
);
808 static void do_abort_rpl_rss(struct cxgbi_device
*cdev
, struct sk_buff
*skb
)
810 struct cxgbi_sock
*csk
;
811 struct cpl_abort_rpl_rss
*rpl
= (struct cpl_abort_rpl_rss
*)skb
->data
;
812 unsigned int tid
= GET_TID(rpl
);
813 struct cxgb4_lld_info
*lldi
= cxgbi_cdev_priv(cdev
);
814 struct tid_info
*t
= lldi
->tids
;
816 csk
= lookup_tid(t
, tid
);
820 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
821 "status 0x%x, csk 0x%p, s %u, 0x%lx.\n",
822 rpl
->status
, csk
, csk
? csk
->state
: 0,
823 csk
? csk
->flags
: 0UL);
825 if (rpl
->status
== CPL_ERR_ABORT_FAILED
)
828 cxgbi_sock_rcv_abort_rpl(csk
);
833 static void do_rx_iscsi_hdr(struct cxgbi_device
*cdev
, struct sk_buff
*skb
)
835 struct cxgbi_sock
*csk
;
836 struct cpl_iscsi_hdr
*cpl
= (struct cpl_iscsi_hdr
*)skb
->data
;
837 unsigned short pdu_len_ddp
= be16_to_cpu(cpl
->pdu_len_ddp
);
838 unsigned int tid
= GET_TID(cpl
);
839 struct cxgb4_lld_info
*lldi
= cxgbi_cdev_priv(cdev
);
840 struct tid_info
*t
= lldi
->tids
;
842 csk
= lookup_tid(t
, tid
);
843 if (unlikely(!csk
)) {
844 pr_err("can't find conn. for tid %u.\n", tid
);
848 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_PDU_RX
,
849 "csk 0x%p,%u,0x%lx, tid %u, skb 0x%p,%u, 0x%x.\n",
850 csk
, csk
->state
, csk
->flags
, csk
->tid
, skb
, skb
->len
,
853 spin_lock_bh(&csk
->lock
);
855 if (unlikely(csk
->state
>= CTP_PASSIVE_CLOSE
)) {
856 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
857 "csk 0x%p,%u,0x%lx,%u, bad state.\n",
858 csk
, csk
->state
, csk
->flags
, csk
->tid
);
859 if (csk
->state
!= CTP_ABORTING
)
865 cxgbi_skcb_tcp_seq(skb
) = ntohl(cpl
->seq
);
866 cxgbi_skcb_flags(skb
) = 0;
868 skb_reset_transport_header(skb
);
869 __skb_pull(skb
, sizeof(*cpl
));
870 __pskb_trim(skb
, ntohs(cpl
->len
));
872 if (!csk
->skb_ulp_lhdr
) {
874 unsigned int hlen
, dlen
;
876 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_PDU_RX
,
877 "csk 0x%p,%u,0x%lx, tid %u, skb 0x%p header.\n",
878 csk
, csk
->state
, csk
->flags
, csk
->tid
, skb
);
879 csk
->skb_ulp_lhdr
= skb
;
880 cxgbi_skcb_set_flag(skb
, SKCBF_RX_HDR
);
882 if (cxgbi_skcb_tcp_seq(skb
) != csk
->rcv_nxt
) {
883 pr_info("tid %u, CPL_ISCSI_HDR, bad seq, 0x%x/0x%x.\n",
884 csk
->tid
, cxgbi_skcb_tcp_seq(skb
),
890 hlen
= ntohs(cpl
->len
);
891 dlen
= ntohl(*(unsigned int *)(bhs
+ 4)) & 0xFFFFFF;
893 if ((hlen
+ dlen
) != ISCSI_PDU_LEN(pdu_len_ddp
) - 40) {
894 pr_info("tid 0x%x, CPL_ISCSI_HDR, pdu len "
895 "mismatch %u != %u + %u, seq 0x%x.\n",
896 csk
->tid
, ISCSI_PDU_LEN(pdu_len_ddp
) - 40,
897 hlen
, dlen
, cxgbi_skcb_tcp_seq(skb
));
901 cxgbi_skcb_rx_pdulen(skb
) = (hlen
+ dlen
+ 3) & (~0x3);
903 cxgbi_skcb_rx_pdulen(skb
) += csk
->dcrc_len
;
904 csk
->rcv_nxt
+= cxgbi_skcb_rx_pdulen(skb
);
906 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_PDU_RX
,
907 "csk 0x%p, skb 0x%p, 0x%x,%u+%u,0x%x,0x%x.\n",
908 csk
, skb
, *bhs
, hlen
, dlen
,
909 ntohl(*((unsigned int *)(bhs
+ 16))),
910 ntohl(*((unsigned int *)(bhs
+ 24))));
913 struct sk_buff
*lskb
= csk
->skb_ulp_lhdr
;
915 cxgbi_skcb_set_flag(lskb
, SKCBF_RX_DATA
);
916 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_PDU_RX
,
917 "csk 0x%p,%u,0x%lx, skb 0x%p data, 0x%p.\n",
918 csk
, csk
->state
, csk
->flags
, skb
, lskb
);
921 __skb_queue_tail(&csk
->receive_queue
, skb
);
922 spin_unlock_bh(&csk
->lock
);
928 spin_unlock_bh(&csk
->lock
);
933 static void do_rx_data_ddp(struct cxgbi_device
*cdev
,
936 struct cxgbi_sock
*csk
;
937 struct sk_buff
*lskb
;
938 struct cpl_rx_data_ddp
*rpl
= (struct cpl_rx_data_ddp
*)skb
->data
;
939 unsigned int tid
= GET_TID(rpl
);
940 struct cxgb4_lld_info
*lldi
= cxgbi_cdev_priv(cdev
);
941 struct tid_info
*t
= lldi
->tids
;
942 unsigned int status
= ntohl(rpl
->ddpvld
);
944 csk
= lookup_tid(t
, tid
);
945 if (unlikely(!csk
)) {
946 pr_err("can't find connection for tid %u.\n", tid
);
950 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_PDU_RX
,
951 "csk 0x%p,%u,0x%lx, skb 0x%p,0x%x, lhdr 0x%p.\n",
952 csk
, csk
->state
, csk
->flags
, skb
, status
, csk
->skb_ulp_lhdr
);
954 spin_lock_bh(&csk
->lock
);
956 if (unlikely(csk
->state
>= CTP_PASSIVE_CLOSE
)) {
957 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
958 "csk 0x%p,%u,0x%lx,%u, bad state.\n",
959 csk
, csk
->state
, csk
->flags
, csk
->tid
);
960 if (csk
->state
!= CTP_ABORTING
)
966 if (!csk
->skb_ulp_lhdr
) {
967 pr_err("tid 0x%x, rcv RX_DATA_DDP w/o pdu bhs.\n", csk
->tid
);
971 lskb
= csk
->skb_ulp_lhdr
;
972 csk
->skb_ulp_lhdr
= NULL
;
974 cxgbi_skcb_rx_ddigest(lskb
) = ntohl(rpl
->ulp_crc
);
976 if (ntohs(rpl
->len
) != cxgbi_skcb_rx_pdulen(lskb
))
977 pr_info("tid 0x%x, RX_DATA_DDP pdulen %u != %u.\n",
978 csk
->tid
, ntohs(rpl
->len
), cxgbi_skcb_rx_pdulen(lskb
));
980 if (status
& (1 << CPL_RX_DDP_STATUS_HCRC_SHIFT
)) {
981 pr_info("csk 0x%p, lhdr 0x%p, status 0x%x, hcrc bad 0x%lx.\n",
982 csk
, lskb
, status
, cxgbi_skcb_flags(lskb
));
983 cxgbi_skcb_set_flag(lskb
, SKCBF_RX_HCRC_ERR
);
985 if (status
& (1 << CPL_RX_DDP_STATUS_DCRC_SHIFT
)) {
986 pr_info("csk 0x%p, lhdr 0x%p, status 0x%x, dcrc bad 0x%lx.\n",
987 csk
, lskb
, status
, cxgbi_skcb_flags(lskb
));
988 cxgbi_skcb_set_flag(lskb
, SKCBF_RX_DCRC_ERR
);
990 if (status
& (1 << CPL_RX_DDP_STATUS_PAD_SHIFT
)) {
991 log_debug(1 << CXGBI_DBG_PDU_RX
,
992 "csk 0x%p, lhdr 0x%p, status 0x%x, pad bad.\n",
994 cxgbi_skcb_set_flag(lskb
, SKCBF_RX_PAD_ERR
);
996 if ((status
& (1 << CPL_RX_DDP_STATUS_DDP_SHIFT
)) &&
997 !cxgbi_skcb_test_flag(lskb
, SKCBF_RX_DATA
)) {
998 log_debug(1 << CXGBI_DBG_PDU_RX
,
999 "csk 0x%p, lhdr 0x%p, 0x%x, data ddp'ed.\n",
1001 cxgbi_skcb_set_flag(lskb
, SKCBF_RX_DATA_DDPD
);
1003 log_debug(1 << CXGBI_DBG_PDU_RX
,
1004 "csk 0x%p, lskb 0x%p, f 0x%lx.\n",
1005 csk
, lskb
, cxgbi_skcb_flags(lskb
));
1007 cxgbi_skcb_set_flag(lskb
, SKCBF_RX_STATUS
);
1008 cxgbi_conn_pdu_ready(csk
);
1009 spin_unlock_bh(&csk
->lock
);
1013 send_abort_req(csk
);
1015 spin_unlock_bh(&csk
->lock
);
1020 static void do_fw4_ack(struct cxgbi_device
*cdev
, struct sk_buff
*skb
)
1022 struct cxgbi_sock
*csk
;
1023 struct cpl_fw4_ack
*rpl
= (struct cpl_fw4_ack
*)skb
->data
;
1024 unsigned int tid
= GET_TID(rpl
);
1025 struct cxgb4_lld_info
*lldi
= cxgbi_cdev_priv(cdev
);
1026 struct tid_info
*t
= lldi
->tids
;
1028 csk
= lookup_tid(t
, tid
);
1030 pr_err("can't find connection for tid %u.\n", tid
);
1032 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
1033 "csk 0x%p,%u,0x%lx,%u.\n",
1034 csk
, csk
->state
, csk
->flags
, csk
->tid
);
1035 cxgbi_sock_rcv_wr_ack(csk
, rpl
->credits
, ntohl(rpl
->snd_una
),
1041 static void do_set_tcb_rpl(struct cxgbi_device
*cdev
, struct sk_buff
*skb
)
1043 struct cpl_set_tcb_rpl
*rpl
= (struct cpl_set_tcb_rpl
*)skb
->data
;
1044 unsigned int tid
= GET_TID(rpl
);
1045 struct cxgb4_lld_info
*lldi
= cxgbi_cdev_priv(cdev
);
1046 struct tid_info
*t
= lldi
->tids
;
1047 struct cxgbi_sock
*csk
;
1049 csk
= lookup_tid(t
, tid
);
1051 pr_err("can't find conn. for tid %u.\n", tid
);
1053 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
1054 "csk 0x%p,%u,%lx,%u, status 0x%x.\n",
1055 csk
, csk
->state
, csk
->flags
, csk
->tid
, rpl
->status
);
1057 if (rpl
->status
!= CPL_ERR_NONE
)
1058 pr_err("csk 0x%p,%u, SET_TCB_RPL status %u.\n",
1059 csk
, tid
, rpl
->status
);
1064 static int alloc_cpls(struct cxgbi_sock
*csk
)
1066 csk
->cpl_close
= alloc_wr(sizeof(struct cpl_close_con_req
),
1068 if (!csk
->cpl_close
)
1071 csk
->cpl_abort_req
= alloc_wr(sizeof(struct cpl_abort_req
),
1073 if (!csk
->cpl_abort_req
)
1076 csk
->cpl_abort_rpl
= alloc_wr(sizeof(struct cpl_abort_rpl
),
1078 if (!csk
->cpl_abort_rpl
)
1083 cxgbi_sock_free_cpl_skbs(csk
);
1087 static inline void l2t_put(struct cxgbi_sock
*csk
)
1090 cxgb4_l2t_release(csk
->l2t
);
1092 cxgbi_sock_put(csk
);
1096 static void release_offload_resources(struct cxgbi_sock
*csk
)
1098 struct cxgb4_lld_info
*lldi
;
1100 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
1101 "csk 0x%p,%u,0x%lx,%u.\n",
1102 csk
, csk
->state
, csk
->flags
, csk
->tid
);
1104 cxgbi_sock_free_cpl_skbs(csk
);
1105 if (csk
->wr_cred
!= csk
->wr_max_cred
) {
1106 cxgbi_sock_purge_wr_queue(csk
);
1107 cxgbi_sock_reset_wr_list(csk
);
1111 if (cxgbi_sock_flag(csk
, CTPF_HAS_ATID
))
1113 else if (cxgbi_sock_flag(csk
, CTPF_HAS_TID
)) {
1114 lldi
= cxgbi_cdev_priv(csk
->cdev
);
1115 cxgb4_remove_tid(lldi
->tids
, 0, csk
->tid
);
1116 cxgbi_sock_clear_flag(csk
, CTPF_HAS_TID
);
1117 cxgbi_sock_put(csk
);
1123 static int init_act_open(struct cxgbi_sock
*csk
)
1125 struct cxgbi_device
*cdev
= csk
->cdev
;
1126 struct cxgb4_lld_info
*lldi
= cxgbi_cdev_priv(cdev
);
1127 struct net_device
*ndev
= cdev
->ports
[csk
->port_id
];
1128 struct port_info
*pi
= netdev_priv(ndev
);
1129 struct sk_buff
*skb
= NULL
;
1130 struct neighbour
*n
;
1133 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
1134 "csk 0x%p,%u,0x%lx,%u.\n",
1135 csk
, csk
->state
, csk
->flags
, csk
->tid
);
1137 csk
->atid
= cxgb4_alloc_atid(lldi
->tids
, csk
);
1138 if (csk
->atid
< 0) {
1139 pr_err("%s, NO atid available.\n", ndev
->name
);
1142 cxgbi_sock_set_flag(csk
, CTPF_HAS_ATID
);
1143 cxgbi_sock_get(csk
);
1145 n
= dst_get_neighbour_noref(csk
->dst
);
1147 pr_err("%s, can't get neighbour of csk->dst.\n", ndev
->name
);
1150 csk
->l2t
= cxgb4_l2t_get(lldi
->l2t
, n
, ndev
, 0);
1152 pr_err("%s, cannot alloc l2t.\n", ndev
->name
);
1155 cxgbi_sock_get(csk
);
1157 skb
= alloc_wr(sizeof(struct cpl_act_open_req
), 0, GFP_KERNEL
);
1160 skb
->sk
= (struct sock
*)csk
;
1161 t4_set_arp_err_handler(skb
, csk
, cxgbi_sock_act_open_req_arp_failure
);
1164 csk
->mtu
= dst_mtu(csk
->dst
);
1165 cxgb4_best_mtu(lldi
->mtus
, csk
->mtu
, &csk
->mss_idx
);
1166 csk
->tx_chan
= cxgb4_port_chan(ndev
);
1167 /* SMT two entries per row */
1168 csk
->smac_idx
= ((cxgb4_port_viid(ndev
) & 0x7F)) << 1;
1169 step
= lldi
->ntxq
/ lldi
->nchan
;
1170 csk
->txq_idx
= cxgb4_port_idx(ndev
) * step
;
1171 step
= lldi
->nrxq
/ lldi
->nchan
;
1172 csk
->rss_qid
= lldi
->rxq_ids
[cxgb4_port_idx(ndev
) * step
];
1173 csk
->wr_max_cred
= csk
->wr_cred
= lldi
->wr_cred
;
1174 csk
->wr_una_cred
= 0;
1175 cxgbi_sock_reset_wr_list(csk
);
1177 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
1178 "csk 0x%p,p%d,%s, %u,%u,%u, mss %u,%u, smac %u.\n",
1179 csk
, pi
->port_id
, ndev
->name
, csk
->tx_chan
,
1180 csk
->txq_idx
, csk
->rss_qid
, csk
->mtu
, csk
->mss_idx
,
1183 cxgbi_sock_set_state(csk
, CTP_ACTIVE_OPEN
);
1184 send_act_open_req(csk
, skb
, csk
->l2t
);
1193 cxgb4i_cplhandler_func cxgb4i_cplhandlers
[NUM_CPL_CMDS
] = {
1194 [CPL_ACT_ESTABLISH
] = do_act_establish
,
1195 [CPL_ACT_OPEN_RPL
] = do_act_open_rpl
,
1196 [CPL_PEER_CLOSE
] = do_peer_close
,
1197 [CPL_ABORT_REQ_RSS
] = do_abort_req_rss
,
1198 [CPL_ABORT_RPL_RSS
] = do_abort_rpl_rss
,
1199 [CPL_CLOSE_CON_RPL
] = do_close_con_rpl
,
1200 [CPL_FW4_ACK
] = do_fw4_ack
,
1201 [CPL_ISCSI_HDR
] = do_rx_iscsi_hdr
,
1202 [CPL_SET_TCB_RPL
] = do_set_tcb_rpl
,
1203 [CPL_RX_DATA_DDP
] = do_rx_data_ddp
,
1206 int cxgb4i_ofld_init(struct cxgbi_device
*cdev
)
1210 if (cxgb4i_max_connect
> CXGB4I_MAX_CONN
)
1211 cxgb4i_max_connect
= CXGB4I_MAX_CONN
;
1213 rc
= cxgbi_device_portmap_create(cdev
, cxgb4i_sport_base
,
1214 cxgb4i_max_connect
);
1218 cdev
->csk_release_offload_resources
= release_offload_resources
;
1219 cdev
->csk_push_tx_frames
= push_tx_frames
;
1220 cdev
->csk_send_abort_req
= send_abort_req
;
1221 cdev
->csk_send_close_req
= send_close_req
;
1222 cdev
->csk_send_rx_credits
= send_rx_credits
;
1223 cdev
->csk_alloc_cpls
= alloc_cpls
;
1224 cdev
->csk_init_act_open
= init_act_open
;
1226 pr_info("cdev 0x%p, offload up, added.\n", cdev
);
1231 * functions to program the pagepod in h/w
1233 #define ULPMEM_IDATA_MAX_NPPODS 4 /* 256/PPOD_SIZE */
1234 static inline void ulp_mem_io_set_hdr(struct ulp_mem_io
*req
,
1235 unsigned int wr_len
, unsigned int dlen
,
1236 unsigned int pm_addr
)
1238 struct ulptx_idata
*idata
= (struct ulptx_idata
*)(req
+ 1);
1240 INIT_ULPTX_WR(req
, wr_len
, 0, 0);
1241 req
->cmd
= htonl(ULPTX_CMD(ULP_TX_MEM_WRITE
) | (1 << 23));
1242 req
->dlen
= htonl(ULP_MEMIO_DATA_LEN(dlen
>> 5));
1243 req
->lock_addr
= htonl(ULP_MEMIO_ADDR(pm_addr
>> 5));
1244 req
->len16
= htonl(DIV_ROUND_UP(wr_len
- sizeof(req
->wr
), 16));
1246 idata
->cmd_more
= htonl(ULPTX_CMD(ULP_TX_SC_IMM
));
1247 idata
->len
= htonl(dlen
);
1250 static int ddp_ppod_write_idata(struct cxgbi_device
*cdev
, unsigned int port_id
,
1251 struct cxgbi_pagepod_hdr
*hdr
, unsigned int idx
,
1253 struct cxgbi_gather_list
*gl
,
1254 unsigned int gl_pidx
)
1256 struct cxgbi_ddp_info
*ddp
= cdev
->ddp
;
1257 struct sk_buff
*skb
;
1258 struct ulp_mem_io
*req
;
1259 struct ulptx_idata
*idata
;
1260 struct cxgbi_pagepod
*ppod
;
1261 unsigned int pm_addr
= idx
* PPOD_SIZE
+ ddp
->llimit
;
1262 unsigned int dlen
= PPOD_SIZE
* npods
;
1263 unsigned int wr_len
= roundup(sizeof(struct ulp_mem_io
) +
1264 sizeof(struct ulptx_idata
) + dlen
, 16);
1267 skb
= alloc_wr(wr_len
, 0, GFP_ATOMIC
);
1269 pr_err("cdev 0x%p, idx %u, npods %u, OOM.\n",
1273 req
= (struct ulp_mem_io
*)skb
->head
;
1274 set_queue(skb
, CPL_PRIORITY_CONTROL
, NULL
);
1276 ulp_mem_io_set_hdr(req
, wr_len
, dlen
, pm_addr
);
1277 idata
= (struct ulptx_idata
*)(req
+ 1);
1278 ppod
= (struct cxgbi_pagepod
*)(idata
+ 1);
1280 for (i
= 0; i
< npods
; i
++, ppod
++, gl_pidx
+= PPOD_PAGES_MAX
) {
1282 cxgbi_ddp_ppod_clear(ppod
);
1284 cxgbi_ddp_ppod_set(ppod
, hdr
, gl
, gl_pidx
);
1287 cxgb4_ofld_send(cdev
->ports
[port_id
], skb
);
1291 static int ddp_set_map(struct cxgbi_sock
*csk
, struct cxgbi_pagepod_hdr
*hdr
,
1292 unsigned int idx
, unsigned int npods
,
1293 struct cxgbi_gather_list
*gl
)
1295 unsigned int i
, cnt
;
1298 for (i
= 0; i
< npods
; i
+= cnt
, idx
+= cnt
) {
1300 if (cnt
> ULPMEM_IDATA_MAX_NPPODS
)
1301 cnt
= ULPMEM_IDATA_MAX_NPPODS
;
1302 err
= ddp_ppod_write_idata(csk
->cdev
, csk
->port_id
, hdr
,
1303 idx
, cnt
, gl
, 4 * i
);
1310 static void ddp_clear_map(struct cxgbi_hba
*chba
, unsigned int tag
,
1311 unsigned int idx
, unsigned int npods
)
1313 unsigned int i
, cnt
;
1316 for (i
= 0; i
< npods
; i
+= cnt
, idx
+= cnt
) {
1318 if (cnt
> ULPMEM_IDATA_MAX_NPPODS
)
1319 cnt
= ULPMEM_IDATA_MAX_NPPODS
;
1320 err
= ddp_ppod_write_idata(chba
->cdev
, chba
->port_id
, NULL
,
1327 static int ddp_setup_conn_pgidx(struct cxgbi_sock
*csk
, unsigned int tid
,
1328 int pg_idx
, bool reply
)
1330 struct sk_buff
*skb
;
1331 struct cpl_set_tcb_field
*req
;
1333 if (!pg_idx
|| pg_idx
>= DDP_PGIDX_MAX
)
1336 skb
= alloc_wr(sizeof(*req
), 0, GFP_KERNEL
);
1340 /* set up ulp page size */
1341 req
= (struct cpl_set_tcb_field
*)skb
->head
;
1342 INIT_TP_WR(req
, csk
->tid
);
1343 OPCODE_TID(req
) = htonl(MK_OPCODE_TID(CPL_SET_TCB_FIELD
, csk
->tid
));
1344 req
->reply_ctrl
= htons(NO_REPLY(reply
) | QUEUENO(csk
->rss_qid
));
1345 req
->word_cookie
= htons(0);
1346 req
->mask
= cpu_to_be64(0x3 << 8);
1347 req
->val
= cpu_to_be64(pg_idx
<< 8);
1348 set_wr_txq(skb
, CPL_PRIORITY_CONTROL
, csk
->port_id
);
1350 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
1351 "csk 0x%p, tid 0x%x, pg_idx %u.\n", csk
, csk
->tid
, pg_idx
);
1353 cxgb4_ofld_send(csk
->cdev
->ports
[csk
->port_id
], skb
);
1357 static int ddp_setup_conn_digest(struct cxgbi_sock
*csk
, unsigned int tid
,
1358 int hcrc
, int dcrc
, int reply
)
1360 struct sk_buff
*skb
;
1361 struct cpl_set_tcb_field
*req
;
1366 skb
= alloc_wr(sizeof(*req
), 0, GFP_KERNEL
);
1370 csk
->hcrc_len
= (hcrc
? 4 : 0);
1371 csk
->dcrc_len
= (dcrc
? 4 : 0);
1372 /* set up ulp submode */
1373 req
= (struct cpl_set_tcb_field
*)skb
->head
;
1374 INIT_TP_WR(req
, tid
);
1375 OPCODE_TID(req
) = htonl(MK_OPCODE_TID(CPL_SET_TCB_FIELD
, tid
));
1376 req
->reply_ctrl
= htons(NO_REPLY(reply
) | QUEUENO(csk
->rss_qid
));
1377 req
->word_cookie
= htons(0);
1378 req
->mask
= cpu_to_be64(0x3 << 4);
1379 req
->val
= cpu_to_be64(((hcrc
? ULP_CRC_HEADER
: 0) |
1380 (dcrc
? ULP_CRC_DATA
: 0)) << 4);
1381 set_wr_txq(skb
, CPL_PRIORITY_CONTROL
, csk
->port_id
);
1383 log_debug(1 << CXGBI_DBG_TOE
| 1 << CXGBI_DBG_SOCK
,
1384 "csk 0x%p, tid 0x%x, crc %d,%d.\n", csk
, csk
->tid
, hcrc
, dcrc
);
1386 cxgb4_ofld_send(csk
->cdev
->ports
[csk
->port_id
], skb
);
1390 static int cxgb4i_ddp_init(struct cxgbi_device
*cdev
)
1392 struct cxgb4_lld_info
*lldi
= cxgbi_cdev_priv(cdev
);
1393 struct cxgbi_ddp_info
*ddp
= cdev
->ddp
;
1394 unsigned int tagmask
, pgsz_factor
[4];
1398 kref_get(&ddp
->refcnt
);
1399 pr_warn("cdev 0x%p, ddp 0x%p already set up.\n",
1404 err
= cxgbi_ddp_init(cdev
, lldi
->vr
->iscsi
.start
,
1405 lldi
->vr
->iscsi
.start
+ lldi
->vr
->iscsi
.size
- 1,
1406 lldi
->iscsi_iolen
, lldi
->iscsi_iolen
);
1412 tagmask
= ddp
->idx_mask
<< PPOD_IDX_SHIFT
;
1413 cxgbi_ddp_page_size_factor(pgsz_factor
);
1414 cxgb4_iscsi_init(lldi
->ports
[0], tagmask
, pgsz_factor
);
1416 cdev
->csk_ddp_setup_digest
= ddp_setup_conn_digest
;
1417 cdev
->csk_ddp_setup_pgidx
= ddp_setup_conn_pgidx
;
1418 cdev
->csk_ddp_set
= ddp_set_map
;
1419 cdev
->csk_ddp_clear
= ddp_clear_map
;
1421 pr_info("cxgb4i 0x%p tag: sw %u, rsvd %u,%u, mask 0x%x.\n",
1422 cdev
, cdev
->tag_format
.sw_bits
, cdev
->tag_format
.rsvd_bits
,
1423 cdev
->tag_format
.rsvd_shift
, cdev
->tag_format
.rsvd_mask
);
1424 pr_info("cxgb4i 0x%p, nppods %u, bits %u, mask 0x%x,0x%x pkt %u/%u, "
1426 cdev
, ddp
->nppods
, ddp
->idx_bits
, ddp
->idx_mask
,
1427 ddp
->rsvd_tag_mask
, ddp
->max_txsz
, lldi
->iscsi_iolen
,
1428 ddp
->max_rxsz
, lldi
->iscsi_iolen
);
1429 pr_info("cxgb4i 0x%p max payload size: %u/%u, %u/%u.\n",
1430 cdev
, cdev
->tx_max_size
, ddp
->max_txsz
, cdev
->rx_max_size
,
1435 static void *t4_uld_add(const struct cxgb4_lld_info
*lldi
)
1437 struct cxgbi_device
*cdev
;
1438 struct port_info
*pi
;
1441 cdev
= cxgbi_device_register(sizeof(*lldi
), lldi
->nports
);
1443 pr_info("t4 device 0x%p, register failed.\n", lldi
);
1446 pr_info("0x%p,0x%x, ports %u,%s, chan %u, q %u,%u, wr %u.\n",
1447 cdev
, lldi
->adapter_type
, lldi
->nports
,
1448 lldi
->ports
[0]->name
, lldi
->nchan
, lldi
->ntxq
,
1449 lldi
->nrxq
, lldi
->wr_cred
);
1450 for (i
= 0; i
< lldi
->nrxq
; i
++)
1451 log_debug(1 << CXGBI_DBG_DEV
,
1452 "t4 0x%p, rxq id #%d: %u.\n",
1453 cdev
, i
, lldi
->rxq_ids
[i
]);
1455 memcpy(cxgbi_cdev_priv(cdev
), lldi
, sizeof(*lldi
));
1456 cdev
->flags
= CXGBI_FLAG_DEV_T4
;
1457 cdev
->pdev
= lldi
->pdev
;
1458 cdev
->ports
= lldi
->ports
;
1459 cdev
->nports
= lldi
->nports
;
1460 cdev
->mtus
= lldi
->mtus
;
1461 cdev
->nmtus
= NMTUS
;
1462 cdev
->snd_win
= cxgb4i_snd_win
;
1463 cdev
->rcv_win
= cxgb4i_rcv_win
;
1464 cdev
->rx_credit_thres
= cxgb4i_rx_credit_thres
;
1465 cdev
->skb_tx_rsvd
= CXGB4I_TX_HEADER_LEN
;
1466 cdev
->skb_rx_extra
= sizeof(struct cpl_iscsi_hdr
);
1467 cdev
->itp
= &cxgb4i_iscsi_transport
;
1469 cdev
->pfvf
= FW_VIID_PFN_GET(cxgb4_port_viid(lldi
->ports
[0])) << 8;
1470 pr_info("cdev 0x%p,%s, pfvf %u.\n",
1471 cdev
, lldi
->ports
[0]->name
, cdev
->pfvf
);
1473 rc
= cxgb4i_ddp_init(cdev
);
1475 pr_info("t4 0x%p ddp init failed.\n", cdev
);
1478 rc
= cxgb4i_ofld_init(cdev
);
1480 pr_info("t4 0x%p ofld init failed.\n", cdev
);
1484 rc
= cxgbi_hbas_add(cdev
, CXGB4I_MAX_LUN
, CXGBI_MAX_CONN
,
1485 &cxgb4i_host_template
, cxgb4i_stt
);
1489 for (i
= 0; i
< cdev
->nports
; i
++) {
1490 pi
= netdev_priv(lldi
->ports
[i
]);
1491 cdev
->hbas
[i
]->port_id
= pi
->port_id
;
1496 cxgbi_device_unregister(cdev
);
1497 return ERR_PTR(-ENOMEM
);
1500 #define RX_PULL_LEN 128
1501 static int t4_uld_rx_handler(void *handle
, const __be64
*rsp
,
1502 const struct pkt_gl
*pgl
)
1504 const struct cpl_act_establish
*rpl
;
1505 struct sk_buff
*skb
;
1507 struct cxgbi_device
*cdev
= handle
;
1510 unsigned int len
= 64 - sizeof(struct rsp_ctrl
) - 8;
1512 skb
= alloc_wr(len
, 0, GFP_ATOMIC
);
1515 skb_copy_to_linear_data(skb
, &rsp
[1], len
);
1517 if (unlikely(*(u8
*)rsp
!= *(u8
*)pgl
->va
)) {
1518 pr_info("? FL 0x%p,RSS%#llx,FL %#llx,len %u.\n",
1519 pgl
->va
, be64_to_cpu(*rsp
),
1520 be64_to_cpu(*(u64
*)pgl
->va
),
1524 skb
= cxgb4_pktgl_to_skb(pgl
, RX_PULL_LEN
, RX_PULL_LEN
);
1529 rpl
= (struct cpl_act_establish
*)skb
->data
;
1530 opc
= rpl
->ot
.opcode
;
1531 log_debug(1 << CXGBI_DBG_TOE
,
1532 "cdev %p, opcode 0x%x(0x%x,0x%x), skb %p.\n",
1533 cdev
, opc
, rpl
->ot
.opcode_tid
, ntohl(rpl
->ot
.opcode_tid
), skb
);
1534 if (cxgb4i_cplhandlers
[opc
])
1535 cxgb4i_cplhandlers
[opc
](cdev
, skb
);
1537 pr_err("No handler for opcode 0x%x.\n", opc
);
1542 log_debug(1 << CXGBI_DBG_TOE
, "OOM bailing out.\n");
1546 static int t4_uld_state_change(void *handle
, enum cxgb4_state state
)
1548 struct cxgbi_device
*cdev
= handle
;
1551 case CXGB4_STATE_UP
:
1552 pr_info("cdev 0x%p, UP.\n", cdev
);
1555 case CXGB4_STATE_START_RECOVERY
:
1556 pr_info("cdev 0x%p, RECOVERY.\n", cdev
);
1557 /* close all connections */
1559 case CXGB4_STATE_DOWN
:
1560 pr_info("cdev 0x%p, DOWN.\n", cdev
);
1562 case CXGB4_STATE_DETACH
:
1563 pr_info("cdev 0x%p, DETACH.\n", cdev
);
1566 pr_info("cdev 0x%p, unknown state %d.\n", cdev
, state
);
1572 static int __init
cxgb4i_init_module(void)
1576 printk(KERN_INFO
"%s", version
);
1578 rc
= cxgbi_iscsi_init(&cxgb4i_iscsi_transport
, &cxgb4i_stt
);
1581 cxgb4_register_uld(CXGB4_ULD_ISCSI
, &cxgb4i_uld_info
);
1585 static void __exit
cxgb4i_exit_module(void)
1587 cxgb4_unregister_uld(CXGB4_ULD_ISCSI
);
1588 cxgbi_device_unregister_all(CXGBI_FLAG_DEV_T4
);
1589 cxgbi_iscsi_cleanup(&cxgb4i_iscsi_transport
, &cxgb4i_stt
);
1592 module_init(cxgb4i_init_module
);
1593 module_exit(cxgb4i_exit_module
);