xref: /openbmc/linux/drivers/ntb/ntb_transport.c (revision 9143595a7e05a848384c240d34abcc4740a65897)
1fce8a7bbSJon Mason /*
2fce8a7bbSJon Mason  * This file is provided under a dual BSD/GPLv2 license.  When using or
3fce8a7bbSJon Mason  *   redistributing this file, you may do so under either license.
4fce8a7bbSJon Mason  *
5fce8a7bbSJon Mason  *   GPL LICENSE SUMMARY
6fce8a7bbSJon Mason  *
7fce8a7bbSJon Mason  *   Copyright(c) 2012 Intel Corporation. All rights reserved.
8e26a5843SAllen Hubbe  *   Copyright (C) 2015 EMC Corporation. All Rights Reserved.
9fce8a7bbSJon Mason  *
10fce8a7bbSJon Mason  *   This program is free software; you can redistribute it and/or modify
11fce8a7bbSJon Mason  *   it under the terms of version 2 of the GNU General Public License as
12fce8a7bbSJon Mason  *   published by the Free Software Foundation.
13fce8a7bbSJon Mason  *
14fce8a7bbSJon Mason  *   BSD LICENSE
15fce8a7bbSJon Mason  *
16fce8a7bbSJon Mason  *   Copyright(c) 2012 Intel Corporation. All rights reserved.
17e26a5843SAllen Hubbe  *   Copyright (C) 2015 EMC Corporation. All Rights Reserved.
18fce8a7bbSJon Mason  *
19fce8a7bbSJon Mason  *   Redistribution and use in source and binary forms, with or without
20fce8a7bbSJon Mason  *   modification, are permitted provided that the following conditions
21fce8a7bbSJon Mason  *   are met:
22fce8a7bbSJon Mason  *
23fce8a7bbSJon Mason  *     * Redistributions of source code must retain the above copyright
24fce8a7bbSJon Mason  *       notice, this list of conditions and the following disclaimer.
25fce8a7bbSJon Mason  *     * Redistributions in binary form must reproduce the above copy
26fce8a7bbSJon Mason  *       notice, this list of conditions and the following disclaimer in
27fce8a7bbSJon Mason  *       the documentation and/or other materials provided with the
28fce8a7bbSJon Mason  *       distribution.
29fce8a7bbSJon Mason  *     * Neither the name of Intel Corporation nor the names of its
30fce8a7bbSJon Mason  *       contributors may be used to endorse or promote products derived
31fce8a7bbSJon Mason  *       from this software without specific prior written permission.
32fce8a7bbSJon Mason  *
33fce8a7bbSJon Mason  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
34fce8a7bbSJon Mason  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
35fce8a7bbSJon Mason  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
36fce8a7bbSJon Mason  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
37fce8a7bbSJon Mason  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
38fce8a7bbSJon Mason  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
39fce8a7bbSJon Mason  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
40fce8a7bbSJon Mason  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
41fce8a7bbSJon Mason  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
42fce8a7bbSJon Mason  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
43fce8a7bbSJon Mason  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
44fce8a7bbSJon Mason  *
45e26a5843SAllen Hubbe  * PCIe NTB Transport Linux driver
46fce8a7bbSJon Mason  *
47fce8a7bbSJon Mason  * Contact Information:
48fce8a7bbSJon Mason  * Jon Mason <jon.mason@intel.com>
49fce8a7bbSJon Mason  */
50fce8a7bbSJon Mason #include <linux/debugfs.h>
51fce8a7bbSJon Mason #include <linux/delay.h>
52282a2feeSJon Mason #include <linux/dmaengine.h>
53fce8a7bbSJon Mason #include <linux/dma-mapping.h>
54fce8a7bbSJon Mason #include <linux/errno.h>
55fce8a7bbSJon Mason #include <linux/export.h>
56fce8a7bbSJon Mason #include <linux/interrupt.h>
57fce8a7bbSJon Mason #include <linux/module.h>
58fce8a7bbSJon Mason #include <linux/pci.h>
59fce8a7bbSJon Mason #include <linux/slab.h>
60fce8a7bbSJon Mason #include <linux/types.h>
6106917f75SDave Jiang #include <linux/uaccess.h>
62e26a5843SAllen Hubbe #include "linux/ntb.h"
63e26a5843SAllen Hubbe #include "linux/ntb_transport.h"
64fce8a7bbSJon Mason 
65e26a5843SAllen Hubbe #define NTB_TRANSPORT_VERSION	4
66e26a5843SAllen Hubbe #define NTB_TRANSPORT_VER	"4"
67e26a5843SAllen Hubbe #define NTB_TRANSPORT_NAME	"ntb_transport"
68e26a5843SAllen Hubbe #define NTB_TRANSPORT_DESC	"Software Queue-Pair Transport over NTB"
69b17faba0SShyam Sundar S K #define NTB_TRANSPORT_MIN_SPADS (MW0_SZ_HIGH + 2)
70e26a5843SAllen Hubbe 
71e26a5843SAllen Hubbe MODULE_DESCRIPTION(NTB_TRANSPORT_DESC);
72e26a5843SAllen Hubbe MODULE_VERSION(NTB_TRANSPORT_VER);
73e26a5843SAllen Hubbe MODULE_LICENSE("Dual BSD/GPL");
74e26a5843SAllen Hubbe MODULE_AUTHOR("Intel Corporation");
75e26a5843SAllen Hubbe 
76e26a5843SAllen Hubbe static unsigned long max_mw_size;
77e26a5843SAllen Hubbe module_param(max_mw_size, ulong, 0644);
78e26a5843SAllen Hubbe MODULE_PARM_DESC(max_mw_size, "Limit size of large memory windows");
79fce8a7bbSJon Mason 
809891417dSDave Jiang static unsigned int transport_mtu = 0x10000;
81fce8a7bbSJon Mason module_param(transport_mtu, uint, 0644);
82fce8a7bbSJon Mason MODULE_PARM_DESC(transport_mtu, "Maximum size of NTB transport packets");
83fce8a7bbSJon Mason 
84948d3a65SJon Mason static unsigned char max_num_clients;
85fce8a7bbSJon Mason module_param(max_num_clients, byte, 0644);
86fce8a7bbSJon Mason MODULE_PARM_DESC(max_num_clients, "Maximum number of NTB transport clients");
87fce8a7bbSJon Mason 
88282a2feeSJon Mason static unsigned int copy_bytes = 1024;
89282a2feeSJon Mason module_param(copy_bytes, uint, 0644);
90282a2feeSJon Mason MODULE_PARM_DESC(copy_bytes, "Threshold under which NTB will use the CPU to copy instead of DMA");
91282a2feeSJon Mason 
92a41ef053SDave Jiang static bool use_dma;
93a41ef053SDave Jiang module_param(use_dma, bool, 0644);
94a41ef053SDave Jiang MODULE_PARM_DESC(use_dma, "Use DMA engine to perform large data copy");
95a41ef053SDave Jiang 
96e26a5843SAllen Hubbe static struct dentry *nt_debugfs_dir;
97e26a5843SAllen Hubbe 
981e530119SSerge Semin /* Only two-ports NTB devices are supported */
991e530119SSerge Semin #define PIDX		NTB_DEF_PEER_IDX
1001e530119SSerge Semin 
101fce8a7bbSJon Mason struct ntb_queue_entry {
102fce8a7bbSJon Mason 	/* ntb_queue list reference */
103fce8a7bbSJon Mason 	struct list_head entry;
104e26a5843SAllen Hubbe 	/* pointers to data to be transferred */
105fce8a7bbSJon Mason 	void *cb_data;
106fce8a7bbSJon Mason 	void *buf;
107fce8a7bbSJon Mason 	unsigned int len;
108fce8a7bbSJon Mason 	unsigned int flags;
1099cabc269SDave Jiang 	int retries;
1109cabc269SDave Jiang 	int errors;
1119cabc269SDave Jiang 	unsigned int tx_index;
11272203572SDave Jiang 	unsigned int rx_index;
113282a2feeSJon Mason 
114282a2feeSJon Mason 	struct ntb_transport_qp *qp;
115282a2feeSJon Mason 	union {
116282a2feeSJon Mason 		struct ntb_payload_header __iomem *tx_hdr;
117282a2feeSJon Mason 		struct ntb_payload_header *rx_hdr;
118282a2feeSJon Mason 	};
119fce8a7bbSJon Mason };
120fce8a7bbSJon Mason 
121793c20e9SJon Mason struct ntb_rx_info {
122793c20e9SJon Mason 	unsigned int entry;
123793c20e9SJon Mason };
124793c20e9SJon Mason 
125fce8a7bbSJon Mason struct ntb_transport_qp {
126e26a5843SAllen Hubbe 	struct ntb_transport_ctx *transport;
127e26a5843SAllen Hubbe 	struct ntb_dev *ndev;
128fce8a7bbSJon Mason 	void *cb_data;
129569410caSDave Jiang 	struct dma_chan *tx_dma_chan;
130569410caSDave Jiang 	struct dma_chan *rx_dma_chan;
131fce8a7bbSJon Mason 
132fce8a7bbSJon Mason 	bool client_ready;
133e26a5843SAllen Hubbe 	bool link_is_up;
134e9021331SDave Jiang 	bool active;
135e26a5843SAllen Hubbe 
136fce8a7bbSJon Mason 	u8 qp_num;	/* Only 64 QP's are allowed.  0-63 */
137e26a5843SAllen Hubbe 	u64 qp_bit;
138fce8a7bbSJon Mason 
13974465645SJon Mason 	struct ntb_rx_info __iomem *rx_info;
140793c20e9SJon Mason 	struct ntb_rx_info *remote_rx_info;
141793c20e9SJon Mason 
142fce8a7bbSJon Mason 	void (*tx_handler)(struct ntb_transport_qp *qp, void *qp_data,
143fce8a7bbSJon Mason 			   void *data, int len);
144fce8a7bbSJon Mason 	struct list_head tx_free_q;
145fce8a7bbSJon Mason 	spinlock_t ntb_tx_free_q_lock;
14674465645SJon Mason 	void __iomem *tx_mw;
147282a2feeSJon Mason 	dma_addr_t tx_mw_phys;
148793c20e9SJon Mason 	unsigned int tx_index;
149793c20e9SJon Mason 	unsigned int tx_max_entry;
150ef114ed5SJon Mason 	unsigned int tx_max_frame;
151fce8a7bbSJon Mason 
152fce8a7bbSJon Mason 	void (*rx_handler)(struct ntb_transport_qp *qp, void *qp_data,
153fce8a7bbSJon Mason 			   void *data, int len);
154da2e5ae5SAllen Hubbe 	struct list_head rx_post_q;
155fce8a7bbSJon Mason 	struct list_head rx_pend_q;
156fce8a7bbSJon Mason 	struct list_head rx_free_q;
157da2e5ae5SAllen Hubbe 	/* ntb_rx_q_lock: synchronize access to rx_XXXX_q */
158da2e5ae5SAllen Hubbe 	spinlock_t ntb_rx_q_lock;
159793c20e9SJon Mason 	void *rx_buff;
160793c20e9SJon Mason 	unsigned int rx_index;
161793c20e9SJon Mason 	unsigned int rx_max_entry;
162ef114ed5SJon Mason 	unsigned int rx_max_frame;
163a754a8fcSDave Jiang 	unsigned int rx_alloc_entry;
164282a2feeSJon Mason 	dma_cookie_t last_cookie;
165e26a5843SAllen Hubbe 	struct tasklet_struct rxc_db_work;
166fce8a7bbSJon Mason 
167fce8a7bbSJon Mason 	void (*event_handler)(void *data, int status);
168fce8a7bbSJon Mason 	struct delayed_work link_work;
1697b4f2d3cSJon Mason 	struct work_struct link_cleanup;
170fce8a7bbSJon Mason 
171fce8a7bbSJon Mason 	struct dentry *debugfs_dir;
172fce8a7bbSJon Mason 	struct dentry *debugfs_stats;
173fce8a7bbSJon Mason 
174fce8a7bbSJon Mason 	/* Stats */
175fce8a7bbSJon Mason 	u64 rx_bytes;
176fce8a7bbSJon Mason 	u64 rx_pkts;
177fce8a7bbSJon Mason 	u64 rx_ring_empty;
178fce8a7bbSJon Mason 	u64 rx_err_no_buf;
179fce8a7bbSJon Mason 	u64 rx_err_oflow;
180fce8a7bbSJon Mason 	u64 rx_err_ver;
181282a2feeSJon Mason 	u64 rx_memcpy;
182282a2feeSJon Mason 	u64 rx_async;
183fce8a7bbSJon Mason 	u64 tx_bytes;
184fce8a7bbSJon Mason 	u64 tx_pkts;
185fce8a7bbSJon Mason 	u64 tx_ring_full;
186282a2feeSJon Mason 	u64 tx_err_no_buf;
187282a2feeSJon Mason 	u64 tx_memcpy;
188282a2feeSJon Mason 	u64 tx_async;
189fce8a7bbSJon Mason };
190fce8a7bbSJon Mason 
191fce8a7bbSJon Mason struct ntb_transport_mw {
192e26a5843SAllen Hubbe 	phys_addr_t phys_addr;
193e26a5843SAllen Hubbe 	resource_size_t phys_size;
194e26a5843SAllen Hubbe 	void __iomem *vbase;
195e26a5843SAllen Hubbe 	size_t xlat_size;
196e26a5843SAllen Hubbe 	size_t buff_size;
197fc5d1829SAaron Sierra 	size_t alloc_size;
198fc5d1829SAaron Sierra 	void *alloc_addr;
199fce8a7bbSJon Mason 	void *virt_addr;
200fce8a7bbSJon Mason 	dma_addr_t dma_addr;
201fce8a7bbSJon Mason };
202fce8a7bbSJon Mason 
203fce8a7bbSJon Mason struct ntb_transport_client_dev {
204fce8a7bbSJon Mason 	struct list_head entry;
205e26a5843SAllen Hubbe 	struct ntb_transport_ctx *nt;
206fce8a7bbSJon Mason 	struct device dev;
207fce8a7bbSJon Mason };
208fce8a7bbSJon Mason 
209e26a5843SAllen Hubbe struct ntb_transport_ctx {
210fce8a7bbSJon Mason 	struct list_head entry;
211fce8a7bbSJon Mason 	struct list_head client_devs;
212fce8a7bbSJon Mason 
213e26a5843SAllen Hubbe 	struct ntb_dev *ndev;
214e26a5843SAllen Hubbe 
215e26a5843SAllen Hubbe 	struct ntb_transport_mw *mw_vec;
216e26a5843SAllen Hubbe 	struct ntb_transport_qp *qp_vec;
217e26a5843SAllen Hubbe 	unsigned int mw_count;
218e26a5843SAllen Hubbe 	unsigned int qp_count;
219e26a5843SAllen Hubbe 	u64 qp_bitmap;
220e26a5843SAllen Hubbe 	u64 qp_bitmap_free;
221e26a5843SAllen Hubbe 
222e26a5843SAllen Hubbe 	bool link_is_up;
223fce8a7bbSJon Mason 	struct delayed_work link_work;
2247b4f2d3cSJon Mason 	struct work_struct link_cleanup;
225c8650fd0SDave Jiang 
226c8650fd0SDave Jiang 	struct dentry *debugfs_node_dir;
227fce8a7bbSJon Mason };
228fce8a7bbSJon Mason 
229fce8a7bbSJon Mason enum {
230e26a5843SAllen Hubbe 	DESC_DONE_FLAG = BIT(0),
231e26a5843SAllen Hubbe 	LINK_DOWN_FLAG = BIT(1),
232fce8a7bbSJon Mason };
233fce8a7bbSJon Mason 
234fce8a7bbSJon Mason struct ntb_payload_header {
23574465645SJon Mason 	unsigned int ver;
236fce8a7bbSJon Mason 	unsigned int len;
237fce8a7bbSJon Mason 	unsigned int flags;
238fce8a7bbSJon Mason };
239fce8a7bbSJon Mason 
240fce8a7bbSJon Mason enum {
241fce8a7bbSJon Mason 	VERSION = 0,
242fce8a7bbSJon Mason 	QP_LINKS,
243113fc505SJon Mason 	NUM_QPS,
244113fc505SJon Mason 	NUM_MWS,
245113fc505SJon Mason 	MW0_SZ_HIGH,
246113fc505SJon Mason 	MW0_SZ_LOW,
247fce8a7bbSJon Mason };
248fce8a7bbSJon Mason 
249e26a5843SAllen Hubbe #define dev_client_dev(__dev) \
250e26a5843SAllen Hubbe 	container_of((__dev), struct ntb_transport_client_dev, dev)
251e26a5843SAllen Hubbe 
252e26a5843SAllen Hubbe #define drv_client(__drv) \
253e26a5843SAllen Hubbe 	container_of((__drv), struct ntb_transport_client, driver)
254e26a5843SAllen Hubbe 
255e26a5843SAllen Hubbe #define QP_TO_MW(nt, qp)	((qp) % nt->mw_count)
256fce8a7bbSJon Mason #define NTB_QP_DEF_NUM_ENTRIES	100
257fce8a7bbSJon Mason #define NTB_LINK_DOWN_TIMEOUT	10
258fce8a7bbSJon Mason 
259e26a5843SAllen Hubbe static void ntb_transport_rxc_db(unsigned long data);
260e26a5843SAllen Hubbe static const struct ntb_ctx_ops ntb_transport_ops;
261e26a5843SAllen Hubbe static struct ntb_client ntb_transport_client;
2629cabc269SDave Jiang static int ntb_async_tx_submit(struct ntb_transport_qp *qp,
2639cabc269SDave Jiang 			       struct ntb_queue_entry *entry);
2649cabc269SDave Jiang static void ntb_memcpy_tx(struct ntb_queue_entry *entry, void __iomem *offset);
26572203572SDave Jiang static int ntb_async_rx_submit(struct ntb_queue_entry *entry, void *offset);
26672203572SDave Jiang static void ntb_memcpy_rx(struct ntb_queue_entry *entry, void *offset);
26772203572SDave Jiang 
268e26a5843SAllen Hubbe 
269e26a5843SAllen Hubbe static int ntb_transport_bus_match(struct device *dev,
270e26a5843SAllen Hubbe 				   struct device_driver *drv)
271fce8a7bbSJon Mason {
272fce8a7bbSJon Mason 	return !strncmp(dev_name(dev), drv->name, strlen(drv->name));
273fce8a7bbSJon Mason }
274fce8a7bbSJon Mason 
275e26a5843SAllen Hubbe static int ntb_transport_bus_probe(struct device *dev)
276fce8a7bbSJon Mason {
277e26a5843SAllen Hubbe 	const struct ntb_transport_client *client;
278fce8a7bbSJon Mason 	int rc = -EINVAL;
279fce8a7bbSJon Mason 
280fce8a7bbSJon Mason 	get_device(dev);
281e26a5843SAllen Hubbe 
282e26a5843SAllen Hubbe 	client = drv_client(dev->driver);
283e26a5843SAllen Hubbe 	rc = client->probe(dev);
284fce8a7bbSJon Mason 	if (rc)
285fce8a7bbSJon Mason 		put_device(dev);
286fce8a7bbSJon Mason 
287fce8a7bbSJon Mason 	return rc;
288fce8a7bbSJon Mason }
289fce8a7bbSJon Mason 
290e26a5843SAllen Hubbe static int ntb_transport_bus_remove(struct device *dev)
291fce8a7bbSJon Mason {
292e26a5843SAllen Hubbe 	const struct ntb_transport_client *client;
293fce8a7bbSJon Mason 
294e26a5843SAllen Hubbe 	client = drv_client(dev->driver);
295e26a5843SAllen Hubbe 	client->remove(dev);
296fce8a7bbSJon Mason 
297fce8a7bbSJon Mason 	put_device(dev);
298fce8a7bbSJon Mason 
299fce8a7bbSJon Mason 	return 0;
300fce8a7bbSJon Mason }
301fce8a7bbSJon Mason 
302e26a5843SAllen Hubbe static struct bus_type ntb_transport_bus = {
303e26a5843SAllen Hubbe 	.name = "ntb_transport",
304e26a5843SAllen Hubbe 	.match = ntb_transport_bus_match,
305e26a5843SAllen Hubbe 	.probe = ntb_transport_bus_probe,
306e26a5843SAllen Hubbe 	.remove = ntb_transport_bus_remove,
307fce8a7bbSJon Mason };
308fce8a7bbSJon Mason 
309fce8a7bbSJon Mason static LIST_HEAD(ntb_transport_list);
310fce8a7bbSJon Mason 
311e26a5843SAllen Hubbe static int ntb_bus_init(struct ntb_transport_ctx *nt)
312fce8a7bbSJon Mason {
31331510000SDave Jiang 	list_add_tail(&nt->entry, &ntb_transport_list);
314fce8a7bbSJon Mason 	return 0;
315fce8a7bbSJon Mason }
316fce8a7bbSJon Mason 
317e26a5843SAllen Hubbe static void ntb_bus_remove(struct ntb_transport_ctx *nt)
318fce8a7bbSJon Mason {
319fce8a7bbSJon Mason 	struct ntb_transport_client_dev *client_dev, *cd;
320fce8a7bbSJon Mason 
321fce8a7bbSJon Mason 	list_for_each_entry_safe(client_dev, cd, &nt->client_devs, entry) {
322fce8a7bbSJon Mason 		dev_err(client_dev->dev.parent, "%s still attached to bus, removing\n",
323fce8a7bbSJon Mason 			dev_name(&client_dev->dev));
324fce8a7bbSJon Mason 		list_del(&client_dev->entry);
325fce8a7bbSJon Mason 		device_unregister(&client_dev->dev);
326fce8a7bbSJon Mason 	}
327fce8a7bbSJon Mason 
328fce8a7bbSJon Mason 	list_del(&nt->entry);
329fce8a7bbSJon Mason }
330fce8a7bbSJon Mason 
331e26a5843SAllen Hubbe static void ntb_transport_client_release(struct device *dev)
332fce8a7bbSJon Mason {
333fce8a7bbSJon Mason 	struct ntb_transport_client_dev *client_dev;
334fce8a7bbSJon Mason 
335e26a5843SAllen Hubbe 	client_dev = dev_client_dev(dev);
336fce8a7bbSJon Mason 	kfree(client_dev);
337fce8a7bbSJon Mason }
338fce8a7bbSJon Mason 
339fce8a7bbSJon Mason /**
340e26a5843SAllen Hubbe  * ntb_transport_unregister_client_dev - Unregister NTB client device
341fce8a7bbSJon Mason  * @device_name: Name of NTB client device
342fce8a7bbSJon Mason  *
343fce8a7bbSJon Mason  * Unregister an NTB client device with the NTB transport layer
344fce8a7bbSJon Mason  */
345e26a5843SAllen Hubbe void ntb_transport_unregister_client_dev(char *device_name)
346fce8a7bbSJon Mason {
347fce8a7bbSJon Mason 	struct ntb_transport_client_dev *client, *cd;
348e26a5843SAllen Hubbe 	struct ntb_transport_ctx *nt;
349fce8a7bbSJon Mason 
350fce8a7bbSJon Mason 	list_for_each_entry(nt, &ntb_transport_list, entry)
351fce8a7bbSJon Mason 		list_for_each_entry_safe(client, cd, &nt->client_devs, entry)
352fce8a7bbSJon Mason 			if (!strncmp(dev_name(&client->dev), device_name,
353fce8a7bbSJon Mason 				     strlen(device_name))) {
354fce8a7bbSJon Mason 				list_del(&client->entry);
355fce8a7bbSJon Mason 				device_unregister(&client->dev);
356fce8a7bbSJon Mason 			}
357fce8a7bbSJon Mason }
358e26a5843SAllen Hubbe EXPORT_SYMBOL_GPL(ntb_transport_unregister_client_dev);
359fce8a7bbSJon Mason 
360fce8a7bbSJon Mason /**
361e26a5843SAllen Hubbe  * ntb_transport_register_client_dev - Register NTB client device
362fce8a7bbSJon Mason  * @device_name: Name of NTB client device
363fce8a7bbSJon Mason  *
364fce8a7bbSJon Mason  * Register an NTB client device with the NTB transport layer
365fce8a7bbSJon Mason  */
366e26a5843SAllen Hubbe int ntb_transport_register_client_dev(char *device_name)
367fce8a7bbSJon Mason {
368fce8a7bbSJon Mason 	struct ntb_transport_client_dev *client_dev;
369e26a5843SAllen Hubbe 	struct ntb_transport_ctx *nt;
3701199aa61SAllen Hubbe 	int node;
3718b19d450SJon Mason 	int rc, i = 0;
372fce8a7bbSJon Mason 
3738222b402SJon Mason 	if (list_empty(&ntb_transport_list))
3748222b402SJon Mason 		return -ENODEV;
3758222b402SJon Mason 
376fce8a7bbSJon Mason 	list_for_each_entry(nt, &ntb_transport_list, entry) {
377fce8a7bbSJon Mason 		struct device *dev;
378fce8a7bbSJon Mason 
3791199aa61SAllen Hubbe 		node = dev_to_node(&nt->ndev->dev);
3801199aa61SAllen Hubbe 
3811199aa61SAllen Hubbe 		client_dev = kzalloc_node(sizeof(*client_dev),
3821199aa61SAllen Hubbe 					  GFP_KERNEL, node);
383fce8a7bbSJon Mason 		if (!client_dev) {
384fce8a7bbSJon Mason 			rc = -ENOMEM;
385fce8a7bbSJon Mason 			goto err;
386fce8a7bbSJon Mason 		}
387fce8a7bbSJon Mason 
388fce8a7bbSJon Mason 		dev = &client_dev->dev;
389fce8a7bbSJon Mason 
390fce8a7bbSJon Mason 		/* setup and register client devices */
3918b19d450SJon Mason 		dev_set_name(dev, "%s%d", device_name, i);
392e26a5843SAllen Hubbe 		dev->bus = &ntb_transport_bus;
393e26a5843SAllen Hubbe 		dev->release = ntb_transport_client_release;
394e26a5843SAllen Hubbe 		dev->parent = &nt->ndev->dev;
395fce8a7bbSJon Mason 
396fce8a7bbSJon Mason 		rc = device_register(dev);
397fce8a7bbSJon Mason 		if (rc) {
398fce8a7bbSJon Mason 			kfree(client_dev);
399fce8a7bbSJon Mason 			goto err;
400fce8a7bbSJon Mason 		}
401fce8a7bbSJon Mason 
402fce8a7bbSJon Mason 		list_add_tail(&client_dev->entry, &nt->client_devs);
4038b19d450SJon Mason 		i++;
404fce8a7bbSJon Mason 	}
405fce8a7bbSJon Mason 
406fce8a7bbSJon Mason 	return 0;
407fce8a7bbSJon Mason 
408fce8a7bbSJon Mason err:
409e26a5843SAllen Hubbe 	ntb_transport_unregister_client_dev(device_name);
410fce8a7bbSJon Mason 
411fce8a7bbSJon Mason 	return rc;
412fce8a7bbSJon Mason }
413e26a5843SAllen Hubbe EXPORT_SYMBOL_GPL(ntb_transport_register_client_dev);
414fce8a7bbSJon Mason 
415fce8a7bbSJon Mason /**
416ec110bc7SAllen Hubbe  * ntb_transport_register_client - Register NTB client driver
417fce8a7bbSJon Mason  * @drv: NTB client driver to be registered
418fce8a7bbSJon Mason  *
419fce8a7bbSJon Mason  * Register an NTB client driver with the NTB transport layer
420fce8a7bbSJon Mason  *
421fce8a7bbSJon Mason  * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
422fce8a7bbSJon Mason  */
423e26a5843SAllen Hubbe int ntb_transport_register_client(struct ntb_transport_client *drv)
424fce8a7bbSJon Mason {
425e26a5843SAllen Hubbe 	drv->driver.bus = &ntb_transport_bus;
426fce8a7bbSJon Mason 
4278222b402SJon Mason 	if (list_empty(&ntb_transport_list))
4288222b402SJon Mason 		return -ENODEV;
4298222b402SJon Mason 
430fce8a7bbSJon Mason 	return driver_register(&drv->driver);
431fce8a7bbSJon Mason }
432ec110bc7SAllen Hubbe EXPORT_SYMBOL_GPL(ntb_transport_register_client);
433fce8a7bbSJon Mason 
434fce8a7bbSJon Mason /**
435ec110bc7SAllen Hubbe  * ntb_transport_unregister_client - Unregister NTB client driver
436fce8a7bbSJon Mason  * @drv: NTB client driver to be unregistered
437fce8a7bbSJon Mason  *
438fce8a7bbSJon Mason  * Unregister an NTB client driver with the NTB transport layer
439fce8a7bbSJon Mason  *
440fce8a7bbSJon Mason  * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
441fce8a7bbSJon Mason  */
442e26a5843SAllen Hubbe void ntb_transport_unregister_client(struct ntb_transport_client *drv)
443fce8a7bbSJon Mason {
444fce8a7bbSJon Mason 	driver_unregister(&drv->driver);
445fce8a7bbSJon Mason }
446ec110bc7SAllen Hubbe EXPORT_SYMBOL_GPL(ntb_transport_unregister_client);
447fce8a7bbSJon Mason 
448fce8a7bbSJon Mason static ssize_t debugfs_read(struct file *filp, char __user *ubuf, size_t count,
449fce8a7bbSJon Mason 			    loff_t *offp)
450fce8a7bbSJon Mason {
451fce8a7bbSJon Mason 	struct ntb_transport_qp *qp;
452d7237e22SJon Mason 	char *buf;
453fce8a7bbSJon Mason 	ssize_t ret, out_offset, out_count;
454fce8a7bbSJon Mason 
455260bee94SDave Jiang 	qp = filp->private_data;
456260bee94SDave Jiang 
457260bee94SDave Jiang 	if (!qp || !qp->link_is_up)
458260bee94SDave Jiang 		return 0;
459260bee94SDave Jiang 
460282a2feeSJon Mason 	out_count = 1000;
461d7237e22SJon Mason 
462d7237e22SJon Mason 	buf = kmalloc(out_count, GFP_KERNEL);
463d7237e22SJon Mason 	if (!buf)
464d7237e22SJon Mason 		return -ENOMEM;
465fce8a7bbSJon Mason 
466fce8a7bbSJon Mason 	out_offset = 0;
467fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
468d98ef99eSDave Jiang 			       "\nNTB QP stats:\n\n");
469fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
470fce8a7bbSJon Mason 			       "rx_bytes - \t%llu\n", qp->rx_bytes);
471fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
472fce8a7bbSJon Mason 			       "rx_pkts - \t%llu\n", qp->rx_pkts);
473fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
474282a2feeSJon Mason 			       "rx_memcpy - \t%llu\n", qp->rx_memcpy);
475282a2feeSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
476282a2feeSJon Mason 			       "rx_async - \t%llu\n", qp->rx_async);
477282a2feeSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
478fce8a7bbSJon Mason 			       "rx_ring_empty - %llu\n", qp->rx_ring_empty);
479fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
480fce8a7bbSJon Mason 			       "rx_err_no_buf - %llu\n", qp->rx_err_no_buf);
481fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
482fce8a7bbSJon Mason 			       "rx_err_oflow - \t%llu\n", qp->rx_err_oflow);
483fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
484fce8a7bbSJon Mason 			       "rx_err_ver - \t%llu\n", qp->rx_err_ver);
485fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
486d98ef99eSDave Jiang 			       "rx_buff - \t0x%p\n", qp->rx_buff);
487fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
488793c20e9SJon Mason 			       "rx_index - \t%u\n", qp->rx_index);
489fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
490a754a8fcSDave Jiang 			       "rx_max_entry - \t%u\n", qp->rx_max_entry);
491a754a8fcSDave Jiang 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
492a754a8fcSDave Jiang 			       "rx_alloc_entry - \t%u\n\n", qp->rx_alloc_entry);
493fce8a7bbSJon Mason 
494fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
495fce8a7bbSJon Mason 			       "tx_bytes - \t%llu\n", qp->tx_bytes);
496fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
497fce8a7bbSJon Mason 			       "tx_pkts - \t%llu\n", qp->tx_pkts);
498fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
499282a2feeSJon Mason 			       "tx_memcpy - \t%llu\n", qp->tx_memcpy);
500282a2feeSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
501282a2feeSJon Mason 			       "tx_async - \t%llu\n", qp->tx_async);
502282a2feeSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
503fce8a7bbSJon Mason 			       "tx_ring_full - \t%llu\n", qp->tx_ring_full);
504fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
505282a2feeSJon Mason 			       "tx_err_no_buf - %llu\n", qp->tx_err_no_buf);
506282a2feeSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
507d98ef99eSDave Jiang 			       "tx_mw - \t0x%p\n", qp->tx_mw);
508fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
509d98ef99eSDave Jiang 			       "tx_index (H) - \t%u\n", qp->tx_index);
510d98ef99eSDave Jiang 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
511d98ef99eSDave Jiang 			       "RRI (T) - \t%u\n",
512d98ef99eSDave Jiang 			       qp->remote_rx_info->entry);
513fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
514793c20e9SJon Mason 			       "tx_max_entry - \t%u\n", qp->tx_max_entry);
515e74bfeedSDave Jiang 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
516e74bfeedSDave Jiang 			       "free tx - \t%u\n",
517e74bfeedSDave Jiang 			       ntb_transport_tx_free_entry(qp));
518fce8a7bbSJon Mason 
519fce8a7bbSJon Mason 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
520d98ef99eSDave Jiang 			       "\n");
521d98ef99eSDave Jiang 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
522569410caSDave Jiang 			       "Using TX DMA - \t%s\n",
523569410caSDave Jiang 			       qp->tx_dma_chan ? "Yes" : "No");
524569410caSDave Jiang 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
525569410caSDave Jiang 			       "Using RX DMA - \t%s\n",
526569410caSDave Jiang 			       qp->rx_dma_chan ? "Yes" : "No");
527d98ef99eSDave Jiang 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
528d98ef99eSDave Jiang 			       "QP Link - \t%s\n",
529e26a5843SAllen Hubbe 			       qp->link_is_up ? "Up" : "Down");
530d98ef99eSDave Jiang 	out_offset += snprintf(buf + out_offset, out_count - out_offset,
531d98ef99eSDave Jiang 			       "\n");
532d98ef99eSDave Jiang 
533d7237e22SJon Mason 	if (out_offset > out_count)
534d7237e22SJon Mason 		out_offset = out_count;
535fce8a7bbSJon Mason 
536fce8a7bbSJon Mason 	ret = simple_read_from_buffer(ubuf, count, offp, buf, out_offset);
537d7237e22SJon Mason 	kfree(buf);
538fce8a7bbSJon Mason 	return ret;
539fce8a7bbSJon Mason }
540fce8a7bbSJon Mason 
541fce8a7bbSJon Mason static const struct file_operations ntb_qp_debugfs_stats = {
542fce8a7bbSJon Mason 	.owner = THIS_MODULE,
543d66d7ac2SJon Mason 	.open = simple_open,
544fce8a7bbSJon Mason 	.read = debugfs_read,
545fce8a7bbSJon Mason };
546fce8a7bbSJon Mason 
547fce8a7bbSJon Mason static void ntb_list_add(spinlock_t *lock, struct list_head *entry,
548fce8a7bbSJon Mason 			 struct list_head *list)
549fce8a7bbSJon Mason {
550fce8a7bbSJon Mason 	unsigned long flags;
551fce8a7bbSJon Mason 
552fce8a7bbSJon Mason 	spin_lock_irqsave(lock, flags);
553fce8a7bbSJon Mason 	list_add_tail(entry, list);
554fce8a7bbSJon Mason 	spin_unlock_irqrestore(lock, flags);
555fce8a7bbSJon Mason }
556fce8a7bbSJon Mason 
557fce8a7bbSJon Mason static struct ntb_queue_entry *ntb_list_rm(spinlock_t *lock,
558fce8a7bbSJon Mason 					   struct list_head *list)
559fce8a7bbSJon Mason {
560fce8a7bbSJon Mason 	struct ntb_queue_entry *entry;
561fce8a7bbSJon Mason 	unsigned long flags;
562fce8a7bbSJon Mason 
563fce8a7bbSJon Mason 	spin_lock_irqsave(lock, flags);
564fce8a7bbSJon Mason 	if (list_empty(list)) {
565fce8a7bbSJon Mason 		entry = NULL;
566fce8a7bbSJon Mason 		goto out;
567fce8a7bbSJon Mason 	}
568fce8a7bbSJon Mason 	entry = list_first_entry(list, struct ntb_queue_entry, entry);
569fce8a7bbSJon Mason 	list_del(&entry->entry);
570e74bfeedSDave Jiang 
571fce8a7bbSJon Mason out:
572fce8a7bbSJon Mason 	spin_unlock_irqrestore(lock, flags);
573fce8a7bbSJon Mason 
574fce8a7bbSJon Mason 	return entry;
575fce8a7bbSJon Mason }
576fce8a7bbSJon Mason 
577da2e5ae5SAllen Hubbe static struct ntb_queue_entry *ntb_list_mv(spinlock_t *lock,
578da2e5ae5SAllen Hubbe 					   struct list_head *list,
579da2e5ae5SAllen Hubbe 					   struct list_head *to_list)
580da2e5ae5SAllen Hubbe {
581da2e5ae5SAllen Hubbe 	struct ntb_queue_entry *entry;
582da2e5ae5SAllen Hubbe 	unsigned long flags;
583da2e5ae5SAllen Hubbe 
584da2e5ae5SAllen Hubbe 	spin_lock_irqsave(lock, flags);
585da2e5ae5SAllen Hubbe 
586da2e5ae5SAllen Hubbe 	if (list_empty(list)) {
587da2e5ae5SAllen Hubbe 		entry = NULL;
588da2e5ae5SAllen Hubbe 	} else {
589da2e5ae5SAllen Hubbe 		entry = list_first_entry(list, struct ntb_queue_entry, entry);
590da2e5ae5SAllen Hubbe 		list_move_tail(&entry->entry, to_list);
591da2e5ae5SAllen Hubbe 	}
592da2e5ae5SAllen Hubbe 
593da2e5ae5SAllen Hubbe 	spin_unlock_irqrestore(lock, flags);
594da2e5ae5SAllen Hubbe 
595da2e5ae5SAllen Hubbe 	return entry;
596da2e5ae5SAllen Hubbe }
597da2e5ae5SAllen Hubbe 
598e26a5843SAllen Hubbe static int ntb_transport_setup_qp_mw(struct ntb_transport_ctx *nt,
599fce8a7bbSJon Mason 				     unsigned int qp_num)
600fce8a7bbSJon Mason {
601e26a5843SAllen Hubbe 	struct ntb_transport_qp *qp = &nt->qp_vec[qp_num];
602e26a5843SAllen Hubbe 	struct ntb_transport_mw *mw;
603a754a8fcSDave Jiang 	struct ntb_dev *ndev = nt->ndev;
604a754a8fcSDave Jiang 	struct ntb_queue_entry *entry;
605ef114ed5SJon Mason 	unsigned int rx_size, num_qps_mw;
606e26a5843SAllen Hubbe 	unsigned int mw_num, mw_count, qp_count;
607793c20e9SJon Mason 	unsigned int i;
608a754a8fcSDave Jiang 	int node;
609fce8a7bbSJon Mason 
610e26a5843SAllen Hubbe 	mw_count = nt->mw_count;
611e26a5843SAllen Hubbe 	qp_count = nt->qp_count;
612948d3a65SJon Mason 
613e26a5843SAllen Hubbe 	mw_num = QP_TO_MW(nt, qp_num);
614e26a5843SAllen Hubbe 	mw = &nt->mw_vec[mw_num];
615fce8a7bbSJon Mason 
616e26a5843SAllen Hubbe 	if (!mw->virt_addr)
617e26a5843SAllen Hubbe 		return -ENOMEM;
618e26a5843SAllen Hubbe 
6198e8496e0SLogan Gunthorpe 	if (mw_num < qp_count % mw_count)
620e26a5843SAllen Hubbe 		num_qps_mw = qp_count / mw_count + 1;
621fce8a7bbSJon Mason 	else
622e26a5843SAllen Hubbe 		num_qps_mw = qp_count / mw_count;
623fce8a7bbSJon Mason 
624e26a5843SAllen Hubbe 	rx_size = (unsigned int)mw->xlat_size / num_qps_mw;
625c92ba3c5SJon Mason 	qp->rx_buff = mw->virt_addr + rx_size * (qp_num / mw_count);
626793c20e9SJon Mason 	rx_size -= sizeof(struct ntb_rx_info);
627793c20e9SJon Mason 
628282a2feeSJon Mason 	qp->remote_rx_info = qp->rx_buff + rx_size;
629282a2feeSJon Mason 
630c9d534c8SJon Mason 	/* Due to housekeeping, there must be atleast 2 buffs */
631c9d534c8SJon Mason 	qp->rx_max_frame = min(transport_mtu, rx_size / 2);
632793c20e9SJon Mason 	qp->rx_max_entry = rx_size / qp->rx_max_frame;
633793c20e9SJon Mason 	qp->rx_index = 0;
634793c20e9SJon Mason 
635a754a8fcSDave Jiang 	/*
636a754a8fcSDave Jiang 	 * Checking to see if we have more entries than the default.
637a754a8fcSDave Jiang 	 * We should add additional entries if that is the case so we
638a754a8fcSDave Jiang 	 * can be in sync with the transport frames.
639a754a8fcSDave Jiang 	 */
640a754a8fcSDave Jiang 	node = dev_to_node(&ndev->dev);
641a754a8fcSDave Jiang 	for (i = qp->rx_alloc_entry; i < qp->rx_max_entry; i++) {
64282edcc75SJia-Ju Bai 		entry = kzalloc_node(sizeof(*entry), GFP_KERNEL, node);
643a754a8fcSDave Jiang 		if (!entry)
644a754a8fcSDave Jiang 			return -ENOMEM;
645a754a8fcSDave Jiang 
646a754a8fcSDave Jiang 		entry->qp = qp;
647a754a8fcSDave Jiang 		ntb_list_add(&qp->ntb_rx_q_lock, &entry->entry,
648a754a8fcSDave Jiang 			     &qp->rx_free_q);
649a754a8fcSDave Jiang 		qp->rx_alloc_entry++;
650a754a8fcSDave Jiang 	}
651a754a8fcSDave Jiang 
652c9d534c8SJon Mason 	qp->remote_rx_info->entry = qp->rx_max_entry - 1;
653fce8a7bbSJon Mason 
654ef114ed5SJon Mason 	/* setup the hdr offsets with 0's */
655793c20e9SJon Mason 	for (i = 0; i < qp->rx_max_entry; i++) {
656e26a5843SAllen Hubbe 		void *offset = (qp->rx_buff + qp->rx_max_frame * (i + 1) -
657e26a5843SAllen Hubbe 				sizeof(struct ntb_payload_header));
658ef114ed5SJon Mason 		memset(offset, 0, sizeof(struct ntb_payload_header));
659793c20e9SJon Mason 	}
660fce8a7bbSJon Mason 
661fce8a7bbSJon Mason 	qp->rx_pkts = 0;
662fce8a7bbSJon Mason 	qp->tx_pkts = 0;
66390f9e934SJon Mason 	qp->tx_index = 0;
664e26a5843SAllen Hubbe 
665e26a5843SAllen Hubbe 	return 0;
666fce8a7bbSJon Mason }
667fce8a7bbSJon Mason 
668e26a5843SAllen Hubbe static void ntb_free_mw(struct ntb_transport_ctx *nt, int num_mw)
669113fc505SJon Mason {
670e26a5843SAllen Hubbe 	struct ntb_transport_mw *mw = &nt->mw_vec[num_mw];
671e26a5843SAllen Hubbe 	struct pci_dev *pdev = nt->ndev->pdev;
672113fc505SJon Mason 
673113fc505SJon Mason 	if (!mw->virt_addr)
674113fc505SJon Mason 		return;
675113fc505SJon Mason 
676443b9a14SSerge Semin 	ntb_mw_clear_trans(nt->ndev, PIDX, num_mw);
677fc5d1829SAaron Sierra 	dma_free_coherent(&pdev->dev, mw->alloc_size,
678fc5d1829SAaron Sierra 			  mw->alloc_addr, mw->dma_addr);
679e26a5843SAllen Hubbe 	mw->xlat_size = 0;
680e26a5843SAllen Hubbe 	mw->buff_size = 0;
681fc5d1829SAaron Sierra 	mw->alloc_size = 0;
682fc5d1829SAaron Sierra 	mw->alloc_addr = NULL;
683113fc505SJon Mason 	mw->virt_addr = NULL;
684113fc505SJon Mason }
685113fc505SJon Mason 
686fc5d1829SAaron Sierra static int ntb_alloc_mw_buffer(struct ntb_transport_mw *mw,
687fc5d1829SAaron Sierra 			       struct device *dma_dev, size_t align)
688fc5d1829SAaron Sierra {
689fc5d1829SAaron Sierra 	dma_addr_t dma_addr;
690fc5d1829SAaron Sierra 	void *alloc_addr, *virt_addr;
691fc5d1829SAaron Sierra 	int rc;
692fc5d1829SAaron Sierra 
693fc5d1829SAaron Sierra 	alloc_addr = dma_alloc_coherent(dma_dev, mw->alloc_size,
694fc5d1829SAaron Sierra 					&dma_addr, GFP_KERNEL);
695fc5d1829SAaron Sierra 	if (!alloc_addr) {
696fc5d1829SAaron Sierra 		dev_err(dma_dev, "Unable to alloc MW buff of size %zu\n",
697fc5d1829SAaron Sierra 			mw->alloc_size);
698fc5d1829SAaron Sierra 		return -ENOMEM;
699fc5d1829SAaron Sierra 	}
700fc5d1829SAaron Sierra 	virt_addr = alloc_addr;
701fc5d1829SAaron Sierra 
702fc5d1829SAaron Sierra 	/*
703fc5d1829SAaron Sierra 	 * we must ensure that the memory address allocated is BAR size
704fc5d1829SAaron Sierra 	 * aligned in order for the XLAT register to take the value. This
705fc5d1829SAaron Sierra 	 * is a requirement of the hardware. It is recommended to setup CMA
706fc5d1829SAaron Sierra 	 * for BAR sizes equal or greater than 4MB.
707fc5d1829SAaron Sierra 	 */
708fc5d1829SAaron Sierra 	if (!IS_ALIGNED(dma_addr, align)) {
709fc5d1829SAaron Sierra 		if (mw->alloc_size > mw->buff_size) {
710fc5d1829SAaron Sierra 			virt_addr = PTR_ALIGN(alloc_addr, align);
711fc5d1829SAaron Sierra 			dma_addr = ALIGN(dma_addr, align);
712fc5d1829SAaron Sierra 		} else {
713fc5d1829SAaron Sierra 			rc = -ENOMEM;
714fc5d1829SAaron Sierra 			goto err;
715fc5d1829SAaron Sierra 		}
716fc5d1829SAaron Sierra 	}
717fc5d1829SAaron Sierra 
718fc5d1829SAaron Sierra 	mw->alloc_addr = alloc_addr;
719fc5d1829SAaron Sierra 	mw->virt_addr = virt_addr;
720fc5d1829SAaron Sierra 	mw->dma_addr = dma_addr;
721fc5d1829SAaron Sierra 
722fc5d1829SAaron Sierra 	return 0;
723fc5d1829SAaron Sierra 
724fc5d1829SAaron Sierra err:
725fc5d1829SAaron Sierra 	dma_free_coherent(dma_dev, mw->alloc_size, alloc_addr, dma_addr);
726fc5d1829SAaron Sierra 
727fc5d1829SAaron Sierra 	return rc;
728fc5d1829SAaron Sierra }
729fc5d1829SAaron Sierra 
730e26a5843SAllen Hubbe static int ntb_set_mw(struct ntb_transport_ctx *nt, int num_mw,
7318c9edf63SAllen Hubbe 		      resource_size_t size)
732b77b2637SJon Mason {
733e26a5843SAllen Hubbe 	struct ntb_transport_mw *mw = &nt->mw_vec[num_mw];
734e26a5843SAllen Hubbe 	struct pci_dev *pdev = nt->ndev->pdev;
7358c9edf63SAllen Hubbe 	size_t xlat_size, buff_size;
736980c41c8SLogan Gunthorpe 	resource_size_t xlat_align;
737980c41c8SLogan Gunthorpe 	resource_size_t xlat_align_size;
738e26a5843SAllen Hubbe 	int rc;
739e26a5843SAllen Hubbe 
7408c9edf63SAllen Hubbe 	if (!size)
7418c9edf63SAllen Hubbe 		return -EINVAL;
7428c9edf63SAllen Hubbe 
743980c41c8SLogan Gunthorpe 	rc = ntb_mw_get_align(nt->ndev, PIDX, num_mw, &xlat_align,
744980c41c8SLogan Gunthorpe 			      &xlat_align_size, NULL);
745980c41c8SLogan Gunthorpe 	if (rc)
746980c41c8SLogan Gunthorpe 		return rc;
747980c41c8SLogan Gunthorpe 
748980c41c8SLogan Gunthorpe 	xlat_size = round_up(size, xlat_align_size);
749980c41c8SLogan Gunthorpe 	buff_size = round_up(size, xlat_align);
750b77b2637SJon Mason 
751b77b2637SJon Mason 	/* No need to re-setup */
752e26a5843SAllen Hubbe 	if (mw->xlat_size == xlat_size)
753b77b2637SJon Mason 		return 0;
754b77b2637SJon Mason 
755e26a5843SAllen Hubbe 	if (mw->buff_size)
756b77b2637SJon Mason 		ntb_free_mw(nt, num_mw);
757b77b2637SJon Mason 
758e26a5843SAllen Hubbe 	/* Alloc memory for receiving data.  Must be aligned */
759e26a5843SAllen Hubbe 	mw->xlat_size = xlat_size;
760e26a5843SAllen Hubbe 	mw->buff_size = buff_size;
761fc5d1829SAaron Sierra 	mw->alloc_size = buff_size;
762b77b2637SJon Mason 
763fc5d1829SAaron Sierra 	rc = ntb_alloc_mw_buffer(mw, &pdev->dev, xlat_align);
764fc5d1829SAaron Sierra 	if (rc) {
765fc5d1829SAaron Sierra 		mw->alloc_size *= 2;
766fc5d1829SAaron Sierra 		rc = ntb_alloc_mw_buffer(mw, &pdev->dev, xlat_align);
767fc5d1829SAaron Sierra 		if (rc) {
768fc5d1829SAaron Sierra 			dev_err(&pdev->dev,
769fc5d1829SAaron Sierra 				"Unable to alloc aligned MW buff\n");
770e26a5843SAllen Hubbe 			mw->xlat_size = 0;
771e26a5843SAllen Hubbe 			mw->buff_size = 0;
772fc5d1829SAaron Sierra 			mw->alloc_size = 0;
773fc5d1829SAaron Sierra 			return rc;
774b77b2637SJon Mason 		}
7753cc5ba19SDave Jiang 	}
7763cc5ba19SDave Jiang 
777b77b2637SJon Mason 	/* Notify HW the memory location of the receive buffer */
778443b9a14SSerge Semin 	rc = ntb_mw_set_trans(nt->ndev, PIDX, num_mw, mw->dma_addr,
779443b9a14SSerge Semin 			      mw->xlat_size);
780e26a5843SAllen Hubbe 	if (rc) {
781e26a5843SAllen Hubbe 		dev_err(&pdev->dev, "Unable to set mw%d translation", num_mw);
782e26a5843SAllen Hubbe 		ntb_free_mw(nt, num_mw);
783e26a5843SAllen Hubbe 		return -EIO;
784e26a5843SAllen Hubbe 	}
785b77b2637SJon Mason 
786b77b2637SJon Mason 	return 0;
787b77b2637SJon Mason }
788b77b2637SJon Mason 
7892849b5d7SAllen Hubbe static void ntb_qp_link_down_reset(struct ntb_transport_qp *qp)
7902849b5d7SAllen Hubbe {
7912849b5d7SAllen Hubbe 	qp->link_is_up = false;
792e9021331SDave Jiang 	qp->active = false;
7932849b5d7SAllen Hubbe 
7942849b5d7SAllen Hubbe 	qp->tx_index = 0;
7952849b5d7SAllen Hubbe 	qp->rx_index = 0;
7962849b5d7SAllen Hubbe 	qp->rx_bytes = 0;
7972849b5d7SAllen Hubbe 	qp->rx_pkts = 0;
7982849b5d7SAllen Hubbe 	qp->rx_ring_empty = 0;
7992849b5d7SAllen Hubbe 	qp->rx_err_no_buf = 0;
8002849b5d7SAllen Hubbe 	qp->rx_err_oflow = 0;
8012849b5d7SAllen Hubbe 	qp->rx_err_ver = 0;
8022849b5d7SAllen Hubbe 	qp->rx_memcpy = 0;
8032849b5d7SAllen Hubbe 	qp->rx_async = 0;
8042849b5d7SAllen Hubbe 	qp->tx_bytes = 0;
8052849b5d7SAllen Hubbe 	qp->tx_pkts = 0;
8062849b5d7SAllen Hubbe 	qp->tx_ring_full = 0;
8072849b5d7SAllen Hubbe 	qp->tx_err_no_buf = 0;
8082849b5d7SAllen Hubbe 	qp->tx_memcpy = 0;
8092849b5d7SAllen Hubbe 	qp->tx_async = 0;
8102849b5d7SAllen Hubbe }
8112849b5d7SAllen Hubbe 
812fca4d518SJon Mason static void ntb_qp_link_cleanup(struct ntb_transport_qp *qp)
813fce8a7bbSJon Mason {
814e26a5843SAllen Hubbe 	struct ntb_transport_ctx *nt = qp->transport;
815e26a5843SAllen Hubbe 	struct pci_dev *pdev = nt->ndev->pdev;
816fce8a7bbSJon Mason 
817e22e0b9dSAllen Hubbe 	dev_info(&pdev->dev, "qp %d: Link Cleanup\n", qp->qp_num);
8182849b5d7SAllen Hubbe 
8192849b5d7SAllen Hubbe 	cancel_delayed_work_sync(&qp->link_work);
8202849b5d7SAllen Hubbe 	ntb_qp_link_down_reset(qp);
821e26a5843SAllen Hubbe 
822e26a5843SAllen Hubbe 	if (qp->event_handler)
823e26a5843SAllen Hubbe 		qp->event_handler(qp->cb_data, qp->link_is_up);
824fca4d518SJon Mason }
825fca4d518SJon Mason 
826fca4d518SJon Mason static void ntb_qp_link_cleanup_work(struct work_struct *work)
827fca4d518SJon Mason {
828fca4d518SJon Mason 	struct ntb_transport_qp *qp = container_of(work,
829fca4d518SJon Mason 						   struct ntb_transport_qp,
830fca4d518SJon Mason 						   link_cleanup);
831e26a5843SAllen Hubbe 	struct ntb_transport_ctx *nt = qp->transport;
832fca4d518SJon Mason 
833fca4d518SJon Mason 	ntb_qp_link_cleanup(qp);
834fce8a7bbSJon Mason 
835e26a5843SAllen Hubbe 	if (nt->link_is_up)
836fce8a7bbSJon Mason 		schedule_delayed_work(&qp->link_work,
837fce8a7bbSJon Mason 				      msecs_to_jiffies(NTB_LINK_DOWN_TIMEOUT));
838fce8a7bbSJon Mason }
839fce8a7bbSJon Mason 
8407b4f2d3cSJon Mason static void ntb_qp_link_down(struct ntb_transport_qp *qp)
841fce8a7bbSJon Mason {
8427b4f2d3cSJon Mason 	schedule_work(&qp->link_cleanup);
8437b4f2d3cSJon Mason }
8447b4f2d3cSJon Mason 
845e26a5843SAllen Hubbe static void ntb_transport_link_cleanup(struct ntb_transport_ctx *nt)
8467b4f2d3cSJon Mason {
847e26a5843SAllen Hubbe 	struct ntb_transport_qp *qp;
848e26a5843SAllen Hubbe 	u64 qp_bitmap_alloc;
849b17faba0SShyam Sundar S K 	unsigned int i, count;
850fce8a7bbSJon Mason 
851e26a5843SAllen Hubbe 	qp_bitmap_alloc = nt->qp_bitmap & ~nt->qp_bitmap_free;
852fca4d518SJon Mason 
853e26a5843SAllen Hubbe 	/* Pass along the info to any clients */
854e26a5843SAllen Hubbe 	for (i = 0; i < nt->qp_count; i++)
855e26a5843SAllen Hubbe 		if (qp_bitmap_alloc & BIT_ULL(i)) {
856e26a5843SAllen Hubbe 			qp = &nt->qp_vec[i];
857e26a5843SAllen Hubbe 			ntb_qp_link_cleanup(qp);
858e26a5843SAllen Hubbe 			cancel_work_sync(&qp->link_cleanup);
859e26a5843SAllen Hubbe 			cancel_delayed_work_sync(&qp->link_work);
860e26a5843SAllen Hubbe 		}
861e26a5843SAllen Hubbe 
862e26a5843SAllen Hubbe 	if (!nt->link_is_up)
863fce8a7bbSJon Mason 		cancel_delayed_work_sync(&nt->link_work);
864fce8a7bbSJon Mason 
865*9143595aSJoey Zhang 	for (i = 0; i < nt->mw_count; i++)
866*9143595aSJoey Zhang 		ntb_free_mw(nt, i);
867*9143595aSJoey Zhang 
868fce8a7bbSJon Mason 	/* The scratchpad registers keep the values if the remote side
869fce8a7bbSJon Mason 	 * goes down, blast them now to give them a sane value the next
870fce8a7bbSJon Mason 	 * time they are accessed
871fce8a7bbSJon Mason 	 */
872b17faba0SShyam Sundar S K 	count = ntb_spad_count(nt->ndev);
873b17faba0SShyam Sundar S K 	for (i = 0; i < count; i++)
874e26a5843SAllen Hubbe 		ntb_spad_write(nt->ndev, i, 0);
875fce8a7bbSJon Mason }
876fce8a7bbSJon Mason 
877fca4d518SJon Mason static void ntb_transport_link_cleanup_work(struct work_struct *work)
878fca4d518SJon Mason {
879e26a5843SAllen Hubbe 	struct ntb_transport_ctx *nt =
880e26a5843SAllen Hubbe 		container_of(work, struct ntb_transport_ctx, link_cleanup);
881fca4d518SJon Mason 
882fca4d518SJon Mason 	ntb_transport_link_cleanup(nt);
883fca4d518SJon Mason }
884fca4d518SJon Mason 
885e26a5843SAllen Hubbe static void ntb_transport_event_callback(void *data)
886fce8a7bbSJon Mason {
887e26a5843SAllen Hubbe 	struct ntb_transport_ctx *nt = data;
888fce8a7bbSJon Mason 
889e26a5843SAllen Hubbe 	if (ntb_link_is_up(nt->ndev, NULL, NULL) == 1)
890fce8a7bbSJon Mason 		schedule_delayed_work(&nt->link_work, 0);
891e26a5843SAllen Hubbe 	else
8927b4f2d3cSJon Mason 		schedule_work(&nt->link_cleanup);
893fce8a7bbSJon Mason }
894fce8a7bbSJon Mason 
895fce8a7bbSJon Mason static void ntb_transport_link_work(struct work_struct *work)
896fce8a7bbSJon Mason {
897e26a5843SAllen Hubbe 	struct ntb_transport_ctx *nt =
898e26a5843SAllen Hubbe 		container_of(work, struct ntb_transport_ctx, link_work.work);
899e26a5843SAllen Hubbe 	struct ntb_dev *ndev = nt->ndev;
900e26a5843SAllen Hubbe 	struct pci_dev *pdev = ndev->pdev;
901e26a5843SAllen Hubbe 	resource_size_t size;
902fce8a7bbSJon Mason 	u32 val;
90384f76685SDave Jiang 	int rc = 0, i, spad;
904fce8a7bbSJon Mason 
905113fc505SJon Mason 	/* send the local info, in the opposite order of the way we read it */
906e26a5843SAllen Hubbe 	for (i = 0; i < nt->mw_count; i++) {
907e26a5843SAllen Hubbe 		size = nt->mw_vec[i].phys_size;
908e26a5843SAllen Hubbe 
909e26a5843SAllen Hubbe 		if (max_mw_size && size > max_mw_size)
910e26a5843SAllen Hubbe 			size = max_mw_size;
911e26a5843SAllen Hubbe 
912e26a5843SAllen Hubbe 		spad = MW0_SZ_HIGH + (i * 2);
913d67288a3SSerge Semin 		ntb_peer_spad_write(ndev, PIDX, spad, upper_32_bits(size));
914e26a5843SAllen Hubbe 
915e26a5843SAllen Hubbe 		spad = MW0_SZ_LOW + (i * 2);
916d67288a3SSerge Semin 		ntb_peer_spad_write(ndev, PIDX, spad, lower_32_bits(size));
917fce8a7bbSJon Mason 	}
918fce8a7bbSJon Mason 
919d67288a3SSerge Semin 	ntb_peer_spad_write(ndev, PIDX, NUM_MWS, nt->mw_count);
920fce8a7bbSJon Mason 
921d67288a3SSerge Semin 	ntb_peer_spad_write(ndev, PIDX, NUM_QPS, nt->qp_count);
922fce8a7bbSJon Mason 
923d67288a3SSerge Semin 	ntb_peer_spad_write(ndev, PIDX, VERSION, NTB_TRANSPORT_VERSION);
924fce8a7bbSJon Mason 
925fce8a7bbSJon Mason 	/* Query the remote side for its info */
9260f69a7dfSDave Jiang 	val = ntb_spad_read(ndev, VERSION);
927e26a5843SAllen Hubbe 	dev_dbg(&pdev->dev, "Remote version = %d\n", val);
928fce8a7bbSJon Mason 	if (val != NTB_TRANSPORT_VERSION)
929fce8a7bbSJon Mason 		goto out;
930fce8a7bbSJon Mason 
9310f69a7dfSDave Jiang 	val = ntb_spad_read(ndev, NUM_QPS);
932fce8a7bbSJon Mason 	dev_dbg(&pdev->dev, "Remote max number of qps = %d\n", val);
933e26a5843SAllen Hubbe 	if (val != nt->qp_count)
934fce8a7bbSJon Mason 		goto out;
935fce8a7bbSJon Mason 
9360f69a7dfSDave Jiang 	val = ntb_spad_read(ndev, NUM_MWS);
937113fc505SJon Mason 	dev_dbg(&pdev->dev, "Remote number of mws = %d\n", val);
938e26a5843SAllen Hubbe 	if (val != nt->mw_count)
939e26a5843SAllen Hubbe 		goto out;
940fce8a7bbSJon Mason 
941e26a5843SAllen Hubbe 	for (i = 0; i < nt->mw_count; i++) {
942113fc505SJon Mason 		u64 val64;
943fce8a7bbSJon Mason 
9440f69a7dfSDave Jiang 		val = ntb_spad_read(ndev, MW0_SZ_HIGH + (i * 2));
945113fc505SJon Mason 		val64 = (u64)val << 32;
946fce8a7bbSJon Mason 
9470f69a7dfSDave Jiang 		val = ntb_spad_read(ndev, MW0_SZ_LOW + (i * 2));
948113fc505SJon Mason 		val64 |= val;
949113fc505SJon Mason 
950e26a5843SAllen Hubbe 		dev_dbg(&pdev->dev, "Remote MW%d size = %#llx\n", i, val64);
951113fc505SJon Mason 
952113fc505SJon Mason 		rc = ntb_set_mw(nt, i, val64);
953fce8a7bbSJon Mason 		if (rc)
954113fc505SJon Mason 			goto out1;
955113fc505SJon Mason 	}
956fce8a7bbSJon Mason 
957e26a5843SAllen Hubbe 	nt->link_is_up = true;
958fce8a7bbSJon Mason 
959e26a5843SAllen Hubbe 	for (i = 0; i < nt->qp_count; i++) {
960e26a5843SAllen Hubbe 		struct ntb_transport_qp *qp = &nt->qp_vec[i];
961fce8a7bbSJon Mason 
962fce8a7bbSJon Mason 		ntb_transport_setup_qp_mw(nt, i);
963fce8a7bbSJon Mason 
964e26a5843SAllen Hubbe 		if (qp->client_ready)
965fce8a7bbSJon Mason 			schedule_delayed_work(&qp->link_work, 0);
966fce8a7bbSJon Mason 	}
967fce8a7bbSJon Mason 
968fce8a7bbSJon Mason 	return;
969fce8a7bbSJon Mason 
970113fc505SJon Mason out1:
971e26a5843SAllen Hubbe 	for (i = 0; i < nt->mw_count; i++)
972113fc505SJon Mason 		ntb_free_mw(nt, i);
97384f76685SDave Jiang 
97484f76685SDave Jiang 	/* if there's an actual failure, we should just bail */
975f3fd2afeSDave Jiang 	if (rc < 0)
97684f76685SDave Jiang 		return;
97784f76685SDave Jiang 
978fce8a7bbSJon Mason out:
979e26a5843SAllen Hubbe 	if (ntb_link_is_up(ndev, NULL, NULL) == 1)
980fce8a7bbSJon Mason 		schedule_delayed_work(&nt->link_work,
981fce8a7bbSJon Mason 				      msecs_to_jiffies(NTB_LINK_DOWN_TIMEOUT));
982fce8a7bbSJon Mason }
983fce8a7bbSJon Mason 
984fce8a7bbSJon Mason static void ntb_qp_link_work(struct work_struct *work)
985fce8a7bbSJon Mason {
986fce8a7bbSJon Mason 	struct ntb_transport_qp *qp = container_of(work,
987fce8a7bbSJon Mason 						   struct ntb_transport_qp,
988fce8a7bbSJon Mason 						   link_work.work);
989e26a5843SAllen Hubbe 	struct pci_dev *pdev = qp->ndev->pdev;
990e26a5843SAllen Hubbe 	struct ntb_transport_ctx *nt = qp->transport;
991e26a5843SAllen Hubbe 	int val;
992fce8a7bbSJon Mason 
993e26a5843SAllen Hubbe 	WARN_ON(!nt->link_is_up);
994fce8a7bbSJon Mason 
995e26a5843SAllen Hubbe 	val = ntb_spad_read(nt->ndev, QP_LINKS);
996fce8a7bbSJon Mason 
997d67288a3SSerge Semin 	ntb_peer_spad_write(nt->ndev, PIDX, QP_LINKS, val | BIT(qp->qp_num));
998fce8a7bbSJon Mason 
999fce8a7bbSJon Mason 	/* query remote spad for qp ready bits */
100028762289SAllen Hubbe 	dev_dbg_ratelimited(&pdev->dev, "Remote QP link status = %x\n", val);
1001fce8a7bbSJon Mason 
1002fce8a7bbSJon Mason 	/* See if the remote side is up */
1003e26a5843SAllen Hubbe 	if (val & BIT(qp->qp_num)) {
1004fce8a7bbSJon Mason 		dev_info(&pdev->dev, "qp %d: Link Up\n", qp->qp_num);
1005e26a5843SAllen Hubbe 		qp->link_is_up = true;
1006e9021331SDave Jiang 		qp->active = true;
1007e26a5843SAllen Hubbe 
1008fce8a7bbSJon Mason 		if (qp->event_handler)
1009e26a5843SAllen Hubbe 			qp->event_handler(qp->cb_data, qp->link_is_up);
10108b5a22d8SAllen Hubbe 
1011e9021331SDave Jiang 		if (qp->active)
10128b5a22d8SAllen Hubbe 			tasklet_schedule(&qp->rxc_db_work);
1013e26a5843SAllen Hubbe 	} else if (nt->link_is_up)
1014fce8a7bbSJon Mason 		schedule_delayed_work(&qp->link_work,
1015fce8a7bbSJon Mason 				      msecs_to_jiffies(NTB_LINK_DOWN_TIMEOUT));
1016fce8a7bbSJon Mason }
1017fce8a7bbSJon Mason 
1018e26a5843SAllen Hubbe static int ntb_transport_init_queue(struct ntb_transport_ctx *nt,
1019fce8a7bbSJon Mason 				    unsigned int qp_num)
1020fce8a7bbSJon Mason {
1021fce8a7bbSJon Mason 	struct ntb_transport_qp *qp;
1022e26a5843SAllen Hubbe 	phys_addr_t mw_base;
1023e26a5843SAllen Hubbe 	resource_size_t mw_size;
1024ef114ed5SJon Mason 	unsigned int num_qps_mw, tx_size;
1025e26a5843SAllen Hubbe 	unsigned int mw_num, mw_count, qp_count;
1026282a2feeSJon Mason 	u64 qp_offset;
1027948d3a65SJon Mason 
1028e26a5843SAllen Hubbe 	mw_count = nt->mw_count;
1029e26a5843SAllen Hubbe 	qp_count = nt->qp_count;
1030fce8a7bbSJon Mason 
1031e26a5843SAllen Hubbe 	mw_num = QP_TO_MW(nt, qp_num);
1032e26a5843SAllen Hubbe 
1033e26a5843SAllen Hubbe 	qp = &nt->qp_vec[qp_num];
1034fce8a7bbSJon Mason 	qp->qp_num = qp_num;
1035fce8a7bbSJon Mason 	qp->transport = nt;
1036fce8a7bbSJon Mason 	qp->ndev = nt->ndev;
1037e26a5843SAllen Hubbe 	qp->client_ready = false;
1038fce8a7bbSJon Mason 	qp->event_handler = NULL;
10392849b5d7SAllen Hubbe 	ntb_qp_link_down_reset(qp);
1040fce8a7bbSJon Mason 
10418e8496e0SLogan Gunthorpe 	if (mw_num < qp_count % mw_count)
1042e26a5843SAllen Hubbe 		num_qps_mw = qp_count / mw_count + 1;
1043ef114ed5SJon Mason 	else
1044e26a5843SAllen Hubbe 		num_qps_mw = qp_count / mw_count;
1045ef114ed5SJon Mason 
1046e26a5843SAllen Hubbe 	mw_base = nt->mw_vec[mw_num].phys_addr;
1047e26a5843SAllen Hubbe 	mw_size = nt->mw_vec[mw_num].phys_size;
1048e26a5843SAllen Hubbe 
1049cbd27448SLogan Gunthorpe 	if (max_mw_size && mw_size > max_mw_size)
1050cbd27448SLogan Gunthorpe 		mw_size = max_mw_size;
1051cbd27448SLogan Gunthorpe 
1052e26a5843SAllen Hubbe 	tx_size = (unsigned int)mw_size / num_qps_mw;
1053c92ba3c5SJon Mason 	qp_offset = tx_size * (qp_num / mw_count);
1054e26a5843SAllen Hubbe 
1055e26a5843SAllen Hubbe 	qp->tx_mw = nt->mw_vec[mw_num].vbase + qp_offset;
1056282a2feeSJon Mason 	if (!qp->tx_mw)
1057282a2feeSJon Mason 		return -EINVAL;
1058793c20e9SJon Mason 
1059e26a5843SAllen Hubbe 	qp->tx_mw_phys = mw_base + qp_offset;
1060282a2feeSJon Mason 	if (!qp->tx_mw_phys)
1061282a2feeSJon Mason 		return -EINVAL;
1062282a2feeSJon Mason 
1063282a2feeSJon Mason 	tx_size -= sizeof(struct ntb_rx_info);
1064282a2feeSJon Mason 	qp->rx_info = qp->tx_mw + tx_size;
1065282a2feeSJon Mason 
1066c9d534c8SJon Mason 	/* Due to housekeeping, there must be atleast 2 buffs */
1067c9d534c8SJon Mason 	qp->tx_max_frame = min(transport_mtu, tx_size / 2);
1068793c20e9SJon Mason 	qp->tx_max_entry = tx_size / qp->tx_max_frame;
1069ef114ed5SJon Mason 
1070c8650fd0SDave Jiang 	if (nt->debugfs_node_dir) {
1071fce8a7bbSJon Mason 		char debugfs_name[4];
1072fce8a7bbSJon Mason 
1073fce8a7bbSJon Mason 		snprintf(debugfs_name, 4, "qp%d", qp_num);
1074fce8a7bbSJon Mason 		qp->debugfs_dir = debugfs_create_dir(debugfs_name,
1075c8650fd0SDave Jiang 						     nt->debugfs_node_dir);
1076fce8a7bbSJon Mason 
1077fce8a7bbSJon Mason 		qp->debugfs_stats = debugfs_create_file("stats", S_IRUSR,
1078fce8a7bbSJon Mason 							qp->debugfs_dir, qp,
1079fce8a7bbSJon Mason 							&ntb_qp_debugfs_stats);
1080e26a5843SAllen Hubbe 	} else {
1081e26a5843SAllen Hubbe 		qp->debugfs_dir = NULL;
1082e26a5843SAllen Hubbe 		qp->debugfs_stats = NULL;
1083fce8a7bbSJon Mason 	}
1084fce8a7bbSJon Mason 
1085fce8a7bbSJon Mason 	INIT_DELAYED_WORK(&qp->link_work, ntb_qp_link_work);
1086fca4d518SJon Mason 	INIT_WORK(&qp->link_cleanup, ntb_qp_link_cleanup_work);
1087fce8a7bbSJon Mason 
1088da2e5ae5SAllen Hubbe 	spin_lock_init(&qp->ntb_rx_q_lock);
1089fce8a7bbSJon Mason 	spin_lock_init(&qp->ntb_tx_free_q_lock);
1090fce8a7bbSJon Mason 
1091da2e5ae5SAllen Hubbe 	INIT_LIST_HEAD(&qp->rx_post_q);
1092fce8a7bbSJon Mason 	INIT_LIST_HEAD(&qp->rx_pend_q);
1093fce8a7bbSJon Mason 	INIT_LIST_HEAD(&qp->rx_free_q);
1094fce8a7bbSJon Mason 	INIT_LIST_HEAD(&qp->tx_free_q);
1095282a2feeSJon Mason 
1096e26a5843SAllen Hubbe 	tasklet_init(&qp->rxc_db_work, ntb_transport_rxc_db,
1097e26a5843SAllen Hubbe 		     (unsigned long)qp);
1098e26a5843SAllen Hubbe 
1099282a2feeSJon Mason 	return 0;
1100fce8a7bbSJon Mason }
1101fce8a7bbSJon Mason 
1102e26a5843SAllen Hubbe static int ntb_transport_probe(struct ntb_client *self, struct ntb_dev *ndev)
1103fce8a7bbSJon Mason {
1104e26a5843SAllen Hubbe 	struct ntb_transport_ctx *nt;
1105e26a5843SAllen Hubbe 	struct ntb_transport_mw *mw;
1106b17faba0SShyam Sundar S K 	unsigned int mw_count, qp_count, spad_count, max_mw_count_for_spads;
1107e26a5843SAllen Hubbe 	u64 qp_bitmap;
11081199aa61SAllen Hubbe 	int node;
1109fce8a7bbSJon Mason 	int rc, i;
1110fce8a7bbSJon Mason 
1111bc240eecSLogan Gunthorpe 	mw_count = ntb_peer_mw_count(ndev);
1112443b9a14SSerge Semin 
1113443b9a14SSerge Semin 	if (!ndev->ops->mw_set_trans) {
1114443b9a14SSerge Semin 		dev_err(&ndev->dev, "Inbound MW based NTB API is required\n");
1115443b9a14SSerge Semin 		return -EINVAL;
1116443b9a14SSerge Semin 	}
111719645a07SLogan Gunthorpe 
1118e26a5843SAllen Hubbe 	if (ntb_db_is_unsafe(ndev))
1119e26a5843SAllen Hubbe 		dev_dbg(&ndev->dev,
1120e26a5843SAllen Hubbe 			"doorbell is unsafe, proceed anyway...\n");
1121e26a5843SAllen Hubbe 	if (ntb_spad_is_unsafe(ndev))
1122e26a5843SAllen Hubbe 		dev_dbg(&ndev->dev,
1123e26a5843SAllen Hubbe 			"scratchpad is unsafe, proceed anyway...\n");
1124e26a5843SAllen Hubbe 
11251e530119SSerge Semin 	if (ntb_peer_port_count(ndev) != NTB_DEF_PEER_CNT)
11261e530119SSerge Semin 		dev_warn(&ndev->dev, "Multi-port NTB devices unsupported\n");
11271e530119SSerge Semin 
11281199aa61SAllen Hubbe 	node = dev_to_node(&ndev->dev);
11291199aa61SAllen Hubbe 
11301199aa61SAllen Hubbe 	nt = kzalloc_node(sizeof(*nt), GFP_KERNEL, node);
1131fce8a7bbSJon Mason 	if (!nt)
1132fce8a7bbSJon Mason 		return -ENOMEM;
1133fce8a7bbSJon Mason 
1134e26a5843SAllen Hubbe 	nt->ndev = ndev;
1135b17faba0SShyam Sundar S K 	spad_count = ntb_spad_count(ndev);
1136e26a5843SAllen Hubbe 
1137b17faba0SShyam Sundar S K 	/* Limit the MW's based on the availability of scratchpads */
1138b17faba0SShyam Sundar S K 
1139b17faba0SShyam Sundar S K 	if (spad_count < NTB_TRANSPORT_MIN_SPADS) {
1140b17faba0SShyam Sundar S K 		nt->mw_count = 0;
1141b17faba0SShyam Sundar S K 		rc = -EINVAL;
1142b17faba0SShyam Sundar S K 		goto err;
1143b17faba0SShyam Sundar S K 	}
1144b17faba0SShyam Sundar S K 
1145b17faba0SShyam Sundar S K 	max_mw_count_for_spads = (spad_count - MW0_SZ_HIGH) / 2;
1146b17faba0SShyam Sundar S K 	nt->mw_count = min(mw_count, max_mw_count_for_spads);
1147e26a5843SAllen Hubbe 
1148590b5b7dSKees Cook 	nt->mw_vec = kcalloc_node(mw_count, sizeof(*nt->mw_vec),
11491199aa61SAllen Hubbe 				  GFP_KERNEL, node);
1150e26a5843SAllen Hubbe 	if (!nt->mw_vec) {
1151e26a5843SAllen Hubbe 		rc = -ENOMEM;
1152fce8a7bbSJon Mason 		goto err;
1153fce8a7bbSJon Mason 	}
1154fce8a7bbSJon Mason 
1155e26a5843SAllen Hubbe 	for (i = 0; i < mw_count; i++) {
1156e26a5843SAllen Hubbe 		mw = &nt->mw_vec[i];
1157e26a5843SAllen Hubbe 
1158443b9a14SSerge Semin 		rc = ntb_peer_mw_get_addr(ndev, i, &mw->phys_addr,
1159443b9a14SSerge Semin 					  &mw->phys_size);
1160e26a5843SAllen Hubbe 		if (rc)
1161e26a5843SAllen Hubbe 			goto err1;
1162e26a5843SAllen Hubbe 
116306917f75SDave Jiang 		mw->vbase = ioremap_wc(mw->phys_addr, mw->phys_size);
1164e26a5843SAllen Hubbe 		if (!mw->vbase) {
1165948d3a65SJon Mason 			rc = -ENOMEM;
1166948d3a65SJon Mason 			goto err1;
1167948d3a65SJon Mason 		}
1168948d3a65SJon Mason 
1169e26a5843SAllen Hubbe 		mw->buff_size = 0;
1170e26a5843SAllen Hubbe 		mw->xlat_size = 0;
1171e26a5843SAllen Hubbe 		mw->virt_addr = NULL;
1172e26a5843SAllen Hubbe 		mw->dma_addr = 0;
1173e26a5843SAllen Hubbe 	}
1174fce8a7bbSJon Mason 
1175e26a5843SAllen Hubbe 	qp_bitmap = ntb_db_valid_mask(ndev);
1176e26a5843SAllen Hubbe 
1177e26a5843SAllen Hubbe 	qp_count = ilog2(qp_bitmap);
1178e26a5843SAllen Hubbe 	if (max_num_clients && max_num_clients < qp_count)
1179e26a5843SAllen Hubbe 		qp_count = max_num_clients;
1180cb827ee6SLogan Gunthorpe 	else if (nt->mw_count < qp_count)
1181cb827ee6SLogan Gunthorpe 		qp_count = nt->mw_count;
1182e26a5843SAllen Hubbe 
1183e26a5843SAllen Hubbe 	qp_bitmap &= BIT_ULL(qp_count) - 1;
1184e26a5843SAllen Hubbe 
1185e26a5843SAllen Hubbe 	nt->qp_count = qp_count;
1186e26a5843SAllen Hubbe 	nt->qp_bitmap = qp_bitmap;
1187e26a5843SAllen Hubbe 	nt->qp_bitmap_free = qp_bitmap;
1188e26a5843SAllen Hubbe 
1189590b5b7dSKees Cook 	nt->qp_vec = kcalloc_node(qp_count, sizeof(*nt->qp_vec),
11901199aa61SAllen Hubbe 				  GFP_KERNEL, node);
1191e26a5843SAllen Hubbe 	if (!nt->qp_vec) {
1192fce8a7bbSJon Mason 		rc = -ENOMEM;
1193d4adee09SSudip Mukherjee 		goto err1;
1194fce8a7bbSJon Mason 	}
1195fce8a7bbSJon Mason 
1196c8650fd0SDave Jiang 	if (nt_debugfs_dir) {
1197c8650fd0SDave Jiang 		nt->debugfs_node_dir =
1198c8650fd0SDave Jiang 			debugfs_create_dir(pci_name(ndev->pdev),
1199c8650fd0SDave Jiang 					   nt_debugfs_dir);
1200c8650fd0SDave Jiang 	}
1201c8650fd0SDave Jiang 
1202e26a5843SAllen Hubbe 	for (i = 0; i < qp_count; i++) {
1203282a2feeSJon Mason 		rc = ntb_transport_init_queue(nt, i);
1204282a2feeSJon Mason 		if (rc)
1205d4adee09SSudip Mukherjee 			goto err2;
1206282a2feeSJon Mason 	}
1207fce8a7bbSJon Mason 
1208fce8a7bbSJon Mason 	INIT_DELAYED_WORK(&nt->link_work, ntb_transport_link_work);
1209fca4d518SJon Mason 	INIT_WORK(&nt->link_cleanup, ntb_transport_link_cleanup_work);
1210fce8a7bbSJon Mason 
1211e26a5843SAllen Hubbe 	rc = ntb_set_ctx(ndev, nt, &ntb_transport_ops);
1212fce8a7bbSJon Mason 	if (rc)
1213d4adee09SSudip Mukherjee 		goto err2;
1214fce8a7bbSJon Mason 
1215fce8a7bbSJon Mason 	INIT_LIST_HEAD(&nt->client_devs);
1216fce8a7bbSJon Mason 	rc = ntb_bus_init(nt);
1217fce8a7bbSJon Mason 	if (rc)
1218d4adee09SSudip Mukherjee 		goto err3;
1219fce8a7bbSJon Mason 
1220e26a5843SAllen Hubbe 	nt->link_is_up = false;
1221e26a5843SAllen Hubbe 	ntb_link_enable(ndev, NTB_SPEED_AUTO, NTB_WIDTH_AUTO);
1222e26a5843SAllen Hubbe 	ntb_link_event(ndev);
1223fce8a7bbSJon Mason 
1224fce8a7bbSJon Mason 	return 0;
1225fce8a7bbSJon Mason 
1226948d3a65SJon Mason err3:
1227d4adee09SSudip Mukherjee 	ntb_clear_ctx(ndev);
1228948d3a65SJon Mason err2:
1229d4adee09SSudip Mukherjee 	kfree(nt->qp_vec);
1230fce8a7bbSJon Mason err1:
1231e26a5843SAllen Hubbe 	while (i--) {
1232e26a5843SAllen Hubbe 		mw = &nt->mw_vec[i];
1233e26a5843SAllen Hubbe 		iounmap(mw->vbase);
1234e26a5843SAllen Hubbe 	}
1235d4adee09SSudip Mukherjee 	kfree(nt->mw_vec);
1236fce8a7bbSJon Mason err:
1237fce8a7bbSJon Mason 	kfree(nt);
1238fce8a7bbSJon Mason 	return rc;
1239fce8a7bbSJon Mason }
1240fce8a7bbSJon Mason 
1241e26a5843SAllen Hubbe static void ntb_transport_free(struct ntb_client *self, struct ntb_dev *ndev)
1242fce8a7bbSJon Mason {
1243e26a5843SAllen Hubbe 	struct ntb_transport_ctx *nt = ndev->ctx;
1244e26a5843SAllen Hubbe 	struct ntb_transport_qp *qp;
1245e26a5843SAllen Hubbe 	u64 qp_bitmap_alloc;
1246fce8a7bbSJon Mason 	int i;
1247fce8a7bbSJon Mason 
1248fca4d518SJon Mason 	ntb_transport_link_cleanup(nt);
1249e26a5843SAllen Hubbe 	cancel_work_sync(&nt->link_cleanup);
1250e26a5843SAllen Hubbe 	cancel_delayed_work_sync(&nt->link_work);
1251e26a5843SAllen Hubbe 
1252e26a5843SAllen Hubbe 	qp_bitmap_alloc = nt->qp_bitmap & ~nt->qp_bitmap_free;
1253fce8a7bbSJon Mason 
1254fce8a7bbSJon Mason 	/* verify that all the qp's are freed */
1255e26a5843SAllen Hubbe 	for (i = 0; i < nt->qp_count; i++) {
1256e26a5843SAllen Hubbe 		qp = &nt->qp_vec[i];
1257e26a5843SAllen Hubbe 		if (qp_bitmap_alloc & BIT_ULL(i))
1258e26a5843SAllen Hubbe 			ntb_transport_free_queue(qp);
1259e26a5843SAllen Hubbe 		debugfs_remove_recursive(qp->debugfs_dir);
12601517a3f2SJon Mason 	}
1261fce8a7bbSJon Mason 
1262e26a5843SAllen Hubbe 	ntb_link_disable(ndev);
1263e26a5843SAllen Hubbe 	ntb_clear_ctx(ndev);
1264e26a5843SAllen Hubbe 
1265fce8a7bbSJon Mason 	ntb_bus_remove(nt);
1266fce8a7bbSJon Mason 
1267e26a5843SAllen Hubbe 	for (i = nt->mw_count; i--; ) {
1268113fc505SJon Mason 		ntb_free_mw(nt, i);
1269e26a5843SAllen Hubbe 		iounmap(nt->mw_vec[i].vbase);
1270e26a5843SAllen Hubbe 	}
1271fce8a7bbSJon Mason 
1272e26a5843SAllen Hubbe 	kfree(nt->qp_vec);
1273e26a5843SAllen Hubbe 	kfree(nt->mw_vec);
1274fce8a7bbSJon Mason 	kfree(nt);
1275fce8a7bbSJon Mason }
1276fce8a7bbSJon Mason 
1277da2e5ae5SAllen Hubbe static void ntb_complete_rxc(struct ntb_transport_qp *qp)
1278fce8a7bbSJon Mason {
1279da2e5ae5SAllen Hubbe 	struct ntb_queue_entry *entry;
1280da2e5ae5SAllen Hubbe 	void *cb_data;
1281da2e5ae5SAllen Hubbe 	unsigned int len;
1282da2e5ae5SAllen Hubbe 	unsigned long irqflags;
1283448c6fb3SJon Mason 
1284da2e5ae5SAllen Hubbe 	spin_lock_irqsave(&qp->ntb_rx_q_lock, irqflags);
1285282a2feeSJon Mason 
1286da2e5ae5SAllen Hubbe 	while (!list_empty(&qp->rx_post_q)) {
1287da2e5ae5SAllen Hubbe 		entry = list_first_entry(&qp->rx_post_q,
1288da2e5ae5SAllen Hubbe 					 struct ntb_queue_entry, entry);
1289da2e5ae5SAllen Hubbe 		if (!(entry->flags & DESC_DONE_FLAG))
1290da2e5ae5SAllen Hubbe 			break;
1291da2e5ae5SAllen Hubbe 
1292da2e5ae5SAllen Hubbe 		entry->rx_hdr->flags = 0;
129372203572SDave Jiang 		iowrite32(entry->rx_index, &qp->rx_info->entry);
1294fce8a7bbSJon Mason 
1295da2e5ae5SAllen Hubbe 		cb_data = entry->cb_data;
1296da2e5ae5SAllen Hubbe 		len = entry->len;
1297da2e5ae5SAllen Hubbe 
1298da2e5ae5SAllen Hubbe 		list_move_tail(&entry->entry, &qp->rx_free_q);
1299da2e5ae5SAllen Hubbe 
1300da2e5ae5SAllen Hubbe 		spin_unlock_irqrestore(&qp->ntb_rx_q_lock, irqflags);
1301448c6fb3SJon Mason 
1302e26a5843SAllen Hubbe 		if (qp->rx_handler && qp->client_ready)
1303448c6fb3SJon Mason 			qp->rx_handler(qp, qp->cb_data, cb_data, len);
1304da2e5ae5SAllen Hubbe 
1305da2e5ae5SAllen Hubbe 		spin_lock_irqsave(&qp->ntb_rx_q_lock, irqflags);
1306da2e5ae5SAllen Hubbe 	}
1307da2e5ae5SAllen Hubbe 
1308da2e5ae5SAllen Hubbe 	spin_unlock_irqrestore(&qp->ntb_rx_q_lock, irqflags);
1309da2e5ae5SAllen Hubbe }
1310da2e5ae5SAllen Hubbe 
131172203572SDave Jiang static void ntb_rx_copy_callback(void *data,
131272203572SDave Jiang 				 const struct dmaengine_result *res)
1313da2e5ae5SAllen Hubbe {
1314da2e5ae5SAllen Hubbe 	struct ntb_queue_entry *entry = data;
1315da2e5ae5SAllen Hubbe 
131672203572SDave Jiang 	/* we need to check DMA results if we are using DMA */
131772203572SDave Jiang 	if (res) {
131872203572SDave Jiang 		enum dmaengine_tx_result dma_err = res->result;
131972203572SDave Jiang 
132072203572SDave Jiang 		switch (dma_err) {
132172203572SDave Jiang 		case DMA_TRANS_READ_FAILED:
132272203572SDave Jiang 		case DMA_TRANS_WRITE_FAILED:
132372203572SDave Jiang 			entry->errors++;
1324846429bcSGustavo A. R. Silva 			/* fall through */
132572203572SDave Jiang 		case DMA_TRANS_ABORTED:
132672203572SDave Jiang 		{
132772203572SDave Jiang 			struct ntb_transport_qp *qp = entry->qp;
132872203572SDave Jiang 			void *offset = qp->rx_buff + qp->rx_max_frame *
132972203572SDave Jiang 					qp->rx_index;
133072203572SDave Jiang 
133172203572SDave Jiang 			ntb_memcpy_rx(entry, offset);
133272203572SDave Jiang 			qp->rx_memcpy++;
133372203572SDave Jiang 			return;
133472203572SDave Jiang 		}
133572203572SDave Jiang 
133672203572SDave Jiang 		case DMA_TRANS_NOERROR:
133772203572SDave Jiang 		default:
133872203572SDave Jiang 			break;
133972203572SDave Jiang 		}
134072203572SDave Jiang 	}
134172203572SDave Jiang 
1342da2e5ae5SAllen Hubbe 	entry->flags |= DESC_DONE_FLAG;
1343da2e5ae5SAllen Hubbe 
1344da2e5ae5SAllen Hubbe 	ntb_complete_rxc(entry->qp);
1345fce8a7bbSJon Mason }
1346fce8a7bbSJon Mason 
1347282a2feeSJon Mason static void ntb_memcpy_rx(struct ntb_queue_entry *entry, void *offset)
1348282a2feeSJon Mason {
1349282a2feeSJon Mason 	void *buf = entry->buf;
1350282a2feeSJon Mason 	size_t len = entry->len;
1351282a2feeSJon Mason 
1352282a2feeSJon Mason 	memcpy(buf, offset, len);
1353282a2feeSJon Mason 
1354e26a5843SAllen Hubbe 	/* Ensure that the data is fully copied out before clearing the flag */
1355e26a5843SAllen Hubbe 	wmb();
1356e26a5843SAllen Hubbe 
135772203572SDave Jiang 	ntb_rx_copy_callback(entry, NULL);
1358282a2feeSJon Mason }
1359282a2feeSJon Mason 
136072203572SDave Jiang static int ntb_async_rx_submit(struct ntb_queue_entry *entry, void *offset)
1361282a2feeSJon Mason {
1362282a2feeSJon Mason 	struct dma_async_tx_descriptor *txd;
1363282a2feeSJon Mason 	struct ntb_transport_qp *qp = entry->qp;
1364569410caSDave Jiang 	struct dma_chan *chan = qp->rx_dma_chan;
1365282a2feeSJon Mason 	struct dma_device *device;
1366da2e5ae5SAllen Hubbe 	size_t pay_off, buff_off, len;
13676f57fd05SBartlomiej Zolnierkiewicz 	struct dmaengine_unmap_data *unmap;
1368282a2feeSJon Mason 	dma_cookie_t cookie;
1369282a2feeSJon Mason 	void *buf = entry->buf;
1370282a2feeSJon Mason 
1371da2e5ae5SAllen Hubbe 	len = entry->len;
1372282a2feeSJon Mason 	device = chan->device;
1373282a2feeSJon Mason 	pay_off = (size_t)offset & ~PAGE_MASK;
1374282a2feeSJon Mason 	buff_off = (size_t)buf & ~PAGE_MASK;
1375282a2feeSJon Mason 
1376282a2feeSJon Mason 	if (!is_dma_copy_aligned(device, pay_off, buff_off, len))
1377905921e7SAllen Hubbe 		goto err;
1378282a2feeSJon Mason 
13796f57fd05SBartlomiej Zolnierkiewicz 	unmap = dmaengine_get_unmap_data(device->dev, 2, GFP_NOWAIT);
13806f57fd05SBartlomiej Zolnierkiewicz 	if (!unmap)
1381905921e7SAllen Hubbe 		goto err;
1382282a2feeSJon Mason 
13836f57fd05SBartlomiej Zolnierkiewicz 	unmap->len = len;
13846f57fd05SBartlomiej Zolnierkiewicz 	unmap->addr[0] = dma_map_page(device->dev, virt_to_page(offset),
13856f57fd05SBartlomiej Zolnierkiewicz 				      pay_off, len, DMA_TO_DEVICE);
13866f57fd05SBartlomiej Zolnierkiewicz 	if (dma_mapping_error(device->dev, unmap->addr[0]))
13876f57fd05SBartlomiej Zolnierkiewicz 		goto err_get_unmap;
1388282a2feeSJon Mason 
13896f57fd05SBartlomiej Zolnierkiewicz 	unmap->to_cnt = 1;
13906f57fd05SBartlomiej Zolnierkiewicz 
13916f57fd05SBartlomiej Zolnierkiewicz 	unmap->addr[1] = dma_map_page(device->dev, virt_to_page(buf),
13926f57fd05SBartlomiej Zolnierkiewicz 				      buff_off, len, DMA_FROM_DEVICE);
13936f57fd05SBartlomiej Zolnierkiewicz 	if (dma_mapping_error(device->dev, unmap->addr[1]))
13946f57fd05SBartlomiej Zolnierkiewicz 		goto err_get_unmap;
13956f57fd05SBartlomiej Zolnierkiewicz 
13966f57fd05SBartlomiej Zolnierkiewicz 	unmap->from_cnt = 1;
13976f57fd05SBartlomiej Zolnierkiewicz 
139888931ec3SAllen Hubbe 	txd = device->device_prep_dma_memcpy(chan, unmap->addr[1],
13990776ae7bSBartlomiej Zolnierkiewicz 					     unmap->addr[0], len,
14000776ae7bSBartlomiej Zolnierkiewicz 					     DMA_PREP_INTERRUPT);
140188931ec3SAllen Hubbe 	if (!txd)
14026f57fd05SBartlomiej Zolnierkiewicz 		goto err_get_unmap;
1403282a2feeSJon Mason 
140472203572SDave Jiang 	txd->callback_result = ntb_rx_copy_callback;
1405282a2feeSJon Mason 	txd->callback_param = entry;
14066f57fd05SBartlomiej Zolnierkiewicz 	dma_set_unmap(txd, unmap);
1407282a2feeSJon Mason 
1408282a2feeSJon Mason 	cookie = dmaengine_submit(txd);
1409282a2feeSJon Mason 	if (dma_submit_error(cookie))
14106f57fd05SBartlomiej Zolnierkiewicz 		goto err_set_unmap;
14116f57fd05SBartlomiej Zolnierkiewicz 
14126f57fd05SBartlomiej Zolnierkiewicz 	dmaengine_unmap_put(unmap);
1413282a2feeSJon Mason 
1414282a2feeSJon Mason 	qp->last_cookie = cookie;
1415282a2feeSJon Mason 
1416282a2feeSJon Mason 	qp->rx_async++;
1417282a2feeSJon Mason 
141872203572SDave Jiang 	return 0;
1419282a2feeSJon Mason 
14206f57fd05SBartlomiej Zolnierkiewicz err_set_unmap:
14216f57fd05SBartlomiej Zolnierkiewicz 	dmaengine_unmap_put(unmap);
14226f57fd05SBartlomiej Zolnierkiewicz err_get_unmap:
14236f57fd05SBartlomiej Zolnierkiewicz 	dmaengine_unmap_put(unmap);
1424282a2feeSJon Mason err:
142572203572SDave Jiang 	return -ENXIO;
142672203572SDave Jiang }
142772203572SDave Jiang 
142872203572SDave Jiang static void ntb_async_rx(struct ntb_queue_entry *entry, void *offset)
142972203572SDave Jiang {
143072203572SDave Jiang 	struct ntb_transport_qp *qp = entry->qp;
143172203572SDave Jiang 	struct dma_chan *chan = qp->rx_dma_chan;
143272203572SDave Jiang 	int res;
143372203572SDave Jiang 
143472203572SDave Jiang 	if (!chan)
143572203572SDave Jiang 		goto err;
143672203572SDave Jiang 
143772203572SDave Jiang 	if (entry->len < copy_bytes)
143872203572SDave Jiang 		goto err;
143972203572SDave Jiang 
144072203572SDave Jiang 	res = ntb_async_rx_submit(entry, offset);
144172203572SDave Jiang 	if (res < 0)
144272203572SDave Jiang 		goto err;
144372203572SDave Jiang 
144472203572SDave Jiang 	if (!entry->retries)
144572203572SDave Jiang 		qp->rx_async++;
144672203572SDave Jiang 
144772203572SDave Jiang 	return;
144872203572SDave Jiang 
144972203572SDave Jiang err:
1450282a2feeSJon Mason 	ntb_memcpy_rx(entry, offset);
1451282a2feeSJon Mason 	qp->rx_memcpy++;
1452282a2feeSJon Mason }
1453282a2feeSJon Mason 
1454fce8a7bbSJon Mason static int ntb_process_rxc(struct ntb_transport_qp *qp)
1455fce8a7bbSJon Mason {
1456fce8a7bbSJon Mason 	struct ntb_payload_header *hdr;
1457fce8a7bbSJon Mason 	struct ntb_queue_entry *entry;
1458fce8a7bbSJon Mason 	void *offset;
1459fce8a7bbSJon Mason 
1460793c20e9SJon Mason 	offset = qp->rx_buff + qp->rx_max_frame * qp->rx_index;
1461793c20e9SJon Mason 	hdr = offset + qp->rx_max_frame - sizeof(struct ntb_payload_header);
1462793c20e9SJon Mason 
1463e26a5843SAllen Hubbe 	dev_dbg(&qp->ndev->pdev->dev, "qp %d: RX ver %u len %d flags %x\n",
1464e26a5843SAllen Hubbe 		qp->qp_num, hdr->ver, hdr->len, hdr->flags);
1465fce8a7bbSJon Mason 
1466fce8a7bbSJon Mason 	if (!(hdr->flags & DESC_DONE_FLAG)) {
1467e26a5843SAllen Hubbe 		dev_dbg(&qp->ndev->pdev->dev, "done flag not set\n");
1468fce8a7bbSJon Mason 		qp->rx_ring_empty++;
1469fce8a7bbSJon Mason 		return -EAGAIN;
1470fce8a7bbSJon Mason 	}
1471fce8a7bbSJon Mason 
1472e26a5843SAllen Hubbe 	if (hdr->flags & LINK_DOWN_FLAG) {
1473e26a5843SAllen Hubbe 		dev_dbg(&qp->ndev->pdev->dev, "link down flag set\n");
1474e26a5843SAllen Hubbe 		ntb_qp_link_down(qp);
1475e26a5843SAllen Hubbe 		hdr->flags = 0;
1476c0900b33SAllen Hubbe 		return -EAGAIN;
1477e26a5843SAllen Hubbe 	}
1478e26a5843SAllen Hubbe 
147974465645SJon Mason 	if (hdr->ver != (u32)qp->rx_pkts) {
1480e26a5843SAllen Hubbe 		dev_dbg(&qp->ndev->pdev->dev,
1481e26a5843SAllen Hubbe 			"version mismatch, expected %llu - got %u\n",
1482e26a5843SAllen Hubbe 			qp->rx_pkts, hdr->ver);
1483fce8a7bbSJon Mason 		qp->rx_err_ver++;
1484fce8a7bbSJon Mason 		return -EIO;
1485fce8a7bbSJon Mason 	}
1486fce8a7bbSJon Mason 
1487da2e5ae5SAllen Hubbe 	entry = ntb_list_mv(&qp->ntb_rx_q_lock, &qp->rx_pend_q, &qp->rx_post_q);
1488e26a5843SAllen Hubbe 	if (!entry) {
1489e26a5843SAllen Hubbe 		dev_dbg(&qp->ndev->pdev->dev, "no receive buffer\n");
1490e26a5843SAllen Hubbe 		qp->rx_err_no_buf++;
1491da2e5ae5SAllen Hubbe 		return -EAGAIN;
1492fce8a7bbSJon Mason 	}
1493fce8a7bbSJon Mason 
1494da2e5ae5SAllen Hubbe 	entry->rx_hdr = hdr;
149572203572SDave Jiang 	entry->rx_index = qp->rx_index;
1496da2e5ae5SAllen Hubbe 
1497e26a5843SAllen Hubbe 	if (hdr->len > entry->len) {
1498e26a5843SAllen Hubbe 		dev_dbg(&qp->ndev->pdev->dev,
1499e26a5843SAllen Hubbe 			"receive buffer overflow! Wanted %d got %d\n",
1500e26a5843SAllen Hubbe 			hdr->len, entry->len);
1501e26a5843SAllen Hubbe 		qp->rx_err_oflow++;
1502e26a5843SAllen Hubbe 
1503da2e5ae5SAllen Hubbe 		entry->len = -EIO;
1504da2e5ae5SAllen Hubbe 		entry->flags |= DESC_DONE_FLAG;
1505e26a5843SAllen Hubbe 
1506da2e5ae5SAllen Hubbe 		ntb_complete_rxc(qp);
1507da2e5ae5SAllen Hubbe 	} else {
1508e26a5843SAllen Hubbe 		dev_dbg(&qp->ndev->pdev->dev,
1509e26a5843SAllen Hubbe 			"RX OK index %u ver %u size %d into buf size %d\n",
1510793c20e9SJon Mason 			qp->rx_index, hdr->ver, hdr->len, entry->len);
1511fce8a7bbSJon Mason 
1512282a2feeSJon Mason 		qp->rx_bytes += hdr->len;
1513282a2feeSJon Mason 		qp->rx_pkts++;
1514fce8a7bbSJon Mason 
1515da2e5ae5SAllen Hubbe 		entry->len = hdr->len;
1516282a2feeSJon Mason 
1517da2e5ae5SAllen Hubbe 		ntb_async_rx(entry, offset);
1518da2e5ae5SAllen Hubbe 	}
1519fce8a7bbSJon Mason 
1520282a2feeSJon Mason 	qp->rx_index++;
1521282a2feeSJon Mason 	qp->rx_index %= qp->rx_max_entry;
1522282a2feeSJon Mason 
1523282a2feeSJon Mason 	return 0;
1524fce8a7bbSJon Mason }
1525fce8a7bbSJon Mason 
1526e26a5843SAllen Hubbe static void ntb_transport_rxc_db(unsigned long data)
1527fce8a7bbSJon Mason {
1528e26a5843SAllen Hubbe 	struct ntb_transport_qp *qp = (void *)data;
1529c336acd3SJon Mason 	int rc, i;
1530fce8a7bbSJon Mason 
1531e26a5843SAllen Hubbe 	dev_dbg(&qp->ndev->pdev->dev, "%s: doorbell %d received\n",
1532e26a5843SAllen Hubbe 		__func__, qp->qp_num);
1533e8aeb60cSJon Mason 
1534c336acd3SJon Mason 	/* Limit the number of packets processed in a single interrupt to
1535c336acd3SJon Mason 	 * provide fairness to others
1536c336acd3SJon Mason 	 */
1537c336acd3SJon Mason 	for (i = 0; i < qp->rx_max_entry; i++) {
1538fce8a7bbSJon Mason 		rc = ntb_process_rxc(qp);
1539c336acd3SJon Mason 		if (rc)
1540c336acd3SJon Mason 			break;
1541c336acd3SJon Mason 	}
1542282a2feeSJon Mason 
1543569410caSDave Jiang 	if (i && qp->rx_dma_chan)
1544569410caSDave Jiang 		dma_async_issue_pending(qp->rx_dma_chan);
1545fce8a7bbSJon Mason 
1546e26a5843SAllen Hubbe 	if (i == qp->rx_max_entry) {
1547e26a5843SAllen Hubbe 		/* there is more work to do */
1548e9021331SDave Jiang 		if (qp->active)
1549e26a5843SAllen Hubbe 			tasklet_schedule(&qp->rxc_db_work);
1550e26a5843SAllen Hubbe 	} else if (ntb_db_read(qp->ndev) & BIT_ULL(qp->qp_num)) {
1551e26a5843SAllen Hubbe 		/* the doorbell bit is set: clear it */
1552e26a5843SAllen Hubbe 		ntb_db_clear(qp->ndev, BIT_ULL(qp->qp_num));
1553e26a5843SAllen Hubbe 		/* ntb_db_read ensures ntb_db_clear write is committed */
1554e26a5843SAllen Hubbe 		ntb_db_read(qp->ndev);
1555e26a5843SAllen Hubbe 
1556e26a5843SAllen Hubbe 		/* an interrupt may have arrived between finishing
1557e26a5843SAllen Hubbe 		 * ntb_process_rxc and clearing the doorbell bit:
1558e26a5843SAllen Hubbe 		 * there might be some more work to do.
1559e26a5843SAllen Hubbe 		 */
1560e9021331SDave Jiang 		if (qp->active)
1561e26a5843SAllen Hubbe 			tasklet_schedule(&qp->rxc_db_work);
1562e26a5843SAllen Hubbe 	}
1563fce8a7bbSJon Mason }
1564fce8a7bbSJon Mason 
15659cabc269SDave Jiang static void ntb_tx_copy_callback(void *data,
15669cabc269SDave Jiang 				 const struct dmaengine_result *res)
1567fce8a7bbSJon Mason {
1568282a2feeSJon Mason 	struct ntb_queue_entry *entry = data;
1569282a2feeSJon Mason 	struct ntb_transport_qp *qp = entry->qp;
1570282a2feeSJon Mason 	struct ntb_payload_header __iomem *hdr = entry->tx_hdr;
1571fce8a7bbSJon Mason 
15729cabc269SDave Jiang 	/* we need to check DMA results if we are using DMA */
15739cabc269SDave Jiang 	if (res) {
15749cabc269SDave Jiang 		enum dmaengine_tx_result dma_err = res->result;
15759cabc269SDave Jiang 
15769cabc269SDave Jiang 		switch (dma_err) {
15779cabc269SDave Jiang 		case DMA_TRANS_READ_FAILED:
15789cabc269SDave Jiang 		case DMA_TRANS_WRITE_FAILED:
15799cabc269SDave Jiang 			entry->errors++;
1580846429bcSGustavo A. R. Silva 			/* fall through */
15819cabc269SDave Jiang 		case DMA_TRANS_ABORTED:
15829cabc269SDave Jiang 		{
15839cabc269SDave Jiang 			void __iomem *offset =
15849cabc269SDave Jiang 				qp->tx_mw + qp->tx_max_frame *
15859cabc269SDave Jiang 				entry->tx_index;
15869cabc269SDave Jiang 
15879cabc269SDave Jiang 			/* resubmit via CPU */
15889cabc269SDave Jiang 			ntb_memcpy_tx(entry, offset);
15899cabc269SDave Jiang 			qp->tx_memcpy++;
15909cabc269SDave Jiang 			return;
15919cabc269SDave Jiang 		}
15929cabc269SDave Jiang 
15939cabc269SDave Jiang 		case DMA_TRANS_NOERROR:
15949cabc269SDave Jiang 		default:
15959cabc269SDave Jiang 			break;
15969cabc269SDave Jiang 		}
15979cabc269SDave Jiang 	}
15989cabc269SDave Jiang 
159974465645SJon Mason 	iowrite32(entry->flags | DESC_DONE_FLAG, &hdr->flags);
1600fce8a7bbSJon Mason 
1601e26a5843SAllen Hubbe 	ntb_peer_db_set(qp->ndev, BIT_ULL(qp->qp_num));
1602fce8a7bbSJon Mason 
1603fce8a7bbSJon Mason 	/* The entry length can only be zero if the packet is intended to be a
1604fce8a7bbSJon Mason 	 * "link down" or similar.  Since no payload is being sent in these
1605fce8a7bbSJon Mason 	 * cases, there is nothing to add to the completion queue.
1606fce8a7bbSJon Mason 	 */
1607fce8a7bbSJon Mason 	if (entry->len > 0) {
1608fce8a7bbSJon Mason 		qp->tx_bytes += entry->len;
1609fce8a7bbSJon Mason 
1610fce8a7bbSJon Mason 		if (qp->tx_handler)
1611fce8a7bbSJon Mason 			qp->tx_handler(qp, qp->cb_data, entry->cb_data,
1612fce8a7bbSJon Mason 				       entry->len);
1613fce8a7bbSJon Mason 	}
1614fce8a7bbSJon Mason 
1615fce8a7bbSJon Mason 	ntb_list_add(&qp->ntb_tx_free_q_lock, &entry->entry, &qp->tx_free_q);
1616fce8a7bbSJon Mason }
1617fce8a7bbSJon Mason 
1618282a2feeSJon Mason static void ntb_memcpy_tx(struct ntb_queue_entry *entry, void __iomem *offset)
1619282a2feeSJon Mason {
162006917f75SDave Jiang #ifdef ARCH_HAS_NOCACHE_UACCESS
162106917f75SDave Jiang 	/*
162206917f75SDave Jiang 	 * Using non-temporal mov to improve performance on non-cached
162306917f75SDave Jiang 	 * writes, even though we aren't actually copying from user space.
162406917f75SDave Jiang 	 */
162506917f75SDave Jiang 	__copy_from_user_inatomic_nocache(offset, entry->buf, entry->len);
162606917f75SDave Jiang #else
1627282a2feeSJon Mason 	memcpy_toio(offset, entry->buf, entry->len);
162806917f75SDave Jiang #endif
1629282a2feeSJon Mason 
1630e26a5843SAllen Hubbe 	/* Ensure that the data is fully copied out before setting the flags */
1631e26a5843SAllen Hubbe 	wmb();
1632e26a5843SAllen Hubbe 
16339cabc269SDave Jiang 	ntb_tx_copy_callback(entry, NULL);
1634282a2feeSJon Mason }
1635282a2feeSJon Mason 
16369cabc269SDave Jiang static int ntb_async_tx_submit(struct ntb_transport_qp *qp,
1637282a2feeSJon Mason 			       struct ntb_queue_entry *entry)
1638282a2feeSJon Mason {
1639282a2feeSJon Mason 	struct dma_async_tx_descriptor *txd;
1640569410caSDave Jiang 	struct dma_chan *chan = qp->tx_dma_chan;
1641282a2feeSJon Mason 	struct dma_device *device;
16429cabc269SDave Jiang 	size_t len = entry->len;
16439cabc269SDave Jiang 	void *buf = entry->buf;
1644282a2feeSJon Mason 	size_t dest_off, buff_off;
16456f57fd05SBartlomiej Zolnierkiewicz 	struct dmaengine_unmap_data *unmap;
16466f57fd05SBartlomiej Zolnierkiewicz 	dma_addr_t dest;
1647282a2feeSJon Mason 	dma_cookie_t cookie;
1648282a2feeSJon Mason 
1649282a2feeSJon Mason 	device = chan->device;
16509cabc269SDave Jiang 	dest = qp->tx_mw_phys + qp->tx_max_frame * entry->tx_index;
1651282a2feeSJon Mason 	buff_off = (size_t)buf & ~PAGE_MASK;
1652282a2feeSJon Mason 	dest_off = (size_t)dest & ~PAGE_MASK;
1653282a2feeSJon Mason 
1654282a2feeSJon Mason 	if (!is_dma_copy_aligned(device, buff_off, dest_off, len))
1655282a2feeSJon Mason 		goto err;
1656282a2feeSJon Mason 
16576f57fd05SBartlomiej Zolnierkiewicz 	unmap = dmaengine_get_unmap_data(device->dev, 1, GFP_NOWAIT);
16586f57fd05SBartlomiej Zolnierkiewicz 	if (!unmap)
1659282a2feeSJon Mason 		goto err;
1660282a2feeSJon Mason 
16616f57fd05SBartlomiej Zolnierkiewicz 	unmap->len = len;
16626f57fd05SBartlomiej Zolnierkiewicz 	unmap->addr[0] = dma_map_page(device->dev, virt_to_page(buf),
16636f57fd05SBartlomiej Zolnierkiewicz 				      buff_off, len, DMA_TO_DEVICE);
16646f57fd05SBartlomiej Zolnierkiewicz 	if (dma_mapping_error(device->dev, unmap->addr[0]))
16656f57fd05SBartlomiej Zolnierkiewicz 		goto err_get_unmap;
16666f57fd05SBartlomiej Zolnierkiewicz 
16676f57fd05SBartlomiej Zolnierkiewicz 	unmap->to_cnt = 1;
16686f57fd05SBartlomiej Zolnierkiewicz 
166988931ec3SAllen Hubbe 	txd = device->device_prep_dma_memcpy(chan, dest, unmap->addr[0], len,
16709cabc269SDave Jiang 					     DMA_PREP_INTERRUPT);
167188931ec3SAllen Hubbe 	if (!txd)
16726f57fd05SBartlomiej Zolnierkiewicz 		goto err_get_unmap;
1673282a2feeSJon Mason 
16749cabc269SDave Jiang 	txd->callback_result = ntb_tx_copy_callback;
1675282a2feeSJon Mason 	txd->callback_param = entry;
16766f57fd05SBartlomiej Zolnierkiewicz 	dma_set_unmap(txd, unmap);
1677282a2feeSJon Mason 
1678282a2feeSJon Mason 	cookie = dmaengine_submit(txd);
1679282a2feeSJon Mason 	if (dma_submit_error(cookie))
16806f57fd05SBartlomiej Zolnierkiewicz 		goto err_set_unmap;
16816f57fd05SBartlomiej Zolnierkiewicz 
16826f57fd05SBartlomiej Zolnierkiewicz 	dmaengine_unmap_put(unmap);
1683282a2feeSJon Mason 
1684282a2feeSJon Mason 	dma_async_issue_pending(chan);
1685282a2feeSJon Mason 
16869cabc269SDave Jiang 	return 0;
16876f57fd05SBartlomiej Zolnierkiewicz err_set_unmap:
16886f57fd05SBartlomiej Zolnierkiewicz 	dmaengine_unmap_put(unmap);
16896f57fd05SBartlomiej Zolnierkiewicz err_get_unmap:
16906f57fd05SBartlomiej Zolnierkiewicz 	dmaengine_unmap_put(unmap);
1691282a2feeSJon Mason err:
16929cabc269SDave Jiang 	return -ENXIO;
16939cabc269SDave Jiang }
16949cabc269SDave Jiang 
16959cabc269SDave Jiang static void ntb_async_tx(struct ntb_transport_qp *qp,
16969cabc269SDave Jiang 			 struct ntb_queue_entry *entry)
16979cabc269SDave Jiang {
16989cabc269SDave Jiang 	struct ntb_payload_header __iomem *hdr;
16999cabc269SDave Jiang 	struct dma_chan *chan = qp->tx_dma_chan;
17009cabc269SDave Jiang 	void __iomem *offset;
17019cabc269SDave Jiang 	int res;
17029cabc269SDave Jiang 
17039cabc269SDave Jiang 	entry->tx_index = qp->tx_index;
17049cabc269SDave Jiang 	offset = qp->tx_mw + qp->tx_max_frame * entry->tx_index;
17059cabc269SDave Jiang 	hdr = offset + qp->tx_max_frame - sizeof(struct ntb_payload_header);
17069cabc269SDave Jiang 	entry->tx_hdr = hdr;
17079cabc269SDave Jiang 
17089cabc269SDave Jiang 	iowrite32(entry->len, &hdr->len);
17099cabc269SDave Jiang 	iowrite32((u32)qp->tx_pkts, &hdr->ver);
17109cabc269SDave Jiang 
17119cabc269SDave Jiang 	if (!chan)
17129cabc269SDave Jiang 		goto err;
17139cabc269SDave Jiang 
17149cabc269SDave Jiang 	if (entry->len < copy_bytes)
17159cabc269SDave Jiang 		goto err;
17169cabc269SDave Jiang 
17179cabc269SDave Jiang 	res = ntb_async_tx_submit(qp, entry);
17189cabc269SDave Jiang 	if (res < 0)
17199cabc269SDave Jiang 		goto err;
17209cabc269SDave Jiang 
17219cabc269SDave Jiang 	if (!entry->retries)
17229cabc269SDave Jiang 		qp->tx_async++;
17239cabc269SDave Jiang 
17249cabc269SDave Jiang 	return;
17259cabc269SDave Jiang 
17269cabc269SDave Jiang err:
1727282a2feeSJon Mason 	ntb_memcpy_tx(entry, offset);
1728282a2feeSJon Mason 	qp->tx_memcpy++;
1729282a2feeSJon Mason }
1730282a2feeSJon Mason 
1731fce8a7bbSJon Mason static int ntb_process_tx(struct ntb_transport_qp *qp,
1732fce8a7bbSJon Mason 			  struct ntb_queue_entry *entry)
1733fce8a7bbSJon Mason {
1734793c20e9SJon Mason 	if (qp->tx_index == qp->remote_rx_info->entry) {
1735fce8a7bbSJon Mason 		qp->tx_ring_full++;
1736fce8a7bbSJon Mason 		return -EAGAIN;
1737fce8a7bbSJon Mason 	}
1738fce8a7bbSJon Mason 
1739ef114ed5SJon Mason 	if (entry->len > qp->tx_max_frame - sizeof(struct ntb_payload_header)) {
1740fce8a7bbSJon Mason 		if (qp->tx_handler)
1741179f912aSJon Mason 			qp->tx_handler(qp, qp->cb_data, NULL, -EIO);
1742fce8a7bbSJon Mason 
1743fce8a7bbSJon Mason 		ntb_list_add(&qp->ntb_tx_free_q_lock, &entry->entry,
1744fce8a7bbSJon Mason 			     &qp->tx_free_q);
1745fce8a7bbSJon Mason 		return 0;
1746fce8a7bbSJon Mason 	}
1747fce8a7bbSJon Mason 
1748282a2feeSJon Mason 	ntb_async_tx(qp, entry);
1749fce8a7bbSJon Mason 
1750793c20e9SJon Mason 	qp->tx_index++;
1751793c20e9SJon Mason 	qp->tx_index %= qp->tx_max_entry;
1752fce8a7bbSJon Mason 
1753fce8a7bbSJon Mason 	qp->tx_pkts++;
1754fce8a7bbSJon Mason 
1755fce8a7bbSJon Mason 	return 0;
1756fce8a7bbSJon Mason }
1757fce8a7bbSJon Mason 
1758fce8a7bbSJon Mason static void ntb_send_link_down(struct ntb_transport_qp *qp)
1759fce8a7bbSJon Mason {
1760e26a5843SAllen Hubbe 	struct pci_dev *pdev = qp->ndev->pdev;
1761fce8a7bbSJon Mason 	struct ntb_queue_entry *entry;
1762fce8a7bbSJon Mason 	int i, rc;
1763fce8a7bbSJon Mason 
1764e26a5843SAllen Hubbe 	if (!qp->link_is_up)
1765fce8a7bbSJon Mason 		return;
1766fce8a7bbSJon Mason 
1767e22e0b9dSAllen Hubbe 	dev_info(&pdev->dev, "qp %d: Send Link Down\n", qp->qp_num);
1768fce8a7bbSJon Mason 
1769fce8a7bbSJon Mason 	for (i = 0; i < NTB_LINK_DOWN_TIMEOUT; i++) {
1770f766755cSJon Mason 		entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q);
1771fce8a7bbSJon Mason 		if (entry)
1772fce8a7bbSJon Mason 			break;
1773fce8a7bbSJon Mason 		msleep(100);
1774fce8a7bbSJon Mason 	}
1775fce8a7bbSJon Mason 
1776fce8a7bbSJon Mason 	if (!entry)
1777fce8a7bbSJon Mason 		return;
1778fce8a7bbSJon Mason 
1779fce8a7bbSJon Mason 	entry->cb_data = NULL;
1780fce8a7bbSJon Mason 	entry->buf = NULL;
1781fce8a7bbSJon Mason 	entry->len = 0;
1782fce8a7bbSJon Mason 	entry->flags = LINK_DOWN_FLAG;
1783fce8a7bbSJon Mason 
1784fce8a7bbSJon Mason 	rc = ntb_process_tx(qp, entry);
1785fce8a7bbSJon Mason 	if (rc)
1786fce8a7bbSJon Mason 		dev_err(&pdev->dev, "ntb: QP%d unable to send linkdown msg\n",
1787fce8a7bbSJon Mason 			qp->qp_num);
17882849b5d7SAllen Hubbe 
17892849b5d7SAllen Hubbe 	ntb_qp_link_down_reset(qp);
1790fce8a7bbSJon Mason }
1791fce8a7bbSJon Mason 
17921199aa61SAllen Hubbe static bool ntb_dma_filter_fn(struct dma_chan *chan, void *node)
17931199aa61SAllen Hubbe {
17941199aa61SAllen Hubbe 	return dev_to_node(&chan->dev->device) == (int)(unsigned long)node;
17951199aa61SAllen Hubbe }
17961199aa61SAllen Hubbe 
1797fce8a7bbSJon Mason /**
1798fce8a7bbSJon Mason  * ntb_transport_create_queue - Create a new NTB transport layer queue
1799fce8a7bbSJon Mason  * @rx_handler: receive callback function
1800fce8a7bbSJon Mason  * @tx_handler: transmit callback function
1801fce8a7bbSJon Mason  * @event_handler: event callback function
1802fce8a7bbSJon Mason  *
1803fce8a7bbSJon Mason  * Create a new NTB transport layer queue and provide the queue with a callback
1804fce8a7bbSJon Mason  * routine for both transmit and receive.  The receive callback routine will be
1805fce8a7bbSJon Mason  * used to pass up data when the transport has received it on the queue.   The
1806fce8a7bbSJon Mason  * transmit callback routine will be called when the transport has completed the
1807fce8a7bbSJon Mason  * transmission of the data on the queue and the data is ready to be freed.
1808fce8a7bbSJon Mason  *
1809fce8a7bbSJon Mason  * RETURNS: pointer to newly created ntb_queue, NULL on error.
1810fce8a7bbSJon Mason  */
1811fce8a7bbSJon Mason struct ntb_transport_qp *
1812e26a5843SAllen Hubbe ntb_transport_create_queue(void *data, struct device *client_dev,
1813fce8a7bbSJon Mason 			   const struct ntb_queue_handlers *handlers)
1814fce8a7bbSJon Mason {
1815e26a5843SAllen Hubbe 	struct ntb_dev *ndev;
1816e26a5843SAllen Hubbe 	struct pci_dev *pdev;
1817e26a5843SAllen Hubbe 	struct ntb_transport_ctx *nt;
1818fce8a7bbSJon Mason 	struct ntb_queue_entry *entry;
1819fce8a7bbSJon Mason 	struct ntb_transport_qp *qp;
1820e26a5843SAllen Hubbe 	u64 qp_bit;
1821fce8a7bbSJon Mason 	unsigned int free_queue;
18221199aa61SAllen Hubbe 	dma_cap_mask_t dma_mask;
18231199aa61SAllen Hubbe 	int node;
1824e26a5843SAllen Hubbe 	int i;
1825fce8a7bbSJon Mason 
1826e26a5843SAllen Hubbe 	ndev = dev_ntb(client_dev->parent);
1827e26a5843SAllen Hubbe 	pdev = ndev->pdev;
1828e26a5843SAllen Hubbe 	nt = ndev->ctx;
1829fce8a7bbSJon Mason 
18301199aa61SAllen Hubbe 	node = dev_to_node(&ndev->dev);
18311199aa61SAllen Hubbe 
18328fcd0950SThomas VanSelus 	free_queue = ffs(nt->qp_bitmap_free);
1833fce8a7bbSJon Mason 	if (!free_queue)
1834fce8a7bbSJon Mason 		goto err;
1835fce8a7bbSJon Mason 
1836fce8a7bbSJon Mason 	/* decrement free_queue to make it zero based */
1837fce8a7bbSJon Mason 	free_queue--;
1838fce8a7bbSJon Mason 
1839e26a5843SAllen Hubbe 	qp = &nt->qp_vec[free_queue];
1840e26a5843SAllen Hubbe 	qp_bit = BIT_ULL(qp->qp_num);
1841fce8a7bbSJon Mason 
1842e26a5843SAllen Hubbe 	nt->qp_bitmap_free &= ~qp_bit;
1843e26a5843SAllen Hubbe 
1844fce8a7bbSJon Mason 	qp->cb_data = data;
1845fce8a7bbSJon Mason 	qp->rx_handler = handlers->rx_handler;
1846fce8a7bbSJon Mason 	qp->tx_handler = handlers->tx_handler;
1847fce8a7bbSJon Mason 	qp->event_handler = handlers->event_handler;
1848fce8a7bbSJon Mason 
18491199aa61SAllen Hubbe 	dma_cap_zero(dma_mask);
18501199aa61SAllen Hubbe 	dma_cap_set(DMA_MEMCPY, dma_mask);
18511199aa61SAllen Hubbe 
1852a41ef053SDave Jiang 	if (use_dma) {
1853569410caSDave Jiang 		qp->tx_dma_chan =
1854569410caSDave Jiang 			dma_request_channel(dma_mask, ntb_dma_filter_fn,
18551199aa61SAllen Hubbe 					    (void *)(unsigned long)node);
1856569410caSDave Jiang 		if (!qp->tx_dma_chan)
1857569410caSDave Jiang 			dev_info(&pdev->dev, "Unable to allocate TX DMA channel\n");
1858569410caSDave Jiang 
1859569410caSDave Jiang 		qp->rx_dma_chan =
1860569410caSDave Jiang 			dma_request_channel(dma_mask, ntb_dma_filter_fn,
1861569410caSDave Jiang 					    (void *)(unsigned long)node);
1862569410caSDave Jiang 		if (!qp->rx_dma_chan)
1863569410caSDave Jiang 			dev_info(&pdev->dev, "Unable to allocate RX DMA channel\n");
1864a41ef053SDave Jiang 	} else {
1865569410caSDave Jiang 		qp->tx_dma_chan = NULL;
1866569410caSDave Jiang 		qp->rx_dma_chan = NULL;
1867a41ef053SDave Jiang 	}
1868569410caSDave Jiang 
1869569410caSDave Jiang 	dev_dbg(&pdev->dev, "Using %s memcpy for TX\n",
1870569410caSDave Jiang 		qp->tx_dma_chan ? "DMA" : "CPU");
1871569410caSDave Jiang 
1872569410caSDave Jiang 	dev_dbg(&pdev->dev, "Using %s memcpy for RX\n",
1873569410caSDave Jiang 		qp->rx_dma_chan ? "DMA" : "CPU");
1874282a2feeSJon Mason 
1875fce8a7bbSJon Mason 	for (i = 0; i < NTB_QP_DEF_NUM_ENTRIES; i++) {
1876c9160b69SJia-Ju Bai 		entry = kzalloc_node(sizeof(*entry), GFP_KERNEL, node);
1877fce8a7bbSJon Mason 		if (!entry)
1878fce8a7bbSJon Mason 			goto err1;
1879fce8a7bbSJon Mason 
1880282a2feeSJon Mason 		entry->qp = qp;
1881da2e5ae5SAllen Hubbe 		ntb_list_add(&qp->ntb_rx_q_lock, &entry->entry,
1882fce8a7bbSJon Mason 			     &qp->rx_free_q);
1883fce8a7bbSJon Mason 	}
1884a754a8fcSDave Jiang 	qp->rx_alloc_entry = NTB_QP_DEF_NUM_ENTRIES;
1885fce8a7bbSJon Mason 
1886a754a8fcSDave Jiang 	for (i = 0; i < qp->tx_max_entry; i++) {
1887c9160b69SJia-Ju Bai 		entry = kzalloc_node(sizeof(*entry), GFP_KERNEL, node);
1888fce8a7bbSJon Mason 		if (!entry)
1889fce8a7bbSJon Mason 			goto err2;
1890fce8a7bbSJon Mason 
1891282a2feeSJon Mason 		entry->qp = qp;
1892fce8a7bbSJon Mason 		ntb_list_add(&qp->ntb_tx_free_q_lock, &entry->entry,
1893fce8a7bbSJon Mason 			     &qp->tx_free_q);
1894fce8a7bbSJon Mason 	}
1895fce8a7bbSJon Mason 
1896e26a5843SAllen Hubbe 	ntb_db_clear(qp->ndev, qp_bit);
1897e26a5843SAllen Hubbe 	ntb_db_clear_mask(qp->ndev, qp_bit);
1898fce8a7bbSJon Mason 
1899fce8a7bbSJon Mason 	dev_info(&pdev->dev, "NTB Transport QP %d created\n", qp->qp_num);
1900fce8a7bbSJon Mason 
1901fce8a7bbSJon Mason 	return qp;
1902fce8a7bbSJon Mason 
1903fce8a7bbSJon Mason err2:
1904f766755cSJon Mason 	while ((entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q)))
1905fce8a7bbSJon Mason 		kfree(entry);
1906fce8a7bbSJon Mason err1:
1907a754a8fcSDave Jiang 	qp->rx_alloc_entry = 0;
1908da2e5ae5SAllen Hubbe 	while ((entry = ntb_list_rm(&qp->ntb_rx_q_lock, &qp->rx_free_q)))
1909fce8a7bbSJon Mason 		kfree(entry);
1910569410caSDave Jiang 	if (qp->tx_dma_chan)
1911569410caSDave Jiang 		dma_release_channel(qp->tx_dma_chan);
1912569410caSDave Jiang 	if (qp->rx_dma_chan)
1913569410caSDave Jiang 		dma_release_channel(qp->rx_dma_chan);
1914e26a5843SAllen Hubbe 	nt->qp_bitmap_free |= qp_bit;
1915fce8a7bbSJon Mason err:
1916fce8a7bbSJon Mason 	return NULL;
1917fce8a7bbSJon Mason }
1918fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_create_queue);
1919fce8a7bbSJon Mason 
1920fce8a7bbSJon Mason /**
1921fce8a7bbSJon Mason  * ntb_transport_free_queue - Frees NTB transport queue
1922fce8a7bbSJon Mason  * @qp: NTB queue to be freed
1923fce8a7bbSJon Mason  *
1924fce8a7bbSJon Mason  * Frees NTB transport queue
1925fce8a7bbSJon Mason  */
1926fce8a7bbSJon Mason void ntb_transport_free_queue(struct ntb_transport_qp *qp)
1927fce8a7bbSJon Mason {
1928186f27ffSJon Mason 	struct pci_dev *pdev;
1929fce8a7bbSJon Mason 	struct ntb_queue_entry *entry;
1930e26a5843SAllen Hubbe 	u64 qp_bit;
1931fce8a7bbSJon Mason 
1932fce8a7bbSJon Mason 	if (!qp)
1933fce8a7bbSJon Mason 		return;
1934fce8a7bbSJon Mason 
1935e26a5843SAllen Hubbe 	pdev = qp->ndev->pdev;
1936186f27ffSJon Mason 
1937e9021331SDave Jiang 	qp->active = false;
1938e9021331SDave Jiang 
1939569410caSDave Jiang 	if (qp->tx_dma_chan) {
1940569410caSDave Jiang 		struct dma_chan *chan = qp->tx_dma_chan;
1941282a2feeSJon Mason 		/* Putting the dma_chan to NULL will force any new traffic to be
1942282a2feeSJon Mason 		 * processed by the CPU instead of the DAM engine
1943282a2feeSJon Mason 		 */
1944569410caSDave Jiang 		qp->tx_dma_chan = NULL;
1945569410caSDave Jiang 
1946569410caSDave Jiang 		/* Try to be nice and wait for any queued DMA engine
1947569410caSDave Jiang 		 * transactions to process before smashing it with a rock
1948569410caSDave Jiang 		 */
1949569410caSDave Jiang 		dma_sync_wait(chan, qp->last_cookie);
1950569410caSDave Jiang 		dmaengine_terminate_all(chan);
1951569410caSDave Jiang 		dma_release_channel(chan);
1952569410caSDave Jiang 	}
1953569410caSDave Jiang 
1954569410caSDave Jiang 	if (qp->rx_dma_chan) {
1955569410caSDave Jiang 		struct dma_chan *chan = qp->rx_dma_chan;
1956569410caSDave Jiang 		/* Putting the dma_chan to NULL will force any new traffic to be
1957569410caSDave Jiang 		 * processed by the CPU instead of the DAM engine
1958569410caSDave Jiang 		 */
1959569410caSDave Jiang 		qp->rx_dma_chan = NULL;
1960282a2feeSJon Mason 
1961282a2feeSJon Mason 		/* Try to be nice and wait for any queued DMA engine
1962282a2feeSJon Mason 		 * transactions to process before smashing it with a rock
1963282a2feeSJon Mason 		 */
1964282a2feeSJon Mason 		dma_sync_wait(chan, qp->last_cookie);
1965282a2feeSJon Mason 		dmaengine_terminate_all(chan);
19661199aa61SAllen Hubbe 		dma_release_channel(chan);
1967282a2feeSJon Mason 	}
1968fce8a7bbSJon Mason 
1969e26a5843SAllen Hubbe 	qp_bit = BIT_ULL(qp->qp_num);
1970e26a5843SAllen Hubbe 
1971e26a5843SAllen Hubbe 	ntb_db_set_mask(qp->ndev, qp_bit);
1972e9021331SDave Jiang 	tasklet_kill(&qp->rxc_db_work);
1973fce8a7bbSJon Mason 
1974282a2feeSJon Mason 	cancel_delayed_work_sync(&qp->link_work);
1975282a2feeSJon Mason 
1976e26a5843SAllen Hubbe 	qp->cb_data = NULL;
1977e26a5843SAllen Hubbe 	qp->rx_handler = NULL;
1978e26a5843SAllen Hubbe 	qp->tx_handler = NULL;
1979e26a5843SAllen Hubbe 	qp->event_handler = NULL;
1980e26a5843SAllen Hubbe 
1981da2e5ae5SAllen Hubbe 	while ((entry = ntb_list_rm(&qp->ntb_rx_q_lock, &qp->rx_free_q)))
1982fce8a7bbSJon Mason 		kfree(entry);
1983fce8a7bbSJon Mason 
1984da2e5ae5SAllen Hubbe 	while ((entry = ntb_list_rm(&qp->ntb_rx_q_lock, &qp->rx_pend_q))) {
1985da2e5ae5SAllen Hubbe 		dev_warn(&pdev->dev, "Freeing item from non-empty rx_pend_q\n");
1986da2e5ae5SAllen Hubbe 		kfree(entry);
1987da2e5ae5SAllen Hubbe 	}
1988da2e5ae5SAllen Hubbe 
1989da2e5ae5SAllen Hubbe 	while ((entry = ntb_list_rm(&qp->ntb_rx_q_lock, &qp->rx_post_q))) {
1990da2e5ae5SAllen Hubbe 		dev_warn(&pdev->dev, "Freeing item from non-empty rx_post_q\n");
1991fce8a7bbSJon Mason 		kfree(entry);
1992fce8a7bbSJon Mason 	}
1993fce8a7bbSJon Mason 
1994f766755cSJon Mason 	while ((entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q)))
1995fce8a7bbSJon Mason 		kfree(entry);
1996fce8a7bbSJon Mason 
199730a4bb1eSAllen Hubbe 	qp->transport->qp_bitmap_free |= qp_bit;
1998fce8a7bbSJon Mason 
1999fce8a7bbSJon Mason 	dev_info(&pdev->dev, "NTB Transport QP %d freed\n", qp->qp_num);
2000fce8a7bbSJon Mason }
2001fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_free_queue);
2002fce8a7bbSJon Mason 
2003fce8a7bbSJon Mason /**
2004fce8a7bbSJon Mason  * ntb_transport_rx_remove - Dequeues enqueued rx packet
2005fce8a7bbSJon Mason  * @qp: NTB queue to be freed
2006fce8a7bbSJon Mason  * @len: pointer to variable to write enqueued buffers length
2007fce8a7bbSJon Mason  *
2008fce8a7bbSJon Mason  * Dequeues unused buffers from receive queue.  Should only be used during
2009fce8a7bbSJon Mason  * shutdown of qp.
2010fce8a7bbSJon Mason  *
2011fce8a7bbSJon Mason  * RETURNS: NULL error value on error, or void* for success.
2012fce8a7bbSJon Mason  */
2013fce8a7bbSJon Mason void *ntb_transport_rx_remove(struct ntb_transport_qp *qp, unsigned int *len)
2014fce8a7bbSJon Mason {
2015fce8a7bbSJon Mason 	struct ntb_queue_entry *entry;
2016fce8a7bbSJon Mason 	void *buf;
2017fce8a7bbSJon Mason 
2018e26a5843SAllen Hubbe 	if (!qp || qp->client_ready)
2019fce8a7bbSJon Mason 		return NULL;
2020fce8a7bbSJon Mason 
2021da2e5ae5SAllen Hubbe 	entry = ntb_list_rm(&qp->ntb_rx_q_lock, &qp->rx_pend_q);
2022fce8a7bbSJon Mason 	if (!entry)
2023fce8a7bbSJon Mason 		return NULL;
2024fce8a7bbSJon Mason 
2025fce8a7bbSJon Mason 	buf = entry->cb_data;
2026fce8a7bbSJon Mason 	*len = entry->len;
2027fce8a7bbSJon Mason 
2028da2e5ae5SAllen Hubbe 	ntb_list_add(&qp->ntb_rx_q_lock, &entry->entry, &qp->rx_free_q);
2029fce8a7bbSJon Mason 
2030fce8a7bbSJon Mason 	return buf;
2031fce8a7bbSJon Mason }
2032fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_rx_remove);
2033fce8a7bbSJon Mason 
2034fce8a7bbSJon Mason /**
2035fce8a7bbSJon Mason  * ntb_transport_rx_enqueue - Enqueue a new NTB queue entry
2036fce8a7bbSJon Mason  * @qp: NTB transport layer queue the entry is to be enqueued on
2037fce8a7bbSJon Mason  * @cb: per buffer pointer for callback function to use
2038fce8a7bbSJon Mason  * @data: pointer to data buffer that incoming packets will be copied into
2039fce8a7bbSJon Mason  * @len: length of the data buffer
2040fce8a7bbSJon Mason  *
2041fce8a7bbSJon Mason  * Enqueue a new receive buffer onto the transport queue into which a NTB
2042fce8a7bbSJon Mason  * payload can be received into.
2043fce8a7bbSJon Mason  *
2044fce8a7bbSJon Mason  * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
2045fce8a7bbSJon Mason  */
2046fce8a7bbSJon Mason int ntb_transport_rx_enqueue(struct ntb_transport_qp *qp, void *cb, void *data,
2047fce8a7bbSJon Mason 			     unsigned int len)
2048fce8a7bbSJon Mason {
2049fce8a7bbSJon Mason 	struct ntb_queue_entry *entry;
2050fce8a7bbSJon Mason 
2051fce8a7bbSJon Mason 	if (!qp)
2052fce8a7bbSJon Mason 		return -EINVAL;
2053fce8a7bbSJon Mason 
2054da2e5ae5SAllen Hubbe 	entry = ntb_list_rm(&qp->ntb_rx_q_lock, &qp->rx_free_q);
2055fce8a7bbSJon Mason 	if (!entry)
2056fce8a7bbSJon Mason 		return -ENOMEM;
2057fce8a7bbSJon Mason 
2058fce8a7bbSJon Mason 	entry->cb_data = cb;
2059fce8a7bbSJon Mason 	entry->buf = data;
2060fce8a7bbSJon Mason 	entry->len = len;
2061da2e5ae5SAllen Hubbe 	entry->flags = 0;
206272203572SDave Jiang 	entry->retries = 0;
206372203572SDave Jiang 	entry->errors = 0;
206472203572SDave Jiang 	entry->rx_index = 0;
2065fce8a7bbSJon Mason 
2066da2e5ae5SAllen Hubbe 	ntb_list_add(&qp->ntb_rx_q_lock, &entry->entry, &qp->rx_pend_q);
2067da2e5ae5SAllen Hubbe 
2068e9021331SDave Jiang 	if (qp->active)
2069da2e5ae5SAllen Hubbe 		tasklet_schedule(&qp->rxc_db_work);
2070fce8a7bbSJon Mason 
2071fce8a7bbSJon Mason 	return 0;
2072fce8a7bbSJon Mason }
2073fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_rx_enqueue);
2074fce8a7bbSJon Mason 
2075fce8a7bbSJon Mason /**
2076fce8a7bbSJon Mason  * ntb_transport_tx_enqueue - Enqueue a new NTB queue entry
2077fce8a7bbSJon Mason  * @qp: NTB transport layer queue the entry is to be enqueued on
2078fce8a7bbSJon Mason  * @cb: per buffer pointer for callback function to use
2079fce8a7bbSJon Mason  * @data: pointer to data buffer that will be sent
2080fce8a7bbSJon Mason  * @len: length of the data buffer
2081fce8a7bbSJon Mason  *
2082fce8a7bbSJon Mason  * Enqueue a new transmit buffer onto the transport queue from which a NTB
2083f9a2cf89SJon Mason  * payload will be transmitted.  This assumes that a lock is being held to
2084fce8a7bbSJon Mason  * serialize access to the qp.
2085fce8a7bbSJon Mason  *
2086fce8a7bbSJon Mason  * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
2087fce8a7bbSJon Mason  */
2088fce8a7bbSJon Mason int ntb_transport_tx_enqueue(struct ntb_transport_qp *qp, void *cb, void *data,
2089fce8a7bbSJon Mason 			     unsigned int len)
2090fce8a7bbSJon Mason {
2091fce8a7bbSJon Mason 	struct ntb_queue_entry *entry;
2092fce8a7bbSJon Mason 	int rc;
2093fce8a7bbSJon Mason 
2094e26a5843SAllen Hubbe 	if (!qp || !qp->link_is_up || !len)
2095fce8a7bbSJon Mason 		return -EINVAL;
2096fce8a7bbSJon Mason 
2097fce8a7bbSJon Mason 	entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q);
2098282a2feeSJon Mason 	if (!entry) {
2099282a2feeSJon Mason 		qp->tx_err_no_buf++;
2100e74bfeedSDave Jiang 		return -EBUSY;
2101282a2feeSJon Mason 	}
2102fce8a7bbSJon Mason 
2103fce8a7bbSJon Mason 	entry->cb_data = cb;
2104fce8a7bbSJon Mason 	entry->buf = data;
2105fce8a7bbSJon Mason 	entry->len = len;
2106fce8a7bbSJon Mason 	entry->flags = 0;
21079cabc269SDave Jiang 	entry->errors = 0;
21089cabc269SDave Jiang 	entry->retries = 0;
21099cabc269SDave Jiang 	entry->tx_index = 0;
2110fce8a7bbSJon Mason 
2111fce8a7bbSJon Mason 	rc = ntb_process_tx(qp, entry);
2112fce8a7bbSJon Mason 	if (rc)
2113fce8a7bbSJon Mason 		ntb_list_add(&qp->ntb_tx_free_q_lock, &entry->entry,
2114fce8a7bbSJon Mason 			     &qp->tx_free_q);
2115fce8a7bbSJon Mason 
2116fce8a7bbSJon Mason 	return rc;
2117fce8a7bbSJon Mason }
2118fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_tx_enqueue);
2119fce8a7bbSJon Mason 
2120fce8a7bbSJon Mason /**
2121fce8a7bbSJon Mason  * ntb_transport_link_up - Notify NTB transport of client readiness to use queue
2122fce8a7bbSJon Mason  * @qp: NTB transport layer queue to be enabled
2123fce8a7bbSJon Mason  *
2124fce8a7bbSJon Mason  * Notify NTB transport layer of client readiness to use queue
2125fce8a7bbSJon Mason  */
2126fce8a7bbSJon Mason void ntb_transport_link_up(struct ntb_transport_qp *qp)
2127fce8a7bbSJon Mason {
2128fce8a7bbSJon Mason 	if (!qp)
2129fce8a7bbSJon Mason 		return;
2130fce8a7bbSJon Mason 
2131e26a5843SAllen Hubbe 	qp->client_ready = true;
2132fce8a7bbSJon Mason 
2133e26a5843SAllen Hubbe 	if (qp->transport->link_is_up)
2134fce8a7bbSJon Mason 		schedule_delayed_work(&qp->link_work, 0);
2135fce8a7bbSJon Mason }
2136fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_link_up);
2137fce8a7bbSJon Mason 
2138fce8a7bbSJon Mason /**
2139fce8a7bbSJon Mason  * ntb_transport_link_down - Notify NTB transport to no longer enqueue data
2140fce8a7bbSJon Mason  * @qp: NTB transport layer queue to be disabled
2141fce8a7bbSJon Mason  *
2142fce8a7bbSJon Mason  * Notify NTB transport layer of client's desire to no longer receive data on
2143fce8a7bbSJon Mason  * transport queue specified.  It is the client's responsibility to ensure all
2144f9a2cf89SJon Mason  * entries on queue are purged or otherwise handled appropriately.
2145fce8a7bbSJon Mason  */
2146fce8a7bbSJon Mason void ntb_transport_link_down(struct ntb_transport_qp *qp)
2147fce8a7bbSJon Mason {
2148e26a5843SAllen Hubbe 	int val;
2149fce8a7bbSJon Mason 
2150fce8a7bbSJon Mason 	if (!qp)
2151fce8a7bbSJon Mason 		return;
2152fce8a7bbSJon Mason 
2153e26a5843SAllen Hubbe 	qp->client_ready = false;
2154fce8a7bbSJon Mason 
2155e26a5843SAllen Hubbe 	val = ntb_spad_read(qp->ndev, QP_LINKS);
2156fce8a7bbSJon Mason 
2157d67288a3SSerge Semin 	ntb_peer_spad_write(qp->ndev, PIDX, QP_LINKS, val & ~BIT(qp->qp_num));
2158fce8a7bbSJon Mason 
2159e26a5843SAllen Hubbe 	if (qp->link_is_up)
2160fce8a7bbSJon Mason 		ntb_send_link_down(qp);
2161fce8a7bbSJon Mason 	else
2162fce8a7bbSJon Mason 		cancel_delayed_work_sync(&qp->link_work);
2163fce8a7bbSJon Mason }
2164fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_link_down);
2165fce8a7bbSJon Mason 
2166fce8a7bbSJon Mason /**
2167fce8a7bbSJon Mason  * ntb_transport_link_query - Query transport link state
2168fce8a7bbSJon Mason  * @qp: NTB transport layer queue to be queried
2169fce8a7bbSJon Mason  *
2170fce8a7bbSJon Mason  * Query connectivity to the remote system of the NTB transport queue
2171fce8a7bbSJon Mason  *
2172fce8a7bbSJon Mason  * RETURNS: true for link up or false for link down
2173fce8a7bbSJon Mason  */
2174fce8a7bbSJon Mason bool ntb_transport_link_query(struct ntb_transport_qp *qp)
2175fce8a7bbSJon Mason {
2176186f27ffSJon Mason 	if (!qp)
2177186f27ffSJon Mason 		return false;
2178186f27ffSJon Mason 
2179e26a5843SAllen Hubbe 	return qp->link_is_up;
2180fce8a7bbSJon Mason }
2181fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_link_query);
2182fce8a7bbSJon Mason 
2183fce8a7bbSJon Mason /**
2184fce8a7bbSJon Mason  * ntb_transport_qp_num - Query the qp number
2185fce8a7bbSJon Mason  * @qp: NTB transport layer queue to be queried
2186fce8a7bbSJon Mason  *
2187fce8a7bbSJon Mason  * Query qp number of the NTB transport queue
2188fce8a7bbSJon Mason  *
2189fce8a7bbSJon Mason  * RETURNS: a zero based number specifying the qp number
2190fce8a7bbSJon Mason  */
2191fce8a7bbSJon Mason unsigned char ntb_transport_qp_num(struct ntb_transport_qp *qp)
2192fce8a7bbSJon Mason {
2193186f27ffSJon Mason 	if (!qp)
2194186f27ffSJon Mason 		return 0;
2195186f27ffSJon Mason 
2196fce8a7bbSJon Mason 	return qp->qp_num;
2197fce8a7bbSJon Mason }
2198fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_qp_num);
2199fce8a7bbSJon Mason 
2200fce8a7bbSJon Mason /**
2201fce8a7bbSJon Mason  * ntb_transport_max_size - Query the max payload size of a qp
2202fce8a7bbSJon Mason  * @qp: NTB transport layer queue to be queried
2203fce8a7bbSJon Mason  *
2204fce8a7bbSJon Mason  * Query the maximum payload size permissible on the given qp
2205fce8a7bbSJon Mason  *
2206fce8a7bbSJon Mason  * RETURNS: the max payload size of a qp
2207fce8a7bbSJon Mason  */
2208ef114ed5SJon Mason unsigned int ntb_transport_max_size(struct ntb_transport_qp *qp)
2209fce8a7bbSJon Mason {
221004afde45SDave Jiang 	unsigned int max_size;
2211569410caSDave Jiang 	unsigned int copy_align;
221204afde45SDave Jiang 	struct dma_chan *rx_chan, *tx_chan;
2213282a2feeSJon Mason 
2214186f27ffSJon Mason 	if (!qp)
2215186f27ffSJon Mason 		return 0;
2216186f27ffSJon Mason 
221704afde45SDave Jiang 	rx_chan = qp->rx_dma_chan;
221804afde45SDave Jiang 	tx_chan = qp->tx_dma_chan;
2219282a2feeSJon Mason 
222004afde45SDave Jiang 	copy_align = max(rx_chan ? rx_chan->device->copy_align : 0,
222104afde45SDave Jiang 			 tx_chan ? tx_chan->device->copy_align : 0);
2222569410caSDave Jiang 
2223282a2feeSJon Mason 	/* If DMA engine usage is possible, try to find the max size for that */
222404afde45SDave Jiang 	max_size = qp->tx_max_frame - sizeof(struct ntb_payload_header);
222504afde45SDave Jiang 	max_size = round_down(max_size, 1 << copy_align);
2226282a2feeSJon Mason 
222704afde45SDave Jiang 	return max_size;
2228fce8a7bbSJon Mason }
2229fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_max_size);
2230e26a5843SAllen Hubbe 
2231e74bfeedSDave Jiang unsigned int ntb_transport_tx_free_entry(struct ntb_transport_qp *qp)
2232e74bfeedSDave Jiang {
2233e74bfeedSDave Jiang 	unsigned int head = qp->tx_index;
2234e74bfeedSDave Jiang 	unsigned int tail = qp->remote_rx_info->entry;
2235e74bfeedSDave Jiang 
2236e74bfeedSDave Jiang 	return tail > head ? tail - head : qp->tx_max_entry + tail - head;
2237e74bfeedSDave Jiang }
2238e74bfeedSDave Jiang EXPORT_SYMBOL_GPL(ntb_transport_tx_free_entry);
2239e74bfeedSDave Jiang 
2240e26a5843SAllen Hubbe static void ntb_transport_doorbell_callback(void *data, int vector)
2241e26a5843SAllen Hubbe {
2242e26a5843SAllen Hubbe 	struct ntb_transport_ctx *nt = data;
2243e26a5843SAllen Hubbe 	struct ntb_transport_qp *qp;
2244e26a5843SAllen Hubbe 	u64 db_bits;
2245e26a5843SAllen Hubbe 	unsigned int qp_num;
2246e26a5843SAllen Hubbe 
2247e26a5843SAllen Hubbe 	db_bits = (nt->qp_bitmap & ~nt->qp_bitmap_free &
2248e26a5843SAllen Hubbe 		   ntb_db_vector_mask(nt->ndev, vector));
2249e26a5843SAllen Hubbe 
2250e26a5843SAllen Hubbe 	while (db_bits) {
2251e26a5843SAllen Hubbe 		qp_num = __ffs(db_bits);
2252e26a5843SAllen Hubbe 		qp = &nt->qp_vec[qp_num];
2253e26a5843SAllen Hubbe 
2254e9021331SDave Jiang 		if (qp->active)
2255e26a5843SAllen Hubbe 			tasklet_schedule(&qp->rxc_db_work);
2256e26a5843SAllen Hubbe 
2257e26a5843SAllen Hubbe 		db_bits &= ~BIT_ULL(qp_num);
2258e26a5843SAllen Hubbe 	}
2259e26a5843SAllen Hubbe }
2260e26a5843SAllen Hubbe 
2261e26a5843SAllen Hubbe static const struct ntb_ctx_ops ntb_transport_ops = {
2262e26a5843SAllen Hubbe 	.link_event = ntb_transport_event_callback,
2263e26a5843SAllen Hubbe 	.db_event = ntb_transport_doorbell_callback,
2264e26a5843SAllen Hubbe };
2265e26a5843SAllen Hubbe 
2266e26a5843SAllen Hubbe static struct ntb_client ntb_transport_client = {
2267e26a5843SAllen Hubbe 	.ops = {
2268e26a5843SAllen Hubbe 		.probe = ntb_transport_probe,
2269e26a5843SAllen Hubbe 		.remove = ntb_transport_free,
2270e26a5843SAllen Hubbe 	},
2271e26a5843SAllen Hubbe };
2272e26a5843SAllen Hubbe 
2273e26a5843SAllen Hubbe static int __init ntb_transport_init(void)
2274e26a5843SAllen Hubbe {
2275e26a5843SAllen Hubbe 	int rc;
2276e26a5843SAllen Hubbe 
22777eb38781SDave Jiang 	pr_info("%s, version %s\n", NTB_TRANSPORT_DESC, NTB_TRANSPORT_VER);
22787eb38781SDave Jiang 
2279e26a5843SAllen Hubbe 	if (debugfs_initialized())
2280e26a5843SAllen Hubbe 		nt_debugfs_dir = debugfs_create_dir(KBUILD_MODNAME, NULL);
2281e26a5843SAllen Hubbe 
2282e26a5843SAllen Hubbe 	rc = bus_register(&ntb_transport_bus);
2283e26a5843SAllen Hubbe 	if (rc)
2284e26a5843SAllen Hubbe 		goto err_bus;
2285e26a5843SAllen Hubbe 
2286e26a5843SAllen Hubbe 	rc = ntb_register_client(&ntb_transport_client);
2287e26a5843SAllen Hubbe 	if (rc)
2288e26a5843SAllen Hubbe 		goto err_client;
2289e26a5843SAllen Hubbe 
2290e26a5843SAllen Hubbe 	return 0;
2291e26a5843SAllen Hubbe 
2292e26a5843SAllen Hubbe err_client:
2293e26a5843SAllen Hubbe 	bus_unregister(&ntb_transport_bus);
2294e26a5843SAllen Hubbe err_bus:
2295e26a5843SAllen Hubbe 	debugfs_remove_recursive(nt_debugfs_dir);
2296e26a5843SAllen Hubbe 	return rc;
2297e26a5843SAllen Hubbe }
2298e26a5843SAllen Hubbe module_init(ntb_transport_init);
2299e26a5843SAllen Hubbe 
2300e26a5843SAllen Hubbe static void __exit ntb_transport_exit(void)
2301e26a5843SAllen Hubbe {
2302e26a5843SAllen Hubbe 	ntb_unregister_client(&ntb_transport_client);
2303e26a5843SAllen Hubbe 	bus_unregister(&ntb_transport_bus);
2304dd62245eSAllen Hubbe 	debugfs_remove_recursive(nt_debugfs_dir);
2305e26a5843SAllen Hubbe }
2306e26a5843SAllen Hubbe module_exit(ntb_transport_exit);
2307