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/module.h> 177b36b6e0Skxie@chelsio.com #include <linux/moduleparam.h> 187b36b6e0Skxie@chelsio.com #include <scsi/scsi_host.h> 197b36b6e0Skxie@chelsio.com #include <net/tcp.h> 207b36b6e0Skxie@chelsio.com #include <net/dst.h> 217b36b6e0Skxie@chelsio.com #include <linux/netdevice.h> 22759a0cc5SAnish Bhatt #include <net/addrconf.h> 237b36b6e0Skxie@chelsio.com 243bd3e8bfSKaren Xie #include "t4_regs.h" 257b36b6e0Skxie@chelsio.com #include "t4_msg.h" 267b36b6e0Skxie@chelsio.com #include "cxgb4.h" 277b36b6e0Skxie@chelsio.com #include "cxgb4_uld.h" 287b36b6e0Skxie@chelsio.com #include "t4fw_api.h" 297b36b6e0Skxie@chelsio.com #include "l2t.h" 307b36b6e0Skxie@chelsio.com #include "cxgb4i.h" 317b36b6e0Skxie@chelsio.com 327b36b6e0Skxie@chelsio.com static unsigned int dbg_level; 337b36b6e0Skxie@chelsio.com 347b36b6e0Skxie@chelsio.com #include "../libcxgbi.h" 357b36b6e0Skxie@chelsio.com 367b36b6e0Skxie@chelsio.com #define DRV_MODULE_NAME "cxgb4i" 373bd3e8bfSKaren Xie #define DRV_MODULE_DESC "Chelsio T4/T5 iSCSI Driver" 383bd3e8bfSKaren Xie #define DRV_MODULE_VERSION "0.9.4" 397b36b6e0Skxie@chelsio.com 407b36b6e0Skxie@chelsio.com static char version[] = 417b36b6e0Skxie@chelsio.com DRV_MODULE_DESC " " DRV_MODULE_NAME 423bd3e8bfSKaren Xie " v" DRV_MODULE_VERSION "\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 | 109fdafd4dfSMike Christie CAP_PADDING_OFFLOAD | CAP_TEXT_NEGO, 1103128c6c7SMike Christie .attr_is_visible = cxgbi_attr_is_visible, 1117b36b6e0Skxie@chelsio.com .get_host_param = cxgbi_get_host_param, 1127b36b6e0Skxie@chelsio.com .set_host_param = cxgbi_set_host_param, 1137b36b6e0Skxie@chelsio.com /* session management */ 1147b36b6e0Skxie@chelsio.com .create_session = cxgbi_create_session, 1157b36b6e0Skxie@chelsio.com .destroy_session = cxgbi_destroy_session, 1167b36b6e0Skxie@chelsio.com .get_session_param = iscsi_session_get_param, 1177b36b6e0Skxie@chelsio.com /* connection management */ 1187b36b6e0Skxie@chelsio.com .create_conn = cxgbi_create_conn, 1197b36b6e0Skxie@chelsio.com .bind_conn = cxgbi_bind_conn, 1207b36b6e0Skxie@chelsio.com .destroy_conn = iscsi_tcp_conn_teardown, 1217b36b6e0Skxie@chelsio.com .start_conn = iscsi_conn_start, 1227b36b6e0Skxie@chelsio.com .stop_conn = iscsi_conn_stop, 123c71b9b66SMike Christie .get_conn_param = iscsi_conn_get_param, 1247b36b6e0Skxie@chelsio.com .set_param = cxgbi_set_conn_param, 1257b36b6e0Skxie@chelsio.com .get_stats = cxgbi_get_conn_stats, 1267b36b6e0Skxie@chelsio.com /* pdu xmit req from user space */ 1277b36b6e0Skxie@chelsio.com .send_pdu = iscsi_conn_send_pdu, 1287b36b6e0Skxie@chelsio.com /* task */ 1297b36b6e0Skxie@chelsio.com .init_task = iscsi_tcp_task_init, 1307b36b6e0Skxie@chelsio.com .xmit_task = iscsi_tcp_task_xmit, 1317b36b6e0Skxie@chelsio.com .cleanup_task = cxgbi_cleanup_task, 1327b36b6e0Skxie@chelsio.com /* pdu */ 1337b36b6e0Skxie@chelsio.com .alloc_pdu = cxgbi_conn_alloc_pdu, 1347b36b6e0Skxie@chelsio.com .init_pdu = cxgbi_conn_init_pdu, 1357b36b6e0Skxie@chelsio.com .xmit_pdu = cxgbi_conn_xmit_pdu, 1367b36b6e0Skxie@chelsio.com .parse_pdu_itt = cxgbi_parse_pdu_itt, 1377b36b6e0Skxie@chelsio.com /* TCP connect/disconnect */ 138c71b9b66SMike Christie .get_ep_param = cxgbi_get_ep_param, 1397b36b6e0Skxie@chelsio.com .ep_connect = cxgbi_ep_connect, 1407b36b6e0Skxie@chelsio.com .ep_poll = cxgbi_ep_poll, 1417b36b6e0Skxie@chelsio.com .ep_disconnect = cxgbi_ep_disconnect, 1427b36b6e0Skxie@chelsio.com /* Error recovery timeout call */ 1437b36b6e0Skxie@chelsio.com .session_recovery_timedout = iscsi_session_recovery_timedout, 1447b36b6e0Skxie@chelsio.com }; 1457b36b6e0Skxie@chelsio.com 1467b36b6e0Skxie@chelsio.com static struct scsi_transport_template *cxgb4i_stt; 1477b36b6e0Skxie@chelsio.com 1487b36b6e0Skxie@chelsio.com /* 1497b36b6e0Skxie@chelsio.com * CPL (Chelsio Protocol Language) defines a message passing interface between 1507b36b6e0Skxie@chelsio.com * the host driver and Chelsio asic. 1517b36b6e0Skxie@chelsio.com * The section below implments CPLs that related to iscsi tcp connection 1527b36b6e0Skxie@chelsio.com * open/close/abort and data send/receive. 1537b36b6e0Skxie@chelsio.com */ 154759a0cc5SAnish Bhatt 1557b36b6e0Skxie@chelsio.com #define DIV_ROUND_UP(n, d) (((n) + (d) - 1) / (d)) 1567b36b6e0Skxie@chelsio.com #define RCV_BUFSIZ_MASK 0x3FFU 1577b36b6e0Skxie@chelsio.com #define MAX_IMM_TX_PKT_LEN 128 1587b36b6e0Skxie@chelsio.com 1597b36b6e0Skxie@chelsio.com static inline void set_queue(struct sk_buff *skb, unsigned int queue, 1607b36b6e0Skxie@chelsio.com const struct cxgbi_sock *csk) 1617b36b6e0Skxie@chelsio.com { 1627b36b6e0Skxie@chelsio.com skb->queue_mapping = queue; 1637b36b6e0Skxie@chelsio.com } 1647b36b6e0Skxie@chelsio.com 1657b36b6e0Skxie@chelsio.com static int push_tx_frames(struct cxgbi_sock *, int); 1667b36b6e0Skxie@chelsio.com 1677b36b6e0Skxie@chelsio.com /* 1687b36b6e0Skxie@chelsio.com * is_ofld_imm - check whether a packet can be sent as immediate data 1697b36b6e0Skxie@chelsio.com * @skb: the packet 1707b36b6e0Skxie@chelsio.com * 1717b36b6e0Skxie@chelsio.com * Returns true if a packet can be sent as an offload WR with immediate 1727b36b6e0Skxie@chelsio.com * data. We currently use the same limit as for Ethernet packets. 1737b36b6e0Skxie@chelsio.com */ 1747b36b6e0Skxie@chelsio.com static inline int is_ofld_imm(const struct sk_buff *skb) 1757b36b6e0Skxie@chelsio.com { 1767b36b6e0Skxie@chelsio.com return skb->len <= (MAX_IMM_TX_PKT_LEN - 1777b36b6e0Skxie@chelsio.com sizeof(struct fw_ofld_tx_data_wr)); 1787b36b6e0Skxie@chelsio.com } 1797b36b6e0Skxie@chelsio.com 1807b36b6e0Skxie@chelsio.com static void send_act_open_req(struct cxgbi_sock *csk, struct sk_buff *skb, 1817b36b6e0Skxie@chelsio.com struct l2t_entry *e) 1827b36b6e0Skxie@chelsio.com { 1833bd3e8bfSKaren Xie struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(csk->cdev); 184759a0cc5SAnish Bhatt int t4 = is_t4(lldi->adapter_type); 1857b36b6e0Skxie@chelsio.com int wscale = cxgbi_sock_compute_wscale(csk->mss_idx); 1867b36b6e0Skxie@chelsio.com unsigned long long opt0; 1877b36b6e0Skxie@chelsio.com unsigned int opt2; 1887b36b6e0Skxie@chelsio.com unsigned int qid_atid = ((unsigned int)csk->atid) | 1897b36b6e0Skxie@chelsio.com (((unsigned int)csk->rss_qid) << 14); 1907b36b6e0Skxie@chelsio.com 1917b36b6e0Skxie@chelsio.com opt0 = KEEP_ALIVE(1) | 1927b36b6e0Skxie@chelsio.com WND_SCALE(wscale) | 1937b36b6e0Skxie@chelsio.com MSS_IDX(csk->mss_idx) | 1947b36b6e0Skxie@chelsio.com L2T_IDX(((struct l2t_entry *)csk->l2t)->idx) | 1957b36b6e0Skxie@chelsio.com TX_CHAN(csk->tx_chan) | 1967b36b6e0Skxie@chelsio.com SMAC_SEL(csk->smac_idx) | 1977b36b6e0Skxie@chelsio.com ULP_MODE(ULP_MODE_ISCSI) | 1987b36b6e0Skxie@chelsio.com RCV_BUFSIZ(cxgb4i_rcv_win >> 10); 1997b36b6e0Skxie@chelsio.com opt2 = RX_CHANNEL(0) | 2007b36b6e0Skxie@chelsio.com RSS_QUEUE_VALID | 2013bd3e8bfSKaren Xie (1 << 20) | 2027b36b6e0Skxie@chelsio.com RSS_QUEUE(csk->rss_qid); 2037b36b6e0Skxie@chelsio.com 2043bd3e8bfSKaren Xie if (is_t4(lldi->adapter_type)) { 2053bd3e8bfSKaren Xie struct cpl_act_open_req *req = 2063bd3e8bfSKaren Xie (struct cpl_act_open_req *)skb->head; 2073bd3e8bfSKaren Xie 2087b36b6e0Skxie@chelsio.com INIT_TP_WR(req, 0); 2097b36b6e0Skxie@chelsio.com OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_ACT_OPEN_REQ, 2107b36b6e0Skxie@chelsio.com qid_atid)); 2117b36b6e0Skxie@chelsio.com req->local_port = csk->saddr.sin_port; 2127b36b6e0Skxie@chelsio.com req->peer_port = csk->daddr.sin_port; 2137b36b6e0Skxie@chelsio.com req->local_ip = csk->saddr.sin_addr.s_addr; 2147b36b6e0Skxie@chelsio.com req->peer_ip = csk->daddr.sin_addr.s_addr; 2157b36b6e0Skxie@chelsio.com req->opt0 = cpu_to_be64(opt0); 216ac0245ffSKaren Xie req->params = cpu_to_be32(cxgb4_select_ntuple( 217ac0245ffSKaren Xie csk->cdev->ports[csk->port_id], 218ac0245ffSKaren Xie csk->l2t)); 2193bd3e8bfSKaren Xie opt2 |= 1 << 22; 2207b36b6e0Skxie@chelsio.com req->opt2 = cpu_to_be32(opt2); 2217b36b6e0Skxie@chelsio.com 2227b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 2233bd3e8bfSKaren Xie "csk t4 0x%p, %pI4:%u-%pI4:%u, atid %d, qid %u.\n", 2247b36b6e0Skxie@chelsio.com csk, &req->local_ip, ntohs(req->local_port), 2257b36b6e0Skxie@chelsio.com &req->peer_ip, ntohs(req->peer_port), 2267b36b6e0Skxie@chelsio.com csk->atid, csk->rss_qid); 2273bd3e8bfSKaren Xie } else { 2283bd3e8bfSKaren Xie struct cpl_t5_act_open_req *req = 2293bd3e8bfSKaren Xie (struct cpl_t5_act_open_req *)skb->head; 2307b36b6e0Skxie@chelsio.com 2313bd3e8bfSKaren Xie INIT_TP_WR(req, 0); 2323bd3e8bfSKaren Xie OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_ACT_OPEN_REQ, 2333bd3e8bfSKaren Xie qid_atid)); 2343bd3e8bfSKaren Xie req->local_port = csk->saddr.sin_port; 2353bd3e8bfSKaren Xie req->peer_port = csk->daddr.sin_port; 2363bd3e8bfSKaren Xie req->local_ip = csk->saddr.sin_addr.s_addr; 2373bd3e8bfSKaren Xie req->peer_ip = csk->daddr.sin_addr.s_addr; 2383bd3e8bfSKaren Xie req->opt0 = cpu_to_be64(opt0); 239ac0245ffSKaren Xie req->params = cpu_to_be64(V_FILTER_TUPLE( 240ac0245ffSKaren Xie cxgb4_select_ntuple( 241ac0245ffSKaren Xie csk->cdev->ports[csk->port_id], 242ac0245ffSKaren Xie csk->l2t))); 2433bd3e8bfSKaren Xie opt2 |= 1 << 31; 2443bd3e8bfSKaren Xie req->opt2 = cpu_to_be32(opt2); 2453bd3e8bfSKaren Xie 2463bd3e8bfSKaren Xie log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 2473bd3e8bfSKaren Xie "csk t5 0x%p, %pI4:%u-%pI4:%u, atid %d, qid %u.\n", 2483bd3e8bfSKaren Xie csk, &req->local_ip, ntohs(req->local_port), 2493bd3e8bfSKaren Xie &req->peer_ip, ntohs(req->peer_port), 2503bd3e8bfSKaren Xie csk->atid, csk->rss_qid); 2513bd3e8bfSKaren Xie } 2523bd3e8bfSKaren Xie 2533bd3e8bfSKaren Xie set_wr_txq(skb, CPL_PRIORITY_SETUP, csk->port_id); 254759a0cc5SAnish Bhatt 255759a0cc5SAnish Bhatt pr_info_ipaddr("t%d csk 0x%p,%u,0x%lx,%u, rss_qid %u.\n", 256759a0cc5SAnish Bhatt (&csk->saddr), (&csk->daddr), t4 ? 4 : 5, csk, 257759a0cc5SAnish Bhatt csk->state, csk->flags, csk->atid, csk->rss_qid); 258759a0cc5SAnish Bhatt 259759a0cc5SAnish Bhatt cxgb4_l2t_send(csk->cdev->ports[csk->port_id], skb, csk->l2t); 260759a0cc5SAnish Bhatt } 261759a0cc5SAnish Bhatt 262f42bb57cSAnish Bhatt #if IS_ENABLED(CONFIG_IPV6) 263759a0cc5SAnish Bhatt static void send_act_open_req6(struct cxgbi_sock *csk, struct sk_buff *skb, 264759a0cc5SAnish Bhatt struct l2t_entry *e) 265759a0cc5SAnish Bhatt { 266759a0cc5SAnish Bhatt struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(csk->cdev); 267759a0cc5SAnish Bhatt int t4 = is_t4(lldi->adapter_type); 268759a0cc5SAnish Bhatt int wscale = cxgbi_sock_compute_wscale(csk->mss_idx); 269759a0cc5SAnish Bhatt unsigned long long opt0; 270759a0cc5SAnish Bhatt unsigned int opt2; 271759a0cc5SAnish Bhatt unsigned int qid_atid = ((unsigned int)csk->atid) | 272759a0cc5SAnish Bhatt (((unsigned int)csk->rss_qid) << 14); 273759a0cc5SAnish Bhatt 274759a0cc5SAnish Bhatt opt0 = KEEP_ALIVE(1) | 275759a0cc5SAnish Bhatt WND_SCALE(wscale) | 276759a0cc5SAnish Bhatt MSS_IDX(csk->mss_idx) | 277759a0cc5SAnish Bhatt L2T_IDX(((struct l2t_entry *)csk->l2t)->idx) | 278759a0cc5SAnish Bhatt TX_CHAN(csk->tx_chan) | 279759a0cc5SAnish Bhatt SMAC_SEL(csk->smac_idx) | 280759a0cc5SAnish Bhatt ULP_MODE(ULP_MODE_ISCSI) | 281759a0cc5SAnish Bhatt RCV_BUFSIZ(cxgb4i_rcv_win >> 10); 282759a0cc5SAnish Bhatt 283759a0cc5SAnish Bhatt opt2 = RX_CHANNEL(0) | 284759a0cc5SAnish Bhatt RSS_QUEUE_VALID | 285759a0cc5SAnish Bhatt RX_FC_DISABLE | 286759a0cc5SAnish Bhatt RSS_QUEUE(csk->rss_qid); 287759a0cc5SAnish Bhatt 288759a0cc5SAnish Bhatt if (t4) { 289759a0cc5SAnish Bhatt struct cpl_act_open_req6 *req = 290759a0cc5SAnish Bhatt (struct cpl_act_open_req6 *)skb->head; 291759a0cc5SAnish Bhatt 292759a0cc5SAnish Bhatt INIT_TP_WR(req, 0); 293759a0cc5SAnish Bhatt OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_ACT_OPEN_REQ6, 294759a0cc5SAnish Bhatt qid_atid)); 295759a0cc5SAnish Bhatt req->local_port = csk->saddr6.sin6_port; 296759a0cc5SAnish Bhatt req->peer_port = csk->daddr6.sin6_port; 297759a0cc5SAnish Bhatt 298759a0cc5SAnish Bhatt req->local_ip_hi = *(__be64 *)(csk->saddr6.sin6_addr.s6_addr); 299759a0cc5SAnish Bhatt req->local_ip_lo = *(__be64 *)(csk->saddr6.sin6_addr.s6_addr + 300759a0cc5SAnish Bhatt 8); 301759a0cc5SAnish Bhatt req->peer_ip_hi = *(__be64 *)(csk->daddr6.sin6_addr.s6_addr); 302759a0cc5SAnish Bhatt req->peer_ip_lo = *(__be64 *)(csk->daddr6.sin6_addr.s6_addr + 303759a0cc5SAnish Bhatt 8); 304759a0cc5SAnish Bhatt 305759a0cc5SAnish Bhatt req->opt0 = cpu_to_be64(opt0); 306759a0cc5SAnish Bhatt 307759a0cc5SAnish Bhatt opt2 |= RX_FC_VALID; 308759a0cc5SAnish Bhatt req->opt2 = cpu_to_be32(opt2); 309759a0cc5SAnish Bhatt 310759a0cc5SAnish Bhatt req->params = cpu_to_be32(cxgb4_select_ntuple( 311759a0cc5SAnish Bhatt csk->cdev->ports[csk->port_id], 312759a0cc5SAnish Bhatt csk->l2t)); 313759a0cc5SAnish Bhatt } else { 314759a0cc5SAnish Bhatt struct cpl_t5_act_open_req6 *req = 315759a0cc5SAnish Bhatt (struct cpl_t5_act_open_req6 *)skb->head; 316759a0cc5SAnish Bhatt 317759a0cc5SAnish Bhatt INIT_TP_WR(req, 0); 318759a0cc5SAnish Bhatt OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_ACT_OPEN_REQ6, 319759a0cc5SAnish Bhatt qid_atid)); 320759a0cc5SAnish Bhatt req->local_port = csk->saddr6.sin6_port; 321759a0cc5SAnish Bhatt req->peer_port = csk->daddr6.sin6_port; 322759a0cc5SAnish Bhatt req->local_ip_hi = *(__be64 *)(csk->saddr6.sin6_addr.s6_addr); 323759a0cc5SAnish Bhatt req->local_ip_lo = *(__be64 *)(csk->saddr6.sin6_addr.s6_addr + 324759a0cc5SAnish Bhatt 8); 325759a0cc5SAnish Bhatt req->peer_ip_hi = *(__be64 *)(csk->daddr6.sin6_addr.s6_addr); 326759a0cc5SAnish Bhatt req->peer_ip_lo = *(__be64 *)(csk->daddr6.sin6_addr.s6_addr + 327759a0cc5SAnish Bhatt 8); 328759a0cc5SAnish Bhatt req->opt0 = cpu_to_be64(opt0); 329759a0cc5SAnish Bhatt 330759a0cc5SAnish Bhatt opt2 |= T5_OPT_2_VALID; 331759a0cc5SAnish Bhatt req->opt2 = cpu_to_be32(opt2); 332759a0cc5SAnish Bhatt 333759a0cc5SAnish Bhatt req->params = cpu_to_be64(V_FILTER_TUPLE(cxgb4_select_ntuple( 334759a0cc5SAnish Bhatt csk->cdev->ports[csk->port_id], 335759a0cc5SAnish Bhatt csk->l2t))); 336759a0cc5SAnish Bhatt } 337759a0cc5SAnish Bhatt 338759a0cc5SAnish Bhatt set_wr_txq(skb, CPL_PRIORITY_SETUP, csk->port_id); 339759a0cc5SAnish Bhatt 340759a0cc5SAnish Bhatt pr_info("t%d csk 0x%p,%u,0x%lx,%u, [%pI6]:%u-[%pI6]:%u, rss_qid %u.\n", 341759a0cc5SAnish Bhatt t4 ? 4 : 5, csk, csk->state, csk->flags, csk->atid, 342759a0cc5SAnish Bhatt &csk->saddr6.sin6_addr, ntohs(csk->saddr.sin_port), 343759a0cc5SAnish Bhatt &csk->daddr6.sin6_addr, ntohs(csk->daddr.sin_port), 344759a0cc5SAnish Bhatt csk->rss_qid); 345759a0cc5SAnish Bhatt 3467b36b6e0Skxie@chelsio.com cxgb4_l2t_send(csk->cdev->ports[csk->port_id], skb, csk->l2t); 3477b36b6e0Skxie@chelsio.com } 348f42bb57cSAnish Bhatt #endif 3497b36b6e0Skxie@chelsio.com 3507b36b6e0Skxie@chelsio.com static void send_close_req(struct cxgbi_sock *csk) 3517b36b6e0Skxie@chelsio.com { 3527b36b6e0Skxie@chelsio.com struct sk_buff *skb = csk->cpl_close; 3537b36b6e0Skxie@chelsio.com struct cpl_close_con_req *req = (struct cpl_close_con_req *)skb->head; 3547b36b6e0Skxie@chelsio.com unsigned int tid = csk->tid; 3557b36b6e0Skxie@chelsio.com 3567b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 3577b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, tid %u.\n", 3587b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 3597b36b6e0Skxie@chelsio.com csk->cpl_close = NULL; 3607b36b6e0Skxie@chelsio.com set_wr_txq(skb, CPL_PRIORITY_DATA, csk->port_id); 3617b36b6e0Skxie@chelsio.com INIT_TP_WR(req, tid); 3627b36b6e0Skxie@chelsio.com OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_CLOSE_CON_REQ, tid)); 3637b36b6e0Skxie@chelsio.com req->rsvd = 0; 3647b36b6e0Skxie@chelsio.com 3657b36b6e0Skxie@chelsio.com cxgbi_sock_skb_entail(csk, skb); 3667b36b6e0Skxie@chelsio.com if (csk->state >= CTP_ESTABLISHED) 3677b36b6e0Skxie@chelsio.com push_tx_frames(csk, 1); 3687b36b6e0Skxie@chelsio.com } 3697b36b6e0Skxie@chelsio.com 3707b36b6e0Skxie@chelsio.com static void abort_arp_failure(void *handle, struct sk_buff *skb) 3717b36b6e0Skxie@chelsio.com { 3727b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk = (struct cxgbi_sock *)handle; 3737b36b6e0Skxie@chelsio.com struct cpl_abort_req *req; 3747b36b6e0Skxie@chelsio.com 3757b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 3767b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, tid %u, abort.\n", 3777b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 3787b36b6e0Skxie@chelsio.com req = (struct cpl_abort_req *)skb->data; 3797b36b6e0Skxie@chelsio.com req->cmd = CPL_ABORT_NO_RST; 3807b36b6e0Skxie@chelsio.com cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb); 3817b36b6e0Skxie@chelsio.com } 3827b36b6e0Skxie@chelsio.com 3837b36b6e0Skxie@chelsio.com static void send_abort_req(struct cxgbi_sock *csk) 3847b36b6e0Skxie@chelsio.com { 3857b36b6e0Skxie@chelsio.com struct cpl_abort_req *req; 3867b36b6e0Skxie@chelsio.com struct sk_buff *skb = csk->cpl_abort_req; 3877b36b6e0Skxie@chelsio.com 3887b36b6e0Skxie@chelsio.com if (unlikely(csk->state == CTP_ABORTING) || !skb || !csk->cdev) 3897b36b6e0Skxie@chelsio.com return; 3907b36b6e0Skxie@chelsio.com cxgbi_sock_set_state(csk, CTP_ABORTING); 3917b36b6e0Skxie@chelsio.com cxgbi_sock_set_flag(csk, CTPF_ABORT_RPL_PENDING); 3927b36b6e0Skxie@chelsio.com cxgbi_sock_purge_write_queue(csk); 3937b36b6e0Skxie@chelsio.com 3947b36b6e0Skxie@chelsio.com csk->cpl_abort_req = NULL; 3957b36b6e0Skxie@chelsio.com req = (struct cpl_abort_req *)skb->head; 3967b36b6e0Skxie@chelsio.com set_queue(skb, CPL_PRIORITY_DATA, csk); 3977b36b6e0Skxie@chelsio.com req->cmd = CPL_ABORT_SEND_RST; 3987b36b6e0Skxie@chelsio.com t4_set_arp_err_handler(skb, csk, abort_arp_failure); 3997b36b6e0Skxie@chelsio.com INIT_TP_WR(req, csk->tid); 4007b36b6e0Skxie@chelsio.com OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_ABORT_REQ, csk->tid)); 4017b36b6e0Skxie@chelsio.com req->rsvd0 = htonl(csk->snd_nxt); 4027b36b6e0Skxie@chelsio.com req->rsvd1 = !cxgbi_sock_flag(csk, CTPF_TX_DATA_SENT); 4037b36b6e0Skxie@chelsio.com 4047b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 4057b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, snd_nxt %u, 0x%x.\n", 4067b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, csk->snd_nxt, 4077b36b6e0Skxie@chelsio.com req->rsvd1); 4087b36b6e0Skxie@chelsio.com 4097b36b6e0Skxie@chelsio.com cxgb4_l2t_send(csk->cdev->ports[csk->port_id], skb, csk->l2t); 4107b36b6e0Skxie@chelsio.com } 4117b36b6e0Skxie@chelsio.com 4127b36b6e0Skxie@chelsio.com static void send_abort_rpl(struct cxgbi_sock *csk, int rst_status) 4137b36b6e0Skxie@chelsio.com { 4147b36b6e0Skxie@chelsio.com struct sk_buff *skb = csk->cpl_abort_rpl; 4157b36b6e0Skxie@chelsio.com struct cpl_abort_rpl *rpl = (struct cpl_abort_rpl *)skb->head; 4167b36b6e0Skxie@chelsio.com 4177b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 4187b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, status %d.\n", 4197b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, rst_status); 4207b36b6e0Skxie@chelsio.com 4217b36b6e0Skxie@chelsio.com csk->cpl_abort_rpl = NULL; 4227b36b6e0Skxie@chelsio.com set_queue(skb, CPL_PRIORITY_DATA, csk); 4237b36b6e0Skxie@chelsio.com INIT_TP_WR(rpl, csk->tid); 4247b36b6e0Skxie@chelsio.com OPCODE_TID(rpl) = cpu_to_be32(MK_OPCODE_TID(CPL_ABORT_RPL, csk->tid)); 4257b36b6e0Skxie@chelsio.com rpl->cmd = rst_status; 4267b36b6e0Skxie@chelsio.com cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb); 4277b36b6e0Skxie@chelsio.com } 4287b36b6e0Skxie@chelsio.com 4297b36b6e0Skxie@chelsio.com /* 4307b36b6e0Skxie@chelsio.com * CPL connection rx data ack: host -> 4317b36b6e0Skxie@chelsio.com * Send RX credits through an RX_DATA_ACK CPL message. Returns the number of 4327b36b6e0Skxie@chelsio.com * credits sent. 4337b36b6e0Skxie@chelsio.com */ 4347b36b6e0Skxie@chelsio.com static u32 send_rx_credits(struct cxgbi_sock *csk, u32 credits) 4357b36b6e0Skxie@chelsio.com { 4367b36b6e0Skxie@chelsio.com struct sk_buff *skb; 4377b36b6e0Skxie@chelsio.com struct cpl_rx_data_ack *req; 4387b36b6e0Skxie@chelsio.com 4397b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX, 4407b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, credit %u.\n", 4417b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, credits); 4427b36b6e0Skxie@chelsio.com 44324d3f95aSkxie@chelsio.com skb = alloc_wr(sizeof(*req), 0, GFP_ATOMIC); 4447b36b6e0Skxie@chelsio.com if (!skb) { 4457b36b6e0Skxie@chelsio.com pr_info("csk 0x%p, credit %u, OOM.\n", csk, credits); 4467b36b6e0Skxie@chelsio.com return 0; 4477b36b6e0Skxie@chelsio.com } 4487b36b6e0Skxie@chelsio.com req = (struct cpl_rx_data_ack *)skb->head; 4497b36b6e0Skxie@chelsio.com 4507b36b6e0Skxie@chelsio.com set_wr_txq(skb, CPL_PRIORITY_ACK, csk->port_id); 4517b36b6e0Skxie@chelsio.com INIT_TP_WR(req, csk->tid); 4527b36b6e0Skxie@chelsio.com OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_RX_DATA_ACK, 4537b36b6e0Skxie@chelsio.com csk->tid)); 4547b36b6e0Skxie@chelsio.com req->credit_dack = cpu_to_be32(RX_CREDITS(credits) | RX_FORCE_ACK(1)); 4557b36b6e0Skxie@chelsio.com cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb); 4567b36b6e0Skxie@chelsio.com return credits; 4577b36b6e0Skxie@chelsio.com } 4587b36b6e0Skxie@chelsio.com 4597b36b6e0Skxie@chelsio.com /* 4607b36b6e0Skxie@chelsio.com * sgl_len - calculates the size of an SGL of the given capacity 4617b36b6e0Skxie@chelsio.com * @n: the number of SGL entries 4627b36b6e0Skxie@chelsio.com * Calculates the number of flits needed for a scatter/gather list that 4637b36b6e0Skxie@chelsio.com * can hold the given number of entries. 4647b36b6e0Skxie@chelsio.com */ 4657b36b6e0Skxie@chelsio.com static inline unsigned int sgl_len(unsigned int n) 4667b36b6e0Skxie@chelsio.com { 4677b36b6e0Skxie@chelsio.com n--; 4687b36b6e0Skxie@chelsio.com return (3 * n) / 2 + (n & 1) + 2; 4697b36b6e0Skxie@chelsio.com } 4707b36b6e0Skxie@chelsio.com 4717b36b6e0Skxie@chelsio.com /* 4727b36b6e0Skxie@chelsio.com * calc_tx_flits_ofld - calculate # of flits for an offload packet 4737b36b6e0Skxie@chelsio.com * @skb: the packet 4747b36b6e0Skxie@chelsio.com * 4757b36b6e0Skxie@chelsio.com * Returns the number of flits needed for the given offload packet. 4767b36b6e0Skxie@chelsio.com * These packets are already fully constructed and no additional headers 4777b36b6e0Skxie@chelsio.com * will be added. 4787b36b6e0Skxie@chelsio.com */ 4797b36b6e0Skxie@chelsio.com static inline unsigned int calc_tx_flits_ofld(const struct sk_buff *skb) 4807b36b6e0Skxie@chelsio.com { 4817b36b6e0Skxie@chelsio.com unsigned int flits, cnt; 4827b36b6e0Skxie@chelsio.com 4837b36b6e0Skxie@chelsio.com if (is_ofld_imm(skb)) 4847b36b6e0Skxie@chelsio.com return DIV_ROUND_UP(skb->len, 8); 4857b36b6e0Skxie@chelsio.com flits = skb_transport_offset(skb) / 8; 4867b36b6e0Skxie@chelsio.com cnt = skb_shinfo(skb)->nr_frags; 487499e2e6fSIsaku Yamahata if (skb_tail_pointer(skb) != skb_transport_header(skb)) 4887b36b6e0Skxie@chelsio.com cnt++; 4897b36b6e0Skxie@chelsio.com return flits + sgl_len(cnt); 4907b36b6e0Skxie@chelsio.com } 4917b36b6e0Skxie@chelsio.com 4927b36b6e0Skxie@chelsio.com static inline void send_tx_flowc_wr(struct cxgbi_sock *csk) 4937b36b6e0Skxie@chelsio.com { 4947b36b6e0Skxie@chelsio.com struct sk_buff *skb; 4957b36b6e0Skxie@chelsio.com struct fw_flowc_wr *flowc; 4967b36b6e0Skxie@chelsio.com int flowclen, i; 4977b36b6e0Skxie@chelsio.com 4987b36b6e0Skxie@chelsio.com flowclen = 80; 49924d3f95aSkxie@chelsio.com skb = alloc_wr(flowclen, 0, GFP_ATOMIC); 5007b36b6e0Skxie@chelsio.com flowc = (struct fw_flowc_wr *)skb->head; 5017b36b6e0Skxie@chelsio.com flowc->op_to_nparams = 5027b36b6e0Skxie@chelsio.com htonl(FW_WR_OP(FW_FLOWC_WR) | FW_FLOWC_WR_NPARAMS(8)); 5037b36b6e0Skxie@chelsio.com flowc->flowid_len16 = 5047b36b6e0Skxie@chelsio.com htonl(FW_WR_LEN16(DIV_ROUND_UP(72, 16)) | 5057b36b6e0Skxie@chelsio.com FW_WR_FLOWID(csk->tid)); 5067b36b6e0Skxie@chelsio.com flowc->mnemval[0].mnemonic = FW_FLOWC_MNEM_PFNVFN; 507e27d6169Skxie@chelsio.com flowc->mnemval[0].val = htonl(csk->cdev->pfvf); 5087b36b6e0Skxie@chelsio.com flowc->mnemval[1].mnemonic = FW_FLOWC_MNEM_CH; 5097b36b6e0Skxie@chelsio.com flowc->mnemval[1].val = htonl(csk->tx_chan); 5107b36b6e0Skxie@chelsio.com flowc->mnemval[2].mnemonic = FW_FLOWC_MNEM_PORT; 5117b36b6e0Skxie@chelsio.com flowc->mnemval[2].val = htonl(csk->tx_chan); 5127b36b6e0Skxie@chelsio.com flowc->mnemval[3].mnemonic = FW_FLOWC_MNEM_IQID; 5137b36b6e0Skxie@chelsio.com flowc->mnemval[3].val = htonl(csk->rss_qid); 5147b36b6e0Skxie@chelsio.com flowc->mnemval[4].mnemonic = FW_FLOWC_MNEM_SNDNXT; 5157b36b6e0Skxie@chelsio.com flowc->mnemval[4].val = htonl(csk->snd_nxt); 5167b36b6e0Skxie@chelsio.com flowc->mnemval[5].mnemonic = FW_FLOWC_MNEM_RCVNXT; 5177b36b6e0Skxie@chelsio.com flowc->mnemval[5].val = htonl(csk->rcv_nxt); 5187b36b6e0Skxie@chelsio.com flowc->mnemval[6].mnemonic = FW_FLOWC_MNEM_SNDBUF; 5197b36b6e0Skxie@chelsio.com flowc->mnemval[6].val = htonl(cxgb4i_snd_win); 5207b36b6e0Skxie@chelsio.com flowc->mnemval[7].mnemonic = FW_FLOWC_MNEM_MSS; 5217b36b6e0Skxie@chelsio.com flowc->mnemval[7].val = htonl(csk->advmss); 5227b36b6e0Skxie@chelsio.com flowc->mnemval[8].mnemonic = 0; 5237b36b6e0Skxie@chelsio.com flowc->mnemval[8].val = 0; 5247b36b6e0Skxie@chelsio.com for (i = 0; i < 9; i++) { 5257b36b6e0Skxie@chelsio.com flowc->mnemval[i].r4[0] = 0; 5267b36b6e0Skxie@chelsio.com flowc->mnemval[i].r4[1] = 0; 5277b36b6e0Skxie@chelsio.com flowc->mnemval[i].r4[2] = 0; 5287b36b6e0Skxie@chelsio.com } 5297b36b6e0Skxie@chelsio.com set_queue(skb, CPL_PRIORITY_DATA, csk); 5307b36b6e0Skxie@chelsio.com 5317b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 5327b36b6e0Skxie@chelsio.com "csk 0x%p, tid 0x%x, %u,%u,%u,%u,%u,%u,%u.\n", 5337b36b6e0Skxie@chelsio.com csk, csk->tid, 0, csk->tx_chan, csk->rss_qid, 5347b36b6e0Skxie@chelsio.com csk->snd_nxt, csk->rcv_nxt, cxgb4i_snd_win, 5357b36b6e0Skxie@chelsio.com csk->advmss); 5367b36b6e0Skxie@chelsio.com 5377b36b6e0Skxie@chelsio.com cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb); 5387b36b6e0Skxie@chelsio.com } 5397b36b6e0Skxie@chelsio.com 5407b36b6e0Skxie@chelsio.com static inline void make_tx_data_wr(struct cxgbi_sock *csk, struct sk_buff *skb, 5417b36b6e0Skxie@chelsio.com int dlen, int len, u32 credits, int compl) 5427b36b6e0Skxie@chelsio.com { 5437b36b6e0Skxie@chelsio.com struct fw_ofld_tx_data_wr *req; 5447b36b6e0Skxie@chelsio.com unsigned int submode = cxgbi_skcb_ulp_mode(skb) & 3; 5457b36b6e0Skxie@chelsio.com unsigned int wr_ulp_mode = 0; 5467b36b6e0Skxie@chelsio.com 5477b36b6e0Skxie@chelsio.com req = (struct fw_ofld_tx_data_wr *)__skb_push(skb, sizeof(*req)); 5487b36b6e0Skxie@chelsio.com 5497b36b6e0Skxie@chelsio.com if (is_ofld_imm(skb)) { 5507b36b6e0Skxie@chelsio.com req->op_to_immdlen = htonl(FW_WR_OP(FW_OFLD_TX_DATA_WR) | 5517b36b6e0Skxie@chelsio.com FW_WR_COMPL(1) | 5527b36b6e0Skxie@chelsio.com FW_WR_IMMDLEN(dlen)); 5537b36b6e0Skxie@chelsio.com req->flowid_len16 = htonl(FW_WR_FLOWID(csk->tid) | 5547b36b6e0Skxie@chelsio.com FW_WR_LEN16(credits)); 5557b36b6e0Skxie@chelsio.com } else { 5567b36b6e0Skxie@chelsio.com req->op_to_immdlen = 5577b36b6e0Skxie@chelsio.com cpu_to_be32(FW_WR_OP(FW_OFLD_TX_DATA_WR) | 5587b36b6e0Skxie@chelsio.com FW_WR_COMPL(1) | 5597b36b6e0Skxie@chelsio.com FW_WR_IMMDLEN(0)); 5607b36b6e0Skxie@chelsio.com req->flowid_len16 = 5617b36b6e0Skxie@chelsio.com cpu_to_be32(FW_WR_FLOWID(csk->tid) | 5627b36b6e0Skxie@chelsio.com FW_WR_LEN16(credits)); 5637b36b6e0Skxie@chelsio.com } 5647b36b6e0Skxie@chelsio.com if (submode) 5657b36b6e0Skxie@chelsio.com wr_ulp_mode = FW_OFLD_TX_DATA_WR_ULPMODE(ULP2_MODE_ISCSI) | 5667b36b6e0Skxie@chelsio.com FW_OFLD_TX_DATA_WR_ULPSUBMODE(submode); 5676aca4112SKaren Xie req->tunnel_to_proxy = htonl(wr_ulp_mode | 5686aca4112SKaren Xie FW_OFLD_TX_DATA_WR_SHOVE(skb_peek(&csk->write_queue) ? 0 : 1)); 5697b36b6e0Skxie@chelsio.com req->plen = htonl(len); 5707b36b6e0Skxie@chelsio.com if (!cxgbi_sock_flag(csk, CTPF_TX_DATA_SENT)) 5717b36b6e0Skxie@chelsio.com cxgbi_sock_set_flag(csk, CTPF_TX_DATA_SENT); 5727b36b6e0Skxie@chelsio.com } 5737b36b6e0Skxie@chelsio.com 5747b36b6e0Skxie@chelsio.com static void arp_failure_skb_discard(void *handle, struct sk_buff *skb) 5757b36b6e0Skxie@chelsio.com { 5767b36b6e0Skxie@chelsio.com kfree_skb(skb); 5777b36b6e0Skxie@chelsio.com } 5787b36b6e0Skxie@chelsio.com 5797b36b6e0Skxie@chelsio.com static int push_tx_frames(struct cxgbi_sock *csk, int req_completion) 5807b36b6e0Skxie@chelsio.com { 5817b36b6e0Skxie@chelsio.com int total_size = 0; 5827b36b6e0Skxie@chelsio.com struct sk_buff *skb; 5837b36b6e0Skxie@chelsio.com 5847b36b6e0Skxie@chelsio.com if (unlikely(csk->state < CTP_ESTABLISHED || 5857b36b6e0Skxie@chelsio.com csk->state == CTP_CLOSE_WAIT_1 || csk->state >= CTP_ABORTING)) { 5867b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK | 5877b36b6e0Skxie@chelsio.com 1 << CXGBI_DBG_PDU_TX, 5887b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, in closing state.\n", 5897b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 5907b36b6e0Skxie@chelsio.com return 0; 5917b36b6e0Skxie@chelsio.com } 5927b36b6e0Skxie@chelsio.com 5937b36b6e0Skxie@chelsio.com while (csk->wr_cred && (skb = skb_peek(&csk->write_queue)) != NULL) { 5947b36b6e0Skxie@chelsio.com int dlen = skb->len; 5957b36b6e0Skxie@chelsio.com int len = skb->len; 5967b36b6e0Skxie@chelsio.com unsigned int credits_needed; 5977b36b6e0Skxie@chelsio.com 5987b36b6e0Skxie@chelsio.com skb_reset_transport_header(skb); 5997b36b6e0Skxie@chelsio.com if (is_ofld_imm(skb)) 6007b36b6e0Skxie@chelsio.com credits_needed = DIV_ROUND_UP(dlen + 6017b36b6e0Skxie@chelsio.com sizeof(struct fw_ofld_tx_data_wr), 16); 6027b36b6e0Skxie@chelsio.com else 6037b36b6e0Skxie@chelsio.com credits_needed = DIV_ROUND_UP(8*calc_tx_flits_ofld(skb) 6047b36b6e0Skxie@chelsio.com + sizeof(struct fw_ofld_tx_data_wr), 6057b36b6e0Skxie@chelsio.com 16); 6067b36b6e0Skxie@chelsio.com 6077b36b6e0Skxie@chelsio.com if (csk->wr_cred < credits_needed) { 6087b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_PDU_TX, 6097b36b6e0Skxie@chelsio.com "csk 0x%p, skb %u/%u, wr %d < %u.\n", 6107b36b6e0Skxie@chelsio.com csk, skb->len, skb->data_len, 6117b36b6e0Skxie@chelsio.com credits_needed, csk->wr_cred); 6127b36b6e0Skxie@chelsio.com break; 6137b36b6e0Skxie@chelsio.com } 6147b36b6e0Skxie@chelsio.com __skb_unlink(skb, &csk->write_queue); 6157b36b6e0Skxie@chelsio.com set_queue(skb, CPL_PRIORITY_DATA, csk); 6167b36b6e0Skxie@chelsio.com skb->csum = credits_needed; 6177b36b6e0Skxie@chelsio.com csk->wr_cred -= credits_needed; 6187b36b6e0Skxie@chelsio.com csk->wr_una_cred += credits_needed; 6197b36b6e0Skxie@chelsio.com cxgbi_sock_enqueue_wr(csk, skb); 6207b36b6e0Skxie@chelsio.com 6217b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_PDU_TX, 6227b36b6e0Skxie@chelsio.com "csk 0x%p, skb %u/%u, wr %d, left %u, unack %u.\n", 6237b36b6e0Skxie@chelsio.com csk, skb->len, skb->data_len, credits_needed, 6247b36b6e0Skxie@chelsio.com csk->wr_cred, csk->wr_una_cred); 6257b36b6e0Skxie@chelsio.com 6267b36b6e0Skxie@chelsio.com if (likely(cxgbi_skcb_test_flag(skb, SKCBF_TX_NEED_HDR))) { 6277b36b6e0Skxie@chelsio.com if (!cxgbi_sock_flag(csk, CTPF_TX_DATA_SENT)) { 6287b36b6e0Skxie@chelsio.com send_tx_flowc_wr(csk); 6297b36b6e0Skxie@chelsio.com skb->csum += 5; 6307b36b6e0Skxie@chelsio.com csk->wr_cred -= 5; 6317b36b6e0Skxie@chelsio.com csk->wr_una_cred += 5; 6327b36b6e0Skxie@chelsio.com } 6337b36b6e0Skxie@chelsio.com len += cxgbi_ulp_extra_len(cxgbi_skcb_ulp_mode(skb)); 6347b36b6e0Skxie@chelsio.com make_tx_data_wr(csk, skb, dlen, len, credits_needed, 6357b36b6e0Skxie@chelsio.com req_completion); 6367b36b6e0Skxie@chelsio.com csk->snd_nxt += len; 6377b36b6e0Skxie@chelsio.com cxgbi_skcb_clear_flag(skb, SKCBF_TX_NEED_HDR); 6387b36b6e0Skxie@chelsio.com } 6397b36b6e0Skxie@chelsio.com total_size += skb->truesize; 6407b36b6e0Skxie@chelsio.com t4_set_arp_err_handler(skb, csk, arp_failure_skb_discard); 6417b36b6e0Skxie@chelsio.com 6427b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_TX, 6437b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, skb 0x%p, %u.\n", 6447b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, skb, len); 6457b36b6e0Skxie@chelsio.com 6467b36b6e0Skxie@chelsio.com cxgb4_l2t_send(csk->cdev->ports[csk->port_id], skb, csk->l2t); 6477b36b6e0Skxie@chelsio.com } 6487b36b6e0Skxie@chelsio.com return total_size; 6497b36b6e0Skxie@chelsio.com } 6507b36b6e0Skxie@chelsio.com 6517b36b6e0Skxie@chelsio.com static inline void free_atid(struct cxgbi_sock *csk) 6527b36b6e0Skxie@chelsio.com { 6537b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(csk->cdev); 6547b36b6e0Skxie@chelsio.com 6557b36b6e0Skxie@chelsio.com if (cxgbi_sock_flag(csk, CTPF_HAS_ATID)) { 6567b36b6e0Skxie@chelsio.com cxgb4_free_atid(lldi->tids, csk->atid); 6577b36b6e0Skxie@chelsio.com cxgbi_sock_clear_flag(csk, CTPF_HAS_ATID); 6587b36b6e0Skxie@chelsio.com cxgbi_sock_put(csk); 6597b36b6e0Skxie@chelsio.com } 6607b36b6e0Skxie@chelsio.com } 6617b36b6e0Skxie@chelsio.com 6627b36b6e0Skxie@chelsio.com static void do_act_establish(struct cxgbi_device *cdev, struct sk_buff *skb) 6637b36b6e0Skxie@chelsio.com { 6647b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 6657b36b6e0Skxie@chelsio.com struct cpl_act_establish *req = (struct cpl_act_establish *)skb->data; 6667b36b6e0Skxie@chelsio.com unsigned short tcp_opt = ntohs(req->tcp_opt); 6677b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(req); 6687b36b6e0Skxie@chelsio.com unsigned int atid = GET_TID_TID(ntohl(req->tos_atid)); 6697b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 6707b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 6717b36b6e0Skxie@chelsio.com u32 rcv_isn = be32_to_cpu(req->rcv_isn); 6727b36b6e0Skxie@chelsio.com 6737b36b6e0Skxie@chelsio.com csk = lookup_atid(t, atid); 6747b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 6757b36b6e0Skxie@chelsio.com pr_err("NO conn. for atid %u, cdev 0x%p.\n", atid, cdev); 6767b36b6e0Skxie@chelsio.com goto rel_skb; 6777b36b6e0Skxie@chelsio.com } 6787b36b6e0Skxie@chelsio.com 679e27d6169Skxie@chelsio.com if (csk->atid != atid) { 680e27d6169Skxie@chelsio.com pr_err("bad conn atid %u, csk 0x%p,%u,0x%lx,tid %u, atid %u.\n", 681e27d6169Skxie@chelsio.com atid, csk, csk->state, csk->flags, csk->tid, csk->atid); 682e27d6169Skxie@chelsio.com goto rel_skb; 683e27d6169Skxie@chelsio.com } 684e27d6169Skxie@chelsio.com 685759a0cc5SAnish Bhatt pr_info_ipaddr("atid 0x%x, tid 0x%x, csk 0x%p,%u,0x%lx, isn %u.\n", 686759a0cc5SAnish Bhatt (&csk->saddr), (&csk->daddr), 687759a0cc5SAnish Bhatt atid, tid, csk, csk->state, csk->flags, rcv_isn); 688759a0cc5SAnish Bhatt 689759a0cc5SAnish Bhatt module_put(THIS_MODULE); 6907b36b6e0Skxie@chelsio.com 6917b36b6e0Skxie@chelsio.com cxgbi_sock_get(csk); 6927b36b6e0Skxie@chelsio.com csk->tid = tid; 6937b36b6e0Skxie@chelsio.com cxgb4_insert_tid(lldi->tids, csk, tid); 6947b36b6e0Skxie@chelsio.com cxgbi_sock_set_flag(csk, CTPF_HAS_TID); 6957b36b6e0Skxie@chelsio.com 6967b36b6e0Skxie@chelsio.com free_atid(csk); 6977b36b6e0Skxie@chelsio.com 6987b36b6e0Skxie@chelsio.com spin_lock_bh(&csk->lock); 6997b36b6e0Skxie@chelsio.com if (unlikely(csk->state != CTP_ACTIVE_OPEN)) 7007b36b6e0Skxie@chelsio.com pr_info("csk 0x%p,%u,0x%lx,%u, got EST.\n", 7017b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 7027b36b6e0Skxie@chelsio.com 7037b36b6e0Skxie@chelsio.com if (csk->retry_timer.function) { 7047b36b6e0Skxie@chelsio.com del_timer(&csk->retry_timer); 7057b36b6e0Skxie@chelsio.com csk->retry_timer.function = NULL; 7067b36b6e0Skxie@chelsio.com } 7077b36b6e0Skxie@chelsio.com 7087b36b6e0Skxie@chelsio.com csk->copied_seq = csk->rcv_wup = csk->rcv_nxt = rcv_isn; 7097b36b6e0Skxie@chelsio.com /* 7107b36b6e0Skxie@chelsio.com * Causes the first RX_DATA_ACK to supply any Rx credits we couldn't 7117b36b6e0Skxie@chelsio.com * pass through opt0. 7127b36b6e0Skxie@chelsio.com */ 7137b36b6e0Skxie@chelsio.com if (cxgb4i_rcv_win > (RCV_BUFSIZ_MASK << 10)) 7147b36b6e0Skxie@chelsio.com csk->rcv_wup -= cxgb4i_rcv_win - (RCV_BUFSIZ_MASK << 10); 7157b36b6e0Skxie@chelsio.com 7167b36b6e0Skxie@chelsio.com csk->advmss = lldi->mtus[GET_TCPOPT_MSS(tcp_opt)] - 40; 7177b36b6e0Skxie@chelsio.com if (GET_TCPOPT_TSTAMP(tcp_opt)) 7187b36b6e0Skxie@chelsio.com csk->advmss -= 12; 7197b36b6e0Skxie@chelsio.com if (csk->advmss < 128) 7207b36b6e0Skxie@chelsio.com csk->advmss = 128; 7217b36b6e0Skxie@chelsio.com 7227b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 7237b36b6e0Skxie@chelsio.com "csk 0x%p, mss_idx %u, advmss %u.\n", 7247b36b6e0Skxie@chelsio.com csk, GET_TCPOPT_MSS(tcp_opt), csk->advmss); 7257b36b6e0Skxie@chelsio.com 7267b36b6e0Skxie@chelsio.com cxgbi_sock_established(csk, ntohl(req->snd_isn), ntohs(req->tcp_opt)); 7277b36b6e0Skxie@chelsio.com 7287b36b6e0Skxie@chelsio.com if (unlikely(cxgbi_sock_flag(csk, CTPF_ACTIVE_CLOSE_NEEDED))) 7297b36b6e0Skxie@chelsio.com send_abort_req(csk); 7307b36b6e0Skxie@chelsio.com else { 7317b36b6e0Skxie@chelsio.com if (skb_queue_len(&csk->write_queue)) 7327b36b6e0Skxie@chelsio.com push_tx_frames(csk, 0); 7337b36b6e0Skxie@chelsio.com cxgbi_conn_tx_open(csk); 7347b36b6e0Skxie@chelsio.com } 7357b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 7367b36b6e0Skxie@chelsio.com 7377b36b6e0Skxie@chelsio.com rel_skb: 7387b36b6e0Skxie@chelsio.com __kfree_skb(skb); 7397b36b6e0Skxie@chelsio.com } 7407b36b6e0Skxie@chelsio.com 7417b36b6e0Skxie@chelsio.com static int act_open_rpl_status_to_errno(int status) 7427b36b6e0Skxie@chelsio.com { 7437b36b6e0Skxie@chelsio.com switch (status) { 7447b36b6e0Skxie@chelsio.com case CPL_ERR_CONN_RESET: 7457b36b6e0Skxie@chelsio.com return -ECONNREFUSED; 7467b36b6e0Skxie@chelsio.com case CPL_ERR_ARP_MISS: 7477b36b6e0Skxie@chelsio.com return -EHOSTUNREACH; 7487b36b6e0Skxie@chelsio.com case CPL_ERR_CONN_TIMEDOUT: 7497b36b6e0Skxie@chelsio.com return -ETIMEDOUT; 7507b36b6e0Skxie@chelsio.com case CPL_ERR_TCAM_FULL: 7517b36b6e0Skxie@chelsio.com return -ENOMEM; 7527b36b6e0Skxie@chelsio.com case CPL_ERR_CONN_EXIST: 7537b36b6e0Skxie@chelsio.com return -EADDRINUSE; 7547b36b6e0Skxie@chelsio.com default: 7557b36b6e0Skxie@chelsio.com return -EIO; 7567b36b6e0Skxie@chelsio.com } 7577b36b6e0Skxie@chelsio.com } 7587b36b6e0Skxie@chelsio.com 7597b36b6e0Skxie@chelsio.com static void csk_act_open_retry_timer(unsigned long data) 7607b36b6e0Skxie@chelsio.com { 761001586a7SAnish Bhatt struct sk_buff *skb = NULL; 7627b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk = (struct cxgbi_sock *)data; 7633bd3e8bfSKaren Xie struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(csk->cdev); 764759a0cc5SAnish Bhatt void (*send_act_open_func)(struct cxgbi_sock *, struct sk_buff *, 765759a0cc5SAnish Bhatt struct l2t_entry *); 766759a0cc5SAnish Bhatt int t4 = is_t4(lldi->adapter_type), size, size6; 7677b36b6e0Skxie@chelsio.com 7687b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 7697b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u.\n", 7707b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 7717b36b6e0Skxie@chelsio.com 7727b36b6e0Skxie@chelsio.com cxgbi_sock_get(csk); 7737b36b6e0Skxie@chelsio.com spin_lock_bh(&csk->lock); 774759a0cc5SAnish Bhatt 775759a0cc5SAnish Bhatt if (t4) { 776759a0cc5SAnish Bhatt size = sizeof(struct cpl_act_open_req); 777759a0cc5SAnish Bhatt size6 = sizeof(struct cpl_act_open_req6); 778759a0cc5SAnish Bhatt } else { 779759a0cc5SAnish Bhatt size = sizeof(struct cpl_t5_act_open_req); 780759a0cc5SAnish Bhatt size6 = sizeof(struct cpl_t5_act_open_req6); 781759a0cc5SAnish Bhatt } 782759a0cc5SAnish Bhatt 783759a0cc5SAnish Bhatt if (csk->csk_family == AF_INET) { 784759a0cc5SAnish Bhatt send_act_open_func = send_act_open_req; 785759a0cc5SAnish Bhatt skb = alloc_wr(size, 0, GFP_ATOMIC); 786f42bb57cSAnish Bhatt #if IS_ENABLED(CONFIG_IPV6) 787759a0cc5SAnish Bhatt } else { 788759a0cc5SAnish Bhatt send_act_open_func = send_act_open_req6; 789759a0cc5SAnish Bhatt skb = alloc_wr(size6, 0, GFP_ATOMIC); 790f42bb57cSAnish Bhatt #endif 791759a0cc5SAnish Bhatt } 792759a0cc5SAnish Bhatt 7937b36b6e0Skxie@chelsio.com if (!skb) 7947b36b6e0Skxie@chelsio.com cxgbi_sock_fail_act_open(csk, -ENOMEM); 7957b36b6e0Skxie@chelsio.com else { 7967b36b6e0Skxie@chelsio.com skb->sk = (struct sock *)csk; 7977b36b6e0Skxie@chelsio.com t4_set_arp_err_handler(skb, csk, 7987b36b6e0Skxie@chelsio.com cxgbi_sock_act_open_req_arp_failure); 799759a0cc5SAnish Bhatt send_act_open_func(csk, skb, csk->l2t); 8007b36b6e0Skxie@chelsio.com } 801759a0cc5SAnish Bhatt 8027b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 8037b36b6e0Skxie@chelsio.com cxgbi_sock_put(csk); 804759a0cc5SAnish Bhatt 8057b36b6e0Skxie@chelsio.com } 8067b36b6e0Skxie@chelsio.com 8077b36b6e0Skxie@chelsio.com static void do_act_open_rpl(struct cxgbi_device *cdev, struct sk_buff *skb) 8087b36b6e0Skxie@chelsio.com { 8097b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 8107b36b6e0Skxie@chelsio.com struct cpl_act_open_rpl *rpl = (struct cpl_act_open_rpl *)skb->data; 8117b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(rpl); 8127b36b6e0Skxie@chelsio.com unsigned int atid = 8137b36b6e0Skxie@chelsio.com GET_TID_TID(GET_AOPEN_ATID(be32_to_cpu(rpl->atid_status))); 8147b36b6e0Skxie@chelsio.com unsigned int status = GET_AOPEN_STATUS(be32_to_cpu(rpl->atid_status)); 8157b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 8167b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 8177b36b6e0Skxie@chelsio.com 8187b36b6e0Skxie@chelsio.com csk = lookup_atid(t, atid); 8197b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 8207b36b6e0Skxie@chelsio.com pr_err("NO matching conn. atid %u, tid %u.\n", atid, tid); 8217b36b6e0Skxie@chelsio.com goto rel_skb; 8227b36b6e0Skxie@chelsio.com } 8237b36b6e0Skxie@chelsio.com 824759a0cc5SAnish Bhatt pr_info_ipaddr("tid %u/%u, status %u.\n" 825759a0cc5SAnish Bhatt "csk 0x%p,%u,0x%lx. ", (&csk->saddr), (&csk->daddr), 826e27d6169Skxie@chelsio.com atid, tid, status, csk, csk->state, csk->flags); 8277b36b6e0Skxie@chelsio.com 828150cca7cSKaren Xie if (status == CPL_ERR_RTX_NEG_ADVICE) 829150cca7cSKaren Xie goto rel_skb; 830150cca7cSKaren Xie 831ee7255adSAnish Bhatt module_put(THIS_MODULE); 832ee7255adSAnish Bhatt 8337b36b6e0Skxie@chelsio.com if (status && status != CPL_ERR_TCAM_FULL && 8347b36b6e0Skxie@chelsio.com status != CPL_ERR_CONN_EXIST && 8357b36b6e0Skxie@chelsio.com status != CPL_ERR_ARP_MISS) 8367b36b6e0Skxie@chelsio.com cxgb4_remove_tid(lldi->tids, csk->port_id, GET_TID(rpl)); 8377b36b6e0Skxie@chelsio.com 8387b36b6e0Skxie@chelsio.com cxgbi_sock_get(csk); 8397b36b6e0Skxie@chelsio.com spin_lock_bh(&csk->lock); 8407b36b6e0Skxie@chelsio.com 8417b36b6e0Skxie@chelsio.com if (status == CPL_ERR_CONN_EXIST && 8427b36b6e0Skxie@chelsio.com csk->retry_timer.function != csk_act_open_retry_timer) { 8437b36b6e0Skxie@chelsio.com csk->retry_timer.function = csk_act_open_retry_timer; 8447b36b6e0Skxie@chelsio.com mod_timer(&csk->retry_timer, jiffies + HZ / 2); 8457b36b6e0Skxie@chelsio.com } else 8467b36b6e0Skxie@chelsio.com cxgbi_sock_fail_act_open(csk, 8477b36b6e0Skxie@chelsio.com act_open_rpl_status_to_errno(status)); 8487b36b6e0Skxie@chelsio.com 8497b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 8507b36b6e0Skxie@chelsio.com cxgbi_sock_put(csk); 8517b36b6e0Skxie@chelsio.com rel_skb: 8527b36b6e0Skxie@chelsio.com __kfree_skb(skb); 8537b36b6e0Skxie@chelsio.com } 8547b36b6e0Skxie@chelsio.com 8557b36b6e0Skxie@chelsio.com static void do_peer_close(struct cxgbi_device *cdev, struct sk_buff *skb) 8567b36b6e0Skxie@chelsio.com { 8577b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 8587b36b6e0Skxie@chelsio.com struct cpl_peer_close *req = (struct cpl_peer_close *)skb->data; 8597b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(req); 8607b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 8617b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 8627b36b6e0Skxie@chelsio.com 8637b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 8647b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 8657b36b6e0Skxie@chelsio.com pr_err("can't find connection for tid %u.\n", tid); 8667b36b6e0Skxie@chelsio.com goto rel_skb; 8677b36b6e0Skxie@chelsio.com } 868759a0cc5SAnish Bhatt pr_info_ipaddr("csk 0x%p,%u,0x%lx,%u.\n", 869759a0cc5SAnish Bhatt (&csk->saddr), (&csk->daddr), 8707b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 8717b36b6e0Skxie@chelsio.com cxgbi_sock_rcv_peer_close(csk); 8727b36b6e0Skxie@chelsio.com rel_skb: 8737b36b6e0Skxie@chelsio.com __kfree_skb(skb); 8747b36b6e0Skxie@chelsio.com } 8757b36b6e0Skxie@chelsio.com 8767b36b6e0Skxie@chelsio.com static void do_close_con_rpl(struct cxgbi_device *cdev, struct sk_buff *skb) 8777b36b6e0Skxie@chelsio.com { 8787b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 8797b36b6e0Skxie@chelsio.com struct cpl_close_con_rpl *rpl = (struct cpl_close_con_rpl *)skb->data; 8807b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(rpl); 8817b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 8827b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 8837b36b6e0Skxie@chelsio.com 8847b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 8857b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 8867b36b6e0Skxie@chelsio.com pr_err("can't find connection for tid %u.\n", tid); 8877b36b6e0Skxie@chelsio.com goto rel_skb; 8887b36b6e0Skxie@chelsio.com } 889759a0cc5SAnish Bhatt pr_info_ipaddr("csk 0x%p,%u,0x%lx,%u.\n", 890759a0cc5SAnish Bhatt (&csk->saddr), (&csk->daddr), 8917b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 8927b36b6e0Skxie@chelsio.com cxgbi_sock_rcv_close_conn_rpl(csk, ntohl(rpl->snd_nxt)); 8937b36b6e0Skxie@chelsio.com rel_skb: 8947b36b6e0Skxie@chelsio.com __kfree_skb(skb); 8957b36b6e0Skxie@chelsio.com } 8967b36b6e0Skxie@chelsio.com 8977b36b6e0Skxie@chelsio.com static int abort_status_to_errno(struct cxgbi_sock *csk, int abort_reason, 8987b36b6e0Skxie@chelsio.com int *need_rst) 8997b36b6e0Skxie@chelsio.com { 9007b36b6e0Skxie@chelsio.com switch (abort_reason) { 9017b36b6e0Skxie@chelsio.com case CPL_ERR_BAD_SYN: /* fall through */ 9027b36b6e0Skxie@chelsio.com case CPL_ERR_CONN_RESET: 9037b36b6e0Skxie@chelsio.com return csk->state > CTP_ESTABLISHED ? 9047b36b6e0Skxie@chelsio.com -EPIPE : -ECONNRESET; 9057b36b6e0Skxie@chelsio.com case CPL_ERR_XMIT_TIMEDOUT: 9067b36b6e0Skxie@chelsio.com case CPL_ERR_PERSIST_TIMEDOUT: 9077b36b6e0Skxie@chelsio.com case CPL_ERR_FINWAIT2_TIMEDOUT: 9087b36b6e0Skxie@chelsio.com case CPL_ERR_KEEPALIVE_TIMEDOUT: 9097b36b6e0Skxie@chelsio.com return -ETIMEDOUT; 9107b36b6e0Skxie@chelsio.com default: 9117b36b6e0Skxie@chelsio.com return -EIO; 9127b36b6e0Skxie@chelsio.com } 9137b36b6e0Skxie@chelsio.com } 9147b36b6e0Skxie@chelsio.com 9157b36b6e0Skxie@chelsio.com static void do_abort_req_rss(struct cxgbi_device *cdev, struct sk_buff *skb) 9167b36b6e0Skxie@chelsio.com { 9177b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 9187b36b6e0Skxie@chelsio.com struct cpl_abort_req_rss *req = (struct cpl_abort_req_rss *)skb->data; 9197b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(req); 9207b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 9217b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 9227b36b6e0Skxie@chelsio.com int rst_status = CPL_ABORT_NO_RST; 9237b36b6e0Skxie@chelsio.com 9247b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 9257b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 9267b36b6e0Skxie@chelsio.com pr_err("can't find connection for tid %u.\n", tid); 9277b36b6e0Skxie@chelsio.com goto rel_skb; 9287b36b6e0Skxie@chelsio.com } 9297b36b6e0Skxie@chelsio.com 930759a0cc5SAnish Bhatt pr_info_ipaddr("csk 0x%p,%u,0x%lx,%u, status %u.\n", 931759a0cc5SAnish Bhatt (&csk->saddr), (&csk->daddr), 9327b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, req->status); 9337b36b6e0Skxie@chelsio.com 9347b36b6e0Skxie@chelsio.com if (req->status == CPL_ERR_RTX_NEG_ADVICE || 9357b36b6e0Skxie@chelsio.com req->status == CPL_ERR_PERSIST_NEG_ADVICE) 9367b36b6e0Skxie@chelsio.com goto rel_skb; 9377b36b6e0Skxie@chelsio.com 9387b36b6e0Skxie@chelsio.com cxgbi_sock_get(csk); 9397b36b6e0Skxie@chelsio.com spin_lock_bh(&csk->lock); 9407b36b6e0Skxie@chelsio.com 9417b36b6e0Skxie@chelsio.com if (!cxgbi_sock_flag(csk, CTPF_ABORT_REQ_RCVD)) { 9427b36b6e0Skxie@chelsio.com cxgbi_sock_set_flag(csk, CTPF_ABORT_REQ_RCVD); 9437b36b6e0Skxie@chelsio.com cxgbi_sock_set_state(csk, CTP_ABORTING); 9447b36b6e0Skxie@chelsio.com goto done; 9457b36b6e0Skxie@chelsio.com } 9467b36b6e0Skxie@chelsio.com 9477b36b6e0Skxie@chelsio.com cxgbi_sock_clear_flag(csk, CTPF_ABORT_REQ_RCVD); 9487b36b6e0Skxie@chelsio.com send_abort_rpl(csk, rst_status); 9497b36b6e0Skxie@chelsio.com 9507b36b6e0Skxie@chelsio.com if (!cxgbi_sock_flag(csk, CTPF_ABORT_RPL_PENDING)) { 9517b36b6e0Skxie@chelsio.com csk->err = abort_status_to_errno(csk, req->status, &rst_status); 9527b36b6e0Skxie@chelsio.com cxgbi_sock_closed(csk); 9537b36b6e0Skxie@chelsio.com } 9547b36b6e0Skxie@chelsio.com done: 9557b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 9567b36b6e0Skxie@chelsio.com cxgbi_sock_put(csk); 9577b36b6e0Skxie@chelsio.com rel_skb: 9587b36b6e0Skxie@chelsio.com __kfree_skb(skb); 9597b36b6e0Skxie@chelsio.com } 9607b36b6e0Skxie@chelsio.com 9617b36b6e0Skxie@chelsio.com static void do_abort_rpl_rss(struct cxgbi_device *cdev, struct sk_buff *skb) 9627b36b6e0Skxie@chelsio.com { 9637b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 9647b36b6e0Skxie@chelsio.com struct cpl_abort_rpl_rss *rpl = (struct cpl_abort_rpl_rss *)skb->data; 9657b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(rpl); 9667b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 9677b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 9687b36b6e0Skxie@chelsio.com 9697b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 9707b36b6e0Skxie@chelsio.com if (!csk) 9717b36b6e0Skxie@chelsio.com goto rel_skb; 9727b36b6e0Skxie@chelsio.com 973759a0cc5SAnish Bhatt if (csk) 974759a0cc5SAnish Bhatt pr_info_ipaddr("csk 0x%p,%u,0x%lx,%u, status %u.\n", 975759a0cc5SAnish Bhatt (&csk->saddr), (&csk->daddr), csk, 976759a0cc5SAnish Bhatt csk->state, csk->flags, csk->tid, rpl->status); 9777b36b6e0Skxie@chelsio.com 9787b36b6e0Skxie@chelsio.com if (rpl->status == CPL_ERR_ABORT_FAILED) 9797b36b6e0Skxie@chelsio.com goto rel_skb; 9807b36b6e0Skxie@chelsio.com 9817b36b6e0Skxie@chelsio.com cxgbi_sock_rcv_abort_rpl(csk); 9827b36b6e0Skxie@chelsio.com rel_skb: 9837b36b6e0Skxie@chelsio.com __kfree_skb(skb); 9847b36b6e0Skxie@chelsio.com } 9857b36b6e0Skxie@chelsio.com 9867b36b6e0Skxie@chelsio.com static void do_rx_iscsi_hdr(struct cxgbi_device *cdev, struct sk_buff *skb) 9877b36b6e0Skxie@chelsio.com { 9887b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 9897b36b6e0Skxie@chelsio.com struct cpl_iscsi_hdr *cpl = (struct cpl_iscsi_hdr *)skb->data; 9907b36b6e0Skxie@chelsio.com unsigned short pdu_len_ddp = be16_to_cpu(cpl->pdu_len_ddp); 9917b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(cpl); 9927b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 9937b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 9947b36b6e0Skxie@chelsio.com 9957b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 9967b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 9977b36b6e0Skxie@chelsio.com pr_err("can't find conn. for tid %u.\n", tid); 9987b36b6e0Skxie@chelsio.com goto rel_skb; 9997b36b6e0Skxie@chelsio.com } 10007b36b6e0Skxie@chelsio.com 10017b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX, 10027b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, tid %u, skb 0x%p,%u, 0x%x.\n", 10037b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, skb, skb->len, 10047b36b6e0Skxie@chelsio.com pdu_len_ddp); 10057b36b6e0Skxie@chelsio.com 10067b36b6e0Skxie@chelsio.com spin_lock_bh(&csk->lock); 10077b36b6e0Skxie@chelsio.com 10087b36b6e0Skxie@chelsio.com if (unlikely(csk->state >= CTP_PASSIVE_CLOSE)) { 10097b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 10107b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, bad state.\n", 10117b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 10127b36b6e0Skxie@chelsio.com if (csk->state != CTP_ABORTING) 10137b36b6e0Skxie@chelsio.com goto abort_conn; 10147b36b6e0Skxie@chelsio.com else 10157b36b6e0Skxie@chelsio.com goto discard; 10167b36b6e0Skxie@chelsio.com } 10177b36b6e0Skxie@chelsio.com 10187b36b6e0Skxie@chelsio.com cxgbi_skcb_tcp_seq(skb) = ntohl(cpl->seq); 1019e27d6169Skxie@chelsio.com cxgbi_skcb_flags(skb) = 0; 1020e27d6169Skxie@chelsio.com 10217b36b6e0Skxie@chelsio.com skb_reset_transport_header(skb); 10227b36b6e0Skxie@chelsio.com __skb_pull(skb, sizeof(*cpl)); 10237b36b6e0Skxie@chelsio.com __pskb_trim(skb, ntohs(cpl->len)); 10247b36b6e0Skxie@chelsio.com 10257b36b6e0Skxie@chelsio.com if (!csk->skb_ulp_lhdr) { 10267b36b6e0Skxie@chelsio.com unsigned char *bhs; 10273bd3e8bfSKaren Xie unsigned int hlen, dlen, plen; 10287b36b6e0Skxie@chelsio.com 10297b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX, 10307b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, tid %u, skb 0x%p header.\n", 10317b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, skb); 10327b36b6e0Skxie@chelsio.com csk->skb_ulp_lhdr = skb; 1033e27d6169Skxie@chelsio.com cxgbi_skcb_set_flag(skb, SKCBF_RX_HDR); 10347b36b6e0Skxie@chelsio.com 1035e27d6169Skxie@chelsio.com if (cxgbi_skcb_tcp_seq(skb) != csk->rcv_nxt) { 10367b36b6e0Skxie@chelsio.com pr_info("tid %u, CPL_ISCSI_HDR, bad seq, 0x%x/0x%x.\n", 1037e27d6169Skxie@chelsio.com csk->tid, cxgbi_skcb_tcp_seq(skb), 10387b36b6e0Skxie@chelsio.com csk->rcv_nxt); 10397b36b6e0Skxie@chelsio.com goto abort_conn; 10407b36b6e0Skxie@chelsio.com } 10417b36b6e0Skxie@chelsio.com 1042e27d6169Skxie@chelsio.com bhs = skb->data; 10437b36b6e0Skxie@chelsio.com hlen = ntohs(cpl->len); 10447b36b6e0Skxie@chelsio.com dlen = ntohl(*(unsigned int *)(bhs + 4)) & 0xFFFFFF; 10457b36b6e0Skxie@chelsio.com 10463bd3e8bfSKaren Xie plen = ISCSI_PDU_LEN(pdu_len_ddp); 10473bd3e8bfSKaren Xie if (is_t4(lldi->adapter_type)) 10483bd3e8bfSKaren Xie plen -= 40; 10493bd3e8bfSKaren Xie 10503bd3e8bfSKaren Xie if ((hlen + dlen) != plen) { 10517b36b6e0Skxie@chelsio.com pr_info("tid 0x%x, CPL_ISCSI_HDR, pdu len " 10527b36b6e0Skxie@chelsio.com "mismatch %u != %u + %u, seq 0x%x.\n", 10533bd3e8bfSKaren Xie csk->tid, plen, hlen, dlen, 10543bd3e8bfSKaren Xie cxgbi_skcb_tcp_seq(skb)); 10557b36b6e0Skxie@chelsio.com goto abort_conn; 10567b36b6e0Skxie@chelsio.com } 10577b36b6e0Skxie@chelsio.com 10587b36b6e0Skxie@chelsio.com cxgbi_skcb_rx_pdulen(skb) = (hlen + dlen + 3) & (~0x3); 10597b36b6e0Skxie@chelsio.com if (dlen) 10607b36b6e0Skxie@chelsio.com cxgbi_skcb_rx_pdulen(skb) += csk->dcrc_len; 10617b36b6e0Skxie@chelsio.com csk->rcv_nxt += cxgbi_skcb_rx_pdulen(skb); 10627b36b6e0Skxie@chelsio.com 10637b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX, 10647b36b6e0Skxie@chelsio.com "csk 0x%p, skb 0x%p, 0x%x,%u+%u,0x%x,0x%x.\n", 10657b36b6e0Skxie@chelsio.com csk, skb, *bhs, hlen, dlen, 10667b36b6e0Skxie@chelsio.com ntohl(*((unsigned int *)(bhs + 16))), 10677b36b6e0Skxie@chelsio.com ntohl(*((unsigned int *)(bhs + 24)))); 10687b36b6e0Skxie@chelsio.com 10697b36b6e0Skxie@chelsio.com } else { 1070e27d6169Skxie@chelsio.com struct sk_buff *lskb = csk->skb_ulp_lhdr; 10717b36b6e0Skxie@chelsio.com 1072e27d6169Skxie@chelsio.com cxgbi_skcb_set_flag(lskb, SKCBF_RX_DATA); 10737b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX, 10747b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, skb 0x%p data, 0x%p.\n", 10757b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, skb, lskb); 10767b36b6e0Skxie@chelsio.com } 10777b36b6e0Skxie@chelsio.com 10787b36b6e0Skxie@chelsio.com __skb_queue_tail(&csk->receive_queue, skb); 10797b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 10807b36b6e0Skxie@chelsio.com return; 10817b36b6e0Skxie@chelsio.com 10827b36b6e0Skxie@chelsio.com abort_conn: 10837b36b6e0Skxie@chelsio.com send_abort_req(csk); 10847b36b6e0Skxie@chelsio.com discard: 10857b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 10867b36b6e0Skxie@chelsio.com rel_skb: 10877b36b6e0Skxie@chelsio.com __kfree_skb(skb); 10887b36b6e0Skxie@chelsio.com } 10897b36b6e0Skxie@chelsio.com 10907b36b6e0Skxie@chelsio.com static void do_rx_data_ddp(struct cxgbi_device *cdev, 10917b36b6e0Skxie@chelsio.com struct sk_buff *skb) 10927b36b6e0Skxie@chelsio.com { 10937b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 10947b36b6e0Skxie@chelsio.com struct sk_buff *lskb; 10957b36b6e0Skxie@chelsio.com struct cpl_rx_data_ddp *rpl = (struct cpl_rx_data_ddp *)skb->data; 10967b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(rpl); 10977b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 10987b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 10997b36b6e0Skxie@chelsio.com unsigned int status = ntohl(rpl->ddpvld); 11007b36b6e0Skxie@chelsio.com 11017b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 11027b36b6e0Skxie@chelsio.com if (unlikely(!csk)) { 11037b36b6e0Skxie@chelsio.com pr_err("can't find connection for tid %u.\n", tid); 11047b36b6e0Skxie@chelsio.com goto rel_skb; 11057b36b6e0Skxie@chelsio.com } 11067b36b6e0Skxie@chelsio.com 11077b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_PDU_RX, 11087b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx, skb 0x%p,0x%x, lhdr 0x%p.\n", 11097b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, skb, status, csk->skb_ulp_lhdr); 11107b36b6e0Skxie@chelsio.com 11117b36b6e0Skxie@chelsio.com spin_lock_bh(&csk->lock); 11127b36b6e0Skxie@chelsio.com 11137b36b6e0Skxie@chelsio.com if (unlikely(csk->state >= CTP_PASSIVE_CLOSE)) { 11147b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 11157b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u, bad state.\n", 11167b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 11177b36b6e0Skxie@chelsio.com if (csk->state != CTP_ABORTING) 11187b36b6e0Skxie@chelsio.com goto abort_conn; 11197b36b6e0Skxie@chelsio.com else 11207b36b6e0Skxie@chelsio.com goto discard; 11217b36b6e0Skxie@chelsio.com } 11227b36b6e0Skxie@chelsio.com 11237b36b6e0Skxie@chelsio.com if (!csk->skb_ulp_lhdr) { 11247b36b6e0Skxie@chelsio.com pr_err("tid 0x%x, rcv RX_DATA_DDP w/o pdu bhs.\n", csk->tid); 11257b36b6e0Skxie@chelsio.com goto abort_conn; 11267b36b6e0Skxie@chelsio.com } 11277b36b6e0Skxie@chelsio.com 11287b36b6e0Skxie@chelsio.com lskb = csk->skb_ulp_lhdr; 11297b36b6e0Skxie@chelsio.com csk->skb_ulp_lhdr = NULL; 11307b36b6e0Skxie@chelsio.com 11317b36b6e0Skxie@chelsio.com cxgbi_skcb_rx_ddigest(lskb) = ntohl(rpl->ulp_crc); 11327b36b6e0Skxie@chelsio.com 11337b36b6e0Skxie@chelsio.com if (ntohs(rpl->len) != cxgbi_skcb_rx_pdulen(lskb)) 11347b36b6e0Skxie@chelsio.com pr_info("tid 0x%x, RX_DATA_DDP pdulen %u != %u.\n", 11357b36b6e0Skxie@chelsio.com csk->tid, ntohs(rpl->len), cxgbi_skcb_rx_pdulen(lskb)); 11367b36b6e0Skxie@chelsio.com 11377b36b6e0Skxie@chelsio.com if (status & (1 << CPL_RX_DDP_STATUS_HCRC_SHIFT)) { 1138e27d6169Skxie@chelsio.com pr_info("csk 0x%p, lhdr 0x%p, status 0x%x, hcrc bad 0x%lx.\n", 1139e27d6169Skxie@chelsio.com csk, lskb, status, cxgbi_skcb_flags(lskb)); 11407b36b6e0Skxie@chelsio.com cxgbi_skcb_set_flag(lskb, SKCBF_RX_HCRC_ERR); 11417b36b6e0Skxie@chelsio.com } 11427b36b6e0Skxie@chelsio.com if (status & (1 << CPL_RX_DDP_STATUS_DCRC_SHIFT)) { 1143e27d6169Skxie@chelsio.com pr_info("csk 0x%p, lhdr 0x%p, status 0x%x, dcrc bad 0x%lx.\n", 1144e27d6169Skxie@chelsio.com csk, lskb, status, cxgbi_skcb_flags(lskb)); 11457b36b6e0Skxie@chelsio.com cxgbi_skcb_set_flag(lskb, SKCBF_RX_DCRC_ERR); 11467b36b6e0Skxie@chelsio.com } 11477b36b6e0Skxie@chelsio.com if (status & (1 << CPL_RX_DDP_STATUS_PAD_SHIFT)) { 11487b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_PDU_RX, 11497b36b6e0Skxie@chelsio.com "csk 0x%p, lhdr 0x%p, status 0x%x, pad bad.\n", 11507b36b6e0Skxie@chelsio.com csk, lskb, status); 11517b36b6e0Skxie@chelsio.com cxgbi_skcb_set_flag(lskb, SKCBF_RX_PAD_ERR); 11527b36b6e0Skxie@chelsio.com } 11537b36b6e0Skxie@chelsio.com if ((status & (1 << CPL_RX_DDP_STATUS_DDP_SHIFT)) && 11547b36b6e0Skxie@chelsio.com !cxgbi_skcb_test_flag(lskb, SKCBF_RX_DATA)) { 11557b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_PDU_RX, 11567b36b6e0Skxie@chelsio.com "csk 0x%p, lhdr 0x%p, 0x%x, data ddp'ed.\n", 11577b36b6e0Skxie@chelsio.com csk, lskb, status); 11587b36b6e0Skxie@chelsio.com cxgbi_skcb_set_flag(lskb, SKCBF_RX_DATA_DDPD); 11597b36b6e0Skxie@chelsio.com } 11607b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_PDU_RX, 11617b36b6e0Skxie@chelsio.com "csk 0x%p, lskb 0x%p, f 0x%lx.\n", 11627b36b6e0Skxie@chelsio.com csk, lskb, cxgbi_skcb_flags(lskb)); 11637b36b6e0Skxie@chelsio.com 1164e27d6169Skxie@chelsio.com cxgbi_skcb_set_flag(lskb, SKCBF_RX_STATUS); 11657b36b6e0Skxie@chelsio.com cxgbi_conn_pdu_ready(csk); 11667b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 11677b36b6e0Skxie@chelsio.com goto rel_skb; 11687b36b6e0Skxie@chelsio.com 11697b36b6e0Skxie@chelsio.com abort_conn: 11707b36b6e0Skxie@chelsio.com send_abort_req(csk); 11717b36b6e0Skxie@chelsio.com discard: 11727b36b6e0Skxie@chelsio.com spin_unlock_bh(&csk->lock); 11737b36b6e0Skxie@chelsio.com rel_skb: 11747b36b6e0Skxie@chelsio.com __kfree_skb(skb); 11757b36b6e0Skxie@chelsio.com } 11767b36b6e0Skxie@chelsio.com 11777b36b6e0Skxie@chelsio.com static void do_fw4_ack(struct cxgbi_device *cdev, struct sk_buff *skb) 11787b36b6e0Skxie@chelsio.com { 11797b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 11807b36b6e0Skxie@chelsio.com struct cpl_fw4_ack *rpl = (struct cpl_fw4_ack *)skb->data; 11817b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(rpl); 11827b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 11837b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 11847b36b6e0Skxie@chelsio.com 11857b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 11867b36b6e0Skxie@chelsio.com if (unlikely(!csk)) 11877b36b6e0Skxie@chelsio.com pr_err("can't find connection for tid %u.\n", tid); 11887b36b6e0Skxie@chelsio.com else { 11897b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 11907b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u.\n", 11917b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 11927b36b6e0Skxie@chelsio.com cxgbi_sock_rcv_wr_ack(csk, rpl->credits, ntohl(rpl->snd_una), 11937b36b6e0Skxie@chelsio.com rpl->seq_vld); 11947b36b6e0Skxie@chelsio.com } 11957b36b6e0Skxie@chelsio.com __kfree_skb(skb); 11967b36b6e0Skxie@chelsio.com } 11977b36b6e0Skxie@chelsio.com 11987b36b6e0Skxie@chelsio.com static void do_set_tcb_rpl(struct cxgbi_device *cdev, struct sk_buff *skb) 11997b36b6e0Skxie@chelsio.com { 12007b36b6e0Skxie@chelsio.com struct cpl_set_tcb_rpl *rpl = (struct cpl_set_tcb_rpl *)skb->data; 12017b36b6e0Skxie@chelsio.com unsigned int tid = GET_TID(rpl); 12027b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 12037b36b6e0Skxie@chelsio.com struct tid_info *t = lldi->tids; 12047b36b6e0Skxie@chelsio.com struct cxgbi_sock *csk; 12057b36b6e0Skxie@chelsio.com 12067b36b6e0Skxie@chelsio.com csk = lookup_tid(t, tid); 12077b36b6e0Skxie@chelsio.com if (!csk) 12087b36b6e0Skxie@chelsio.com pr_err("can't find conn. for tid %u.\n", tid); 12097b36b6e0Skxie@chelsio.com 12107b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 12117b36b6e0Skxie@chelsio.com "csk 0x%p,%u,%lx,%u, status 0x%x.\n", 12127b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid, rpl->status); 12137b36b6e0Skxie@chelsio.com 12147b36b6e0Skxie@chelsio.com if (rpl->status != CPL_ERR_NONE) 12157b36b6e0Skxie@chelsio.com pr_err("csk 0x%p,%u, SET_TCB_RPL status %u.\n", 12167b36b6e0Skxie@chelsio.com csk, tid, rpl->status); 12177b36b6e0Skxie@chelsio.com 12187b36b6e0Skxie@chelsio.com __kfree_skb(skb); 12197b36b6e0Skxie@chelsio.com } 12207b36b6e0Skxie@chelsio.com 12217b36b6e0Skxie@chelsio.com static int alloc_cpls(struct cxgbi_sock *csk) 12227b36b6e0Skxie@chelsio.com { 122324d3f95aSkxie@chelsio.com csk->cpl_close = alloc_wr(sizeof(struct cpl_close_con_req), 122424d3f95aSkxie@chelsio.com 0, GFP_KERNEL); 12257b36b6e0Skxie@chelsio.com if (!csk->cpl_close) 12267b36b6e0Skxie@chelsio.com return -ENOMEM; 12277b36b6e0Skxie@chelsio.com 122824d3f95aSkxie@chelsio.com csk->cpl_abort_req = alloc_wr(sizeof(struct cpl_abort_req), 122924d3f95aSkxie@chelsio.com 0, GFP_KERNEL); 12307b36b6e0Skxie@chelsio.com if (!csk->cpl_abort_req) 12317b36b6e0Skxie@chelsio.com goto free_cpls; 12327b36b6e0Skxie@chelsio.com 123324d3f95aSkxie@chelsio.com csk->cpl_abort_rpl = alloc_wr(sizeof(struct cpl_abort_rpl), 123424d3f95aSkxie@chelsio.com 0, GFP_KERNEL); 12357b36b6e0Skxie@chelsio.com if (!csk->cpl_abort_rpl) 12367b36b6e0Skxie@chelsio.com goto free_cpls; 12377b36b6e0Skxie@chelsio.com return 0; 12387b36b6e0Skxie@chelsio.com 12397b36b6e0Skxie@chelsio.com free_cpls: 12407b36b6e0Skxie@chelsio.com cxgbi_sock_free_cpl_skbs(csk); 12417b36b6e0Skxie@chelsio.com return -ENOMEM; 12427b36b6e0Skxie@chelsio.com } 12437b36b6e0Skxie@chelsio.com 12447b36b6e0Skxie@chelsio.com static inline void l2t_put(struct cxgbi_sock *csk) 12457b36b6e0Skxie@chelsio.com { 12467b36b6e0Skxie@chelsio.com if (csk->l2t) { 12477b36b6e0Skxie@chelsio.com cxgb4_l2t_release(csk->l2t); 12487b36b6e0Skxie@chelsio.com csk->l2t = NULL; 12497b36b6e0Skxie@chelsio.com cxgbi_sock_put(csk); 12507b36b6e0Skxie@chelsio.com } 12517b36b6e0Skxie@chelsio.com } 12527b36b6e0Skxie@chelsio.com 12537b36b6e0Skxie@chelsio.com static void release_offload_resources(struct cxgbi_sock *csk) 12547b36b6e0Skxie@chelsio.com { 12557b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi; 12567b36b6e0Skxie@chelsio.com 12577b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 12587b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u.\n", 12597b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 12607b36b6e0Skxie@chelsio.com 12617b36b6e0Skxie@chelsio.com cxgbi_sock_free_cpl_skbs(csk); 12627b36b6e0Skxie@chelsio.com if (csk->wr_cred != csk->wr_max_cred) { 12637b36b6e0Skxie@chelsio.com cxgbi_sock_purge_wr_queue(csk); 12647b36b6e0Skxie@chelsio.com cxgbi_sock_reset_wr_list(csk); 12657b36b6e0Skxie@chelsio.com } 12667b36b6e0Skxie@chelsio.com 12677b36b6e0Skxie@chelsio.com l2t_put(csk); 12687b36b6e0Skxie@chelsio.com if (cxgbi_sock_flag(csk, CTPF_HAS_ATID)) 12697b36b6e0Skxie@chelsio.com free_atid(csk); 12707b36b6e0Skxie@chelsio.com else if (cxgbi_sock_flag(csk, CTPF_HAS_TID)) { 12717b36b6e0Skxie@chelsio.com lldi = cxgbi_cdev_priv(csk->cdev); 12727b36b6e0Skxie@chelsio.com cxgb4_remove_tid(lldi->tids, 0, csk->tid); 12737b36b6e0Skxie@chelsio.com cxgbi_sock_clear_flag(csk, CTPF_HAS_TID); 12747b36b6e0Skxie@chelsio.com cxgbi_sock_put(csk); 12757b36b6e0Skxie@chelsio.com } 12767b36b6e0Skxie@chelsio.com csk->dst = NULL; 12777b36b6e0Skxie@chelsio.com csk->cdev = NULL; 12787b36b6e0Skxie@chelsio.com } 12797b36b6e0Skxie@chelsio.com 12807b36b6e0Skxie@chelsio.com static int init_act_open(struct cxgbi_sock *csk) 12817b36b6e0Skxie@chelsio.com { 12827b36b6e0Skxie@chelsio.com struct cxgbi_device *cdev = csk->cdev; 12837b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 12847b36b6e0Skxie@chelsio.com struct net_device *ndev = cdev->ports[csk->port_id]; 12857b36b6e0Skxie@chelsio.com struct sk_buff *skb = NULL; 1286759a0cc5SAnish Bhatt struct neighbour *n = NULL; 1287759a0cc5SAnish Bhatt void *daddr; 12887b36b6e0Skxie@chelsio.com unsigned int step; 1289759a0cc5SAnish Bhatt unsigned int size, size6; 1290759a0cc5SAnish Bhatt int t4 = is_t4(lldi->adapter_type); 12917b36b6e0Skxie@chelsio.com 12927b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 12937b36b6e0Skxie@chelsio.com "csk 0x%p,%u,0x%lx,%u.\n", 12947b36b6e0Skxie@chelsio.com csk, csk->state, csk->flags, csk->tid); 12957b36b6e0Skxie@chelsio.com 1296759a0cc5SAnish Bhatt if (csk->csk_family == AF_INET) 1297759a0cc5SAnish Bhatt daddr = &csk->daddr.sin_addr.s_addr; 1298e81fbf6cSAnish Bhatt #if IS_ENABLED(CONFIG_IPV6) 1299e81fbf6cSAnish Bhatt else if (csk->csk_family == AF_INET6) 1300759a0cc5SAnish Bhatt daddr = &csk->daddr6.sin6_addr; 1301e81fbf6cSAnish Bhatt #endif 1302e81fbf6cSAnish Bhatt else { 1303e81fbf6cSAnish Bhatt pr_err("address family 0x%x not supported\n", csk->csk_family); 1304e81fbf6cSAnish Bhatt goto rel_resource; 1305e81fbf6cSAnish Bhatt } 1306759a0cc5SAnish Bhatt 1307759a0cc5SAnish Bhatt n = dst_neigh_lookup(csk->dst, daddr); 1308759a0cc5SAnish Bhatt 1309759a0cc5SAnish Bhatt if (!n) { 1310759a0cc5SAnish Bhatt pr_err("%s, can't get neighbour of csk->dst.\n", ndev->name); 1311759a0cc5SAnish Bhatt goto rel_resource; 1312759a0cc5SAnish Bhatt } 1313759a0cc5SAnish Bhatt 13147b36b6e0Skxie@chelsio.com csk->atid = cxgb4_alloc_atid(lldi->tids, csk); 13157b36b6e0Skxie@chelsio.com if (csk->atid < 0) { 13167b36b6e0Skxie@chelsio.com pr_err("%s, NO atid available.\n", ndev->name); 13177b36b6e0Skxie@chelsio.com return -EINVAL; 13187b36b6e0Skxie@chelsio.com } 13197b36b6e0Skxie@chelsio.com cxgbi_sock_set_flag(csk, CTPF_HAS_ATID); 13207b36b6e0Skxie@chelsio.com cxgbi_sock_get(csk); 13217b36b6e0Skxie@chelsio.com 132251e059bdSDavid Miller csk->l2t = cxgb4_l2t_get(lldi->l2t, n, ndev, 0); 13237b36b6e0Skxie@chelsio.com if (!csk->l2t) { 13247b36b6e0Skxie@chelsio.com pr_err("%s, cannot alloc l2t.\n", ndev->name); 13257b36b6e0Skxie@chelsio.com goto rel_resource; 13267b36b6e0Skxie@chelsio.com } 13277b36b6e0Skxie@chelsio.com cxgbi_sock_get(csk); 13287b36b6e0Skxie@chelsio.com 1329759a0cc5SAnish Bhatt if (t4) { 1330759a0cc5SAnish Bhatt size = sizeof(struct cpl_act_open_req); 1331759a0cc5SAnish Bhatt size6 = sizeof(struct cpl_act_open_req6); 1332759a0cc5SAnish Bhatt } else { 1333759a0cc5SAnish Bhatt size = sizeof(struct cpl_t5_act_open_req); 1334759a0cc5SAnish Bhatt size6 = sizeof(struct cpl_t5_act_open_req6); 1335759a0cc5SAnish Bhatt } 1336759a0cc5SAnish Bhatt 1337759a0cc5SAnish Bhatt if (csk->csk_family == AF_INET) 1338759a0cc5SAnish Bhatt skb = alloc_wr(size, 0, GFP_NOIO); 1339f42bb57cSAnish Bhatt #if IS_ENABLED(CONFIG_IPV6) 1340759a0cc5SAnish Bhatt else 1341759a0cc5SAnish Bhatt skb = alloc_wr(size6, 0, GFP_NOIO); 1342f42bb57cSAnish Bhatt #endif 1343759a0cc5SAnish Bhatt 13447b36b6e0Skxie@chelsio.com if (!skb) 13457b36b6e0Skxie@chelsio.com goto rel_resource; 13467b36b6e0Skxie@chelsio.com skb->sk = (struct sock *)csk; 13477b36b6e0Skxie@chelsio.com t4_set_arp_err_handler(skb, csk, cxgbi_sock_act_open_req_arp_failure); 13487b36b6e0Skxie@chelsio.com 13497b36b6e0Skxie@chelsio.com if (!csk->mtu) 13507b36b6e0Skxie@chelsio.com csk->mtu = dst_mtu(csk->dst); 13517b36b6e0Skxie@chelsio.com cxgb4_best_mtu(lldi->mtus, csk->mtu, &csk->mss_idx); 13527b36b6e0Skxie@chelsio.com csk->tx_chan = cxgb4_port_chan(ndev); 13537b36b6e0Skxie@chelsio.com /* SMT two entries per row */ 13547b36b6e0Skxie@chelsio.com csk->smac_idx = ((cxgb4_port_viid(ndev) & 0x7F)) << 1; 13557b36b6e0Skxie@chelsio.com step = lldi->ntxq / lldi->nchan; 13567b36b6e0Skxie@chelsio.com csk->txq_idx = cxgb4_port_idx(ndev) * step; 13577b36b6e0Skxie@chelsio.com step = lldi->nrxq / lldi->nchan; 13587b36b6e0Skxie@chelsio.com csk->rss_qid = lldi->rxq_ids[cxgb4_port_idx(ndev) * step]; 1359759a0cc5SAnish Bhatt csk->wr_cred = lldi->wr_cred - 1360759a0cc5SAnish Bhatt DIV_ROUND_UP(sizeof(struct cpl_abort_req), 16); 1361759a0cc5SAnish Bhatt csk->wr_max_cred = csk->wr_cred; 13627b36b6e0Skxie@chelsio.com csk->wr_una_cred = 0; 13637b36b6e0Skxie@chelsio.com cxgbi_sock_reset_wr_list(csk); 13647b36b6e0Skxie@chelsio.com csk->err = 0; 13657b36b6e0Skxie@chelsio.com 1366759a0cc5SAnish Bhatt pr_info_ipaddr("csk 0x%p,%u,0x%lx,%u,%u,%u, mtu %u,%u, smac %u.\n", 1367759a0cc5SAnish Bhatt (&csk->saddr), (&csk->daddr), csk, csk->state, 1368759a0cc5SAnish Bhatt csk->flags, csk->tx_chan, csk->txq_idx, csk->rss_qid, 1369759a0cc5SAnish Bhatt csk->mtu, csk->mss_idx, csk->smac_idx); 1370759a0cc5SAnish Bhatt 1371759a0cc5SAnish Bhatt /* must wait for either a act_open_rpl or act_open_establish */ 1372759a0cc5SAnish Bhatt try_module_get(THIS_MODULE); 13737b36b6e0Skxie@chelsio.com cxgbi_sock_set_state(csk, CTP_ACTIVE_OPEN); 1374759a0cc5SAnish Bhatt if (csk->csk_family == AF_INET) 13757b36b6e0Skxie@chelsio.com send_act_open_req(csk, skb, csk->l2t); 1376f42bb57cSAnish Bhatt #if IS_ENABLED(CONFIG_IPV6) 1377759a0cc5SAnish Bhatt else 1378759a0cc5SAnish Bhatt send_act_open_req6(csk, skb, csk->l2t); 1379f42bb57cSAnish Bhatt #endif 1380c4737377SDavid S. Miller neigh_release(n); 1381759a0cc5SAnish Bhatt 13827b36b6e0Skxie@chelsio.com return 0; 13837b36b6e0Skxie@chelsio.com 13847b36b6e0Skxie@chelsio.com rel_resource: 1385c4737377SDavid S. Miller if (n) 1386c4737377SDavid S. Miller neigh_release(n); 13877b36b6e0Skxie@chelsio.com if (skb) 13887b36b6e0Skxie@chelsio.com __kfree_skb(skb); 13897b36b6e0Skxie@chelsio.com return -EINVAL; 13907b36b6e0Skxie@chelsio.com } 13917b36b6e0Skxie@chelsio.com 13927b36b6e0Skxie@chelsio.com cxgb4i_cplhandler_func cxgb4i_cplhandlers[NUM_CPL_CMDS] = { 13937b36b6e0Skxie@chelsio.com [CPL_ACT_ESTABLISH] = do_act_establish, 13947b36b6e0Skxie@chelsio.com [CPL_ACT_OPEN_RPL] = do_act_open_rpl, 13957b36b6e0Skxie@chelsio.com [CPL_PEER_CLOSE] = do_peer_close, 13967b36b6e0Skxie@chelsio.com [CPL_ABORT_REQ_RSS] = do_abort_req_rss, 13977b36b6e0Skxie@chelsio.com [CPL_ABORT_RPL_RSS] = do_abort_rpl_rss, 13987b36b6e0Skxie@chelsio.com [CPL_CLOSE_CON_RPL] = do_close_con_rpl, 13997b36b6e0Skxie@chelsio.com [CPL_FW4_ACK] = do_fw4_ack, 14007b36b6e0Skxie@chelsio.com [CPL_ISCSI_HDR] = do_rx_iscsi_hdr, 14013bd3e8bfSKaren Xie [CPL_ISCSI_DATA] = do_rx_iscsi_hdr, 14027b36b6e0Skxie@chelsio.com [CPL_SET_TCB_RPL] = do_set_tcb_rpl, 14037b36b6e0Skxie@chelsio.com [CPL_RX_DATA_DDP] = do_rx_data_ddp, 14043bd3e8bfSKaren Xie [CPL_RX_ISCSI_DDP] = do_rx_data_ddp, 14057b36b6e0Skxie@chelsio.com }; 14067b36b6e0Skxie@chelsio.com 14077b36b6e0Skxie@chelsio.com int cxgb4i_ofld_init(struct cxgbi_device *cdev) 14087b36b6e0Skxie@chelsio.com { 14097b36b6e0Skxie@chelsio.com int rc; 14107b36b6e0Skxie@chelsio.com 14117b36b6e0Skxie@chelsio.com if (cxgb4i_max_connect > CXGB4I_MAX_CONN) 14127b36b6e0Skxie@chelsio.com cxgb4i_max_connect = CXGB4I_MAX_CONN; 14137b36b6e0Skxie@chelsio.com 14147b36b6e0Skxie@chelsio.com rc = cxgbi_device_portmap_create(cdev, cxgb4i_sport_base, 14157b36b6e0Skxie@chelsio.com cxgb4i_max_connect); 14167b36b6e0Skxie@chelsio.com if (rc < 0) 14177b36b6e0Skxie@chelsio.com return rc; 14187b36b6e0Skxie@chelsio.com 14197b36b6e0Skxie@chelsio.com cdev->csk_release_offload_resources = release_offload_resources; 14207b36b6e0Skxie@chelsio.com cdev->csk_push_tx_frames = push_tx_frames; 14217b36b6e0Skxie@chelsio.com cdev->csk_send_abort_req = send_abort_req; 14227b36b6e0Skxie@chelsio.com cdev->csk_send_close_req = send_close_req; 14237b36b6e0Skxie@chelsio.com cdev->csk_send_rx_credits = send_rx_credits; 14247b36b6e0Skxie@chelsio.com cdev->csk_alloc_cpls = alloc_cpls; 14257b36b6e0Skxie@chelsio.com cdev->csk_init_act_open = init_act_open; 14267b36b6e0Skxie@chelsio.com 14277b36b6e0Skxie@chelsio.com pr_info("cdev 0x%p, offload up, added.\n", cdev); 14287b36b6e0Skxie@chelsio.com return 0; 14297b36b6e0Skxie@chelsio.com } 14307b36b6e0Skxie@chelsio.com 14317b36b6e0Skxie@chelsio.com /* 14327b36b6e0Skxie@chelsio.com * functions to program the pagepod in h/w 14337b36b6e0Skxie@chelsio.com */ 1434e27d6169Skxie@chelsio.com #define ULPMEM_IDATA_MAX_NPPODS 4 /* 256/PPOD_SIZE */ 14353bd3e8bfSKaren Xie static inline void ulp_mem_io_set_hdr(struct cxgb4_lld_info *lldi, 14363bd3e8bfSKaren Xie struct ulp_mem_io *req, 1437e27d6169Skxie@chelsio.com unsigned int wr_len, unsigned int dlen, 1438e27d6169Skxie@chelsio.com unsigned int pm_addr) 14397b36b6e0Skxie@chelsio.com { 1440e27d6169Skxie@chelsio.com struct ulptx_idata *idata = (struct ulptx_idata *)(req + 1); 14417b36b6e0Skxie@chelsio.com 14427b36b6e0Skxie@chelsio.com INIT_ULPTX_WR(req, wr_len, 0, 0); 14433bd3e8bfSKaren Xie if (is_t4(lldi->adapter_type)) 14443bd3e8bfSKaren Xie req->cmd = htonl(ULPTX_CMD(ULP_TX_MEM_WRITE) | 14453bd3e8bfSKaren Xie (ULP_MEMIO_ORDER(1))); 14463bd3e8bfSKaren Xie else 14473bd3e8bfSKaren Xie req->cmd = htonl(ULPTX_CMD(ULP_TX_MEM_WRITE) | 14483bd3e8bfSKaren Xie (V_T5_ULP_MEMIO_IMM(1))); 14497b36b6e0Skxie@chelsio.com req->dlen = htonl(ULP_MEMIO_DATA_LEN(dlen >> 5)); 14507b36b6e0Skxie@chelsio.com req->lock_addr = htonl(ULP_MEMIO_ADDR(pm_addr >> 5)); 14517b36b6e0Skxie@chelsio.com req->len16 = htonl(DIV_ROUND_UP(wr_len - sizeof(req->wr), 16)); 1452e27d6169Skxie@chelsio.com 1453e27d6169Skxie@chelsio.com idata->cmd_more = htonl(ULPTX_CMD(ULP_TX_SC_IMM)); 1454e27d6169Skxie@chelsio.com idata->len = htonl(dlen); 14557b36b6e0Skxie@chelsio.com } 14567b36b6e0Skxie@chelsio.com 1457e27d6169Skxie@chelsio.com static int ddp_ppod_write_idata(struct cxgbi_device *cdev, unsigned int port_id, 14587b36b6e0Skxie@chelsio.com struct cxgbi_pagepod_hdr *hdr, unsigned int idx, 14597b36b6e0Skxie@chelsio.com unsigned int npods, 14607b36b6e0Skxie@chelsio.com struct cxgbi_gather_list *gl, 14617b36b6e0Skxie@chelsio.com unsigned int gl_pidx) 14627b36b6e0Skxie@chelsio.com { 14637b36b6e0Skxie@chelsio.com struct cxgbi_ddp_info *ddp = cdev->ddp; 14643bd3e8bfSKaren Xie struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 14657b36b6e0Skxie@chelsio.com struct sk_buff *skb; 14667b36b6e0Skxie@chelsio.com struct ulp_mem_io *req; 1467e27d6169Skxie@chelsio.com struct ulptx_idata *idata; 14687b36b6e0Skxie@chelsio.com struct cxgbi_pagepod *ppod; 1469e27d6169Skxie@chelsio.com unsigned int pm_addr = idx * PPOD_SIZE + ddp->llimit; 1470e27d6169Skxie@chelsio.com unsigned int dlen = PPOD_SIZE * npods; 1471e27d6169Skxie@chelsio.com unsigned int wr_len = roundup(sizeof(struct ulp_mem_io) + 1472e27d6169Skxie@chelsio.com sizeof(struct ulptx_idata) + dlen, 16); 14737b36b6e0Skxie@chelsio.com unsigned int i; 14747b36b6e0Skxie@chelsio.com 1475e27d6169Skxie@chelsio.com skb = alloc_wr(wr_len, 0, GFP_ATOMIC); 14767b36b6e0Skxie@chelsio.com if (!skb) { 14777b36b6e0Skxie@chelsio.com pr_err("cdev 0x%p, idx %u, npods %u, OOM.\n", 14787b36b6e0Skxie@chelsio.com cdev, idx, npods); 14797b36b6e0Skxie@chelsio.com return -ENOMEM; 14807b36b6e0Skxie@chelsio.com } 14817b36b6e0Skxie@chelsio.com req = (struct ulp_mem_io *)skb->head; 14827b36b6e0Skxie@chelsio.com set_queue(skb, CPL_PRIORITY_CONTROL, NULL); 14837b36b6e0Skxie@chelsio.com 14843bd3e8bfSKaren Xie ulp_mem_io_set_hdr(lldi, req, wr_len, dlen, pm_addr); 1485e27d6169Skxie@chelsio.com idata = (struct ulptx_idata *)(req + 1); 1486e27d6169Skxie@chelsio.com ppod = (struct cxgbi_pagepod *)(idata + 1); 14877b36b6e0Skxie@chelsio.com 14887b36b6e0Skxie@chelsio.com for (i = 0; i < npods; i++, ppod++, gl_pidx += PPOD_PAGES_MAX) { 14897b36b6e0Skxie@chelsio.com if (!hdr && !gl) 14907b36b6e0Skxie@chelsio.com cxgbi_ddp_ppod_clear(ppod); 14917b36b6e0Skxie@chelsio.com else 14927b36b6e0Skxie@chelsio.com cxgbi_ddp_ppod_set(ppod, hdr, gl, gl_pidx); 14937b36b6e0Skxie@chelsio.com } 14947b36b6e0Skxie@chelsio.com 14957b36b6e0Skxie@chelsio.com cxgb4_ofld_send(cdev->ports[port_id], skb); 14967b36b6e0Skxie@chelsio.com return 0; 14977b36b6e0Skxie@chelsio.com } 14987b36b6e0Skxie@chelsio.com 14997b36b6e0Skxie@chelsio.com static int ddp_set_map(struct cxgbi_sock *csk, struct cxgbi_pagepod_hdr *hdr, 15007b36b6e0Skxie@chelsio.com unsigned int idx, unsigned int npods, 15017b36b6e0Skxie@chelsio.com struct cxgbi_gather_list *gl) 15027b36b6e0Skxie@chelsio.com { 15037b36b6e0Skxie@chelsio.com unsigned int i, cnt; 15047b36b6e0Skxie@chelsio.com int err = 0; 15057b36b6e0Skxie@chelsio.com 15067b36b6e0Skxie@chelsio.com for (i = 0; i < npods; i += cnt, idx += cnt) { 15077b36b6e0Skxie@chelsio.com cnt = npods - i; 1508e27d6169Skxie@chelsio.com if (cnt > ULPMEM_IDATA_MAX_NPPODS) 1509e27d6169Skxie@chelsio.com cnt = ULPMEM_IDATA_MAX_NPPODS; 1510e27d6169Skxie@chelsio.com err = ddp_ppod_write_idata(csk->cdev, csk->port_id, hdr, 15117b36b6e0Skxie@chelsio.com idx, cnt, gl, 4 * i); 15127b36b6e0Skxie@chelsio.com if (err < 0) 15137b36b6e0Skxie@chelsio.com break; 15147b36b6e0Skxie@chelsio.com } 15157b36b6e0Skxie@chelsio.com return err; 15167b36b6e0Skxie@chelsio.com } 15177b36b6e0Skxie@chelsio.com 15187b36b6e0Skxie@chelsio.com static void ddp_clear_map(struct cxgbi_hba *chba, unsigned int tag, 15197b36b6e0Skxie@chelsio.com unsigned int idx, unsigned int npods) 15207b36b6e0Skxie@chelsio.com { 15217b36b6e0Skxie@chelsio.com unsigned int i, cnt; 15227b36b6e0Skxie@chelsio.com int err; 15237b36b6e0Skxie@chelsio.com 15247b36b6e0Skxie@chelsio.com for (i = 0; i < npods; i += cnt, idx += cnt) { 15257b36b6e0Skxie@chelsio.com cnt = npods - i; 1526e27d6169Skxie@chelsio.com if (cnt > ULPMEM_IDATA_MAX_NPPODS) 1527e27d6169Skxie@chelsio.com cnt = ULPMEM_IDATA_MAX_NPPODS; 1528e27d6169Skxie@chelsio.com err = ddp_ppod_write_idata(chba->cdev, chba->port_id, NULL, 15297b36b6e0Skxie@chelsio.com idx, cnt, NULL, 0); 15307b36b6e0Skxie@chelsio.com if (err < 0) 15317b36b6e0Skxie@chelsio.com break; 15327b36b6e0Skxie@chelsio.com } 15337b36b6e0Skxie@chelsio.com } 15347b36b6e0Skxie@chelsio.com 15357b36b6e0Skxie@chelsio.com static int ddp_setup_conn_pgidx(struct cxgbi_sock *csk, unsigned int tid, 15367b36b6e0Skxie@chelsio.com int pg_idx, bool reply) 15377b36b6e0Skxie@chelsio.com { 15387b36b6e0Skxie@chelsio.com struct sk_buff *skb; 15397b36b6e0Skxie@chelsio.com struct cpl_set_tcb_field *req; 15407b36b6e0Skxie@chelsio.com 1541e27d6169Skxie@chelsio.com if (!pg_idx || pg_idx >= DDP_PGIDX_MAX) 15427b36b6e0Skxie@chelsio.com return 0; 15437b36b6e0Skxie@chelsio.com 154424d3f95aSkxie@chelsio.com skb = alloc_wr(sizeof(*req), 0, GFP_KERNEL); 15457b36b6e0Skxie@chelsio.com if (!skb) 15467b36b6e0Skxie@chelsio.com return -ENOMEM; 15477b36b6e0Skxie@chelsio.com 1548e27d6169Skxie@chelsio.com /* set up ulp page size */ 15497b36b6e0Skxie@chelsio.com req = (struct cpl_set_tcb_field *)skb->head; 15507b36b6e0Skxie@chelsio.com INIT_TP_WR(req, csk->tid); 15517b36b6e0Skxie@chelsio.com OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_SET_TCB_FIELD, csk->tid)); 15527b36b6e0Skxie@chelsio.com req->reply_ctrl = htons(NO_REPLY(reply) | QUEUENO(csk->rss_qid)); 1553e27d6169Skxie@chelsio.com req->word_cookie = htons(0); 1554e27d6169Skxie@chelsio.com req->mask = cpu_to_be64(0x3 << 8); 1555e27d6169Skxie@chelsio.com req->val = cpu_to_be64(pg_idx << 8); 15567b36b6e0Skxie@chelsio.com set_wr_txq(skb, CPL_PRIORITY_CONTROL, csk->port_id); 15577b36b6e0Skxie@chelsio.com 15587b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 15597b36b6e0Skxie@chelsio.com "csk 0x%p, tid 0x%x, pg_idx %u.\n", csk, csk->tid, pg_idx); 15607b36b6e0Skxie@chelsio.com 15617b36b6e0Skxie@chelsio.com cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb); 15627b36b6e0Skxie@chelsio.com return 0; 15637b36b6e0Skxie@chelsio.com } 15647b36b6e0Skxie@chelsio.com 15657b36b6e0Skxie@chelsio.com static int ddp_setup_conn_digest(struct cxgbi_sock *csk, unsigned int tid, 15667b36b6e0Skxie@chelsio.com int hcrc, int dcrc, int reply) 15677b36b6e0Skxie@chelsio.com { 15687b36b6e0Skxie@chelsio.com struct sk_buff *skb; 15697b36b6e0Skxie@chelsio.com struct cpl_set_tcb_field *req; 15707b36b6e0Skxie@chelsio.com 1571e27d6169Skxie@chelsio.com if (!hcrc && !dcrc) 1572e27d6169Skxie@chelsio.com return 0; 15737b36b6e0Skxie@chelsio.com 157424d3f95aSkxie@chelsio.com skb = alloc_wr(sizeof(*req), 0, GFP_KERNEL); 15757b36b6e0Skxie@chelsio.com if (!skb) 15767b36b6e0Skxie@chelsio.com return -ENOMEM; 15777b36b6e0Skxie@chelsio.com 15787b36b6e0Skxie@chelsio.com csk->hcrc_len = (hcrc ? 4 : 0); 15797b36b6e0Skxie@chelsio.com csk->dcrc_len = (dcrc ? 4 : 0); 1580e27d6169Skxie@chelsio.com /* set up ulp submode */ 15817b36b6e0Skxie@chelsio.com req = (struct cpl_set_tcb_field *)skb->head; 15827b36b6e0Skxie@chelsio.com INIT_TP_WR(req, tid); 15837b36b6e0Skxie@chelsio.com OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_SET_TCB_FIELD, tid)); 15847b36b6e0Skxie@chelsio.com req->reply_ctrl = htons(NO_REPLY(reply) | QUEUENO(csk->rss_qid)); 1585e27d6169Skxie@chelsio.com req->word_cookie = htons(0); 1586e27d6169Skxie@chelsio.com req->mask = cpu_to_be64(0x3 << 4); 1587e27d6169Skxie@chelsio.com req->val = cpu_to_be64(((hcrc ? ULP_CRC_HEADER : 0) | 1588e27d6169Skxie@chelsio.com (dcrc ? ULP_CRC_DATA : 0)) << 4); 15897b36b6e0Skxie@chelsio.com set_wr_txq(skb, CPL_PRIORITY_CONTROL, csk->port_id); 15907b36b6e0Skxie@chelsio.com 15917b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK, 15927b36b6e0Skxie@chelsio.com "csk 0x%p, tid 0x%x, crc %d,%d.\n", csk, csk->tid, hcrc, dcrc); 15937b36b6e0Skxie@chelsio.com 15947b36b6e0Skxie@chelsio.com cxgb4_ofld_send(csk->cdev->ports[csk->port_id], skb); 15957b36b6e0Skxie@chelsio.com return 0; 15967b36b6e0Skxie@chelsio.com } 15977b36b6e0Skxie@chelsio.com 15987b36b6e0Skxie@chelsio.com static int cxgb4i_ddp_init(struct cxgbi_device *cdev) 15997b36b6e0Skxie@chelsio.com { 16007b36b6e0Skxie@chelsio.com struct cxgb4_lld_info *lldi = cxgbi_cdev_priv(cdev); 16017b36b6e0Skxie@chelsio.com struct cxgbi_ddp_info *ddp = cdev->ddp; 16027b36b6e0Skxie@chelsio.com unsigned int tagmask, pgsz_factor[4]; 16037b36b6e0Skxie@chelsio.com int err; 16047b36b6e0Skxie@chelsio.com 16057b36b6e0Skxie@chelsio.com if (ddp) { 16067b36b6e0Skxie@chelsio.com kref_get(&ddp->refcnt); 16077b36b6e0Skxie@chelsio.com pr_warn("cdev 0x%p, ddp 0x%p already set up.\n", 16087b36b6e0Skxie@chelsio.com cdev, cdev->ddp); 16097b36b6e0Skxie@chelsio.com return -EALREADY; 16107b36b6e0Skxie@chelsio.com } 16117b36b6e0Skxie@chelsio.com 16127b36b6e0Skxie@chelsio.com err = cxgbi_ddp_init(cdev, lldi->vr->iscsi.start, 16137b36b6e0Skxie@chelsio.com lldi->vr->iscsi.start + lldi->vr->iscsi.size - 1, 16147b36b6e0Skxie@chelsio.com lldi->iscsi_iolen, lldi->iscsi_iolen); 16157b36b6e0Skxie@chelsio.com if (err < 0) 16167b36b6e0Skxie@chelsio.com return err; 16177b36b6e0Skxie@chelsio.com 16187b36b6e0Skxie@chelsio.com ddp = cdev->ddp; 16197b36b6e0Skxie@chelsio.com 16207b36b6e0Skxie@chelsio.com tagmask = ddp->idx_mask << PPOD_IDX_SHIFT; 16217b36b6e0Skxie@chelsio.com cxgbi_ddp_page_size_factor(pgsz_factor); 16227b36b6e0Skxie@chelsio.com cxgb4_iscsi_init(lldi->ports[0], tagmask, pgsz_factor); 16237b36b6e0Skxie@chelsio.com 16247b36b6e0Skxie@chelsio.com cdev->csk_ddp_setup_digest = ddp_setup_conn_digest; 16257b36b6e0Skxie@chelsio.com cdev->csk_ddp_setup_pgidx = ddp_setup_conn_pgidx; 16267b36b6e0Skxie@chelsio.com cdev->csk_ddp_set = ddp_set_map; 16277b36b6e0Skxie@chelsio.com cdev->csk_ddp_clear = ddp_clear_map; 16287b36b6e0Skxie@chelsio.com 16297b36b6e0Skxie@chelsio.com pr_info("cxgb4i 0x%p tag: sw %u, rsvd %u,%u, mask 0x%x.\n", 16307b36b6e0Skxie@chelsio.com cdev, cdev->tag_format.sw_bits, cdev->tag_format.rsvd_bits, 16317b36b6e0Skxie@chelsio.com cdev->tag_format.rsvd_shift, cdev->tag_format.rsvd_mask); 16327b36b6e0Skxie@chelsio.com pr_info("cxgb4i 0x%p, nppods %u, bits %u, mask 0x%x,0x%x pkt %u/%u, " 16337b36b6e0Skxie@chelsio.com " %u/%u.\n", 16347b36b6e0Skxie@chelsio.com cdev, ddp->nppods, ddp->idx_bits, ddp->idx_mask, 16357b36b6e0Skxie@chelsio.com ddp->rsvd_tag_mask, ddp->max_txsz, lldi->iscsi_iolen, 16367b36b6e0Skxie@chelsio.com ddp->max_rxsz, lldi->iscsi_iolen); 16377b36b6e0Skxie@chelsio.com pr_info("cxgb4i 0x%p max payload size: %u/%u, %u/%u.\n", 16387b36b6e0Skxie@chelsio.com cdev, cdev->tx_max_size, ddp->max_txsz, cdev->rx_max_size, 16397b36b6e0Skxie@chelsio.com ddp->max_rxsz); 16407b36b6e0Skxie@chelsio.com return 0; 16417b36b6e0Skxie@chelsio.com } 16427b36b6e0Skxie@chelsio.com 16437b36b6e0Skxie@chelsio.com static void *t4_uld_add(const struct cxgb4_lld_info *lldi) 16447b36b6e0Skxie@chelsio.com { 16457b36b6e0Skxie@chelsio.com struct cxgbi_device *cdev; 16467b36b6e0Skxie@chelsio.com struct port_info *pi; 16477b36b6e0Skxie@chelsio.com int i, rc; 16487b36b6e0Skxie@chelsio.com 16497b36b6e0Skxie@chelsio.com cdev = cxgbi_device_register(sizeof(*lldi), lldi->nports); 16507b36b6e0Skxie@chelsio.com if (!cdev) { 16517b36b6e0Skxie@chelsio.com pr_info("t4 device 0x%p, register failed.\n", lldi); 16527b36b6e0Skxie@chelsio.com return NULL; 16537b36b6e0Skxie@chelsio.com } 16547b36b6e0Skxie@chelsio.com pr_info("0x%p,0x%x, ports %u,%s, chan %u, q %u,%u, wr %u.\n", 16557b36b6e0Skxie@chelsio.com cdev, lldi->adapter_type, lldi->nports, 16567b36b6e0Skxie@chelsio.com lldi->ports[0]->name, lldi->nchan, lldi->ntxq, 16577b36b6e0Skxie@chelsio.com lldi->nrxq, lldi->wr_cred); 16587b36b6e0Skxie@chelsio.com for (i = 0; i < lldi->nrxq; i++) 16597b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_DEV, 16607b36b6e0Skxie@chelsio.com "t4 0x%p, rxq id #%d: %u.\n", 16617b36b6e0Skxie@chelsio.com cdev, i, lldi->rxq_ids[i]); 16627b36b6e0Skxie@chelsio.com 16637b36b6e0Skxie@chelsio.com memcpy(cxgbi_cdev_priv(cdev), lldi, sizeof(*lldi)); 16647b36b6e0Skxie@chelsio.com cdev->flags = CXGBI_FLAG_DEV_T4; 16657b36b6e0Skxie@chelsio.com cdev->pdev = lldi->pdev; 16667b36b6e0Skxie@chelsio.com cdev->ports = lldi->ports; 16677b36b6e0Skxie@chelsio.com cdev->nports = lldi->nports; 16687b36b6e0Skxie@chelsio.com cdev->mtus = lldi->mtus; 16697b36b6e0Skxie@chelsio.com cdev->nmtus = NMTUS; 16707b36b6e0Skxie@chelsio.com cdev->snd_win = cxgb4i_snd_win; 16717b36b6e0Skxie@chelsio.com cdev->rcv_win = cxgb4i_rcv_win; 16727b36b6e0Skxie@chelsio.com cdev->rx_credit_thres = cxgb4i_rx_credit_thres; 16737b36b6e0Skxie@chelsio.com cdev->skb_tx_rsvd = CXGB4I_TX_HEADER_LEN; 16747b36b6e0Skxie@chelsio.com cdev->skb_rx_extra = sizeof(struct cpl_iscsi_hdr); 16757b36b6e0Skxie@chelsio.com cdev->itp = &cxgb4i_iscsi_transport; 16767b36b6e0Skxie@chelsio.com 1677e27d6169Skxie@chelsio.com cdev->pfvf = FW_VIID_PFN_GET(cxgb4_port_viid(lldi->ports[0])) << 8; 1678e27d6169Skxie@chelsio.com pr_info("cdev 0x%p,%s, pfvf %u.\n", 1679e27d6169Skxie@chelsio.com cdev, lldi->ports[0]->name, cdev->pfvf); 1680e27d6169Skxie@chelsio.com 16817b36b6e0Skxie@chelsio.com rc = cxgb4i_ddp_init(cdev); 16827b36b6e0Skxie@chelsio.com if (rc) { 16837b36b6e0Skxie@chelsio.com pr_info("t4 0x%p ddp init failed.\n", cdev); 16847b36b6e0Skxie@chelsio.com goto err_out; 16857b36b6e0Skxie@chelsio.com } 16867b36b6e0Skxie@chelsio.com rc = cxgb4i_ofld_init(cdev); 16877b36b6e0Skxie@chelsio.com if (rc) { 16887b36b6e0Skxie@chelsio.com pr_info("t4 0x%p ofld init failed.\n", cdev); 16897b36b6e0Skxie@chelsio.com goto err_out; 16907b36b6e0Skxie@chelsio.com } 16917b36b6e0Skxie@chelsio.com 16927b36b6e0Skxie@chelsio.com rc = cxgbi_hbas_add(cdev, CXGB4I_MAX_LUN, CXGBI_MAX_CONN, 16937b36b6e0Skxie@chelsio.com &cxgb4i_host_template, cxgb4i_stt); 16947b36b6e0Skxie@chelsio.com if (rc) 16957b36b6e0Skxie@chelsio.com goto err_out; 16967b36b6e0Skxie@chelsio.com 16977b36b6e0Skxie@chelsio.com for (i = 0; i < cdev->nports; i++) { 16987b36b6e0Skxie@chelsio.com pi = netdev_priv(lldi->ports[i]); 16997b36b6e0Skxie@chelsio.com cdev->hbas[i]->port_id = pi->port_id; 17007b36b6e0Skxie@chelsio.com } 17017b36b6e0Skxie@chelsio.com return cdev; 17027b36b6e0Skxie@chelsio.com 17037b36b6e0Skxie@chelsio.com err_out: 17047b36b6e0Skxie@chelsio.com cxgbi_device_unregister(cdev); 17057b36b6e0Skxie@chelsio.com return ERR_PTR(-ENOMEM); 17067b36b6e0Skxie@chelsio.com } 17077b36b6e0Skxie@chelsio.com 17087b36b6e0Skxie@chelsio.com #define RX_PULL_LEN 128 17097b36b6e0Skxie@chelsio.com static int t4_uld_rx_handler(void *handle, const __be64 *rsp, 17107b36b6e0Skxie@chelsio.com const struct pkt_gl *pgl) 17117b36b6e0Skxie@chelsio.com { 17127b36b6e0Skxie@chelsio.com const struct cpl_act_establish *rpl; 17137b36b6e0Skxie@chelsio.com struct sk_buff *skb; 17147b36b6e0Skxie@chelsio.com unsigned int opc; 17157b36b6e0Skxie@chelsio.com struct cxgbi_device *cdev = handle; 17167b36b6e0Skxie@chelsio.com 17177b36b6e0Skxie@chelsio.com if (pgl == NULL) { 17187b36b6e0Skxie@chelsio.com unsigned int len = 64 - sizeof(struct rsp_ctrl) - 8; 17197b36b6e0Skxie@chelsio.com 172024d3f95aSkxie@chelsio.com skb = alloc_wr(len, 0, GFP_ATOMIC); 17217b36b6e0Skxie@chelsio.com if (!skb) 17227b36b6e0Skxie@chelsio.com goto nomem; 17237b36b6e0Skxie@chelsio.com skb_copy_to_linear_data(skb, &rsp[1], len); 17247b36b6e0Skxie@chelsio.com } else { 17257b36b6e0Skxie@chelsio.com if (unlikely(*(u8 *)rsp != *(u8 *)pgl->va)) { 17267b36b6e0Skxie@chelsio.com pr_info("? FL 0x%p,RSS%#llx,FL %#llx,len %u.\n", 17277b36b6e0Skxie@chelsio.com pgl->va, be64_to_cpu(*rsp), 17287b36b6e0Skxie@chelsio.com be64_to_cpu(*(u64 *)pgl->va), 17297b36b6e0Skxie@chelsio.com pgl->tot_len); 17307b36b6e0Skxie@chelsio.com return 0; 17317b36b6e0Skxie@chelsio.com } 17327b36b6e0Skxie@chelsio.com skb = cxgb4_pktgl_to_skb(pgl, RX_PULL_LEN, RX_PULL_LEN); 17337b36b6e0Skxie@chelsio.com if (unlikely(!skb)) 17347b36b6e0Skxie@chelsio.com goto nomem; 17357b36b6e0Skxie@chelsio.com } 17367b36b6e0Skxie@chelsio.com 17377b36b6e0Skxie@chelsio.com rpl = (struct cpl_act_establish *)skb->data; 17387b36b6e0Skxie@chelsio.com opc = rpl->ot.opcode; 17397b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE, 17407b36b6e0Skxie@chelsio.com "cdev %p, opcode 0x%x(0x%x,0x%x), skb %p.\n", 17417b36b6e0Skxie@chelsio.com cdev, opc, rpl->ot.opcode_tid, ntohl(rpl->ot.opcode_tid), skb); 17427b36b6e0Skxie@chelsio.com if (cxgb4i_cplhandlers[opc]) 17437b36b6e0Skxie@chelsio.com cxgb4i_cplhandlers[opc](cdev, skb); 17447b36b6e0Skxie@chelsio.com else { 17457b36b6e0Skxie@chelsio.com pr_err("No handler for opcode 0x%x.\n", opc); 17467b36b6e0Skxie@chelsio.com __kfree_skb(skb); 17477b36b6e0Skxie@chelsio.com } 17487b36b6e0Skxie@chelsio.com return 0; 17497b36b6e0Skxie@chelsio.com nomem: 17507b36b6e0Skxie@chelsio.com log_debug(1 << CXGBI_DBG_TOE, "OOM bailing out.\n"); 17517b36b6e0Skxie@chelsio.com return 1; 17527b36b6e0Skxie@chelsio.com } 17537b36b6e0Skxie@chelsio.com 17547b36b6e0Skxie@chelsio.com static int t4_uld_state_change(void *handle, enum cxgb4_state state) 17557b36b6e0Skxie@chelsio.com { 17567b36b6e0Skxie@chelsio.com struct cxgbi_device *cdev = handle; 17577b36b6e0Skxie@chelsio.com 17587b36b6e0Skxie@chelsio.com switch (state) { 17597b36b6e0Skxie@chelsio.com case CXGB4_STATE_UP: 17607b36b6e0Skxie@chelsio.com pr_info("cdev 0x%p, UP.\n", cdev); 17617b36b6e0Skxie@chelsio.com break; 17627b36b6e0Skxie@chelsio.com case CXGB4_STATE_START_RECOVERY: 17637b36b6e0Skxie@chelsio.com pr_info("cdev 0x%p, RECOVERY.\n", cdev); 17647b36b6e0Skxie@chelsio.com /* close all connections */ 17657b36b6e0Skxie@chelsio.com break; 17667b36b6e0Skxie@chelsio.com case CXGB4_STATE_DOWN: 17677b36b6e0Skxie@chelsio.com pr_info("cdev 0x%p, DOWN.\n", cdev); 17687b36b6e0Skxie@chelsio.com break; 17697b36b6e0Skxie@chelsio.com case CXGB4_STATE_DETACH: 17707b36b6e0Skxie@chelsio.com pr_info("cdev 0x%p, DETACH.\n", cdev); 1771c3b331a3SThadeu Lima de Souza Cascardo cxgbi_device_unregister(cdev); 17727b36b6e0Skxie@chelsio.com break; 17737b36b6e0Skxie@chelsio.com default: 17747b36b6e0Skxie@chelsio.com pr_info("cdev 0x%p, unknown state %d.\n", cdev, state); 17757b36b6e0Skxie@chelsio.com break; 17767b36b6e0Skxie@chelsio.com } 17777b36b6e0Skxie@chelsio.com return 0; 17787b36b6e0Skxie@chelsio.com } 17797b36b6e0Skxie@chelsio.com 17807b36b6e0Skxie@chelsio.com static int __init cxgb4i_init_module(void) 17817b36b6e0Skxie@chelsio.com { 17827b36b6e0Skxie@chelsio.com int rc; 17837b36b6e0Skxie@chelsio.com 17847b36b6e0Skxie@chelsio.com printk(KERN_INFO "%s", version); 17857b36b6e0Skxie@chelsio.com 17867b36b6e0Skxie@chelsio.com rc = cxgbi_iscsi_init(&cxgb4i_iscsi_transport, &cxgb4i_stt); 17877b36b6e0Skxie@chelsio.com if (rc < 0) 17887b36b6e0Skxie@chelsio.com return rc; 17897b36b6e0Skxie@chelsio.com cxgb4_register_uld(CXGB4_ULD_ISCSI, &cxgb4i_uld_info); 1790759a0cc5SAnish Bhatt 17917b36b6e0Skxie@chelsio.com return 0; 17927b36b6e0Skxie@chelsio.com } 17937b36b6e0Skxie@chelsio.com 17947b36b6e0Skxie@chelsio.com static void __exit cxgb4i_exit_module(void) 17957b36b6e0Skxie@chelsio.com { 17967b36b6e0Skxie@chelsio.com cxgb4_unregister_uld(CXGB4_ULD_ISCSI); 17977b36b6e0Skxie@chelsio.com cxgbi_device_unregister_all(CXGBI_FLAG_DEV_T4); 17987b36b6e0Skxie@chelsio.com cxgbi_iscsi_cleanup(&cxgb4i_iscsi_transport, &cxgb4i_stt); 17997b36b6e0Skxie@chelsio.com } 18007b36b6e0Skxie@chelsio.com 18017b36b6e0Skxie@chelsio.com module_init(cxgb4i_init_module); 18027b36b6e0Skxie@chelsio.com module_exit(cxgb4i_exit_module); 1803