17b36b6e0Skxie@chelsio.com /* 27b36b6e0Skxie@chelsio.com * cxgb4i.c: Chelsio T4 iSCSI driver. 37b36b6e0Skxie@chelsio.com * 47b36b6e0Skxie@chelsio.com * Copyright (c) 2010 Chelsio Communications, Inc. 57b36b6e0Skxie@chelsio.com * 67b36b6e0Skxie@chelsio.com * This program is free software; you can redistribute it and/or modify 77b36b6e0Skxie@chelsio.com * it under the terms of the GNU General Public License as published by 87b36b6e0Skxie@chelsio.com * the Free Software Foundation. 97b36b6e0Skxie@chelsio.com * 107b36b6e0Skxie@chelsio.com * Written by: Karen Xie (kxie@chelsio.com) 117b36b6e0Skxie@chelsio.com * Rakesh Ranjan (rranjan@chelsio.com) 127b36b6e0Skxie@chelsio.com */ 137b36b6e0Skxie@chelsio.com 147b36b6e0Skxie@chelsio.com #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__ 157b36b6e0Skxie@chelsio.com 167b36b6e0Skxie@chelsio.com #include <linux/version.h> 177b36b6e0Skxie@chelsio.com #include <linux/module.h> 187b36b6e0Skxie@chelsio.com #include <linux/moduleparam.h> 197b36b6e0Skxie@chelsio.com #include <scsi/scsi_host.h> 207b36b6e0Skxie@chelsio.com #include <net/tcp.h> 217b36b6e0Skxie@chelsio.com #include <net/dst.h> 227b36b6e0Skxie@chelsio.com #include <linux/netdevice.h> 237b36b6e0Skxie@chelsio.com 247b36b6e0Skxie@chelsio.com #include "t4_msg.h" 257b36b6e0Skxie@chelsio.com #include "cxgb4.h" 267b36b6e0Skxie@chelsio.com #include "cxgb4_uld.h" 277b36b6e0Skxie@chelsio.com #include "t4fw_api.h" 287b36b6e0Skxie@chelsio.com #include "l2t.h" 297b36b6e0Skxie@chelsio.com #include "cxgb4i.h" 307b36b6e0Skxie@chelsio.com 317b36b6e0Skxie@chelsio.com static unsigned int dbg_level; 327b36b6e0Skxie@chelsio.com 337b36b6e0Skxie@chelsio.com #include "../libcxgbi.h" 347b36b6e0Skxie@chelsio.com 357b36b6e0Skxie@chelsio.com #define DRV_MODULE_NAME "cxgb4i" 367b36b6e0Skxie@chelsio.com #define DRV_MODULE_DESC "Chelsio T4 iSCSI Driver" 37e27d6169Skxie@chelsio.com #define DRV_MODULE_VERSION "0.9.1" 38e27d6169Skxie@chelsio.com #define DRV_MODULE_RELDATE "Aug. 2010" 397b36b6e0Skxie@chelsio.com 407b36b6e0Skxie@chelsio.com static char version[] = 417b36b6e0Skxie@chelsio.com DRV_MODULE_DESC " " DRV_MODULE_NAME 427b36b6e0Skxie@chelsio.com " v" DRV_MODULE_VERSION " (" DRV_MODULE_RELDATE ")\n"; 437b36b6e0Skxie@chelsio.com 447b36b6e0Skxie@chelsio.com MODULE_AUTHOR("Chelsio Communications, Inc."); 457b36b6e0Skxie@chelsio.com MODULE_DESCRIPTION(DRV_MODULE_DESC); 467b36b6e0Skxie@chelsio.com MODULE_VERSION(DRV_MODULE_VERSION); 477b36b6e0Skxie@chelsio.com MODULE_LICENSE("GPL"); 487b36b6e0Skxie@chelsio.com 497b36b6e0Skxie@chelsio.com module_param(dbg_level, uint, 0644); 507b36b6e0Skxie@chelsio.com MODULE_PARM_DESC(dbg_level, "Debug flag (default=0)"); 517b36b6e0Skxie@chelsio.com 527b36b6e0Skxie@chelsio.com static int cxgb4i_rcv_win = 256 * 1024; 537b36b6e0Skxie@chelsio.com module_param(cxgb4i_rcv_win, int, 0644); 547b36b6e0Skxie@chelsio.com MODULE_PARM_DESC(cxgb4i_rcv_win, "TCP reveive window in bytes"); 557b36b6e0Skxie@chelsio.com 567b36b6e0Skxie@chelsio.com static int cxgb4i_snd_win = 128 * 1024; 577b36b6e0Skxie@chelsio.com module_param(cxgb4i_snd_win, int, 0644); 587b36b6e0Skxie@chelsio.com MODULE_PARM_DESC(cxgb4i_snd_win, "TCP send window in bytes"); 597b36b6e0Skxie@chelsio.com 607b36b6e0Skxie@chelsio.com static int cxgb4i_rx_credit_thres = 10 * 1024; 617b36b6e0Skxie@chelsio.com module_param(cxgb4i_rx_credit_thres, int, 0644); 627b36b6e0Skxie@chelsio.com MODULE_PARM_DESC(cxgb4i_rx_credit_thres, 637b36b6e0Skxie@chelsio.com "RX credits return threshold in bytes (default=10KB)"); 647b36b6e0Skxie@chelsio.com 657b36b6e0Skxie@chelsio.com static unsigned int cxgb4i_max_connect = (8 * 1024); 667b36b6e0Skxie@chelsio.com module_param(cxgb4i_max_connect, uint, 0644); 677b36b6e0Skxie@chelsio.com MODULE_PARM_DESC(cxgb4i_max_connect, "Maximum number of connections"); 687b36b6e0Skxie@chelsio.com 697b36b6e0Skxie@chelsio.com static unsigned short cxgb4i_sport_base = 20000; 707b36b6e0Skxie@chelsio.com module_param(cxgb4i_sport_base, ushort, 0644); 717b36b6e0Skxie@chelsio.com MODULE_PARM_DESC(cxgb4i_sport_base, "Starting port number (default 20000)"); 727b36b6e0Skxie@chelsio.com 737b36b6e0Skxie@chelsio.com typedef void (*cxgb4i_cplhandler_func)(struct cxgbi_device *, struct sk_buff *); 747b36b6e0Skxie@chelsio.com 757b36b6e0Skxie@chelsio.com static void *t4_uld_add(const struct cxgb4_lld_info *); 767b36b6e0Skxie@chelsio.com static int t4_uld_rx_handler(void *, const __be64 *, const struct pkt_gl *); 777b36b6e0Skxie@chelsio.com static int t4_uld_state_change(void *, enum cxgb4_state state); 787b36b6e0Skxie@chelsio.com 797b36b6e0Skxie@chelsio.com static const struct cxgb4_uld_info cxgb4i_uld_info = { 807b36b6e0Skxie@chelsio.com .name = DRV_MODULE_NAME, 817b36b6e0Skxie@chelsio.com .add = t4_uld_add, 827b36b6e0Skxie@chelsio.com .rx_handler = t4_uld_rx_handler, 837b36b6e0Skxie@chelsio.com .state_change = t4_uld_state_change, 847b36b6e0Skxie@chelsio.com }; 857b36b6e0Skxie@chelsio.com 867b36b6e0Skxie@chelsio.com static struct scsi_host_template cxgb4i_host_template = { 877b36b6e0Skxie@chelsio.com .module = THIS_MODULE, 887b36b6e0Skxie@chelsio.com .name = DRV_MODULE_NAME, 897b36b6e0Skxie@chelsio.com .proc_name = DRV_MODULE_NAME, 907b36b6e0Skxie@chelsio.com .can_queue = CXGB4I_SCSI_HOST_QDEPTH, 917b36b6e0Skxie@chelsio.com .queuecommand = iscsi_queuecommand, 927b36b6e0Skxie@chelsio.com .change_queue_depth = iscsi_change_queue_depth, 937b36b6e0Skxie@chelsio.com .sg_tablesize = SG_ALL, 947b36b6e0Skxie@chelsio.com .max_sectors = 0xFFFF, 957b36b6e0Skxie@chelsio.com .cmd_per_lun = ISCSI_DEF_CMD_PER_LUN, 967b36b6e0Skxie@chelsio.com .eh_abort_handler = iscsi_eh_abort, 977b36b6e0Skxie@chelsio.com .eh_device_reset_handler = iscsi_eh_device_reset, 987b36b6e0Skxie@chelsio.com .eh_target_reset_handler = iscsi_eh_recover_target, 997b36b6e0Skxie@chelsio.com .target_alloc = iscsi_target_alloc, 1007b36b6e0Skxie@chelsio.com .use_clustering = DISABLE_CLUSTERING, 1017b36b6e0Skxie@chelsio.com .this_id = -1, 1027b36b6e0Skxie@chelsio.com }; 1037b36b6e0Skxie@chelsio.com 1047b36b6e0Skxie@chelsio.com static struct iscsi_transport cxgb4i_iscsi_transport = { 1057b36b6e0Skxie@chelsio.com .owner = THIS_MODULE, 1067b36b6e0Skxie@chelsio.com .name = DRV_MODULE_NAME, 1077b36b6e0Skxie@chelsio.com .caps = CAP_RECOVERY_L0 | CAP_MULTI_R2T | CAP_HDRDGST | 1087b36b6e0Skxie@chelsio.com CAP_DATADGST | CAP_DIGEST_OFFLOAD | 109*fdafd4dfSMike Christie CAP_PADDING_OFFLOAD | CAP_TEXT_NEGO, 1107b36b6e0Skxie@chelsio.com .param_mask = ISCSI_MAX_RECV_DLENGTH | ISCSI_MAX_XMIT_DLENGTH | 1117b36b6e0Skxie@chelsio.com ISCSI_HDRDGST_EN | ISCSI_DATADGST_EN | 1127b36b6e0Skxie@chelsio.com ISCSI_INITIAL_R2T_EN | ISCSI_MAX_R2T | 1137b36b6e0Skxie@chelsio.com ISCSI_IMM_DATA_EN | ISCSI_FIRST_BURST | 1147b36b6e0Skxie@chelsio.com ISCSI_MAX_BURST | ISCSI_PDU_INORDER_EN | 1157b36b6e0Skxie@chelsio.com ISCSI_DATASEQ_INORDER_EN | ISCSI_ERL | 1167b36b6e0Skxie@chelsio.com ISCSI_CONN_PORT | ISCSI_CONN_ADDRESS | 1177b36b6e0Skxie@chelsio.com ISCSI_EXP_STATSN | ISCSI_PERSISTENT_PORT | 1187b36b6e0Skxie@chelsio.com ISCSI_PERSISTENT_ADDRESS | 1197b36b6e0Skxie@chelsio.com ISCSI_TARGET_NAME | ISCSI_TPGT | 1207b36b6e0Skxie@chelsio.com ISCSI_USERNAME | ISCSI_PASSWORD | 1217b36b6e0Skxie@chelsio.com ISCSI_USERNAME_IN | ISCSI_PASSWORD_IN | 1227b36b6e0Skxie@chelsio.com ISCSI_FAST_ABORT | ISCSI_ABORT_TMO | 1237b36b6e0Skxie@chelsio.com ISCSI_LU_RESET_TMO | ISCSI_TGT_RESET_TMO | 1247b36b6e0Skxie@chelsio.com ISCSI_PING_TMO | ISCSI_RECV_TMO | 1257b36b6e0Skxie@chelsio.com ISCSI_IFACE_NAME | ISCSI_INITIATOR_NAME, 1267b36b6e0Skxie@chelsio.com .host_param_mask = ISCSI_HOST_HWADDRESS | ISCSI_HOST_IPADDRESS | 1277b36b6e0Skxie@chelsio.com ISCSI_HOST_INITIATOR_NAME | 1287b36b6e0Skxie@chelsio.com ISCSI_HOST_NETDEV_NAME, 1297b36b6e0Skxie@chelsio.com .get_host_param = cxgbi_get_host_param, 1307b36b6e0Skxie@chelsio.com .set_host_param = cxgbi_set_host_param, 1317b36b6e0Skxie@chelsio.com /* session management */ 1327b36b6e0Skxie@chelsio.com .create_session = cxgbi_create_session, 1337b36b6e0Skxie@chelsio.com .destroy_session = cxgbi_destroy_session, 1347b36b6e0Skxie@chelsio.com .get_session_param = iscsi_session_get_param, 1357b36b6e0Skxie@chelsio.com /* connection management */ 1367b36b6e0Skxie@chelsio.com .create_conn = cxgbi_create_conn, 1377b36b6e0Skxie@chelsio.com .bind_conn = cxgbi_bind_conn, 1387b36b6e0Skxie@chelsio.com .destroy_conn = iscsi_tcp_conn_teardown, 1397b36b6e0Skxie@chelsio.com .start_conn = iscsi_conn_start, 1407b36b6e0Skxie@chelsio.com .stop_conn = iscsi_conn_stop, 1417b36b6e0Skxie@chelsio.com .get_conn_param = cxgbi_get_conn_param, 1427b36b6e0Skxie@chelsio.com .set_param = cxgbi_set_conn_param, 1437b36b6e0Skxie@chelsio.com .get_stats = cxgbi_get_conn_stats, 1447b36b6e0Skxie@chelsio.com /* pdu xmit req from user space */ 1457b36b6e0Skxie@chelsio.com .send_pdu = iscsi_conn_send_pdu, 1467b36b6e0Skxie@chelsio.com /* task */ 1477b36b6e0Skxie@chelsio.com .init_task = iscsi_tcp_task_init, 1487b36b6e0Skxie@chelsio.com .xmit_task = iscsi_tcp_task_xmit, 1497b36b6e0Skxie@chelsio.com .cleanup_task = cxgbi_cleanup_task, 1507b36b6e0Skxie@chelsio.com /* pdu */ 1517b36b6e0Skxie@chelsio.com .alloc_pdu = cxgbi_conn_alloc_pdu, 1527b36b6e0Skxie@chelsio.com .init_pdu = cxgbi_conn_init_pdu, 1537b36b6e0Skxie@chelsio.com .xmit_pdu = cxgbi_conn_xmit_pdu, 1547b36b6e0Skxie@chelsio.com .parse_pdu_itt = cxgbi_parse_pdu_itt, 1557b36b6e0Skxie@chelsio.com /* TCP connect/disconnect */ 1567b36b6e0Skxie@chelsio.com .ep_connect = cxgbi_ep_connect, 1577b36b6e0Skxie@chelsio.com .ep_poll = cxgbi_ep_poll, 1587b36b6e0Skxie@chelsio.com .ep_disconnect = cxgbi_ep_disconnect, 1597b36b6e0Skxie@chelsio.com /* Error recovery timeout call */ 1607b36b6e0Skxie@chelsio.com .session_recovery_timedout = iscsi_session_recovery_timedout, 1617b36b6e0Skxie@chelsio.com }; 1627b36b6e0Skxie@chelsio.com 1637b36b6e0Skxie@chelsio.com static struct scsi_transport_template *cxgb4i_stt; 1647b36b6e0Skxie@chelsio.com 1657b36b6e0Skxie@chelsio.com /* 1667b36b6e0Skxie@chelsio.com * CPL (Chelsio Protocol Language) defines a message passing interface between 1677b36b6e0Skxie@chelsio.com * the host driver and Chelsio asic. 1687b36b6e0Skxie@chelsio.com * The section below implments CPLs that related to iscsi tcp connection 1697b36b6e0Skxie@chelsio.com * open/close/abort and data send/receive. 1707b36b6e0Skxie@chelsio.com */ 1717b36b6e0Skxie@chelsio.com #define DIV_ROUND_UP(n, d) (((n) + (d) - 1) / (d)) 1727b36b6e0Skxie@chelsio.com #define RCV_BUFSIZ_MASK 0x3FFU 1737b36b6e0Skxie@chelsio.com #define MAX_IMM_TX_PKT_LEN 128 1747b36b6e0Skxie@chelsio.com 1757b36b6e0Skxie@chelsio.com static inline void set_queue(struct sk_buff *skb, unsigned int queue, 1767b36b6e0Skxie@chelsio.com const struct cxgbi_sock *csk) 1777b36b6e0Skxie@chelsio.com { 1787b36b6e0Skxie@chelsio.com skb->queue_mapping = queue; 1797b36b6e0Skxie@chelsio.com } 1807b36b6e0Skxie@chelsio.com 1817b36b6e0Skxie@chelsio.com static int push_tx_frames(struct cxgbi_sock *, int); 1827b36b6e0Skxie@chelsio.com 1837b36b6e0Skxie@chelsio.com /* 1847b36b6e0Skxie@chelsio.com * is_ofld_imm - check whether a packet can be sent as immediate data 1857b36b6e0Skxie@chelsio.com * @skb: the packet 1867b36b6e0Skxie@chelsio.com * 1877b36b6e0Skxie@chelsio.com * Returns true if a packet can be sent as an offload WR with immediate 1887b36b6e0Skxie@chelsio.com * data. We currently use the same limit as for Ethernet packets. 1897b36b6e0Skxie@chelsio.com */ 1907b36b6e0Skxie@chelsio.com static inline int is_ofld_imm(const struct sk_buff *skb) 1917b36b6e0Skxie@chelsio.com { 1927b36b6e0Skxie@chelsio.com return skb->len <= (MAX_IMM_TX_PKT_LEN - 1937b36b6e0Skxie@chelsio.com sizeof(struct fw_ofld_tx_data_wr)); 1947b36b6e0Skxie@chelsio.com } 1957b36b6e0Skxie@chelsio.com 1967b36b6e0Skxie@chelsio.com static void send_act_open_req(struct cxgbi_sock *csk, struct sk_buff *skb, 1977b36b6e0Skxie@chelsio.com struct l2t_entry *e) 1987b36b6e0Skxie@chelsio.com { 1997b36b6e0Skxie@chelsio.com struct cpl_act_open_req *req; 2007b36b6e0Skxie@chelsio.com int wscale = cxgbi_sock_compute_wscale(csk->mss_idx); 2017b36b6e0Skxie@chelsio.com unsigned long long opt0; 2027b36b6e0Skxie@chelsio.com unsigned int opt2; 2037b36b6e0Skxie@chelsio.com unsigned int qid_atid = ((unsigned int)csk->atid) | 2047b36b6e0Skxie@chelsio.com (((unsigned int)csk->rss_qid) << 14); 2057b36b6e0Skxie@chelsio.com 2067b36b6e0Skxie@chelsio.com opt0 = KEEP_ALIVE(1) | 2077b36b6e0Skxie@chelsio.com WND_SCALE(wscale) | 2087b36b6e0Skxie@chelsio.com MSS_IDX(csk->mss_idx) | 2097b36b6e0Skxie@chelsio.com L2T_IDX(((struct l2t_entry *)csk->l2t)->idx) | 2107b36b6e0Skxie@chelsio.com TX_CHAN(csk->tx_chan) | 2117b36b6e0Skxie@chelsio.com SMAC_SEL(csk->smac_idx) | 2127b36b6e0Skxie@chelsio.com ULP_MODE(ULP_MODE_ISCSI) | 2137b36b6e0Skxie@chelsio.com RCV_BUFSIZ(cxgb4i_rcv_win >> 10); 2147b36b6e0Skxie@chelsio.com opt2 = RX_CHANNEL(0) | 2157b36b6e0Skxie@chelsio.com RSS_QUEUE_VALID | 2167b36b6e0Skxie@chelsio.com (1 << 20) | (1 << 22) | 2177b36b6e0Skxie@chelsio.com RSS_QUEUE(csk->rss_qid); 2187b36b6e0Skxie@chelsio.com 2197b36b6e0Skxie@chelsio.com set_wr_txq(skb, CPL_PRIORITY_SETUP, csk->port_id); 2207b36b6e0Skxie@chelsio.com req = (struct cpl_act_open_req *)skb->head; 2217b36b6e0Skxie@chelsio.com 2227b36b6e0Skxie@chelsio.com INIT_TP_WR(req, 0); 2237b36b6e0Skxie@chelsio.com OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_ACT_OPEN_REQ, 2247b36b6e0Skxie@chelsio.com qid_atid)); 2257b36b6e0Skxie@chelsio.com req->local_port = csk->saddr.sin_port; 2267b36b6e0Skxie@chelsio.com req->peer_port = csk->daddr.sin_port; 2277b36b6e0Skxie@chelsio.com req->local_ip = csk->saddr.sin_addr.s_addr; 2287b36b6e0Skxie@chelsio.com req->peer_ip = csk->daddr.sin_addr.s_addr; 2297b36b6e0Skxie@chelsio.com req->opt0 = cpu_to_be64(opt0); 2307b36b6e0Skxie@chelsio.com req->params = 0; 2317b36b6e0Skxie@chelsio.com req->opt2 = cpu_to_be32(opt2); 2327b36b6e0Skxie@chelsio.com 2337b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 2347b36b6e0Skxie@chelsio.com "csk 0x%p, %pI4:%u-%pI4:%u, atid %d, qid %u.\n", 2357b36b6e0Skxie@chelsio.com csk, &req->local_ip, ntohs(req->local_port), 2367b36b6e0Skxie@chelsio.com &req->peer_ip, ntohs(req->peer_port), 2377b36b6e0Skxie@chelsio.com csk->atid, csk->rss_qid); 2387b36b6e0Skxie@chelsio.com 2397b36b6e0Skxie@chelsio.com cxgb4_l2t_send(csk->cdev->ports[csk->port_id], skb, csk->l2t); 2407b36b6e0Skxie@chelsio.com } 2417b36b6e0Skxie@chelsio.com 2427b36b6e0Skxie@chelsio.com static void send_close_req(struct cxgbi_sock *csk) 2437b36b6e0Skxie@chelsio.com { 2447b36b6e0Skxie@chelsio.com struct sk_buff *skb = csk->cpl_close; 2457b36b6e0Skxie@chelsio.com struct cpl_close_con_req *req = (struct cpl_close_con_req *)skb->head; 2467b36b6e0Skxie@chelsio.com unsigned int tid = csk->tid; 2477b36b6e0Skxie@chelsio.com 2487b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 2497b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, tid %u.\n", 2507b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 2517b36b6e0Skxie@chelsio.com csk->cpl_close = NULL; 2527b36b6e0Skxie@chelsio.com set_wr_txq(skb, CPL_PRIORITY_DATA, csk->port_id); 2537b36b6e0Skxie@chelsio.com INIT_TP_WR(req, tid); 2547b36b6e0Skxie@chelsio.com OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_CLOSE_CON_REQ, tid)); 2557b36b6e0Skxie@chelsio.com req->rsvd = 0; 2567b36b6e0Skxie@chelsio.com 2577b36b6e0Skxie@chelsio.com cxgbi_sock_skb_entail(csk, skb); 2587b36b6e0Skxie@chelsio.com if (csk->state >= CTP_ESTABLISHED) 2597b36b6e0Skxie@chelsio.com push_tx_frames(csk, 1); 2607b36b6e0Skxie@chelsio.com } 2617b36b6e0Skxie@chelsio.com 2627b36b6e0Skxie@chelsio.com static void abort_arp_failure(void *handle, struct sk_buff *skb) 2637b36b6e0Skxie@chelsio.com { 2647b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk = (struct cxgbi_sock *)handle; 2657b36b6e0Skxie@chelsio.com struct cpl_abort_req *req; 2667b36b6e0Skxie@chelsio.com 2677b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 2687b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, tid %u, abort.\n", 2697b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 2707b36b6e0Skxie@chelsio.com req = (struct cpl_abort_req *)skb->data; 2717b36b6e0Skxie@chelsio.com req->cmd = CPL_ABORT_NO_RST; 2727b36b6e0Skxie@chelsio.com cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb); 2737b36b6e0Skxie@chelsio.com } 2747b36b6e0Skxie@chelsio.com 2757b36b6e0Skxie@chelsio.com static void send_abort_req(struct cxgbi_sock *csk) 2767b36b6e0Skxie@chelsio.com { 2777b36b6e0Skxie@chelsio.com struct cpl_abort_req *req; 2787b36b6e0Skxie@chelsio.com struct sk_buff *skb = csk->cpl_abort_req; 2797b36b6e0Skxie@chelsio.com 2807b36b6e0Skxie@chelsio.com if (unlikely(csk->state == CTP_ABORTING) || !skb || !csk->cdev) 2817b36b6e0Skxie@chelsio.com return; 2827b36b6e0Skxie@chelsio.com cxgbi_sock_set_state(csk, CTP_ABORTING); 2837b36b6e0Skxie@chelsio.com cxgbi_sock_set_flag(csk, CTPF_ABORT_RPL_PENDING); 2847b36b6e0Skxie@chelsio.com cxgbi_sock_purge_write_queue(csk); 2857b36b6e0Skxie@chelsio.com 2867b36b6e0Skxie@chelsio.com csk->cpl_abort_req = NULL; 2877b36b6e0Skxie@chelsio.com req = (struct cpl_abort_req *)skb->head; 2887b36b6e0Skxie@chelsio.com set_queue(skb, CPL_PRIORITY_DATA, csk); 2897b36b6e0Skxie@chelsio.com req->cmd = CPL_ABORT_SEND_RST; 2907b36b6e0Skxie@chelsio.com t4_set_arp_err_handler(skb, csk, abort_arp_failure); 2917b36b6e0Skxie@chelsio.com INIT_TP_WR(req, csk->tid); 2927b36b6e0Skxie@chelsio.com OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_ABORT_REQ, csk->tid)); 2937b36b6e0Skxie@chelsio.com req->rsvd0 = htonl(csk->snd_nxt); 2947b36b6e0Skxie@chelsio.com req->rsvd1 = !cxgbi_sock_flag(csk, CTPF_TX_DATA_SENT); 2957b36b6e0Skxie@chelsio.com 2967b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 2977b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, snd_nxt %u, 0x%x.\n", 2987b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, csk->snd_nxt, 2997b36b6e0Skxie@chelsio.com req->rsvd1); 3007b36b6e0Skxie@chelsio.com 3017b36b6e0Skxie@chelsio.com cxgb4_l2t_send(csk->cdev->ports[csk->port_id], skb, csk->l2t); 3027b36b6e0Skxie@chelsio.com } 3037b36b6e0Skxie@chelsio.com 3047b36b6e0Skxie@chelsio.com static void send_abort_rpl(struct cxgbi_sock *csk, int rst_status) 3057b36b6e0Skxie@chelsio.com { 3067b36b6e0Skxie@chelsio.com struct sk_buff *skb = csk->cpl_abort_rpl; 3077b36b6e0Skxie@chelsio.com struct cpl_abort_rpl *rpl = (struct cpl_abort_rpl *)skb->head; 3087b36b6e0Skxie@chelsio.com 3097b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 3107b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, status %d.\n", 3117b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, rst_status); 3127b36b6e0Skxie@chelsio.com 3137b36b6e0Skxie@chelsio.com csk->cpl_abort_rpl = NULL; 3147b36b6e0Skxie@chelsio.com set_queue(skb, CPL_PRIORITY_DATA, csk); 3157b36b6e0Skxie@chelsio.com INIT_TP_WR(rpl, csk->tid); 3167b36b6e0Skxie@chelsio.com OPCODE_TID(rpl) = cpu_to_be32(MK_OPCODE_TID(CPL_ABORT_RPL, csk->tid)); 3177b36b6e0Skxie@chelsio.com rpl->cmd = rst_status; 3187b36b6e0Skxie@chelsio.com cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb); 3197b36b6e0Skxie@chelsio.com } 3207b36b6e0Skxie@chelsio.com 3217b36b6e0Skxie@chelsio.com /* 3227b36b6e0Skxie@chelsio.com * CPL connection rx data ack: host -> 3237b36b6e0Skxie@chelsio.com * Send RX credits through an RX_DATA_ACK CPL message. Returns the number of 3247b36b6e0Skxie@chelsio.com * credits sent. 3257b36b6e0Skxie@chelsio.com */ 3267b36b6e0Skxie@chelsio.com static u32 send_rx_credits(struct cxgbi_sock *csk, u32 credits) 3277b36b6e0Skxie@chelsio.com { 3287b36b6e0Skxie@chelsio.com struct sk_buff *skb; 3297b36b6e0Skxie@chelsio.com struct cpl_rx_data_ack *req; 3307b36b6e0Skxie@chelsio.com 3317b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX, 3327b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, credit %u.\n", 3337b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, credits); 3347b36b6e0Skxie@chelsio.com 33524d3f95aSkxie@chelsio.com skb = alloc_wr(sizeof(*req), 0, GFP_ATOMIC); 3367b36b6e0Skxie@chelsio.com if (!skb) { 3377b36b6e0Skxie@chelsio.com pr_info("csk 0x%p, credit %u, OOM.\n", csk, credits); 3387b36b6e0Skxie@chelsio.com return 0; 3397b36b6e0Skxie@chelsio.com } 3407b36b6e0Skxie@chelsio.com req = (struct cpl_rx_data_ack *)skb->head; 3417b36b6e0Skxie@chelsio.com 3427b36b6e0Skxie@chelsio.com set_wr_txq(skb, CPL_PRIORITY_ACK, csk->port_id); 3437b36b6e0Skxie@chelsio.com INIT_TP_WR(req, csk->tid); 3447b36b6e0Skxie@chelsio.com OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_RX_DATA_ACK, 3457b36b6e0Skxie@chelsio.com csk->tid)); 3467b36b6e0Skxie@chelsio.com req->credit_dack = cpu_to_be32(RX_CREDITS(credits) | RX_FORCE_ACK(1)); 3477b36b6e0Skxie@chelsio.com cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb); 3487b36b6e0Skxie@chelsio.com return credits; 3497b36b6e0Skxie@chelsio.com } 3507b36b6e0Skxie@chelsio.com 3517b36b6e0Skxie@chelsio.com /* 3527b36b6e0Skxie@chelsio.com * sgl_len - calculates the size of an SGL of the given capacity 3537b36b6e0Skxie@chelsio.com * @n: the number of SGL entries 3547b36b6e0Skxie@chelsio.com * Calculates the number of flits needed for a scatter/gather list that 3557b36b6e0Skxie@chelsio.com * can hold the given number of entries. 3567b36b6e0Skxie@chelsio.com */ 3577b36b6e0Skxie@chelsio.com static inline unsigned int sgl_len(unsigned int n) 3587b36b6e0Skxie@chelsio.com { 3597b36b6e0Skxie@chelsio.com n--; 3607b36b6e0Skxie@chelsio.com return (3 * n) / 2 + (n & 1) + 2; 3617b36b6e0Skxie@chelsio.com } 3627b36b6e0Skxie@chelsio.com 3637b36b6e0Skxie@chelsio.com /* 3647b36b6e0Skxie@chelsio.com * calc_tx_flits_ofld - calculate # of flits for an offload packet 3657b36b6e0Skxie@chelsio.com * @skb: the packet 3667b36b6e0Skxie@chelsio.com * 3677b36b6e0Skxie@chelsio.com * Returns the number of flits needed for the given offload packet. 3687b36b6e0Skxie@chelsio.com * These packets are already fully constructed and no additional headers 3697b36b6e0Skxie@chelsio.com * will be added. 3707b36b6e0Skxie@chelsio.com */ 3717b36b6e0Skxie@chelsio.com static inline unsigned int calc_tx_flits_ofld(const struct sk_buff *skb) 3727b36b6e0Skxie@chelsio.com { 3737b36b6e0Skxie@chelsio.com unsigned int flits, cnt; 3747b36b6e0Skxie@chelsio.com 3757b36b6e0Skxie@chelsio.com if (is_ofld_imm(skb)) 3767b36b6e0Skxie@chelsio.com return DIV_ROUND_UP(skb->len, 8); 3777b36b6e0Skxie@chelsio.com flits = skb_transport_offset(skb) / 8; 3787b36b6e0Skxie@chelsio.com cnt = skb_shinfo(skb)->nr_frags; 3797b36b6e0Skxie@chelsio.com if (skb->tail != skb->transport_header) 3807b36b6e0Skxie@chelsio.com cnt++; 3817b36b6e0Skxie@chelsio.com return flits + sgl_len(cnt); 3827b36b6e0Skxie@chelsio.com } 3837b36b6e0Skxie@chelsio.com 3847b36b6e0Skxie@chelsio.com static inline void send_tx_flowc_wr(struct cxgbi_sock *csk) 3857b36b6e0Skxie@chelsio.com { 3867b36b6e0Skxie@chelsio.com struct sk_buff *skb; 3877b36b6e0Skxie@chelsio.com struct fw_flowc_wr *flowc; 3887b36b6e0Skxie@chelsio.com int flowclen, i; 3897b36b6e0Skxie@chelsio.com 3907b36b6e0Skxie@chelsio.com flowclen = 80; 39124d3f95aSkxie@chelsio.com skb = alloc_wr(flowclen, 0, GFP_ATOMIC); 3927b36b6e0Skxie@chelsio.com flowc = (struct fw_flowc_wr *)skb->head; 3937b36b6e0Skxie@chelsio.com flowc->op_to_nparams = 3947b36b6e0Skxie@chelsio.com htonl(FW_WR_OP(FW_FLOWC_WR) | FW_FLOWC_WR_NPARAMS(8)); 3957b36b6e0Skxie@chelsio.com flowc->flowid_len16 = 3967b36b6e0Skxie@chelsio.com htonl(FW_WR_LEN16(DIV_ROUND_UP(72, 16)) | 3977b36b6e0Skxie@chelsio.com FW_WR_FLOWID(csk->tid)); 3987b36b6e0Skxie@chelsio.com flowc->mnemval[0].mnemonic = FW_FLOWC_MNEM_PFNVFN; 399e27d6169Skxie@chelsio.com flowc->mnemval[0].val = htonl(csk->cdev->pfvf); 4007b36b6e0Skxie@chelsio.com flowc->mnemval[1].mnemonic = FW_FLOWC_MNEM_CH; 4017b36b6e0Skxie@chelsio.com flowc->mnemval[1].val = htonl(csk->tx_chan); 4027b36b6e0Skxie@chelsio.com flowc->mnemval[2].mnemonic = FW_FLOWC_MNEM_PORT; 4037b36b6e0Skxie@chelsio.com flowc->mnemval[2].val = htonl(csk->tx_chan); 4047b36b6e0Skxie@chelsio.com flowc->mnemval[3].mnemonic = FW_FLOWC_MNEM_IQID; 4057b36b6e0Skxie@chelsio.com flowc->mnemval[3].val = htonl(csk->rss_qid); 4067b36b6e0Skxie@chelsio.com flowc->mnemval[4].mnemonic = FW_FLOWC_MNEM_SNDNXT; 4077b36b6e0Skxie@chelsio.com flowc->mnemval[4].val = htonl(csk->snd_nxt); 4087b36b6e0Skxie@chelsio.com flowc->mnemval[5].mnemonic = FW_FLOWC_MNEM_RCVNXT; 4097b36b6e0Skxie@chelsio.com flowc->mnemval[5].val = htonl(csk->rcv_nxt); 4107b36b6e0Skxie@chelsio.com flowc->mnemval[6].mnemonic = FW_FLOWC_MNEM_SNDBUF; 4117b36b6e0Skxie@chelsio.com flowc->mnemval[6].val = htonl(cxgb4i_snd_win); 4127b36b6e0Skxie@chelsio.com flowc->mnemval[7].mnemonic = FW_FLOWC_MNEM_MSS; 4137b36b6e0Skxie@chelsio.com flowc->mnemval[7].val = htonl(csk->advmss); 4147b36b6e0Skxie@chelsio.com flowc->mnemval[8].mnemonic = 0; 4157b36b6e0Skxie@chelsio.com flowc->mnemval[8].val = 0; 4167b36b6e0Skxie@chelsio.com for (i = 0; i < 9; i++) { 4177b36b6e0Skxie@chelsio.com flowc->mnemval[i].r4[0] = 0; 4187b36b6e0Skxie@chelsio.com flowc->mnemval[i].r4[1] = 0; 4197b36b6e0Skxie@chelsio.com flowc->mnemval[i].r4[2] = 0; 4207b36b6e0Skxie@chelsio.com } 4217b36b6e0Skxie@chelsio.com set_queue(skb, CPL_PRIORITY_DATA, csk); 4227b36b6e0Skxie@chelsio.com 4237b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 4247b36b6e0Skxie@chelsio.com "csk 0x%p, tid 0x%x, %u,%u,%u,%u,%u,%u,%u.\n", 4257b36b6e0Skxie@chelsio.com csk, csk->tid, 0, csk->tx_chan, csk->rss_qid, 4267b36b6e0Skxie@chelsio.com csk->snd_nxt, csk->rcv_nxt, cxgb4i_snd_win, 4277b36b6e0Skxie@chelsio.com csk->advmss); 4287b36b6e0Skxie@chelsio.com 4297b36b6e0Skxie@chelsio.com cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb); 4307b36b6e0Skxie@chelsio.com } 4317b36b6e0Skxie@chelsio.com 4327b36b6e0Skxie@chelsio.com static inline void make_tx_data_wr(struct cxgbi_sock *csk, struct sk_buff *skb, 4337b36b6e0Skxie@chelsio.com int dlen, int len, u32 credits, int compl) 4347b36b6e0Skxie@chelsio.com { 4357b36b6e0Skxie@chelsio.com struct fw_ofld_tx_data_wr *req; 4367b36b6e0Skxie@chelsio.com unsigned int submode = cxgbi_skcb_ulp_mode(skb) & 3; 4377b36b6e0Skxie@chelsio.com unsigned int wr_ulp_mode = 0; 4387b36b6e0Skxie@chelsio.com 4397b36b6e0Skxie@chelsio.com req = (struct fw_ofld_tx_data_wr *)__skb_push(skb, sizeof(*req)); 4407b36b6e0Skxie@chelsio.com 4417b36b6e0Skxie@chelsio.com if (is_ofld_imm(skb)) { 4427b36b6e0Skxie@chelsio.com req->op_to_immdlen = htonl(FW_WR_OP(FW_OFLD_TX_DATA_WR) | 4437b36b6e0Skxie@chelsio.com FW_WR_COMPL(1) | 4447b36b6e0Skxie@chelsio.com FW_WR_IMMDLEN(dlen)); 4457b36b6e0Skxie@chelsio.com req->flowid_len16 = htonl(FW_WR_FLOWID(csk->tid) | 4467b36b6e0Skxie@chelsio.com FW_WR_LEN16(credits)); 4477b36b6e0Skxie@chelsio.com } else { 4487b36b6e0Skxie@chelsio.com req->op_to_immdlen = 4497b36b6e0Skxie@chelsio.com cpu_to_be32(FW_WR_OP(FW_OFLD_TX_DATA_WR) | 4507b36b6e0Skxie@chelsio.com FW_WR_COMPL(1) | 4517b36b6e0Skxie@chelsio.com FW_WR_IMMDLEN(0)); 4527b36b6e0Skxie@chelsio.com req->flowid_len16 = 4537b36b6e0Skxie@chelsio.com cpu_to_be32(FW_WR_FLOWID(csk->tid) | 4547b36b6e0Skxie@chelsio.com FW_WR_LEN16(credits)); 4557b36b6e0Skxie@chelsio.com } 4567b36b6e0Skxie@chelsio.com if (submode) 4577b36b6e0Skxie@chelsio.com wr_ulp_mode = FW_OFLD_TX_DATA_WR_ULPMODE(ULP2_MODE_ISCSI) | 4587b36b6e0Skxie@chelsio.com FW_OFLD_TX_DATA_WR_ULPSUBMODE(submode); 4597b36b6e0Skxie@chelsio.com req->tunnel_to_proxy = htonl(wr_ulp_mode) | 4607b36b6e0Skxie@chelsio.com FW_OFLD_TX_DATA_WR_SHOVE(skb_peek(&csk->write_queue) ? 0 : 1); 4617b36b6e0Skxie@chelsio.com req->plen = htonl(len); 4627b36b6e0Skxie@chelsio.com if (!cxgbi_sock_flag(csk, CTPF_TX_DATA_SENT)) 4637b36b6e0Skxie@chelsio.com cxgbi_sock_set_flag(csk, CTPF_TX_DATA_SENT); 4647b36b6e0Skxie@chelsio.com } 4657b36b6e0Skxie@chelsio.com 4667b36b6e0Skxie@chelsio.com static void arp_failure_skb_discard(void *handle, struct sk_buff *skb) 4677b36b6e0Skxie@chelsio.com { 4687b36b6e0Skxie@chelsio.com kfree_skb(skb); 4697b36b6e0Skxie@chelsio.com } 4707b36b6e0Skxie@chelsio.com 4717b36b6e0Skxie@chelsio.com static int push_tx_frames(struct cxgbi_sock *csk, int req_completion) 4727b36b6e0Skxie@chelsio.com { 4737b36b6e0Skxie@chelsio.com int total_size = 0; 4747b36b6e0Skxie@chelsio.com struct sk_buff *skb; 4757b36b6e0Skxie@chelsio.com 4767b36b6e0Skxie@chelsio.com if (unlikely(csk->state < CTP_ESTABLISHED || 4777b36b6e0Skxie@chelsio.com csk->state == CTP_CLOSE_WAIT_1 || csk->state >= CTP_ABORTING)) { 4787b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK | 4797b36b6e0Skxie@chelsio.com 1 << CXGBI_DBG_PDU_TX, 4807b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, in closing state.\n", 4817b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 4827b36b6e0Skxie@chelsio.com return 0; 4837b36b6e0Skxie@chelsio.com } 4847b36b6e0Skxie@chelsio.com 4857b36b6e0Skxie@chelsio.com while (csk->wr_cred && (skb = skb_peek(&csk->write_queue)) != NULL) { 4867b36b6e0Skxie@chelsio.com int dlen = skb->len; 4877b36b6e0Skxie@chelsio.com int len = skb->len; 4887b36b6e0Skxie@chelsio.com unsigned int credits_needed; 4897b36b6e0Skxie@chelsio.com 4907b36b6e0Skxie@chelsio.com skb_reset_transport_header(skb); 4917b36b6e0Skxie@chelsio.com if (is_ofld_imm(skb)) 4927b36b6e0Skxie@chelsio.com credits_needed = DIV_ROUND_UP(dlen + 4937b36b6e0Skxie@chelsio.com sizeof(struct fw_ofld_tx_data_wr), 16); 4947b36b6e0Skxie@chelsio.com else 4957b36b6e0Skxie@chelsio.com credits_needed = DIV_ROUND_UP(8*calc_tx_flits_ofld(skb) 4967b36b6e0Skxie@chelsio.com + sizeof(struct fw_ofld_tx_data_wr), 4977b36b6e0Skxie@chelsio.com 16); 4987b36b6e0Skxie@chelsio.com 4997b36b6e0Skxie@chelsio.com if (csk->wr_cred < credits_needed) { 5007b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_PDU_TX, 5017b36b6e0Skxie@chelsio.com "csk 0x%p, skb %u/%u, wr %d < %u.\n", 5027b36b6e0Skxie@chelsio.com csk, skb->len, skb->data_len, 5037b36b6e0Skxie@chelsio.com credits_needed, csk->wr_cred); 5047b36b6e0Skxie@chelsio.com break; 5057b36b6e0Skxie@chelsio.com } 5067b36b6e0Skxie@chelsio.com __skb_unlink(skb, &csk->write_queue); 5077b36b6e0Skxie@chelsio.com set_queue(skb, CPL_PRIORITY_DATA, csk); 5087b36b6e0Skxie@chelsio.com skb->csum = credits_needed; 5097b36b6e0Skxie@chelsio.com csk->wr_cred -= credits_needed; 5107b36b6e0Skxie@chelsio.com csk->wr_una_cred += credits_needed; 5117b36b6e0Skxie@chelsio.com cxgbi_sock_enqueue_wr(csk, skb); 5127b36b6e0Skxie@chelsio.com 5137b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_PDU_TX, 5147b36b6e0Skxie@chelsio.com "csk 0x%p, skb %u/%u, wr %d, left %u, unack %u.\n", 5157b36b6e0Skxie@chelsio.com csk, skb->len, skb->data_len, credits_needed, 5167b36b6e0Skxie@chelsio.com csk->wr_cred, csk->wr_una_cred); 5177b36b6e0Skxie@chelsio.com 5187b36b6e0Skxie@chelsio.com if (likely(cxgbi_skcb_test_flag(skb, SKCBF_TX_NEED_HDR))) { 5197b36b6e0Skxie@chelsio.com if (!cxgbi_sock_flag(csk, CTPF_TX_DATA_SENT)) { 5207b36b6e0Skxie@chelsio.com send_tx_flowc_wr(csk); 5217b36b6e0Skxie@chelsio.com skb->csum += 5; 5227b36b6e0Skxie@chelsio.com csk->wr_cred -= 5; 5237b36b6e0Skxie@chelsio.com csk->wr_una_cred += 5; 5247b36b6e0Skxie@chelsio.com } 5257b36b6e0Skxie@chelsio.com len += cxgbi_ulp_extra_len(cxgbi_skcb_ulp_mode(skb)); 5267b36b6e0Skxie@chelsio.com make_tx_data_wr(csk, skb, dlen, len, credits_needed, 5277b36b6e0Skxie@chelsio.com req_completion); 5287b36b6e0Skxie@chelsio.com csk->snd_nxt += len; 5297b36b6e0Skxie@chelsio.com cxgbi_skcb_clear_flag(skb, SKCBF_TX_NEED_HDR); 5307b36b6e0Skxie@chelsio.com } 5317b36b6e0Skxie@chelsio.com total_size += skb->truesize; 5327b36b6e0Skxie@chelsio.com t4_set_arp_err_handler(skb, csk, arp_failure_skb_discard); 5337b36b6e0Skxie@chelsio.com 5347b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_TX, 5357b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, skb 0x%p, %u.\n", 5367b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, skb, len); 5377b36b6e0Skxie@chelsio.com 5387b36b6e0Skxie@chelsio.com cxgb4_l2t_send(csk->cdev->ports[csk->port_id], skb, csk->l2t); 5397b36b6e0Skxie@chelsio.com } 5407b36b6e0Skxie@chelsio.com return total_size; 5417b36b6e0Skxie@chelsio.com } 5427b36b6e0Skxie@chelsio.com 5437b36b6e0Skxie@chelsio.com static inline void free_atid(struct cxgbi_sock *csk) 5447b36b6e0Skxie@chelsio.com { 5457b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(csk->cdev); 5467b36b6e0Skxie@chelsio.com 5477b36b6e0Skxie@chelsio.com if (cxgbi_sock_flag(csk, CTPF_HAS_ATID)) { 5487b36b6e0Skxie@chelsio.com cxgb4_free_atid(lldi->tids, csk->atid); 5497b36b6e0Skxie@chelsio.com cxgbi_sock_clear_flag(csk, CTPF_HAS_ATID); 5507b36b6e0Skxie@chelsio.com cxgbi_sock_put(csk); 5517b36b6e0Skxie@chelsio.com } 5527b36b6e0Skxie@chelsio.com } 5537b36b6e0Skxie@chelsio.com 5547b36b6e0Skxie@chelsio.com static void do_act_establish(struct cxgbi_device *cdev, struct sk_buff *skb) 5557b36b6e0Skxie@chelsio.com { 5567b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 5577b36b6e0Skxie@chelsio.com struct cpl_act_establish *req = (struct cpl_act_establish *)skb->data; 5587b36b6e0Skxie@chelsio.com unsigned short tcp_opt = ntohs(req->tcp_opt); 5597b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(req); 5607b36b6e0Skxie@chelsio.com unsigned int atid = GET_TID_TID(ntohl(req->tos_atid)); 5617b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 5627b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 5637b36b6e0Skxie@chelsio.com u32 rcv_isn = be32_to_cpu(req->rcv_isn); 5647b36b6e0Skxie@chelsio.com 5657b36b6e0Skxie@chelsio.com csk = lookup_atid(t, atid); 5667b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 5677b36b6e0Skxie@chelsio.com pr_err("NO conn. for atid %u, cdev 0x%p.\n", atid, cdev); 5687b36b6e0Skxie@chelsio.com goto rel_skb; 5697b36b6e0Skxie@chelsio.com } 5707b36b6e0Skxie@chelsio.com 571e27d6169Skxie@chelsio.com if (csk->atid != atid) { 572e27d6169Skxie@chelsio.com pr_err("bad conn atid %u, csk 0x%p,%u,0x%lx,tid %u, atid %u.\n", 573e27d6169Skxie@chelsio.com atid, csk, csk->state, csk->flags, csk->tid, csk->atid); 574e27d6169Skxie@chelsio.com goto rel_skb; 575e27d6169Skxie@chelsio.com } 576e27d6169Skxie@chelsio.com 5777b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 5787b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, tid %u, atid %u, rseq %u.\n", 5797b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, tid, atid, rcv_isn); 5807b36b6e0Skxie@chelsio.com 5817b36b6e0Skxie@chelsio.com cxgbi_sock_get(csk); 5827b36b6e0Skxie@chelsio.com csk->tid = tid; 5837b36b6e0Skxie@chelsio.com cxgb4_insert_tid(lldi->tids, csk, tid); 5847b36b6e0Skxie@chelsio.com cxgbi_sock_set_flag(csk, CTPF_HAS_TID); 5857b36b6e0Skxie@chelsio.com 5867b36b6e0Skxie@chelsio.com free_atid(csk); 5877b36b6e0Skxie@chelsio.com 5887b36b6e0Skxie@chelsio.com spin_lock_bh(&csk->lock); 5897b36b6e0Skxie@chelsio.com if (unlikely(csk->state != CTP_ACTIVE_OPEN)) 5907b36b6e0Skxie@chelsio.com pr_info("csk 0x%p,%u,0x%lx,%u, got EST.\n", 5917b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 5927b36b6e0Skxie@chelsio.com 5937b36b6e0Skxie@chelsio.com if (csk->retry_timer.function) { 5947b36b6e0Skxie@chelsio.com del_timer(&csk->retry_timer); 5957b36b6e0Skxie@chelsio.com csk->retry_timer.function = NULL; 5967b36b6e0Skxie@chelsio.com } 5977b36b6e0Skxie@chelsio.com 5987b36b6e0Skxie@chelsio.com csk->copied_seq = csk->rcv_wup = csk->rcv_nxt = rcv_isn; 5997b36b6e0Skxie@chelsio.com /* 6007b36b6e0Skxie@chelsio.com * Causes the first RX_DATA_ACK to supply any Rx credits we couldn't 6017b36b6e0Skxie@chelsio.com * pass through opt0. 6027b36b6e0Skxie@chelsio.com */ 6037b36b6e0Skxie@chelsio.com if (cxgb4i_rcv_win > (RCV_BUFSIZ_MASK << 10)) 6047b36b6e0Skxie@chelsio.com csk->rcv_wup -= cxgb4i_rcv_win - (RCV_BUFSIZ_MASK << 10); 6057b36b6e0Skxie@chelsio.com 6067b36b6e0Skxie@chelsio.com csk->advmss = lldi->mtus[GET_TCPOPT_MSS(tcp_opt)] - 40; 6077b36b6e0Skxie@chelsio.com if (GET_TCPOPT_TSTAMP(tcp_opt)) 6087b36b6e0Skxie@chelsio.com csk->advmss -= 12; 6097b36b6e0Skxie@chelsio.com if (csk->advmss < 128) 6107b36b6e0Skxie@chelsio.com csk->advmss = 128; 6117b36b6e0Skxie@chelsio.com 6127b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 6137b36b6e0Skxie@chelsio.com "csk 0x%p, mss_idx %u, advmss %u.\n", 6147b36b6e0Skxie@chelsio.com csk, GET_TCPOPT_MSS(tcp_opt), csk->advmss); 6157b36b6e0Skxie@chelsio.com 6167b36b6e0Skxie@chelsio.com cxgbi_sock_established(csk, ntohl(req->snd_isn), ntohs(req->tcp_opt)); 6177b36b6e0Skxie@chelsio.com 6187b36b6e0Skxie@chelsio.com if (unlikely(cxgbi_sock_flag(csk, CTPF_ACTIVE_CLOSE_NEEDED))) 6197b36b6e0Skxie@chelsio.com send_abort_req(csk); 6207b36b6e0Skxie@chelsio.com else { 6217b36b6e0Skxie@chelsio.com if (skb_queue_len(&csk->write_queue)) 6227b36b6e0Skxie@chelsio.com push_tx_frames(csk, 0); 6237b36b6e0Skxie@chelsio.com cxgbi_conn_tx_open(csk); 6247b36b6e0Skxie@chelsio.com } 6257b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 6267b36b6e0Skxie@chelsio.com 6277b36b6e0Skxie@chelsio.com rel_skb: 6287b36b6e0Skxie@chelsio.com __kfree_skb(skb); 6297b36b6e0Skxie@chelsio.com } 6307b36b6e0Skxie@chelsio.com 6317b36b6e0Skxie@chelsio.com static int act_open_rpl_status_to_errno(int status) 6327b36b6e0Skxie@chelsio.com { 6337b36b6e0Skxie@chelsio.com switch (status) { 6347b36b6e0Skxie@chelsio.com case CPL_ERR_CONN_RESET: 6357b36b6e0Skxie@chelsio.com return -ECONNREFUSED; 6367b36b6e0Skxie@chelsio.com case CPL_ERR_ARP_MISS: 6377b36b6e0Skxie@chelsio.com return -EHOSTUNREACH; 6387b36b6e0Skxie@chelsio.com case CPL_ERR_CONN_TIMEDOUT: 6397b36b6e0Skxie@chelsio.com return -ETIMEDOUT; 6407b36b6e0Skxie@chelsio.com case CPL_ERR_TCAM_FULL: 6417b36b6e0Skxie@chelsio.com return -ENOMEM; 6427b36b6e0Skxie@chelsio.com case CPL_ERR_CONN_EXIST: 6437b36b6e0Skxie@chelsio.com return -EADDRINUSE; 6447b36b6e0Skxie@chelsio.com default: 6457b36b6e0Skxie@chelsio.com return -EIO; 6467b36b6e0Skxie@chelsio.com } 6477b36b6e0Skxie@chelsio.com } 6487b36b6e0Skxie@chelsio.com 6497b36b6e0Skxie@chelsio.com static void csk_act_open_retry_timer(unsigned long data) 6507b36b6e0Skxie@chelsio.com { 6517b36b6e0Skxie@chelsio.com struct sk_buff *skb; 6527b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk = (struct cxgbi_sock *)data; 6537b36b6e0Skxie@chelsio.com 6547b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 6557b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u.\n", 6567b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 6577b36b6e0Skxie@chelsio.com 6587b36b6e0Skxie@chelsio.com cxgbi_sock_get(csk); 6597b36b6e0Skxie@chelsio.com spin_lock_bh(&csk->lock); 66024d3f95aSkxie@chelsio.com skb = alloc_wr(sizeof(struct cpl_act_open_req), 0, GFP_ATOMIC); 6617b36b6e0Skxie@chelsio.com if (!skb) 6627b36b6e0Skxie@chelsio.com cxgbi_sock_fail_act_open(csk, -ENOMEM); 6637b36b6e0Skxie@chelsio.com else { 6647b36b6e0Skxie@chelsio.com skb->sk = (struct sock *)csk; 6657b36b6e0Skxie@chelsio.com t4_set_arp_err_handler(skb, csk, 6667b36b6e0Skxie@chelsio.com cxgbi_sock_act_open_req_arp_failure); 6677b36b6e0Skxie@chelsio.com send_act_open_req(csk, skb, csk->l2t); 6687b36b6e0Skxie@chelsio.com } 6697b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 6707b36b6e0Skxie@chelsio.com cxgbi_sock_put(csk); 6717b36b6e0Skxie@chelsio.com } 6727b36b6e0Skxie@chelsio.com 6737b36b6e0Skxie@chelsio.com static void do_act_open_rpl(struct cxgbi_device *cdev, struct sk_buff *skb) 6747b36b6e0Skxie@chelsio.com { 6757b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 6767b36b6e0Skxie@chelsio.com struct cpl_act_open_rpl *rpl = (struct cpl_act_open_rpl *)skb->data; 6777b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(rpl); 6787b36b6e0Skxie@chelsio.com unsigned int atid = 6797b36b6e0Skxie@chelsio.com GET_TID_TID(GET_AOPEN_ATID(be32_to_cpu(rpl->atid_status))); 6807b36b6e0Skxie@chelsio.com unsigned int status = GET_AOPEN_STATUS(be32_to_cpu(rpl->atid_status)); 6817b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 6827b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 6837b36b6e0Skxie@chelsio.com 6847b36b6e0Skxie@chelsio.com csk = lookup_atid(t, atid); 6857b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 6867b36b6e0Skxie@chelsio.com pr_err("NO matching conn. atid %u, tid %u.\n", atid, tid); 6877b36b6e0Skxie@chelsio.com goto rel_skb; 6887b36b6e0Skxie@chelsio.com } 6897b36b6e0Skxie@chelsio.com 690e27d6169Skxie@chelsio.com pr_info("%pI4:%u-%pI4:%u, atid %u,%u, status %u, csk 0x%p,%u,0x%lx.\n", 691e27d6169Skxie@chelsio.com &csk->saddr.sin_addr.s_addr, ntohs(csk->saddr.sin_port), 692e27d6169Skxie@chelsio.com &csk->daddr.sin_addr.s_addr, ntohs(csk->daddr.sin_port), 693e27d6169Skxie@chelsio.com atid, tid, status, csk, csk->state, csk->flags); 6947b36b6e0Skxie@chelsio.com 695150cca7cSKaren Xie if (status == CPL_ERR_RTX_NEG_ADVICE) 696150cca7cSKaren Xie goto rel_skb; 697150cca7cSKaren Xie 6987b36b6e0Skxie@chelsio.com if (status && status != CPL_ERR_TCAM_FULL && 6997b36b6e0Skxie@chelsio.com status != CPL_ERR_CONN_EXIST && 7007b36b6e0Skxie@chelsio.com status != CPL_ERR_ARP_MISS) 7017b36b6e0Skxie@chelsio.com cxgb4_remove_tid(lldi->tids, csk->port_id, GET_TID(rpl)); 7027b36b6e0Skxie@chelsio.com 7037b36b6e0Skxie@chelsio.com cxgbi_sock_get(csk); 7047b36b6e0Skxie@chelsio.com spin_lock_bh(&csk->lock); 7057b36b6e0Skxie@chelsio.com 7067b36b6e0Skxie@chelsio.com if (status == CPL_ERR_CONN_EXIST && 7077b36b6e0Skxie@chelsio.com csk->retry_timer.function != csk_act_open_retry_timer) { 7087b36b6e0Skxie@chelsio.com csk->retry_timer.function = csk_act_open_retry_timer; 7097b36b6e0Skxie@chelsio.com mod_timer(&csk->retry_timer, jiffies + HZ / 2); 7107b36b6e0Skxie@chelsio.com } else 7117b36b6e0Skxie@chelsio.com cxgbi_sock_fail_act_open(csk, 7127b36b6e0Skxie@chelsio.com act_open_rpl_status_to_errno(status)); 7137b36b6e0Skxie@chelsio.com 7147b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 7157b36b6e0Skxie@chelsio.com cxgbi_sock_put(csk); 7167b36b6e0Skxie@chelsio.com rel_skb: 7177b36b6e0Skxie@chelsio.com __kfree_skb(skb); 7187b36b6e0Skxie@chelsio.com } 7197b36b6e0Skxie@chelsio.com 7207b36b6e0Skxie@chelsio.com static void do_peer_close(struct cxgbi_device *cdev, struct sk_buff *skb) 7217b36b6e0Skxie@chelsio.com { 7227b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 7237b36b6e0Skxie@chelsio.com struct cpl_peer_close *req = (struct cpl_peer_close *)skb->data; 7247b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(req); 7257b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 7267b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 7277b36b6e0Skxie@chelsio.com 7287b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 7297b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 7307b36b6e0Skxie@chelsio.com pr_err("can't find connection for tid %u.\n", tid); 7317b36b6e0Skxie@chelsio.com goto rel_skb; 7327b36b6e0Skxie@chelsio.com } 7337b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 7347b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u.\n", 7357b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 7367b36b6e0Skxie@chelsio.com cxgbi_sock_rcv_peer_close(csk); 7377b36b6e0Skxie@chelsio.com rel_skb: 7387b36b6e0Skxie@chelsio.com __kfree_skb(skb); 7397b36b6e0Skxie@chelsio.com } 7407b36b6e0Skxie@chelsio.com 7417b36b6e0Skxie@chelsio.com static void do_close_con_rpl(struct cxgbi_device *cdev, struct sk_buff *skb) 7427b36b6e0Skxie@chelsio.com { 7437b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 7447b36b6e0Skxie@chelsio.com struct cpl_close_con_rpl *rpl = (struct cpl_close_con_rpl *)skb->data; 7457b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(rpl); 7467b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 7477b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 7487b36b6e0Skxie@chelsio.com 7497b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 7507b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 7517b36b6e0Skxie@chelsio.com pr_err("can't find connection for tid %u.\n", tid); 7527b36b6e0Skxie@chelsio.com goto rel_skb; 7537b36b6e0Skxie@chelsio.com } 7547b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 7557b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u.\n", 7567b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 7577b36b6e0Skxie@chelsio.com cxgbi_sock_rcv_close_conn_rpl(csk, ntohl(rpl->snd_nxt)); 7587b36b6e0Skxie@chelsio.com rel_skb: 7597b36b6e0Skxie@chelsio.com __kfree_skb(skb); 7607b36b6e0Skxie@chelsio.com } 7617b36b6e0Skxie@chelsio.com 7627b36b6e0Skxie@chelsio.com static int abort_status_to_errno(struct cxgbi_sock *csk, int abort_reason, 7637b36b6e0Skxie@chelsio.com int *need_rst) 7647b36b6e0Skxie@chelsio.com { 7657b36b6e0Skxie@chelsio.com switch (abort_reason) { 7667b36b6e0Skxie@chelsio.com case CPL_ERR_BAD_SYN: /* fall through */ 7677b36b6e0Skxie@chelsio.com case CPL_ERR_CONN_RESET: 7687b36b6e0Skxie@chelsio.com return csk->state > CTP_ESTABLISHED ? 7697b36b6e0Skxie@chelsio.com -EPIPE : -ECONNRESET; 7707b36b6e0Skxie@chelsio.com case CPL_ERR_XMIT_TIMEDOUT: 7717b36b6e0Skxie@chelsio.com case CPL_ERR_PERSIST_TIMEDOUT: 7727b36b6e0Skxie@chelsio.com case CPL_ERR_FINWAIT2_TIMEDOUT: 7737b36b6e0Skxie@chelsio.com case CPL_ERR_KEEPALIVE_TIMEDOUT: 7747b36b6e0Skxie@chelsio.com return -ETIMEDOUT; 7757b36b6e0Skxie@chelsio.com default: 7767b36b6e0Skxie@chelsio.com return -EIO; 7777b36b6e0Skxie@chelsio.com } 7787b36b6e0Skxie@chelsio.com } 7797b36b6e0Skxie@chelsio.com 7807b36b6e0Skxie@chelsio.com static void do_abort_req_rss(struct cxgbi_device *cdev, struct sk_buff *skb) 7817b36b6e0Skxie@chelsio.com { 7827b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 7837b36b6e0Skxie@chelsio.com struct cpl_abort_req_rss *req = (struct cpl_abort_req_rss *)skb->data; 7847b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(req); 7857b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 7867b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 7877b36b6e0Skxie@chelsio.com int rst_status = CPL_ABORT_NO_RST; 7887b36b6e0Skxie@chelsio.com 7897b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 7907b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 7917b36b6e0Skxie@chelsio.com pr_err("can't find connection for tid %u.\n", tid); 7927b36b6e0Skxie@chelsio.com goto rel_skb; 7937b36b6e0Skxie@chelsio.com } 7947b36b6e0Skxie@chelsio.com 7957b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 7967b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, tid %u, status 0x%x.\n", 7977b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, req->status); 7987b36b6e0Skxie@chelsio.com 7997b36b6e0Skxie@chelsio.com if (req->status == CPL_ERR_RTX_NEG_ADVICE || 8007b36b6e0Skxie@chelsio.com req->status == CPL_ERR_PERSIST_NEG_ADVICE) 8017b36b6e0Skxie@chelsio.com goto rel_skb; 8027b36b6e0Skxie@chelsio.com 8037b36b6e0Skxie@chelsio.com cxgbi_sock_get(csk); 8047b36b6e0Skxie@chelsio.com spin_lock_bh(&csk->lock); 8057b36b6e0Skxie@chelsio.com 8067b36b6e0Skxie@chelsio.com if (!cxgbi_sock_flag(csk, CTPF_ABORT_REQ_RCVD)) { 8077b36b6e0Skxie@chelsio.com cxgbi_sock_set_flag(csk, CTPF_ABORT_REQ_RCVD); 8087b36b6e0Skxie@chelsio.com cxgbi_sock_set_state(csk, CTP_ABORTING); 8097b36b6e0Skxie@chelsio.com goto done; 8107b36b6e0Skxie@chelsio.com } 8117b36b6e0Skxie@chelsio.com 8127b36b6e0Skxie@chelsio.com cxgbi_sock_clear_flag(csk, CTPF_ABORT_REQ_RCVD); 8137b36b6e0Skxie@chelsio.com send_abort_rpl(csk, rst_status); 8147b36b6e0Skxie@chelsio.com 8157b36b6e0Skxie@chelsio.com if (!cxgbi_sock_flag(csk, CTPF_ABORT_RPL_PENDING)) { 8167b36b6e0Skxie@chelsio.com csk->err = abort_status_to_errno(csk, req->status, &rst_status); 8177b36b6e0Skxie@chelsio.com cxgbi_sock_closed(csk); 8187b36b6e0Skxie@chelsio.com } 8197b36b6e0Skxie@chelsio.com done: 8207b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 8217b36b6e0Skxie@chelsio.com cxgbi_sock_put(csk); 8227b36b6e0Skxie@chelsio.com rel_skb: 8237b36b6e0Skxie@chelsio.com __kfree_skb(skb); 8247b36b6e0Skxie@chelsio.com } 8257b36b6e0Skxie@chelsio.com 8267b36b6e0Skxie@chelsio.com static void do_abort_rpl_rss(struct cxgbi_device *cdev, struct sk_buff *skb) 8277b36b6e0Skxie@chelsio.com { 8287b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 8297b36b6e0Skxie@chelsio.com struct cpl_abort_rpl_rss *rpl = (struct cpl_abort_rpl_rss *)skb->data; 8307b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(rpl); 8317b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 8327b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 8337b36b6e0Skxie@chelsio.com 8347b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 8357b36b6e0Skxie@chelsio.com if (!csk) 8367b36b6e0Skxie@chelsio.com goto rel_skb; 8377b36b6e0Skxie@chelsio.com 8387b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 8397b36b6e0Skxie@chelsio.com "status 0x%x, csk 0x%p, s %u, 0x%lx.\n", 8407b36b6e0Skxie@chelsio.com rpl->status, csk, csk ? csk->state : 0, 8417b36b6e0Skxie@chelsio.com csk ? csk->flags : 0UL); 8427b36b6e0Skxie@chelsio.com 8437b36b6e0Skxie@chelsio.com if (rpl->status == CPL_ERR_ABORT_FAILED) 8447b36b6e0Skxie@chelsio.com goto rel_skb; 8457b36b6e0Skxie@chelsio.com 8467b36b6e0Skxie@chelsio.com cxgbi_sock_rcv_abort_rpl(csk); 8477b36b6e0Skxie@chelsio.com rel_skb: 8487b36b6e0Skxie@chelsio.com __kfree_skb(skb); 8497b36b6e0Skxie@chelsio.com } 8507b36b6e0Skxie@chelsio.com 8517b36b6e0Skxie@chelsio.com static void do_rx_iscsi_hdr(struct cxgbi_device *cdev, struct sk_buff *skb) 8527b36b6e0Skxie@chelsio.com { 8537b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 8547b36b6e0Skxie@chelsio.com struct cpl_iscsi_hdr *cpl = (struct cpl_iscsi_hdr *)skb->data; 8557b36b6e0Skxie@chelsio.com unsigned short pdu_len_ddp = be16_to_cpu(cpl->pdu_len_ddp); 8567b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(cpl); 8577b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 8587b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 8597b36b6e0Skxie@chelsio.com 8607b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 8617b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 8627b36b6e0Skxie@chelsio.com pr_err("can't find conn. for tid %u.\n", tid); 8637b36b6e0Skxie@chelsio.com goto rel_skb; 8647b36b6e0Skxie@chelsio.com } 8657b36b6e0Skxie@chelsio.com 8667b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX, 8677b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, tid %u, skb 0x%p,%u, 0x%x.\n", 8687b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, skb, skb->len, 8697b36b6e0Skxie@chelsio.com pdu_len_ddp); 8707b36b6e0Skxie@chelsio.com 8717b36b6e0Skxie@chelsio.com spin_lock_bh(&csk->lock); 8727b36b6e0Skxie@chelsio.com 8737b36b6e0Skxie@chelsio.com if (unlikely(csk->state >= CTP_PASSIVE_CLOSE)) { 8747b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 8757b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, bad state.\n", 8767b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 8777b36b6e0Skxie@chelsio.com if (csk->state != CTP_ABORTING) 8787b36b6e0Skxie@chelsio.com goto abort_conn; 8797b36b6e0Skxie@chelsio.com else 8807b36b6e0Skxie@chelsio.com goto discard; 8817b36b6e0Skxie@chelsio.com } 8827b36b6e0Skxie@chelsio.com 8837b36b6e0Skxie@chelsio.com cxgbi_skcb_tcp_seq(skb) = ntohl(cpl->seq); 884e27d6169Skxie@chelsio.com cxgbi_skcb_flags(skb) = 0; 885e27d6169Skxie@chelsio.com 8867b36b6e0Skxie@chelsio.com skb_reset_transport_header(skb); 8877b36b6e0Skxie@chelsio.com __skb_pull(skb, sizeof(*cpl)); 8887b36b6e0Skxie@chelsio.com __pskb_trim(skb, ntohs(cpl->len)); 8897b36b6e0Skxie@chelsio.com 8907b36b6e0Skxie@chelsio.com if (!csk->skb_ulp_lhdr) { 8917b36b6e0Skxie@chelsio.com unsigned char *bhs; 8927b36b6e0Skxie@chelsio.com unsigned int hlen, dlen; 8937b36b6e0Skxie@chelsio.com 8947b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX, 8957b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, tid %u, skb 0x%p header.\n", 8967b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, skb); 8977b36b6e0Skxie@chelsio.com csk->skb_ulp_lhdr = skb; 898e27d6169Skxie@chelsio.com cxgbi_skcb_set_flag(skb, SKCBF_RX_HDR); 8997b36b6e0Skxie@chelsio.com 900e27d6169Skxie@chelsio.com if (cxgbi_skcb_tcp_seq(skb) != csk->rcv_nxt) { 9017b36b6e0Skxie@chelsio.com pr_info("tid %u, CPL_ISCSI_HDR, bad seq, 0x%x/0x%x.\n", 902e27d6169Skxie@chelsio.com csk->tid, cxgbi_skcb_tcp_seq(skb), 9037b36b6e0Skxie@chelsio.com csk->rcv_nxt); 9047b36b6e0Skxie@chelsio.com goto abort_conn; 9057b36b6e0Skxie@chelsio.com } 9067b36b6e0Skxie@chelsio.com 907e27d6169Skxie@chelsio.com bhs = skb->data; 9087b36b6e0Skxie@chelsio.com hlen = ntohs(cpl->len); 9097b36b6e0Skxie@chelsio.com dlen = ntohl(*(unsigned int *)(bhs + 4)) & 0xFFFFFF; 9107b36b6e0Skxie@chelsio.com 9117b36b6e0Skxie@chelsio.com if ((hlen + dlen) != ISCSI_PDU_LEN(pdu_len_ddp) - 40) { 9127b36b6e0Skxie@chelsio.com pr_info("tid 0x%x, CPL_ISCSI_HDR, pdu len " 9137b36b6e0Skxie@chelsio.com "mismatch %u != %u + %u, seq 0x%x.\n", 9147b36b6e0Skxie@chelsio.com csk->tid, ISCSI_PDU_LEN(pdu_len_ddp) - 40, 9157b36b6e0Skxie@chelsio.com hlen, dlen, cxgbi_skcb_tcp_seq(skb)); 9167b36b6e0Skxie@chelsio.com goto abort_conn; 9177b36b6e0Skxie@chelsio.com } 9187b36b6e0Skxie@chelsio.com 9197b36b6e0Skxie@chelsio.com cxgbi_skcb_rx_pdulen(skb) = (hlen + dlen + 3) & (~0x3); 9207b36b6e0Skxie@chelsio.com if (dlen) 9217b36b6e0Skxie@chelsio.com cxgbi_skcb_rx_pdulen(skb) += csk->dcrc_len; 9227b36b6e0Skxie@chelsio.com csk->rcv_nxt += cxgbi_skcb_rx_pdulen(skb); 9237b36b6e0Skxie@chelsio.com 9247b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX, 9257b36b6e0Skxie@chelsio.com "csk 0x%p, skb 0x%p, 0x%x,%u+%u,0x%x,0x%x.\n", 9267b36b6e0Skxie@chelsio.com csk, skb, *bhs, hlen, dlen, 9277b36b6e0Skxie@chelsio.com ntohl(*((unsigned int *)(bhs + 16))), 9287b36b6e0Skxie@chelsio.com ntohl(*((unsigned int *)(bhs + 24)))); 9297b36b6e0Skxie@chelsio.com 9307b36b6e0Skxie@chelsio.com } else { 931e27d6169Skxie@chelsio.com struct sk_buff *lskb = csk->skb_ulp_lhdr; 9327b36b6e0Skxie@chelsio.com 933e27d6169Skxie@chelsio.com cxgbi_skcb_set_flag(lskb, SKCBF_RX_DATA); 9347b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX, 9357b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, skb 0x%p data, 0x%p.\n", 9367b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, skb, lskb); 9377b36b6e0Skxie@chelsio.com } 9387b36b6e0Skxie@chelsio.com 9397b36b6e0Skxie@chelsio.com __skb_queue_tail(&csk->receive_queue, skb); 9407b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 9417b36b6e0Skxie@chelsio.com return; 9427b36b6e0Skxie@chelsio.com 9437b36b6e0Skxie@chelsio.com abort_conn: 9447b36b6e0Skxie@chelsio.com send_abort_req(csk); 9457b36b6e0Skxie@chelsio.com discard: 9467b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 9477b36b6e0Skxie@chelsio.com rel_skb: 9487b36b6e0Skxie@chelsio.com __kfree_skb(skb); 9497b36b6e0Skxie@chelsio.com } 9507b36b6e0Skxie@chelsio.com 9517b36b6e0Skxie@chelsio.com static void do_rx_data_ddp(struct cxgbi_device *cdev, 9527b36b6e0Skxie@chelsio.com struct sk_buff *skb) 9537b36b6e0Skxie@chelsio.com { 9547b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 9557b36b6e0Skxie@chelsio.com struct sk_buff *lskb; 9567b36b6e0Skxie@chelsio.com struct cpl_rx_data_ddp *rpl = (struct cpl_rx_data_ddp *)skb->data; 9577b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(rpl); 9587b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 9597b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 9607b36b6e0Skxie@chelsio.com unsigned int status = ntohl(rpl->ddpvld); 9617b36b6e0Skxie@chelsio.com 9627b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 9637b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 9647b36b6e0Skxie@chelsio.com pr_err("can't find connection for tid %u.\n", tid); 9657b36b6e0Skxie@chelsio.com goto rel_skb; 9667b36b6e0Skxie@chelsio.com } 9677b36b6e0Skxie@chelsio.com 9687b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX, 9697b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, skb 0x%p,0x%x, lhdr 0x%p.\n", 9707b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, skb, status, csk->skb_ulp_lhdr); 9717b36b6e0Skxie@chelsio.com 9727b36b6e0Skxie@chelsio.com spin_lock_bh(&csk->lock); 9737b36b6e0Skxie@chelsio.com 9747b36b6e0Skxie@chelsio.com if (unlikely(csk->state >= CTP_PASSIVE_CLOSE)) { 9757b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 9767b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, bad state.\n", 9777b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 9787b36b6e0Skxie@chelsio.com if (csk->state != CTP_ABORTING) 9797b36b6e0Skxie@chelsio.com goto abort_conn; 9807b36b6e0Skxie@chelsio.com else 9817b36b6e0Skxie@chelsio.com goto discard; 9827b36b6e0Skxie@chelsio.com } 9837b36b6e0Skxie@chelsio.com 9847b36b6e0Skxie@chelsio.com if (!csk->skb_ulp_lhdr) { 9857b36b6e0Skxie@chelsio.com pr_err("tid 0x%x, rcv RX_DATA_DDP w/o pdu bhs.\n", csk->tid); 9867b36b6e0Skxie@chelsio.com goto abort_conn; 9877b36b6e0Skxie@chelsio.com } 9887b36b6e0Skxie@chelsio.com 9897b36b6e0Skxie@chelsio.com lskb = csk->skb_ulp_lhdr; 9907b36b6e0Skxie@chelsio.com csk->skb_ulp_lhdr = NULL; 9917b36b6e0Skxie@chelsio.com 9927b36b6e0Skxie@chelsio.com cxgbi_skcb_rx_ddigest(lskb) = ntohl(rpl->ulp_crc); 9937b36b6e0Skxie@chelsio.com 9947b36b6e0Skxie@chelsio.com if (ntohs(rpl->len) != cxgbi_skcb_rx_pdulen(lskb)) 9957b36b6e0Skxie@chelsio.com pr_info("tid 0x%x, RX_DATA_DDP pdulen %u != %u.\n", 9967b36b6e0Skxie@chelsio.com csk->tid, ntohs(rpl->len), cxgbi_skcb_rx_pdulen(lskb)); 9977b36b6e0Skxie@chelsio.com 9987b36b6e0Skxie@chelsio.com if (status & (1 << CPL_RX_DDP_STATUS_HCRC_SHIFT)) { 999e27d6169Skxie@chelsio.com pr_info("csk 0x%p, lhdr 0x%p, status 0x%x, hcrc bad 0x%lx.\n", 1000e27d6169Skxie@chelsio.com csk, lskb, status, cxgbi_skcb_flags(lskb)); 10017b36b6e0Skxie@chelsio.com cxgbi_skcb_set_flag(lskb, SKCBF_RX_HCRC_ERR); 10027b36b6e0Skxie@chelsio.com } 10037b36b6e0Skxie@chelsio.com if (status & (1 << CPL_RX_DDP_STATUS_DCRC_SHIFT)) { 1004e27d6169Skxie@chelsio.com pr_info("csk 0x%p, lhdr 0x%p, status 0x%x, dcrc bad 0x%lx.\n", 1005e27d6169Skxie@chelsio.com csk, lskb, status, cxgbi_skcb_flags(lskb)); 10067b36b6e0Skxie@chelsio.com cxgbi_skcb_set_flag(lskb, SKCBF_RX_DCRC_ERR); 10077b36b6e0Skxie@chelsio.com } 10087b36b6e0Skxie@chelsio.com if (status & (1 << CPL_RX_DDP_STATUS_PAD_SHIFT)) { 10097b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_PDU_RX, 10107b36b6e0Skxie@chelsio.com "csk 0x%p, lhdr 0x%p, status 0x%x, pad bad.\n", 10117b36b6e0Skxie@chelsio.com csk, lskb, status); 10127b36b6e0Skxie@chelsio.com cxgbi_skcb_set_flag(lskb, SKCBF_RX_PAD_ERR); 10137b36b6e0Skxie@chelsio.com } 10147b36b6e0Skxie@chelsio.com if ((status & (1 << CPL_RX_DDP_STATUS_DDP_SHIFT)) && 10157b36b6e0Skxie@chelsio.com !cxgbi_skcb_test_flag(lskb, SKCBF_RX_DATA)) { 10167b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_PDU_RX, 10177b36b6e0Skxie@chelsio.com "csk 0x%p, lhdr 0x%p, 0x%x, data ddp'ed.\n", 10187b36b6e0Skxie@chelsio.com csk, lskb, status); 10197b36b6e0Skxie@chelsio.com cxgbi_skcb_set_flag(lskb, SKCBF_RX_DATA_DDPD); 10207b36b6e0Skxie@chelsio.com } 10217b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_PDU_RX, 10227b36b6e0Skxie@chelsio.com "csk 0x%p, lskb 0x%p, f 0x%lx.\n", 10237b36b6e0Skxie@chelsio.com csk, lskb, cxgbi_skcb_flags(lskb)); 10247b36b6e0Skxie@chelsio.com 1025e27d6169Skxie@chelsio.com cxgbi_skcb_set_flag(lskb, SKCBF_RX_STATUS); 10267b36b6e0Skxie@chelsio.com cxgbi_conn_pdu_ready(csk); 10277b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 10287b36b6e0Skxie@chelsio.com goto rel_skb; 10297b36b6e0Skxie@chelsio.com 10307b36b6e0Skxie@chelsio.com abort_conn: 10317b36b6e0Skxie@chelsio.com send_abort_req(csk); 10327b36b6e0Skxie@chelsio.com discard: 10337b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 10347b36b6e0Skxie@chelsio.com rel_skb: 10357b36b6e0Skxie@chelsio.com __kfree_skb(skb); 10367b36b6e0Skxie@chelsio.com } 10377b36b6e0Skxie@chelsio.com 10387b36b6e0Skxie@chelsio.com static void do_fw4_ack(struct cxgbi_device *cdev, struct sk_buff *skb) 10397b36b6e0Skxie@chelsio.com { 10407b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 10417b36b6e0Skxie@chelsio.com struct cpl_fw4_ack *rpl = (struct cpl_fw4_ack *)skb->data; 10427b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(rpl); 10437b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 10447b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 10457b36b6e0Skxie@chelsio.com 10467b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 10477b36b6e0Skxie@chelsio.com if (unlikely(!csk)) 10487b36b6e0Skxie@chelsio.com pr_err("can't find connection for tid %u.\n", tid); 10497b36b6e0Skxie@chelsio.com else { 10507b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 10517b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u.\n", 10527b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 10537b36b6e0Skxie@chelsio.com cxgbi_sock_rcv_wr_ack(csk, rpl->credits, ntohl(rpl->snd_una), 10547b36b6e0Skxie@chelsio.com rpl->seq_vld); 10557b36b6e0Skxie@chelsio.com } 10567b36b6e0Skxie@chelsio.com __kfree_skb(skb); 10577b36b6e0Skxie@chelsio.com } 10587b36b6e0Skxie@chelsio.com 10597b36b6e0Skxie@chelsio.com static void do_set_tcb_rpl(struct cxgbi_device *cdev, struct sk_buff *skb) 10607b36b6e0Skxie@chelsio.com { 10617b36b6e0Skxie@chelsio.com struct cpl_set_tcb_rpl *rpl = (struct cpl_set_tcb_rpl *)skb->data; 10627b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(rpl); 10637b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 10647b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 10657b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 10667b36b6e0Skxie@chelsio.com 10677b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 10687b36b6e0Skxie@chelsio.com if (!csk) 10697b36b6e0Skxie@chelsio.com pr_err("can't find conn. for tid %u.\n", tid); 10707b36b6e0Skxie@chelsio.com 10717b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 10727b36b6e0Skxie@chelsio.com "csk 0x%p,%u,%lx,%u, status 0x%x.\n", 10737b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, rpl->status); 10747b36b6e0Skxie@chelsio.com 10757b36b6e0Skxie@chelsio.com if (rpl->status != CPL_ERR_NONE) 10767b36b6e0Skxie@chelsio.com pr_err("csk 0x%p,%u, SET_TCB_RPL status %u.\n", 10777b36b6e0Skxie@chelsio.com csk, tid, rpl->status); 10787b36b6e0Skxie@chelsio.com 10797b36b6e0Skxie@chelsio.com __kfree_skb(skb); 10807b36b6e0Skxie@chelsio.com } 10817b36b6e0Skxie@chelsio.com 10827b36b6e0Skxie@chelsio.com static int alloc_cpls(struct cxgbi_sock *csk) 10837b36b6e0Skxie@chelsio.com { 108424d3f95aSkxie@chelsio.com csk->cpl_close = alloc_wr(sizeof(struct cpl_close_con_req), 108524d3f95aSkxie@chelsio.com 0, GFP_KERNEL); 10867b36b6e0Skxie@chelsio.com if (!csk->cpl_close) 10877b36b6e0Skxie@chelsio.com return -ENOMEM; 10887b36b6e0Skxie@chelsio.com 108924d3f95aSkxie@chelsio.com csk->cpl_abort_req = alloc_wr(sizeof(struct cpl_abort_req), 109024d3f95aSkxie@chelsio.com 0, GFP_KERNEL); 10917b36b6e0Skxie@chelsio.com if (!csk->cpl_abort_req) 10927b36b6e0Skxie@chelsio.com goto free_cpls; 10937b36b6e0Skxie@chelsio.com 109424d3f95aSkxie@chelsio.com csk->cpl_abort_rpl = alloc_wr(sizeof(struct cpl_abort_rpl), 109524d3f95aSkxie@chelsio.com 0, GFP_KERNEL); 10967b36b6e0Skxie@chelsio.com if (!csk->cpl_abort_rpl) 10977b36b6e0Skxie@chelsio.com goto free_cpls; 10987b36b6e0Skxie@chelsio.com return 0; 10997b36b6e0Skxie@chelsio.com 11007b36b6e0Skxie@chelsio.com free_cpls: 11017b36b6e0Skxie@chelsio.com cxgbi_sock_free_cpl_skbs(csk); 11027b36b6e0Skxie@chelsio.com return -ENOMEM; 11037b36b6e0Skxie@chelsio.com } 11047b36b6e0Skxie@chelsio.com 11057b36b6e0Skxie@chelsio.com static inline void l2t_put(struct cxgbi_sock *csk) 11067b36b6e0Skxie@chelsio.com { 11077b36b6e0Skxie@chelsio.com if (csk->l2t) { 11087b36b6e0Skxie@chelsio.com cxgb4_l2t_release(csk->l2t); 11097b36b6e0Skxie@chelsio.com csk->l2t = NULL; 11107b36b6e0Skxie@chelsio.com cxgbi_sock_put(csk); 11117b36b6e0Skxie@chelsio.com } 11127b36b6e0Skxie@chelsio.com } 11137b36b6e0Skxie@chelsio.com 11147b36b6e0Skxie@chelsio.com static void release_offload_resources(struct cxgbi_sock *csk) 11157b36b6e0Skxie@chelsio.com { 11167b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi; 11177b36b6e0Skxie@chelsio.com 11187b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 11197b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u.\n", 11207b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 11217b36b6e0Skxie@chelsio.com 11227b36b6e0Skxie@chelsio.com cxgbi_sock_free_cpl_skbs(csk); 11237b36b6e0Skxie@chelsio.com if (csk->wr_cred != csk->wr_max_cred) { 11247b36b6e0Skxie@chelsio.com cxgbi_sock_purge_wr_queue(csk); 11257b36b6e0Skxie@chelsio.com cxgbi_sock_reset_wr_list(csk); 11267b36b6e0Skxie@chelsio.com } 11277b36b6e0Skxie@chelsio.com 11287b36b6e0Skxie@chelsio.com l2t_put(csk); 11297b36b6e0Skxie@chelsio.com if (cxgbi_sock_flag(csk, CTPF_HAS_ATID)) 11307b36b6e0Skxie@chelsio.com free_atid(csk); 11317b36b6e0Skxie@chelsio.com else if (cxgbi_sock_flag(csk, CTPF_HAS_TID)) { 11327b36b6e0Skxie@chelsio.com lldi = cxgbi_cdev_priv(csk->cdev); 11337b36b6e0Skxie@chelsio.com cxgb4_remove_tid(lldi->tids, 0, csk->tid); 11347b36b6e0Skxie@chelsio.com cxgbi_sock_clear_flag(csk, CTPF_HAS_TID); 11357b36b6e0Skxie@chelsio.com cxgbi_sock_put(csk); 11367b36b6e0Skxie@chelsio.com } 11377b36b6e0Skxie@chelsio.com csk->dst = NULL; 11387b36b6e0Skxie@chelsio.com csk->cdev = NULL; 11397b36b6e0Skxie@chelsio.com } 11407b36b6e0Skxie@chelsio.com 11417b36b6e0Skxie@chelsio.com static int init_act_open(struct cxgbi_sock *csk) 11427b36b6e0Skxie@chelsio.com { 11437b36b6e0Skxie@chelsio.com struct cxgbi_device *cdev = csk->cdev; 11447b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 11457b36b6e0Skxie@chelsio.com struct net_device *ndev = cdev->ports[csk->port_id]; 11467b36b6e0Skxie@chelsio.com struct port_info *pi = netdev_priv(ndev); 11477b36b6e0Skxie@chelsio.com struct sk_buff *skb = NULL; 11487b36b6e0Skxie@chelsio.com unsigned int step; 11497b36b6e0Skxie@chelsio.com 11507b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 11517b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u.\n", 11527b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 11537b36b6e0Skxie@chelsio.com 11547b36b6e0Skxie@chelsio.com csk->atid = cxgb4_alloc_atid(lldi->tids, csk); 11557b36b6e0Skxie@chelsio.com if (csk->atid < 0) { 11567b36b6e0Skxie@chelsio.com pr_err("%s, NO atid available.\n", ndev->name); 11577b36b6e0Skxie@chelsio.com return -EINVAL; 11587b36b6e0Skxie@chelsio.com } 11597b36b6e0Skxie@chelsio.com cxgbi_sock_set_flag(csk, CTPF_HAS_ATID); 11607b36b6e0Skxie@chelsio.com cxgbi_sock_get(csk); 11617b36b6e0Skxie@chelsio.com 11627b36b6e0Skxie@chelsio.com csk->l2t = cxgb4_l2t_get(lldi->l2t, csk->dst->neighbour, ndev, 0); 11637b36b6e0Skxie@chelsio.com if (!csk->l2t) { 11647b36b6e0Skxie@chelsio.com pr_err("%s, cannot alloc l2t.\n", ndev->name); 11657b36b6e0Skxie@chelsio.com goto rel_resource; 11667b36b6e0Skxie@chelsio.com } 11677b36b6e0Skxie@chelsio.com cxgbi_sock_get(csk); 11687b36b6e0Skxie@chelsio.com 116924d3f95aSkxie@chelsio.com skb = alloc_wr(sizeof(struct cpl_act_open_req), 0, GFP_KERNEL); 11707b36b6e0Skxie@chelsio.com if (!skb) 11717b36b6e0Skxie@chelsio.com goto rel_resource; 11727b36b6e0Skxie@chelsio.com skb->sk = (struct sock *)csk; 11737b36b6e0Skxie@chelsio.com t4_set_arp_err_handler(skb, csk, cxgbi_sock_act_open_req_arp_failure); 11747b36b6e0Skxie@chelsio.com 11757b36b6e0Skxie@chelsio.com if (!csk->mtu) 11767b36b6e0Skxie@chelsio.com csk->mtu = dst_mtu(csk->dst); 11777b36b6e0Skxie@chelsio.com cxgb4_best_mtu(lldi->mtus, csk->mtu, &csk->mss_idx); 11787b36b6e0Skxie@chelsio.com csk->tx_chan = cxgb4_port_chan(ndev); 11797b36b6e0Skxie@chelsio.com /* SMT two entries per row */ 11807b36b6e0Skxie@chelsio.com csk->smac_idx = ((cxgb4_port_viid(ndev) & 0x7F)) << 1; 11817b36b6e0Skxie@chelsio.com step = lldi->ntxq / lldi->nchan; 11827b36b6e0Skxie@chelsio.com csk->txq_idx = cxgb4_port_idx(ndev) * step; 11837b36b6e0Skxie@chelsio.com step = lldi->nrxq / lldi->nchan; 11847b36b6e0Skxie@chelsio.com csk->rss_qid = lldi->rxq_ids[cxgb4_port_idx(ndev) * step]; 11857b36b6e0Skxie@chelsio.com csk->wr_max_cred = csk->wr_cred = lldi->wr_cred; 11867b36b6e0Skxie@chelsio.com csk->wr_una_cred = 0; 11877b36b6e0Skxie@chelsio.com cxgbi_sock_reset_wr_list(csk); 11887b36b6e0Skxie@chelsio.com csk->err = 0; 11897b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 11907b36b6e0Skxie@chelsio.com "csk 0x%p,p%d,%s, %u,%u,%u, mss %u,%u, smac %u.\n", 11917b36b6e0Skxie@chelsio.com csk, pi->port_id, ndev->name, csk->tx_chan, 11927b36b6e0Skxie@chelsio.com csk->txq_idx, csk->rss_qid, csk->mtu, csk->mss_idx, 11937b36b6e0Skxie@chelsio.com csk->smac_idx); 11947b36b6e0Skxie@chelsio.com 11957b36b6e0Skxie@chelsio.com cxgbi_sock_set_state(csk, CTP_ACTIVE_OPEN); 11967b36b6e0Skxie@chelsio.com send_act_open_req(csk, skb, csk->l2t); 11977b36b6e0Skxie@chelsio.com return 0; 11987b36b6e0Skxie@chelsio.com 11997b36b6e0Skxie@chelsio.com rel_resource: 12007b36b6e0Skxie@chelsio.com if (skb) 12017b36b6e0Skxie@chelsio.com __kfree_skb(skb); 12027b36b6e0Skxie@chelsio.com return -EINVAL; 12037b36b6e0Skxie@chelsio.com } 12047b36b6e0Skxie@chelsio.com 12057b36b6e0Skxie@chelsio.com cxgb4i_cplhandler_func cxgb4i_cplhandlers[NUM_CPL_CMDS] = { 12067b36b6e0Skxie@chelsio.com [CPL_ACT_ESTABLISH] = do_act_establish, 12077b36b6e0Skxie@chelsio.com [CPL_ACT_OPEN_RPL] = do_act_open_rpl, 12087b36b6e0Skxie@chelsio.com [CPL_PEER_CLOSE] = do_peer_close, 12097b36b6e0Skxie@chelsio.com [CPL_ABORT_REQ_RSS] = do_abort_req_rss, 12107b36b6e0Skxie@chelsio.com [CPL_ABORT_RPL_RSS] = do_abort_rpl_rss, 12117b36b6e0Skxie@chelsio.com [CPL_CLOSE_CON_RPL] = do_close_con_rpl, 12127b36b6e0Skxie@chelsio.com [CPL_FW4_ACK] = do_fw4_ack, 12137b36b6e0Skxie@chelsio.com [CPL_ISCSI_HDR] = do_rx_iscsi_hdr, 12147b36b6e0Skxie@chelsio.com [CPL_SET_TCB_RPL] = do_set_tcb_rpl, 12157b36b6e0Skxie@chelsio.com [CPL_RX_DATA_DDP] = do_rx_data_ddp, 12167b36b6e0Skxie@chelsio.com }; 12177b36b6e0Skxie@chelsio.com 12187b36b6e0Skxie@chelsio.com int cxgb4i_ofld_init(struct cxgbi_device *cdev) 12197b36b6e0Skxie@chelsio.com { 12207b36b6e0Skxie@chelsio.com int rc; 12217b36b6e0Skxie@chelsio.com 12227b36b6e0Skxie@chelsio.com if (cxgb4i_max_connect > CXGB4I_MAX_CONN) 12237b36b6e0Skxie@chelsio.com cxgb4i_max_connect = CXGB4I_MAX_CONN; 12247b36b6e0Skxie@chelsio.com 12257b36b6e0Skxie@chelsio.com rc = cxgbi_device_portmap_create(cdev, cxgb4i_sport_base, 12267b36b6e0Skxie@chelsio.com cxgb4i_max_connect); 12277b36b6e0Skxie@chelsio.com if (rc < 0) 12287b36b6e0Skxie@chelsio.com return rc; 12297b36b6e0Skxie@chelsio.com 12307b36b6e0Skxie@chelsio.com cdev->csk_release_offload_resources = release_offload_resources; 12317b36b6e0Skxie@chelsio.com cdev->csk_push_tx_frames = push_tx_frames; 12327b36b6e0Skxie@chelsio.com cdev->csk_send_abort_req = send_abort_req; 12337b36b6e0Skxie@chelsio.com cdev->csk_send_close_req = send_close_req; 12347b36b6e0Skxie@chelsio.com cdev->csk_send_rx_credits = send_rx_credits; 12357b36b6e0Skxie@chelsio.com cdev->csk_alloc_cpls = alloc_cpls; 12367b36b6e0Skxie@chelsio.com cdev->csk_init_act_open = init_act_open; 12377b36b6e0Skxie@chelsio.com 12387b36b6e0Skxie@chelsio.com pr_info("cdev 0x%p, offload up, added.\n", cdev); 12397b36b6e0Skxie@chelsio.com return 0; 12407b36b6e0Skxie@chelsio.com } 12417b36b6e0Skxie@chelsio.com 12427b36b6e0Skxie@chelsio.com /* 12437b36b6e0Skxie@chelsio.com * functions to program the pagepod in h/w 12447b36b6e0Skxie@chelsio.com */ 1245e27d6169Skxie@chelsio.com #define ULPMEM_IDATA_MAX_NPPODS 4 /* 256/PPOD_SIZE */ 12467b36b6e0Skxie@chelsio.com static inline void ulp_mem_io_set_hdr(struct ulp_mem_io *req, 1247e27d6169Skxie@chelsio.com unsigned int wr_len, unsigned int dlen, 1248e27d6169Skxie@chelsio.com unsigned int pm_addr) 12497b36b6e0Skxie@chelsio.com { 1250e27d6169Skxie@chelsio.com struct ulptx_idata *idata = (struct ulptx_idata *)(req + 1); 12517b36b6e0Skxie@chelsio.com 12527b36b6e0Skxie@chelsio.com INIT_ULPTX_WR(req, wr_len, 0, 0); 1253e27d6169Skxie@chelsio.com req->cmd = htonl(ULPTX_CMD(ULP_TX_MEM_WRITE) | (1 << 23)); 12547b36b6e0Skxie@chelsio.com req->dlen = htonl(ULP_MEMIO_DATA_LEN(dlen >> 5)); 12557b36b6e0Skxie@chelsio.com req->lock_addr = htonl(ULP_MEMIO_ADDR(pm_addr >> 5)); 12567b36b6e0Skxie@chelsio.com req->len16 = htonl(DIV_ROUND_UP(wr_len - sizeof(req->wr), 16)); 1257e27d6169Skxie@chelsio.com 1258e27d6169Skxie@chelsio.com idata->cmd_more = htonl(ULPTX_CMD(ULP_TX_SC_IMM)); 1259e27d6169Skxie@chelsio.com idata->len = htonl(dlen); 12607b36b6e0Skxie@chelsio.com } 12617b36b6e0Skxie@chelsio.com 1262e27d6169Skxie@chelsio.com static int ddp_ppod_write_idata(struct cxgbi_device *cdev, unsigned int port_id, 12637b36b6e0Skxie@chelsio.com struct cxgbi_pagepod_hdr *hdr, unsigned int idx, 12647b36b6e0Skxie@chelsio.com unsigned int npods, 12657b36b6e0Skxie@chelsio.com struct cxgbi_gather_list *gl, 12667b36b6e0Skxie@chelsio.com unsigned int gl_pidx) 12677b36b6e0Skxie@chelsio.com { 12687b36b6e0Skxie@chelsio.com struct cxgbi_ddp_info *ddp = cdev->ddp; 12697b36b6e0Skxie@chelsio.com struct sk_buff *skb; 12707b36b6e0Skxie@chelsio.com struct ulp_mem_io *req; 1271e27d6169Skxie@chelsio.com struct ulptx_idata *idata; 12727b36b6e0Skxie@chelsio.com struct cxgbi_pagepod *ppod; 1273e27d6169Skxie@chelsio.com unsigned int pm_addr = idx * PPOD_SIZE + ddp->llimit; 1274e27d6169Skxie@chelsio.com unsigned int dlen = PPOD_SIZE * npods; 1275e27d6169Skxie@chelsio.com unsigned int wr_len = roundup(sizeof(struct ulp_mem_io) + 1276e27d6169Skxie@chelsio.com sizeof(struct ulptx_idata) + dlen, 16); 12777b36b6e0Skxie@chelsio.com unsigned int i; 12787b36b6e0Skxie@chelsio.com 1279e27d6169Skxie@chelsio.com skb = alloc_wr(wr_len, 0, GFP_ATOMIC); 12807b36b6e0Skxie@chelsio.com if (!skb) { 12817b36b6e0Skxie@chelsio.com pr_err("cdev 0x%p, idx %u, npods %u, OOM.\n", 12827b36b6e0Skxie@chelsio.com cdev, idx, npods); 12837b36b6e0Skxie@chelsio.com return -ENOMEM; 12847b36b6e0Skxie@chelsio.com } 12857b36b6e0Skxie@chelsio.com req = (struct ulp_mem_io *)skb->head; 12867b36b6e0Skxie@chelsio.com set_queue(skb, CPL_PRIORITY_CONTROL, NULL); 12877b36b6e0Skxie@chelsio.com 1288e27d6169Skxie@chelsio.com ulp_mem_io_set_hdr(req, wr_len, dlen, pm_addr); 1289e27d6169Skxie@chelsio.com idata = (struct ulptx_idata *)(req + 1); 1290e27d6169Skxie@chelsio.com ppod = (struct cxgbi_pagepod *)(idata + 1); 12917b36b6e0Skxie@chelsio.com 12927b36b6e0Skxie@chelsio.com for (i = 0; i < npods; i++, ppod++, gl_pidx += PPOD_PAGES_MAX) { 12937b36b6e0Skxie@chelsio.com if (!hdr && !gl) 12947b36b6e0Skxie@chelsio.com cxgbi_ddp_ppod_clear(ppod); 12957b36b6e0Skxie@chelsio.com else 12967b36b6e0Skxie@chelsio.com cxgbi_ddp_ppod_set(ppod, hdr, gl, gl_pidx); 12977b36b6e0Skxie@chelsio.com } 12987b36b6e0Skxie@chelsio.com 12997b36b6e0Skxie@chelsio.com cxgb4_ofld_send(cdev->ports[port_id], skb); 13007b36b6e0Skxie@chelsio.com return 0; 13017b36b6e0Skxie@chelsio.com } 13027b36b6e0Skxie@chelsio.com 13037b36b6e0Skxie@chelsio.com static int ddp_set_map(struct cxgbi_sock *csk, struct cxgbi_pagepod_hdr *hdr, 13047b36b6e0Skxie@chelsio.com unsigned int idx, unsigned int npods, 13057b36b6e0Skxie@chelsio.com struct cxgbi_gather_list *gl) 13067b36b6e0Skxie@chelsio.com { 13077b36b6e0Skxie@chelsio.com unsigned int i, cnt; 13087b36b6e0Skxie@chelsio.com int err = 0; 13097b36b6e0Skxie@chelsio.com 13107b36b6e0Skxie@chelsio.com for (i = 0; i < npods; i += cnt, idx += cnt) { 13117b36b6e0Skxie@chelsio.com cnt = npods - i; 1312e27d6169Skxie@chelsio.com if (cnt > ULPMEM_IDATA_MAX_NPPODS) 1313e27d6169Skxie@chelsio.com cnt = ULPMEM_IDATA_MAX_NPPODS; 1314e27d6169Skxie@chelsio.com err = ddp_ppod_write_idata(csk->cdev, csk->port_id, hdr, 13157b36b6e0Skxie@chelsio.com idx, cnt, gl, 4 * i); 13167b36b6e0Skxie@chelsio.com if (err < 0) 13177b36b6e0Skxie@chelsio.com break; 13187b36b6e0Skxie@chelsio.com } 13197b36b6e0Skxie@chelsio.com return err; 13207b36b6e0Skxie@chelsio.com } 13217b36b6e0Skxie@chelsio.com 13227b36b6e0Skxie@chelsio.com static void ddp_clear_map(struct cxgbi_hba *chba, unsigned int tag, 13237b36b6e0Skxie@chelsio.com unsigned int idx, unsigned int npods) 13247b36b6e0Skxie@chelsio.com { 13257b36b6e0Skxie@chelsio.com unsigned int i, cnt; 13267b36b6e0Skxie@chelsio.com int err; 13277b36b6e0Skxie@chelsio.com 13287b36b6e0Skxie@chelsio.com for (i = 0; i < npods; i += cnt, idx += cnt) { 13297b36b6e0Skxie@chelsio.com cnt = npods - i; 1330e27d6169Skxie@chelsio.com if (cnt > ULPMEM_IDATA_MAX_NPPODS) 1331e27d6169Skxie@chelsio.com cnt = ULPMEM_IDATA_MAX_NPPODS; 1332e27d6169Skxie@chelsio.com err = ddp_ppod_write_idata(chba->cdev, chba->port_id, NULL, 13337b36b6e0Skxie@chelsio.com idx, cnt, NULL, 0); 13347b36b6e0Skxie@chelsio.com if (err < 0) 13357b36b6e0Skxie@chelsio.com break; 13367b36b6e0Skxie@chelsio.com } 13377b36b6e0Skxie@chelsio.com } 13387b36b6e0Skxie@chelsio.com 13397b36b6e0Skxie@chelsio.com static int ddp_setup_conn_pgidx(struct cxgbi_sock *csk, unsigned int tid, 13407b36b6e0Skxie@chelsio.com int pg_idx, bool reply) 13417b36b6e0Skxie@chelsio.com { 13427b36b6e0Skxie@chelsio.com struct sk_buff *skb; 13437b36b6e0Skxie@chelsio.com struct cpl_set_tcb_field *req; 13447b36b6e0Skxie@chelsio.com 1345e27d6169Skxie@chelsio.com if (!pg_idx || pg_idx >= DDP_PGIDX_MAX) 13467b36b6e0Skxie@chelsio.com return 0; 13477b36b6e0Skxie@chelsio.com 134824d3f95aSkxie@chelsio.com skb = alloc_wr(sizeof(*req), 0, GFP_KERNEL); 13497b36b6e0Skxie@chelsio.com if (!skb) 13507b36b6e0Skxie@chelsio.com return -ENOMEM; 13517b36b6e0Skxie@chelsio.com 1352e27d6169Skxie@chelsio.com /* set up ulp page size */ 13537b36b6e0Skxie@chelsio.com req = (struct cpl_set_tcb_field *)skb->head; 13547b36b6e0Skxie@chelsio.com INIT_TP_WR(req, csk->tid); 13557b36b6e0Skxie@chelsio.com OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_SET_TCB_FIELD, csk->tid)); 13567b36b6e0Skxie@chelsio.com req->reply_ctrl = htons(NO_REPLY(reply) | QUEUENO(csk->rss_qid)); 1357e27d6169Skxie@chelsio.com req->word_cookie = htons(0); 1358e27d6169Skxie@chelsio.com req->mask = cpu_to_be64(0x3 << 8); 1359e27d6169Skxie@chelsio.com req->val = cpu_to_be64(pg_idx << 8); 13607b36b6e0Skxie@chelsio.com set_wr_txq(skb, CPL_PRIORITY_CONTROL, csk->port_id); 13617b36b6e0Skxie@chelsio.com 13627b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 13637b36b6e0Skxie@chelsio.com "csk 0x%p, tid 0x%x, pg_idx %u.\n", csk, csk->tid, pg_idx); 13647b36b6e0Skxie@chelsio.com 13657b36b6e0Skxie@chelsio.com cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb); 13667b36b6e0Skxie@chelsio.com return 0; 13677b36b6e0Skxie@chelsio.com } 13687b36b6e0Skxie@chelsio.com 13697b36b6e0Skxie@chelsio.com static int ddp_setup_conn_digest(struct cxgbi_sock *csk, unsigned int tid, 13707b36b6e0Skxie@chelsio.com int hcrc, int dcrc, int reply) 13717b36b6e0Skxie@chelsio.com { 13727b36b6e0Skxie@chelsio.com struct sk_buff *skb; 13737b36b6e0Skxie@chelsio.com struct cpl_set_tcb_field *req; 13747b36b6e0Skxie@chelsio.com 1375e27d6169Skxie@chelsio.com if (!hcrc && !dcrc) 1376e27d6169Skxie@chelsio.com return 0; 13777b36b6e0Skxie@chelsio.com 137824d3f95aSkxie@chelsio.com skb = alloc_wr(sizeof(*req), 0, GFP_KERNEL); 13797b36b6e0Skxie@chelsio.com if (!skb) 13807b36b6e0Skxie@chelsio.com return -ENOMEM; 13817b36b6e0Skxie@chelsio.com 13827b36b6e0Skxie@chelsio.com csk->hcrc_len = (hcrc ? 4 : 0); 13837b36b6e0Skxie@chelsio.com csk->dcrc_len = (dcrc ? 4 : 0); 1384e27d6169Skxie@chelsio.com /* set up ulp submode */ 13857b36b6e0Skxie@chelsio.com req = (struct cpl_set_tcb_field *)skb->head; 13867b36b6e0Skxie@chelsio.com INIT_TP_WR(req, tid); 13877b36b6e0Skxie@chelsio.com OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_SET_TCB_FIELD, tid)); 13887b36b6e0Skxie@chelsio.com req->reply_ctrl = htons(NO_REPLY(reply) | QUEUENO(csk->rss_qid)); 1389e27d6169Skxie@chelsio.com req->word_cookie = htons(0); 1390e27d6169Skxie@chelsio.com req->mask = cpu_to_be64(0x3 << 4); 1391e27d6169Skxie@chelsio.com req->val = cpu_to_be64(((hcrc ? ULP_CRC_HEADER : 0) | 1392e27d6169Skxie@chelsio.com (dcrc ? ULP_CRC_DATA : 0)) << 4); 13937b36b6e0Skxie@chelsio.com set_wr_txq(skb, CPL_PRIORITY_CONTROL, csk->port_id); 13947b36b6e0Skxie@chelsio.com 13957b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 13967b36b6e0Skxie@chelsio.com "csk 0x%p, tid 0x%x, crc %d,%d.\n", csk, csk->tid, hcrc, dcrc); 13977b36b6e0Skxie@chelsio.com 13987b36b6e0Skxie@chelsio.com cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb); 13997b36b6e0Skxie@chelsio.com return 0; 14007b36b6e0Skxie@chelsio.com } 14017b36b6e0Skxie@chelsio.com 14027b36b6e0Skxie@chelsio.com static int cxgb4i_ddp_init(struct cxgbi_device *cdev) 14037b36b6e0Skxie@chelsio.com { 14047b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 14057b36b6e0Skxie@chelsio.com struct cxgbi_ddp_info *ddp = cdev->ddp; 14067b36b6e0Skxie@chelsio.com unsigned int tagmask, pgsz_factor[4]; 14077b36b6e0Skxie@chelsio.com int err; 14087b36b6e0Skxie@chelsio.com 14097b36b6e0Skxie@chelsio.com if (ddp) { 14107b36b6e0Skxie@chelsio.com kref_get(&ddp->refcnt); 14117b36b6e0Skxie@chelsio.com pr_warn("cdev 0x%p, ddp 0x%p already set up.\n", 14127b36b6e0Skxie@chelsio.com cdev, cdev->ddp); 14137b36b6e0Skxie@chelsio.com return -EALREADY; 14147b36b6e0Skxie@chelsio.com } 14157b36b6e0Skxie@chelsio.com 14167b36b6e0Skxie@chelsio.com err = cxgbi_ddp_init(cdev, lldi->vr->iscsi.start, 14177b36b6e0Skxie@chelsio.com lldi->vr->iscsi.start + lldi->vr->iscsi.size - 1, 14187b36b6e0Skxie@chelsio.com lldi->iscsi_iolen, lldi->iscsi_iolen); 14197b36b6e0Skxie@chelsio.com if (err < 0) 14207b36b6e0Skxie@chelsio.com return err; 14217b36b6e0Skxie@chelsio.com 14227b36b6e0Skxie@chelsio.com ddp = cdev->ddp; 14237b36b6e0Skxie@chelsio.com 14247b36b6e0Skxie@chelsio.com tagmask = ddp->idx_mask << PPOD_IDX_SHIFT; 14257b36b6e0Skxie@chelsio.com cxgbi_ddp_page_size_factor(pgsz_factor); 14267b36b6e0Skxie@chelsio.com cxgb4_iscsi_init(lldi->ports[0], tagmask, pgsz_factor); 14277b36b6e0Skxie@chelsio.com 14287b36b6e0Skxie@chelsio.com cdev->csk_ddp_setup_digest = ddp_setup_conn_digest; 14297b36b6e0Skxie@chelsio.com cdev->csk_ddp_setup_pgidx = ddp_setup_conn_pgidx; 14307b36b6e0Skxie@chelsio.com cdev->csk_ddp_set = ddp_set_map; 14317b36b6e0Skxie@chelsio.com cdev->csk_ddp_clear = ddp_clear_map; 14327b36b6e0Skxie@chelsio.com 14337b36b6e0Skxie@chelsio.com pr_info("cxgb4i 0x%p tag: sw %u, rsvd %u,%u, mask 0x%x.\n", 14347b36b6e0Skxie@chelsio.com cdev, cdev->tag_format.sw_bits, cdev->tag_format.rsvd_bits, 14357b36b6e0Skxie@chelsio.com cdev->tag_format.rsvd_shift, cdev->tag_format.rsvd_mask); 14367b36b6e0Skxie@chelsio.com pr_info("cxgb4i 0x%p, nppods %u, bits %u, mask 0x%x,0x%x pkt %u/%u, " 14377b36b6e0Skxie@chelsio.com " %u/%u.\n", 14387b36b6e0Skxie@chelsio.com cdev, ddp->nppods, ddp->idx_bits, ddp->idx_mask, 14397b36b6e0Skxie@chelsio.com ddp->rsvd_tag_mask, ddp->max_txsz, lldi->iscsi_iolen, 14407b36b6e0Skxie@chelsio.com ddp->max_rxsz, lldi->iscsi_iolen); 14417b36b6e0Skxie@chelsio.com pr_info("cxgb4i 0x%p max payload size: %u/%u, %u/%u.\n", 14427b36b6e0Skxie@chelsio.com cdev, cdev->tx_max_size, ddp->max_txsz, cdev->rx_max_size, 14437b36b6e0Skxie@chelsio.com ddp->max_rxsz); 14447b36b6e0Skxie@chelsio.com return 0; 14457b36b6e0Skxie@chelsio.com } 14467b36b6e0Skxie@chelsio.com 14477b36b6e0Skxie@chelsio.com static void *t4_uld_add(const struct cxgb4_lld_info *lldi) 14487b36b6e0Skxie@chelsio.com { 14497b36b6e0Skxie@chelsio.com struct cxgbi_device *cdev; 14507b36b6e0Skxie@chelsio.com struct port_info *pi; 14517b36b6e0Skxie@chelsio.com int i, rc; 14527b36b6e0Skxie@chelsio.com 14537b36b6e0Skxie@chelsio.com cdev = cxgbi_device_register(sizeof(*lldi), lldi->nports); 14547b36b6e0Skxie@chelsio.com if (!cdev) { 14557b36b6e0Skxie@chelsio.com pr_info("t4 device 0x%p, register failed.\n", lldi); 14567b36b6e0Skxie@chelsio.com return NULL; 14577b36b6e0Skxie@chelsio.com } 14587b36b6e0Skxie@chelsio.com pr_info("0x%p,0x%x, ports %u,%s, chan %u, q %u,%u, wr %u.\n", 14597b36b6e0Skxie@chelsio.com cdev, lldi->adapter_type, lldi->nports, 14607b36b6e0Skxie@chelsio.com lldi->ports[0]->name, lldi->nchan, lldi->ntxq, 14617b36b6e0Skxie@chelsio.com lldi->nrxq, lldi->wr_cred); 14627b36b6e0Skxie@chelsio.com for (i = 0; i < lldi->nrxq; i++) 14637b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_DEV, 14647b36b6e0Skxie@chelsio.com "t4 0x%p, rxq id #%d: %u.\n", 14657b36b6e0Skxie@chelsio.com cdev, i, lldi->rxq_ids[i]); 14667b36b6e0Skxie@chelsio.com 14677b36b6e0Skxie@chelsio.com memcpy(cxgbi_cdev_priv(cdev), lldi, sizeof(*lldi)); 14687b36b6e0Skxie@chelsio.com cdev->flags = CXGBI_FLAG_DEV_T4; 14697b36b6e0Skxie@chelsio.com cdev->pdev = lldi->pdev; 14707b36b6e0Skxie@chelsio.com cdev->ports = lldi->ports; 14717b36b6e0Skxie@chelsio.com cdev->nports = lldi->nports; 14727b36b6e0Skxie@chelsio.com cdev->mtus = lldi->mtus; 14737b36b6e0Skxie@chelsio.com cdev->nmtus = NMTUS; 14747b36b6e0Skxie@chelsio.com cdev->snd_win = cxgb4i_snd_win; 14757b36b6e0Skxie@chelsio.com cdev->rcv_win = cxgb4i_rcv_win; 14767b36b6e0Skxie@chelsio.com cdev->rx_credit_thres = cxgb4i_rx_credit_thres; 14777b36b6e0Skxie@chelsio.com cdev->skb_tx_rsvd = CXGB4I_TX_HEADER_LEN; 14787b36b6e0Skxie@chelsio.com cdev->skb_rx_extra = sizeof(struct cpl_iscsi_hdr); 14797b36b6e0Skxie@chelsio.com cdev->itp = &cxgb4i_iscsi_transport; 14807b36b6e0Skxie@chelsio.com 1481e27d6169Skxie@chelsio.com cdev->pfvf = FW_VIID_PFN_GET(cxgb4_port_viid(lldi->ports[0])) << 8; 1482e27d6169Skxie@chelsio.com pr_info("cdev 0x%p,%s, pfvf %u.\n", 1483e27d6169Skxie@chelsio.com cdev, lldi->ports[0]->name, cdev->pfvf); 1484e27d6169Skxie@chelsio.com 14857b36b6e0Skxie@chelsio.com rc = cxgb4i_ddp_init(cdev); 14867b36b6e0Skxie@chelsio.com if (rc) { 14877b36b6e0Skxie@chelsio.com pr_info("t4 0x%p ddp init failed.\n", cdev); 14887b36b6e0Skxie@chelsio.com goto err_out; 14897b36b6e0Skxie@chelsio.com } 14907b36b6e0Skxie@chelsio.com rc = cxgb4i_ofld_init(cdev); 14917b36b6e0Skxie@chelsio.com if (rc) { 14927b36b6e0Skxie@chelsio.com pr_info("t4 0x%p ofld init failed.\n", cdev); 14937b36b6e0Skxie@chelsio.com goto err_out; 14947b36b6e0Skxie@chelsio.com } 14957b36b6e0Skxie@chelsio.com 14967b36b6e0Skxie@chelsio.com rc = cxgbi_hbas_add(cdev, CXGB4I_MAX_LUN, CXGBI_MAX_CONN, 14977b36b6e0Skxie@chelsio.com &cxgb4i_host_template, cxgb4i_stt); 14987b36b6e0Skxie@chelsio.com if (rc) 14997b36b6e0Skxie@chelsio.com goto err_out; 15007b36b6e0Skxie@chelsio.com 15017b36b6e0Skxie@chelsio.com for (i = 0; i < cdev->nports; i++) { 15027b36b6e0Skxie@chelsio.com pi = netdev_priv(lldi->ports[i]); 15037b36b6e0Skxie@chelsio.com cdev->hbas[i]->port_id = pi->port_id; 15047b36b6e0Skxie@chelsio.com } 15057b36b6e0Skxie@chelsio.com return cdev; 15067b36b6e0Skxie@chelsio.com 15077b36b6e0Skxie@chelsio.com err_out: 15087b36b6e0Skxie@chelsio.com cxgbi_device_unregister(cdev); 15097b36b6e0Skxie@chelsio.com return ERR_PTR(-ENOMEM); 15107b36b6e0Skxie@chelsio.com } 15117b36b6e0Skxie@chelsio.com 15127b36b6e0Skxie@chelsio.com #define RX_PULL_LEN 128 15137b36b6e0Skxie@chelsio.com static int t4_uld_rx_handler(void *handle, const __be64 *rsp, 15147b36b6e0Skxie@chelsio.com const struct pkt_gl *pgl) 15157b36b6e0Skxie@chelsio.com { 15167b36b6e0Skxie@chelsio.com const struct cpl_act_establish *rpl; 15177b36b6e0Skxie@chelsio.com struct sk_buff *skb; 15187b36b6e0Skxie@chelsio.com unsigned int opc; 15197b36b6e0Skxie@chelsio.com struct cxgbi_device *cdev = handle; 15207b36b6e0Skxie@chelsio.com 15217b36b6e0Skxie@chelsio.com if (pgl == NULL) { 15227b36b6e0Skxie@chelsio.com unsigned int len = 64 - sizeof(struct rsp_ctrl) - 8; 15237b36b6e0Skxie@chelsio.com 152424d3f95aSkxie@chelsio.com skb = alloc_wr(len, 0, GFP_ATOMIC); 15257b36b6e0Skxie@chelsio.com if (!skb) 15267b36b6e0Skxie@chelsio.com goto nomem; 15277b36b6e0Skxie@chelsio.com skb_copy_to_linear_data(skb, &rsp[1], len); 15287b36b6e0Skxie@chelsio.com } else { 15297b36b6e0Skxie@chelsio.com if (unlikely(*(u8 *)rsp != *(u8 *)pgl->va)) { 15307b36b6e0Skxie@chelsio.com pr_info("? FL 0x%p,RSS%#llx,FL %#llx,len %u.\n", 15317b36b6e0Skxie@chelsio.com pgl->va, be64_to_cpu(*rsp), 15327b36b6e0Skxie@chelsio.com be64_to_cpu(*(u64 *)pgl->va), 15337b36b6e0Skxie@chelsio.com pgl->tot_len); 15347b36b6e0Skxie@chelsio.com return 0; 15357b36b6e0Skxie@chelsio.com } 15367b36b6e0Skxie@chelsio.com skb = cxgb4_pktgl_to_skb(pgl, RX_PULL_LEN, RX_PULL_LEN); 15377b36b6e0Skxie@chelsio.com if (unlikely(!skb)) 15387b36b6e0Skxie@chelsio.com goto nomem; 15397b36b6e0Skxie@chelsio.com } 15407b36b6e0Skxie@chelsio.com 15417b36b6e0Skxie@chelsio.com rpl = (struct cpl_act_establish *)skb->data; 15427b36b6e0Skxie@chelsio.com opc = rpl->ot.opcode; 15437b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE, 15447b36b6e0Skxie@chelsio.com "cdev %p, opcode 0x%x(0x%x,0x%x), skb %p.\n", 15457b36b6e0Skxie@chelsio.com cdev, opc, rpl->ot.opcode_tid, ntohl(rpl->ot.opcode_tid), skb); 15467b36b6e0Skxie@chelsio.com if (cxgb4i_cplhandlers[opc]) 15477b36b6e0Skxie@chelsio.com cxgb4i_cplhandlers[opc](cdev, skb); 15487b36b6e0Skxie@chelsio.com else { 15497b36b6e0Skxie@chelsio.com pr_err("No handler for opcode 0x%x.\n", opc); 15507b36b6e0Skxie@chelsio.com __kfree_skb(skb); 15517b36b6e0Skxie@chelsio.com } 15527b36b6e0Skxie@chelsio.com return 0; 15537b36b6e0Skxie@chelsio.com nomem: 15547b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE, "OOM bailing out.\n"); 15557b36b6e0Skxie@chelsio.com return 1; 15567b36b6e0Skxie@chelsio.com } 15577b36b6e0Skxie@chelsio.com 15587b36b6e0Skxie@chelsio.com static int t4_uld_state_change(void *handle, enum cxgb4_state state) 15597b36b6e0Skxie@chelsio.com { 15607b36b6e0Skxie@chelsio.com struct cxgbi_device *cdev = handle; 15617b36b6e0Skxie@chelsio.com 15627b36b6e0Skxie@chelsio.com switch (state) { 15637b36b6e0Skxie@chelsio.com case CXGB4_STATE_UP: 15647b36b6e0Skxie@chelsio.com pr_info("cdev 0x%p, UP.\n", cdev); 15657b36b6e0Skxie@chelsio.com /* re-initialize */ 15667b36b6e0Skxie@chelsio.com break; 15677b36b6e0Skxie@chelsio.com case CXGB4_STATE_START_RECOVERY: 15687b36b6e0Skxie@chelsio.com pr_info("cdev 0x%p, RECOVERY.\n", cdev); 15697b36b6e0Skxie@chelsio.com /* close all connections */ 15707b36b6e0Skxie@chelsio.com break; 15717b36b6e0Skxie@chelsio.com case CXGB4_STATE_DOWN: 15727b36b6e0Skxie@chelsio.com pr_info("cdev 0x%p, DOWN.\n", cdev); 15737b36b6e0Skxie@chelsio.com break; 15747b36b6e0Skxie@chelsio.com case CXGB4_STATE_DETACH: 15757b36b6e0Skxie@chelsio.com pr_info("cdev 0x%p, DETACH.\n", cdev); 15767b36b6e0Skxie@chelsio.com break; 15777b36b6e0Skxie@chelsio.com default: 15787b36b6e0Skxie@chelsio.com pr_info("cdev 0x%p, unknown state %d.\n", cdev, state); 15797b36b6e0Skxie@chelsio.com break; 15807b36b6e0Skxie@chelsio.com } 15817b36b6e0Skxie@chelsio.com return 0; 15827b36b6e0Skxie@chelsio.com } 15837b36b6e0Skxie@chelsio.com 15847b36b6e0Skxie@chelsio.com static int __init cxgb4i_init_module(void) 15857b36b6e0Skxie@chelsio.com { 15867b36b6e0Skxie@chelsio.com int rc; 15877b36b6e0Skxie@chelsio.com 15887b36b6e0Skxie@chelsio.com printk(KERN_INFO "%s", version); 15897b36b6e0Skxie@chelsio.com 15907b36b6e0Skxie@chelsio.com rc = cxgbi_iscsi_init(&cxgb4i_iscsi_transport, &cxgb4i_stt); 15917b36b6e0Skxie@chelsio.com if (rc < 0) 15927b36b6e0Skxie@chelsio.com return rc; 15937b36b6e0Skxie@chelsio.com cxgb4_register_uld(CXGB4_ULD_ISCSI, &cxgb4i_uld_info); 15947b36b6e0Skxie@chelsio.com return 0; 15957b36b6e0Skxie@chelsio.com } 15967b36b6e0Skxie@chelsio.com 15977b36b6e0Skxie@chelsio.com static void __exit cxgb4i_exit_module(void) 15987b36b6e0Skxie@chelsio.com { 15997b36b6e0Skxie@chelsio.com cxgb4_unregister_uld(CXGB4_ULD_ISCSI); 16007b36b6e0Skxie@chelsio.com cxgbi_device_unregister_all(CXGBI_FLAG_DEV_T4); 16017b36b6e0Skxie@chelsio.com cxgbi_iscsi_cleanup(&cxgb4i_iscsi_transport, &cxgb4i_stt); 16027b36b6e0Skxie@chelsio.com } 16037b36b6e0Skxie@chelsio.com 16047b36b6e0Skxie@chelsio.com module_init(cxgb4i_init_module); 16057b36b6e0Skxie@chelsio.com module_exit(cxgb4i_exit_module); 1606