xref: /openbmc/linux/drivers/scsi/cxgbi/libcxgbi.c (revision 0ea5bf3dc16c868e302e85d627f885fcf1aa6e81)
19ba682f0Skxie@chelsio.com /*
29ba682f0Skxie@chelsio.com  * libcxgbi.c: Chelsio common library for T3/T4 iSCSI driver.
39ba682f0Skxie@chelsio.com  *
41149a5edSKaren Xie  * Copyright (c) 2010-2015 Chelsio Communications, Inc.
59ba682f0Skxie@chelsio.com  *
69ba682f0Skxie@chelsio.com  * This program is free software; you can redistribute it and/or modify
79ba682f0Skxie@chelsio.com  * it under the terms of the GNU General Public License as published by
89ba682f0Skxie@chelsio.com  * the Free Software Foundation.
99ba682f0Skxie@chelsio.com  *
109ba682f0Skxie@chelsio.com  * Written by: Karen Xie (kxie@chelsio.com)
119ba682f0Skxie@chelsio.com  * Written by: Rakesh Ranjan (rranjan@chelsio.com)
129ba682f0Skxie@chelsio.com  */
139ba682f0Skxie@chelsio.com 
149ba682f0Skxie@chelsio.com #define pr_fmt(fmt)	KBUILD_MODNAME ":%s: " fmt, __func__
159ba682f0Skxie@chelsio.com 
169ba682f0Skxie@chelsio.com #include <linux/skbuff.h>
179ba682f0Skxie@chelsio.com #include <linux/crypto.h>
189ba682f0Skxie@chelsio.com #include <linux/scatterlist.h>
199ba682f0Skxie@chelsio.com #include <linux/pci.h>
209ba682f0Skxie@chelsio.com #include <scsi/scsi.h>
219ba682f0Skxie@chelsio.com #include <scsi/scsi_cmnd.h>
229ba682f0Skxie@chelsio.com #include <scsi/scsi_host.h>
239ba682f0Skxie@chelsio.com #include <linux/if_vlan.h>
249ba682f0Skxie@chelsio.com #include <linux/inet.h>
259ba682f0Skxie@chelsio.com #include <net/dst.h>
269ba682f0Skxie@chelsio.com #include <net/route.h>
27fc8d0590SAnish Bhatt #include <net/ipv6.h>
28fc8d0590SAnish Bhatt #include <net/ip6_route.h>
29fc8d0590SAnish Bhatt #include <net/addrconf.h>
30fc8d0590SAnish Bhatt 
319ba682f0Skxie@chelsio.com #include <linux/inetdevice.h>	/* ip_dev_find */
32acf3368fSPaul Gortmaker #include <linux/module.h>
339ba682f0Skxie@chelsio.com #include <net/tcp.h>
349ba682f0Skxie@chelsio.com 
359ba682f0Skxie@chelsio.com static unsigned int dbg_level;
369ba682f0Skxie@chelsio.com 
379ba682f0Skxie@chelsio.com #include "libcxgbi.h"
389ba682f0Skxie@chelsio.com 
399ba682f0Skxie@chelsio.com #define DRV_MODULE_NAME		"libcxgbi"
409ba682f0Skxie@chelsio.com #define DRV_MODULE_DESC		"Chelsio iSCSI driver library"
41*0ea5bf3dSKaren Xie #define DRV_MODULE_VERSION	"0.9.1-ko"
42*0ea5bf3dSKaren Xie #define DRV_MODULE_RELDATE	"Apr. 2015"
43*0ea5bf3dSKaren Xie 
44*0ea5bf3dSKaren Xie static char version[] =
45*0ea5bf3dSKaren Xie 	DRV_MODULE_DESC " " DRV_MODULE_NAME
46*0ea5bf3dSKaren Xie 	" v" DRV_MODULE_VERSION " (" DRV_MODULE_RELDATE ")\n";
479ba682f0Skxie@chelsio.com 
489ba682f0Skxie@chelsio.com MODULE_AUTHOR("Chelsio Communications, Inc.");
499ba682f0Skxie@chelsio.com MODULE_DESCRIPTION(DRV_MODULE_DESC);
509ba682f0Skxie@chelsio.com MODULE_VERSION(DRV_MODULE_VERSION);
519ba682f0Skxie@chelsio.com MODULE_LICENSE("GPL");
529ba682f0Skxie@chelsio.com 
539ba682f0Skxie@chelsio.com module_param(dbg_level, uint, 0644);
549ba682f0Skxie@chelsio.com MODULE_PARM_DESC(dbg_level, "libiscsi debug level (default=0)");
559ba682f0Skxie@chelsio.com 
569ba682f0Skxie@chelsio.com 
579ba682f0Skxie@chelsio.com /*
589ba682f0Skxie@chelsio.com  * cxgbi device management
599ba682f0Skxie@chelsio.com  * maintains a list of the cxgbi devices
609ba682f0Skxie@chelsio.com  */
619ba682f0Skxie@chelsio.com static LIST_HEAD(cdev_list);
629ba682f0Skxie@chelsio.com static DEFINE_MUTEX(cdev_mutex);
639ba682f0Skxie@chelsio.com 
64576b5863SAnish Bhatt static LIST_HEAD(cdev_rcu_list);
65576b5863SAnish Bhatt static DEFINE_SPINLOCK(cdev_rcu_lock);
66576b5863SAnish Bhatt 
679ba682f0Skxie@chelsio.com int cxgbi_device_portmap_create(struct cxgbi_device *cdev, unsigned int base,
689ba682f0Skxie@chelsio.com 				unsigned int max_conn)
699ba682f0Skxie@chelsio.com {
709ba682f0Skxie@chelsio.com 	struct cxgbi_ports_map *pmap = &cdev->pmap;
719ba682f0Skxie@chelsio.com 
729ba682f0Skxie@chelsio.com 	pmap->port_csk = cxgbi_alloc_big_mem(max_conn *
739ba682f0Skxie@chelsio.com 					     sizeof(struct cxgbi_sock *),
749ba682f0Skxie@chelsio.com 					     GFP_KERNEL);
759ba682f0Skxie@chelsio.com 	if (!pmap->port_csk) {
769ba682f0Skxie@chelsio.com 		pr_warn("cdev 0x%p, portmap OOM %u.\n", cdev, max_conn);
779ba682f0Skxie@chelsio.com 		return -ENOMEM;
789ba682f0Skxie@chelsio.com 	}
799ba682f0Skxie@chelsio.com 
809ba682f0Skxie@chelsio.com 	pmap->max_connect = max_conn;
819ba682f0Skxie@chelsio.com 	pmap->sport_base = base;
829ba682f0Skxie@chelsio.com 	spin_lock_init(&pmap->lock);
839ba682f0Skxie@chelsio.com 	return 0;
849ba682f0Skxie@chelsio.com }
859ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_device_portmap_create);
869ba682f0Skxie@chelsio.com 
879ba682f0Skxie@chelsio.com void cxgbi_device_portmap_cleanup(struct cxgbi_device *cdev)
889ba682f0Skxie@chelsio.com {
899ba682f0Skxie@chelsio.com 	struct cxgbi_ports_map *pmap = &cdev->pmap;
909ba682f0Skxie@chelsio.com 	struct cxgbi_sock *csk;
919ba682f0Skxie@chelsio.com 	int i;
929ba682f0Skxie@chelsio.com 
939ba682f0Skxie@chelsio.com 	for (i = 0; i < pmap->max_connect; i++) {
949ba682f0Skxie@chelsio.com 		if (pmap->port_csk[i]) {
959ba682f0Skxie@chelsio.com 			csk = pmap->port_csk[i];
969ba682f0Skxie@chelsio.com 			pmap->port_csk[i] = NULL;
979ba682f0Skxie@chelsio.com 			log_debug(1 << CXGBI_DBG_SOCK,
989ba682f0Skxie@chelsio.com 				"csk 0x%p, cdev 0x%p, offload down.\n",
999ba682f0Skxie@chelsio.com 				csk, cdev);
1009ba682f0Skxie@chelsio.com 			spin_lock_bh(&csk->lock);
1019ba682f0Skxie@chelsio.com 			cxgbi_sock_set_flag(csk, CTPF_OFFLOAD_DOWN);
1029ba682f0Skxie@chelsio.com 			cxgbi_sock_closed(csk);
1039ba682f0Skxie@chelsio.com 			spin_unlock_bh(&csk->lock);
1049ba682f0Skxie@chelsio.com 			cxgbi_sock_put(csk);
1059ba682f0Skxie@chelsio.com 		}
1069ba682f0Skxie@chelsio.com 	}
1079ba682f0Skxie@chelsio.com }
1089ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_device_portmap_cleanup);
1099ba682f0Skxie@chelsio.com 
1109ba682f0Skxie@chelsio.com static inline void cxgbi_device_destroy(struct cxgbi_device *cdev)
1119ba682f0Skxie@chelsio.com {
1129ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DEV,
1139ba682f0Skxie@chelsio.com 		"cdev 0x%p, p# %u.\n", cdev, cdev->nports);
1149ba682f0Skxie@chelsio.com 	cxgbi_hbas_remove(cdev);
1159ba682f0Skxie@chelsio.com 	cxgbi_device_portmap_cleanup(cdev);
1169ba682f0Skxie@chelsio.com 	if (cdev->dev_ddp_cleanup)
1179ba682f0Skxie@chelsio.com 		cdev->dev_ddp_cleanup(cdev);
1189ba682f0Skxie@chelsio.com 	else
1199ba682f0Skxie@chelsio.com 		cxgbi_ddp_cleanup(cdev);
1209ba682f0Skxie@chelsio.com 	if (cdev->ddp)
1219ba682f0Skxie@chelsio.com 		cxgbi_ddp_cleanup(cdev);
1229ba682f0Skxie@chelsio.com 	if (cdev->pmap.max_connect)
1239ba682f0Skxie@chelsio.com 		cxgbi_free_big_mem(cdev->pmap.port_csk);
1249ba682f0Skxie@chelsio.com 	kfree(cdev);
1259ba682f0Skxie@chelsio.com }
1269ba682f0Skxie@chelsio.com 
1279ba682f0Skxie@chelsio.com struct cxgbi_device *cxgbi_device_register(unsigned int extra,
1289ba682f0Skxie@chelsio.com 					   unsigned int nports)
1299ba682f0Skxie@chelsio.com {
1309ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev;
1319ba682f0Skxie@chelsio.com 
1329ba682f0Skxie@chelsio.com 	cdev = kzalloc(sizeof(*cdev) + extra + nports *
1339ba682f0Skxie@chelsio.com 			(sizeof(struct cxgbi_hba *) +
1349ba682f0Skxie@chelsio.com 			 sizeof(struct net_device *)),
1359ba682f0Skxie@chelsio.com 			GFP_KERNEL);
1369ba682f0Skxie@chelsio.com 	if (!cdev) {
1379ba682f0Skxie@chelsio.com 		pr_warn("nport %d, OOM.\n", nports);
1389ba682f0Skxie@chelsio.com 		return NULL;
1399ba682f0Skxie@chelsio.com 	}
1409ba682f0Skxie@chelsio.com 	cdev->ports = (struct net_device **)(cdev + 1);
1419ba682f0Skxie@chelsio.com 	cdev->hbas = (struct cxgbi_hba **)(((char*)cdev->ports) + nports *
1429ba682f0Skxie@chelsio.com 						sizeof(struct net_device *));
1439ba682f0Skxie@chelsio.com 	if (extra)
1449ba682f0Skxie@chelsio.com 		cdev->dd_data = ((char *)cdev->hbas) +
1459ba682f0Skxie@chelsio.com 				nports * sizeof(struct cxgbi_hba *);
1469ba682f0Skxie@chelsio.com 	spin_lock_init(&cdev->pmap.lock);
1479ba682f0Skxie@chelsio.com 
1489ba682f0Skxie@chelsio.com 	mutex_lock(&cdev_mutex);
1499ba682f0Skxie@chelsio.com 	list_add_tail(&cdev->list_head, &cdev_list);
1509ba682f0Skxie@chelsio.com 	mutex_unlock(&cdev_mutex);
1519ba682f0Skxie@chelsio.com 
152576b5863SAnish Bhatt 	spin_lock(&cdev_rcu_lock);
153576b5863SAnish Bhatt 	list_add_tail_rcu(&cdev->rcu_node, &cdev_rcu_list);
154576b5863SAnish Bhatt 	spin_unlock(&cdev_rcu_lock);
155576b5863SAnish Bhatt 
1569ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DEV,
1579ba682f0Skxie@chelsio.com 		"cdev 0x%p, p# %u.\n", cdev, nports);
1589ba682f0Skxie@chelsio.com 	return cdev;
1599ba682f0Skxie@chelsio.com }
1609ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_device_register);
1619ba682f0Skxie@chelsio.com 
1629ba682f0Skxie@chelsio.com void cxgbi_device_unregister(struct cxgbi_device *cdev)
1639ba682f0Skxie@chelsio.com {
1649ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DEV,
1659ba682f0Skxie@chelsio.com 		"cdev 0x%p, p# %u,%s.\n",
1669ba682f0Skxie@chelsio.com 		cdev, cdev->nports, cdev->nports ? cdev->ports[0]->name : "");
167576b5863SAnish Bhatt 
1689ba682f0Skxie@chelsio.com 	mutex_lock(&cdev_mutex);
1699ba682f0Skxie@chelsio.com 	list_del(&cdev->list_head);
1709ba682f0Skxie@chelsio.com 	mutex_unlock(&cdev_mutex);
171576b5863SAnish Bhatt 
172576b5863SAnish Bhatt 	spin_lock(&cdev_rcu_lock);
173576b5863SAnish Bhatt 	list_del_rcu(&cdev->rcu_node);
174576b5863SAnish Bhatt 	spin_unlock(&cdev_rcu_lock);
175576b5863SAnish Bhatt 	synchronize_rcu();
176576b5863SAnish Bhatt 
1779ba682f0Skxie@chelsio.com 	cxgbi_device_destroy(cdev);
1789ba682f0Skxie@chelsio.com }
1799ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_device_unregister);
1809ba682f0Skxie@chelsio.com 
1819ba682f0Skxie@chelsio.com void cxgbi_device_unregister_all(unsigned int flag)
1829ba682f0Skxie@chelsio.com {
1839ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev, *tmp;
1849ba682f0Skxie@chelsio.com 
1859ba682f0Skxie@chelsio.com 	mutex_lock(&cdev_mutex);
1869ba682f0Skxie@chelsio.com 	list_for_each_entry_safe(cdev, tmp, &cdev_list, list_head) {
1879ba682f0Skxie@chelsio.com 		if ((cdev->flags & flag) == flag) {
188576b5863SAnish Bhatt 			mutex_unlock(&cdev_mutex);
189576b5863SAnish Bhatt 			cxgbi_device_unregister(cdev);
190576b5863SAnish Bhatt 			mutex_lock(&cdev_mutex);
1919ba682f0Skxie@chelsio.com 		}
1929ba682f0Skxie@chelsio.com 	}
1939ba682f0Skxie@chelsio.com 	mutex_unlock(&cdev_mutex);
1949ba682f0Skxie@chelsio.com }
1959ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_device_unregister_all);
1969ba682f0Skxie@chelsio.com 
1979ba682f0Skxie@chelsio.com struct cxgbi_device *cxgbi_device_find_by_lldev(void *lldev)
1989ba682f0Skxie@chelsio.com {
1999ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev, *tmp;
2009ba682f0Skxie@chelsio.com 
2019ba682f0Skxie@chelsio.com 	mutex_lock(&cdev_mutex);
2029ba682f0Skxie@chelsio.com 	list_for_each_entry_safe(cdev, tmp, &cdev_list, list_head) {
2039ba682f0Skxie@chelsio.com 		if (cdev->lldev == lldev) {
2049ba682f0Skxie@chelsio.com 			mutex_unlock(&cdev_mutex);
2059ba682f0Skxie@chelsio.com 			return cdev;
2069ba682f0Skxie@chelsio.com 		}
2079ba682f0Skxie@chelsio.com 	}
2089ba682f0Skxie@chelsio.com 	mutex_unlock(&cdev_mutex);
209576b5863SAnish Bhatt 
2109ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DEV,
2119ba682f0Skxie@chelsio.com 		"lldev 0x%p, NO match found.\n", lldev);
2129ba682f0Skxie@chelsio.com 	return NULL;
2139ba682f0Skxie@chelsio.com }
2149ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_device_find_by_lldev);
2159ba682f0Skxie@chelsio.com 
216fc8d0590SAnish Bhatt struct cxgbi_device *cxgbi_device_find_by_netdev(struct net_device *ndev,
2179ba682f0Skxie@chelsio.com 						 int *port)
2189ba682f0Skxie@chelsio.com {
2190b3d8947Skxie@chelsio.com 	struct net_device *vdev = NULL;
2209ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev, *tmp;
2219ba682f0Skxie@chelsio.com 	int i;
2229ba682f0Skxie@chelsio.com 
2230b3d8947Skxie@chelsio.com 	if (ndev->priv_flags & IFF_802_1Q_VLAN) {
2240b3d8947Skxie@chelsio.com 		vdev = ndev;
2259ba682f0Skxie@chelsio.com 		ndev = vlan_dev_real_dev(ndev);
2260b3d8947Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_DEV,
2270b3d8947Skxie@chelsio.com 			"vlan dev %s -> %s.\n", vdev->name, ndev->name);
2280b3d8947Skxie@chelsio.com 	}
2299ba682f0Skxie@chelsio.com 
2309ba682f0Skxie@chelsio.com 	mutex_lock(&cdev_mutex);
2319ba682f0Skxie@chelsio.com 	list_for_each_entry_safe(cdev, tmp, &cdev_list, list_head) {
2329ba682f0Skxie@chelsio.com 		for (i = 0; i < cdev->nports; i++) {
2339ba682f0Skxie@chelsio.com 			if (ndev == cdev->ports[i]) {
2340b3d8947Skxie@chelsio.com 				cdev->hbas[i]->vdev = vdev;
2359ba682f0Skxie@chelsio.com 				mutex_unlock(&cdev_mutex);
2369ba682f0Skxie@chelsio.com 				if (port)
2379ba682f0Skxie@chelsio.com 					*port = i;
2389ba682f0Skxie@chelsio.com 				return cdev;
2399ba682f0Skxie@chelsio.com 			}
2409ba682f0Skxie@chelsio.com 		}
2419ba682f0Skxie@chelsio.com 	}
2429ba682f0Skxie@chelsio.com 	mutex_unlock(&cdev_mutex);
2439ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DEV,
2449ba682f0Skxie@chelsio.com 		"ndev 0x%p, %s, NO match found.\n", ndev, ndev->name);
2459ba682f0Skxie@chelsio.com 	return NULL;
2469ba682f0Skxie@chelsio.com }
247fc8d0590SAnish Bhatt EXPORT_SYMBOL_GPL(cxgbi_device_find_by_netdev);
248fc8d0590SAnish Bhatt 
249576b5863SAnish Bhatt struct cxgbi_device *cxgbi_device_find_by_netdev_rcu(struct net_device *ndev,
250576b5863SAnish Bhatt 						     int *port)
251576b5863SAnish Bhatt {
252576b5863SAnish Bhatt 	struct net_device *vdev = NULL;
253576b5863SAnish Bhatt 	struct cxgbi_device *cdev;
254576b5863SAnish Bhatt 	int i;
255576b5863SAnish Bhatt 
256576b5863SAnish Bhatt 	if (ndev->priv_flags & IFF_802_1Q_VLAN) {
257576b5863SAnish Bhatt 		vdev = ndev;
258576b5863SAnish Bhatt 		ndev = vlan_dev_real_dev(ndev);
259576b5863SAnish Bhatt 		pr_info("vlan dev %s -> %s.\n", vdev->name, ndev->name);
260576b5863SAnish Bhatt 	}
261576b5863SAnish Bhatt 
262576b5863SAnish Bhatt 	rcu_read_lock();
263576b5863SAnish Bhatt 	list_for_each_entry_rcu(cdev, &cdev_rcu_list, rcu_node) {
264576b5863SAnish Bhatt 		for (i = 0; i < cdev->nports; i++) {
265576b5863SAnish Bhatt 			if (ndev == cdev->ports[i]) {
266576b5863SAnish Bhatt 				cdev->hbas[i]->vdev = vdev;
267576b5863SAnish Bhatt 				rcu_read_unlock();
268576b5863SAnish Bhatt 				if (port)
269576b5863SAnish Bhatt 					*port = i;
270576b5863SAnish Bhatt 				return cdev;
271576b5863SAnish Bhatt 			}
272576b5863SAnish Bhatt 		}
273576b5863SAnish Bhatt 	}
274576b5863SAnish Bhatt 	rcu_read_unlock();
275576b5863SAnish Bhatt 
276576b5863SAnish Bhatt 	log_debug(1 << CXGBI_DBG_DEV,
277576b5863SAnish Bhatt 		  "ndev 0x%p, %s, NO match found.\n", ndev, ndev->name);
278576b5863SAnish Bhatt 	return NULL;
279576b5863SAnish Bhatt }
280576b5863SAnish Bhatt EXPORT_SYMBOL_GPL(cxgbi_device_find_by_netdev_rcu);
281576b5863SAnish Bhatt 
282f42bb57cSAnish Bhatt #if IS_ENABLED(CONFIG_IPV6)
283fc8d0590SAnish Bhatt static struct cxgbi_device *cxgbi_device_find_by_mac(struct net_device *ndev,
284fc8d0590SAnish Bhatt 						     int *port)
285fc8d0590SAnish Bhatt {
286fc8d0590SAnish Bhatt 	struct net_device *vdev = NULL;
287fc8d0590SAnish Bhatt 	struct cxgbi_device *cdev, *tmp;
288fc8d0590SAnish Bhatt 	int i;
289fc8d0590SAnish Bhatt 
290fc8d0590SAnish Bhatt 	if (ndev->priv_flags & IFF_802_1Q_VLAN) {
291fc8d0590SAnish Bhatt 		vdev = ndev;
292fc8d0590SAnish Bhatt 		ndev = vlan_dev_real_dev(ndev);
293fc8d0590SAnish Bhatt 		pr_info("vlan dev %s -> %s.\n", vdev->name, ndev->name);
294fc8d0590SAnish Bhatt 	}
295fc8d0590SAnish Bhatt 
296fc8d0590SAnish Bhatt 	mutex_lock(&cdev_mutex);
297fc8d0590SAnish Bhatt 	list_for_each_entry_safe(cdev, tmp, &cdev_list, list_head) {
298fc8d0590SAnish Bhatt 		for (i = 0; i < cdev->nports; i++) {
299fc8d0590SAnish Bhatt 			if (!memcmp(ndev->dev_addr, cdev->ports[i]->dev_addr,
300fc8d0590SAnish Bhatt 				    MAX_ADDR_LEN)) {
301fc8d0590SAnish Bhatt 				cdev->hbas[i]->vdev = vdev;
302fc8d0590SAnish Bhatt 				mutex_unlock(&cdev_mutex);
303fc8d0590SAnish Bhatt 				if (port)
304fc8d0590SAnish Bhatt 					*port = i;
305fc8d0590SAnish Bhatt 				return cdev;
306fc8d0590SAnish Bhatt 			}
307fc8d0590SAnish Bhatt 		}
308fc8d0590SAnish Bhatt 	}
309fc8d0590SAnish Bhatt 	mutex_unlock(&cdev_mutex);
310fc8d0590SAnish Bhatt 	log_debug(1 << CXGBI_DBG_DEV,
311fc8d0590SAnish Bhatt 		  "ndev 0x%p, %s, NO match mac found.\n",
312fc8d0590SAnish Bhatt 		  ndev, ndev->name);
313fc8d0590SAnish Bhatt 	return NULL;
314fc8d0590SAnish Bhatt }
315f42bb57cSAnish Bhatt #endif
3169ba682f0Skxie@chelsio.com 
3179ba682f0Skxie@chelsio.com void cxgbi_hbas_remove(struct cxgbi_device *cdev)
3189ba682f0Skxie@chelsio.com {
3199ba682f0Skxie@chelsio.com 	int i;
3209ba682f0Skxie@chelsio.com 	struct cxgbi_hba *chba;
3219ba682f0Skxie@chelsio.com 
3229ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DEV,
3239ba682f0Skxie@chelsio.com 		"cdev 0x%p, p#%u.\n", cdev, cdev->nports);
3249ba682f0Skxie@chelsio.com 
3259ba682f0Skxie@chelsio.com 	for (i = 0; i < cdev->nports; i++) {
3269ba682f0Skxie@chelsio.com 		chba = cdev->hbas[i];
3279ba682f0Skxie@chelsio.com 		if (chba) {
3289ba682f0Skxie@chelsio.com 			cdev->hbas[i] = NULL;
3299ba682f0Skxie@chelsio.com 			iscsi_host_remove(chba->shost);
3309ba682f0Skxie@chelsio.com 			pci_dev_put(cdev->pdev);
3319ba682f0Skxie@chelsio.com 			iscsi_host_free(chba->shost);
3329ba682f0Skxie@chelsio.com 		}
3339ba682f0Skxie@chelsio.com 	}
3349ba682f0Skxie@chelsio.com }
3359ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_hbas_remove);
3369ba682f0Skxie@chelsio.com 
3371abf635dSHannes Reinecke int cxgbi_hbas_add(struct cxgbi_device *cdev, u64 max_lun,
3389ba682f0Skxie@chelsio.com 		unsigned int max_id, struct scsi_host_template *sht,
3399ba682f0Skxie@chelsio.com 		struct scsi_transport_template *stt)
3409ba682f0Skxie@chelsio.com {
3419ba682f0Skxie@chelsio.com 	struct cxgbi_hba *chba;
3429ba682f0Skxie@chelsio.com 	struct Scsi_Host *shost;
3439ba682f0Skxie@chelsio.com 	int i, err;
3449ba682f0Skxie@chelsio.com 
3459ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DEV, "cdev 0x%p, p#%u.\n", cdev, cdev->nports);
3469ba682f0Skxie@chelsio.com 
3479ba682f0Skxie@chelsio.com 	for (i = 0; i < cdev->nports; i++) {
3489ba682f0Skxie@chelsio.com 		shost = iscsi_host_alloc(sht, sizeof(*chba), 1);
3499ba682f0Skxie@chelsio.com 		if (!shost) {
3509ba682f0Skxie@chelsio.com 			pr_info("0x%p, p%d, %s, host alloc failed.\n",
3519ba682f0Skxie@chelsio.com 				cdev, i, cdev->ports[i]->name);
3529ba682f0Skxie@chelsio.com 			err = -ENOMEM;
3539ba682f0Skxie@chelsio.com 			goto err_out;
3549ba682f0Skxie@chelsio.com 		}
3559ba682f0Skxie@chelsio.com 
3569ba682f0Skxie@chelsio.com 		shost->transportt = stt;
3579ba682f0Skxie@chelsio.com 		shost->max_lun = max_lun;
3589ba682f0Skxie@chelsio.com 		shost->max_id = max_id;
3599ba682f0Skxie@chelsio.com 		shost->max_channel = 0;
3609ba682f0Skxie@chelsio.com 		shost->max_cmd_len = 16;
3619ba682f0Skxie@chelsio.com 
3629ba682f0Skxie@chelsio.com 		chba = iscsi_host_priv(shost);
3639ba682f0Skxie@chelsio.com 		chba->cdev = cdev;
3649ba682f0Skxie@chelsio.com 		chba->ndev = cdev->ports[i];
3659ba682f0Skxie@chelsio.com 		chba->shost = shost;
3669ba682f0Skxie@chelsio.com 
3679ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_DEV,
3689ba682f0Skxie@chelsio.com 			"cdev 0x%p, p#%d %s: chba 0x%p.\n",
3699ba682f0Skxie@chelsio.com 			cdev, i, cdev->ports[i]->name, chba);
3709ba682f0Skxie@chelsio.com 
3719ba682f0Skxie@chelsio.com 		pci_dev_get(cdev->pdev);
3729ba682f0Skxie@chelsio.com 		err = iscsi_host_add(shost, &cdev->pdev->dev);
3739ba682f0Skxie@chelsio.com 		if (err) {
3749ba682f0Skxie@chelsio.com 			pr_info("cdev 0x%p, p#%d %s, host add failed.\n",
3759ba682f0Skxie@chelsio.com 				cdev, i, cdev->ports[i]->name);
3769ba682f0Skxie@chelsio.com 			pci_dev_put(cdev->pdev);
3779ba682f0Skxie@chelsio.com 			scsi_host_put(shost);
3789ba682f0Skxie@chelsio.com 			goto  err_out;
3799ba682f0Skxie@chelsio.com 		}
3809ba682f0Skxie@chelsio.com 
3819ba682f0Skxie@chelsio.com 		cdev->hbas[i] = chba;
3829ba682f0Skxie@chelsio.com 	}
3839ba682f0Skxie@chelsio.com 
3849ba682f0Skxie@chelsio.com 	return 0;
3859ba682f0Skxie@chelsio.com 
3869ba682f0Skxie@chelsio.com err_out:
3879ba682f0Skxie@chelsio.com 	cxgbi_hbas_remove(cdev);
3889ba682f0Skxie@chelsio.com 	return err;
3899ba682f0Skxie@chelsio.com }
3909ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_hbas_add);
3919ba682f0Skxie@chelsio.com 
3929ba682f0Skxie@chelsio.com /*
3939ba682f0Skxie@chelsio.com  * iSCSI offload
3949ba682f0Skxie@chelsio.com  *
3959ba682f0Skxie@chelsio.com  * - source port management
3969ba682f0Skxie@chelsio.com  *   To find a free source port in the port allocation map we use a very simple
3979ba682f0Skxie@chelsio.com  *   rotor scheme to look for the next free port.
3989ba682f0Skxie@chelsio.com  *
3999ba682f0Skxie@chelsio.com  *   If a source port has been specified make sure that it doesn't collide with
4009ba682f0Skxie@chelsio.com  *   our normal source port allocation map.  If it's outside the range of our
4019ba682f0Skxie@chelsio.com  *   allocation/deallocation scheme just let them use it.
4029ba682f0Skxie@chelsio.com  *
4039ba682f0Skxie@chelsio.com  *   If the source port is outside our allocation range, the caller is
4049ba682f0Skxie@chelsio.com  *   responsible for keeping track of their port usage.
4059ba682f0Skxie@chelsio.com  */
406dd9ad67eSAnish Bhatt 
407dd9ad67eSAnish Bhatt static struct cxgbi_sock *find_sock_on_port(struct cxgbi_device *cdev,
408dd9ad67eSAnish Bhatt 					    unsigned char port_id)
409dd9ad67eSAnish Bhatt {
410dd9ad67eSAnish Bhatt 	struct cxgbi_ports_map *pmap = &cdev->pmap;
411dd9ad67eSAnish Bhatt 	unsigned int i;
412dd9ad67eSAnish Bhatt 	unsigned int used;
413dd9ad67eSAnish Bhatt 
414dd9ad67eSAnish Bhatt 	if (!pmap->max_connect || !pmap->used)
415dd9ad67eSAnish Bhatt 		return NULL;
416dd9ad67eSAnish Bhatt 
417dd9ad67eSAnish Bhatt 	spin_lock_bh(&pmap->lock);
418dd9ad67eSAnish Bhatt 	used = pmap->used;
419dd9ad67eSAnish Bhatt 	for (i = 0; used && i < pmap->max_connect; i++) {
420dd9ad67eSAnish Bhatt 		struct cxgbi_sock *csk = pmap->port_csk[i];
421dd9ad67eSAnish Bhatt 
422dd9ad67eSAnish Bhatt 		if (csk) {
423dd9ad67eSAnish Bhatt 			if (csk->port_id == port_id) {
424dd9ad67eSAnish Bhatt 				spin_unlock_bh(&pmap->lock);
425dd9ad67eSAnish Bhatt 				return csk;
426dd9ad67eSAnish Bhatt 			}
427dd9ad67eSAnish Bhatt 			used--;
428dd9ad67eSAnish Bhatt 		}
429dd9ad67eSAnish Bhatt 	}
430dd9ad67eSAnish Bhatt 	spin_unlock_bh(&pmap->lock);
431dd9ad67eSAnish Bhatt 
432dd9ad67eSAnish Bhatt 	return NULL;
433dd9ad67eSAnish Bhatt }
434dd9ad67eSAnish Bhatt 
4359ba682f0Skxie@chelsio.com static int sock_get_port(struct cxgbi_sock *csk)
4369ba682f0Skxie@chelsio.com {
4379ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev = csk->cdev;
4389ba682f0Skxie@chelsio.com 	struct cxgbi_ports_map *pmap = &cdev->pmap;
4399ba682f0Skxie@chelsio.com 	unsigned int start;
4409ba682f0Skxie@chelsio.com 	int idx;
441fc8d0590SAnish Bhatt 	__be16 *port;
4429ba682f0Skxie@chelsio.com 
4439ba682f0Skxie@chelsio.com 	if (!pmap->max_connect) {
4449ba682f0Skxie@chelsio.com 		pr_err("cdev 0x%p, p#%u %s, NO port map.\n",
4459ba682f0Skxie@chelsio.com 			   cdev, csk->port_id, cdev->ports[csk->port_id]->name);
4469ba682f0Skxie@chelsio.com 		return -EADDRNOTAVAIL;
4479ba682f0Skxie@chelsio.com 	}
4489ba682f0Skxie@chelsio.com 
449fc8d0590SAnish Bhatt 	if (csk->csk_family == AF_INET)
450fc8d0590SAnish Bhatt 		port = &csk->saddr.sin_port;
451fc8d0590SAnish Bhatt 	else /* ipv6 */
452fc8d0590SAnish Bhatt 		port = &csk->saddr6.sin6_port;
453fc8d0590SAnish Bhatt 
454fc8d0590SAnish Bhatt 	if (*port) {
4559ba682f0Skxie@chelsio.com 		pr_err("source port NON-ZERO %u.\n",
456fc8d0590SAnish Bhatt 			ntohs(*port));
4579ba682f0Skxie@chelsio.com 		return -EADDRINUSE;
4589ba682f0Skxie@chelsio.com 	}
4599ba682f0Skxie@chelsio.com 
4609ba682f0Skxie@chelsio.com 	spin_lock_bh(&pmap->lock);
4619ba682f0Skxie@chelsio.com 	if (pmap->used >= pmap->max_connect) {
4629ba682f0Skxie@chelsio.com 		spin_unlock_bh(&pmap->lock);
4639ba682f0Skxie@chelsio.com 		pr_info("cdev 0x%p, p#%u %s, ALL ports used.\n",
4649ba682f0Skxie@chelsio.com 			cdev, csk->port_id, cdev->ports[csk->port_id]->name);
4659ba682f0Skxie@chelsio.com 		return -EADDRNOTAVAIL;
4669ba682f0Skxie@chelsio.com 	}
4679ba682f0Skxie@chelsio.com 
4689ba682f0Skxie@chelsio.com 	start = idx = pmap->next;
4699ba682f0Skxie@chelsio.com 	do {
4709ba682f0Skxie@chelsio.com 		if (++idx >= pmap->max_connect)
4719ba682f0Skxie@chelsio.com 			idx = 0;
4729ba682f0Skxie@chelsio.com 		if (!pmap->port_csk[idx]) {
4739ba682f0Skxie@chelsio.com 			pmap->used++;
474fc8d0590SAnish Bhatt 			*port = htons(pmap->sport_base + idx);
4759ba682f0Skxie@chelsio.com 			pmap->next = idx;
4769ba682f0Skxie@chelsio.com 			pmap->port_csk[idx] = csk;
4779ba682f0Skxie@chelsio.com 			spin_unlock_bh(&pmap->lock);
4789ba682f0Skxie@chelsio.com 			cxgbi_sock_get(csk);
4799ba682f0Skxie@chelsio.com 			log_debug(1 << CXGBI_DBG_SOCK,
4809ba682f0Skxie@chelsio.com 				"cdev 0x%p, p#%u %s, p %u, %u.\n",
4819ba682f0Skxie@chelsio.com 				cdev, csk->port_id,
4829ba682f0Skxie@chelsio.com 				cdev->ports[csk->port_id]->name,
4839ba682f0Skxie@chelsio.com 				pmap->sport_base + idx, pmap->next);
4849ba682f0Skxie@chelsio.com 			return 0;
4859ba682f0Skxie@chelsio.com 		}
4869ba682f0Skxie@chelsio.com 	} while (idx != start);
4879ba682f0Skxie@chelsio.com 	spin_unlock_bh(&pmap->lock);
4889ba682f0Skxie@chelsio.com 
4899ba682f0Skxie@chelsio.com 	/* should not happen */
4909ba682f0Skxie@chelsio.com 	pr_warn("cdev 0x%p, p#%u %s, next %u?\n",
4919ba682f0Skxie@chelsio.com 		cdev, csk->port_id, cdev->ports[csk->port_id]->name,
4929ba682f0Skxie@chelsio.com 		pmap->next);
4939ba682f0Skxie@chelsio.com 	return -EADDRNOTAVAIL;
4949ba682f0Skxie@chelsio.com }
4959ba682f0Skxie@chelsio.com 
4969ba682f0Skxie@chelsio.com static void sock_put_port(struct cxgbi_sock *csk)
4979ba682f0Skxie@chelsio.com {
4989ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev = csk->cdev;
4999ba682f0Skxie@chelsio.com 	struct cxgbi_ports_map *pmap = &cdev->pmap;
500fc8d0590SAnish Bhatt 	__be16 *port;
5019ba682f0Skxie@chelsio.com 
502fc8d0590SAnish Bhatt 	if (csk->csk_family == AF_INET)
503fc8d0590SAnish Bhatt 		port = &csk->saddr.sin_port;
504fc8d0590SAnish Bhatt 	else /* ipv6 */
505fc8d0590SAnish Bhatt 		port = &csk->saddr6.sin6_port;
5069ba682f0Skxie@chelsio.com 
507fc8d0590SAnish Bhatt 	if (*port) {
508fc8d0590SAnish Bhatt 		int idx = ntohs(*port) - pmap->sport_base;
509fc8d0590SAnish Bhatt 
510fc8d0590SAnish Bhatt 		*port = 0;
5119ba682f0Skxie@chelsio.com 		if (idx < 0 || idx >= pmap->max_connect) {
5129ba682f0Skxie@chelsio.com 			pr_err("cdev 0x%p, p#%u %s, port %u OOR.\n",
5139ba682f0Skxie@chelsio.com 				cdev, csk->port_id,
5149ba682f0Skxie@chelsio.com 				cdev->ports[csk->port_id]->name,
515fc8d0590SAnish Bhatt 				ntohs(*port));
5169ba682f0Skxie@chelsio.com 			return;
5179ba682f0Skxie@chelsio.com 		}
5189ba682f0Skxie@chelsio.com 
5199ba682f0Skxie@chelsio.com 		spin_lock_bh(&pmap->lock);
5209ba682f0Skxie@chelsio.com 		pmap->port_csk[idx] = NULL;
5219ba682f0Skxie@chelsio.com 		pmap->used--;
5229ba682f0Skxie@chelsio.com 		spin_unlock_bh(&pmap->lock);
5239ba682f0Skxie@chelsio.com 
5249ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_SOCK,
5259ba682f0Skxie@chelsio.com 			"cdev 0x%p, p#%u %s, release %u.\n",
5269ba682f0Skxie@chelsio.com 			cdev, csk->port_id, cdev->ports[csk->port_id]->name,
5279ba682f0Skxie@chelsio.com 			pmap->sport_base + idx);
5289ba682f0Skxie@chelsio.com 
5299ba682f0Skxie@chelsio.com 		cxgbi_sock_put(csk);
5309ba682f0Skxie@chelsio.com 	}
5319ba682f0Skxie@chelsio.com }
5329ba682f0Skxie@chelsio.com 
5339ba682f0Skxie@chelsio.com /*
5349ba682f0Skxie@chelsio.com  * iscsi tcp connection
5359ba682f0Skxie@chelsio.com  */
5369ba682f0Skxie@chelsio.com void cxgbi_sock_free_cpl_skbs(struct cxgbi_sock *csk)
5379ba682f0Skxie@chelsio.com {
5389ba682f0Skxie@chelsio.com 	if (csk->cpl_close) {
5399ba682f0Skxie@chelsio.com 		kfree_skb(csk->cpl_close);
5409ba682f0Skxie@chelsio.com 		csk->cpl_close = NULL;
5419ba682f0Skxie@chelsio.com 	}
5429ba682f0Skxie@chelsio.com 	if (csk->cpl_abort_req) {
5439ba682f0Skxie@chelsio.com 		kfree_skb(csk->cpl_abort_req);
5449ba682f0Skxie@chelsio.com 		csk->cpl_abort_req = NULL;
5459ba682f0Skxie@chelsio.com 	}
5469ba682f0Skxie@chelsio.com 	if (csk->cpl_abort_rpl) {
5479ba682f0Skxie@chelsio.com 		kfree_skb(csk->cpl_abort_rpl);
5489ba682f0Skxie@chelsio.com 		csk->cpl_abort_rpl = NULL;
5499ba682f0Skxie@chelsio.com 	}
5509ba682f0Skxie@chelsio.com }
5519ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_sock_free_cpl_skbs);
5529ba682f0Skxie@chelsio.com 
5539ba682f0Skxie@chelsio.com static struct cxgbi_sock *cxgbi_sock_create(struct cxgbi_device *cdev)
5549ba682f0Skxie@chelsio.com {
5559ba682f0Skxie@chelsio.com 	struct cxgbi_sock *csk = kzalloc(sizeof(*csk), GFP_NOIO);
5569ba682f0Skxie@chelsio.com 
5579ba682f0Skxie@chelsio.com 	if (!csk) {
5589ba682f0Skxie@chelsio.com 		pr_info("alloc csk %zu failed.\n", sizeof(*csk));
5599ba682f0Skxie@chelsio.com 		return NULL;
5609ba682f0Skxie@chelsio.com 	}
5619ba682f0Skxie@chelsio.com 
5629ba682f0Skxie@chelsio.com 	if (cdev->csk_alloc_cpls(csk) < 0) {
5639ba682f0Skxie@chelsio.com 		pr_info("csk 0x%p, alloc cpls failed.\n", csk);
5649ba682f0Skxie@chelsio.com 		kfree(csk);
5659ba682f0Skxie@chelsio.com 		return NULL;
5669ba682f0Skxie@chelsio.com 	}
5679ba682f0Skxie@chelsio.com 
5689ba682f0Skxie@chelsio.com 	spin_lock_init(&csk->lock);
5699ba682f0Skxie@chelsio.com 	kref_init(&csk->refcnt);
5709ba682f0Skxie@chelsio.com 	skb_queue_head_init(&csk->receive_queue);
5719ba682f0Skxie@chelsio.com 	skb_queue_head_init(&csk->write_queue);
5729ba682f0Skxie@chelsio.com 	setup_timer(&csk->retry_timer, NULL, (unsigned long)csk);
5739ba682f0Skxie@chelsio.com 	rwlock_init(&csk->callback_lock);
5749ba682f0Skxie@chelsio.com 	csk->cdev = cdev;
5759ba682f0Skxie@chelsio.com 	csk->flags = 0;
5769ba682f0Skxie@chelsio.com 	cxgbi_sock_set_state(csk, CTP_CLOSED);
5779ba682f0Skxie@chelsio.com 
5789ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_SOCK, "cdev 0x%p, new csk 0x%p.\n", cdev, csk);
5799ba682f0Skxie@chelsio.com 
5809ba682f0Skxie@chelsio.com 	return csk;
5819ba682f0Skxie@chelsio.com }
5829ba682f0Skxie@chelsio.com 
583f4bfd99fSDavid S. Miller static struct rtable *find_route_ipv4(struct flowi4 *fl4,
584f4bfd99fSDavid S. Miller 				      __be32 saddr, __be32 daddr,
5859ba682f0Skxie@chelsio.com 				      __be16 sport, __be16 dport, u8 tos)
5869ba682f0Skxie@chelsio.com {
5879ba682f0Skxie@chelsio.com 	struct rtable *rt;
5889ba682f0Skxie@chelsio.com 
589f4bfd99fSDavid S. Miller 	rt = ip_route_output_ports(&init_net, fl4, NULL, daddr, saddr,
59078fbfd8aSDavid S. Miller 				   dport, sport, IPPROTO_TCP, tos, 0);
591b23dd4feSDavid S. Miller 	if (IS_ERR(rt))
5929ba682f0Skxie@chelsio.com 		return NULL;
5939ba682f0Skxie@chelsio.com 
5949ba682f0Skxie@chelsio.com 	return rt;
5959ba682f0Skxie@chelsio.com }
5969ba682f0Skxie@chelsio.com 
5979ba682f0Skxie@chelsio.com static struct cxgbi_sock *cxgbi_check_route(struct sockaddr *dst_addr)
5989ba682f0Skxie@chelsio.com {
5999ba682f0Skxie@chelsio.com 	struct sockaddr_in *daddr = (struct sockaddr_in *)dst_addr;
6009ba682f0Skxie@chelsio.com 	struct dst_entry *dst;
6019ba682f0Skxie@chelsio.com 	struct net_device *ndev;
6029ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev;
6039ba682f0Skxie@chelsio.com 	struct rtable *rt = NULL;
604a58b61e5SDavid Miller 	struct neighbour *n;
605f4bfd99fSDavid S. Miller 	struct flowi4 fl4;
6069ba682f0Skxie@chelsio.com 	struct cxgbi_sock *csk = NULL;
6079ba682f0Skxie@chelsio.com 	unsigned int mtu = 0;
6089ba682f0Skxie@chelsio.com 	int port = 0xFFFF;
6099ba682f0Skxie@chelsio.com 	int err = 0;
6109ba682f0Skxie@chelsio.com 
611f4bfd99fSDavid S. Miller 	rt = find_route_ipv4(&fl4, 0, daddr->sin_addr.s_addr, 0, daddr->sin_port, 0);
6129ba682f0Skxie@chelsio.com 	if (!rt) {
6139ba682f0Skxie@chelsio.com 		pr_info("no route to ipv4 0x%x, port %u.\n",
614fc8d0590SAnish Bhatt 			be32_to_cpu(daddr->sin_addr.s_addr),
615fc8d0590SAnish Bhatt 			be16_to_cpu(daddr->sin_port));
6169ba682f0Skxie@chelsio.com 		err = -ENETUNREACH;
6179ba682f0Skxie@chelsio.com 		goto err_out;
6189ba682f0Skxie@chelsio.com 	}
6199ba682f0Skxie@chelsio.com 	dst = &rt->dst;
6200b399d46SDavid S. Miller 	n = dst_neigh_lookup(dst, &daddr->sin_addr.s_addr);
621a58b61e5SDavid Miller 	if (!n) {
622a58b61e5SDavid Miller 		err = -ENODEV;
623a58b61e5SDavid Miller 		goto rel_rt;
624a58b61e5SDavid Miller 	}
625a58b61e5SDavid Miller 	ndev = n->dev;
6269ba682f0Skxie@chelsio.com 
6279ba682f0Skxie@chelsio.com 	if (rt->rt_flags & (RTCF_MULTICAST | RTCF_BROADCAST)) {
6289ba682f0Skxie@chelsio.com 		pr_info("multi-cast route %pI4, port %u, dev %s.\n",
6299ba682f0Skxie@chelsio.com 			&daddr->sin_addr.s_addr, ntohs(daddr->sin_port),
6309ba682f0Skxie@chelsio.com 			ndev->name);
6319ba682f0Skxie@chelsio.com 		err = -ENETUNREACH;
6320b399d46SDavid S. Miller 		goto rel_neigh;
6339ba682f0Skxie@chelsio.com 	}
6349ba682f0Skxie@chelsio.com 
6359ba682f0Skxie@chelsio.com 	if (ndev->flags & IFF_LOOPBACK) {
6369ba682f0Skxie@chelsio.com 		ndev = ip_dev_find(&init_net, daddr->sin_addr.s_addr);
6379ba682f0Skxie@chelsio.com 		mtu = ndev->mtu;
6389ba682f0Skxie@chelsio.com 		pr_info("rt dev %s, loopback -> %s, mtu %u.\n",
639a58b61e5SDavid Miller 			n->dev->name, ndev->name, mtu);
6409ba682f0Skxie@chelsio.com 	}
6419ba682f0Skxie@chelsio.com 
6429ba682f0Skxie@chelsio.com 	cdev = cxgbi_device_find_by_netdev(ndev, &port);
6439ba682f0Skxie@chelsio.com 	if (!cdev) {
6449ba682f0Skxie@chelsio.com 		pr_info("dst %pI4, %s, NOT cxgbi device.\n",
6459ba682f0Skxie@chelsio.com 			&daddr->sin_addr.s_addr, ndev->name);
6469ba682f0Skxie@chelsio.com 		err = -ENETUNREACH;
6470b399d46SDavid S. Miller 		goto rel_neigh;
6489ba682f0Skxie@chelsio.com 	}
6499ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_SOCK,
6509ba682f0Skxie@chelsio.com 		"route to %pI4 :%u, ndev p#%d,%s, cdev 0x%p.\n",
6519ba682f0Skxie@chelsio.com 		&daddr->sin_addr.s_addr, ntohs(daddr->sin_port),
6529ba682f0Skxie@chelsio.com 			   port, ndev->name, cdev);
6539ba682f0Skxie@chelsio.com 
6549ba682f0Skxie@chelsio.com 	csk = cxgbi_sock_create(cdev);
6559ba682f0Skxie@chelsio.com 	if (!csk) {
6569ba682f0Skxie@chelsio.com 		err = -ENOMEM;
6570b399d46SDavid S. Miller 		goto rel_neigh;
6589ba682f0Skxie@chelsio.com 	}
6599ba682f0Skxie@chelsio.com 	csk->cdev = cdev;
6609ba682f0Skxie@chelsio.com 	csk->port_id = port;
6619ba682f0Skxie@chelsio.com 	csk->mtu = mtu;
6629ba682f0Skxie@chelsio.com 	csk->dst = dst;
663fc8d0590SAnish Bhatt 
664fc8d0590SAnish Bhatt 	csk->csk_family = AF_INET;
6659ba682f0Skxie@chelsio.com 	csk->daddr.sin_addr.s_addr = daddr->sin_addr.s_addr;
6669ba682f0Skxie@chelsio.com 	csk->daddr.sin_port = daddr->sin_port;
667c71b9b66SMike Christie 	csk->daddr.sin_family = daddr->sin_family;
668fc8d0590SAnish Bhatt 	csk->saddr.sin_family = daddr->sin_family;
669f4bfd99fSDavid S. Miller 	csk->saddr.sin_addr.s_addr = fl4.saddr;
6700b399d46SDavid S. Miller 	neigh_release(n);
6719ba682f0Skxie@chelsio.com 
6729ba682f0Skxie@chelsio.com 	return csk;
6739ba682f0Skxie@chelsio.com 
6740b399d46SDavid S. Miller rel_neigh:
6750b399d46SDavid S. Miller 	neigh_release(n);
6760b399d46SDavid S. Miller 
6779ba682f0Skxie@chelsio.com rel_rt:
6789ba682f0Skxie@chelsio.com 	ip_rt_put(rt);
6799ba682f0Skxie@chelsio.com 	if (csk)
6809ba682f0Skxie@chelsio.com 		cxgbi_sock_closed(csk);
6819ba682f0Skxie@chelsio.com err_out:
6829ba682f0Skxie@chelsio.com 	return ERR_PTR(err);
6839ba682f0Skxie@chelsio.com }
6849ba682f0Skxie@chelsio.com 
685e81fbf6cSAnish Bhatt #if IS_ENABLED(CONFIG_IPV6)
686fc8d0590SAnish Bhatt static struct rt6_info *find_route_ipv6(const struct in6_addr *saddr,
687fc8d0590SAnish Bhatt 					const struct in6_addr *daddr)
688fc8d0590SAnish Bhatt {
689fc8d0590SAnish Bhatt 	struct flowi6 fl;
690fc8d0590SAnish Bhatt 
691fc8d0590SAnish Bhatt 	if (saddr)
692fc8d0590SAnish Bhatt 		memcpy(&fl.saddr, saddr, sizeof(struct in6_addr));
693fc8d0590SAnish Bhatt 	if (daddr)
694fc8d0590SAnish Bhatt 		memcpy(&fl.daddr, daddr, sizeof(struct in6_addr));
695fc8d0590SAnish Bhatt 	return (struct rt6_info *)ip6_route_output(&init_net, NULL, &fl);
696fc8d0590SAnish Bhatt }
697fc8d0590SAnish Bhatt 
698fc8d0590SAnish Bhatt static struct cxgbi_sock *cxgbi_check_route6(struct sockaddr *dst_addr)
699fc8d0590SAnish Bhatt {
700fc8d0590SAnish Bhatt 	struct sockaddr_in6 *daddr6 = (struct sockaddr_in6 *)dst_addr;
701fc8d0590SAnish Bhatt 	struct dst_entry *dst;
702fc8d0590SAnish Bhatt 	struct net_device *ndev;
703fc8d0590SAnish Bhatt 	struct cxgbi_device *cdev;
704fc8d0590SAnish Bhatt 	struct rt6_info *rt = NULL;
705fc8d0590SAnish Bhatt 	struct neighbour *n;
706fc8d0590SAnish Bhatt 	struct in6_addr pref_saddr;
707fc8d0590SAnish Bhatt 	struct cxgbi_sock *csk = NULL;
708fc8d0590SAnish Bhatt 	unsigned int mtu = 0;
709fc8d0590SAnish Bhatt 	int port = 0xFFFF;
710fc8d0590SAnish Bhatt 	int err = 0;
711fc8d0590SAnish Bhatt 
712fc8d0590SAnish Bhatt 	rt = find_route_ipv6(NULL, &daddr6->sin6_addr);
713fc8d0590SAnish Bhatt 
714fc8d0590SAnish Bhatt 	if (!rt) {
715fc8d0590SAnish Bhatt 		pr_info("no route to ipv6 %pI6 port %u\n",
716fc8d0590SAnish Bhatt 			daddr6->sin6_addr.s6_addr,
717fc8d0590SAnish Bhatt 			be16_to_cpu(daddr6->sin6_port));
718fc8d0590SAnish Bhatt 		err = -ENETUNREACH;
719fc8d0590SAnish Bhatt 		goto err_out;
720fc8d0590SAnish Bhatt 	}
721fc8d0590SAnish Bhatt 
722fc8d0590SAnish Bhatt 	dst = &rt->dst;
723fc8d0590SAnish Bhatt 
724fc8d0590SAnish Bhatt 	n = dst_neigh_lookup(dst, &daddr6->sin6_addr);
725fc8d0590SAnish Bhatt 
726fc8d0590SAnish Bhatt 	if (!n) {
727fc8d0590SAnish Bhatt 		pr_info("%pI6, port %u, dst no neighbour.\n",
728fc8d0590SAnish Bhatt 			daddr6->sin6_addr.s6_addr,
729fc8d0590SAnish Bhatt 			be16_to_cpu(daddr6->sin6_port));
730fc8d0590SAnish Bhatt 		err = -ENETUNREACH;
731fc8d0590SAnish Bhatt 		goto rel_rt;
732fc8d0590SAnish Bhatt 	}
733fc8d0590SAnish Bhatt 	ndev = n->dev;
734fc8d0590SAnish Bhatt 
735fc8d0590SAnish Bhatt 	if (ipv6_addr_is_multicast(&rt->rt6i_dst.addr)) {
736fc8d0590SAnish Bhatt 		pr_info("multi-cast route %pI6 port %u, dev %s.\n",
737fc8d0590SAnish Bhatt 			daddr6->sin6_addr.s6_addr,
738fc8d0590SAnish Bhatt 			ntohs(daddr6->sin6_port), ndev->name);
739fc8d0590SAnish Bhatt 		err = -ENETUNREACH;
740fc8d0590SAnish Bhatt 		goto rel_rt;
741fc8d0590SAnish Bhatt 	}
742fc8d0590SAnish Bhatt 
743fc8d0590SAnish Bhatt 	cdev = cxgbi_device_find_by_netdev(ndev, &port);
744fc8d0590SAnish Bhatt 	if (!cdev)
745fc8d0590SAnish Bhatt 		cdev = cxgbi_device_find_by_mac(ndev, &port);
746fc8d0590SAnish Bhatt 	if (!cdev) {
747fc8d0590SAnish Bhatt 		pr_info("dst %pI6 %s, NOT cxgbi device.\n",
748fc8d0590SAnish Bhatt 			daddr6->sin6_addr.s6_addr, ndev->name);
749fc8d0590SAnish Bhatt 		err = -ENETUNREACH;
750fc8d0590SAnish Bhatt 		goto rel_rt;
751fc8d0590SAnish Bhatt 	}
752fc8d0590SAnish Bhatt 	log_debug(1 << CXGBI_DBG_SOCK,
753fc8d0590SAnish Bhatt 		  "route to %pI6 :%u, ndev p#%d,%s, cdev 0x%p.\n",
754fc8d0590SAnish Bhatt 		  daddr6->sin6_addr.s6_addr, ntohs(daddr6->sin6_port), port,
755fc8d0590SAnish Bhatt 		  ndev->name, cdev);
756fc8d0590SAnish Bhatt 
757fc8d0590SAnish Bhatt 	csk = cxgbi_sock_create(cdev);
758fc8d0590SAnish Bhatt 	if (!csk) {
759fc8d0590SAnish Bhatt 		err = -ENOMEM;
760fc8d0590SAnish Bhatt 		goto rel_rt;
761fc8d0590SAnish Bhatt 	}
762fc8d0590SAnish Bhatt 	csk->cdev = cdev;
763fc8d0590SAnish Bhatt 	csk->port_id = port;
764fc8d0590SAnish Bhatt 	csk->mtu = mtu;
765fc8d0590SAnish Bhatt 	csk->dst = dst;
766fc8d0590SAnish Bhatt 
767fc8d0590SAnish Bhatt 	if (ipv6_addr_any(&rt->rt6i_prefsrc.addr)) {
768fc8d0590SAnish Bhatt 		struct inet6_dev *idev = ip6_dst_idev((struct dst_entry *)rt);
769fc8d0590SAnish Bhatt 
770fc8d0590SAnish Bhatt 		err = ipv6_dev_get_saddr(&init_net, idev ? idev->dev : NULL,
771fc8d0590SAnish Bhatt 					 &daddr6->sin6_addr, 0, &pref_saddr);
772fc8d0590SAnish Bhatt 		if (err) {
773fc8d0590SAnish Bhatt 			pr_info("failed to get source address to reach %pI6\n",
774fc8d0590SAnish Bhatt 				&daddr6->sin6_addr);
775fc8d0590SAnish Bhatt 			goto rel_rt;
776fc8d0590SAnish Bhatt 		}
777fc8d0590SAnish Bhatt 	} else {
778fc8d0590SAnish Bhatt 		pref_saddr = rt->rt6i_prefsrc.addr;
779fc8d0590SAnish Bhatt 	}
780fc8d0590SAnish Bhatt 
781fc8d0590SAnish Bhatt 	csk->csk_family = AF_INET6;
782fc8d0590SAnish Bhatt 	csk->daddr6.sin6_addr = daddr6->sin6_addr;
783fc8d0590SAnish Bhatt 	csk->daddr6.sin6_port = daddr6->sin6_port;
784fc8d0590SAnish Bhatt 	csk->daddr6.sin6_family = daddr6->sin6_family;
785dd9ad67eSAnish Bhatt 	csk->saddr6.sin6_family = daddr6->sin6_family;
786fc8d0590SAnish Bhatt 	csk->saddr6.sin6_addr = pref_saddr;
787fc8d0590SAnish Bhatt 
788fc8d0590SAnish Bhatt 	neigh_release(n);
789fc8d0590SAnish Bhatt 	return csk;
790fc8d0590SAnish Bhatt 
791fc8d0590SAnish Bhatt rel_rt:
792fc8d0590SAnish Bhatt 	if (n)
793fc8d0590SAnish Bhatt 		neigh_release(n);
794fc8d0590SAnish Bhatt 
795fc8d0590SAnish Bhatt 	ip6_rt_put(rt);
796fc8d0590SAnish Bhatt 	if (csk)
797fc8d0590SAnish Bhatt 		cxgbi_sock_closed(csk);
798fc8d0590SAnish Bhatt err_out:
799fc8d0590SAnish Bhatt 	return ERR_PTR(err);
800fc8d0590SAnish Bhatt }
801e81fbf6cSAnish Bhatt #endif /* IS_ENABLED(CONFIG_IPV6) */
802fc8d0590SAnish Bhatt 
8039ba682f0Skxie@chelsio.com void cxgbi_sock_established(struct cxgbi_sock *csk, unsigned int snd_isn,
8049ba682f0Skxie@chelsio.com 			unsigned int opt)
8059ba682f0Skxie@chelsio.com {
8069ba682f0Skxie@chelsio.com 	csk->write_seq = csk->snd_nxt = csk->snd_una = snd_isn;
8079ba682f0Skxie@chelsio.com 	dst_confirm(csk->dst);
8089ba682f0Skxie@chelsio.com 	smp_mb();
8099ba682f0Skxie@chelsio.com 	cxgbi_sock_set_state(csk, CTP_ESTABLISHED);
8109ba682f0Skxie@chelsio.com }
8119ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_sock_established);
8129ba682f0Skxie@chelsio.com 
8139ba682f0Skxie@chelsio.com static void cxgbi_inform_iscsi_conn_closing(struct cxgbi_sock *csk)
8149ba682f0Skxie@chelsio.com {
8159ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_SOCK,
8169ba682f0Skxie@chelsio.com 		"csk 0x%p, state %u, flags 0x%lx, conn 0x%p.\n",
8179ba682f0Skxie@chelsio.com 		csk, csk->state, csk->flags, csk->user_data);
8189ba682f0Skxie@chelsio.com 
8199ba682f0Skxie@chelsio.com 	if (csk->state != CTP_ESTABLISHED) {
820e3d2ad8cSkxie@chelsio.com 		read_lock_bh(&csk->callback_lock);
8219ba682f0Skxie@chelsio.com 		if (csk->user_data)
8229ba682f0Skxie@chelsio.com 			iscsi_conn_failure(csk->user_data,
823ee7255adSAnish Bhatt 					ISCSI_ERR_TCP_CONN_CLOSE);
824e3d2ad8cSkxie@chelsio.com 		read_unlock_bh(&csk->callback_lock);
8259ba682f0Skxie@chelsio.com 	}
8269ba682f0Skxie@chelsio.com }
8279ba682f0Skxie@chelsio.com 
8289ba682f0Skxie@chelsio.com void cxgbi_sock_closed(struct cxgbi_sock *csk)
8299ba682f0Skxie@chelsio.com {
8309ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_SOCK, "csk 0x%p,%u,0x%lx,%u.\n",
8319ba682f0Skxie@chelsio.com 		csk, (csk)->state, (csk)->flags, (csk)->tid);
8329ba682f0Skxie@chelsio.com 	cxgbi_sock_set_flag(csk, CTPF_ACTIVE_CLOSE_NEEDED);
8339ba682f0Skxie@chelsio.com 	if (csk->state == CTP_ACTIVE_OPEN || csk->state == CTP_CLOSED)
8349ba682f0Skxie@chelsio.com 		return;
8359ba682f0Skxie@chelsio.com 	if (csk->saddr.sin_port)
8369ba682f0Skxie@chelsio.com 		sock_put_port(csk);
8379ba682f0Skxie@chelsio.com 	if (csk->dst)
8389ba682f0Skxie@chelsio.com 		dst_release(csk->dst);
8399ba682f0Skxie@chelsio.com 	csk->cdev->csk_release_offload_resources(csk);
8409ba682f0Skxie@chelsio.com 	cxgbi_sock_set_state(csk, CTP_CLOSED);
8419ba682f0Skxie@chelsio.com 	cxgbi_inform_iscsi_conn_closing(csk);
8429ba682f0Skxie@chelsio.com 	cxgbi_sock_put(csk);
8439ba682f0Skxie@chelsio.com }
8449ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_sock_closed);
8459ba682f0Skxie@chelsio.com 
8469ba682f0Skxie@chelsio.com static void need_active_close(struct cxgbi_sock *csk)
8479ba682f0Skxie@chelsio.com {
8489ba682f0Skxie@chelsio.com 	int data_lost;
8499ba682f0Skxie@chelsio.com 	int close_req = 0;
8509ba682f0Skxie@chelsio.com 
8519ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_SOCK, "csk 0x%p,%u,0x%lx,%u.\n",
8529ba682f0Skxie@chelsio.com 		csk, (csk)->state, (csk)->flags, (csk)->tid);
8539ba682f0Skxie@chelsio.com 	spin_lock_bh(&csk->lock);
8549ba682f0Skxie@chelsio.com 	dst_confirm(csk->dst);
8559ba682f0Skxie@chelsio.com 	data_lost = skb_queue_len(&csk->receive_queue);
8569ba682f0Skxie@chelsio.com 	__skb_queue_purge(&csk->receive_queue);
8579ba682f0Skxie@chelsio.com 
8589ba682f0Skxie@chelsio.com 	if (csk->state == CTP_ACTIVE_OPEN)
8599ba682f0Skxie@chelsio.com 		cxgbi_sock_set_flag(csk, CTPF_ACTIVE_CLOSE_NEEDED);
8609ba682f0Skxie@chelsio.com 	else if (csk->state == CTP_ESTABLISHED) {
8619ba682f0Skxie@chelsio.com 		close_req = 1;
8629ba682f0Skxie@chelsio.com 		cxgbi_sock_set_state(csk, CTP_ACTIVE_CLOSE);
8639ba682f0Skxie@chelsio.com 	} else if (csk->state == CTP_PASSIVE_CLOSE) {
8649ba682f0Skxie@chelsio.com 		close_req = 1;
8659ba682f0Skxie@chelsio.com 		cxgbi_sock_set_state(csk, CTP_CLOSE_WAIT_2);
8669ba682f0Skxie@chelsio.com 	}
8679ba682f0Skxie@chelsio.com 
8689ba682f0Skxie@chelsio.com 	if (close_req) {
8699ba682f0Skxie@chelsio.com 		if (data_lost)
8709ba682f0Skxie@chelsio.com 			csk->cdev->csk_send_abort_req(csk);
8719ba682f0Skxie@chelsio.com 		else
8729ba682f0Skxie@chelsio.com 			csk->cdev->csk_send_close_req(csk);
8739ba682f0Skxie@chelsio.com 	}
8749ba682f0Skxie@chelsio.com 
8759ba682f0Skxie@chelsio.com 	spin_unlock_bh(&csk->lock);
8769ba682f0Skxie@chelsio.com }
8779ba682f0Skxie@chelsio.com 
8789ba682f0Skxie@chelsio.com void cxgbi_sock_fail_act_open(struct cxgbi_sock *csk, int errno)
8799ba682f0Skxie@chelsio.com {
8809ba682f0Skxie@chelsio.com 	pr_info("csk 0x%p,%u,%lx, %pI4:%u-%pI4:%u, err %d.\n",
8819ba682f0Skxie@chelsio.com 			csk, csk->state, csk->flags,
8829ba682f0Skxie@chelsio.com 			&csk->saddr.sin_addr.s_addr, csk->saddr.sin_port,
8839ba682f0Skxie@chelsio.com 			&csk->daddr.sin_addr.s_addr, csk->daddr.sin_port,
8849ba682f0Skxie@chelsio.com 			errno);
8859ba682f0Skxie@chelsio.com 
8869ba682f0Skxie@chelsio.com 	cxgbi_sock_set_state(csk, CTP_CONNECTING);
8879ba682f0Skxie@chelsio.com 	csk->err = errno;
8889ba682f0Skxie@chelsio.com 	cxgbi_sock_closed(csk);
8899ba682f0Skxie@chelsio.com }
8909ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_sock_fail_act_open);
8919ba682f0Skxie@chelsio.com 
8929ba682f0Skxie@chelsio.com void cxgbi_sock_act_open_req_arp_failure(void *handle, struct sk_buff *skb)
8939ba682f0Skxie@chelsio.com {
8949ba682f0Skxie@chelsio.com 	struct cxgbi_sock *csk = (struct cxgbi_sock *)skb->sk;
8959ba682f0Skxie@chelsio.com 
8969ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_SOCK, "csk 0x%p,%u,0x%lx,%u.\n",
8979ba682f0Skxie@chelsio.com 		csk, (csk)->state, (csk)->flags, (csk)->tid);
8989ba682f0Skxie@chelsio.com 	cxgbi_sock_get(csk);
8999ba682f0Skxie@chelsio.com 	spin_lock_bh(&csk->lock);
9009ba682f0Skxie@chelsio.com 	if (csk->state == CTP_ACTIVE_OPEN)
9019ba682f0Skxie@chelsio.com 		cxgbi_sock_fail_act_open(csk, -EHOSTUNREACH);
9029ba682f0Skxie@chelsio.com 	spin_unlock_bh(&csk->lock);
9039ba682f0Skxie@chelsio.com 	cxgbi_sock_put(csk);
9049ba682f0Skxie@chelsio.com 	__kfree_skb(skb);
9059ba682f0Skxie@chelsio.com }
9069ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_sock_act_open_req_arp_failure);
9079ba682f0Skxie@chelsio.com 
9089ba682f0Skxie@chelsio.com void cxgbi_sock_rcv_abort_rpl(struct cxgbi_sock *csk)
9099ba682f0Skxie@chelsio.com {
9109ba682f0Skxie@chelsio.com 	cxgbi_sock_get(csk);
9119ba682f0Skxie@chelsio.com 	spin_lock_bh(&csk->lock);
9127b07bf24SAnish Bhatt 
9139ba682f0Skxie@chelsio.com 	cxgbi_sock_set_flag(csk, CTPF_ABORT_RPL_RCVD);
9147b07bf24SAnish Bhatt 	if (cxgbi_sock_flag(csk, CTPF_ABORT_RPL_PENDING)) {
9159ba682f0Skxie@chelsio.com 		cxgbi_sock_clear_flag(csk, CTPF_ABORT_RPL_PENDING);
9169ba682f0Skxie@chelsio.com 		if (cxgbi_sock_flag(csk, CTPF_ABORT_REQ_RCVD))
9179ba682f0Skxie@chelsio.com 			pr_err("csk 0x%p,%u,0x%lx,%u,ABT_RPL_RSS.\n",
9189ba682f0Skxie@chelsio.com 			       csk, csk->state, csk->flags, csk->tid);
9199ba682f0Skxie@chelsio.com 		cxgbi_sock_closed(csk);
9209ba682f0Skxie@chelsio.com 	}
9217b07bf24SAnish Bhatt 
9229ba682f0Skxie@chelsio.com 	spin_unlock_bh(&csk->lock);
9239ba682f0Skxie@chelsio.com 	cxgbi_sock_put(csk);
9249ba682f0Skxie@chelsio.com }
9259ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_sock_rcv_abort_rpl);
9269ba682f0Skxie@chelsio.com 
9279ba682f0Skxie@chelsio.com void cxgbi_sock_rcv_peer_close(struct cxgbi_sock *csk)
9289ba682f0Skxie@chelsio.com {
9299ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_SOCK, "csk 0x%p,%u,0x%lx,%u.\n",
9309ba682f0Skxie@chelsio.com 		csk, (csk)->state, (csk)->flags, (csk)->tid);
9319ba682f0Skxie@chelsio.com 	cxgbi_sock_get(csk);
9329ba682f0Skxie@chelsio.com 	spin_lock_bh(&csk->lock);
9339ba682f0Skxie@chelsio.com 
9349ba682f0Skxie@chelsio.com 	if (cxgbi_sock_flag(csk, CTPF_ABORT_RPL_PENDING))
9359ba682f0Skxie@chelsio.com 		goto done;
9369ba682f0Skxie@chelsio.com 
9379ba682f0Skxie@chelsio.com 	switch (csk->state) {
9389ba682f0Skxie@chelsio.com 	case CTP_ESTABLISHED:
9399ba682f0Skxie@chelsio.com 		cxgbi_sock_set_state(csk, CTP_PASSIVE_CLOSE);
9409ba682f0Skxie@chelsio.com 		break;
9419ba682f0Skxie@chelsio.com 	case CTP_ACTIVE_CLOSE:
9429ba682f0Skxie@chelsio.com 		cxgbi_sock_set_state(csk, CTP_CLOSE_WAIT_2);
9439ba682f0Skxie@chelsio.com 		break;
9449ba682f0Skxie@chelsio.com 	case CTP_CLOSE_WAIT_1:
9459ba682f0Skxie@chelsio.com 		cxgbi_sock_closed(csk);
9469ba682f0Skxie@chelsio.com 		break;
9479ba682f0Skxie@chelsio.com 	case CTP_ABORTING:
9489ba682f0Skxie@chelsio.com 		break;
9499ba682f0Skxie@chelsio.com 	default:
9509ba682f0Skxie@chelsio.com 		pr_err("csk 0x%p,%u,0x%lx,%u, bad state.\n",
9519ba682f0Skxie@chelsio.com 			csk, csk->state, csk->flags, csk->tid);
9529ba682f0Skxie@chelsio.com 	}
9539ba682f0Skxie@chelsio.com 	cxgbi_inform_iscsi_conn_closing(csk);
9549ba682f0Skxie@chelsio.com done:
9559ba682f0Skxie@chelsio.com 	spin_unlock_bh(&csk->lock);
9569ba682f0Skxie@chelsio.com 	cxgbi_sock_put(csk);
9579ba682f0Skxie@chelsio.com }
9589ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_sock_rcv_peer_close);
9599ba682f0Skxie@chelsio.com 
9609ba682f0Skxie@chelsio.com void cxgbi_sock_rcv_close_conn_rpl(struct cxgbi_sock *csk, u32 snd_nxt)
9619ba682f0Skxie@chelsio.com {
9629ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_SOCK, "csk 0x%p,%u,0x%lx,%u.\n",
9639ba682f0Skxie@chelsio.com 		csk, (csk)->state, (csk)->flags, (csk)->tid);
9649ba682f0Skxie@chelsio.com 	cxgbi_sock_get(csk);
9659ba682f0Skxie@chelsio.com 	spin_lock_bh(&csk->lock);
9669ba682f0Skxie@chelsio.com 
9679ba682f0Skxie@chelsio.com 	csk->snd_una = snd_nxt - 1;
9689ba682f0Skxie@chelsio.com 	if (cxgbi_sock_flag(csk, CTPF_ABORT_RPL_PENDING))
9699ba682f0Skxie@chelsio.com 		goto done;
9709ba682f0Skxie@chelsio.com 
9719ba682f0Skxie@chelsio.com 	switch (csk->state) {
9729ba682f0Skxie@chelsio.com 	case CTP_ACTIVE_CLOSE:
9739ba682f0Skxie@chelsio.com 		cxgbi_sock_set_state(csk, CTP_CLOSE_WAIT_1);
9749ba682f0Skxie@chelsio.com 		break;
9759ba682f0Skxie@chelsio.com 	case CTP_CLOSE_WAIT_1:
9769ba682f0Skxie@chelsio.com 	case CTP_CLOSE_WAIT_2:
9779ba682f0Skxie@chelsio.com 		cxgbi_sock_closed(csk);
9789ba682f0Skxie@chelsio.com 		break;
9799ba682f0Skxie@chelsio.com 	case CTP_ABORTING:
9809ba682f0Skxie@chelsio.com 		break;
9819ba682f0Skxie@chelsio.com 	default:
9829ba682f0Skxie@chelsio.com 		pr_err("csk 0x%p,%u,0x%lx,%u, bad state.\n",
9839ba682f0Skxie@chelsio.com 			csk, csk->state, csk->flags, csk->tid);
9849ba682f0Skxie@chelsio.com 	}
9859ba682f0Skxie@chelsio.com done:
9869ba682f0Skxie@chelsio.com 	spin_unlock_bh(&csk->lock);
9879ba682f0Skxie@chelsio.com 	cxgbi_sock_put(csk);
9889ba682f0Skxie@chelsio.com }
9899ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_sock_rcv_close_conn_rpl);
9909ba682f0Skxie@chelsio.com 
9919ba682f0Skxie@chelsio.com void cxgbi_sock_rcv_wr_ack(struct cxgbi_sock *csk, unsigned int credits,
9929ba682f0Skxie@chelsio.com 			   unsigned int snd_una, int seq_chk)
9939ba682f0Skxie@chelsio.com {
9949ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
9959ba682f0Skxie@chelsio.com 			"csk 0x%p,%u,0x%lx,%u, cr %u,%u+%u, snd_una %u,%d.\n",
9969ba682f0Skxie@chelsio.com 			csk, csk->state, csk->flags, csk->tid, credits,
9979ba682f0Skxie@chelsio.com 			csk->wr_cred, csk->wr_una_cred, snd_una, seq_chk);
9989ba682f0Skxie@chelsio.com 
9999ba682f0Skxie@chelsio.com 	spin_lock_bh(&csk->lock);
10009ba682f0Skxie@chelsio.com 
10019ba682f0Skxie@chelsio.com 	csk->wr_cred += credits;
10029ba682f0Skxie@chelsio.com 	if (csk->wr_una_cred > csk->wr_max_cred - csk->wr_cred)
10039ba682f0Skxie@chelsio.com 		csk->wr_una_cred = csk->wr_max_cred - csk->wr_cred;
10049ba682f0Skxie@chelsio.com 
10059ba682f0Skxie@chelsio.com 	while (credits) {
10069ba682f0Skxie@chelsio.com 		struct sk_buff *p = cxgbi_sock_peek_wr(csk);
10079ba682f0Skxie@chelsio.com 
10089ba682f0Skxie@chelsio.com 		if (unlikely(!p)) {
10099ba682f0Skxie@chelsio.com 			pr_err("csk 0x%p,%u,0x%lx,%u, cr %u,%u+%u, empty.\n",
10109ba682f0Skxie@chelsio.com 				csk, csk->state, csk->flags, csk->tid, credits,
10119ba682f0Skxie@chelsio.com 				csk->wr_cred, csk->wr_una_cred);
10129ba682f0Skxie@chelsio.com 			break;
10139ba682f0Skxie@chelsio.com 		}
10149ba682f0Skxie@chelsio.com 
10159ba682f0Skxie@chelsio.com 		if (unlikely(credits < p->csum)) {
10169ba682f0Skxie@chelsio.com 			pr_warn("csk 0x%p,%u,0x%lx,%u, cr %u,%u+%u, < %u.\n",
10179ba682f0Skxie@chelsio.com 				csk, csk->state, csk->flags, csk->tid,
10189ba682f0Skxie@chelsio.com 				credits, csk->wr_cred, csk->wr_una_cred,
10199ba682f0Skxie@chelsio.com 				p->csum);
10209ba682f0Skxie@chelsio.com 			p->csum -= credits;
10219ba682f0Skxie@chelsio.com 			break;
10229ba682f0Skxie@chelsio.com 		} else {
10239ba682f0Skxie@chelsio.com 			cxgbi_sock_dequeue_wr(csk);
10249ba682f0Skxie@chelsio.com 			credits -= p->csum;
10259ba682f0Skxie@chelsio.com 			kfree_skb(p);
10269ba682f0Skxie@chelsio.com 		}
10279ba682f0Skxie@chelsio.com 	}
10289ba682f0Skxie@chelsio.com 
10299ba682f0Skxie@chelsio.com 	cxgbi_sock_check_wr_invariants(csk);
10309ba682f0Skxie@chelsio.com 
10319ba682f0Skxie@chelsio.com 	if (seq_chk) {
10329ba682f0Skxie@chelsio.com 		if (unlikely(before(snd_una, csk->snd_una))) {
10339ba682f0Skxie@chelsio.com 			pr_warn("csk 0x%p,%u,0x%lx,%u, snd_una %u/%u.",
10349ba682f0Skxie@chelsio.com 				csk, csk->state, csk->flags, csk->tid, snd_una,
10359ba682f0Skxie@chelsio.com 				csk->snd_una);
10369ba682f0Skxie@chelsio.com 			goto done;
10379ba682f0Skxie@chelsio.com 		}
10389ba682f0Skxie@chelsio.com 
10399ba682f0Skxie@chelsio.com 		if (csk->snd_una != snd_una) {
10409ba682f0Skxie@chelsio.com 			csk->snd_una = snd_una;
10419ba682f0Skxie@chelsio.com 			dst_confirm(csk->dst);
10429ba682f0Skxie@chelsio.com 		}
10439ba682f0Skxie@chelsio.com 	}
10449ba682f0Skxie@chelsio.com 
10459ba682f0Skxie@chelsio.com 	if (skb_queue_len(&csk->write_queue)) {
10469ba682f0Skxie@chelsio.com 		if (csk->cdev->csk_push_tx_frames(csk, 0))
10479ba682f0Skxie@chelsio.com 			cxgbi_conn_tx_open(csk);
10489ba682f0Skxie@chelsio.com 	} else
10499ba682f0Skxie@chelsio.com 		cxgbi_conn_tx_open(csk);
10509ba682f0Skxie@chelsio.com done:
10519ba682f0Skxie@chelsio.com 	spin_unlock_bh(&csk->lock);
10529ba682f0Skxie@chelsio.com }
10539ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_sock_rcv_wr_ack);
10549ba682f0Skxie@chelsio.com 
10559ba682f0Skxie@chelsio.com static unsigned int cxgbi_sock_find_best_mtu(struct cxgbi_sock *csk,
10569ba682f0Skxie@chelsio.com 					     unsigned short mtu)
10579ba682f0Skxie@chelsio.com {
10589ba682f0Skxie@chelsio.com 	int i = 0;
10599ba682f0Skxie@chelsio.com 
10609ba682f0Skxie@chelsio.com 	while (i < csk->cdev->nmtus - 1 && csk->cdev->mtus[i + 1] <= mtu)
10619ba682f0Skxie@chelsio.com 		++i;
10629ba682f0Skxie@chelsio.com 
10639ba682f0Skxie@chelsio.com 	return i;
10649ba682f0Skxie@chelsio.com }
10659ba682f0Skxie@chelsio.com 
10669ba682f0Skxie@chelsio.com unsigned int cxgbi_sock_select_mss(struct cxgbi_sock *csk, unsigned int pmtu)
10679ba682f0Skxie@chelsio.com {
10689ba682f0Skxie@chelsio.com 	unsigned int idx;
10699ba682f0Skxie@chelsio.com 	struct dst_entry *dst = csk->dst;
10709ba682f0Skxie@chelsio.com 
10710dbaee3bSDavid S. Miller 	csk->advmss = dst_metric_advmss(dst);
10729ba682f0Skxie@chelsio.com 
10739ba682f0Skxie@chelsio.com 	if (csk->advmss > pmtu - 40)
10749ba682f0Skxie@chelsio.com 		csk->advmss = pmtu - 40;
10759ba682f0Skxie@chelsio.com 	if (csk->advmss < csk->cdev->mtus[0] - 40)
10769ba682f0Skxie@chelsio.com 		csk->advmss = csk->cdev->mtus[0] - 40;
10779ba682f0Skxie@chelsio.com 	idx = cxgbi_sock_find_best_mtu(csk, csk->advmss + 40);
10789ba682f0Skxie@chelsio.com 
10799ba682f0Skxie@chelsio.com 	return idx;
10809ba682f0Skxie@chelsio.com }
10819ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_sock_select_mss);
10829ba682f0Skxie@chelsio.com 
10839ba682f0Skxie@chelsio.com void cxgbi_sock_skb_entail(struct cxgbi_sock *csk, struct sk_buff *skb)
10849ba682f0Skxie@chelsio.com {
10859ba682f0Skxie@chelsio.com 	cxgbi_skcb_tcp_seq(skb) = csk->write_seq;
10869ba682f0Skxie@chelsio.com 	__skb_queue_tail(&csk->write_queue, skb);
10879ba682f0Skxie@chelsio.com }
10889ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_sock_skb_entail);
10899ba682f0Skxie@chelsio.com 
10909ba682f0Skxie@chelsio.com void cxgbi_sock_purge_wr_queue(struct cxgbi_sock *csk)
10919ba682f0Skxie@chelsio.com {
10929ba682f0Skxie@chelsio.com 	struct sk_buff *skb;
10939ba682f0Skxie@chelsio.com 
10949ba682f0Skxie@chelsio.com 	while ((skb = cxgbi_sock_dequeue_wr(csk)) != NULL)
10959ba682f0Skxie@chelsio.com 		kfree_skb(skb);
10969ba682f0Skxie@chelsio.com }
10979ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_sock_purge_wr_queue);
10989ba682f0Skxie@chelsio.com 
10999ba682f0Skxie@chelsio.com void cxgbi_sock_check_wr_invariants(const struct cxgbi_sock *csk)
11009ba682f0Skxie@chelsio.com {
11019ba682f0Skxie@chelsio.com 	int pending = cxgbi_sock_count_pending_wrs(csk);
11029ba682f0Skxie@chelsio.com 
11039ba682f0Skxie@chelsio.com 	if (unlikely(csk->wr_cred + pending != csk->wr_max_cred))
11049ba682f0Skxie@chelsio.com 		pr_err("csk 0x%p, tid %u, credit %u + %u != %u.\n",
11059ba682f0Skxie@chelsio.com 			csk, csk->tid, csk->wr_cred, pending, csk->wr_max_cred);
11069ba682f0Skxie@chelsio.com }
11079ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_sock_check_wr_invariants);
11089ba682f0Skxie@chelsio.com 
11099ba682f0Skxie@chelsio.com static int cxgbi_sock_send_pdus(struct cxgbi_sock *csk, struct sk_buff *skb)
11109ba682f0Skxie@chelsio.com {
11119ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev = csk->cdev;
11129ba682f0Skxie@chelsio.com 	struct sk_buff *next;
11139ba682f0Skxie@chelsio.com 	int err, copied = 0;
11149ba682f0Skxie@chelsio.com 
11159ba682f0Skxie@chelsio.com 	spin_lock_bh(&csk->lock);
11169ba682f0Skxie@chelsio.com 
11179ba682f0Skxie@chelsio.com 	if (csk->state != CTP_ESTABLISHED) {
11189ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_PDU_TX,
11199ba682f0Skxie@chelsio.com 			"csk 0x%p,%u,0x%lx,%u, EAGAIN.\n",
11209ba682f0Skxie@chelsio.com 			csk, csk->state, csk->flags, csk->tid);
11219ba682f0Skxie@chelsio.com 		err = -EAGAIN;
11229ba682f0Skxie@chelsio.com 		goto out_err;
11239ba682f0Skxie@chelsio.com 	}
11249ba682f0Skxie@chelsio.com 
11259ba682f0Skxie@chelsio.com 	if (csk->err) {
11269ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_PDU_TX,
11279ba682f0Skxie@chelsio.com 			"csk 0x%p,%u,0x%lx,%u, EPIPE %d.\n",
11289ba682f0Skxie@chelsio.com 			csk, csk->state, csk->flags, csk->tid, csk->err);
11299ba682f0Skxie@chelsio.com 		err = -EPIPE;
11309ba682f0Skxie@chelsio.com 		goto out_err;
11319ba682f0Skxie@chelsio.com 	}
11329ba682f0Skxie@chelsio.com 
113381daf10cSKaren Xie 	if (csk->write_seq - csk->snd_una >= csk->snd_win) {
11349ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_PDU_TX,
11359ba682f0Skxie@chelsio.com 			"csk 0x%p,%u,0x%lx,%u, FULL %u-%u >= %u.\n",
11369ba682f0Skxie@chelsio.com 			csk, csk->state, csk->flags, csk->tid, csk->write_seq,
113781daf10cSKaren Xie 			csk->snd_una, csk->snd_win);
11389ba682f0Skxie@chelsio.com 		err = -ENOBUFS;
11399ba682f0Skxie@chelsio.com 		goto out_err;
11409ba682f0Skxie@chelsio.com 	}
11419ba682f0Skxie@chelsio.com 
11429ba682f0Skxie@chelsio.com 	while (skb) {
11439ba682f0Skxie@chelsio.com 		int frags = skb_shinfo(skb)->nr_frags +
11449ba682f0Skxie@chelsio.com 				(skb->len != skb->data_len);
11459ba682f0Skxie@chelsio.com 
11469ba682f0Skxie@chelsio.com 		if (unlikely(skb_headroom(skb) < cdev->skb_tx_rsvd)) {
11479ba682f0Skxie@chelsio.com 			pr_err("csk 0x%p, skb head %u < %u.\n",
11489ba682f0Skxie@chelsio.com 				csk, skb_headroom(skb), cdev->skb_tx_rsvd);
11499ba682f0Skxie@chelsio.com 			err = -EINVAL;
11509ba682f0Skxie@chelsio.com 			goto out_err;
11519ba682f0Skxie@chelsio.com 		}
11529ba682f0Skxie@chelsio.com 
11539ba682f0Skxie@chelsio.com 		if (frags >= SKB_WR_LIST_SIZE) {
11549ba682f0Skxie@chelsio.com 			pr_err("csk 0x%p, frags %d, %u,%u >%u.\n",
11559ba682f0Skxie@chelsio.com 				csk, skb_shinfo(skb)->nr_frags, skb->len,
11569ba682f0Skxie@chelsio.com 				skb->data_len, (uint)(SKB_WR_LIST_SIZE));
11579ba682f0Skxie@chelsio.com 			err = -EINVAL;
11589ba682f0Skxie@chelsio.com 			goto out_err;
11599ba682f0Skxie@chelsio.com 		}
11609ba682f0Skxie@chelsio.com 
11619ba682f0Skxie@chelsio.com 		next = skb->next;
11629ba682f0Skxie@chelsio.com 		skb->next = NULL;
11639ba682f0Skxie@chelsio.com 		cxgbi_skcb_set_flag(skb, SKCBF_TX_NEED_HDR);
11649ba682f0Skxie@chelsio.com 		cxgbi_sock_skb_entail(csk, skb);
11659ba682f0Skxie@chelsio.com 		copied += skb->len;
11669ba682f0Skxie@chelsio.com 		csk->write_seq += skb->len +
11679ba682f0Skxie@chelsio.com 				cxgbi_ulp_extra_len(cxgbi_skcb_ulp_mode(skb));
11689ba682f0Skxie@chelsio.com 		skb = next;
11699ba682f0Skxie@chelsio.com 	}
11709ba682f0Skxie@chelsio.com done:
11719ba682f0Skxie@chelsio.com 	if (likely(skb_queue_len(&csk->write_queue)))
11729ba682f0Skxie@chelsio.com 		cdev->csk_push_tx_frames(csk, 1);
11739ba682f0Skxie@chelsio.com 	spin_unlock_bh(&csk->lock);
11749ba682f0Skxie@chelsio.com 	return copied;
11759ba682f0Skxie@chelsio.com 
11769ba682f0Skxie@chelsio.com out_err:
11779ba682f0Skxie@chelsio.com 	if (copied == 0 && err == -EPIPE)
11789ba682f0Skxie@chelsio.com 		copied = csk->err ? csk->err : -EPIPE;
11799ba682f0Skxie@chelsio.com 	else
11809ba682f0Skxie@chelsio.com 		copied = err;
11819ba682f0Skxie@chelsio.com 	goto done;
11829ba682f0Skxie@chelsio.com }
11839ba682f0Skxie@chelsio.com 
11849ba682f0Skxie@chelsio.com /*
11859ba682f0Skxie@chelsio.com  * Direct Data Placement -
11869ba682f0Skxie@chelsio.com  * Directly place the iSCSI Data-In or Data-Out PDU's payload into pre-posted
11879ba682f0Skxie@chelsio.com  * final destination host-memory buffers based on the Initiator Task Tag (ITT)
11889ba682f0Skxie@chelsio.com  * in Data-In or Target Task Tag (TTT) in Data-Out PDUs.
11899ba682f0Skxie@chelsio.com  * The host memory address is programmed into h/w in the format of pagepod
11909ba682f0Skxie@chelsio.com  * entries.
11919ba682f0Skxie@chelsio.com  * The location of the pagepod entry is encoded into ddp tag which is used as
11929ba682f0Skxie@chelsio.com  * the base for ITT/TTT.
11939ba682f0Skxie@chelsio.com  */
11949ba682f0Skxie@chelsio.com 
11959ba682f0Skxie@chelsio.com static unsigned char ddp_page_order[DDP_PGIDX_MAX] = {0, 1, 2, 4};
11969ba682f0Skxie@chelsio.com static unsigned char ddp_page_shift[DDP_PGIDX_MAX] = {12, 13, 14, 16};
11979ba682f0Skxie@chelsio.com static unsigned char page_idx = DDP_PGIDX_MAX;
11989ba682f0Skxie@chelsio.com 
11999ba682f0Skxie@chelsio.com static unsigned char sw_tag_idx_bits;
12009ba682f0Skxie@chelsio.com static unsigned char sw_tag_age_bits;
12019ba682f0Skxie@chelsio.com 
12029ba682f0Skxie@chelsio.com /*
12039ba682f0Skxie@chelsio.com  * Direct-Data Placement page size adjustment
12049ba682f0Skxie@chelsio.com  */
12059ba682f0Skxie@chelsio.com static int ddp_adjust_page_table(void)
12069ba682f0Skxie@chelsio.com {
12079ba682f0Skxie@chelsio.com 	int i;
12089ba682f0Skxie@chelsio.com 	unsigned int base_order, order;
12099ba682f0Skxie@chelsio.com 
12109ba682f0Skxie@chelsio.com 	if (PAGE_SIZE < (1UL << ddp_page_shift[0])) {
12119ba682f0Skxie@chelsio.com 		pr_info("PAGE_SIZE 0x%lx too small, min 0x%lx\n",
12129ba682f0Skxie@chelsio.com 			PAGE_SIZE, 1UL << ddp_page_shift[0]);
12139ba682f0Skxie@chelsio.com 		return -EINVAL;
12149ba682f0Skxie@chelsio.com 	}
12159ba682f0Skxie@chelsio.com 
12169ba682f0Skxie@chelsio.com 	base_order = get_order(1UL << ddp_page_shift[0]);
12179ba682f0Skxie@chelsio.com 	order = get_order(1UL << PAGE_SHIFT);
12189ba682f0Skxie@chelsio.com 
12199ba682f0Skxie@chelsio.com 	for (i = 0; i < DDP_PGIDX_MAX; i++) {
12209ba682f0Skxie@chelsio.com 		/* first is the kernel page size, then just doubling */
12219ba682f0Skxie@chelsio.com 		ddp_page_order[i] = order - base_order + i;
12229ba682f0Skxie@chelsio.com 		ddp_page_shift[i] = PAGE_SHIFT + i;
12239ba682f0Skxie@chelsio.com 	}
12249ba682f0Skxie@chelsio.com 	return 0;
12259ba682f0Skxie@chelsio.com }
12269ba682f0Skxie@chelsio.com 
12279ba682f0Skxie@chelsio.com static int ddp_find_page_index(unsigned long pgsz)
12289ba682f0Skxie@chelsio.com {
12299ba682f0Skxie@chelsio.com 	int i;
12309ba682f0Skxie@chelsio.com 
12319ba682f0Skxie@chelsio.com 	for (i = 0; i < DDP_PGIDX_MAX; i++) {
12329ba682f0Skxie@chelsio.com 		if (pgsz == (1UL << ddp_page_shift[i]))
12339ba682f0Skxie@chelsio.com 			return i;
12349ba682f0Skxie@chelsio.com 	}
12359ba682f0Skxie@chelsio.com 	pr_info("ddp page size %lu not supported.\n", pgsz);
12369ba682f0Skxie@chelsio.com 	return DDP_PGIDX_MAX;
12379ba682f0Skxie@chelsio.com }
12389ba682f0Skxie@chelsio.com 
12399ba682f0Skxie@chelsio.com static void ddp_setup_host_page_size(void)
12409ba682f0Skxie@chelsio.com {
12419ba682f0Skxie@chelsio.com 	if (page_idx == DDP_PGIDX_MAX) {
12429ba682f0Skxie@chelsio.com 		page_idx = ddp_find_page_index(PAGE_SIZE);
12439ba682f0Skxie@chelsio.com 
12449ba682f0Skxie@chelsio.com 		if (page_idx == DDP_PGIDX_MAX) {
12459ba682f0Skxie@chelsio.com 			pr_info("system PAGE %lu, update hw.\n", PAGE_SIZE);
12469ba682f0Skxie@chelsio.com 			if (ddp_adjust_page_table() < 0) {
12479ba682f0Skxie@chelsio.com 				pr_info("PAGE %lu, disable ddp.\n", PAGE_SIZE);
12489ba682f0Skxie@chelsio.com 				return;
12499ba682f0Skxie@chelsio.com 			}
12509ba682f0Skxie@chelsio.com 			page_idx = ddp_find_page_index(PAGE_SIZE);
12519ba682f0Skxie@chelsio.com 		}
12529ba682f0Skxie@chelsio.com 		pr_info("system PAGE %lu, ddp idx %u.\n", PAGE_SIZE, page_idx);
12539ba682f0Skxie@chelsio.com 	}
12549ba682f0Skxie@chelsio.com }
12559ba682f0Skxie@chelsio.com 
12569ba682f0Skxie@chelsio.com void cxgbi_ddp_page_size_factor(int *pgsz_factor)
12579ba682f0Skxie@chelsio.com {
12589ba682f0Skxie@chelsio.com 	int i;
12599ba682f0Skxie@chelsio.com 
12609ba682f0Skxie@chelsio.com 	for (i = 0; i < DDP_PGIDX_MAX; i++)
12619ba682f0Skxie@chelsio.com 		pgsz_factor[i] = ddp_page_order[i];
12629ba682f0Skxie@chelsio.com }
12639ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_ddp_page_size_factor);
12649ba682f0Skxie@chelsio.com 
12659ba682f0Skxie@chelsio.com /*
12669ba682f0Skxie@chelsio.com  * DDP setup & teardown
12679ba682f0Skxie@chelsio.com  */
12689ba682f0Skxie@chelsio.com 
12699ba682f0Skxie@chelsio.com void cxgbi_ddp_ppod_set(struct cxgbi_pagepod *ppod,
12709ba682f0Skxie@chelsio.com 			struct cxgbi_pagepod_hdr *hdr,
12719ba682f0Skxie@chelsio.com 			struct cxgbi_gather_list *gl, unsigned int gidx)
12729ba682f0Skxie@chelsio.com {
12739ba682f0Skxie@chelsio.com 	int i;
12749ba682f0Skxie@chelsio.com 
12759ba682f0Skxie@chelsio.com 	memcpy(ppod, hdr, sizeof(*hdr));
12769ba682f0Skxie@chelsio.com 	for (i = 0; i < (PPOD_PAGES_MAX + 1); i++, gidx++) {
12779ba682f0Skxie@chelsio.com 		ppod->addr[i] = gidx < gl->nelem ?
12789ba682f0Skxie@chelsio.com 				cpu_to_be64(gl->phys_addr[gidx]) : 0ULL;
12799ba682f0Skxie@chelsio.com 	}
12809ba682f0Skxie@chelsio.com }
12819ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_ddp_ppod_set);
12829ba682f0Skxie@chelsio.com 
12839ba682f0Skxie@chelsio.com void cxgbi_ddp_ppod_clear(struct cxgbi_pagepod *ppod)
12849ba682f0Skxie@chelsio.com {
12859ba682f0Skxie@chelsio.com 	memset(ppod, 0, sizeof(*ppod));
12869ba682f0Skxie@chelsio.com }
12879ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_ddp_ppod_clear);
12889ba682f0Skxie@chelsio.com 
12899ba682f0Skxie@chelsio.com static inline int ddp_find_unused_entries(struct cxgbi_ddp_info *ddp,
12909ba682f0Skxie@chelsio.com 					unsigned int start, unsigned int max,
12919ba682f0Skxie@chelsio.com 					unsigned int count,
12929ba682f0Skxie@chelsio.com 					struct cxgbi_gather_list *gl)
12939ba682f0Skxie@chelsio.com {
12949ba682f0Skxie@chelsio.com 	unsigned int i, j, k;
12959ba682f0Skxie@chelsio.com 
12969ba682f0Skxie@chelsio.com 	/*  not enough entries */
12979ba682f0Skxie@chelsio.com 	if ((max - start) < count) {
12989ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_DDP,
12999ba682f0Skxie@chelsio.com 			"NOT enough entries %u+%u < %u.\n", start, count, max);
13009ba682f0Skxie@chelsio.com 		return -EBUSY;
13019ba682f0Skxie@chelsio.com 	}
13029ba682f0Skxie@chelsio.com 
13039ba682f0Skxie@chelsio.com 	max -= count;
13049ba682f0Skxie@chelsio.com 	spin_lock(&ddp->map_lock);
13059ba682f0Skxie@chelsio.com 	for (i = start; i < max;) {
13069ba682f0Skxie@chelsio.com 		for (j = 0, k = i; j < count; j++, k++) {
13079ba682f0Skxie@chelsio.com 			if (ddp->gl_map[k])
13089ba682f0Skxie@chelsio.com 				break;
13099ba682f0Skxie@chelsio.com 		}
13109ba682f0Skxie@chelsio.com 		if (j == count) {
13119ba682f0Skxie@chelsio.com 			for (j = 0, k = i; j < count; j++, k++)
13129ba682f0Skxie@chelsio.com 				ddp->gl_map[k] = gl;
13139ba682f0Skxie@chelsio.com 			spin_unlock(&ddp->map_lock);
13149ba682f0Skxie@chelsio.com 			return i;
13159ba682f0Skxie@chelsio.com 		}
13169ba682f0Skxie@chelsio.com 		i += j + 1;
13179ba682f0Skxie@chelsio.com 	}
13189ba682f0Skxie@chelsio.com 	spin_unlock(&ddp->map_lock);
13199ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DDP,
13209ba682f0Skxie@chelsio.com 		"NO suitable entries %u available.\n", count);
13219ba682f0Skxie@chelsio.com 	return -EBUSY;
13229ba682f0Skxie@chelsio.com }
13239ba682f0Skxie@chelsio.com 
13249ba682f0Skxie@chelsio.com static inline void ddp_unmark_entries(struct cxgbi_ddp_info *ddp,
13259ba682f0Skxie@chelsio.com 						int start, int count)
13269ba682f0Skxie@chelsio.com {
13279ba682f0Skxie@chelsio.com 	spin_lock(&ddp->map_lock);
13289ba682f0Skxie@chelsio.com 	memset(&ddp->gl_map[start], 0,
13299ba682f0Skxie@chelsio.com 		count * sizeof(struct cxgbi_gather_list *));
13309ba682f0Skxie@chelsio.com 	spin_unlock(&ddp->map_lock);
13319ba682f0Skxie@chelsio.com }
13329ba682f0Skxie@chelsio.com 
13339ba682f0Skxie@chelsio.com static inline void ddp_gl_unmap(struct pci_dev *pdev,
13349ba682f0Skxie@chelsio.com 					struct cxgbi_gather_list *gl)
13359ba682f0Skxie@chelsio.com {
13369ba682f0Skxie@chelsio.com 	int i;
13379ba682f0Skxie@chelsio.com 
13389ba682f0Skxie@chelsio.com 	for (i = 0; i < gl->nelem; i++)
13399ba682f0Skxie@chelsio.com 		dma_unmap_page(&pdev->dev, gl->phys_addr[i], PAGE_SIZE,
13409ba682f0Skxie@chelsio.com 				PCI_DMA_FROMDEVICE);
13419ba682f0Skxie@chelsio.com }
13429ba682f0Skxie@chelsio.com 
13439ba682f0Skxie@chelsio.com static inline int ddp_gl_map(struct pci_dev *pdev,
13449ba682f0Skxie@chelsio.com 				    struct cxgbi_gather_list *gl)
13459ba682f0Skxie@chelsio.com {
13469ba682f0Skxie@chelsio.com 	int i;
13479ba682f0Skxie@chelsio.com 
13489ba682f0Skxie@chelsio.com 	for (i = 0; i < gl->nelem; i++) {
13499ba682f0Skxie@chelsio.com 		gl->phys_addr[i] = dma_map_page(&pdev->dev, gl->pages[i], 0,
13509ba682f0Skxie@chelsio.com 						PAGE_SIZE,
13519ba682f0Skxie@chelsio.com 						PCI_DMA_FROMDEVICE);
13529ba682f0Skxie@chelsio.com 		if (unlikely(dma_mapping_error(&pdev->dev, gl->phys_addr[i]))) {
13539ba682f0Skxie@chelsio.com 			log_debug(1 << CXGBI_DBG_DDP,
13549ba682f0Skxie@chelsio.com 				"page %d 0x%p, 0x%p dma mapping err.\n",
13559ba682f0Skxie@chelsio.com 				i, gl->pages[i], pdev);
13569ba682f0Skxie@chelsio.com 			goto unmap;
13579ba682f0Skxie@chelsio.com 		}
13589ba682f0Skxie@chelsio.com 	}
13599ba682f0Skxie@chelsio.com 	return i;
13609ba682f0Skxie@chelsio.com unmap:
13619ba682f0Skxie@chelsio.com 	if (i) {
13629ba682f0Skxie@chelsio.com 		unsigned int nelem = gl->nelem;
13639ba682f0Skxie@chelsio.com 
13649ba682f0Skxie@chelsio.com 		gl->nelem = i;
13659ba682f0Skxie@chelsio.com 		ddp_gl_unmap(pdev, gl);
13669ba682f0Skxie@chelsio.com 		gl->nelem = nelem;
13679ba682f0Skxie@chelsio.com 	}
13689ba682f0Skxie@chelsio.com 	return -EINVAL;
13699ba682f0Skxie@chelsio.com }
13709ba682f0Skxie@chelsio.com 
13719ba682f0Skxie@chelsio.com static void ddp_release_gl(struct cxgbi_gather_list *gl,
13729ba682f0Skxie@chelsio.com 				  struct pci_dev *pdev)
13739ba682f0Skxie@chelsio.com {
13749ba682f0Skxie@chelsio.com 	ddp_gl_unmap(pdev, gl);
13759ba682f0Skxie@chelsio.com 	kfree(gl);
13769ba682f0Skxie@chelsio.com }
13779ba682f0Skxie@chelsio.com 
13789ba682f0Skxie@chelsio.com static struct cxgbi_gather_list *ddp_make_gl(unsigned int xferlen,
13799ba682f0Skxie@chelsio.com 						    struct scatterlist *sgl,
13809ba682f0Skxie@chelsio.com 						    unsigned int sgcnt,
13819ba682f0Skxie@chelsio.com 						    struct pci_dev *pdev,
13829ba682f0Skxie@chelsio.com 						    gfp_t gfp)
13839ba682f0Skxie@chelsio.com {
13849ba682f0Skxie@chelsio.com 	struct cxgbi_gather_list *gl;
13859ba682f0Skxie@chelsio.com 	struct scatterlist *sg = sgl;
13869ba682f0Skxie@chelsio.com 	struct page *sgpage = sg_page(sg);
13879ba682f0Skxie@chelsio.com 	unsigned int sglen = sg->length;
13889ba682f0Skxie@chelsio.com 	unsigned int sgoffset = sg->offset;
13899ba682f0Skxie@chelsio.com 	unsigned int npages = (xferlen + sgoffset + PAGE_SIZE - 1) >>
13909ba682f0Skxie@chelsio.com 				PAGE_SHIFT;
13919ba682f0Skxie@chelsio.com 	int i = 1, j = 0;
13929ba682f0Skxie@chelsio.com 
13939ba682f0Skxie@chelsio.com 	if (xferlen < DDP_THRESHOLD) {
13949ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_DDP,
13959ba682f0Skxie@chelsio.com 			"xfer %u < threshold %u, no ddp.\n",
13969ba682f0Skxie@chelsio.com 			xferlen, DDP_THRESHOLD);
13979ba682f0Skxie@chelsio.com 		return NULL;
13989ba682f0Skxie@chelsio.com 	}
13999ba682f0Skxie@chelsio.com 
14009ba682f0Skxie@chelsio.com 	gl = kzalloc(sizeof(struct cxgbi_gather_list) +
14019ba682f0Skxie@chelsio.com 		     npages * (sizeof(dma_addr_t) +
14029ba682f0Skxie@chelsio.com 		     sizeof(struct page *)), gfp);
14039ba682f0Skxie@chelsio.com 	if (!gl) {
14049ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_DDP,
14059ba682f0Skxie@chelsio.com 			"xfer %u, %u pages, OOM.\n", xferlen, npages);
14069ba682f0Skxie@chelsio.com 		return NULL;
14079ba682f0Skxie@chelsio.com 	}
14089ba682f0Skxie@chelsio.com 
14099ba682f0Skxie@chelsio.com 	 log_debug(1 << CXGBI_DBG_DDP,
14109ba682f0Skxie@chelsio.com 		"xfer %u, sgl %u, gl max %u.\n", xferlen, sgcnt, npages);
14119ba682f0Skxie@chelsio.com 
14129ba682f0Skxie@chelsio.com 	gl->pages = (struct page **)&gl->phys_addr[npages];
14139ba682f0Skxie@chelsio.com 	gl->nelem = npages;
14149ba682f0Skxie@chelsio.com 	gl->length = xferlen;
14159ba682f0Skxie@chelsio.com 	gl->offset = sgoffset;
14169ba682f0Skxie@chelsio.com 	gl->pages[0] = sgpage;
14179ba682f0Skxie@chelsio.com 
14189ba682f0Skxie@chelsio.com 	for (i = 1, sg = sg_next(sgl), j = 0; i < sgcnt;
14199ba682f0Skxie@chelsio.com 		i++, sg = sg_next(sg)) {
14209ba682f0Skxie@chelsio.com 		struct page *page = sg_page(sg);
14219ba682f0Skxie@chelsio.com 
14229ba682f0Skxie@chelsio.com 		if (sgpage == page && sg->offset == sgoffset + sglen)
14239ba682f0Skxie@chelsio.com 			sglen += sg->length;
14249ba682f0Skxie@chelsio.com 		else {
14259ba682f0Skxie@chelsio.com 			/*  make sure the sgl is fit for ddp:
14269ba682f0Skxie@chelsio.com 			 *  each has the same page size, and
14279ba682f0Skxie@chelsio.com 			 *  all of the middle pages are used completely
14289ba682f0Skxie@chelsio.com 			 */
14299ba682f0Skxie@chelsio.com 			if ((j && sgoffset) || ((i != sgcnt - 1) &&
14309ba682f0Skxie@chelsio.com 			    ((sglen + sgoffset) & ~PAGE_MASK))) {
14319ba682f0Skxie@chelsio.com 				log_debug(1 << CXGBI_DBG_DDP,
14329ba682f0Skxie@chelsio.com 					"page %d/%u, %u + %u.\n",
14339ba682f0Skxie@chelsio.com 					i, sgcnt, sgoffset, sglen);
14349ba682f0Skxie@chelsio.com 				goto error_out;
14359ba682f0Skxie@chelsio.com 			}
14369ba682f0Skxie@chelsio.com 
14379ba682f0Skxie@chelsio.com 			j++;
14389ba682f0Skxie@chelsio.com 			if (j == gl->nelem || sg->offset) {
14399ba682f0Skxie@chelsio.com 				log_debug(1 << CXGBI_DBG_DDP,
14409ba682f0Skxie@chelsio.com 					"page %d/%u, offset %u.\n",
14419ba682f0Skxie@chelsio.com 					j, gl->nelem, sg->offset);
14429ba682f0Skxie@chelsio.com 				goto error_out;
14439ba682f0Skxie@chelsio.com 			}
14449ba682f0Skxie@chelsio.com 			gl->pages[j] = page;
14459ba682f0Skxie@chelsio.com 			sglen = sg->length;
14469ba682f0Skxie@chelsio.com 			sgoffset = sg->offset;
14479ba682f0Skxie@chelsio.com 			sgpage = page;
14489ba682f0Skxie@chelsio.com 		}
14499ba682f0Skxie@chelsio.com 	}
14509ba682f0Skxie@chelsio.com 	gl->nelem = ++j;
14519ba682f0Skxie@chelsio.com 
14529ba682f0Skxie@chelsio.com 	if (ddp_gl_map(pdev, gl) < 0)
14539ba682f0Skxie@chelsio.com 		goto error_out;
14549ba682f0Skxie@chelsio.com 
14559ba682f0Skxie@chelsio.com 	return gl;
14569ba682f0Skxie@chelsio.com 
14579ba682f0Skxie@chelsio.com error_out:
14589ba682f0Skxie@chelsio.com 	kfree(gl);
14599ba682f0Skxie@chelsio.com 	return NULL;
14609ba682f0Skxie@chelsio.com }
14619ba682f0Skxie@chelsio.com 
14629ba682f0Skxie@chelsio.com static void ddp_tag_release(struct cxgbi_hba *chba, u32 tag)
14639ba682f0Skxie@chelsio.com {
14649ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev = chba->cdev;
14659ba682f0Skxie@chelsio.com 	struct cxgbi_ddp_info *ddp = cdev->ddp;
14669ba682f0Skxie@chelsio.com 	u32 idx;
14679ba682f0Skxie@chelsio.com 
14689ba682f0Skxie@chelsio.com 	idx = (tag >> PPOD_IDX_SHIFT) & ddp->idx_mask;
14699ba682f0Skxie@chelsio.com 	if (idx < ddp->nppods) {
14709ba682f0Skxie@chelsio.com 		struct cxgbi_gather_list *gl = ddp->gl_map[idx];
14719ba682f0Skxie@chelsio.com 		unsigned int npods;
14729ba682f0Skxie@chelsio.com 
14739ba682f0Skxie@chelsio.com 		if (!gl || !gl->nelem) {
14749ba682f0Skxie@chelsio.com 			pr_warn("tag 0x%x, idx %u, gl 0x%p, %u.\n",
14759ba682f0Skxie@chelsio.com 				tag, idx, gl, gl ? gl->nelem : 0);
14769ba682f0Skxie@chelsio.com 			return;
14779ba682f0Skxie@chelsio.com 		}
14789ba682f0Skxie@chelsio.com 		npods = (gl->nelem + PPOD_PAGES_MAX - 1) >> PPOD_PAGES_SHIFT;
14799ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_DDP,
14809ba682f0Skxie@chelsio.com 			"tag 0x%x, release idx %u, npods %u.\n",
14819ba682f0Skxie@chelsio.com 			tag, idx, npods);
14829ba682f0Skxie@chelsio.com 		cdev->csk_ddp_clear(chba, tag, idx, npods);
14839ba682f0Skxie@chelsio.com 		ddp_unmark_entries(ddp, idx, npods);
14849ba682f0Skxie@chelsio.com 		ddp_release_gl(gl, ddp->pdev);
14859ba682f0Skxie@chelsio.com 	} else
14869ba682f0Skxie@chelsio.com 		pr_warn("tag 0x%x, idx %u > max %u.\n", tag, idx, ddp->nppods);
14879ba682f0Skxie@chelsio.com }
14889ba682f0Skxie@chelsio.com 
14899ba682f0Skxie@chelsio.com static int ddp_tag_reserve(struct cxgbi_sock *csk, unsigned int tid,
14909ba682f0Skxie@chelsio.com 			   u32 sw_tag, u32 *tagp, struct cxgbi_gather_list *gl,
14919ba682f0Skxie@chelsio.com 			   gfp_t gfp)
14929ba682f0Skxie@chelsio.com {
14939ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev = csk->cdev;
14949ba682f0Skxie@chelsio.com 	struct cxgbi_ddp_info *ddp = cdev->ddp;
14959ba682f0Skxie@chelsio.com 	struct cxgbi_tag_format *tformat = &cdev->tag_format;
14969ba682f0Skxie@chelsio.com 	struct cxgbi_pagepod_hdr hdr;
14979ba682f0Skxie@chelsio.com 	unsigned int npods;
14989ba682f0Skxie@chelsio.com 	int idx = -1;
14999ba682f0Skxie@chelsio.com 	int err = -ENOMEM;
15009ba682f0Skxie@chelsio.com 	u32 tag;
15019ba682f0Skxie@chelsio.com 
15029ba682f0Skxie@chelsio.com 	npods = (gl->nelem + PPOD_PAGES_MAX - 1) >> PPOD_PAGES_SHIFT;
15039ba682f0Skxie@chelsio.com 	if (ddp->idx_last == ddp->nppods)
15049ba682f0Skxie@chelsio.com 		idx = ddp_find_unused_entries(ddp, 0, ddp->nppods,
15059ba682f0Skxie@chelsio.com 							npods, gl);
15069ba682f0Skxie@chelsio.com 	else {
15079ba682f0Skxie@chelsio.com 		idx = ddp_find_unused_entries(ddp, ddp->idx_last + 1,
15089ba682f0Skxie@chelsio.com 							ddp->nppods, npods,
15099ba682f0Skxie@chelsio.com 							gl);
15109ba682f0Skxie@chelsio.com 		if (idx < 0 && ddp->idx_last >= npods) {
15119ba682f0Skxie@chelsio.com 			idx = ddp_find_unused_entries(ddp, 0,
15129ba682f0Skxie@chelsio.com 				min(ddp->idx_last + npods, ddp->nppods),
15139ba682f0Skxie@chelsio.com 							npods, gl);
15149ba682f0Skxie@chelsio.com 		}
15159ba682f0Skxie@chelsio.com 	}
15169ba682f0Skxie@chelsio.com 	if (idx < 0) {
15179ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_DDP,
15189ba682f0Skxie@chelsio.com 			"xferlen %u, gl %u, npods %u NO DDP.\n",
15199ba682f0Skxie@chelsio.com 			gl->length, gl->nelem, npods);
15209ba682f0Skxie@chelsio.com 		return idx;
15219ba682f0Skxie@chelsio.com 	}
15229ba682f0Skxie@chelsio.com 
15239ba682f0Skxie@chelsio.com 	tag = cxgbi_ddp_tag_base(tformat, sw_tag);
15249ba682f0Skxie@chelsio.com 	tag |= idx << PPOD_IDX_SHIFT;
15259ba682f0Skxie@chelsio.com 
15269ba682f0Skxie@chelsio.com 	hdr.rsvd = 0;
15279ba682f0Skxie@chelsio.com 	hdr.vld_tid = htonl(PPOD_VALID_FLAG | PPOD_TID(tid));
15289ba682f0Skxie@chelsio.com 	hdr.pgsz_tag_clr = htonl(tag & ddp->rsvd_tag_mask);
15299ba682f0Skxie@chelsio.com 	hdr.max_offset = htonl(gl->length);
15309ba682f0Skxie@chelsio.com 	hdr.page_offset = htonl(gl->offset);
15319ba682f0Skxie@chelsio.com 
15329ba682f0Skxie@chelsio.com 	err = cdev->csk_ddp_set(csk, &hdr, idx, npods, gl);
1533b8ce8b59Skxie@chelsio.com 	if (err < 0)
15349ba682f0Skxie@chelsio.com 		goto unmark_entries;
15359ba682f0Skxie@chelsio.com 
15369ba682f0Skxie@chelsio.com 	ddp->idx_last = idx;
15379ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DDP,
15389ba682f0Skxie@chelsio.com 		"xfer %u, gl %u,%u, tid 0x%x, tag 0x%x->0x%x(%u,%u).\n",
15399ba682f0Skxie@chelsio.com 		gl->length, gl->nelem, gl->offset, tid, sw_tag, tag, idx,
15409ba682f0Skxie@chelsio.com 		npods);
15419ba682f0Skxie@chelsio.com 	*tagp = tag;
15429ba682f0Skxie@chelsio.com 	return 0;
15439ba682f0Skxie@chelsio.com 
15449ba682f0Skxie@chelsio.com unmark_entries:
15459ba682f0Skxie@chelsio.com 	ddp_unmark_entries(ddp, idx, npods);
15469ba682f0Skxie@chelsio.com 	return err;
15479ba682f0Skxie@chelsio.com }
15489ba682f0Skxie@chelsio.com 
15499ba682f0Skxie@chelsio.com int cxgbi_ddp_reserve(struct cxgbi_sock *csk, unsigned int *tagp,
15509ba682f0Skxie@chelsio.com 			unsigned int sw_tag, unsigned int xferlen,
15519ba682f0Skxie@chelsio.com 			struct scatterlist *sgl, unsigned int sgcnt, gfp_t gfp)
15529ba682f0Skxie@chelsio.com {
15539ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev = csk->cdev;
15549ba682f0Skxie@chelsio.com 	struct cxgbi_tag_format *tformat = &cdev->tag_format;
15559ba682f0Skxie@chelsio.com 	struct cxgbi_gather_list *gl;
15569ba682f0Skxie@chelsio.com 	int err;
15579ba682f0Skxie@chelsio.com 
15589ba682f0Skxie@chelsio.com 	if (page_idx >= DDP_PGIDX_MAX || !cdev->ddp ||
15599ba682f0Skxie@chelsio.com 	    xferlen < DDP_THRESHOLD) {
15609ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_DDP,
15619ba682f0Skxie@chelsio.com 			"pgidx %u, xfer %u, NO ddp.\n", page_idx, xferlen);
15629ba682f0Skxie@chelsio.com 		return -EINVAL;
15639ba682f0Skxie@chelsio.com 	}
15649ba682f0Skxie@chelsio.com 
15659ba682f0Skxie@chelsio.com 	if (!cxgbi_sw_tag_usable(tformat, sw_tag)) {
15669ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_DDP,
15679ba682f0Skxie@chelsio.com 			"sw_tag 0x%x NOT usable.\n", sw_tag);
15689ba682f0Skxie@chelsio.com 		return -EINVAL;
15699ba682f0Skxie@chelsio.com 	}
15709ba682f0Skxie@chelsio.com 
15719ba682f0Skxie@chelsio.com 	gl = ddp_make_gl(xferlen, sgl, sgcnt, cdev->pdev, gfp);
15729ba682f0Skxie@chelsio.com 	if (!gl)
15739ba682f0Skxie@chelsio.com 		return -ENOMEM;
15749ba682f0Skxie@chelsio.com 
15759ba682f0Skxie@chelsio.com 	err = ddp_tag_reserve(csk, csk->tid, sw_tag, tagp, gl, gfp);
15769ba682f0Skxie@chelsio.com 	if (err < 0)
15779ba682f0Skxie@chelsio.com 		ddp_release_gl(gl, cdev->pdev);
15789ba682f0Skxie@chelsio.com 
15799ba682f0Skxie@chelsio.com 	return err;
15809ba682f0Skxie@chelsio.com }
15819ba682f0Skxie@chelsio.com 
15829ba682f0Skxie@chelsio.com static void ddp_destroy(struct kref *kref)
15839ba682f0Skxie@chelsio.com {
15849ba682f0Skxie@chelsio.com 	struct cxgbi_ddp_info *ddp = container_of(kref,
15859ba682f0Skxie@chelsio.com 						struct cxgbi_ddp_info,
15869ba682f0Skxie@chelsio.com 						refcnt);
15879ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev = ddp->cdev;
15889ba682f0Skxie@chelsio.com 	int i = 0;
15899ba682f0Skxie@chelsio.com 
15909ba682f0Skxie@chelsio.com 	pr_info("kref 0, destroy ddp 0x%p, cdev 0x%p.\n", ddp, cdev);
15919ba682f0Skxie@chelsio.com 
15929ba682f0Skxie@chelsio.com 	while (i < ddp->nppods) {
15939ba682f0Skxie@chelsio.com 		struct cxgbi_gather_list *gl = ddp->gl_map[i];
15949ba682f0Skxie@chelsio.com 
15959ba682f0Skxie@chelsio.com 		if (gl) {
15969ba682f0Skxie@chelsio.com 			int npods = (gl->nelem + PPOD_PAGES_MAX - 1)
15979ba682f0Skxie@chelsio.com 					>> PPOD_PAGES_SHIFT;
15989ba682f0Skxie@chelsio.com 			pr_info("cdev 0x%p, ddp %d + %d.\n", cdev, i, npods);
15999ba682f0Skxie@chelsio.com 			kfree(gl);
16009ba682f0Skxie@chelsio.com 			i += npods;
16019ba682f0Skxie@chelsio.com 		} else
16029ba682f0Skxie@chelsio.com 			i++;
16039ba682f0Skxie@chelsio.com 	}
16049ba682f0Skxie@chelsio.com 	cxgbi_free_big_mem(ddp);
16059ba682f0Skxie@chelsio.com }
16069ba682f0Skxie@chelsio.com 
16079ba682f0Skxie@chelsio.com int cxgbi_ddp_cleanup(struct cxgbi_device *cdev)
16089ba682f0Skxie@chelsio.com {
16099ba682f0Skxie@chelsio.com 	struct cxgbi_ddp_info *ddp = cdev->ddp;
16109ba682f0Skxie@chelsio.com 
16119ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DDP,
16129ba682f0Skxie@chelsio.com 		"cdev 0x%p, release ddp 0x%p.\n", cdev, ddp);
16139ba682f0Skxie@chelsio.com 	cdev->ddp = NULL;
16149ba682f0Skxie@chelsio.com 	if (ddp)
16159ba682f0Skxie@chelsio.com 		return kref_put(&ddp->refcnt, ddp_destroy);
16169ba682f0Skxie@chelsio.com 	return 0;
16179ba682f0Skxie@chelsio.com }
16189ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_ddp_cleanup);
16199ba682f0Skxie@chelsio.com 
16209ba682f0Skxie@chelsio.com int cxgbi_ddp_init(struct cxgbi_device *cdev,
16219ba682f0Skxie@chelsio.com 		   unsigned int llimit, unsigned int ulimit,
16229ba682f0Skxie@chelsio.com 		   unsigned int max_txsz, unsigned int max_rxsz)
16239ba682f0Skxie@chelsio.com {
16249ba682f0Skxie@chelsio.com 	struct cxgbi_ddp_info *ddp;
16259ba682f0Skxie@chelsio.com 	unsigned int ppmax, bits;
16269ba682f0Skxie@chelsio.com 
16279ba682f0Skxie@chelsio.com 	ppmax = (ulimit - llimit + 1) >> PPOD_SIZE_SHIFT;
16289ba682f0Skxie@chelsio.com 	bits = __ilog2_u32(ppmax) + 1;
16299ba682f0Skxie@chelsio.com 	if (bits > PPOD_IDX_MAX_SIZE)
16309ba682f0Skxie@chelsio.com 		bits = PPOD_IDX_MAX_SIZE;
16319ba682f0Skxie@chelsio.com 	ppmax = (1 << (bits - 1)) - 1;
16329ba682f0Skxie@chelsio.com 
16339ba682f0Skxie@chelsio.com 	ddp = cxgbi_alloc_big_mem(sizeof(struct cxgbi_ddp_info) +
16349ba682f0Skxie@chelsio.com 				ppmax * (sizeof(struct cxgbi_gather_list *) +
16359ba682f0Skxie@chelsio.com 					 sizeof(struct sk_buff *)),
16369ba682f0Skxie@chelsio.com 				GFP_KERNEL);
16379ba682f0Skxie@chelsio.com 	if (!ddp) {
16389ba682f0Skxie@chelsio.com 		pr_warn("cdev 0x%p, ddp ppmax %u OOM.\n", cdev, ppmax);
16399ba682f0Skxie@chelsio.com 		return -ENOMEM;
16409ba682f0Skxie@chelsio.com 	}
16419ba682f0Skxie@chelsio.com 	ddp->gl_map = (struct cxgbi_gather_list **)(ddp + 1);
16429ba682f0Skxie@chelsio.com 	cdev->ddp = ddp;
16439ba682f0Skxie@chelsio.com 
16449ba682f0Skxie@chelsio.com 	spin_lock_init(&ddp->map_lock);
16459ba682f0Skxie@chelsio.com 	kref_init(&ddp->refcnt);
16469ba682f0Skxie@chelsio.com 
16479ba682f0Skxie@chelsio.com 	ddp->cdev = cdev;
16489ba682f0Skxie@chelsio.com 	ddp->pdev = cdev->pdev;
16499ba682f0Skxie@chelsio.com 	ddp->llimit = llimit;
16509ba682f0Skxie@chelsio.com 	ddp->ulimit = ulimit;
16519ba682f0Skxie@chelsio.com 	ddp->max_txsz = min_t(unsigned int, max_txsz, ULP2_MAX_PKT_SIZE);
16529ba682f0Skxie@chelsio.com 	ddp->max_rxsz = min_t(unsigned int, max_rxsz, ULP2_MAX_PKT_SIZE);
16539ba682f0Skxie@chelsio.com 	ddp->nppods = ppmax;
16549ba682f0Skxie@chelsio.com 	ddp->idx_last = ppmax;
16559ba682f0Skxie@chelsio.com 	ddp->idx_bits = bits;
16569ba682f0Skxie@chelsio.com 	ddp->idx_mask = (1 << bits) - 1;
16579ba682f0Skxie@chelsio.com 	ddp->rsvd_tag_mask = (1 << (bits + PPOD_IDX_SHIFT)) - 1;
16589ba682f0Skxie@chelsio.com 
16599ba682f0Skxie@chelsio.com 	cdev->tag_format.sw_bits = sw_tag_idx_bits + sw_tag_age_bits;
16609ba682f0Skxie@chelsio.com 	cdev->tag_format.rsvd_bits = ddp->idx_bits;
16619ba682f0Skxie@chelsio.com 	cdev->tag_format.rsvd_shift = PPOD_IDX_SHIFT;
16629ba682f0Skxie@chelsio.com 	cdev->tag_format.rsvd_mask = (1 << cdev->tag_format.rsvd_bits) - 1;
16639ba682f0Skxie@chelsio.com 
16649ba682f0Skxie@chelsio.com 	pr_info("%s tag format, sw %u, rsvd %u,%u, mask 0x%x.\n",
16659ba682f0Skxie@chelsio.com 		cdev->ports[0]->name, cdev->tag_format.sw_bits,
16669ba682f0Skxie@chelsio.com 		cdev->tag_format.rsvd_bits, cdev->tag_format.rsvd_shift,
16679ba682f0Skxie@chelsio.com 		cdev->tag_format.rsvd_mask);
16689ba682f0Skxie@chelsio.com 
16699ba682f0Skxie@chelsio.com 	cdev->tx_max_size = min_t(unsigned int, ULP2_MAX_PDU_PAYLOAD,
16709ba682f0Skxie@chelsio.com 				ddp->max_txsz - ISCSI_PDU_NONPAYLOAD_LEN);
16719ba682f0Skxie@chelsio.com 	cdev->rx_max_size = min_t(unsigned int, ULP2_MAX_PDU_PAYLOAD,
16729ba682f0Skxie@chelsio.com 				ddp->max_rxsz - ISCSI_PDU_NONPAYLOAD_LEN);
16739ba682f0Skxie@chelsio.com 
16749ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DDP,
16759ba682f0Skxie@chelsio.com 		"%s max payload size: %u/%u, %u/%u.\n",
16769ba682f0Skxie@chelsio.com 		cdev->ports[0]->name, cdev->tx_max_size, ddp->max_txsz,
16779ba682f0Skxie@chelsio.com 		cdev->rx_max_size, ddp->max_rxsz);
16789ba682f0Skxie@chelsio.com 	return 0;
16799ba682f0Skxie@chelsio.com }
16809ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_ddp_init);
16819ba682f0Skxie@chelsio.com 
16829ba682f0Skxie@chelsio.com /*
16839ba682f0Skxie@chelsio.com  * APIs interacting with open-iscsi libraries
16849ba682f0Skxie@chelsio.com  */
16859ba682f0Skxie@chelsio.com 
16869ba682f0Skxie@chelsio.com static unsigned char padding[4];
16879ba682f0Skxie@chelsio.com 
16889ba682f0Skxie@chelsio.com static void task_release_itt(struct iscsi_task *task, itt_t hdr_itt)
16899ba682f0Skxie@chelsio.com {
16909ba682f0Skxie@chelsio.com 	struct scsi_cmnd *sc = task->sc;
16919ba682f0Skxie@chelsio.com 	struct iscsi_tcp_conn *tcp_conn = task->conn->dd_data;
16929ba682f0Skxie@chelsio.com 	struct cxgbi_conn *cconn = tcp_conn->dd_data;
16939ba682f0Skxie@chelsio.com 	struct cxgbi_hba *chba = cconn->chba;
16949ba682f0Skxie@chelsio.com 	struct cxgbi_tag_format *tformat = &chba->cdev->tag_format;
16959ba682f0Skxie@chelsio.com 	u32 tag = ntohl((__force u32)hdr_itt);
16969ba682f0Skxie@chelsio.com 
16979ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DDP,
16989ba682f0Skxie@chelsio.com 		   "cdev 0x%p, release tag 0x%x.\n", chba->cdev, tag);
16999ba682f0Skxie@chelsio.com 	if (sc &&
17009ba682f0Skxie@chelsio.com 	    (scsi_bidi_cmnd(sc) || sc->sc_data_direction == DMA_FROM_DEVICE) &&
17019ba682f0Skxie@chelsio.com 	    cxgbi_is_ddp_tag(tformat, tag))
17029ba682f0Skxie@chelsio.com 		ddp_tag_release(chba, tag);
17039ba682f0Skxie@chelsio.com }
17049ba682f0Skxie@chelsio.com 
17059ba682f0Skxie@chelsio.com static int task_reserve_itt(struct iscsi_task *task, itt_t *hdr_itt)
17069ba682f0Skxie@chelsio.com {
17079ba682f0Skxie@chelsio.com 	struct scsi_cmnd *sc = task->sc;
17089ba682f0Skxie@chelsio.com 	struct iscsi_conn *conn = task->conn;
17099ba682f0Skxie@chelsio.com 	struct iscsi_session *sess = conn->session;
17109ba682f0Skxie@chelsio.com 	struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
17119ba682f0Skxie@chelsio.com 	struct cxgbi_conn *cconn = tcp_conn->dd_data;
17129ba682f0Skxie@chelsio.com 	struct cxgbi_hba *chba = cconn->chba;
17139ba682f0Skxie@chelsio.com 	struct cxgbi_tag_format *tformat = &chba->cdev->tag_format;
17149ba682f0Skxie@chelsio.com 	u32 sw_tag = (sess->age << cconn->task_idx_bits) | task->itt;
17159ba682f0Skxie@chelsio.com 	u32 tag = 0;
17169ba682f0Skxie@chelsio.com 	int err = -EINVAL;
17179ba682f0Skxie@chelsio.com 
17189ba682f0Skxie@chelsio.com 	if (sc &&
17199ba682f0Skxie@chelsio.com 	    (scsi_bidi_cmnd(sc) || sc->sc_data_direction == DMA_FROM_DEVICE)) {
17209ba682f0Skxie@chelsio.com 		err = cxgbi_ddp_reserve(cconn->cep->csk, &tag, sw_tag,
17219ba682f0Skxie@chelsio.com 					scsi_in(sc)->length,
17229ba682f0Skxie@chelsio.com 					scsi_in(sc)->table.sgl,
17239ba682f0Skxie@chelsio.com 					scsi_in(sc)->table.nents,
17249ba682f0Skxie@chelsio.com 					GFP_ATOMIC);
17259ba682f0Skxie@chelsio.com 		if (err < 0)
17269ba682f0Skxie@chelsio.com 			log_debug(1 << CXGBI_DBG_DDP,
17279ba682f0Skxie@chelsio.com 				"csk 0x%p, R task 0x%p, %u,%u, no ddp.\n",
17289ba682f0Skxie@chelsio.com 				cconn->cep->csk, task, scsi_in(sc)->length,
17299ba682f0Skxie@chelsio.com 				scsi_in(sc)->table.nents);
17309ba682f0Skxie@chelsio.com 	}
17319ba682f0Skxie@chelsio.com 
17329ba682f0Skxie@chelsio.com 	if (err < 0)
17339ba682f0Skxie@chelsio.com 		tag = cxgbi_set_non_ddp_tag(tformat, sw_tag);
17349ba682f0Skxie@chelsio.com 	/*  the itt need to sent in big-endian order */
17359ba682f0Skxie@chelsio.com 	*hdr_itt = (__force itt_t)htonl(tag);
17369ba682f0Skxie@chelsio.com 
17379ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DDP,
17389ba682f0Skxie@chelsio.com 		"cdev 0x%p, task 0x%p, 0x%x(0x%x,0x%x)->0x%x/0x%x.\n",
17399ba682f0Skxie@chelsio.com 		chba->cdev, task, sw_tag, task->itt, sess->age, tag, *hdr_itt);
17409ba682f0Skxie@chelsio.com 	return 0;
17419ba682f0Skxie@chelsio.com }
17429ba682f0Skxie@chelsio.com 
17439ba682f0Skxie@chelsio.com void cxgbi_parse_pdu_itt(struct iscsi_conn *conn, itt_t itt, int *idx, int *age)
17449ba682f0Skxie@chelsio.com {
17459ba682f0Skxie@chelsio.com 	struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
17469ba682f0Skxie@chelsio.com 	struct cxgbi_conn *cconn = tcp_conn->dd_data;
17479ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev = cconn->chba->cdev;
17489ba682f0Skxie@chelsio.com 	u32 tag = ntohl((__force u32) itt);
17499ba682f0Skxie@chelsio.com 	u32 sw_bits;
17509ba682f0Skxie@chelsio.com 
17519ba682f0Skxie@chelsio.com 	sw_bits = cxgbi_tag_nonrsvd_bits(&cdev->tag_format, tag);
17529ba682f0Skxie@chelsio.com 	if (idx)
17539ba682f0Skxie@chelsio.com 		*idx = sw_bits & ((1 << cconn->task_idx_bits) - 1);
17549ba682f0Skxie@chelsio.com 	if (age)
17559ba682f0Skxie@chelsio.com 		*age = (sw_bits >> cconn->task_idx_bits) & ISCSI_AGE_MASK;
17569ba682f0Skxie@chelsio.com 
17579ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_DDP,
17589ba682f0Skxie@chelsio.com 		"cdev 0x%p, tag 0x%x/0x%x, -> 0x%x(0x%x,0x%x).\n",
17599ba682f0Skxie@chelsio.com 		cdev, tag, itt, sw_bits, idx ? *idx : 0xFFFFF,
17609ba682f0Skxie@chelsio.com 		age ? *age : 0xFF);
17619ba682f0Skxie@chelsio.com }
17629ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_parse_pdu_itt);
17639ba682f0Skxie@chelsio.com 
17649ba682f0Skxie@chelsio.com void cxgbi_conn_tx_open(struct cxgbi_sock *csk)
17659ba682f0Skxie@chelsio.com {
17669ba682f0Skxie@chelsio.com 	struct iscsi_conn *conn = csk->user_data;
17679ba682f0Skxie@chelsio.com 
17689ba682f0Skxie@chelsio.com 	if (conn) {
17699ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_SOCK,
17709ba682f0Skxie@chelsio.com 			"csk 0x%p, cid %d.\n", csk, conn->id);
17719ba682f0Skxie@chelsio.com 		iscsi_conn_queue_work(conn);
17729ba682f0Skxie@chelsio.com 	}
17739ba682f0Skxie@chelsio.com }
17749ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_conn_tx_open);
17759ba682f0Skxie@chelsio.com 
17769ba682f0Skxie@chelsio.com /*
17779ba682f0Skxie@chelsio.com  * pdu receive, interact with libiscsi_tcp
17789ba682f0Skxie@chelsio.com  */
17799ba682f0Skxie@chelsio.com static inline int read_pdu_skb(struct iscsi_conn *conn,
17809ba682f0Skxie@chelsio.com 			       struct sk_buff *skb,
17819ba682f0Skxie@chelsio.com 			       unsigned int offset,
17829ba682f0Skxie@chelsio.com 			       int offloaded)
17839ba682f0Skxie@chelsio.com {
17849ba682f0Skxie@chelsio.com 	int status = 0;
17859ba682f0Skxie@chelsio.com 	int bytes_read;
17869ba682f0Skxie@chelsio.com 
17879ba682f0Skxie@chelsio.com 	bytes_read = iscsi_tcp_recv_skb(conn, skb, offset, offloaded, &status);
17889ba682f0Skxie@chelsio.com 	switch (status) {
17899ba682f0Skxie@chelsio.com 	case ISCSI_TCP_CONN_ERR:
17909ba682f0Skxie@chelsio.com 		pr_info("skb 0x%p, off %u, %d, TCP_ERR.\n",
17919ba682f0Skxie@chelsio.com 			  skb, offset, offloaded);
17929ba682f0Skxie@chelsio.com 		return -EIO;
17939ba682f0Skxie@chelsio.com 	case ISCSI_TCP_SUSPENDED:
17949ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_PDU_RX,
17959ba682f0Skxie@chelsio.com 			"skb 0x%p, off %u, %d, TCP_SUSPEND, rc %d.\n",
17969ba682f0Skxie@chelsio.com 			skb, offset, offloaded, bytes_read);
17979ba682f0Skxie@chelsio.com 		/* no transfer - just have caller flush queue */
17989ba682f0Skxie@chelsio.com 		return bytes_read;
17999ba682f0Skxie@chelsio.com 	case ISCSI_TCP_SKB_DONE:
18009ba682f0Skxie@chelsio.com 		pr_info("skb 0x%p, off %u, %d, TCP_SKB_DONE.\n",
18019ba682f0Skxie@chelsio.com 			skb, offset, offloaded);
18029ba682f0Skxie@chelsio.com 		/*
18039ba682f0Skxie@chelsio.com 		 * pdus should always fit in the skb and we should get
18049ba682f0Skxie@chelsio.com 		 * segment done notifcation.
18059ba682f0Skxie@chelsio.com 		 */
18069ba682f0Skxie@chelsio.com 		iscsi_conn_printk(KERN_ERR, conn, "Invalid pdu or skb.");
18079ba682f0Skxie@chelsio.com 		return -EFAULT;
18089ba682f0Skxie@chelsio.com 	case ISCSI_TCP_SEGMENT_DONE:
18099ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_PDU_RX,
18109ba682f0Skxie@chelsio.com 			"skb 0x%p, off %u, %d, TCP_SEG_DONE, rc %d.\n",
18119ba682f0Skxie@chelsio.com 			skb, offset, offloaded, bytes_read);
18129ba682f0Skxie@chelsio.com 		return bytes_read;
18139ba682f0Skxie@chelsio.com 	default:
18149ba682f0Skxie@chelsio.com 		pr_info("skb 0x%p, off %u, %d, invalid status %d.\n",
18159ba682f0Skxie@chelsio.com 			skb, offset, offloaded, status);
18169ba682f0Skxie@chelsio.com 		return -EINVAL;
18179ba682f0Skxie@chelsio.com 	}
18189ba682f0Skxie@chelsio.com }
18199ba682f0Skxie@chelsio.com 
18209ba682f0Skxie@chelsio.com static int skb_read_pdu_bhs(struct iscsi_conn *conn, struct sk_buff *skb)
18219ba682f0Skxie@chelsio.com {
18229ba682f0Skxie@chelsio.com 	struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
18239ba682f0Skxie@chelsio.com 
18249ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_PDU_RX,
18259ba682f0Skxie@chelsio.com 		"conn 0x%p, skb 0x%p, len %u, flag 0x%lx.\n",
18269ba682f0Skxie@chelsio.com 		conn, skb, skb->len, cxgbi_skcb_flags(skb));
18279ba682f0Skxie@chelsio.com 
18289ba682f0Skxie@chelsio.com 	if (!iscsi_tcp_recv_segment_is_hdr(tcp_conn)) {
18299ba682f0Skxie@chelsio.com 		pr_info("conn 0x%p, skb 0x%p, not hdr.\n", conn, skb);
18309ba682f0Skxie@chelsio.com 		iscsi_conn_failure(conn, ISCSI_ERR_PROTO);
18319ba682f0Skxie@chelsio.com 		return -EIO;
18329ba682f0Skxie@chelsio.com 	}
18339ba682f0Skxie@chelsio.com 
18349ba682f0Skxie@chelsio.com 	if (conn->hdrdgst_en &&
18359ba682f0Skxie@chelsio.com 	    cxgbi_skcb_test_flag(skb, SKCBF_RX_HCRC_ERR)) {
18369ba682f0Skxie@chelsio.com 		pr_info("conn 0x%p, skb 0x%p, hcrc.\n", conn, skb);
18379ba682f0Skxie@chelsio.com 		iscsi_conn_failure(conn, ISCSI_ERR_HDR_DGST);
18389ba682f0Skxie@chelsio.com 		return -EIO;
18399ba682f0Skxie@chelsio.com 	}
18409ba682f0Skxie@chelsio.com 
18419ba682f0Skxie@chelsio.com 	return read_pdu_skb(conn, skb, 0, 0);
18429ba682f0Skxie@chelsio.com }
18439ba682f0Skxie@chelsio.com 
18449ba682f0Skxie@chelsio.com static int skb_read_pdu_data(struct iscsi_conn *conn, struct sk_buff *lskb,
18459ba682f0Skxie@chelsio.com 			     struct sk_buff *skb, unsigned int offset)
18469ba682f0Skxie@chelsio.com {
18479ba682f0Skxie@chelsio.com 	struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
18489ba682f0Skxie@chelsio.com 	bool offloaded = 0;
18499ba682f0Skxie@chelsio.com 	int opcode = tcp_conn->in.hdr->opcode & ISCSI_OPCODE_MASK;
18509ba682f0Skxie@chelsio.com 
18519ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_PDU_RX,
18529ba682f0Skxie@chelsio.com 		"conn 0x%p, skb 0x%p, len %u, flag 0x%lx.\n",
18539ba682f0Skxie@chelsio.com 		conn, skb, skb->len, cxgbi_skcb_flags(skb));
18549ba682f0Skxie@chelsio.com 
18559ba682f0Skxie@chelsio.com 	if (conn->datadgst_en &&
18569ba682f0Skxie@chelsio.com 	    cxgbi_skcb_test_flag(lskb, SKCBF_RX_DCRC_ERR)) {
18579ba682f0Skxie@chelsio.com 		pr_info("conn 0x%p, skb 0x%p, dcrc 0x%lx.\n",
18589ba682f0Skxie@chelsio.com 			conn, lskb, cxgbi_skcb_flags(lskb));
18599ba682f0Skxie@chelsio.com 		iscsi_conn_failure(conn, ISCSI_ERR_DATA_DGST);
18609ba682f0Skxie@chelsio.com 		return -EIO;
18619ba682f0Skxie@chelsio.com 	}
18629ba682f0Skxie@chelsio.com 
18639ba682f0Skxie@chelsio.com 	if (iscsi_tcp_recv_segment_is_hdr(tcp_conn))
18649ba682f0Skxie@chelsio.com 		return 0;
18659ba682f0Skxie@chelsio.com 
18669ba682f0Skxie@chelsio.com 	/* coalesced, add header digest length */
18679ba682f0Skxie@chelsio.com 	if (lskb == skb && conn->hdrdgst_en)
18689ba682f0Skxie@chelsio.com 		offset += ISCSI_DIGEST_SIZE;
18699ba682f0Skxie@chelsio.com 
18709ba682f0Skxie@chelsio.com 	if (cxgbi_skcb_test_flag(lskb, SKCBF_RX_DATA_DDPD))
18719ba682f0Skxie@chelsio.com 		offloaded = 1;
18729ba682f0Skxie@chelsio.com 
18739ba682f0Skxie@chelsio.com 	if (opcode == ISCSI_OP_SCSI_DATA_IN)
18749ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_PDU_RX,
18759ba682f0Skxie@chelsio.com 			"skb 0x%p, op 0x%x, itt 0x%x, %u %s ddp'ed.\n",
18769ba682f0Skxie@chelsio.com 			skb, opcode, ntohl(tcp_conn->in.hdr->itt),
18779ba682f0Skxie@chelsio.com 			tcp_conn->in.datalen, offloaded ? "is" : "not");
18789ba682f0Skxie@chelsio.com 
18799ba682f0Skxie@chelsio.com 	return read_pdu_skb(conn, skb, offset, offloaded);
18809ba682f0Skxie@chelsio.com }
18819ba682f0Skxie@chelsio.com 
18829ba682f0Skxie@chelsio.com static void csk_return_rx_credits(struct cxgbi_sock *csk, int copied)
18839ba682f0Skxie@chelsio.com {
18849ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev = csk->cdev;
18859ba682f0Skxie@chelsio.com 	int must_send;
18869ba682f0Skxie@chelsio.com 	u32 credits;
18879ba682f0Skxie@chelsio.com 
18889ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_PDU_RX,
1889fc385045SHans Wennborg 		"csk 0x%p,%u,0x%lx,%u, seq %u, wup %u, thre %u, %u.\n",
18909ba682f0Skxie@chelsio.com 		csk, csk->state, csk->flags, csk->tid, csk->copied_seq,
18919ba682f0Skxie@chelsio.com 		csk->rcv_wup, cdev->rx_credit_thres,
189281daf10cSKaren Xie 		csk->rcv_win);
18939ba682f0Skxie@chelsio.com 
18949ba682f0Skxie@chelsio.com 	if (csk->state != CTP_ESTABLISHED)
18959ba682f0Skxie@chelsio.com 		return;
18969ba682f0Skxie@chelsio.com 
18979ba682f0Skxie@chelsio.com 	credits = csk->copied_seq - csk->rcv_wup;
18989ba682f0Skxie@chelsio.com 	if (unlikely(!credits))
18999ba682f0Skxie@chelsio.com 		return;
19009ba682f0Skxie@chelsio.com 	if (unlikely(cdev->rx_credit_thres == 0))
19019ba682f0Skxie@chelsio.com 		return;
19029ba682f0Skxie@chelsio.com 
190381daf10cSKaren Xie 	must_send = credits + 16384 >= csk->rcv_win;
19049ba682f0Skxie@chelsio.com 	if (must_send || credits >= cdev->rx_credit_thres)
19059ba682f0Skxie@chelsio.com 		csk->rcv_wup += cdev->csk_send_rx_credits(csk, credits);
19069ba682f0Skxie@chelsio.com }
19079ba682f0Skxie@chelsio.com 
19089ba682f0Skxie@chelsio.com void cxgbi_conn_pdu_ready(struct cxgbi_sock *csk)
19099ba682f0Skxie@chelsio.com {
19109ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev = csk->cdev;
19119ba682f0Skxie@chelsio.com 	struct iscsi_conn *conn = csk->user_data;
19129ba682f0Skxie@chelsio.com 	struct sk_buff *skb;
19139ba682f0Skxie@chelsio.com 	unsigned int read = 0;
19149ba682f0Skxie@chelsio.com 	int err = 0;
19159ba682f0Skxie@chelsio.com 
19169ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_PDU_RX,
19179ba682f0Skxie@chelsio.com 		"csk 0x%p, conn 0x%p.\n", csk, conn);
19189ba682f0Skxie@chelsio.com 
19199ba682f0Skxie@chelsio.com 	if (unlikely(!conn || conn->suspend_rx)) {
19209ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_PDU_RX,
19219ba682f0Skxie@chelsio.com 			"csk 0x%p, conn 0x%p, id %d, suspend_rx %lu!\n",
19229ba682f0Skxie@chelsio.com 			csk, conn, conn ? conn->id : 0xFF,
19239ba682f0Skxie@chelsio.com 			conn ? conn->suspend_rx : 0xFF);
19249ba682f0Skxie@chelsio.com 		return;
19259ba682f0Skxie@chelsio.com 	}
19269ba682f0Skxie@chelsio.com 
19279ba682f0Skxie@chelsio.com 	while (!err) {
19289ba682f0Skxie@chelsio.com 		skb = skb_peek(&csk->receive_queue);
19299ba682f0Skxie@chelsio.com 		if (!skb ||
19309ba682f0Skxie@chelsio.com 		    !(cxgbi_skcb_test_flag(skb, SKCBF_RX_STATUS))) {
19319ba682f0Skxie@chelsio.com 			if (skb)
19329ba682f0Skxie@chelsio.com 				log_debug(1 << CXGBI_DBG_PDU_RX,
19339ba682f0Skxie@chelsio.com 					"skb 0x%p, NOT ready 0x%lx.\n",
19349ba682f0Skxie@chelsio.com 					skb, cxgbi_skcb_flags(skb));
19359ba682f0Skxie@chelsio.com 			break;
19369ba682f0Skxie@chelsio.com 		}
19379ba682f0Skxie@chelsio.com 		__skb_unlink(skb, &csk->receive_queue);
19389ba682f0Skxie@chelsio.com 
19399ba682f0Skxie@chelsio.com 		read += cxgbi_skcb_rx_pdulen(skb);
19409ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_PDU_RX,
19419ba682f0Skxie@chelsio.com 			"csk 0x%p, skb 0x%p,%u,f 0x%lx, pdu len %u.\n",
19429ba682f0Skxie@chelsio.com 			csk, skb, skb->len, cxgbi_skcb_flags(skb),
19439ba682f0Skxie@chelsio.com 			cxgbi_skcb_rx_pdulen(skb));
19449ba682f0Skxie@chelsio.com 
19459ba682f0Skxie@chelsio.com 		if (cxgbi_skcb_test_flag(skb, SKCBF_RX_COALESCED)) {
19469ba682f0Skxie@chelsio.com 			err = skb_read_pdu_bhs(conn, skb);
1947e3d2ad8cSkxie@chelsio.com 			if (err < 0) {
1948e3d2ad8cSkxie@chelsio.com 				pr_err("coalesced bhs, csk 0x%p, skb 0x%p,%u, "
1949e3d2ad8cSkxie@chelsio.com 					"f 0x%lx, plen %u.\n",
1950e3d2ad8cSkxie@chelsio.com 					csk, skb, skb->len,
1951e3d2ad8cSkxie@chelsio.com 					cxgbi_skcb_flags(skb),
1952e3d2ad8cSkxie@chelsio.com 					cxgbi_skcb_rx_pdulen(skb));
1953e3d2ad8cSkxie@chelsio.com 				goto skb_done;
1954e3d2ad8cSkxie@chelsio.com 			}
19559ba682f0Skxie@chelsio.com 			err = skb_read_pdu_data(conn, skb, skb,
19569ba682f0Skxie@chelsio.com 						err + cdev->skb_rx_extra);
1957e3d2ad8cSkxie@chelsio.com 			if (err < 0)
1958e3d2ad8cSkxie@chelsio.com 				pr_err("coalesced data, csk 0x%p, skb 0x%p,%u, "
1959e3d2ad8cSkxie@chelsio.com 					"f 0x%lx, plen %u.\n",
1960e3d2ad8cSkxie@chelsio.com 					csk, skb, skb->len,
1961e3d2ad8cSkxie@chelsio.com 					cxgbi_skcb_flags(skb),
1962e3d2ad8cSkxie@chelsio.com 					cxgbi_skcb_rx_pdulen(skb));
19639ba682f0Skxie@chelsio.com 		} else {
19649ba682f0Skxie@chelsio.com 			err = skb_read_pdu_bhs(conn, skb);
1965e3d2ad8cSkxie@chelsio.com 			if (err < 0) {
1966e3d2ad8cSkxie@chelsio.com 				pr_err("bhs, csk 0x%p, skb 0x%p,%u, "
1967e3d2ad8cSkxie@chelsio.com 					"f 0x%lx, plen %u.\n",
1968e3d2ad8cSkxie@chelsio.com 					csk, skb, skb->len,
1969e3d2ad8cSkxie@chelsio.com 					cxgbi_skcb_flags(skb),
1970e3d2ad8cSkxie@chelsio.com 					cxgbi_skcb_rx_pdulen(skb));
1971e3d2ad8cSkxie@chelsio.com 				goto skb_done;
1972e3d2ad8cSkxie@chelsio.com 			}
1973e3d2ad8cSkxie@chelsio.com 
19749ba682f0Skxie@chelsio.com 			if (cxgbi_skcb_test_flag(skb, SKCBF_RX_DATA)) {
19759ba682f0Skxie@chelsio.com 				struct sk_buff *dskb;
19769ba682f0Skxie@chelsio.com 
19779ba682f0Skxie@chelsio.com 				dskb = skb_peek(&csk->receive_queue);
19789ba682f0Skxie@chelsio.com 				if (!dskb) {
1979e3d2ad8cSkxie@chelsio.com 					pr_err("csk 0x%p, skb 0x%p,%u, f 0x%lx,"
1980e3d2ad8cSkxie@chelsio.com 						" plen %u, NO data.\n",
1981e3d2ad8cSkxie@chelsio.com 						csk, skb, skb->len,
1982e3d2ad8cSkxie@chelsio.com 						cxgbi_skcb_flags(skb),
1983e3d2ad8cSkxie@chelsio.com 						cxgbi_skcb_rx_pdulen(skb));
1984e3d2ad8cSkxie@chelsio.com 					err = -EIO;
1985e3d2ad8cSkxie@chelsio.com 					goto skb_done;
19869ba682f0Skxie@chelsio.com 				}
19879ba682f0Skxie@chelsio.com 				__skb_unlink(dskb, &csk->receive_queue);
19889ba682f0Skxie@chelsio.com 
19899ba682f0Skxie@chelsio.com 				err = skb_read_pdu_data(conn, skb, dskb, 0);
1990e3d2ad8cSkxie@chelsio.com 				if (err < 0)
1991e3d2ad8cSkxie@chelsio.com 					pr_err("data, csk 0x%p, skb 0x%p,%u, "
1992e3d2ad8cSkxie@chelsio.com 						"f 0x%lx, plen %u, dskb 0x%p,"
1993e3d2ad8cSkxie@chelsio.com 						"%u.\n",
1994e3d2ad8cSkxie@chelsio.com 						csk, skb, skb->len,
1995e3d2ad8cSkxie@chelsio.com 						cxgbi_skcb_flags(skb),
1996e3d2ad8cSkxie@chelsio.com 						cxgbi_skcb_rx_pdulen(skb),
1997e3d2ad8cSkxie@chelsio.com 						dskb, dskb->len);
19989ba682f0Skxie@chelsio.com 				__kfree_skb(dskb);
19999ba682f0Skxie@chelsio.com 			} else
20009ba682f0Skxie@chelsio.com 				err = skb_read_pdu_data(conn, skb, skb, 0);
20019ba682f0Skxie@chelsio.com 		}
2002e3d2ad8cSkxie@chelsio.com skb_done:
2003e3d2ad8cSkxie@chelsio.com 		__kfree_skb(skb);
2004e3d2ad8cSkxie@chelsio.com 
20059ba682f0Skxie@chelsio.com 		if (err < 0)
20069ba682f0Skxie@chelsio.com 			break;
20079ba682f0Skxie@chelsio.com 	}
20089ba682f0Skxie@chelsio.com 
20099ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_PDU_RX, "csk 0x%p, read %u.\n", csk, read);
20109ba682f0Skxie@chelsio.com 	if (read) {
20119ba682f0Skxie@chelsio.com 		csk->copied_seq += read;
20129ba682f0Skxie@chelsio.com 		csk_return_rx_credits(csk, read);
20139ba682f0Skxie@chelsio.com 		conn->rxdata_octets += read;
20149ba682f0Skxie@chelsio.com 	}
20159ba682f0Skxie@chelsio.com 
20169ba682f0Skxie@chelsio.com 	if (err < 0) {
2017e3d2ad8cSkxie@chelsio.com 		pr_info("csk 0x%p, 0x%p, rx failed %d, read %u.\n",
2018e3d2ad8cSkxie@chelsio.com 			csk, conn, err, read);
20199ba682f0Skxie@chelsio.com 		iscsi_conn_failure(conn, ISCSI_ERR_CONN_FAILED);
20209ba682f0Skxie@chelsio.com 	}
20219ba682f0Skxie@chelsio.com }
20229ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_conn_pdu_ready);
20239ba682f0Skxie@chelsio.com 
20249ba682f0Skxie@chelsio.com static int sgl_seek_offset(struct scatterlist *sgl, unsigned int sgcnt,
20259ba682f0Skxie@chelsio.com 				unsigned int offset, unsigned int *off,
20269ba682f0Skxie@chelsio.com 				struct scatterlist **sgp)
20279ba682f0Skxie@chelsio.com {
20289ba682f0Skxie@chelsio.com 	int i;
20299ba682f0Skxie@chelsio.com 	struct scatterlist *sg;
20309ba682f0Skxie@chelsio.com 
20319ba682f0Skxie@chelsio.com 	for_each_sg(sgl, sg, sgcnt, i) {
20329ba682f0Skxie@chelsio.com 		if (offset < sg->length) {
20339ba682f0Skxie@chelsio.com 			*off = offset;
20349ba682f0Skxie@chelsio.com 			*sgp = sg;
20359ba682f0Skxie@chelsio.com 			return 0;
20369ba682f0Skxie@chelsio.com 		}
20379ba682f0Skxie@chelsio.com 		offset -= sg->length;
20389ba682f0Skxie@chelsio.com 	}
20399ba682f0Skxie@chelsio.com 	return -EFAULT;
20409ba682f0Skxie@chelsio.com }
20419ba682f0Skxie@chelsio.com 
20429ba682f0Skxie@chelsio.com static int sgl_read_to_frags(struct scatterlist *sg, unsigned int sgoffset,
20436a39a16aSIan Campbell 				unsigned int dlen, struct page_frag *frags,
20449ba682f0Skxie@chelsio.com 				int frag_max)
20459ba682f0Skxie@chelsio.com {
20469ba682f0Skxie@chelsio.com 	unsigned int datalen = dlen;
20479ba682f0Skxie@chelsio.com 	unsigned int sglen = sg->length - sgoffset;
20489ba682f0Skxie@chelsio.com 	struct page *page = sg_page(sg);
20499ba682f0Skxie@chelsio.com 	int i;
20509ba682f0Skxie@chelsio.com 
20519ba682f0Skxie@chelsio.com 	i = 0;
20529ba682f0Skxie@chelsio.com 	do {
20539ba682f0Skxie@chelsio.com 		unsigned int copy;
20549ba682f0Skxie@chelsio.com 
20559ba682f0Skxie@chelsio.com 		if (!sglen) {
20569ba682f0Skxie@chelsio.com 			sg = sg_next(sg);
20579ba682f0Skxie@chelsio.com 			if (!sg) {
20589ba682f0Skxie@chelsio.com 				pr_warn("sg %d NULL, len %u/%u.\n",
20599ba682f0Skxie@chelsio.com 					i, datalen, dlen);
20609ba682f0Skxie@chelsio.com 				return -EINVAL;
20619ba682f0Skxie@chelsio.com 			}
20629ba682f0Skxie@chelsio.com 			sgoffset = 0;
20639ba682f0Skxie@chelsio.com 			sglen = sg->length;
20649ba682f0Skxie@chelsio.com 			page = sg_page(sg);
20659ba682f0Skxie@chelsio.com 
20669ba682f0Skxie@chelsio.com 		}
20679ba682f0Skxie@chelsio.com 		copy = min(datalen, sglen);
20689ba682f0Skxie@chelsio.com 		if (i && page == frags[i - 1].page &&
20699ba682f0Skxie@chelsio.com 		    sgoffset + sg->offset ==
20706a39a16aSIan Campbell 			frags[i - 1].offset + frags[i - 1].size) {
20716a39a16aSIan Campbell 			frags[i - 1].size += copy;
20729ba682f0Skxie@chelsio.com 		} else {
20739ba682f0Skxie@chelsio.com 			if (i >= frag_max) {
20749ba682f0Skxie@chelsio.com 				pr_warn("too many pages %u, dlen %u.\n",
20759ba682f0Skxie@chelsio.com 					frag_max, dlen);
20769ba682f0Skxie@chelsio.com 				return -EINVAL;
20779ba682f0Skxie@chelsio.com 			}
20789ba682f0Skxie@chelsio.com 
20799ba682f0Skxie@chelsio.com 			frags[i].page = page;
20806a39a16aSIan Campbell 			frags[i].offset = sg->offset + sgoffset;
20816a39a16aSIan Campbell 			frags[i].size = copy;
20829ba682f0Skxie@chelsio.com 			i++;
20839ba682f0Skxie@chelsio.com 		}
20849ba682f0Skxie@chelsio.com 		datalen -= copy;
20859ba682f0Skxie@chelsio.com 		sgoffset += copy;
20869ba682f0Skxie@chelsio.com 		sglen -= copy;
20879ba682f0Skxie@chelsio.com 	} while (datalen);
20889ba682f0Skxie@chelsio.com 
20899ba682f0Skxie@chelsio.com 	return i;
20909ba682f0Skxie@chelsio.com }
20919ba682f0Skxie@chelsio.com 
20929ba682f0Skxie@chelsio.com int cxgbi_conn_alloc_pdu(struct iscsi_task *task, u8 opcode)
20939ba682f0Skxie@chelsio.com {
20949ba682f0Skxie@chelsio.com 	struct iscsi_tcp_conn *tcp_conn = task->conn->dd_data;
20959ba682f0Skxie@chelsio.com 	struct cxgbi_conn *cconn = tcp_conn->dd_data;
20969ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev = cconn->chba->cdev;
20979ba682f0Skxie@chelsio.com 	struct iscsi_conn *conn = task->conn;
20989ba682f0Skxie@chelsio.com 	struct iscsi_tcp_task *tcp_task = task->dd_data;
2099e3d2ad8cSkxie@chelsio.com 	struct cxgbi_task_data *tdata = iscsi_task_cxgbi_data(task);
21009ba682f0Skxie@chelsio.com 	struct scsi_cmnd *sc = task->sc;
21019ba682f0Skxie@chelsio.com 	int headroom = SKB_TX_ISCSI_PDU_HEADER_MAX;
21029ba682f0Skxie@chelsio.com 
21039ba682f0Skxie@chelsio.com 	tcp_task->dd_data = tdata;
21049ba682f0Skxie@chelsio.com 	task->hdr = NULL;
21059ba682f0Skxie@chelsio.com 
21069ba682f0Skxie@chelsio.com 	if (SKB_MAX_HEAD(cdev->skb_tx_rsvd) > (512 * MAX_SKB_FRAGS) &&
21079ba682f0Skxie@chelsio.com 	    (opcode == ISCSI_OP_SCSI_DATA_OUT ||
21089ba682f0Skxie@chelsio.com 	     (opcode == ISCSI_OP_SCSI_CMD &&
21099ba682f0Skxie@chelsio.com 	      (scsi_bidi_cmnd(sc) || sc->sc_data_direction == DMA_TO_DEVICE))))
21109ba682f0Skxie@chelsio.com 		/* data could goes into skb head */
21119ba682f0Skxie@chelsio.com 		headroom += min_t(unsigned int,
21129ba682f0Skxie@chelsio.com 				SKB_MAX_HEAD(cdev->skb_tx_rsvd),
21139ba682f0Skxie@chelsio.com 				conn->max_xmit_dlength);
21149ba682f0Skxie@chelsio.com 
21159ba682f0Skxie@chelsio.com 	tdata->skb = alloc_skb(cdev->skb_tx_rsvd + headroom, GFP_ATOMIC);
21169ba682f0Skxie@chelsio.com 	if (!tdata->skb) {
211700c4a09bSThadeu Lima de Souza Cascardo 		struct cxgbi_sock *csk = cconn->cep->csk;
211800c4a09bSThadeu Lima de Souza Cascardo 		struct net_device *ndev = cdev->ports[csk->port_id];
211900c4a09bSThadeu Lima de Souza Cascardo 		ndev->stats.tx_dropped++;
21209ba682f0Skxie@chelsio.com 		return -ENOMEM;
21219ba682f0Skxie@chelsio.com 	}
21229ba682f0Skxie@chelsio.com 
21239ba682f0Skxie@chelsio.com 	skb_reserve(tdata->skb, cdev->skb_tx_rsvd);
21249ba682f0Skxie@chelsio.com 	task->hdr = (struct iscsi_hdr *)tdata->skb->data;
21259ba682f0Skxie@chelsio.com 	task->hdr_max = SKB_TX_ISCSI_PDU_HEADER_MAX; /* BHS + AHS */
21269ba682f0Skxie@chelsio.com 
21279ba682f0Skxie@chelsio.com 	/* data_out uses scsi_cmd's itt */
21289ba682f0Skxie@chelsio.com 	if (opcode != ISCSI_OP_SCSI_DATA_OUT)
21299ba682f0Skxie@chelsio.com 		task_reserve_itt(task, &task->hdr->itt);
21309ba682f0Skxie@chelsio.com 
21319ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_PDU_TX,
21329ba682f0Skxie@chelsio.com 		"task 0x%p, op 0x%x, skb 0x%p,%u+%u/%u, itt 0x%x.\n",
21339ba682f0Skxie@chelsio.com 		task, opcode, tdata->skb, cdev->skb_tx_rsvd, headroom,
21349ba682f0Skxie@chelsio.com 		conn->max_xmit_dlength, ntohl(task->hdr->itt));
21359ba682f0Skxie@chelsio.com 
21369ba682f0Skxie@chelsio.com 	return 0;
21379ba682f0Skxie@chelsio.com }
21389ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_conn_alloc_pdu);
21399ba682f0Skxie@chelsio.com 
21409ba682f0Skxie@chelsio.com static inline void tx_skb_setmode(struct sk_buff *skb, int hcrc, int dcrc)
21419ba682f0Skxie@chelsio.com {
2142c343a01cSkxie@chelsio.com 	if (hcrc || dcrc) {
21439ba682f0Skxie@chelsio.com 		u8 submode = 0;
21449ba682f0Skxie@chelsio.com 
21459ba682f0Skxie@chelsio.com 		if (hcrc)
21469ba682f0Skxie@chelsio.com 			submode |= 1;
21479ba682f0Skxie@chelsio.com 		if (dcrc)
21489ba682f0Skxie@chelsio.com 			submode |= 2;
21499ba682f0Skxie@chelsio.com 		cxgbi_skcb_ulp_mode(skb) = (ULP2_MODE_ISCSI << 4) | submode;
2150c343a01cSkxie@chelsio.com 	} else
2151c343a01cSkxie@chelsio.com 		cxgbi_skcb_ulp_mode(skb) = 0;
21529ba682f0Skxie@chelsio.com }
21539ba682f0Skxie@chelsio.com 
21549ba682f0Skxie@chelsio.com int cxgbi_conn_init_pdu(struct iscsi_task *task, unsigned int offset,
21559ba682f0Skxie@chelsio.com 			      unsigned int count)
21569ba682f0Skxie@chelsio.com {
21579ba682f0Skxie@chelsio.com 	struct iscsi_conn *conn = task->conn;
2158e3d2ad8cSkxie@chelsio.com 	struct cxgbi_task_data *tdata = iscsi_task_cxgbi_data(task);
21599ba682f0Skxie@chelsio.com 	struct sk_buff *skb = tdata->skb;
21609ba682f0Skxie@chelsio.com 	unsigned int datalen = count;
21619ba682f0Skxie@chelsio.com 	int i, padlen = iscsi_padding(count);
21629ba682f0Skxie@chelsio.com 	struct page *pg;
21639ba682f0Skxie@chelsio.com 
21649ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_PDU_TX,
21659ba682f0Skxie@chelsio.com 		"task 0x%p,0x%p, skb 0x%p, 0x%x,0x%x,0x%x, %u+%u.\n",
21669ba682f0Skxie@chelsio.com 		task, task->sc, skb, (*skb->data) & ISCSI_OPCODE_MASK,
21679ba682f0Skxie@chelsio.com 		ntohl(task->cmdsn), ntohl(task->hdr->itt), offset, count);
21689ba682f0Skxie@chelsio.com 
21699ba682f0Skxie@chelsio.com 	skb_put(skb, task->hdr_len);
21709ba682f0Skxie@chelsio.com 	tx_skb_setmode(skb, conn->hdrdgst_en, datalen ? conn->datadgst_en : 0);
21719ba682f0Skxie@chelsio.com 	if (!count)
21729ba682f0Skxie@chelsio.com 		return 0;
21739ba682f0Skxie@chelsio.com 
21749ba682f0Skxie@chelsio.com 	if (task->sc) {
21759ba682f0Skxie@chelsio.com 		struct scsi_data_buffer *sdb = scsi_out(task->sc);
21769ba682f0Skxie@chelsio.com 		struct scatterlist *sg = NULL;
21779ba682f0Skxie@chelsio.com 		int err;
21789ba682f0Skxie@chelsio.com 
21799ba682f0Skxie@chelsio.com 		tdata->offset = offset;
21809ba682f0Skxie@chelsio.com 		tdata->count = count;
21819ba682f0Skxie@chelsio.com 		err = sgl_seek_offset(
21829ba682f0Skxie@chelsio.com 					sdb->table.sgl, sdb->table.nents,
21839ba682f0Skxie@chelsio.com 					tdata->offset, &tdata->sgoffset, &sg);
21849ba682f0Skxie@chelsio.com 		if (err < 0) {
21859ba682f0Skxie@chelsio.com 			pr_warn("tpdu, sgl %u, bad offset %u/%u.\n",
21869ba682f0Skxie@chelsio.com 				sdb->table.nents, tdata->offset, sdb->length);
21879ba682f0Skxie@chelsio.com 			return err;
21889ba682f0Skxie@chelsio.com 		}
21899ba682f0Skxie@chelsio.com 		err = sgl_read_to_frags(sg, tdata->sgoffset, tdata->count,
21909ba682f0Skxie@chelsio.com 					tdata->frags, MAX_PDU_FRAGS);
21919ba682f0Skxie@chelsio.com 		if (err < 0) {
21929ba682f0Skxie@chelsio.com 			pr_warn("tpdu, sgl %u, bad offset %u + %u.\n",
21939ba682f0Skxie@chelsio.com 				sdb->table.nents, tdata->offset, tdata->count);
21949ba682f0Skxie@chelsio.com 			return err;
21959ba682f0Skxie@chelsio.com 		}
21969ba682f0Skxie@chelsio.com 		tdata->nr_frags = err;
21979ba682f0Skxie@chelsio.com 
21989ba682f0Skxie@chelsio.com 		if (tdata->nr_frags > MAX_SKB_FRAGS ||
21999ba682f0Skxie@chelsio.com 		    (padlen && tdata->nr_frags == MAX_SKB_FRAGS)) {
22009ba682f0Skxie@chelsio.com 			char *dst = skb->data + task->hdr_len;
22016a39a16aSIan Campbell 			struct page_frag *frag = tdata->frags;
22029ba682f0Skxie@chelsio.com 
22039ba682f0Skxie@chelsio.com 			/* data fits in the skb's headroom */
22049ba682f0Skxie@chelsio.com 			for (i = 0; i < tdata->nr_frags; i++, frag++) {
220577dfce07SCong Wang 				char *src = kmap_atomic(frag->page);
22069ba682f0Skxie@chelsio.com 
22076a39a16aSIan Campbell 				memcpy(dst, src+frag->offset, frag->size);
22086a39a16aSIan Campbell 				dst += frag->size;
220977dfce07SCong Wang 				kunmap_atomic(src);
22109ba682f0Skxie@chelsio.com 			}
22119ba682f0Skxie@chelsio.com 			if (padlen) {
22129ba682f0Skxie@chelsio.com 				memset(dst, 0, padlen);
22139ba682f0Skxie@chelsio.com 				padlen = 0;
22149ba682f0Skxie@chelsio.com 			}
22159ba682f0Skxie@chelsio.com 			skb_put(skb, count + padlen);
22169ba682f0Skxie@chelsio.com 		} else {
22179ba682f0Skxie@chelsio.com 			/* data fit into frag_list */
22186a39a16aSIan Campbell 			for (i = 0; i < tdata->nr_frags; i++) {
22196a39a16aSIan Campbell 				__skb_fill_page_desc(skb, i,
22206a39a16aSIan Campbell 						tdata->frags[i].page,
22216a39a16aSIan Campbell 						tdata->frags[i].offset,
22226a39a16aSIan Campbell 						tdata->frags[i].size);
22236a39a16aSIan Campbell 				skb_frag_ref(skb, i);
22246a39a16aSIan Campbell 			}
22259ba682f0Skxie@chelsio.com 			skb_shinfo(skb)->nr_frags = tdata->nr_frags;
22269ba682f0Skxie@chelsio.com 			skb->len += count;
22279ba682f0Skxie@chelsio.com 			skb->data_len += count;
22289ba682f0Skxie@chelsio.com 			skb->truesize += count;
22299ba682f0Skxie@chelsio.com 		}
22309ba682f0Skxie@chelsio.com 
22319ba682f0Skxie@chelsio.com 	} else {
22329ba682f0Skxie@chelsio.com 		pg = virt_to_page(task->data);
22339ba682f0Skxie@chelsio.com 
22349ba682f0Skxie@chelsio.com 		get_page(pg);
22359ba682f0Skxie@chelsio.com 		skb_fill_page_desc(skb, 0, pg, offset_in_page(task->data),
22369ba682f0Skxie@chelsio.com 					count);
22379ba682f0Skxie@chelsio.com 		skb->len += count;
22389ba682f0Skxie@chelsio.com 		skb->data_len += count;
22399ba682f0Skxie@chelsio.com 		skb->truesize += count;
22409ba682f0Skxie@chelsio.com 	}
22419ba682f0Skxie@chelsio.com 
22429ba682f0Skxie@chelsio.com 	if (padlen) {
22439ba682f0Skxie@chelsio.com 		i = skb_shinfo(skb)->nr_frags;
22449ba682f0Skxie@chelsio.com 		skb_fill_page_desc(skb, skb_shinfo(skb)->nr_frags,
22459ba682f0Skxie@chelsio.com 				virt_to_page(padding), offset_in_page(padding),
22469ba682f0Skxie@chelsio.com 				padlen);
22479ba682f0Skxie@chelsio.com 
22489ba682f0Skxie@chelsio.com 		skb->data_len += padlen;
22499ba682f0Skxie@chelsio.com 		skb->truesize += padlen;
22509ba682f0Skxie@chelsio.com 		skb->len += padlen;
22519ba682f0Skxie@chelsio.com 	}
22529ba682f0Skxie@chelsio.com 
22539ba682f0Skxie@chelsio.com 	return 0;
22549ba682f0Skxie@chelsio.com }
22559ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_conn_init_pdu);
22569ba682f0Skxie@chelsio.com 
22579ba682f0Skxie@chelsio.com int cxgbi_conn_xmit_pdu(struct iscsi_task *task)
22589ba682f0Skxie@chelsio.com {
22599ba682f0Skxie@chelsio.com 	struct iscsi_tcp_conn *tcp_conn = task->conn->dd_data;
22609ba682f0Skxie@chelsio.com 	struct cxgbi_conn *cconn = tcp_conn->dd_data;
2261e3d2ad8cSkxie@chelsio.com 	struct cxgbi_task_data *tdata = iscsi_task_cxgbi_data(task);
22629ba682f0Skxie@chelsio.com 	struct sk_buff *skb = tdata->skb;
22639ba682f0Skxie@chelsio.com 	unsigned int datalen;
22649ba682f0Skxie@chelsio.com 	int err;
22659ba682f0Skxie@chelsio.com 
22669ba682f0Skxie@chelsio.com 	if (!skb) {
22679ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_PDU_TX,
22689ba682f0Skxie@chelsio.com 			"task 0x%p, skb NULL.\n", task);
22699ba682f0Skxie@chelsio.com 		return 0;
22709ba682f0Skxie@chelsio.com 	}
22719ba682f0Skxie@chelsio.com 
22729ba682f0Skxie@chelsio.com 	datalen = skb->data_len;
22739ba682f0Skxie@chelsio.com 	tdata->skb = NULL;
22749ba682f0Skxie@chelsio.com 	err = cxgbi_sock_send_pdus(cconn->cep->csk, skb);
22759ba682f0Skxie@chelsio.com 	if (err > 0) {
22769ba682f0Skxie@chelsio.com 		int pdulen = err;
22779ba682f0Skxie@chelsio.com 
22789ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_PDU_TX,
22799ba682f0Skxie@chelsio.com 			"task 0x%p,0x%p, skb 0x%p, len %u/%u, rv %d.\n",
22809ba682f0Skxie@chelsio.com 			task, task->sc, skb, skb->len, skb->data_len, err);
22819ba682f0Skxie@chelsio.com 
22829ba682f0Skxie@chelsio.com 		if (task->conn->hdrdgst_en)
22839ba682f0Skxie@chelsio.com 			pdulen += ISCSI_DIGEST_SIZE;
22849ba682f0Skxie@chelsio.com 
22859ba682f0Skxie@chelsio.com 		if (datalen && task->conn->datadgst_en)
22869ba682f0Skxie@chelsio.com 			pdulen += ISCSI_DIGEST_SIZE;
22879ba682f0Skxie@chelsio.com 
22889ba682f0Skxie@chelsio.com 		task->conn->txdata_octets += pdulen;
22899ba682f0Skxie@chelsio.com 		return 0;
22909ba682f0Skxie@chelsio.com 	}
22919ba682f0Skxie@chelsio.com 
22929ba682f0Skxie@chelsio.com 	if (err == -EAGAIN || err == -ENOBUFS) {
22939ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_PDU_TX,
22949ba682f0Skxie@chelsio.com 			"task 0x%p, skb 0x%p, len %u/%u, %d EAGAIN.\n",
22959ba682f0Skxie@chelsio.com 			task, skb, skb->len, skb->data_len, err);
22969ba682f0Skxie@chelsio.com 		/* reset skb to send when we are called again */
22979ba682f0Skxie@chelsio.com 		tdata->skb = skb;
22989ba682f0Skxie@chelsio.com 		return err;
22999ba682f0Skxie@chelsio.com 	}
23009ba682f0Skxie@chelsio.com 
23019ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_PDU_TX,
23029ba682f0Skxie@chelsio.com 		"itt 0x%x, skb 0x%p, len %u/%u, xmit err %d.\n",
23039ba682f0Skxie@chelsio.com 		task->itt, skb, skb->len, skb->data_len, err);
2304ed481a33SKaren Xie 
2305ed481a33SKaren Xie 	kfree_skb(skb);
2306ed481a33SKaren Xie 
23079ba682f0Skxie@chelsio.com 	iscsi_conn_printk(KERN_ERR, task->conn, "xmit err %d.\n", err);
23089ba682f0Skxie@chelsio.com 	iscsi_conn_failure(task->conn, ISCSI_ERR_XMIT_FAILED);
23099ba682f0Skxie@chelsio.com 	return err;
23109ba682f0Skxie@chelsio.com }
23119ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_conn_xmit_pdu);
23129ba682f0Skxie@chelsio.com 
23139ba682f0Skxie@chelsio.com void cxgbi_cleanup_task(struct iscsi_task *task)
23149ba682f0Skxie@chelsio.com {
2315e3d2ad8cSkxie@chelsio.com 	struct cxgbi_task_data *tdata = iscsi_task_cxgbi_data(task);
23169ba682f0Skxie@chelsio.com 
23179ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI,
23189ba682f0Skxie@chelsio.com 		"task 0x%p, skb 0x%p, itt 0x%x.\n",
23199ba682f0Skxie@chelsio.com 		task, tdata->skb, task->hdr_itt);
23209ba682f0Skxie@chelsio.com 
23219ba682f0Skxie@chelsio.com 	/*  never reached the xmit task callout */
23229ba682f0Skxie@chelsio.com 	if (tdata->skb)
23239ba682f0Skxie@chelsio.com 		__kfree_skb(tdata->skb);
23249ba682f0Skxie@chelsio.com 	memset(tdata, 0, sizeof(*tdata));
23259ba682f0Skxie@chelsio.com 
23269ba682f0Skxie@chelsio.com 	task_release_itt(task, task->hdr_itt);
23279ba682f0Skxie@chelsio.com 	iscsi_tcp_cleanup_task(task);
23289ba682f0Skxie@chelsio.com }
23299ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_cleanup_task);
23309ba682f0Skxie@chelsio.com 
23319ba682f0Skxie@chelsio.com void cxgbi_get_conn_stats(struct iscsi_cls_conn *cls_conn,
23329ba682f0Skxie@chelsio.com 				struct iscsi_stats *stats)
23339ba682f0Skxie@chelsio.com {
23349ba682f0Skxie@chelsio.com 	struct iscsi_conn *conn = cls_conn->dd_data;
23359ba682f0Skxie@chelsio.com 
23369ba682f0Skxie@chelsio.com 	stats->txdata_octets = conn->txdata_octets;
23379ba682f0Skxie@chelsio.com 	stats->rxdata_octets = conn->rxdata_octets;
23389ba682f0Skxie@chelsio.com 	stats->scsicmd_pdus = conn->scsicmd_pdus_cnt;
23399ba682f0Skxie@chelsio.com 	stats->dataout_pdus = conn->dataout_pdus_cnt;
23409ba682f0Skxie@chelsio.com 	stats->scsirsp_pdus = conn->scsirsp_pdus_cnt;
23419ba682f0Skxie@chelsio.com 	stats->datain_pdus = conn->datain_pdus_cnt;
23429ba682f0Skxie@chelsio.com 	stats->r2t_pdus = conn->r2t_pdus_cnt;
23439ba682f0Skxie@chelsio.com 	stats->tmfcmd_pdus = conn->tmfcmd_pdus_cnt;
23449ba682f0Skxie@chelsio.com 	stats->tmfrsp_pdus = conn->tmfrsp_pdus_cnt;
23459ba682f0Skxie@chelsio.com 	stats->digest_err = 0;
23469ba682f0Skxie@chelsio.com 	stats->timeout_err = 0;
23479ba682f0Skxie@chelsio.com 	stats->custom_length = 1;
23489ba682f0Skxie@chelsio.com 	strcpy(stats->custom[0].desc, "eh_abort_cnt");
23499ba682f0Skxie@chelsio.com 	stats->custom[0].value = conn->eh_abort_cnt;
23509ba682f0Skxie@chelsio.com }
23519ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_get_conn_stats);
23529ba682f0Skxie@chelsio.com 
23539ba682f0Skxie@chelsio.com static int cxgbi_conn_max_xmit_dlength(struct iscsi_conn *conn)
23549ba682f0Skxie@chelsio.com {
23559ba682f0Skxie@chelsio.com 	struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
23569ba682f0Skxie@chelsio.com 	struct cxgbi_conn *cconn = tcp_conn->dd_data;
23579ba682f0Skxie@chelsio.com 	struct cxgbi_device *cdev = cconn->chba->cdev;
23589ba682f0Skxie@chelsio.com 	unsigned int headroom = SKB_MAX_HEAD(cdev->skb_tx_rsvd);
23599ba682f0Skxie@chelsio.com 	unsigned int max_def = 512 * MAX_SKB_FRAGS;
23609ba682f0Skxie@chelsio.com 	unsigned int max = max(max_def, headroom);
23619ba682f0Skxie@chelsio.com 
23629ba682f0Skxie@chelsio.com 	max = min(cconn->chba->cdev->tx_max_size, max);
23639ba682f0Skxie@chelsio.com 	if (conn->max_xmit_dlength)
23649ba682f0Skxie@chelsio.com 		conn->max_xmit_dlength = min(conn->max_xmit_dlength, max);
23659ba682f0Skxie@chelsio.com 	else
23669ba682f0Skxie@chelsio.com 		conn->max_xmit_dlength = max;
23679ba682f0Skxie@chelsio.com 	cxgbi_align_pdu_size(conn->max_xmit_dlength);
23689ba682f0Skxie@chelsio.com 
23699ba682f0Skxie@chelsio.com 	return 0;
23709ba682f0Skxie@chelsio.com }
23719ba682f0Skxie@chelsio.com 
23729ba682f0Skxie@chelsio.com static int cxgbi_conn_max_recv_dlength(struct iscsi_conn *conn)
23739ba682f0Skxie@chelsio.com {
23749ba682f0Skxie@chelsio.com 	struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
23759ba682f0Skxie@chelsio.com 	struct cxgbi_conn *cconn = tcp_conn->dd_data;
23769ba682f0Skxie@chelsio.com 	unsigned int max = cconn->chba->cdev->rx_max_size;
23779ba682f0Skxie@chelsio.com 
23789ba682f0Skxie@chelsio.com 	cxgbi_align_pdu_size(max);
23799ba682f0Skxie@chelsio.com 
23809ba682f0Skxie@chelsio.com 	if (conn->max_recv_dlength) {
23819ba682f0Skxie@chelsio.com 		if (conn->max_recv_dlength > max) {
23829ba682f0Skxie@chelsio.com 			pr_err("MaxRecvDataSegmentLength %u > %u.\n",
23839ba682f0Skxie@chelsio.com 				conn->max_recv_dlength, max);
23849ba682f0Skxie@chelsio.com 			return -EINVAL;
23859ba682f0Skxie@chelsio.com 		}
23869ba682f0Skxie@chelsio.com 		conn->max_recv_dlength = min(conn->max_recv_dlength, max);
23879ba682f0Skxie@chelsio.com 		cxgbi_align_pdu_size(conn->max_recv_dlength);
23889ba682f0Skxie@chelsio.com 	} else
23899ba682f0Skxie@chelsio.com 		conn->max_recv_dlength = max;
23909ba682f0Skxie@chelsio.com 
23919ba682f0Skxie@chelsio.com 	return 0;
23929ba682f0Skxie@chelsio.com }
23939ba682f0Skxie@chelsio.com 
23949ba682f0Skxie@chelsio.com int cxgbi_set_conn_param(struct iscsi_cls_conn *cls_conn,
23959ba682f0Skxie@chelsio.com 			enum iscsi_param param, char *buf, int buflen)
23969ba682f0Skxie@chelsio.com {
23979ba682f0Skxie@chelsio.com 	struct iscsi_conn *conn = cls_conn->dd_data;
23989ba682f0Skxie@chelsio.com 	struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
23999ba682f0Skxie@chelsio.com 	struct cxgbi_conn *cconn = tcp_conn->dd_data;
24009ba682f0Skxie@chelsio.com 	struct cxgbi_sock *csk = cconn->cep->csk;
24011304be5fSMike Christie 	int err;
24029ba682f0Skxie@chelsio.com 
24039ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI,
24049ba682f0Skxie@chelsio.com 		"cls_conn 0x%p, param %d, buf(%d) %s.\n",
24059ba682f0Skxie@chelsio.com 		cls_conn, param, buflen, buf);
24069ba682f0Skxie@chelsio.com 
24079ba682f0Skxie@chelsio.com 	switch (param) {
24089ba682f0Skxie@chelsio.com 	case ISCSI_PARAM_HDRDGST_EN:
24099ba682f0Skxie@chelsio.com 		err = iscsi_set_param(cls_conn, param, buf, buflen);
24109ba682f0Skxie@chelsio.com 		if (!err && conn->hdrdgst_en)
24119ba682f0Skxie@chelsio.com 			err = csk->cdev->csk_ddp_setup_digest(csk, csk->tid,
24129ba682f0Skxie@chelsio.com 							conn->hdrdgst_en,
24139ba682f0Skxie@chelsio.com 							conn->datadgst_en, 0);
24149ba682f0Skxie@chelsio.com 		break;
24159ba682f0Skxie@chelsio.com 	case ISCSI_PARAM_DATADGST_EN:
24169ba682f0Skxie@chelsio.com 		err = iscsi_set_param(cls_conn, param, buf, buflen);
24179ba682f0Skxie@chelsio.com 		if (!err && conn->datadgst_en)
24189ba682f0Skxie@chelsio.com 			err = csk->cdev->csk_ddp_setup_digest(csk, csk->tid,
24199ba682f0Skxie@chelsio.com 							conn->hdrdgst_en,
24209ba682f0Skxie@chelsio.com 							conn->datadgst_en, 0);
24219ba682f0Skxie@chelsio.com 		break;
24229ba682f0Skxie@chelsio.com 	case ISCSI_PARAM_MAX_R2T:
24231304be5fSMike Christie 		return iscsi_tcp_set_max_r2t(conn, buf);
24249ba682f0Skxie@chelsio.com 	case ISCSI_PARAM_MAX_RECV_DLENGTH:
24259ba682f0Skxie@chelsio.com 		err = iscsi_set_param(cls_conn, param, buf, buflen);
24269ba682f0Skxie@chelsio.com 		if (!err)
24279ba682f0Skxie@chelsio.com 			err = cxgbi_conn_max_recv_dlength(conn);
24289ba682f0Skxie@chelsio.com 		break;
24299ba682f0Skxie@chelsio.com 	case ISCSI_PARAM_MAX_XMIT_DLENGTH:
24309ba682f0Skxie@chelsio.com 		err = iscsi_set_param(cls_conn, param, buf, buflen);
24319ba682f0Skxie@chelsio.com 		if (!err)
24329ba682f0Skxie@chelsio.com 			err = cxgbi_conn_max_xmit_dlength(conn);
24339ba682f0Skxie@chelsio.com 		break;
24349ba682f0Skxie@chelsio.com 	default:
24359ba682f0Skxie@chelsio.com 		return iscsi_set_param(cls_conn, param, buf, buflen);
24369ba682f0Skxie@chelsio.com 	}
24379ba682f0Skxie@chelsio.com 	return err;
24389ba682f0Skxie@chelsio.com }
24399ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_set_conn_param);
24409ba682f0Skxie@chelsio.com 
2441fc8d0590SAnish Bhatt static inline int csk_print_port(struct cxgbi_sock *csk, char *buf)
2442fc8d0590SAnish Bhatt {
2443fc8d0590SAnish Bhatt 	int len;
2444fc8d0590SAnish Bhatt 
2445fc8d0590SAnish Bhatt 	cxgbi_sock_get(csk);
2446fc8d0590SAnish Bhatt 	len = sprintf(buf, "%hu\n", ntohs(csk->daddr.sin_port));
2447fc8d0590SAnish Bhatt 	cxgbi_sock_put(csk);
2448fc8d0590SAnish Bhatt 
2449fc8d0590SAnish Bhatt 	return len;
2450fc8d0590SAnish Bhatt }
2451fc8d0590SAnish Bhatt 
2452fc8d0590SAnish Bhatt static inline int csk_print_ip(struct cxgbi_sock *csk, char *buf)
2453fc8d0590SAnish Bhatt {
2454fc8d0590SAnish Bhatt 	int len;
2455fc8d0590SAnish Bhatt 
2456fc8d0590SAnish Bhatt 	cxgbi_sock_get(csk);
2457fc8d0590SAnish Bhatt 	if (csk->csk_family == AF_INET)
2458fc8d0590SAnish Bhatt 		len = sprintf(buf, "%pI4",
2459fc8d0590SAnish Bhatt 			      &csk->daddr.sin_addr.s_addr);
2460fc8d0590SAnish Bhatt 	else
2461fc8d0590SAnish Bhatt 		len = sprintf(buf, "%pI6",
2462fc8d0590SAnish Bhatt 			      &csk->daddr6.sin6_addr);
2463fc8d0590SAnish Bhatt 
2464fc8d0590SAnish Bhatt 	cxgbi_sock_put(csk);
2465fc8d0590SAnish Bhatt 
2466fc8d0590SAnish Bhatt 	return len;
2467fc8d0590SAnish Bhatt }
2468fc8d0590SAnish Bhatt 
2469c71b9b66SMike Christie int cxgbi_get_ep_param(struct iscsi_endpoint *ep, enum iscsi_param param,
2470c71b9b66SMike Christie 		       char *buf)
24719ba682f0Skxie@chelsio.com {
2472c71b9b66SMike Christie 	struct cxgbi_endpoint *cep = ep->dd_data;
2473c71b9b66SMike Christie 	struct cxgbi_sock *csk;
24749ba682f0Skxie@chelsio.com 	int len;
24759ba682f0Skxie@chelsio.com 
24769ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI,
2477c71b9b66SMike Christie 		"cls_conn 0x%p, param %d.\n", ep, param);
24789ba682f0Skxie@chelsio.com 
24799ba682f0Skxie@chelsio.com 	switch (param) {
24809ba682f0Skxie@chelsio.com 	case ISCSI_PARAM_CONN_PORT:
24819ba682f0Skxie@chelsio.com 	case ISCSI_PARAM_CONN_ADDRESS:
2482c71b9b66SMike Christie 		if (!cep)
2483c71b9b66SMike Christie 			return -ENOTCONN;
2484c71b9b66SMike Christie 
2485c71b9b66SMike Christie 		csk = cep->csk;
2486c71b9b66SMike Christie 		if (!csk)
2487c71b9b66SMike Christie 			return -ENOTCONN;
2488c71b9b66SMike Christie 
2489c71b9b66SMike Christie 		return iscsi_conn_get_addr_param((struct sockaddr_storage *)
2490c71b9b66SMike Christie 						 &csk->daddr, param, buf);
24919ba682f0Skxie@chelsio.com 	default:
2492c71b9b66SMike Christie 		return -ENOSYS;
24939ba682f0Skxie@chelsio.com 	}
24949ba682f0Skxie@chelsio.com 	return len;
24959ba682f0Skxie@chelsio.com }
2496c71b9b66SMike Christie EXPORT_SYMBOL_GPL(cxgbi_get_ep_param);
24979ba682f0Skxie@chelsio.com 
24989ba682f0Skxie@chelsio.com struct iscsi_cls_conn *
24999ba682f0Skxie@chelsio.com cxgbi_create_conn(struct iscsi_cls_session *cls_session, u32 cid)
25009ba682f0Skxie@chelsio.com {
25019ba682f0Skxie@chelsio.com 	struct iscsi_cls_conn *cls_conn;
25029ba682f0Skxie@chelsio.com 	struct iscsi_conn *conn;
25039ba682f0Skxie@chelsio.com 	struct iscsi_tcp_conn *tcp_conn;
25049ba682f0Skxie@chelsio.com 	struct cxgbi_conn *cconn;
25059ba682f0Skxie@chelsio.com 
25069ba682f0Skxie@chelsio.com 	cls_conn = iscsi_tcp_conn_setup(cls_session, sizeof(*cconn), cid);
25079ba682f0Skxie@chelsio.com 	if (!cls_conn)
25089ba682f0Skxie@chelsio.com 		return NULL;
25099ba682f0Skxie@chelsio.com 
25109ba682f0Skxie@chelsio.com 	conn = cls_conn->dd_data;
25119ba682f0Skxie@chelsio.com 	tcp_conn = conn->dd_data;
25129ba682f0Skxie@chelsio.com 	cconn = tcp_conn->dd_data;
25139ba682f0Skxie@chelsio.com 	cconn->iconn = conn;
25149ba682f0Skxie@chelsio.com 
25159ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI,
25169ba682f0Skxie@chelsio.com 		"cid %u(0x%x), cls 0x%p,0x%p, conn 0x%p,0x%p,0x%p.\n",
25179ba682f0Skxie@chelsio.com 		cid, cid, cls_session, cls_conn, conn, tcp_conn, cconn);
25189ba682f0Skxie@chelsio.com 
25199ba682f0Skxie@chelsio.com 	return cls_conn;
25209ba682f0Skxie@chelsio.com }
25219ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_create_conn);
25229ba682f0Skxie@chelsio.com 
25239ba682f0Skxie@chelsio.com int cxgbi_bind_conn(struct iscsi_cls_session *cls_session,
25249ba682f0Skxie@chelsio.com 				struct iscsi_cls_conn *cls_conn,
25259ba682f0Skxie@chelsio.com 				u64 transport_eph, int is_leading)
25269ba682f0Skxie@chelsio.com {
25279ba682f0Skxie@chelsio.com 	struct iscsi_conn *conn = cls_conn->dd_data;
25289ba682f0Skxie@chelsio.com 	struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
25299ba682f0Skxie@chelsio.com 	struct cxgbi_conn *cconn = tcp_conn->dd_data;
25309ba682f0Skxie@chelsio.com 	struct iscsi_endpoint *ep;
25319ba682f0Skxie@chelsio.com 	struct cxgbi_endpoint *cep;
25329ba682f0Skxie@chelsio.com 	struct cxgbi_sock *csk;
25339ba682f0Skxie@chelsio.com 	int err;
25349ba682f0Skxie@chelsio.com 
25359ba682f0Skxie@chelsio.com 	ep = iscsi_lookup_endpoint(transport_eph);
25369ba682f0Skxie@chelsio.com 	if (!ep)
25379ba682f0Skxie@chelsio.com 		return -EINVAL;
25389ba682f0Skxie@chelsio.com 
25399ba682f0Skxie@chelsio.com 	/*  setup ddp pagesize */
25409ba682f0Skxie@chelsio.com 	cep = ep->dd_data;
25419ba682f0Skxie@chelsio.com 	csk = cep->csk;
25429ba682f0Skxie@chelsio.com 	err = csk->cdev->csk_ddp_setup_pgidx(csk, csk->tid, page_idx, 0);
25439ba682f0Skxie@chelsio.com 	if (err < 0)
25449ba682f0Skxie@chelsio.com 		return err;
25459ba682f0Skxie@chelsio.com 
25469ba682f0Skxie@chelsio.com 	err = iscsi_conn_bind(cls_session, cls_conn, is_leading);
25479ba682f0Skxie@chelsio.com 	if (err)
25489ba682f0Skxie@chelsio.com 		return -EINVAL;
25499ba682f0Skxie@chelsio.com 
25509ba682f0Skxie@chelsio.com 	/*  calculate the tag idx bits needed for this conn based on cmds_max */
25519ba682f0Skxie@chelsio.com 	cconn->task_idx_bits = (__ilog2_u32(conn->session->cmds_max - 1)) + 1;
25529ba682f0Skxie@chelsio.com 
2553e3d2ad8cSkxie@chelsio.com 	write_lock_bh(&csk->callback_lock);
25549ba682f0Skxie@chelsio.com 	csk->user_data = conn;
25559ba682f0Skxie@chelsio.com 	cconn->chba = cep->chba;
25569ba682f0Skxie@chelsio.com 	cconn->cep = cep;
25579ba682f0Skxie@chelsio.com 	cep->cconn = cconn;
2558e3d2ad8cSkxie@chelsio.com 	write_unlock_bh(&csk->callback_lock);
25599ba682f0Skxie@chelsio.com 
25609ba682f0Skxie@chelsio.com 	cxgbi_conn_max_xmit_dlength(conn);
25619ba682f0Skxie@chelsio.com 	cxgbi_conn_max_recv_dlength(conn);
25629ba682f0Skxie@chelsio.com 
25639ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI,
25649ba682f0Skxie@chelsio.com 		"cls 0x%p,0x%p, ep 0x%p, cconn 0x%p, csk 0x%p.\n",
25659ba682f0Skxie@chelsio.com 		cls_session, cls_conn, ep, cconn, csk);
25669ba682f0Skxie@chelsio.com 	/*  init recv engine */
25679ba682f0Skxie@chelsio.com 	iscsi_tcp_hdr_recv_prep(tcp_conn);
25689ba682f0Skxie@chelsio.com 
25699ba682f0Skxie@chelsio.com 	return 0;
25709ba682f0Skxie@chelsio.com }
25719ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_bind_conn);
25729ba682f0Skxie@chelsio.com 
25739ba682f0Skxie@chelsio.com struct iscsi_cls_session *cxgbi_create_session(struct iscsi_endpoint *ep,
25749ba682f0Skxie@chelsio.com 						u16 cmds_max, u16 qdepth,
25759ba682f0Skxie@chelsio.com 						u32 initial_cmdsn)
25769ba682f0Skxie@chelsio.com {
25779ba682f0Skxie@chelsio.com 	struct cxgbi_endpoint *cep;
25789ba682f0Skxie@chelsio.com 	struct cxgbi_hba *chba;
25799ba682f0Skxie@chelsio.com 	struct Scsi_Host *shost;
25809ba682f0Skxie@chelsio.com 	struct iscsi_cls_session *cls_session;
25819ba682f0Skxie@chelsio.com 	struct iscsi_session *session;
25829ba682f0Skxie@chelsio.com 
25839ba682f0Skxie@chelsio.com 	if (!ep) {
25849ba682f0Skxie@chelsio.com 		pr_err("missing endpoint.\n");
25859ba682f0Skxie@chelsio.com 		return NULL;
25869ba682f0Skxie@chelsio.com 	}
25879ba682f0Skxie@chelsio.com 
25889ba682f0Skxie@chelsio.com 	cep = ep->dd_data;
25899ba682f0Skxie@chelsio.com 	chba = cep->chba;
25909ba682f0Skxie@chelsio.com 	shost = chba->shost;
25919ba682f0Skxie@chelsio.com 
25929ba682f0Skxie@chelsio.com 	BUG_ON(chba != iscsi_host_priv(shost));
25939ba682f0Skxie@chelsio.com 
25949ba682f0Skxie@chelsio.com 	cls_session = iscsi_session_setup(chba->cdev->itp, shost,
25959ba682f0Skxie@chelsio.com 					cmds_max, 0,
25969ba682f0Skxie@chelsio.com 					sizeof(struct iscsi_tcp_task) +
25979ba682f0Skxie@chelsio.com 					sizeof(struct cxgbi_task_data),
25989ba682f0Skxie@chelsio.com 					initial_cmdsn, ISCSI_MAX_TARGET);
25999ba682f0Skxie@chelsio.com 	if (!cls_session)
26009ba682f0Skxie@chelsio.com 		return NULL;
26019ba682f0Skxie@chelsio.com 
26029ba682f0Skxie@chelsio.com 	session = cls_session->dd_data;
26039ba682f0Skxie@chelsio.com 	if (iscsi_tcp_r2tpool_alloc(session))
26049ba682f0Skxie@chelsio.com 		goto remove_session;
26059ba682f0Skxie@chelsio.com 
26069ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI,
26079ba682f0Skxie@chelsio.com 		"ep 0x%p, cls sess 0x%p.\n", ep, cls_session);
26089ba682f0Skxie@chelsio.com 	return cls_session;
26099ba682f0Skxie@chelsio.com 
26109ba682f0Skxie@chelsio.com remove_session:
26119ba682f0Skxie@chelsio.com 	iscsi_session_teardown(cls_session);
26129ba682f0Skxie@chelsio.com 	return NULL;
26139ba682f0Skxie@chelsio.com }
26149ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_create_session);
26159ba682f0Skxie@chelsio.com 
26169ba682f0Skxie@chelsio.com void cxgbi_destroy_session(struct iscsi_cls_session *cls_session)
26179ba682f0Skxie@chelsio.com {
26189ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI,
26199ba682f0Skxie@chelsio.com 		"cls sess 0x%p.\n", cls_session);
26209ba682f0Skxie@chelsio.com 
26219ba682f0Skxie@chelsio.com 	iscsi_tcp_r2tpool_free(cls_session->dd_data);
26229ba682f0Skxie@chelsio.com 	iscsi_session_teardown(cls_session);
26239ba682f0Skxie@chelsio.com }
26249ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_destroy_session);
26259ba682f0Skxie@chelsio.com 
26269ba682f0Skxie@chelsio.com int cxgbi_set_host_param(struct Scsi_Host *shost, enum iscsi_host_param param,
26279ba682f0Skxie@chelsio.com 			char *buf, int buflen)
26289ba682f0Skxie@chelsio.com {
26299ba682f0Skxie@chelsio.com 	struct cxgbi_hba *chba = iscsi_host_priv(shost);
26309ba682f0Skxie@chelsio.com 
26319ba682f0Skxie@chelsio.com 	if (!chba->ndev) {
26329ba682f0Skxie@chelsio.com 		shost_printk(KERN_ERR, shost, "Could not get host param. "
26339ba682f0Skxie@chelsio.com 				"netdev for host not set.\n");
26349ba682f0Skxie@chelsio.com 		return -ENODEV;
26359ba682f0Skxie@chelsio.com 	}
26369ba682f0Skxie@chelsio.com 
26379ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI,
26389ba682f0Skxie@chelsio.com 		"shost 0x%p, hba 0x%p,%s, param %d, buf(%d) %s.\n",
26399ba682f0Skxie@chelsio.com 		shost, chba, chba->ndev->name, param, buflen, buf);
26409ba682f0Skxie@chelsio.com 
26419ba682f0Skxie@chelsio.com 	switch (param) {
26429ba682f0Skxie@chelsio.com 	case ISCSI_HOST_PARAM_IPADDRESS:
26439ba682f0Skxie@chelsio.com 	{
26449ba682f0Skxie@chelsio.com 		__be32 addr = in_aton(buf);
26459ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_ISCSI,
26469ba682f0Skxie@chelsio.com 			"hba %s, req. ipv4 %pI4.\n", chba->ndev->name, &addr);
26479ba682f0Skxie@chelsio.com 		cxgbi_set_iscsi_ipv4(chba, addr);
26489ba682f0Skxie@chelsio.com 		return 0;
26499ba682f0Skxie@chelsio.com 	}
26509ba682f0Skxie@chelsio.com 	case ISCSI_HOST_PARAM_HWADDRESS:
26519ba682f0Skxie@chelsio.com 	case ISCSI_HOST_PARAM_NETDEV_NAME:
26529ba682f0Skxie@chelsio.com 		return 0;
26539ba682f0Skxie@chelsio.com 	default:
26549ba682f0Skxie@chelsio.com 		return iscsi_host_set_param(shost, param, buf, buflen);
26559ba682f0Skxie@chelsio.com 	}
26569ba682f0Skxie@chelsio.com }
26579ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_set_host_param);
26589ba682f0Skxie@chelsio.com 
26599ba682f0Skxie@chelsio.com int cxgbi_get_host_param(struct Scsi_Host *shost, enum iscsi_host_param param,
26609ba682f0Skxie@chelsio.com 			char *buf)
26619ba682f0Skxie@chelsio.com {
26629ba682f0Skxie@chelsio.com 	struct cxgbi_hba *chba = iscsi_host_priv(shost);
26639ba682f0Skxie@chelsio.com 	int len = 0;
26649ba682f0Skxie@chelsio.com 
26659ba682f0Skxie@chelsio.com 	if (!chba->ndev) {
26669ba682f0Skxie@chelsio.com 		shost_printk(KERN_ERR, shost, "Could not get host param. "
26679ba682f0Skxie@chelsio.com 				"netdev for host not set.\n");
26689ba682f0Skxie@chelsio.com 		return -ENODEV;
26699ba682f0Skxie@chelsio.com 	}
26709ba682f0Skxie@chelsio.com 
26719ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI,
26729ba682f0Skxie@chelsio.com 		"shost 0x%p, hba 0x%p,%s, param %d.\n",
26739ba682f0Skxie@chelsio.com 		shost, chba, chba->ndev->name, param);
26749ba682f0Skxie@chelsio.com 
26759ba682f0Skxie@chelsio.com 	switch (param) {
26769ba682f0Skxie@chelsio.com 	case ISCSI_HOST_PARAM_HWADDRESS:
26779ba682f0Skxie@chelsio.com 		len = sysfs_format_mac(buf, chba->ndev->dev_addr, 6);
26789ba682f0Skxie@chelsio.com 		break;
26799ba682f0Skxie@chelsio.com 	case ISCSI_HOST_PARAM_NETDEV_NAME:
26809ba682f0Skxie@chelsio.com 		len = sprintf(buf, "%s\n", chba->ndev->name);
26819ba682f0Skxie@chelsio.com 		break;
26829ba682f0Skxie@chelsio.com 	case ISCSI_HOST_PARAM_IPADDRESS:
26839ba682f0Skxie@chelsio.com 	{
2684dd9ad67eSAnish Bhatt 		struct cxgbi_sock *csk = find_sock_on_port(chba->cdev,
2685dd9ad67eSAnish Bhatt 							   chba->port_id);
2686dd9ad67eSAnish Bhatt 		if (csk) {
2687dd9ad67eSAnish Bhatt 			len = sprintf(buf, "%pIS",
2688dd9ad67eSAnish Bhatt 				      (struct sockaddr *)&csk->saddr);
2689dd9ad67eSAnish Bhatt 		}
26909ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_ISCSI,
2691dd9ad67eSAnish Bhatt 			  "hba %s, addr %s.\n", chba->ndev->name, buf);
26929ba682f0Skxie@chelsio.com 		break;
26939ba682f0Skxie@chelsio.com 	}
26949ba682f0Skxie@chelsio.com 	default:
26959ba682f0Skxie@chelsio.com 		return iscsi_host_get_param(shost, param, buf);
26969ba682f0Skxie@chelsio.com 	}
26979ba682f0Skxie@chelsio.com 
26989ba682f0Skxie@chelsio.com 	return len;
26999ba682f0Skxie@chelsio.com }
27009ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_get_host_param);
27019ba682f0Skxie@chelsio.com 
27029ba682f0Skxie@chelsio.com struct iscsi_endpoint *cxgbi_ep_connect(struct Scsi_Host *shost,
27039ba682f0Skxie@chelsio.com 					struct sockaddr *dst_addr,
27049ba682f0Skxie@chelsio.com 					int non_blocking)
27059ba682f0Skxie@chelsio.com {
27069ba682f0Skxie@chelsio.com 	struct iscsi_endpoint *ep;
27079ba682f0Skxie@chelsio.com 	struct cxgbi_endpoint *cep;
27089ba682f0Skxie@chelsio.com 	struct cxgbi_hba *hba = NULL;
27099ba682f0Skxie@chelsio.com 	struct cxgbi_sock *csk;
27109ba682f0Skxie@chelsio.com 	int err = -EINVAL;
27119ba682f0Skxie@chelsio.com 
27129ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_SOCK,
27139ba682f0Skxie@chelsio.com 		"shost 0x%p, non_blocking %d, dst_addr 0x%p.\n",
27149ba682f0Skxie@chelsio.com 		shost, non_blocking, dst_addr);
27159ba682f0Skxie@chelsio.com 
27169ba682f0Skxie@chelsio.com 	if (shost) {
27179ba682f0Skxie@chelsio.com 		hba = iscsi_host_priv(shost);
27189ba682f0Skxie@chelsio.com 		if (!hba) {
27199ba682f0Skxie@chelsio.com 			pr_info("shost 0x%p, priv NULL.\n", shost);
27209ba682f0Skxie@chelsio.com 			goto err_out;
27219ba682f0Skxie@chelsio.com 		}
27229ba682f0Skxie@chelsio.com 	}
27239ba682f0Skxie@chelsio.com 
2724fc8d0590SAnish Bhatt 	if (dst_addr->sa_family == AF_INET) {
27259ba682f0Skxie@chelsio.com 		csk = cxgbi_check_route(dst_addr);
2726e81fbf6cSAnish Bhatt #if IS_ENABLED(CONFIG_IPV6)
2727fc8d0590SAnish Bhatt 	} else if (dst_addr->sa_family == AF_INET6) {
2728fc8d0590SAnish Bhatt 		csk = cxgbi_check_route6(dst_addr);
2729e81fbf6cSAnish Bhatt #endif
2730fc8d0590SAnish Bhatt 	} else {
2731fc8d0590SAnish Bhatt 		pr_info("address family 0x%x NOT supported.\n",
2732fc8d0590SAnish Bhatt 			dst_addr->sa_family);
2733fc8d0590SAnish Bhatt 		err = -EAFNOSUPPORT;
2734fc8d0590SAnish Bhatt 		return (struct iscsi_endpoint *)ERR_PTR(err);
2735fc8d0590SAnish Bhatt 	}
2736fc8d0590SAnish Bhatt 
27379ba682f0Skxie@chelsio.com 	if (IS_ERR(csk))
27389ba682f0Skxie@chelsio.com 		return (struct iscsi_endpoint *)csk;
27399ba682f0Skxie@chelsio.com 	cxgbi_sock_get(csk);
27409ba682f0Skxie@chelsio.com 
27419ba682f0Skxie@chelsio.com 	if (!hba)
27429ba682f0Skxie@chelsio.com 		hba = csk->cdev->hbas[csk->port_id];
27439ba682f0Skxie@chelsio.com 	else if (hba != csk->cdev->hbas[csk->port_id]) {
27449ba682f0Skxie@chelsio.com 		pr_info("Could not connect through requested host %u"
27459ba682f0Skxie@chelsio.com 			"hba 0x%p != 0x%p (%u).\n",
27469ba682f0Skxie@chelsio.com 			shost->host_no, hba,
27479ba682f0Skxie@chelsio.com 			csk->cdev->hbas[csk->port_id], csk->port_id);
27489ba682f0Skxie@chelsio.com 		err = -ENOSPC;
27499ba682f0Skxie@chelsio.com 		goto release_conn;
27509ba682f0Skxie@chelsio.com 	}
27519ba682f0Skxie@chelsio.com 
27529ba682f0Skxie@chelsio.com 	err = sock_get_port(csk);
27539ba682f0Skxie@chelsio.com 	if (err)
27549ba682f0Skxie@chelsio.com 		goto release_conn;
27559ba682f0Skxie@chelsio.com 
27569ba682f0Skxie@chelsio.com 	cxgbi_sock_set_state(csk, CTP_CONNECTING);
27579ba682f0Skxie@chelsio.com 	err = csk->cdev->csk_init_act_open(csk);
27589ba682f0Skxie@chelsio.com 	if (err)
27599ba682f0Skxie@chelsio.com 		goto release_conn;
27609ba682f0Skxie@chelsio.com 
27619ba682f0Skxie@chelsio.com 	if (cxgbi_sock_is_closing(csk)) {
27629ba682f0Skxie@chelsio.com 		err = -ENOSPC;
27639ba682f0Skxie@chelsio.com 		pr_info("csk 0x%p is closing.\n", csk);
27649ba682f0Skxie@chelsio.com 		goto release_conn;
27659ba682f0Skxie@chelsio.com 	}
27669ba682f0Skxie@chelsio.com 
27679ba682f0Skxie@chelsio.com 	ep = iscsi_create_endpoint(sizeof(*cep));
27689ba682f0Skxie@chelsio.com 	if (!ep) {
27699ba682f0Skxie@chelsio.com 		err = -ENOMEM;
27709ba682f0Skxie@chelsio.com 		pr_info("iscsi alloc ep, OOM.\n");
27719ba682f0Skxie@chelsio.com 		goto release_conn;
27729ba682f0Skxie@chelsio.com 	}
27739ba682f0Skxie@chelsio.com 
27749ba682f0Skxie@chelsio.com 	cep = ep->dd_data;
27759ba682f0Skxie@chelsio.com 	cep->csk = csk;
27769ba682f0Skxie@chelsio.com 	cep->chba = hba;
27779ba682f0Skxie@chelsio.com 
27789ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_SOCK,
27799ba682f0Skxie@chelsio.com 		"ep 0x%p, cep 0x%p, csk 0x%p, hba 0x%p,%s.\n",
27809ba682f0Skxie@chelsio.com 		ep, cep, csk, hba, hba->ndev->name);
27819ba682f0Skxie@chelsio.com 	return ep;
27829ba682f0Skxie@chelsio.com 
27839ba682f0Skxie@chelsio.com release_conn:
27849ba682f0Skxie@chelsio.com 	cxgbi_sock_put(csk);
27859ba682f0Skxie@chelsio.com 	cxgbi_sock_closed(csk);
27869ba682f0Skxie@chelsio.com err_out:
27879ba682f0Skxie@chelsio.com 	return ERR_PTR(err);
27889ba682f0Skxie@chelsio.com }
27899ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_ep_connect);
27909ba682f0Skxie@chelsio.com 
27919ba682f0Skxie@chelsio.com int cxgbi_ep_poll(struct iscsi_endpoint *ep, int timeout_ms)
27929ba682f0Skxie@chelsio.com {
27939ba682f0Skxie@chelsio.com 	struct cxgbi_endpoint *cep = ep->dd_data;
27949ba682f0Skxie@chelsio.com 	struct cxgbi_sock *csk = cep->csk;
27959ba682f0Skxie@chelsio.com 
27969ba682f0Skxie@chelsio.com 	if (!cxgbi_sock_is_established(csk))
27979ba682f0Skxie@chelsio.com 		return 0;
27989ba682f0Skxie@chelsio.com 	return 1;
27999ba682f0Skxie@chelsio.com }
28009ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_ep_poll);
28019ba682f0Skxie@chelsio.com 
28029ba682f0Skxie@chelsio.com void cxgbi_ep_disconnect(struct iscsi_endpoint *ep)
28039ba682f0Skxie@chelsio.com {
28049ba682f0Skxie@chelsio.com 	struct cxgbi_endpoint *cep = ep->dd_data;
28059ba682f0Skxie@chelsio.com 	struct cxgbi_conn *cconn = cep->cconn;
28069ba682f0Skxie@chelsio.com 	struct cxgbi_sock *csk = cep->csk;
28079ba682f0Skxie@chelsio.com 
28089ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_SOCK,
28099ba682f0Skxie@chelsio.com 		"ep 0x%p, cep 0x%p, cconn 0x%p, csk 0x%p,%u,0x%lx.\n",
28109ba682f0Skxie@chelsio.com 		ep, cep, cconn, csk, csk->state, csk->flags);
28119ba682f0Skxie@chelsio.com 
28129ba682f0Skxie@chelsio.com 	if (cconn && cconn->iconn) {
28139ba682f0Skxie@chelsio.com 		iscsi_suspend_tx(cconn->iconn);
28149ba682f0Skxie@chelsio.com 		write_lock_bh(&csk->callback_lock);
28159ba682f0Skxie@chelsio.com 		cep->csk->user_data = NULL;
28169ba682f0Skxie@chelsio.com 		cconn->cep = NULL;
28179ba682f0Skxie@chelsio.com 		write_unlock_bh(&csk->callback_lock);
28189ba682f0Skxie@chelsio.com 	}
28199ba682f0Skxie@chelsio.com 	iscsi_destroy_endpoint(ep);
28209ba682f0Skxie@chelsio.com 
28219ba682f0Skxie@chelsio.com 	if (likely(csk->state >= CTP_ESTABLISHED))
28229ba682f0Skxie@chelsio.com 		need_active_close(csk);
28239ba682f0Skxie@chelsio.com 	else
28249ba682f0Skxie@chelsio.com 		cxgbi_sock_closed(csk);
28259ba682f0Skxie@chelsio.com 
28269ba682f0Skxie@chelsio.com 	cxgbi_sock_put(csk);
28279ba682f0Skxie@chelsio.com }
28289ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_ep_disconnect);
28299ba682f0Skxie@chelsio.com 
28309ba682f0Skxie@chelsio.com int cxgbi_iscsi_init(struct iscsi_transport *itp,
28319ba682f0Skxie@chelsio.com 			struct scsi_transport_template **stt)
28329ba682f0Skxie@chelsio.com {
28339ba682f0Skxie@chelsio.com 	*stt = iscsi_register_transport(itp);
28349ba682f0Skxie@chelsio.com 	if (*stt == NULL) {
28359ba682f0Skxie@chelsio.com 		pr_err("unable to register %s transport 0x%p.\n",
28369ba682f0Skxie@chelsio.com 			itp->name, itp);
28379ba682f0Skxie@chelsio.com 		return -ENODEV;
28389ba682f0Skxie@chelsio.com 	}
28399ba682f0Skxie@chelsio.com 	log_debug(1 << CXGBI_DBG_ISCSI,
28409ba682f0Skxie@chelsio.com 		"%s, registered iscsi transport 0x%p.\n",
28419ba682f0Skxie@chelsio.com 		itp->name, stt);
28429ba682f0Skxie@chelsio.com 	return 0;
28439ba682f0Skxie@chelsio.com }
28449ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_iscsi_init);
28459ba682f0Skxie@chelsio.com 
28469ba682f0Skxie@chelsio.com void cxgbi_iscsi_cleanup(struct iscsi_transport *itp,
28479ba682f0Skxie@chelsio.com 			struct scsi_transport_template **stt)
28489ba682f0Skxie@chelsio.com {
28499ba682f0Skxie@chelsio.com 	if (*stt) {
28509ba682f0Skxie@chelsio.com 		log_debug(1 << CXGBI_DBG_ISCSI,
28519ba682f0Skxie@chelsio.com 			"de-register transport 0x%p, %s, stt 0x%p.\n",
28529ba682f0Skxie@chelsio.com 			itp, itp->name, *stt);
28539ba682f0Skxie@chelsio.com 		*stt = NULL;
28549ba682f0Skxie@chelsio.com 		iscsi_unregister_transport(itp);
28559ba682f0Skxie@chelsio.com 	}
28569ba682f0Skxie@chelsio.com }
28579ba682f0Skxie@chelsio.com EXPORT_SYMBOL_GPL(cxgbi_iscsi_cleanup);
28589ba682f0Skxie@chelsio.com 
2859587a1f16SAl Viro umode_t cxgbi_attr_is_visible(int param_type, int param)
28603128c6c7SMike Christie {
28613128c6c7SMike Christie 	switch (param_type) {
2862f27fb2efSMike Christie 	case ISCSI_HOST_PARAM:
2863f27fb2efSMike Christie 		switch (param) {
2864f27fb2efSMike Christie 		case ISCSI_HOST_PARAM_NETDEV_NAME:
2865f27fb2efSMike Christie 		case ISCSI_HOST_PARAM_HWADDRESS:
2866f27fb2efSMike Christie 		case ISCSI_HOST_PARAM_IPADDRESS:
2867f27fb2efSMike Christie 		case ISCSI_HOST_PARAM_INITIATOR_NAME:
2868f27fb2efSMike Christie 			return S_IRUGO;
2869f27fb2efSMike Christie 		default:
2870f27fb2efSMike Christie 			return 0;
2871f27fb2efSMike Christie 		}
28723128c6c7SMike Christie 	case ISCSI_PARAM:
28733128c6c7SMike Christie 		switch (param) {
28743128c6c7SMike Christie 		case ISCSI_PARAM_MAX_RECV_DLENGTH:
28753128c6c7SMike Christie 		case ISCSI_PARAM_MAX_XMIT_DLENGTH:
28763128c6c7SMike Christie 		case ISCSI_PARAM_HDRDGST_EN:
28773128c6c7SMike Christie 		case ISCSI_PARAM_DATADGST_EN:
28783128c6c7SMike Christie 		case ISCSI_PARAM_CONN_ADDRESS:
28793128c6c7SMike Christie 		case ISCSI_PARAM_CONN_PORT:
28803128c6c7SMike Christie 		case ISCSI_PARAM_EXP_STATSN:
28813128c6c7SMike Christie 		case ISCSI_PARAM_PERSISTENT_ADDRESS:
28823128c6c7SMike Christie 		case ISCSI_PARAM_PERSISTENT_PORT:
28833128c6c7SMike Christie 		case ISCSI_PARAM_PING_TMO:
28843128c6c7SMike Christie 		case ISCSI_PARAM_RECV_TMO:
28851d063c17SMike Christie 		case ISCSI_PARAM_INITIAL_R2T_EN:
28861d063c17SMike Christie 		case ISCSI_PARAM_MAX_R2T:
28871d063c17SMike Christie 		case ISCSI_PARAM_IMM_DATA_EN:
28881d063c17SMike Christie 		case ISCSI_PARAM_FIRST_BURST:
28891d063c17SMike Christie 		case ISCSI_PARAM_MAX_BURST:
28901d063c17SMike Christie 		case ISCSI_PARAM_PDU_INORDER_EN:
28911d063c17SMike Christie 		case ISCSI_PARAM_DATASEQ_INORDER_EN:
28921d063c17SMike Christie 		case ISCSI_PARAM_ERL:
28931d063c17SMike Christie 		case ISCSI_PARAM_TARGET_NAME:
28941d063c17SMike Christie 		case ISCSI_PARAM_TPGT:
28951d063c17SMike Christie 		case ISCSI_PARAM_USERNAME:
28961d063c17SMike Christie 		case ISCSI_PARAM_PASSWORD:
28971d063c17SMike Christie 		case ISCSI_PARAM_USERNAME_IN:
28981d063c17SMike Christie 		case ISCSI_PARAM_PASSWORD_IN:
28991d063c17SMike Christie 		case ISCSI_PARAM_FAST_ABORT:
29001d063c17SMike Christie 		case ISCSI_PARAM_ABORT_TMO:
29011d063c17SMike Christie 		case ISCSI_PARAM_LU_RESET_TMO:
29021d063c17SMike Christie 		case ISCSI_PARAM_TGT_RESET_TMO:
29031d063c17SMike Christie 		case ISCSI_PARAM_IFACE_NAME:
29041d063c17SMike Christie 		case ISCSI_PARAM_INITIATOR_NAME:
29053128c6c7SMike Christie 			return S_IRUGO;
29063128c6c7SMike Christie 		default:
29073128c6c7SMike Christie 			return 0;
29083128c6c7SMike Christie 		}
29093128c6c7SMike Christie 	}
29103128c6c7SMike Christie 
29113128c6c7SMike Christie 	return 0;
29123128c6c7SMike Christie }
29133128c6c7SMike Christie EXPORT_SYMBOL_GPL(cxgbi_attr_is_visible);
29143128c6c7SMike Christie 
29159ba682f0Skxie@chelsio.com static int __init libcxgbi_init_module(void)
29169ba682f0Skxie@chelsio.com {
29179ba682f0Skxie@chelsio.com 	sw_tag_idx_bits = (__ilog2_u32(ISCSI_ITT_MASK)) + 1;
29189ba682f0Skxie@chelsio.com 	sw_tag_age_bits = (__ilog2_u32(ISCSI_AGE_MASK)) + 1;
29199ba682f0Skxie@chelsio.com 
2920*0ea5bf3dSKaren Xie 	pr_info("%s", version);
2921*0ea5bf3dSKaren Xie 
29229ba682f0Skxie@chelsio.com 	pr_info("tag itt 0x%x, %u bits, age 0x%x, %u bits.\n",
29239ba682f0Skxie@chelsio.com 		ISCSI_ITT_MASK, sw_tag_idx_bits,
29249ba682f0Skxie@chelsio.com 		ISCSI_AGE_MASK, sw_tag_age_bits);
29259ba682f0Skxie@chelsio.com 
29269ba682f0Skxie@chelsio.com 	ddp_setup_host_page_size();
29279ba682f0Skxie@chelsio.com 	return 0;
29289ba682f0Skxie@chelsio.com }
29299ba682f0Skxie@chelsio.com 
29309ba682f0Skxie@chelsio.com static void __exit libcxgbi_exit_module(void)
29319ba682f0Skxie@chelsio.com {
29329ba682f0Skxie@chelsio.com 	cxgbi_device_unregister_all(0xFF);
29339ba682f0Skxie@chelsio.com 	return;
29349ba682f0Skxie@chelsio.com }
29359ba682f0Skxie@chelsio.com 
29369ba682f0Skxie@chelsio.com module_init(libcxgbi_init_module);
29379ba682f0Skxie@chelsio.com module_exit(libcxgbi_exit_module);
2938