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" 69e26a5843SAllen Hubbe 70e26a5843SAllen Hubbe MODULE_DESCRIPTION(NTB_TRANSPORT_DESC); 71e26a5843SAllen Hubbe MODULE_VERSION(NTB_TRANSPORT_VER); 72e26a5843SAllen Hubbe MODULE_LICENSE("Dual BSD/GPL"); 73e26a5843SAllen Hubbe MODULE_AUTHOR("Intel Corporation"); 74e26a5843SAllen Hubbe 75e26a5843SAllen Hubbe static unsigned long max_mw_size; 76e26a5843SAllen Hubbe module_param(max_mw_size, ulong, 0644); 77e26a5843SAllen Hubbe MODULE_PARM_DESC(max_mw_size, "Limit size of large memory windows"); 78fce8a7bbSJon Mason 799891417dSDave Jiang static unsigned int transport_mtu = 0x10000; 80fce8a7bbSJon Mason module_param(transport_mtu, uint, 0644); 81fce8a7bbSJon Mason MODULE_PARM_DESC(transport_mtu, "Maximum size of NTB transport packets"); 82fce8a7bbSJon Mason 83948d3a65SJon Mason static unsigned char max_num_clients; 84fce8a7bbSJon Mason module_param(max_num_clients, byte, 0644); 85fce8a7bbSJon Mason MODULE_PARM_DESC(max_num_clients, "Maximum number of NTB transport clients"); 86fce8a7bbSJon Mason 87282a2feeSJon Mason static unsigned int copy_bytes = 1024; 88282a2feeSJon Mason module_param(copy_bytes, uint, 0644); 89282a2feeSJon Mason MODULE_PARM_DESC(copy_bytes, "Threshold under which NTB will use the CPU to copy instead of DMA"); 90282a2feeSJon Mason 91a41ef053SDave Jiang static bool use_dma; 92a41ef053SDave Jiang module_param(use_dma, bool, 0644); 93a41ef053SDave Jiang MODULE_PARM_DESC(use_dma, "Use DMA engine to perform large data copy"); 94a41ef053SDave Jiang 95e26a5843SAllen Hubbe static struct dentry *nt_debugfs_dir; 96e26a5843SAllen Hubbe 97fce8a7bbSJon Mason struct ntb_queue_entry { 98fce8a7bbSJon Mason /* ntb_queue list reference */ 99fce8a7bbSJon Mason struct list_head entry; 100e26a5843SAllen Hubbe /* pointers to data to be transferred */ 101fce8a7bbSJon Mason void *cb_data; 102fce8a7bbSJon Mason void *buf; 103fce8a7bbSJon Mason unsigned int len; 104fce8a7bbSJon Mason unsigned int flags; 1059cabc269SDave Jiang int retries; 1069cabc269SDave Jiang int errors; 1079cabc269SDave Jiang unsigned int tx_index; 108*72203572SDave Jiang unsigned int rx_index; 109282a2feeSJon Mason 110282a2feeSJon Mason struct ntb_transport_qp *qp; 111282a2feeSJon Mason union { 112282a2feeSJon Mason struct ntb_payload_header __iomem *tx_hdr; 113282a2feeSJon Mason struct ntb_payload_header *rx_hdr; 114282a2feeSJon Mason }; 115fce8a7bbSJon Mason }; 116fce8a7bbSJon Mason 117793c20e9SJon Mason struct ntb_rx_info { 118793c20e9SJon Mason unsigned int entry; 119793c20e9SJon Mason }; 120793c20e9SJon Mason 121fce8a7bbSJon Mason struct ntb_transport_qp { 122e26a5843SAllen Hubbe struct ntb_transport_ctx *transport; 123e26a5843SAllen Hubbe struct ntb_dev *ndev; 124fce8a7bbSJon Mason void *cb_data; 125569410caSDave Jiang struct dma_chan *tx_dma_chan; 126569410caSDave Jiang struct dma_chan *rx_dma_chan; 127fce8a7bbSJon Mason 128fce8a7bbSJon Mason bool client_ready; 129e26a5843SAllen Hubbe bool link_is_up; 130e9021331SDave Jiang bool active; 131e26a5843SAllen Hubbe 132fce8a7bbSJon Mason u8 qp_num; /* Only 64 QP's are allowed. 0-63 */ 133e26a5843SAllen Hubbe u64 qp_bit; 134fce8a7bbSJon Mason 13574465645SJon Mason struct ntb_rx_info __iomem *rx_info; 136793c20e9SJon Mason struct ntb_rx_info *remote_rx_info; 137793c20e9SJon Mason 138fce8a7bbSJon Mason void (*tx_handler)(struct ntb_transport_qp *qp, void *qp_data, 139fce8a7bbSJon Mason void *data, int len); 140fce8a7bbSJon Mason struct list_head tx_free_q; 141fce8a7bbSJon Mason spinlock_t ntb_tx_free_q_lock; 14274465645SJon Mason void __iomem *tx_mw; 143282a2feeSJon Mason dma_addr_t tx_mw_phys; 144793c20e9SJon Mason unsigned int tx_index; 145793c20e9SJon Mason unsigned int tx_max_entry; 146ef114ed5SJon Mason unsigned int tx_max_frame; 147fce8a7bbSJon Mason 148fce8a7bbSJon Mason void (*rx_handler)(struct ntb_transport_qp *qp, void *qp_data, 149fce8a7bbSJon Mason void *data, int len); 150da2e5ae5SAllen Hubbe struct list_head rx_post_q; 151fce8a7bbSJon Mason struct list_head rx_pend_q; 152fce8a7bbSJon Mason struct list_head rx_free_q; 153da2e5ae5SAllen Hubbe /* ntb_rx_q_lock: synchronize access to rx_XXXX_q */ 154da2e5ae5SAllen Hubbe spinlock_t ntb_rx_q_lock; 155793c20e9SJon Mason void *rx_buff; 156793c20e9SJon Mason unsigned int rx_index; 157793c20e9SJon Mason unsigned int rx_max_entry; 158ef114ed5SJon Mason unsigned int rx_max_frame; 159a754a8fcSDave Jiang unsigned int rx_alloc_entry; 160282a2feeSJon Mason dma_cookie_t last_cookie; 161e26a5843SAllen Hubbe struct tasklet_struct rxc_db_work; 162fce8a7bbSJon Mason 163fce8a7bbSJon Mason void (*event_handler)(void *data, int status); 164fce8a7bbSJon Mason struct delayed_work link_work; 1657b4f2d3cSJon Mason struct work_struct link_cleanup; 166fce8a7bbSJon Mason 167fce8a7bbSJon Mason struct dentry *debugfs_dir; 168fce8a7bbSJon Mason struct dentry *debugfs_stats; 169fce8a7bbSJon Mason 170fce8a7bbSJon Mason /* Stats */ 171fce8a7bbSJon Mason u64 rx_bytes; 172fce8a7bbSJon Mason u64 rx_pkts; 173fce8a7bbSJon Mason u64 rx_ring_empty; 174fce8a7bbSJon Mason u64 rx_err_no_buf; 175fce8a7bbSJon Mason u64 rx_err_oflow; 176fce8a7bbSJon Mason u64 rx_err_ver; 177282a2feeSJon Mason u64 rx_memcpy; 178282a2feeSJon Mason u64 rx_async; 1798c874cc1SDave Jiang u64 dma_rx_prep_err; 180fce8a7bbSJon Mason u64 tx_bytes; 181fce8a7bbSJon Mason u64 tx_pkts; 182fce8a7bbSJon Mason u64 tx_ring_full; 183282a2feeSJon Mason u64 tx_err_no_buf; 184282a2feeSJon Mason u64 tx_memcpy; 185282a2feeSJon Mason u64 tx_async; 1868c874cc1SDave Jiang u64 dma_tx_prep_err; 187fce8a7bbSJon Mason }; 188fce8a7bbSJon Mason 189fce8a7bbSJon Mason struct ntb_transport_mw { 190e26a5843SAllen Hubbe phys_addr_t phys_addr; 191e26a5843SAllen Hubbe resource_size_t phys_size; 192e26a5843SAllen Hubbe resource_size_t xlat_align; 193e26a5843SAllen Hubbe resource_size_t xlat_align_size; 194e26a5843SAllen Hubbe void __iomem *vbase; 195e26a5843SAllen Hubbe size_t xlat_size; 196e26a5843SAllen Hubbe size_t buff_size; 197fce8a7bbSJon Mason void *virt_addr; 198fce8a7bbSJon Mason dma_addr_t dma_addr; 199fce8a7bbSJon Mason }; 200fce8a7bbSJon Mason 201fce8a7bbSJon Mason struct ntb_transport_client_dev { 202fce8a7bbSJon Mason struct list_head entry; 203e26a5843SAllen Hubbe struct ntb_transport_ctx *nt; 204fce8a7bbSJon Mason struct device dev; 205fce8a7bbSJon Mason }; 206fce8a7bbSJon Mason 207e26a5843SAllen Hubbe struct ntb_transport_ctx { 208fce8a7bbSJon Mason struct list_head entry; 209fce8a7bbSJon Mason struct list_head client_devs; 210fce8a7bbSJon Mason 211e26a5843SAllen Hubbe struct ntb_dev *ndev; 212e26a5843SAllen Hubbe 213e26a5843SAllen Hubbe struct ntb_transport_mw *mw_vec; 214e26a5843SAllen Hubbe struct ntb_transport_qp *qp_vec; 215e26a5843SAllen Hubbe unsigned int mw_count; 216e26a5843SAllen Hubbe unsigned int qp_count; 217e26a5843SAllen Hubbe u64 qp_bitmap; 218e26a5843SAllen Hubbe u64 qp_bitmap_free; 219e26a5843SAllen Hubbe 220e26a5843SAllen Hubbe bool link_is_up; 221fce8a7bbSJon Mason struct delayed_work link_work; 2227b4f2d3cSJon Mason struct work_struct link_cleanup; 223c8650fd0SDave Jiang 224c8650fd0SDave Jiang struct dentry *debugfs_node_dir; 225fce8a7bbSJon Mason }; 226fce8a7bbSJon Mason 227fce8a7bbSJon Mason enum { 228e26a5843SAllen Hubbe DESC_DONE_FLAG = BIT(0), 229e26a5843SAllen Hubbe LINK_DOWN_FLAG = BIT(1), 230fce8a7bbSJon Mason }; 231fce8a7bbSJon Mason 232fce8a7bbSJon Mason struct ntb_payload_header { 23374465645SJon Mason unsigned int ver; 234fce8a7bbSJon Mason unsigned int len; 235fce8a7bbSJon Mason unsigned int flags; 236fce8a7bbSJon Mason }; 237fce8a7bbSJon Mason 238fce8a7bbSJon Mason enum { 239fce8a7bbSJon Mason VERSION = 0, 240fce8a7bbSJon Mason QP_LINKS, 241113fc505SJon Mason NUM_QPS, 242113fc505SJon Mason NUM_MWS, 243113fc505SJon Mason MW0_SZ_HIGH, 244113fc505SJon Mason MW0_SZ_LOW, 245113fc505SJon Mason MW1_SZ_HIGH, 246113fc505SJon Mason MW1_SZ_LOW, 247fce8a7bbSJon Mason MAX_SPAD, 248fce8a7bbSJon Mason }; 249fce8a7bbSJon Mason 250e26a5843SAllen Hubbe #define dev_client_dev(__dev) \ 251e26a5843SAllen Hubbe container_of((__dev), struct ntb_transport_client_dev, dev) 252e26a5843SAllen Hubbe 253e26a5843SAllen Hubbe #define drv_client(__drv) \ 254e26a5843SAllen Hubbe container_of((__drv), struct ntb_transport_client, driver) 255e26a5843SAllen Hubbe 256e26a5843SAllen Hubbe #define QP_TO_MW(nt, qp) ((qp) % nt->mw_count) 257fce8a7bbSJon Mason #define NTB_QP_DEF_NUM_ENTRIES 100 258fce8a7bbSJon Mason #define NTB_LINK_DOWN_TIMEOUT 10 2598c874cc1SDave Jiang #define DMA_RETRIES 20 2608c874cc1SDave Jiang #define DMA_OUT_RESOURCE_TO 50 261fce8a7bbSJon Mason 262e26a5843SAllen Hubbe static void ntb_transport_rxc_db(unsigned long data); 263e26a5843SAllen Hubbe static const struct ntb_ctx_ops ntb_transport_ops; 264e26a5843SAllen Hubbe static struct ntb_client ntb_transport_client; 2659cabc269SDave Jiang static int ntb_async_tx_submit(struct ntb_transport_qp *qp, 2669cabc269SDave Jiang struct ntb_queue_entry *entry); 2679cabc269SDave Jiang static void ntb_memcpy_tx(struct ntb_queue_entry *entry, void __iomem *offset); 268*72203572SDave Jiang static int ntb_async_rx_submit(struct ntb_queue_entry *entry, void *offset); 269*72203572SDave Jiang static void ntb_memcpy_rx(struct ntb_queue_entry *entry, void *offset); 270*72203572SDave Jiang 271e26a5843SAllen Hubbe 272e26a5843SAllen Hubbe static int ntb_transport_bus_match(struct device *dev, 273e26a5843SAllen Hubbe struct device_driver *drv) 274fce8a7bbSJon Mason { 275fce8a7bbSJon Mason return !strncmp(dev_name(dev), drv->name, strlen(drv->name)); 276fce8a7bbSJon Mason } 277fce8a7bbSJon Mason 278e26a5843SAllen Hubbe static int ntb_transport_bus_probe(struct device *dev) 279fce8a7bbSJon Mason { 280e26a5843SAllen Hubbe const struct ntb_transport_client *client; 281fce8a7bbSJon Mason int rc = -EINVAL; 282fce8a7bbSJon Mason 283fce8a7bbSJon Mason get_device(dev); 284e26a5843SAllen Hubbe 285e26a5843SAllen Hubbe client = drv_client(dev->driver); 286e26a5843SAllen Hubbe rc = client->probe(dev); 287fce8a7bbSJon Mason if (rc) 288fce8a7bbSJon Mason put_device(dev); 289fce8a7bbSJon Mason 290fce8a7bbSJon Mason return rc; 291fce8a7bbSJon Mason } 292fce8a7bbSJon Mason 293e26a5843SAllen Hubbe static int ntb_transport_bus_remove(struct device *dev) 294fce8a7bbSJon Mason { 295e26a5843SAllen Hubbe const struct ntb_transport_client *client; 296fce8a7bbSJon Mason 297e26a5843SAllen Hubbe client = drv_client(dev->driver); 298e26a5843SAllen Hubbe client->remove(dev); 299fce8a7bbSJon Mason 300fce8a7bbSJon Mason put_device(dev); 301fce8a7bbSJon Mason 302fce8a7bbSJon Mason return 0; 303fce8a7bbSJon Mason } 304fce8a7bbSJon Mason 305e26a5843SAllen Hubbe static struct bus_type ntb_transport_bus = { 306e26a5843SAllen Hubbe .name = "ntb_transport", 307e26a5843SAllen Hubbe .match = ntb_transport_bus_match, 308e26a5843SAllen Hubbe .probe = ntb_transport_bus_probe, 309e26a5843SAllen Hubbe .remove = ntb_transport_bus_remove, 310fce8a7bbSJon Mason }; 311fce8a7bbSJon Mason 312fce8a7bbSJon Mason static LIST_HEAD(ntb_transport_list); 313fce8a7bbSJon Mason 314e26a5843SAllen Hubbe static int ntb_bus_init(struct ntb_transport_ctx *nt) 315fce8a7bbSJon Mason { 31631510000SDave Jiang list_add_tail(&nt->entry, &ntb_transport_list); 317fce8a7bbSJon Mason return 0; 318fce8a7bbSJon Mason } 319fce8a7bbSJon Mason 320e26a5843SAllen Hubbe static void ntb_bus_remove(struct ntb_transport_ctx *nt) 321fce8a7bbSJon Mason { 322fce8a7bbSJon Mason struct ntb_transport_client_dev *client_dev, *cd; 323fce8a7bbSJon Mason 324fce8a7bbSJon Mason list_for_each_entry_safe(client_dev, cd, &nt->client_devs, entry) { 325fce8a7bbSJon Mason dev_err(client_dev->dev.parent, "%s still attached to bus, removing\n", 326fce8a7bbSJon Mason dev_name(&client_dev->dev)); 327fce8a7bbSJon Mason list_del(&client_dev->entry); 328fce8a7bbSJon Mason device_unregister(&client_dev->dev); 329fce8a7bbSJon Mason } 330fce8a7bbSJon Mason 331fce8a7bbSJon Mason list_del(&nt->entry); 332fce8a7bbSJon Mason } 333fce8a7bbSJon Mason 334e26a5843SAllen Hubbe static void ntb_transport_client_release(struct device *dev) 335fce8a7bbSJon Mason { 336fce8a7bbSJon Mason struct ntb_transport_client_dev *client_dev; 337fce8a7bbSJon Mason 338e26a5843SAllen Hubbe client_dev = dev_client_dev(dev); 339fce8a7bbSJon Mason kfree(client_dev); 340fce8a7bbSJon Mason } 341fce8a7bbSJon Mason 342fce8a7bbSJon Mason /** 343e26a5843SAllen Hubbe * ntb_transport_unregister_client_dev - Unregister NTB client device 344fce8a7bbSJon Mason * @device_name: Name of NTB client device 345fce8a7bbSJon Mason * 346fce8a7bbSJon Mason * Unregister an NTB client device with the NTB transport layer 347fce8a7bbSJon Mason */ 348e26a5843SAllen Hubbe void ntb_transport_unregister_client_dev(char *device_name) 349fce8a7bbSJon Mason { 350fce8a7bbSJon Mason struct ntb_transport_client_dev *client, *cd; 351e26a5843SAllen Hubbe struct ntb_transport_ctx *nt; 352fce8a7bbSJon Mason 353fce8a7bbSJon Mason list_for_each_entry(nt, &ntb_transport_list, entry) 354fce8a7bbSJon Mason list_for_each_entry_safe(client, cd, &nt->client_devs, entry) 355fce8a7bbSJon Mason if (!strncmp(dev_name(&client->dev), device_name, 356fce8a7bbSJon Mason strlen(device_name))) { 357fce8a7bbSJon Mason list_del(&client->entry); 358fce8a7bbSJon Mason device_unregister(&client->dev); 359fce8a7bbSJon Mason } 360fce8a7bbSJon Mason } 361e26a5843SAllen Hubbe EXPORT_SYMBOL_GPL(ntb_transport_unregister_client_dev); 362fce8a7bbSJon Mason 363fce8a7bbSJon Mason /** 364e26a5843SAllen Hubbe * ntb_transport_register_client_dev - Register NTB client device 365fce8a7bbSJon Mason * @device_name: Name of NTB client device 366fce8a7bbSJon Mason * 367fce8a7bbSJon Mason * Register an NTB client device with the NTB transport layer 368fce8a7bbSJon Mason */ 369e26a5843SAllen Hubbe int ntb_transport_register_client_dev(char *device_name) 370fce8a7bbSJon Mason { 371fce8a7bbSJon Mason struct ntb_transport_client_dev *client_dev; 372e26a5843SAllen Hubbe struct ntb_transport_ctx *nt; 3731199aa61SAllen Hubbe int node; 3748b19d450SJon Mason int rc, i = 0; 375fce8a7bbSJon Mason 3768222b402SJon Mason if (list_empty(&ntb_transport_list)) 3778222b402SJon Mason return -ENODEV; 3788222b402SJon Mason 379fce8a7bbSJon Mason list_for_each_entry(nt, &ntb_transport_list, entry) { 380fce8a7bbSJon Mason struct device *dev; 381fce8a7bbSJon Mason 3821199aa61SAllen Hubbe node = dev_to_node(&nt->ndev->dev); 3831199aa61SAllen Hubbe 3841199aa61SAllen Hubbe client_dev = kzalloc_node(sizeof(*client_dev), 3851199aa61SAllen Hubbe GFP_KERNEL, node); 386fce8a7bbSJon Mason if (!client_dev) { 387fce8a7bbSJon Mason rc = -ENOMEM; 388fce8a7bbSJon Mason goto err; 389fce8a7bbSJon Mason } 390fce8a7bbSJon Mason 391fce8a7bbSJon Mason dev = &client_dev->dev; 392fce8a7bbSJon Mason 393fce8a7bbSJon Mason /* setup and register client devices */ 3948b19d450SJon Mason dev_set_name(dev, "%s%d", device_name, i); 395e26a5843SAllen Hubbe dev->bus = &ntb_transport_bus; 396e26a5843SAllen Hubbe dev->release = ntb_transport_client_release; 397e26a5843SAllen Hubbe dev->parent = &nt->ndev->dev; 398fce8a7bbSJon Mason 399fce8a7bbSJon Mason rc = device_register(dev); 400fce8a7bbSJon Mason if (rc) { 401fce8a7bbSJon Mason kfree(client_dev); 402fce8a7bbSJon Mason goto err; 403fce8a7bbSJon Mason } 404fce8a7bbSJon Mason 405fce8a7bbSJon Mason list_add_tail(&client_dev->entry, &nt->client_devs); 4068b19d450SJon Mason i++; 407fce8a7bbSJon Mason } 408fce8a7bbSJon Mason 409fce8a7bbSJon Mason return 0; 410fce8a7bbSJon Mason 411fce8a7bbSJon Mason err: 412e26a5843SAllen Hubbe ntb_transport_unregister_client_dev(device_name); 413fce8a7bbSJon Mason 414fce8a7bbSJon Mason return rc; 415fce8a7bbSJon Mason } 416e26a5843SAllen Hubbe EXPORT_SYMBOL_GPL(ntb_transport_register_client_dev); 417fce8a7bbSJon Mason 418fce8a7bbSJon Mason /** 419ec110bc7SAllen Hubbe * ntb_transport_register_client - Register NTB client driver 420fce8a7bbSJon Mason * @drv: NTB client driver to be registered 421fce8a7bbSJon Mason * 422fce8a7bbSJon Mason * Register an NTB client driver with the NTB transport layer 423fce8a7bbSJon Mason * 424fce8a7bbSJon Mason * RETURNS: An appropriate -ERRNO error value on error, or zero for success. 425fce8a7bbSJon Mason */ 426e26a5843SAllen Hubbe int ntb_transport_register_client(struct ntb_transport_client *drv) 427fce8a7bbSJon Mason { 428e26a5843SAllen Hubbe drv->driver.bus = &ntb_transport_bus; 429fce8a7bbSJon Mason 4308222b402SJon Mason if (list_empty(&ntb_transport_list)) 4318222b402SJon Mason return -ENODEV; 4328222b402SJon Mason 433fce8a7bbSJon Mason return driver_register(&drv->driver); 434fce8a7bbSJon Mason } 435ec110bc7SAllen Hubbe EXPORT_SYMBOL_GPL(ntb_transport_register_client); 436fce8a7bbSJon Mason 437fce8a7bbSJon Mason /** 438ec110bc7SAllen Hubbe * ntb_transport_unregister_client - Unregister NTB client driver 439fce8a7bbSJon Mason * @drv: NTB client driver to be unregistered 440fce8a7bbSJon Mason * 441fce8a7bbSJon Mason * Unregister an NTB client driver with the NTB transport layer 442fce8a7bbSJon Mason * 443fce8a7bbSJon Mason * RETURNS: An appropriate -ERRNO error value on error, or zero for success. 444fce8a7bbSJon Mason */ 445e26a5843SAllen Hubbe void ntb_transport_unregister_client(struct ntb_transport_client *drv) 446fce8a7bbSJon Mason { 447fce8a7bbSJon Mason driver_unregister(&drv->driver); 448fce8a7bbSJon Mason } 449ec110bc7SAllen Hubbe EXPORT_SYMBOL_GPL(ntb_transport_unregister_client); 450fce8a7bbSJon Mason 451fce8a7bbSJon Mason static ssize_t debugfs_read(struct file *filp, char __user *ubuf, size_t count, 452fce8a7bbSJon Mason loff_t *offp) 453fce8a7bbSJon Mason { 454fce8a7bbSJon Mason struct ntb_transport_qp *qp; 455d7237e22SJon Mason char *buf; 456fce8a7bbSJon Mason ssize_t ret, out_offset, out_count; 457fce8a7bbSJon Mason 458260bee94SDave Jiang qp = filp->private_data; 459260bee94SDave Jiang 460260bee94SDave Jiang if (!qp || !qp->link_is_up) 461260bee94SDave Jiang return 0; 462260bee94SDave Jiang 463282a2feeSJon Mason out_count = 1000; 464d7237e22SJon Mason 465d7237e22SJon Mason buf = kmalloc(out_count, GFP_KERNEL); 466d7237e22SJon Mason if (!buf) 467d7237e22SJon Mason return -ENOMEM; 468fce8a7bbSJon Mason 469fce8a7bbSJon Mason out_offset = 0; 470fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 471d98ef99eSDave Jiang "\nNTB QP stats:\n\n"); 472fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 473fce8a7bbSJon Mason "rx_bytes - \t%llu\n", qp->rx_bytes); 474fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 475fce8a7bbSJon Mason "rx_pkts - \t%llu\n", qp->rx_pkts); 476fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 477282a2feeSJon Mason "rx_memcpy - \t%llu\n", qp->rx_memcpy); 478282a2feeSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 479282a2feeSJon Mason "rx_async - \t%llu\n", qp->rx_async); 480282a2feeSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 481fce8a7bbSJon Mason "rx_ring_empty - %llu\n", qp->rx_ring_empty); 482fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 483fce8a7bbSJon Mason "rx_err_no_buf - %llu\n", qp->rx_err_no_buf); 484fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 485fce8a7bbSJon Mason "rx_err_oflow - \t%llu\n", qp->rx_err_oflow); 486fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 487fce8a7bbSJon Mason "rx_err_ver - \t%llu\n", qp->rx_err_ver); 488fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 489d98ef99eSDave Jiang "rx_buff - \t0x%p\n", qp->rx_buff); 490fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 491793c20e9SJon Mason "rx_index - \t%u\n", qp->rx_index); 492fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 493a754a8fcSDave Jiang "rx_max_entry - \t%u\n", qp->rx_max_entry); 494a754a8fcSDave Jiang out_offset += snprintf(buf + out_offset, out_count - out_offset, 495a754a8fcSDave Jiang "rx_alloc_entry - \t%u\n\n", qp->rx_alloc_entry); 496fce8a7bbSJon Mason 497fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 498fce8a7bbSJon Mason "tx_bytes - \t%llu\n", qp->tx_bytes); 499fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 500fce8a7bbSJon Mason "tx_pkts - \t%llu\n", qp->tx_pkts); 501fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 502282a2feeSJon Mason "tx_memcpy - \t%llu\n", qp->tx_memcpy); 503282a2feeSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 504282a2feeSJon Mason "tx_async - \t%llu\n", qp->tx_async); 505282a2feeSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 506fce8a7bbSJon Mason "tx_ring_full - \t%llu\n", qp->tx_ring_full); 507fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 508282a2feeSJon Mason "tx_err_no_buf - %llu\n", qp->tx_err_no_buf); 509282a2feeSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 510d98ef99eSDave Jiang "tx_mw - \t0x%p\n", qp->tx_mw); 511fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 512d98ef99eSDave Jiang "tx_index (H) - \t%u\n", qp->tx_index); 513d98ef99eSDave Jiang out_offset += snprintf(buf + out_offset, out_count - out_offset, 514d98ef99eSDave Jiang "RRI (T) - \t%u\n", 515d98ef99eSDave Jiang qp->remote_rx_info->entry); 516fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 517793c20e9SJon Mason "tx_max_entry - \t%u\n", qp->tx_max_entry); 518e74bfeedSDave Jiang out_offset += snprintf(buf + out_offset, out_count - out_offset, 519e74bfeedSDave Jiang "free tx - \t%u\n", 520e74bfeedSDave Jiang ntb_transport_tx_free_entry(qp)); 5218c874cc1SDave Jiang out_offset += snprintf(buf + out_offset, out_count - out_offset, 5228c874cc1SDave Jiang "DMA tx prep err - \t%llu\n", 5238c874cc1SDave Jiang qp->dma_tx_prep_err); 5248c874cc1SDave Jiang out_offset += snprintf(buf + out_offset, out_count - out_offset, 5258c874cc1SDave Jiang "DMA rx prep err - \t%llu\n", 5268c874cc1SDave Jiang qp->dma_rx_prep_err); 527fce8a7bbSJon Mason 528fce8a7bbSJon Mason out_offset += snprintf(buf + out_offset, out_count - out_offset, 529d98ef99eSDave Jiang "\n"); 530d98ef99eSDave Jiang out_offset += snprintf(buf + out_offset, out_count - out_offset, 531569410caSDave Jiang "Using TX DMA - \t%s\n", 532569410caSDave Jiang qp->tx_dma_chan ? "Yes" : "No"); 533569410caSDave Jiang out_offset += snprintf(buf + out_offset, out_count - out_offset, 534569410caSDave Jiang "Using RX DMA - \t%s\n", 535569410caSDave Jiang qp->rx_dma_chan ? "Yes" : "No"); 536d98ef99eSDave Jiang out_offset += snprintf(buf + out_offset, out_count - out_offset, 537d98ef99eSDave Jiang "QP Link - \t%s\n", 538e26a5843SAllen Hubbe qp->link_is_up ? "Up" : "Down"); 539d98ef99eSDave Jiang out_offset += snprintf(buf + out_offset, out_count - out_offset, 540d98ef99eSDave Jiang "\n"); 541d98ef99eSDave Jiang 542d7237e22SJon Mason if (out_offset > out_count) 543d7237e22SJon Mason out_offset = out_count; 544fce8a7bbSJon Mason 545fce8a7bbSJon Mason ret = simple_read_from_buffer(ubuf, count, offp, buf, out_offset); 546d7237e22SJon Mason kfree(buf); 547fce8a7bbSJon Mason return ret; 548fce8a7bbSJon Mason } 549fce8a7bbSJon Mason 550fce8a7bbSJon Mason static const struct file_operations ntb_qp_debugfs_stats = { 551fce8a7bbSJon Mason .owner = THIS_MODULE, 552d66d7ac2SJon Mason .open = simple_open, 553fce8a7bbSJon Mason .read = debugfs_read, 554fce8a7bbSJon Mason }; 555fce8a7bbSJon Mason 556fce8a7bbSJon Mason static void ntb_list_add(spinlock_t *lock, struct list_head *entry, 557fce8a7bbSJon Mason struct list_head *list) 558fce8a7bbSJon Mason { 559fce8a7bbSJon Mason unsigned long flags; 560fce8a7bbSJon Mason 561fce8a7bbSJon Mason spin_lock_irqsave(lock, flags); 562fce8a7bbSJon Mason list_add_tail(entry, list); 563fce8a7bbSJon Mason spin_unlock_irqrestore(lock, flags); 564fce8a7bbSJon Mason } 565fce8a7bbSJon Mason 566fce8a7bbSJon Mason static struct ntb_queue_entry *ntb_list_rm(spinlock_t *lock, 567fce8a7bbSJon Mason struct list_head *list) 568fce8a7bbSJon Mason { 569fce8a7bbSJon Mason struct ntb_queue_entry *entry; 570fce8a7bbSJon Mason unsigned long flags; 571fce8a7bbSJon Mason 572fce8a7bbSJon Mason spin_lock_irqsave(lock, flags); 573fce8a7bbSJon Mason if (list_empty(list)) { 574fce8a7bbSJon Mason entry = NULL; 575fce8a7bbSJon Mason goto out; 576fce8a7bbSJon Mason } 577fce8a7bbSJon Mason entry = list_first_entry(list, struct ntb_queue_entry, entry); 578fce8a7bbSJon Mason list_del(&entry->entry); 579e74bfeedSDave Jiang 580fce8a7bbSJon Mason out: 581fce8a7bbSJon Mason spin_unlock_irqrestore(lock, flags); 582fce8a7bbSJon Mason 583fce8a7bbSJon Mason return entry; 584fce8a7bbSJon Mason } 585fce8a7bbSJon Mason 586da2e5ae5SAllen Hubbe static struct ntb_queue_entry *ntb_list_mv(spinlock_t *lock, 587da2e5ae5SAllen Hubbe struct list_head *list, 588da2e5ae5SAllen Hubbe struct list_head *to_list) 589da2e5ae5SAllen Hubbe { 590da2e5ae5SAllen Hubbe struct ntb_queue_entry *entry; 591da2e5ae5SAllen Hubbe unsigned long flags; 592da2e5ae5SAllen Hubbe 593da2e5ae5SAllen Hubbe spin_lock_irqsave(lock, flags); 594da2e5ae5SAllen Hubbe 595da2e5ae5SAllen Hubbe if (list_empty(list)) { 596da2e5ae5SAllen Hubbe entry = NULL; 597da2e5ae5SAllen Hubbe } else { 598da2e5ae5SAllen Hubbe entry = list_first_entry(list, struct ntb_queue_entry, entry); 599da2e5ae5SAllen Hubbe list_move_tail(&entry->entry, to_list); 600da2e5ae5SAllen Hubbe } 601da2e5ae5SAllen Hubbe 602da2e5ae5SAllen Hubbe spin_unlock_irqrestore(lock, flags); 603da2e5ae5SAllen Hubbe 604da2e5ae5SAllen Hubbe return entry; 605da2e5ae5SAllen Hubbe } 606da2e5ae5SAllen Hubbe 607e26a5843SAllen Hubbe static int ntb_transport_setup_qp_mw(struct ntb_transport_ctx *nt, 608fce8a7bbSJon Mason unsigned int qp_num) 609fce8a7bbSJon Mason { 610e26a5843SAllen Hubbe struct ntb_transport_qp *qp = &nt->qp_vec[qp_num]; 611e26a5843SAllen Hubbe struct ntb_transport_mw *mw; 612a754a8fcSDave Jiang struct ntb_dev *ndev = nt->ndev; 613a754a8fcSDave Jiang struct ntb_queue_entry *entry; 614ef114ed5SJon Mason unsigned int rx_size, num_qps_mw; 615e26a5843SAllen Hubbe unsigned int mw_num, mw_count, qp_count; 616793c20e9SJon Mason unsigned int i; 617a754a8fcSDave Jiang int node; 618fce8a7bbSJon Mason 619e26a5843SAllen Hubbe mw_count = nt->mw_count; 620e26a5843SAllen Hubbe qp_count = nt->qp_count; 621948d3a65SJon Mason 622e26a5843SAllen Hubbe mw_num = QP_TO_MW(nt, qp_num); 623e26a5843SAllen Hubbe mw = &nt->mw_vec[mw_num]; 624fce8a7bbSJon Mason 625e26a5843SAllen Hubbe if (!mw->virt_addr) 626e26a5843SAllen Hubbe return -ENOMEM; 627e26a5843SAllen Hubbe 628e26a5843SAllen Hubbe if (qp_count % mw_count && mw_num + 1 < qp_count / mw_count) 629e26a5843SAllen Hubbe num_qps_mw = qp_count / mw_count + 1; 630fce8a7bbSJon Mason else 631e26a5843SAllen Hubbe num_qps_mw = qp_count / mw_count; 632fce8a7bbSJon Mason 633e26a5843SAllen Hubbe rx_size = (unsigned int)mw->xlat_size / num_qps_mw; 634c92ba3c5SJon Mason qp->rx_buff = mw->virt_addr + rx_size * (qp_num / mw_count); 635793c20e9SJon Mason rx_size -= sizeof(struct ntb_rx_info); 636793c20e9SJon Mason 637282a2feeSJon Mason qp->remote_rx_info = qp->rx_buff + rx_size; 638282a2feeSJon Mason 639c9d534c8SJon Mason /* Due to housekeeping, there must be atleast 2 buffs */ 640c9d534c8SJon Mason qp->rx_max_frame = min(transport_mtu, rx_size / 2); 641793c20e9SJon Mason qp->rx_max_entry = rx_size / qp->rx_max_frame; 642793c20e9SJon Mason qp->rx_index = 0; 643793c20e9SJon Mason 644a754a8fcSDave Jiang /* 645a754a8fcSDave Jiang * Checking to see if we have more entries than the default. 646a754a8fcSDave Jiang * We should add additional entries if that is the case so we 647a754a8fcSDave Jiang * can be in sync with the transport frames. 648a754a8fcSDave Jiang */ 649a754a8fcSDave Jiang node = dev_to_node(&ndev->dev); 650a754a8fcSDave Jiang for (i = qp->rx_alloc_entry; i < qp->rx_max_entry; i++) { 651a754a8fcSDave Jiang entry = kzalloc_node(sizeof(*entry), GFP_ATOMIC, node); 652a754a8fcSDave Jiang if (!entry) 653a754a8fcSDave Jiang return -ENOMEM; 654a754a8fcSDave Jiang 655a754a8fcSDave Jiang entry->qp = qp; 656a754a8fcSDave Jiang ntb_list_add(&qp->ntb_rx_q_lock, &entry->entry, 657a754a8fcSDave Jiang &qp->rx_free_q); 658a754a8fcSDave Jiang qp->rx_alloc_entry++; 659a754a8fcSDave Jiang } 660a754a8fcSDave Jiang 661c9d534c8SJon Mason qp->remote_rx_info->entry = qp->rx_max_entry - 1; 662fce8a7bbSJon Mason 663ef114ed5SJon Mason /* setup the hdr offsets with 0's */ 664793c20e9SJon Mason for (i = 0; i < qp->rx_max_entry; i++) { 665e26a5843SAllen Hubbe void *offset = (qp->rx_buff + qp->rx_max_frame * (i + 1) - 666e26a5843SAllen Hubbe sizeof(struct ntb_payload_header)); 667ef114ed5SJon Mason memset(offset, 0, sizeof(struct ntb_payload_header)); 668793c20e9SJon Mason } 669fce8a7bbSJon Mason 670fce8a7bbSJon Mason qp->rx_pkts = 0; 671fce8a7bbSJon Mason qp->tx_pkts = 0; 67290f9e934SJon Mason qp->tx_index = 0; 673e26a5843SAllen Hubbe 674e26a5843SAllen Hubbe return 0; 675fce8a7bbSJon Mason } 676fce8a7bbSJon Mason 677e26a5843SAllen Hubbe static void ntb_free_mw(struct ntb_transport_ctx *nt, int num_mw) 678113fc505SJon Mason { 679e26a5843SAllen Hubbe struct ntb_transport_mw *mw = &nt->mw_vec[num_mw]; 680e26a5843SAllen Hubbe struct pci_dev *pdev = nt->ndev->pdev; 681113fc505SJon Mason 682113fc505SJon Mason if (!mw->virt_addr) 683113fc505SJon Mason return; 684113fc505SJon Mason 685e26a5843SAllen Hubbe ntb_mw_clear_trans(nt->ndev, num_mw); 686e26a5843SAllen Hubbe dma_free_coherent(&pdev->dev, mw->buff_size, 687e26a5843SAllen Hubbe mw->virt_addr, mw->dma_addr); 688e26a5843SAllen Hubbe mw->xlat_size = 0; 689e26a5843SAllen Hubbe mw->buff_size = 0; 690113fc505SJon Mason mw->virt_addr = NULL; 691113fc505SJon Mason } 692113fc505SJon Mason 693e26a5843SAllen Hubbe static int ntb_set_mw(struct ntb_transport_ctx *nt, int num_mw, 6948c9edf63SAllen Hubbe resource_size_t size) 695b77b2637SJon Mason { 696e26a5843SAllen Hubbe struct ntb_transport_mw *mw = &nt->mw_vec[num_mw]; 697e26a5843SAllen Hubbe struct pci_dev *pdev = nt->ndev->pdev; 6988c9edf63SAllen Hubbe size_t xlat_size, buff_size; 699e26a5843SAllen Hubbe int rc; 700e26a5843SAllen Hubbe 7018c9edf63SAllen Hubbe if (!size) 7028c9edf63SAllen Hubbe return -EINVAL; 7038c9edf63SAllen Hubbe 704e26a5843SAllen Hubbe xlat_size = round_up(size, mw->xlat_align_size); 705e26a5843SAllen Hubbe buff_size = round_up(size, mw->xlat_align); 706b77b2637SJon Mason 707b77b2637SJon Mason /* No need to re-setup */ 708e26a5843SAllen Hubbe if (mw->xlat_size == xlat_size) 709b77b2637SJon Mason return 0; 710b77b2637SJon Mason 711e26a5843SAllen Hubbe if (mw->buff_size) 712b77b2637SJon Mason ntb_free_mw(nt, num_mw); 713b77b2637SJon Mason 714e26a5843SAllen Hubbe /* Alloc memory for receiving data. Must be aligned */ 715e26a5843SAllen Hubbe mw->xlat_size = xlat_size; 716e26a5843SAllen Hubbe mw->buff_size = buff_size; 717b77b2637SJon Mason 718e26a5843SAllen Hubbe mw->virt_addr = dma_alloc_coherent(&pdev->dev, buff_size, 719e26a5843SAllen Hubbe &mw->dma_addr, GFP_KERNEL); 720b77b2637SJon Mason if (!mw->virt_addr) { 721e26a5843SAllen Hubbe mw->xlat_size = 0; 722e26a5843SAllen Hubbe mw->buff_size = 0; 7238c9edf63SAllen Hubbe dev_err(&pdev->dev, "Unable to alloc MW buff of size %zu\n", 724e26a5843SAllen Hubbe buff_size); 725b77b2637SJon Mason return -ENOMEM; 726b77b2637SJon Mason } 727b77b2637SJon Mason 7283cc5ba19SDave Jiang /* 7293cc5ba19SDave Jiang * we must ensure that the memory address allocated is BAR size 7303cc5ba19SDave Jiang * aligned in order for the XLAT register to take the value. This 7313cc5ba19SDave Jiang * is a requirement of the hardware. It is recommended to setup CMA 7323cc5ba19SDave Jiang * for BAR sizes equal or greater than 4MB. 7333cc5ba19SDave Jiang */ 734e26a5843SAllen Hubbe if (!IS_ALIGNED(mw->dma_addr, mw->xlat_align)) { 735e26a5843SAllen Hubbe dev_err(&pdev->dev, "DMA memory %pad is not aligned\n", 7363cc5ba19SDave Jiang &mw->dma_addr); 7373cc5ba19SDave Jiang ntb_free_mw(nt, num_mw); 7383cc5ba19SDave Jiang return -ENOMEM; 7393cc5ba19SDave Jiang } 7403cc5ba19SDave Jiang 741b77b2637SJon Mason /* Notify HW the memory location of the receive buffer */ 742e26a5843SAllen Hubbe rc = ntb_mw_set_trans(nt->ndev, num_mw, mw->dma_addr, mw->xlat_size); 743e26a5843SAllen Hubbe if (rc) { 744e26a5843SAllen Hubbe dev_err(&pdev->dev, "Unable to set mw%d translation", num_mw); 745e26a5843SAllen Hubbe ntb_free_mw(nt, num_mw); 746e26a5843SAllen Hubbe return -EIO; 747e26a5843SAllen Hubbe } 748b77b2637SJon Mason 749b77b2637SJon Mason return 0; 750b77b2637SJon Mason } 751b77b2637SJon Mason 7522849b5d7SAllen Hubbe static void ntb_qp_link_down_reset(struct ntb_transport_qp *qp) 7532849b5d7SAllen Hubbe { 7542849b5d7SAllen Hubbe qp->link_is_up = false; 755e9021331SDave Jiang qp->active = false; 7562849b5d7SAllen Hubbe 7572849b5d7SAllen Hubbe qp->tx_index = 0; 7582849b5d7SAllen Hubbe qp->rx_index = 0; 7592849b5d7SAllen Hubbe qp->rx_bytes = 0; 7602849b5d7SAllen Hubbe qp->rx_pkts = 0; 7612849b5d7SAllen Hubbe qp->rx_ring_empty = 0; 7622849b5d7SAllen Hubbe qp->rx_err_no_buf = 0; 7632849b5d7SAllen Hubbe qp->rx_err_oflow = 0; 7642849b5d7SAllen Hubbe qp->rx_err_ver = 0; 7652849b5d7SAllen Hubbe qp->rx_memcpy = 0; 7662849b5d7SAllen Hubbe qp->rx_async = 0; 7672849b5d7SAllen Hubbe qp->tx_bytes = 0; 7682849b5d7SAllen Hubbe qp->tx_pkts = 0; 7692849b5d7SAllen Hubbe qp->tx_ring_full = 0; 7702849b5d7SAllen Hubbe qp->tx_err_no_buf = 0; 7712849b5d7SAllen Hubbe qp->tx_memcpy = 0; 7722849b5d7SAllen Hubbe qp->tx_async = 0; 7738c874cc1SDave Jiang qp->dma_tx_prep_err = 0; 7748c874cc1SDave Jiang qp->dma_rx_prep_err = 0; 7752849b5d7SAllen Hubbe } 7762849b5d7SAllen Hubbe 777fca4d518SJon Mason static void ntb_qp_link_cleanup(struct ntb_transport_qp *qp) 778fce8a7bbSJon Mason { 779e26a5843SAllen Hubbe struct ntb_transport_ctx *nt = qp->transport; 780e26a5843SAllen Hubbe struct pci_dev *pdev = nt->ndev->pdev; 781fce8a7bbSJon Mason 782e22e0b9dSAllen Hubbe dev_info(&pdev->dev, "qp %d: Link Cleanup\n", qp->qp_num); 7832849b5d7SAllen Hubbe 7842849b5d7SAllen Hubbe cancel_delayed_work_sync(&qp->link_work); 7852849b5d7SAllen Hubbe ntb_qp_link_down_reset(qp); 786e26a5843SAllen Hubbe 787e26a5843SAllen Hubbe if (qp->event_handler) 788e26a5843SAllen Hubbe qp->event_handler(qp->cb_data, qp->link_is_up); 789fca4d518SJon Mason } 790fca4d518SJon Mason 791fca4d518SJon Mason static void ntb_qp_link_cleanup_work(struct work_struct *work) 792fca4d518SJon Mason { 793fca4d518SJon Mason struct ntb_transport_qp *qp = container_of(work, 794fca4d518SJon Mason struct ntb_transport_qp, 795fca4d518SJon Mason link_cleanup); 796e26a5843SAllen Hubbe struct ntb_transport_ctx *nt = qp->transport; 797fca4d518SJon Mason 798fca4d518SJon Mason ntb_qp_link_cleanup(qp); 799fce8a7bbSJon Mason 800e26a5843SAllen Hubbe if (nt->link_is_up) 801fce8a7bbSJon Mason schedule_delayed_work(&qp->link_work, 802fce8a7bbSJon Mason msecs_to_jiffies(NTB_LINK_DOWN_TIMEOUT)); 803fce8a7bbSJon Mason } 804fce8a7bbSJon Mason 8057b4f2d3cSJon Mason static void ntb_qp_link_down(struct ntb_transport_qp *qp) 806fce8a7bbSJon Mason { 8077b4f2d3cSJon Mason schedule_work(&qp->link_cleanup); 8087b4f2d3cSJon Mason } 8097b4f2d3cSJon Mason 810e26a5843SAllen Hubbe static void ntb_transport_link_cleanup(struct ntb_transport_ctx *nt) 8117b4f2d3cSJon Mason { 812e26a5843SAllen Hubbe struct ntb_transport_qp *qp; 813e26a5843SAllen Hubbe u64 qp_bitmap_alloc; 814fce8a7bbSJon Mason int i; 815fce8a7bbSJon Mason 816e26a5843SAllen Hubbe qp_bitmap_alloc = nt->qp_bitmap & ~nt->qp_bitmap_free; 817fca4d518SJon Mason 818e26a5843SAllen Hubbe /* Pass along the info to any clients */ 819e26a5843SAllen Hubbe for (i = 0; i < nt->qp_count; i++) 820e26a5843SAllen Hubbe if (qp_bitmap_alloc & BIT_ULL(i)) { 821e26a5843SAllen Hubbe qp = &nt->qp_vec[i]; 822e26a5843SAllen Hubbe ntb_qp_link_cleanup(qp); 823e26a5843SAllen Hubbe cancel_work_sync(&qp->link_cleanup); 824e26a5843SAllen Hubbe cancel_delayed_work_sync(&qp->link_work); 825e26a5843SAllen Hubbe } 826e26a5843SAllen Hubbe 827e26a5843SAllen Hubbe if (!nt->link_is_up) 828fce8a7bbSJon Mason cancel_delayed_work_sync(&nt->link_work); 829fce8a7bbSJon Mason 830fce8a7bbSJon Mason /* The scratchpad registers keep the values if the remote side 831fce8a7bbSJon Mason * goes down, blast them now to give them a sane value the next 832fce8a7bbSJon Mason * time they are accessed 833fce8a7bbSJon Mason */ 834fce8a7bbSJon Mason for (i = 0; i < MAX_SPAD; i++) 835e26a5843SAllen Hubbe ntb_spad_write(nt->ndev, i, 0); 836fce8a7bbSJon Mason } 837fce8a7bbSJon Mason 838fca4d518SJon Mason static void ntb_transport_link_cleanup_work(struct work_struct *work) 839fca4d518SJon Mason { 840e26a5843SAllen Hubbe struct ntb_transport_ctx *nt = 841e26a5843SAllen Hubbe container_of(work, struct ntb_transport_ctx, link_cleanup); 842fca4d518SJon Mason 843fca4d518SJon Mason ntb_transport_link_cleanup(nt); 844fca4d518SJon Mason } 845fca4d518SJon Mason 846e26a5843SAllen Hubbe static void ntb_transport_event_callback(void *data) 847fce8a7bbSJon Mason { 848e26a5843SAllen Hubbe struct ntb_transport_ctx *nt = data; 849fce8a7bbSJon Mason 850e26a5843SAllen Hubbe if (ntb_link_is_up(nt->ndev, NULL, NULL) == 1) 851fce8a7bbSJon Mason schedule_delayed_work(&nt->link_work, 0); 852e26a5843SAllen Hubbe else 8537b4f2d3cSJon Mason schedule_work(&nt->link_cleanup); 854fce8a7bbSJon Mason } 855fce8a7bbSJon Mason 856fce8a7bbSJon Mason static void ntb_transport_link_work(struct work_struct *work) 857fce8a7bbSJon Mason { 858e26a5843SAllen Hubbe struct ntb_transport_ctx *nt = 859e26a5843SAllen Hubbe container_of(work, struct ntb_transport_ctx, link_work.work); 860e26a5843SAllen Hubbe struct ntb_dev *ndev = nt->ndev; 861e26a5843SAllen Hubbe struct pci_dev *pdev = ndev->pdev; 862e26a5843SAllen Hubbe resource_size_t size; 863fce8a7bbSJon Mason u32 val; 86484f76685SDave Jiang int rc = 0, i, spad; 865fce8a7bbSJon Mason 866113fc505SJon Mason /* send the local info, in the opposite order of the way we read it */ 867e26a5843SAllen Hubbe for (i = 0; i < nt->mw_count; i++) { 868e26a5843SAllen Hubbe size = nt->mw_vec[i].phys_size; 869e26a5843SAllen Hubbe 870e26a5843SAllen Hubbe if (max_mw_size && size > max_mw_size) 871e26a5843SAllen Hubbe size = max_mw_size; 872e26a5843SAllen Hubbe 873e26a5843SAllen Hubbe spad = MW0_SZ_HIGH + (i * 2); 874fdcb4b2eSArnd Bergmann ntb_peer_spad_write(ndev, spad, upper_32_bits(size)); 875e26a5843SAllen Hubbe 876e26a5843SAllen Hubbe spad = MW0_SZ_LOW + (i * 2); 877fdcb4b2eSArnd Bergmann ntb_peer_spad_write(ndev, spad, lower_32_bits(size)); 878fce8a7bbSJon Mason } 879fce8a7bbSJon Mason 880e26a5843SAllen Hubbe ntb_peer_spad_write(ndev, NUM_MWS, nt->mw_count); 881fce8a7bbSJon Mason 882e26a5843SAllen Hubbe ntb_peer_spad_write(ndev, NUM_QPS, nt->qp_count); 883fce8a7bbSJon Mason 884e26a5843SAllen Hubbe ntb_peer_spad_write(ndev, VERSION, NTB_TRANSPORT_VERSION); 885fce8a7bbSJon Mason 886fce8a7bbSJon Mason /* Query the remote side for its info */ 8870f69a7dfSDave Jiang val = ntb_spad_read(ndev, VERSION); 888e26a5843SAllen Hubbe dev_dbg(&pdev->dev, "Remote version = %d\n", val); 889fce8a7bbSJon Mason if (val != NTB_TRANSPORT_VERSION) 890fce8a7bbSJon Mason goto out; 891fce8a7bbSJon Mason 8920f69a7dfSDave Jiang val = ntb_spad_read(ndev, NUM_QPS); 893fce8a7bbSJon Mason dev_dbg(&pdev->dev, "Remote max number of qps = %d\n", val); 894e26a5843SAllen Hubbe if (val != nt->qp_count) 895fce8a7bbSJon Mason goto out; 896fce8a7bbSJon Mason 8970f69a7dfSDave Jiang val = ntb_spad_read(ndev, NUM_MWS); 898113fc505SJon Mason dev_dbg(&pdev->dev, "Remote number of mws = %d\n", val); 899e26a5843SAllen Hubbe if (val != nt->mw_count) 900e26a5843SAllen Hubbe goto out; 901fce8a7bbSJon Mason 902e26a5843SAllen Hubbe for (i = 0; i < nt->mw_count; i++) { 903113fc505SJon Mason u64 val64; 904fce8a7bbSJon Mason 9050f69a7dfSDave Jiang val = ntb_spad_read(ndev, MW0_SZ_HIGH + (i * 2)); 906113fc505SJon Mason val64 = (u64)val << 32; 907fce8a7bbSJon Mason 9080f69a7dfSDave Jiang val = ntb_spad_read(ndev, MW0_SZ_LOW + (i * 2)); 909113fc505SJon Mason val64 |= val; 910113fc505SJon Mason 911e26a5843SAllen Hubbe dev_dbg(&pdev->dev, "Remote MW%d size = %#llx\n", i, val64); 912113fc505SJon Mason 913113fc505SJon Mason rc = ntb_set_mw(nt, i, val64); 914fce8a7bbSJon Mason if (rc) 915113fc505SJon Mason goto out1; 916113fc505SJon Mason } 917fce8a7bbSJon Mason 918e26a5843SAllen Hubbe nt->link_is_up = true; 919fce8a7bbSJon Mason 920e26a5843SAllen Hubbe for (i = 0; i < nt->qp_count; i++) { 921e26a5843SAllen Hubbe struct ntb_transport_qp *qp = &nt->qp_vec[i]; 922fce8a7bbSJon Mason 923fce8a7bbSJon Mason ntb_transport_setup_qp_mw(nt, i); 924fce8a7bbSJon Mason 925e26a5843SAllen Hubbe if (qp->client_ready) 926fce8a7bbSJon Mason schedule_delayed_work(&qp->link_work, 0); 927fce8a7bbSJon Mason } 928fce8a7bbSJon Mason 929fce8a7bbSJon Mason return; 930fce8a7bbSJon Mason 931113fc505SJon Mason out1: 932e26a5843SAllen Hubbe for (i = 0; i < nt->mw_count; i++) 933113fc505SJon Mason ntb_free_mw(nt, i); 93484f76685SDave Jiang 93584f76685SDave Jiang /* if there's an actual failure, we should just bail */ 93684f76685SDave Jiang if (rc < 0) { 93784f76685SDave Jiang ntb_link_disable(ndev); 93884f76685SDave Jiang return; 93984f76685SDave Jiang } 94084f76685SDave Jiang 941fce8a7bbSJon Mason out: 942e26a5843SAllen Hubbe if (ntb_link_is_up(ndev, NULL, NULL) == 1) 943fce8a7bbSJon Mason schedule_delayed_work(&nt->link_work, 944fce8a7bbSJon Mason msecs_to_jiffies(NTB_LINK_DOWN_TIMEOUT)); 945fce8a7bbSJon Mason } 946fce8a7bbSJon Mason 947fce8a7bbSJon Mason static void ntb_qp_link_work(struct work_struct *work) 948fce8a7bbSJon Mason { 949fce8a7bbSJon Mason struct ntb_transport_qp *qp = container_of(work, 950fce8a7bbSJon Mason struct ntb_transport_qp, 951fce8a7bbSJon Mason link_work.work); 952e26a5843SAllen Hubbe struct pci_dev *pdev = qp->ndev->pdev; 953e26a5843SAllen Hubbe struct ntb_transport_ctx *nt = qp->transport; 954e26a5843SAllen Hubbe int val; 955fce8a7bbSJon Mason 956e26a5843SAllen Hubbe WARN_ON(!nt->link_is_up); 957fce8a7bbSJon Mason 958e26a5843SAllen Hubbe val = ntb_spad_read(nt->ndev, QP_LINKS); 959fce8a7bbSJon Mason 960e26a5843SAllen Hubbe ntb_peer_spad_write(nt->ndev, QP_LINKS, val | BIT(qp->qp_num)); 961fce8a7bbSJon Mason 962fce8a7bbSJon Mason /* query remote spad for qp ready bits */ 963e26a5843SAllen Hubbe ntb_peer_spad_read(nt->ndev, QP_LINKS); 96428762289SAllen Hubbe dev_dbg_ratelimited(&pdev->dev, "Remote QP link status = %x\n", val); 965fce8a7bbSJon Mason 966fce8a7bbSJon Mason /* See if the remote side is up */ 967e26a5843SAllen Hubbe if (val & BIT(qp->qp_num)) { 968fce8a7bbSJon Mason dev_info(&pdev->dev, "qp %d: Link Up\n", qp->qp_num); 969e26a5843SAllen Hubbe qp->link_is_up = true; 970e9021331SDave Jiang qp->active = true; 971e26a5843SAllen Hubbe 972fce8a7bbSJon Mason if (qp->event_handler) 973e26a5843SAllen Hubbe qp->event_handler(qp->cb_data, qp->link_is_up); 9748b5a22d8SAllen Hubbe 975e9021331SDave Jiang if (qp->active) 9768b5a22d8SAllen Hubbe tasklet_schedule(&qp->rxc_db_work); 977e26a5843SAllen Hubbe } else if (nt->link_is_up) 978fce8a7bbSJon Mason schedule_delayed_work(&qp->link_work, 979fce8a7bbSJon Mason msecs_to_jiffies(NTB_LINK_DOWN_TIMEOUT)); 980fce8a7bbSJon Mason } 981fce8a7bbSJon Mason 982e26a5843SAllen Hubbe static int ntb_transport_init_queue(struct ntb_transport_ctx *nt, 983fce8a7bbSJon Mason unsigned int qp_num) 984fce8a7bbSJon Mason { 985fce8a7bbSJon Mason struct ntb_transport_qp *qp; 986e26a5843SAllen Hubbe phys_addr_t mw_base; 987e26a5843SAllen Hubbe resource_size_t mw_size; 988ef114ed5SJon Mason unsigned int num_qps_mw, tx_size; 989e26a5843SAllen Hubbe unsigned int mw_num, mw_count, qp_count; 990282a2feeSJon Mason u64 qp_offset; 991948d3a65SJon Mason 992e26a5843SAllen Hubbe mw_count = nt->mw_count; 993e26a5843SAllen Hubbe qp_count = nt->qp_count; 994fce8a7bbSJon Mason 995e26a5843SAllen Hubbe mw_num = QP_TO_MW(nt, qp_num); 996e26a5843SAllen Hubbe 997e26a5843SAllen Hubbe qp = &nt->qp_vec[qp_num]; 998fce8a7bbSJon Mason qp->qp_num = qp_num; 999fce8a7bbSJon Mason qp->transport = nt; 1000fce8a7bbSJon Mason qp->ndev = nt->ndev; 1001e26a5843SAllen Hubbe qp->client_ready = false; 1002fce8a7bbSJon Mason qp->event_handler = NULL; 10032849b5d7SAllen Hubbe ntb_qp_link_down_reset(qp); 1004fce8a7bbSJon Mason 1005e26a5843SAllen Hubbe if (qp_count % mw_count && mw_num + 1 < qp_count / mw_count) 1006e26a5843SAllen Hubbe num_qps_mw = qp_count / mw_count + 1; 1007ef114ed5SJon Mason else 1008e26a5843SAllen Hubbe num_qps_mw = qp_count / mw_count; 1009ef114ed5SJon Mason 1010e26a5843SAllen Hubbe mw_base = nt->mw_vec[mw_num].phys_addr; 1011e26a5843SAllen Hubbe mw_size = nt->mw_vec[mw_num].phys_size; 1012e26a5843SAllen Hubbe 1013e26a5843SAllen Hubbe tx_size = (unsigned int)mw_size / num_qps_mw; 1014c92ba3c5SJon Mason qp_offset = tx_size * (qp_num / mw_count); 1015e26a5843SAllen Hubbe 1016e26a5843SAllen Hubbe qp->tx_mw = nt->mw_vec[mw_num].vbase + qp_offset; 1017282a2feeSJon Mason if (!qp->tx_mw) 1018282a2feeSJon Mason return -EINVAL; 1019793c20e9SJon Mason 1020e26a5843SAllen Hubbe qp->tx_mw_phys = mw_base + qp_offset; 1021282a2feeSJon Mason if (!qp->tx_mw_phys) 1022282a2feeSJon Mason return -EINVAL; 1023282a2feeSJon Mason 1024282a2feeSJon Mason tx_size -= sizeof(struct ntb_rx_info); 1025282a2feeSJon Mason qp->rx_info = qp->tx_mw + tx_size; 1026282a2feeSJon Mason 1027c9d534c8SJon Mason /* Due to housekeeping, there must be atleast 2 buffs */ 1028c9d534c8SJon Mason qp->tx_max_frame = min(transport_mtu, tx_size / 2); 1029793c20e9SJon Mason qp->tx_max_entry = tx_size / qp->tx_max_frame; 1030ef114ed5SJon Mason 1031c8650fd0SDave Jiang if (nt->debugfs_node_dir) { 1032fce8a7bbSJon Mason char debugfs_name[4]; 1033fce8a7bbSJon Mason 1034fce8a7bbSJon Mason snprintf(debugfs_name, 4, "qp%d", qp_num); 1035fce8a7bbSJon Mason qp->debugfs_dir = debugfs_create_dir(debugfs_name, 1036c8650fd0SDave Jiang nt->debugfs_node_dir); 1037fce8a7bbSJon Mason 1038fce8a7bbSJon Mason qp->debugfs_stats = debugfs_create_file("stats", S_IRUSR, 1039fce8a7bbSJon Mason qp->debugfs_dir, qp, 1040fce8a7bbSJon Mason &ntb_qp_debugfs_stats); 1041e26a5843SAllen Hubbe } else { 1042e26a5843SAllen Hubbe qp->debugfs_dir = NULL; 1043e26a5843SAllen Hubbe qp->debugfs_stats = NULL; 1044fce8a7bbSJon Mason } 1045fce8a7bbSJon Mason 1046fce8a7bbSJon Mason INIT_DELAYED_WORK(&qp->link_work, ntb_qp_link_work); 1047fca4d518SJon Mason INIT_WORK(&qp->link_cleanup, ntb_qp_link_cleanup_work); 1048fce8a7bbSJon Mason 1049da2e5ae5SAllen Hubbe spin_lock_init(&qp->ntb_rx_q_lock); 1050fce8a7bbSJon Mason spin_lock_init(&qp->ntb_tx_free_q_lock); 1051fce8a7bbSJon Mason 1052da2e5ae5SAllen Hubbe INIT_LIST_HEAD(&qp->rx_post_q); 1053fce8a7bbSJon Mason INIT_LIST_HEAD(&qp->rx_pend_q); 1054fce8a7bbSJon Mason INIT_LIST_HEAD(&qp->rx_free_q); 1055fce8a7bbSJon Mason INIT_LIST_HEAD(&qp->tx_free_q); 1056282a2feeSJon Mason 1057e26a5843SAllen Hubbe tasklet_init(&qp->rxc_db_work, ntb_transport_rxc_db, 1058e26a5843SAllen Hubbe (unsigned long)qp); 1059e26a5843SAllen Hubbe 1060282a2feeSJon Mason return 0; 1061fce8a7bbSJon Mason } 1062fce8a7bbSJon Mason 1063e26a5843SAllen Hubbe static int ntb_transport_probe(struct ntb_client *self, struct ntb_dev *ndev) 1064fce8a7bbSJon Mason { 1065e26a5843SAllen Hubbe struct ntb_transport_ctx *nt; 1066e26a5843SAllen Hubbe struct ntb_transport_mw *mw; 1067e26a5843SAllen Hubbe unsigned int mw_count, qp_count; 1068e26a5843SAllen Hubbe u64 qp_bitmap; 10691199aa61SAllen Hubbe int node; 1070fce8a7bbSJon Mason int rc, i; 1071fce8a7bbSJon Mason 107219645a07SLogan Gunthorpe mw_count = ntb_mw_count(ndev); 107319645a07SLogan Gunthorpe if (ntb_spad_count(ndev) < (NUM_MWS + 1 + mw_count * 2)) { 107419645a07SLogan Gunthorpe dev_err(&ndev->dev, "Not enough scratch pad registers for %s", 107519645a07SLogan Gunthorpe NTB_TRANSPORT_NAME); 107619645a07SLogan Gunthorpe return -EIO; 107719645a07SLogan Gunthorpe } 107819645a07SLogan Gunthorpe 1079e26a5843SAllen Hubbe if (ntb_db_is_unsafe(ndev)) 1080e26a5843SAllen Hubbe dev_dbg(&ndev->dev, 1081e26a5843SAllen Hubbe "doorbell is unsafe, proceed anyway...\n"); 1082e26a5843SAllen Hubbe if (ntb_spad_is_unsafe(ndev)) 1083e26a5843SAllen Hubbe dev_dbg(&ndev->dev, 1084e26a5843SAllen Hubbe "scratchpad is unsafe, proceed anyway...\n"); 1085e26a5843SAllen Hubbe 10861199aa61SAllen Hubbe node = dev_to_node(&ndev->dev); 10871199aa61SAllen Hubbe 10881199aa61SAllen Hubbe nt = kzalloc_node(sizeof(*nt), GFP_KERNEL, node); 1089fce8a7bbSJon Mason if (!nt) 1090fce8a7bbSJon Mason return -ENOMEM; 1091fce8a7bbSJon Mason 1092e26a5843SAllen Hubbe nt->ndev = ndev; 1093e26a5843SAllen Hubbe 1094e26a5843SAllen Hubbe nt->mw_count = mw_count; 1095e26a5843SAllen Hubbe 10961199aa61SAllen Hubbe nt->mw_vec = kzalloc_node(mw_count * sizeof(*nt->mw_vec), 10971199aa61SAllen Hubbe GFP_KERNEL, node); 1098e26a5843SAllen Hubbe if (!nt->mw_vec) { 1099e26a5843SAllen Hubbe rc = -ENOMEM; 1100fce8a7bbSJon Mason goto err; 1101fce8a7bbSJon Mason } 1102fce8a7bbSJon Mason 1103e26a5843SAllen Hubbe for (i = 0; i < mw_count; i++) { 1104e26a5843SAllen Hubbe mw = &nt->mw_vec[i]; 1105e26a5843SAllen Hubbe 1106e26a5843SAllen Hubbe rc = ntb_mw_get_range(ndev, i, &mw->phys_addr, &mw->phys_size, 1107e26a5843SAllen Hubbe &mw->xlat_align, &mw->xlat_align_size); 1108e26a5843SAllen Hubbe if (rc) 1109e26a5843SAllen Hubbe goto err1; 1110e26a5843SAllen Hubbe 111106917f75SDave Jiang mw->vbase = ioremap_wc(mw->phys_addr, mw->phys_size); 1112e26a5843SAllen Hubbe if (!mw->vbase) { 1113948d3a65SJon Mason rc = -ENOMEM; 1114948d3a65SJon Mason goto err1; 1115948d3a65SJon Mason } 1116948d3a65SJon Mason 1117e26a5843SAllen Hubbe mw->buff_size = 0; 1118e26a5843SAllen Hubbe mw->xlat_size = 0; 1119e26a5843SAllen Hubbe mw->virt_addr = NULL; 1120e26a5843SAllen Hubbe mw->dma_addr = 0; 1121e26a5843SAllen Hubbe } 1122fce8a7bbSJon Mason 1123e26a5843SAllen Hubbe qp_bitmap = ntb_db_valid_mask(ndev); 1124e26a5843SAllen Hubbe 1125e26a5843SAllen Hubbe qp_count = ilog2(qp_bitmap); 1126e26a5843SAllen Hubbe if (max_num_clients && max_num_clients < qp_count) 1127e26a5843SAllen Hubbe qp_count = max_num_clients; 1128e26a5843SAllen Hubbe else if (mw_count < qp_count) 1129e26a5843SAllen Hubbe qp_count = mw_count; 1130e26a5843SAllen Hubbe 1131e26a5843SAllen Hubbe qp_bitmap &= BIT_ULL(qp_count) - 1; 1132e26a5843SAllen Hubbe 1133e26a5843SAllen Hubbe nt->qp_count = qp_count; 1134e26a5843SAllen Hubbe nt->qp_bitmap = qp_bitmap; 1135e26a5843SAllen Hubbe nt->qp_bitmap_free = qp_bitmap; 1136e26a5843SAllen Hubbe 11371199aa61SAllen Hubbe nt->qp_vec = kzalloc_node(qp_count * sizeof(*nt->qp_vec), 11381199aa61SAllen Hubbe GFP_KERNEL, node); 1139e26a5843SAllen Hubbe if (!nt->qp_vec) { 1140fce8a7bbSJon Mason rc = -ENOMEM; 1141d4adee09SSudip Mukherjee goto err1; 1142fce8a7bbSJon Mason } 1143fce8a7bbSJon Mason 1144c8650fd0SDave Jiang if (nt_debugfs_dir) { 1145c8650fd0SDave Jiang nt->debugfs_node_dir = 1146c8650fd0SDave Jiang debugfs_create_dir(pci_name(ndev->pdev), 1147c8650fd0SDave Jiang nt_debugfs_dir); 1148c8650fd0SDave Jiang } 1149c8650fd0SDave Jiang 1150e26a5843SAllen Hubbe for (i = 0; i < qp_count; i++) { 1151282a2feeSJon Mason rc = ntb_transport_init_queue(nt, i); 1152282a2feeSJon Mason if (rc) 1153d4adee09SSudip Mukherjee goto err2; 1154282a2feeSJon Mason } 1155fce8a7bbSJon Mason 1156fce8a7bbSJon Mason INIT_DELAYED_WORK(&nt->link_work, ntb_transport_link_work); 1157fca4d518SJon Mason INIT_WORK(&nt->link_cleanup, ntb_transport_link_cleanup_work); 1158fce8a7bbSJon Mason 1159e26a5843SAllen Hubbe rc = ntb_set_ctx(ndev, nt, &ntb_transport_ops); 1160fce8a7bbSJon Mason if (rc) 1161d4adee09SSudip Mukherjee goto err2; 1162fce8a7bbSJon Mason 1163fce8a7bbSJon Mason INIT_LIST_HEAD(&nt->client_devs); 1164fce8a7bbSJon Mason rc = ntb_bus_init(nt); 1165fce8a7bbSJon Mason if (rc) 1166d4adee09SSudip Mukherjee goto err3; 1167fce8a7bbSJon Mason 1168e26a5843SAllen Hubbe nt->link_is_up = false; 1169e26a5843SAllen Hubbe ntb_link_enable(ndev, NTB_SPEED_AUTO, NTB_WIDTH_AUTO); 1170e26a5843SAllen Hubbe ntb_link_event(ndev); 1171fce8a7bbSJon Mason 1172fce8a7bbSJon Mason return 0; 1173fce8a7bbSJon Mason 1174948d3a65SJon Mason err3: 1175d4adee09SSudip Mukherjee ntb_clear_ctx(ndev); 1176948d3a65SJon Mason err2: 1177d4adee09SSudip Mukherjee kfree(nt->qp_vec); 1178fce8a7bbSJon Mason err1: 1179e26a5843SAllen Hubbe while (i--) { 1180e26a5843SAllen Hubbe mw = &nt->mw_vec[i]; 1181e26a5843SAllen Hubbe iounmap(mw->vbase); 1182e26a5843SAllen Hubbe } 1183d4adee09SSudip Mukherjee kfree(nt->mw_vec); 1184fce8a7bbSJon Mason err: 1185fce8a7bbSJon Mason kfree(nt); 1186fce8a7bbSJon Mason return rc; 1187fce8a7bbSJon Mason } 1188fce8a7bbSJon Mason 1189e26a5843SAllen Hubbe static void ntb_transport_free(struct ntb_client *self, struct ntb_dev *ndev) 1190fce8a7bbSJon Mason { 1191e26a5843SAllen Hubbe struct ntb_transport_ctx *nt = ndev->ctx; 1192e26a5843SAllen Hubbe struct ntb_transport_qp *qp; 1193e26a5843SAllen Hubbe u64 qp_bitmap_alloc; 1194fce8a7bbSJon Mason int i; 1195fce8a7bbSJon Mason 1196fca4d518SJon Mason ntb_transport_link_cleanup(nt); 1197e26a5843SAllen Hubbe cancel_work_sync(&nt->link_cleanup); 1198e26a5843SAllen Hubbe cancel_delayed_work_sync(&nt->link_work); 1199e26a5843SAllen Hubbe 1200e26a5843SAllen Hubbe qp_bitmap_alloc = nt->qp_bitmap & ~nt->qp_bitmap_free; 1201fce8a7bbSJon Mason 1202fce8a7bbSJon Mason /* verify that all the qp's are freed */ 1203e26a5843SAllen Hubbe for (i = 0; i < nt->qp_count; i++) { 1204e26a5843SAllen Hubbe qp = &nt->qp_vec[i]; 1205e26a5843SAllen Hubbe if (qp_bitmap_alloc & BIT_ULL(i)) 1206e26a5843SAllen Hubbe ntb_transport_free_queue(qp); 1207e26a5843SAllen Hubbe debugfs_remove_recursive(qp->debugfs_dir); 12081517a3f2SJon Mason } 1209fce8a7bbSJon Mason 1210e26a5843SAllen Hubbe ntb_link_disable(ndev); 1211e26a5843SAllen Hubbe ntb_clear_ctx(ndev); 1212e26a5843SAllen Hubbe 1213fce8a7bbSJon Mason ntb_bus_remove(nt); 1214fce8a7bbSJon Mason 1215e26a5843SAllen Hubbe for (i = nt->mw_count; i--; ) { 1216113fc505SJon Mason ntb_free_mw(nt, i); 1217e26a5843SAllen Hubbe iounmap(nt->mw_vec[i].vbase); 1218e26a5843SAllen Hubbe } 1219fce8a7bbSJon Mason 1220e26a5843SAllen Hubbe kfree(nt->qp_vec); 1221e26a5843SAllen Hubbe kfree(nt->mw_vec); 1222fce8a7bbSJon Mason kfree(nt); 1223fce8a7bbSJon Mason } 1224fce8a7bbSJon Mason 1225da2e5ae5SAllen Hubbe static void ntb_complete_rxc(struct ntb_transport_qp *qp) 1226fce8a7bbSJon Mason { 1227da2e5ae5SAllen Hubbe struct ntb_queue_entry *entry; 1228da2e5ae5SAllen Hubbe void *cb_data; 1229da2e5ae5SAllen Hubbe unsigned int len; 1230da2e5ae5SAllen Hubbe unsigned long irqflags; 1231448c6fb3SJon Mason 1232da2e5ae5SAllen Hubbe spin_lock_irqsave(&qp->ntb_rx_q_lock, irqflags); 1233282a2feeSJon Mason 1234da2e5ae5SAllen Hubbe while (!list_empty(&qp->rx_post_q)) { 1235da2e5ae5SAllen Hubbe entry = list_first_entry(&qp->rx_post_q, 1236da2e5ae5SAllen Hubbe struct ntb_queue_entry, entry); 1237da2e5ae5SAllen Hubbe if (!(entry->flags & DESC_DONE_FLAG)) 1238da2e5ae5SAllen Hubbe break; 1239da2e5ae5SAllen Hubbe 1240da2e5ae5SAllen Hubbe entry->rx_hdr->flags = 0; 1241*72203572SDave Jiang iowrite32(entry->rx_index, &qp->rx_info->entry); 1242fce8a7bbSJon Mason 1243da2e5ae5SAllen Hubbe cb_data = entry->cb_data; 1244da2e5ae5SAllen Hubbe len = entry->len; 1245da2e5ae5SAllen Hubbe 1246da2e5ae5SAllen Hubbe list_move_tail(&entry->entry, &qp->rx_free_q); 1247da2e5ae5SAllen Hubbe 1248da2e5ae5SAllen Hubbe spin_unlock_irqrestore(&qp->ntb_rx_q_lock, irqflags); 1249448c6fb3SJon Mason 1250e26a5843SAllen Hubbe if (qp->rx_handler && qp->client_ready) 1251448c6fb3SJon Mason qp->rx_handler(qp, qp->cb_data, cb_data, len); 1252da2e5ae5SAllen Hubbe 1253da2e5ae5SAllen Hubbe spin_lock_irqsave(&qp->ntb_rx_q_lock, irqflags); 1254da2e5ae5SAllen Hubbe } 1255da2e5ae5SAllen Hubbe 1256da2e5ae5SAllen Hubbe spin_unlock_irqrestore(&qp->ntb_rx_q_lock, irqflags); 1257da2e5ae5SAllen Hubbe } 1258da2e5ae5SAllen Hubbe 1259*72203572SDave Jiang static void ntb_rx_copy_callback(void *data, 1260*72203572SDave Jiang const struct dmaengine_result *res) 1261da2e5ae5SAllen Hubbe { 1262da2e5ae5SAllen Hubbe struct ntb_queue_entry *entry = data; 1263da2e5ae5SAllen Hubbe 1264*72203572SDave Jiang /* we need to check DMA results if we are using DMA */ 1265*72203572SDave Jiang if (res) { 1266*72203572SDave Jiang enum dmaengine_tx_result dma_err = res->result; 1267*72203572SDave Jiang 1268*72203572SDave Jiang switch (dma_err) { 1269*72203572SDave Jiang case DMA_TRANS_READ_FAILED: 1270*72203572SDave Jiang case DMA_TRANS_WRITE_FAILED: 1271*72203572SDave Jiang entry->errors++; 1272*72203572SDave Jiang case DMA_TRANS_ABORTED: 1273*72203572SDave Jiang { 1274*72203572SDave Jiang struct ntb_transport_qp *qp = entry->qp; 1275*72203572SDave Jiang void *offset = qp->rx_buff + qp->rx_max_frame * 1276*72203572SDave Jiang qp->rx_index; 1277*72203572SDave Jiang 1278*72203572SDave Jiang ntb_memcpy_rx(entry, offset); 1279*72203572SDave Jiang qp->rx_memcpy++; 1280*72203572SDave Jiang return; 1281*72203572SDave Jiang } 1282*72203572SDave Jiang 1283*72203572SDave Jiang case DMA_TRANS_NOERROR: 1284*72203572SDave Jiang default: 1285*72203572SDave Jiang break; 1286*72203572SDave Jiang } 1287*72203572SDave Jiang } 1288*72203572SDave Jiang 1289da2e5ae5SAllen Hubbe entry->flags |= DESC_DONE_FLAG; 1290da2e5ae5SAllen Hubbe 1291da2e5ae5SAllen Hubbe ntb_complete_rxc(entry->qp); 1292fce8a7bbSJon Mason } 1293fce8a7bbSJon Mason 1294282a2feeSJon Mason static void ntb_memcpy_rx(struct ntb_queue_entry *entry, void *offset) 1295282a2feeSJon Mason { 1296282a2feeSJon Mason void *buf = entry->buf; 1297282a2feeSJon Mason size_t len = entry->len; 1298282a2feeSJon Mason 1299282a2feeSJon Mason memcpy(buf, offset, len); 1300282a2feeSJon Mason 1301e26a5843SAllen Hubbe /* Ensure that the data is fully copied out before clearing the flag */ 1302e26a5843SAllen Hubbe wmb(); 1303e26a5843SAllen Hubbe 1304*72203572SDave Jiang ntb_rx_copy_callback(entry, NULL); 1305282a2feeSJon Mason } 1306282a2feeSJon Mason 1307*72203572SDave Jiang static int ntb_async_rx_submit(struct ntb_queue_entry *entry, void *offset) 1308282a2feeSJon Mason { 1309282a2feeSJon Mason struct dma_async_tx_descriptor *txd; 1310282a2feeSJon Mason struct ntb_transport_qp *qp = entry->qp; 1311569410caSDave Jiang struct dma_chan *chan = qp->rx_dma_chan; 1312282a2feeSJon Mason struct dma_device *device; 1313da2e5ae5SAllen Hubbe size_t pay_off, buff_off, len; 13146f57fd05SBartlomiej Zolnierkiewicz struct dmaengine_unmap_data *unmap; 1315282a2feeSJon Mason dma_cookie_t cookie; 1316282a2feeSJon Mason void *buf = entry->buf; 13178c874cc1SDave Jiang int retries = 0; 1318282a2feeSJon Mason 1319da2e5ae5SAllen Hubbe len = entry->len; 1320282a2feeSJon Mason device = chan->device; 1321282a2feeSJon Mason pay_off = (size_t)offset & ~PAGE_MASK; 1322282a2feeSJon Mason buff_off = (size_t)buf & ~PAGE_MASK; 1323282a2feeSJon Mason 1324282a2feeSJon Mason if (!is_dma_copy_aligned(device, pay_off, buff_off, len)) 1325905921e7SAllen Hubbe goto err; 1326282a2feeSJon Mason 13276f57fd05SBartlomiej Zolnierkiewicz unmap = dmaengine_get_unmap_data(device->dev, 2, GFP_NOWAIT); 13286f57fd05SBartlomiej Zolnierkiewicz if (!unmap) 1329905921e7SAllen Hubbe goto err; 1330282a2feeSJon Mason 13316f57fd05SBartlomiej Zolnierkiewicz unmap->len = len; 13326f57fd05SBartlomiej Zolnierkiewicz unmap->addr[0] = dma_map_page(device->dev, virt_to_page(offset), 13336f57fd05SBartlomiej Zolnierkiewicz pay_off, len, DMA_TO_DEVICE); 13346f57fd05SBartlomiej Zolnierkiewicz if (dma_mapping_error(device->dev, unmap->addr[0])) 13356f57fd05SBartlomiej Zolnierkiewicz goto err_get_unmap; 1336282a2feeSJon Mason 13376f57fd05SBartlomiej Zolnierkiewicz unmap->to_cnt = 1; 13386f57fd05SBartlomiej Zolnierkiewicz 13396f57fd05SBartlomiej Zolnierkiewicz unmap->addr[1] = dma_map_page(device->dev, virt_to_page(buf), 13406f57fd05SBartlomiej Zolnierkiewicz buff_off, len, DMA_FROM_DEVICE); 13416f57fd05SBartlomiej Zolnierkiewicz if (dma_mapping_error(device->dev, unmap->addr[1])) 13426f57fd05SBartlomiej Zolnierkiewicz goto err_get_unmap; 13436f57fd05SBartlomiej Zolnierkiewicz 13446f57fd05SBartlomiej Zolnierkiewicz unmap->from_cnt = 1; 13456f57fd05SBartlomiej Zolnierkiewicz 13468c874cc1SDave Jiang for (retries = 0; retries < DMA_RETRIES; retries++) { 1347*72203572SDave Jiang txd = device->device_prep_dma_memcpy(chan, 1348*72203572SDave Jiang unmap->addr[1], 13490776ae7bSBartlomiej Zolnierkiewicz unmap->addr[0], len, 13500776ae7bSBartlomiej Zolnierkiewicz DMA_PREP_INTERRUPT); 13518c874cc1SDave Jiang if (txd) 13528c874cc1SDave Jiang break; 13538c874cc1SDave Jiang 13548c874cc1SDave Jiang set_current_state(TASK_INTERRUPTIBLE); 13558c874cc1SDave Jiang schedule_timeout(DMA_OUT_RESOURCE_TO); 13568c874cc1SDave Jiang } 13578c874cc1SDave Jiang 13588c874cc1SDave Jiang if (!txd) { 13598c874cc1SDave Jiang qp->dma_rx_prep_err++; 13606f57fd05SBartlomiej Zolnierkiewicz goto err_get_unmap; 13618c874cc1SDave Jiang } 1362282a2feeSJon Mason 1363*72203572SDave Jiang txd->callback_result = ntb_rx_copy_callback; 1364282a2feeSJon Mason txd->callback_param = entry; 13656f57fd05SBartlomiej Zolnierkiewicz dma_set_unmap(txd, unmap); 1366282a2feeSJon Mason 1367282a2feeSJon Mason cookie = dmaengine_submit(txd); 1368282a2feeSJon Mason if (dma_submit_error(cookie)) 13696f57fd05SBartlomiej Zolnierkiewicz goto err_set_unmap; 13706f57fd05SBartlomiej Zolnierkiewicz 13716f57fd05SBartlomiej Zolnierkiewicz dmaengine_unmap_put(unmap); 1372282a2feeSJon Mason 1373282a2feeSJon Mason qp->last_cookie = cookie; 1374282a2feeSJon Mason 1375282a2feeSJon Mason qp->rx_async++; 1376282a2feeSJon Mason 1377*72203572SDave Jiang return 0; 1378282a2feeSJon Mason 13796f57fd05SBartlomiej Zolnierkiewicz err_set_unmap: 13806f57fd05SBartlomiej Zolnierkiewicz dmaengine_unmap_put(unmap); 13816f57fd05SBartlomiej Zolnierkiewicz err_get_unmap: 13826f57fd05SBartlomiej Zolnierkiewicz dmaengine_unmap_put(unmap); 1383282a2feeSJon Mason err: 1384*72203572SDave Jiang return -ENXIO; 1385*72203572SDave Jiang } 1386*72203572SDave Jiang 1387*72203572SDave Jiang static void ntb_async_rx(struct ntb_queue_entry *entry, void *offset) 1388*72203572SDave Jiang { 1389*72203572SDave Jiang struct ntb_transport_qp *qp = entry->qp; 1390*72203572SDave Jiang struct dma_chan *chan = qp->rx_dma_chan; 1391*72203572SDave Jiang int res; 1392*72203572SDave Jiang 1393*72203572SDave Jiang if (!chan) 1394*72203572SDave Jiang goto err; 1395*72203572SDave Jiang 1396*72203572SDave Jiang if (entry->len < copy_bytes) 1397*72203572SDave Jiang goto err; 1398*72203572SDave Jiang 1399*72203572SDave Jiang res = ntb_async_rx_submit(entry, offset); 1400*72203572SDave Jiang if (res < 0) 1401*72203572SDave Jiang goto err; 1402*72203572SDave Jiang 1403*72203572SDave Jiang if (!entry->retries) 1404*72203572SDave Jiang qp->rx_async++; 1405*72203572SDave Jiang 1406*72203572SDave Jiang return; 1407*72203572SDave Jiang 1408*72203572SDave Jiang err: 1409282a2feeSJon Mason ntb_memcpy_rx(entry, offset); 1410282a2feeSJon Mason qp->rx_memcpy++; 1411282a2feeSJon Mason } 1412282a2feeSJon Mason 1413fce8a7bbSJon Mason static int ntb_process_rxc(struct ntb_transport_qp *qp) 1414fce8a7bbSJon Mason { 1415fce8a7bbSJon Mason struct ntb_payload_header *hdr; 1416fce8a7bbSJon Mason struct ntb_queue_entry *entry; 1417fce8a7bbSJon Mason void *offset; 1418fce8a7bbSJon Mason 1419793c20e9SJon Mason offset = qp->rx_buff + qp->rx_max_frame * qp->rx_index; 1420793c20e9SJon Mason hdr = offset + qp->rx_max_frame - sizeof(struct ntb_payload_header); 1421793c20e9SJon Mason 1422e26a5843SAllen Hubbe dev_dbg(&qp->ndev->pdev->dev, "qp %d: RX ver %u len %d flags %x\n", 1423e26a5843SAllen Hubbe qp->qp_num, hdr->ver, hdr->len, hdr->flags); 1424fce8a7bbSJon Mason 1425fce8a7bbSJon Mason if (!(hdr->flags & DESC_DONE_FLAG)) { 1426e26a5843SAllen Hubbe dev_dbg(&qp->ndev->pdev->dev, "done flag not set\n"); 1427fce8a7bbSJon Mason qp->rx_ring_empty++; 1428fce8a7bbSJon Mason return -EAGAIN; 1429fce8a7bbSJon Mason } 1430fce8a7bbSJon Mason 1431e26a5843SAllen Hubbe if (hdr->flags & LINK_DOWN_FLAG) { 1432e26a5843SAllen Hubbe dev_dbg(&qp->ndev->pdev->dev, "link down flag set\n"); 1433e26a5843SAllen Hubbe ntb_qp_link_down(qp); 1434e26a5843SAllen Hubbe hdr->flags = 0; 1435c0900b33SAllen Hubbe return -EAGAIN; 1436e26a5843SAllen Hubbe } 1437e26a5843SAllen Hubbe 143874465645SJon Mason if (hdr->ver != (u32)qp->rx_pkts) { 1439e26a5843SAllen Hubbe dev_dbg(&qp->ndev->pdev->dev, 1440e26a5843SAllen Hubbe "version mismatch, expected %llu - got %u\n", 1441e26a5843SAllen Hubbe qp->rx_pkts, hdr->ver); 1442fce8a7bbSJon Mason qp->rx_err_ver++; 1443fce8a7bbSJon Mason return -EIO; 1444fce8a7bbSJon Mason } 1445fce8a7bbSJon Mason 1446da2e5ae5SAllen Hubbe entry = ntb_list_mv(&qp->ntb_rx_q_lock, &qp->rx_pend_q, &qp->rx_post_q); 1447e26a5843SAllen Hubbe if (!entry) { 1448e26a5843SAllen Hubbe dev_dbg(&qp->ndev->pdev->dev, "no receive buffer\n"); 1449e26a5843SAllen Hubbe qp->rx_err_no_buf++; 1450da2e5ae5SAllen Hubbe return -EAGAIN; 1451fce8a7bbSJon Mason } 1452fce8a7bbSJon Mason 1453da2e5ae5SAllen Hubbe entry->rx_hdr = hdr; 1454*72203572SDave Jiang entry->rx_index = qp->rx_index; 1455da2e5ae5SAllen Hubbe 1456e26a5843SAllen Hubbe if (hdr->len > entry->len) { 1457e26a5843SAllen Hubbe dev_dbg(&qp->ndev->pdev->dev, 1458e26a5843SAllen Hubbe "receive buffer overflow! Wanted %d got %d\n", 1459e26a5843SAllen Hubbe hdr->len, entry->len); 1460e26a5843SAllen Hubbe qp->rx_err_oflow++; 1461e26a5843SAllen Hubbe 1462da2e5ae5SAllen Hubbe entry->len = -EIO; 1463da2e5ae5SAllen Hubbe entry->flags |= DESC_DONE_FLAG; 1464e26a5843SAllen Hubbe 1465da2e5ae5SAllen Hubbe ntb_complete_rxc(qp); 1466da2e5ae5SAllen Hubbe } else { 1467e26a5843SAllen Hubbe dev_dbg(&qp->ndev->pdev->dev, 1468e26a5843SAllen Hubbe "RX OK index %u ver %u size %d into buf size %d\n", 1469793c20e9SJon Mason qp->rx_index, hdr->ver, hdr->len, entry->len); 1470fce8a7bbSJon Mason 1471282a2feeSJon Mason qp->rx_bytes += hdr->len; 1472282a2feeSJon Mason qp->rx_pkts++; 1473fce8a7bbSJon Mason 1474da2e5ae5SAllen Hubbe entry->len = hdr->len; 1475282a2feeSJon Mason 1476da2e5ae5SAllen Hubbe ntb_async_rx(entry, offset); 1477da2e5ae5SAllen Hubbe } 1478fce8a7bbSJon Mason 1479282a2feeSJon Mason qp->rx_index++; 1480282a2feeSJon Mason qp->rx_index %= qp->rx_max_entry; 1481282a2feeSJon Mason 1482282a2feeSJon Mason return 0; 1483fce8a7bbSJon Mason } 1484fce8a7bbSJon Mason 1485e26a5843SAllen Hubbe static void ntb_transport_rxc_db(unsigned long data) 1486fce8a7bbSJon Mason { 1487e26a5843SAllen Hubbe struct ntb_transport_qp *qp = (void *)data; 1488c336acd3SJon Mason int rc, i; 1489fce8a7bbSJon Mason 1490e26a5843SAllen Hubbe dev_dbg(&qp->ndev->pdev->dev, "%s: doorbell %d received\n", 1491e26a5843SAllen Hubbe __func__, qp->qp_num); 1492e8aeb60cSJon Mason 1493c336acd3SJon Mason /* Limit the number of packets processed in a single interrupt to 1494c336acd3SJon Mason * provide fairness to others 1495c336acd3SJon Mason */ 1496c336acd3SJon Mason for (i = 0; i < qp->rx_max_entry; i++) { 1497fce8a7bbSJon Mason rc = ntb_process_rxc(qp); 1498c336acd3SJon Mason if (rc) 1499c336acd3SJon Mason break; 1500c336acd3SJon Mason } 1501282a2feeSJon Mason 1502569410caSDave Jiang if (i && qp->rx_dma_chan) 1503569410caSDave Jiang dma_async_issue_pending(qp->rx_dma_chan); 1504fce8a7bbSJon Mason 1505e26a5843SAllen Hubbe if (i == qp->rx_max_entry) { 1506e26a5843SAllen Hubbe /* there is more work to do */ 1507e9021331SDave Jiang if (qp->active) 1508e26a5843SAllen Hubbe tasklet_schedule(&qp->rxc_db_work); 1509e26a5843SAllen Hubbe } else if (ntb_db_read(qp->ndev) & BIT_ULL(qp->qp_num)) { 1510e26a5843SAllen Hubbe /* the doorbell bit is set: clear it */ 1511e26a5843SAllen Hubbe ntb_db_clear(qp->ndev, BIT_ULL(qp->qp_num)); 1512e26a5843SAllen Hubbe /* ntb_db_read ensures ntb_db_clear write is committed */ 1513e26a5843SAllen Hubbe ntb_db_read(qp->ndev); 1514e26a5843SAllen Hubbe 1515e26a5843SAllen Hubbe /* an interrupt may have arrived between finishing 1516e26a5843SAllen Hubbe * ntb_process_rxc and clearing the doorbell bit: 1517e26a5843SAllen Hubbe * there might be some more work to do. 1518e26a5843SAllen Hubbe */ 1519e9021331SDave Jiang if (qp->active) 1520e26a5843SAllen Hubbe tasklet_schedule(&qp->rxc_db_work); 1521e26a5843SAllen Hubbe } 1522fce8a7bbSJon Mason } 1523fce8a7bbSJon Mason 15249cabc269SDave Jiang static void ntb_tx_copy_callback(void *data, 15259cabc269SDave Jiang const struct dmaengine_result *res) 1526fce8a7bbSJon Mason { 1527282a2feeSJon Mason struct ntb_queue_entry *entry = data; 1528282a2feeSJon Mason struct ntb_transport_qp *qp = entry->qp; 1529282a2feeSJon Mason struct ntb_payload_header __iomem *hdr = entry->tx_hdr; 1530fce8a7bbSJon Mason 15319cabc269SDave Jiang /* we need to check DMA results if we are using DMA */ 15329cabc269SDave Jiang if (res) { 15339cabc269SDave Jiang enum dmaengine_tx_result dma_err = res->result; 15349cabc269SDave Jiang 15359cabc269SDave Jiang switch (dma_err) { 15369cabc269SDave Jiang case DMA_TRANS_READ_FAILED: 15379cabc269SDave Jiang case DMA_TRANS_WRITE_FAILED: 15389cabc269SDave Jiang entry->errors++; 15399cabc269SDave Jiang case DMA_TRANS_ABORTED: 15409cabc269SDave Jiang { 15419cabc269SDave Jiang void __iomem *offset = 15429cabc269SDave Jiang qp->tx_mw + qp->tx_max_frame * 15439cabc269SDave Jiang entry->tx_index; 15449cabc269SDave Jiang 15459cabc269SDave Jiang /* resubmit via CPU */ 15469cabc269SDave Jiang ntb_memcpy_tx(entry, offset); 15479cabc269SDave Jiang qp->tx_memcpy++; 15489cabc269SDave Jiang return; 15499cabc269SDave Jiang } 15509cabc269SDave Jiang 15519cabc269SDave Jiang case DMA_TRANS_NOERROR: 15529cabc269SDave Jiang default: 15539cabc269SDave Jiang break; 15549cabc269SDave Jiang } 15559cabc269SDave Jiang } 15569cabc269SDave Jiang 155774465645SJon Mason iowrite32(entry->flags | DESC_DONE_FLAG, &hdr->flags); 1558fce8a7bbSJon Mason 1559e26a5843SAllen Hubbe ntb_peer_db_set(qp->ndev, BIT_ULL(qp->qp_num)); 1560fce8a7bbSJon Mason 1561fce8a7bbSJon Mason /* The entry length can only be zero if the packet is intended to be a 1562fce8a7bbSJon Mason * "link down" or similar. Since no payload is being sent in these 1563fce8a7bbSJon Mason * cases, there is nothing to add to the completion queue. 1564fce8a7bbSJon Mason */ 1565fce8a7bbSJon Mason if (entry->len > 0) { 1566fce8a7bbSJon Mason qp->tx_bytes += entry->len; 1567fce8a7bbSJon Mason 1568fce8a7bbSJon Mason if (qp->tx_handler) 1569fce8a7bbSJon Mason qp->tx_handler(qp, qp->cb_data, entry->cb_data, 1570fce8a7bbSJon Mason entry->len); 1571fce8a7bbSJon Mason } 1572fce8a7bbSJon Mason 1573fce8a7bbSJon Mason ntb_list_add(&qp->ntb_tx_free_q_lock, &entry->entry, &qp->tx_free_q); 1574fce8a7bbSJon Mason } 1575fce8a7bbSJon Mason 1576282a2feeSJon Mason static void ntb_memcpy_tx(struct ntb_queue_entry *entry, void __iomem *offset) 1577282a2feeSJon Mason { 157806917f75SDave Jiang #ifdef ARCH_HAS_NOCACHE_UACCESS 157906917f75SDave Jiang /* 158006917f75SDave Jiang * Using non-temporal mov to improve performance on non-cached 158106917f75SDave Jiang * writes, even though we aren't actually copying from user space. 158206917f75SDave Jiang */ 158306917f75SDave Jiang __copy_from_user_inatomic_nocache(offset, entry->buf, entry->len); 158406917f75SDave Jiang #else 1585282a2feeSJon Mason memcpy_toio(offset, entry->buf, entry->len); 158606917f75SDave Jiang #endif 1587282a2feeSJon Mason 1588e26a5843SAllen Hubbe /* Ensure that the data is fully copied out before setting the flags */ 1589e26a5843SAllen Hubbe wmb(); 1590e26a5843SAllen Hubbe 15919cabc269SDave Jiang ntb_tx_copy_callback(entry, NULL); 1592282a2feeSJon Mason } 1593282a2feeSJon Mason 15949cabc269SDave Jiang static int ntb_async_tx_submit(struct ntb_transport_qp *qp, 1595282a2feeSJon Mason struct ntb_queue_entry *entry) 1596282a2feeSJon Mason { 1597282a2feeSJon Mason struct dma_async_tx_descriptor *txd; 1598569410caSDave Jiang struct dma_chan *chan = qp->tx_dma_chan; 1599282a2feeSJon Mason struct dma_device *device; 16009cabc269SDave Jiang size_t len = entry->len; 16019cabc269SDave Jiang void *buf = entry->buf; 1602282a2feeSJon Mason size_t dest_off, buff_off; 16036f57fd05SBartlomiej Zolnierkiewicz struct dmaengine_unmap_data *unmap; 16046f57fd05SBartlomiej Zolnierkiewicz dma_addr_t dest; 1605282a2feeSJon Mason dma_cookie_t cookie; 16068c874cc1SDave Jiang int retries = 0; 1607282a2feeSJon Mason 1608282a2feeSJon Mason device = chan->device; 16099cabc269SDave Jiang dest = qp->tx_mw_phys + qp->tx_max_frame * entry->tx_index; 1610282a2feeSJon Mason buff_off = (size_t)buf & ~PAGE_MASK; 1611282a2feeSJon Mason dest_off = (size_t)dest & ~PAGE_MASK; 1612282a2feeSJon Mason 1613282a2feeSJon Mason if (!is_dma_copy_aligned(device, buff_off, dest_off, len)) 1614282a2feeSJon Mason goto err; 1615282a2feeSJon Mason 16166f57fd05SBartlomiej Zolnierkiewicz unmap = dmaengine_get_unmap_data(device->dev, 1, GFP_NOWAIT); 16176f57fd05SBartlomiej Zolnierkiewicz if (!unmap) 1618282a2feeSJon Mason goto err; 1619282a2feeSJon Mason 16206f57fd05SBartlomiej Zolnierkiewicz unmap->len = len; 16216f57fd05SBartlomiej Zolnierkiewicz unmap->addr[0] = dma_map_page(device->dev, virt_to_page(buf), 16226f57fd05SBartlomiej Zolnierkiewicz buff_off, len, DMA_TO_DEVICE); 16236f57fd05SBartlomiej Zolnierkiewicz if (dma_mapping_error(device->dev, unmap->addr[0])) 16246f57fd05SBartlomiej Zolnierkiewicz goto err_get_unmap; 16256f57fd05SBartlomiej Zolnierkiewicz 16266f57fd05SBartlomiej Zolnierkiewicz unmap->to_cnt = 1; 16276f57fd05SBartlomiej Zolnierkiewicz 16288c874cc1SDave Jiang for (retries = 0; retries < DMA_RETRIES; retries++) { 16299cabc269SDave Jiang txd = device->device_prep_dma_memcpy(chan, dest, 16309cabc269SDave Jiang unmap->addr[0], len, 16319cabc269SDave Jiang DMA_PREP_INTERRUPT); 16328c874cc1SDave Jiang if (txd) 16338c874cc1SDave Jiang break; 16348c874cc1SDave Jiang 16358c874cc1SDave Jiang set_current_state(TASK_INTERRUPTIBLE); 16368c874cc1SDave Jiang schedule_timeout(DMA_OUT_RESOURCE_TO); 16378c874cc1SDave Jiang } 16388c874cc1SDave Jiang 16398c874cc1SDave Jiang if (!txd) { 16408c874cc1SDave Jiang qp->dma_tx_prep_err++; 16416f57fd05SBartlomiej Zolnierkiewicz goto err_get_unmap; 16428c874cc1SDave Jiang } 1643282a2feeSJon Mason 16449cabc269SDave Jiang txd->callback_result = ntb_tx_copy_callback; 1645282a2feeSJon Mason txd->callback_param = entry; 16466f57fd05SBartlomiej Zolnierkiewicz dma_set_unmap(txd, unmap); 1647282a2feeSJon Mason 1648282a2feeSJon Mason cookie = dmaengine_submit(txd); 1649282a2feeSJon Mason if (dma_submit_error(cookie)) 16506f57fd05SBartlomiej Zolnierkiewicz goto err_set_unmap; 16516f57fd05SBartlomiej Zolnierkiewicz 16526f57fd05SBartlomiej Zolnierkiewicz dmaengine_unmap_put(unmap); 1653282a2feeSJon Mason 1654282a2feeSJon Mason dma_async_issue_pending(chan); 1655282a2feeSJon Mason 16569cabc269SDave Jiang return 0; 16576f57fd05SBartlomiej Zolnierkiewicz err_set_unmap: 16586f57fd05SBartlomiej Zolnierkiewicz dmaengine_unmap_put(unmap); 16596f57fd05SBartlomiej Zolnierkiewicz err_get_unmap: 16606f57fd05SBartlomiej Zolnierkiewicz dmaengine_unmap_put(unmap); 1661282a2feeSJon Mason err: 16629cabc269SDave Jiang return -ENXIO; 16639cabc269SDave Jiang } 16649cabc269SDave Jiang 16659cabc269SDave Jiang static void ntb_async_tx(struct ntb_transport_qp *qp, 16669cabc269SDave Jiang struct ntb_queue_entry *entry) 16679cabc269SDave Jiang { 16689cabc269SDave Jiang struct ntb_payload_header __iomem *hdr; 16699cabc269SDave Jiang struct dma_chan *chan = qp->tx_dma_chan; 16709cabc269SDave Jiang void __iomem *offset; 16719cabc269SDave Jiang int res; 16729cabc269SDave Jiang 16739cabc269SDave Jiang entry->tx_index = qp->tx_index; 16749cabc269SDave Jiang offset = qp->tx_mw + qp->tx_max_frame * entry->tx_index; 16759cabc269SDave Jiang hdr = offset + qp->tx_max_frame - sizeof(struct ntb_payload_header); 16769cabc269SDave Jiang entry->tx_hdr = hdr; 16779cabc269SDave Jiang 16789cabc269SDave Jiang iowrite32(entry->len, &hdr->len); 16799cabc269SDave Jiang iowrite32((u32)qp->tx_pkts, &hdr->ver); 16809cabc269SDave Jiang 16819cabc269SDave Jiang if (!chan) 16829cabc269SDave Jiang goto err; 16839cabc269SDave Jiang 16849cabc269SDave Jiang if (entry->len < copy_bytes) 16859cabc269SDave Jiang goto err; 16869cabc269SDave Jiang 16879cabc269SDave Jiang res = ntb_async_tx_submit(qp, entry); 16889cabc269SDave Jiang if (res < 0) 16899cabc269SDave Jiang goto err; 16909cabc269SDave Jiang 16919cabc269SDave Jiang if (!entry->retries) 16929cabc269SDave Jiang qp->tx_async++; 16939cabc269SDave Jiang 16949cabc269SDave Jiang return; 16959cabc269SDave Jiang 16969cabc269SDave Jiang err: 1697282a2feeSJon Mason ntb_memcpy_tx(entry, offset); 1698282a2feeSJon Mason qp->tx_memcpy++; 1699282a2feeSJon Mason } 1700282a2feeSJon Mason 1701fce8a7bbSJon Mason static int ntb_process_tx(struct ntb_transport_qp *qp, 1702fce8a7bbSJon Mason struct ntb_queue_entry *entry) 1703fce8a7bbSJon Mason { 1704793c20e9SJon Mason if (qp->tx_index == qp->remote_rx_info->entry) { 1705fce8a7bbSJon Mason qp->tx_ring_full++; 1706fce8a7bbSJon Mason return -EAGAIN; 1707fce8a7bbSJon Mason } 1708fce8a7bbSJon Mason 1709ef114ed5SJon Mason if (entry->len > qp->tx_max_frame - sizeof(struct ntb_payload_header)) { 1710fce8a7bbSJon Mason if (qp->tx_handler) 1711179f912aSJon Mason qp->tx_handler(qp, qp->cb_data, NULL, -EIO); 1712fce8a7bbSJon Mason 1713fce8a7bbSJon Mason ntb_list_add(&qp->ntb_tx_free_q_lock, &entry->entry, 1714fce8a7bbSJon Mason &qp->tx_free_q); 1715fce8a7bbSJon Mason return 0; 1716fce8a7bbSJon Mason } 1717fce8a7bbSJon Mason 1718282a2feeSJon Mason ntb_async_tx(qp, entry); 1719fce8a7bbSJon Mason 1720793c20e9SJon Mason qp->tx_index++; 1721793c20e9SJon Mason qp->tx_index %= qp->tx_max_entry; 1722fce8a7bbSJon Mason 1723fce8a7bbSJon Mason qp->tx_pkts++; 1724fce8a7bbSJon Mason 1725fce8a7bbSJon Mason return 0; 1726fce8a7bbSJon Mason } 1727fce8a7bbSJon Mason 1728fce8a7bbSJon Mason static void ntb_send_link_down(struct ntb_transport_qp *qp) 1729fce8a7bbSJon Mason { 1730e26a5843SAllen Hubbe struct pci_dev *pdev = qp->ndev->pdev; 1731fce8a7bbSJon Mason struct ntb_queue_entry *entry; 1732fce8a7bbSJon Mason int i, rc; 1733fce8a7bbSJon Mason 1734e26a5843SAllen Hubbe if (!qp->link_is_up) 1735fce8a7bbSJon Mason return; 1736fce8a7bbSJon Mason 1737e22e0b9dSAllen Hubbe dev_info(&pdev->dev, "qp %d: Send Link Down\n", qp->qp_num); 1738fce8a7bbSJon Mason 1739fce8a7bbSJon Mason for (i = 0; i < NTB_LINK_DOWN_TIMEOUT; i++) { 1740f766755cSJon Mason entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q); 1741fce8a7bbSJon Mason if (entry) 1742fce8a7bbSJon Mason break; 1743fce8a7bbSJon Mason msleep(100); 1744fce8a7bbSJon Mason } 1745fce8a7bbSJon Mason 1746fce8a7bbSJon Mason if (!entry) 1747fce8a7bbSJon Mason return; 1748fce8a7bbSJon Mason 1749fce8a7bbSJon Mason entry->cb_data = NULL; 1750fce8a7bbSJon Mason entry->buf = NULL; 1751fce8a7bbSJon Mason entry->len = 0; 1752fce8a7bbSJon Mason entry->flags = LINK_DOWN_FLAG; 1753fce8a7bbSJon Mason 1754fce8a7bbSJon Mason rc = ntb_process_tx(qp, entry); 1755fce8a7bbSJon Mason if (rc) 1756fce8a7bbSJon Mason dev_err(&pdev->dev, "ntb: QP%d unable to send linkdown msg\n", 1757fce8a7bbSJon Mason qp->qp_num); 17582849b5d7SAllen Hubbe 17592849b5d7SAllen Hubbe ntb_qp_link_down_reset(qp); 1760fce8a7bbSJon Mason } 1761fce8a7bbSJon Mason 17621199aa61SAllen Hubbe static bool ntb_dma_filter_fn(struct dma_chan *chan, void *node) 17631199aa61SAllen Hubbe { 17641199aa61SAllen Hubbe return dev_to_node(&chan->dev->device) == (int)(unsigned long)node; 17651199aa61SAllen Hubbe } 17661199aa61SAllen Hubbe 1767fce8a7bbSJon Mason /** 1768fce8a7bbSJon Mason * ntb_transport_create_queue - Create a new NTB transport layer queue 1769fce8a7bbSJon Mason * @rx_handler: receive callback function 1770fce8a7bbSJon Mason * @tx_handler: transmit callback function 1771fce8a7bbSJon Mason * @event_handler: event callback function 1772fce8a7bbSJon Mason * 1773fce8a7bbSJon Mason * Create a new NTB transport layer queue and provide the queue with a callback 1774fce8a7bbSJon Mason * routine for both transmit and receive. The receive callback routine will be 1775fce8a7bbSJon Mason * used to pass up data when the transport has received it on the queue. The 1776fce8a7bbSJon Mason * transmit callback routine will be called when the transport has completed the 1777fce8a7bbSJon Mason * transmission of the data on the queue and the data is ready to be freed. 1778fce8a7bbSJon Mason * 1779fce8a7bbSJon Mason * RETURNS: pointer to newly created ntb_queue, NULL on error. 1780fce8a7bbSJon Mason */ 1781fce8a7bbSJon Mason struct ntb_transport_qp * 1782e26a5843SAllen Hubbe ntb_transport_create_queue(void *data, struct device *client_dev, 1783fce8a7bbSJon Mason const struct ntb_queue_handlers *handlers) 1784fce8a7bbSJon Mason { 1785e26a5843SAllen Hubbe struct ntb_dev *ndev; 1786e26a5843SAllen Hubbe struct pci_dev *pdev; 1787e26a5843SAllen Hubbe struct ntb_transport_ctx *nt; 1788fce8a7bbSJon Mason struct ntb_queue_entry *entry; 1789fce8a7bbSJon Mason struct ntb_transport_qp *qp; 1790e26a5843SAllen Hubbe u64 qp_bit; 1791fce8a7bbSJon Mason unsigned int free_queue; 17921199aa61SAllen Hubbe dma_cap_mask_t dma_mask; 17931199aa61SAllen Hubbe int node; 1794e26a5843SAllen Hubbe int i; 1795fce8a7bbSJon Mason 1796e26a5843SAllen Hubbe ndev = dev_ntb(client_dev->parent); 1797e26a5843SAllen Hubbe pdev = ndev->pdev; 1798e26a5843SAllen Hubbe nt = ndev->ctx; 1799fce8a7bbSJon Mason 18001199aa61SAllen Hubbe node = dev_to_node(&ndev->dev); 18011199aa61SAllen Hubbe 1802fce8a7bbSJon Mason free_queue = ffs(nt->qp_bitmap); 1803fce8a7bbSJon Mason if (!free_queue) 1804fce8a7bbSJon Mason goto err; 1805fce8a7bbSJon Mason 1806fce8a7bbSJon Mason /* decrement free_queue to make it zero based */ 1807fce8a7bbSJon Mason free_queue--; 1808fce8a7bbSJon Mason 1809e26a5843SAllen Hubbe qp = &nt->qp_vec[free_queue]; 1810e26a5843SAllen Hubbe qp_bit = BIT_ULL(qp->qp_num); 1811fce8a7bbSJon Mason 1812e26a5843SAllen Hubbe nt->qp_bitmap_free &= ~qp_bit; 1813e26a5843SAllen Hubbe 1814fce8a7bbSJon Mason qp->cb_data = data; 1815fce8a7bbSJon Mason qp->rx_handler = handlers->rx_handler; 1816fce8a7bbSJon Mason qp->tx_handler = handlers->tx_handler; 1817fce8a7bbSJon Mason qp->event_handler = handlers->event_handler; 1818fce8a7bbSJon Mason 18191199aa61SAllen Hubbe dma_cap_zero(dma_mask); 18201199aa61SAllen Hubbe dma_cap_set(DMA_MEMCPY, dma_mask); 18211199aa61SAllen Hubbe 1822a41ef053SDave Jiang if (use_dma) { 1823569410caSDave Jiang qp->tx_dma_chan = 1824569410caSDave Jiang dma_request_channel(dma_mask, ntb_dma_filter_fn, 18251199aa61SAllen Hubbe (void *)(unsigned long)node); 1826569410caSDave Jiang if (!qp->tx_dma_chan) 1827569410caSDave Jiang dev_info(&pdev->dev, "Unable to allocate TX DMA channel\n"); 1828569410caSDave Jiang 1829569410caSDave Jiang qp->rx_dma_chan = 1830569410caSDave Jiang dma_request_channel(dma_mask, ntb_dma_filter_fn, 1831569410caSDave Jiang (void *)(unsigned long)node); 1832569410caSDave Jiang if (!qp->rx_dma_chan) 1833569410caSDave Jiang dev_info(&pdev->dev, "Unable to allocate RX DMA channel\n"); 1834a41ef053SDave Jiang } else { 1835569410caSDave Jiang qp->tx_dma_chan = NULL; 1836569410caSDave Jiang qp->rx_dma_chan = NULL; 1837a41ef053SDave Jiang } 1838569410caSDave Jiang 1839569410caSDave Jiang dev_dbg(&pdev->dev, "Using %s memcpy for TX\n", 1840569410caSDave Jiang qp->tx_dma_chan ? "DMA" : "CPU"); 1841569410caSDave Jiang 1842569410caSDave Jiang dev_dbg(&pdev->dev, "Using %s memcpy for RX\n", 1843569410caSDave Jiang qp->rx_dma_chan ? "DMA" : "CPU"); 1844282a2feeSJon Mason 1845fce8a7bbSJon Mason for (i = 0; i < NTB_QP_DEF_NUM_ENTRIES; i++) { 18461199aa61SAllen Hubbe entry = kzalloc_node(sizeof(*entry), GFP_ATOMIC, node); 1847fce8a7bbSJon Mason if (!entry) 1848fce8a7bbSJon Mason goto err1; 1849fce8a7bbSJon Mason 1850282a2feeSJon Mason entry->qp = qp; 1851da2e5ae5SAllen Hubbe ntb_list_add(&qp->ntb_rx_q_lock, &entry->entry, 1852fce8a7bbSJon Mason &qp->rx_free_q); 1853fce8a7bbSJon Mason } 1854a754a8fcSDave Jiang qp->rx_alloc_entry = NTB_QP_DEF_NUM_ENTRIES; 1855fce8a7bbSJon Mason 1856a754a8fcSDave Jiang for (i = 0; i < qp->tx_max_entry; i++) { 18571199aa61SAllen Hubbe entry = kzalloc_node(sizeof(*entry), GFP_ATOMIC, node); 1858fce8a7bbSJon Mason if (!entry) 1859fce8a7bbSJon Mason goto err2; 1860fce8a7bbSJon Mason 1861282a2feeSJon Mason entry->qp = qp; 1862fce8a7bbSJon Mason ntb_list_add(&qp->ntb_tx_free_q_lock, &entry->entry, 1863fce8a7bbSJon Mason &qp->tx_free_q); 1864fce8a7bbSJon Mason } 1865fce8a7bbSJon Mason 1866e26a5843SAllen Hubbe ntb_db_clear(qp->ndev, qp_bit); 1867e26a5843SAllen Hubbe ntb_db_clear_mask(qp->ndev, qp_bit); 1868fce8a7bbSJon Mason 1869fce8a7bbSJon Mason dev_info(&pdev->dev, "NTB Transport QP %d created\n", qp->qp_num); 1870fce8a7bbSJon Mason 1871fce8a7bbSJon Mason return qp; 1872fce8a7bbSJon Mason 1873fce8a7bbSJon Mason err2: 1874f766755cSJon Mason while ((entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q))) 1875fce8a7bbSJon Mason kfree(entry); 1876fce8a7bbSJon Mason err1: 1877a754a8fcSDave Jiang qp->rx_alloc_entry = 0; 1878da2e5ae5SAllen Hubbe while ((entry = ntb_list_rm(&qp->ntb_rx_q_lock, &qp->rx_free_q))) 1879fce8a7bbSJon Mason kfree(entry); 1880569410caSDave Jiang if (qp->tx_dma_chan) 1881569410caSDave Jiang dma_release_channel(qp->tx_dma_chan); 1882569410caSDave Jiang if (qp->rx_dma_chan) 1883569410caSDave Jiang dma_release_channel(qp->rx_dma_chan); 1884e26a5843SAllen Hubbe nt->qp_bitmap_free |= qp_bit; 1885fce8a7bbSJon Mason err: 1886fce8a7bbSJon Mason return NULL; 1887fce8a7bbSJon Mason } 1888fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_create_queue); 1889fce8a7bbSJon Mason 1890fce8a7bbSJon Mason /** 1891fce8a7bbSJon Mason * ntb_transport_free_queue - Frees NTB transport queue 1892fce8a7bbSJon Mason * @qp: NTB queue to be freed 1893fce8a7bbSJon Mason * 1894fce8a7bbSJon Mason * Frees NTB transport queue 1895fce8a7bbSJon Mason */ 1896fce8a7bbSJon Mason void ntb_transport_free_queue(struct ntb_transport_qp *qp) 1897fce8a7bbSJon Mason { 1898186f27ffSJon Mason struct pci_dev *pdev; 1899fce8a7bbSJon Mason struct ntb_queue_entry *entry; 1900e26a5843SAllen Hubbe u64 qp_bit; 1901fce8a7bbSJon Mason 1902fce8a7bbSJon Mason if (!qp) 1903fce8a7bbSJon Mason return; 1904fce8a7bbSJon Mason 1905e26a5843SAllen Hubbe pdev = qp->ndev->pdev; 1906186f27ffSJon Mason 1907e9021331SDave Jiang qp->active = false; 1908e9021331SDave Jiang 1909569410caSDave Jiang if (qp->tx_dma_chan) { 1910569410caSDave Jiang struct dma_chan *chan = qp->tx_dma_chan; 1911282a2feeSJon Mason /* Putting the dma_chan to NULL will force any new traffic to be 1912282a2feeSJon Mason * processed by the CPU instead of the DAM engine 1913282a2feeSJon Mason */ 1914569410caSDave Jiang qp->tx_dma_chan = NULL; 1915569410caSDave Jiang 1916569410caSDave Jiang /* Try to be nice and wait for any queued DMA engine 1917569410caSDave Jiang * transactions to process before smashing it with a rock 1918569410caSDave Jiang */ 1919569410caSDave Jiang dma_sync_wait(chan, qp->last_cookie); 1920569410caSDave Jiang dmaengine_terminate_all(chan); 1921569410caSDave Jiang dma_release_channel(chan); 1922569410caSDave Jiang } 1923569410caSDave Jiang 1924569410caSDave Jiang if (qp->rx_dma_chan) { 1925569410caSDave Jiang struct dma_chan *chan = qp->rx_dma_chan; 1926569410caSDave Jiang /* Putting the dma_chan to NULL will force any new traffic to be 1927569410caSDave Jiang * processed by the CPU instead of the DAM engine 1928569410caSDave Jiang */ 1929569410caSDave Jiang qp->rx_dma_chan = NULL; 1930282a2feeSJon Mason 1931282a2feeSJon Mason /* Try to be nice and wait for any queued DMA engine 1932282a2feeSJon Mason * transactions to process before smashing it with a rock 1933282a2feeSJon Mason */ 1934282a2feeSJon Mason dma_sync_wait(chan, qp->last_cookie); 1935282a2feeSJon Mason dmaengine_terminate_all(chan); 19361199aa61SAllen Hubbe dma_release_channel(chan); 1937282a2feeSJon Mason } 1938fce8a7bbSJon Mason 1939e26a5843SAllen Hubbe qp_bit = BIT_ULL(qp->qp_num); 1940e26a5843SAllen Hubbe 1941e26a5843SAllen Hubbe ntb_db_set_mask(qp->ndev, qp_bit); 1942e9021331SDave Jiang tasklet_kill(&qp->rxc_db_work); 1943fce8a7bbSJon Mason 1944282a2feeSJon Mason cancel_delayed_work_sync(&qp->link_work); 1945282a2feeSJon Mason 1946e26a5843SAllen Hubbe qp->cb_data = NULL; 1947e26a5843SAllen Hubbe qp->rx_handler = NULL; 1948e26a5843SAllen Hubbe qp->tx_handler = NULL; 1949e26a5843SAllen Hubbe qp->event_handler = NULL; 1950e26a5843SAllen Hubbe 1951da2e5ae5SAllen Hubbe while ((entry = ntb_list_rm(&qp->ntb_rx_q_lock, &qp->rx_free_q))) 1952fce8a7bbSJon Mason kfree(entry); 1953fce8a7bbSJon Mason 1954da2e5ae5SAllen Hubbe while ((entry = ntb_list_rm(&qp->ntb_rx_q_lock, &qp->rx_pend_q))) { 1955da2e5ae5SAllen Hubbe dev_warn(&pdev->dev, "Freeing item from non-empty rx_pend_q\n"); 1956da2e5ae5SAllen Hubbe kfree(entry); 1957da2e5ae5SAllen Hubbe } 1958da2e5ae5SAllen Hubbe 1959da2e5ae5SAllen Hubbe while ((entry = ntb_list_rm(&qp->ntb_rx_q_lock, &qp->rx_post_q))) { 1960da2e5ae5SAllen Hubbe dev_warn(&pdev->dev, "Freeing item from non-empty rx_post_q\n"); 1961fce8a7bbSJon Mason kfree(entry); 1962fce8a7bbSJon Mason } 1963fce8a7bbSJon Mason 1964f766755cSJon Mason while ((entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q))) 1965fce8a7bbSJon Mason kfree(entry); 1966fce8a7bbSJon Mason 196730a4bb1eSAllen Hubbe qp->transport->qp_bitmap_free |= qp_bit; 1968fce8a7bbSJon Mason 1969fce8a7bbSJon Mason dev_info(&pdev->dev, "NTB Transport QP %d freed\n", qp->qp_num); 1970fce8a7bbSJon Mason } 1971fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_free_queue); 1972fce8a7bbSJon Mason 1973fce8a7bbSJon Mason /** 1974fce8a7bbSJon Mason * ntb_transport_rx_remove - Dequeues enqueued rx packet 1975fce8a7bbSJon Mason * @qp: NTB queue to be freed 1976fce8a7bbSJon Mason * @len: pointer to variable to write enqueued buffers length 1977fce8a7bbSJon Mason * 1978fce8a7bbSJon Mason * Dequeues unused buffers from receive queue. Should only be used during 1979fce8a7bbSJon Mason * shutdown of qp. 1980fce8a7bbSJon Mason * 1981fce8a7bbSJon Mason * RETURNS: NULL error value on error, or void* for success. 1982fce8a7bbSJon Mason */ 1983fce8a7bbSJon Mason void *ntb_transport_rx_remove(struct ntb_transport_qp *qp, unsigned int *len) 1984fce8a7bbSJon Mason { 1985fce8a7bbSJon Mason struct ntb_queue_entry *entry; 1986fce8a7bbSJon Mason void *buf; 1987fce8a7bbSJon Mason 1988e26a5843SAllen Hubbe if (!qp || qp->client_ready) 1989fce8a7bbSJon Mason return NULL; 1990fce8a7bbSJon Mason 1991da2e5ae5SAllen Hubbe entry = ntb_list_rm(&qp->ntb_rx_q_lock, &qp->rx_pend_q); 1992fce8a7bbSJon Mason if (!entry) 1993fce8a7bbSJon Mason return NULL; 1994fce8a7bbSJon Mason 1995fce8a7bbSJon Mason buf = entry->cb_data; 1996fce8a7bbSJon Mason *len = entry->len; 1997fce8a7bbSJon Mason 1998da2e5ae5SAllen Hubbe ntb_list_add(&qp->ntb_rx_q_lock, &entry->entry, &qp->rx_free_q); 1999fce8a7bbSJon Mason 2000fce8a7bbSJon Mason return buf; 2001fce8a7bbSJon Mason } 2002fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_rx_remove); 2003fce8a7bbSJon Mason 2004fce8a7bbSJon Mason /** 2005fce8a7bbSJon Mason * ntb_transport_rx_enqueue - Enqueue a new NTB queue entry 2006fce8a7bbSJon Mason * @qp: NTB transport layer queue the entry is to be enqueued on 2007fce8a7bbSJon Mason * @cb: per buffer pointer for callback function to use 2008fce8a7bbSJon Mason * @data: pointer to data buffer that incoming packets will be copied into 2009fce8a7bbSJon Mason * @len: length of the data buffer 2010fce8a7bbSJon Mason * 2011fce8a7bbSJon Mason * Enqueue a new receive buffer onto the transport queue into which a NTB 2012fce8a7bbSJon Mason * payload can be received into. 2013fce8a7bbSJon Mason * 2014fce8a7bbSJon Mason * RETURNS: An appropriate -ERRNO error value on error, or zero for success. 2015fce8a7bbSJon Mason */ 2016fce8a7bbSJon Mason int ntb_transport_rx_enqueue(struct ntb_transport_qp *qp, void *cb, void *data, 2017fce8a7bbSJon Mason unsigned int len) 2018fce8a7bbSJon Mason { 2019fce8a7bbSJon Mason struct ntb_queue_entry *entry; 2020fce8a7bbSJon Mason 2021fce8a7bbSJon Mason if (!qp) 2022fce8a7bbSJon Mason return -EINVAL; 2023fce8a7bbSJon Mason 2024da2e5ae5SAllen Hubbe entry = ntb_list_rm(&qp->ntb_rx_q_lock, &qp->rx_free_q); 2025fce8a7bbSJon Mason if (!entry) 2026fce8a7bbSJon Mason return -ENOMEM; 2027fce8a7bbSJon Mason 2028fce8a7bbSJon Mason entry->cb_data = cb; 2029fce8a7bbSJon Mason entry->buf = data; 2030fce8a7bbSJon Mason entry->len = len; 2031da2e5ae5SAllen Hubbe entry->flags = 0; 2032*72203572SDave Jiang entry->retries = 0; 2033*72203572SDave Jiang entry->errors = 0; 2034*72203572SDave Jiang entry->rx_index = 0; 2035fce8a7bbSJon Mason 2036da2e5ae5SAllen Hubbe ntb_list_add(&qp->ntb_rx_q_lock, &entry->entry, &qp->rx_pend_q); 2037da2e5ae5SAllen Hubbe 2038e9021331SDave Jiang if (qp->active) 2039da2e5ae5SAllen Hubbe tasklet_schedule(&qp->rxc_db_work); 2040fce8a7bbSJon Mason 2041fce8a7bbSJon Mason return 0; 2042fce8a7bbSJon Mason } 2043fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_rx_enqueue); 2044fce8a7bbSJon Mason 2045fce8a7bbSJon Mason /** 2046fce8a7bbSJon Mason * ntb_transport_tx_enqueue - Enqueue a new NTB queue entry 2047fce8a7bbSJon Mason * @qp: NTB transport layer queue the entry is to be enqueued on 2048fce8a7bbSJon Mason * @cb: per buffer pointer for callback function to use 2049fce8a7bbSJon Mason * @data: pointer to data buffer that will be sent 2050fce8a7bbSJon Mason * @len: length of the data buffer 2051fce8a7bbSJon Mason * 2052fce8a7bbSJon Mason * Enqueue a new transmit buffer onto the transport queue from which a NTB 2053f9a2cf89SJon Mason * payload will be transmitted. This assumes that a lock is being held to 2054fce8a7bbSJon Mason * serialize access to the qp. 2055fce8a7bbSJon Mason * 2056fce8a7bbSJon Mason * RETURNS: An appropriate -ERRNO error value on error, or zero for success. 2057fce8a7bbSJon Mason */ 2058fce8a7bbSJon Mason int ntb_transport_tx_enqueue(struct ntb_transport_qp *qp, void *cb, void *data, 2059fce8a7bbSJon Mason unsigned int len) 2060fce8a7bbSJon Mason { 2061fce8a7bbSJon Mason struct ntb_queue_entry *entry; 2062fce8a7bbSJon Mason int rc; 2063fce8a7bbSJon Mason 2064e26a5843SAllen Hubbe if (!qp || !qp->link_is_up || !len) 2065fce8a7bbSJon Mason return -EINVAL; 2066fce8a7bbSJon Mason 2067fce8a7bbSJon Mason entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q); 2068282a2feeSJon Mason if (!entry) { 2069282a2feeSJon Mason qp->tx_err_no_buf++; 2070e74bfeedSDave Jiang return -EBUSY; 2071282a2feeSJon Mason } 2072fce8a7bbSJon Mason 2073fce8a7bbSJon Mason entry->cb_data = cb; 2074fce8a7bbSJon Mason entry->buf = data; 2075fce8a7bbSJon Mason entry->len = len; 2076fce8a7bbSJon Mason entry->flags = 0; 20779cabc269SDave Jiang entry->errors = 0; 20789cabc269SDave Jiang entry->retries = 0; 20799cabc269SDave Jiang entry->tx_index = 0; 2080fce8a7bbSJon Mason 2081fce8a7bbSJon Mason rc = ntb_process_tx(qp, entry); 2082fce8a7bbSJon Mason if (rc) 2083fce8a7bbSJon Mason ntb_list_add(&qp->ntb_tx_free_q_lock, &entry->entry, 2084fce8a7bbSJon Mason &qp->tx_free_q); 2085fce8a7bbSJon Mason 2086fce8a7bbSJon Mason return rc; 2087fce8a7bbSJon Mason } 2088fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_tx_enqueue); 2089fce8a7bbSJon Mason 2090fce8a7bbSJon Mason /** 2091fce8a7bbSJon Mason * ntb_transport_link_up - Notify NTB transport of client readiness to use queue 2092fce8a7bbSJon Mason * @qp: NTB transport layer queue to be enabled 2093fce8a7bbSJon Mason * 2094fce8a7bbSJon Mason * Notify NTB transport layer of client readiness to use queue 2095fce8a7bbSJon Mason */ 2096fce8a7bbSJon Mason void ntb_transport_link_up(struct ntb_transport_qp *qp) 2097fce8a7bbSJon Mason { 2098fce8a7bbSJon Mason if (!qp) 2099fce8a7bbSJon Mason return; 2100fce8a7bbSJon Mason 2101e26a5843SAllen Hubbe qp->client_ready = true; 2102fce8a7bbSJon Mason 2103e26a5843SAllen Hubbe if (qp->transport->link_is_up) 2104fce8a7bbSJon Mason schedule_delayed_work(&qp->link_work, 0); 2105fce8a7bbSJon Mason } 2106fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_link_up); 2107fce8a7bbSJon Mason 2108fce8a7bbSJon Mason /** 2109fce8a7bbSJon Mason * ntb_transport_link_down - Notify NTB transport to no longer enqueue data 2110fce8a7bbSJon Mason * @qp: NTB transport layer queue to be disabled 2111fce8a7bbSJon Mason * 2112fce8a7bbSJon Mason * Notify NTB transport layer of client's desire to no longer receive data on 2113fce8a7bbSJon Mason * transport queue specified. It is the client's responsibility to ensure all 2114f9a2cf89SJon Mason * entries on queue are purged or otherwise handled appropriately. 2115fce8a7bbSJon Mason */ 2116fce8a7bbSJon Mason void ntb_transport_link_down(struct ntb_transport_qp *qp) 2117fce8a7bbSJon Mason { 2118e26a5843SAllen Hubbe int val; 2119fce8a7bbSJon Mason 2120fce8a7bbSJon Mason if (!qp) 2121fce8a7bbSJon Mason return; 2122fce8a7bbSJon Mason 2123e26a5843SAllen Hubbe qp->client_ready = false; 2124fce8a7bbSJon Mason 2125e26a5843SAllen Hubbe val = ntb_spad_read(qp->ndev, QP_LINKS); 2126fce8a7bbSJon Mason 2127e26a5843SAllen Hubbe ntb_peer_spad_write(qp->ndev, QP_LINKS, 2128e26a5843SAllen Hubbe val & ~BIT(qp->qp_num)); 2129fce8a7bbSJon Mason 2130e26a5843SAllen Hubbe if (qp->link_is_up) 2131fce8a7bbSJon Mason ntb_send_link_down(qp); 2132fce8a7bbSJon Mason else 2133fce8a7bbSJon Mason cancel_delayed_work_sync(&qp->link_work); 2134fce8a7bbSJon Mason } 2135fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_link_down); 2136fce8a7bbSJon Mason 2137fce8a7bbSJon Mason /** 2138fce8a7bbSJon Mason * ntb_transport_link_query - Query transport link state 2139fce8a7bbSJon Mason * @qp: NTB transport layer queue to be queried 2140fce8a7bbSJon Mason * 2141fce8a7bbSJon Mason * Query connectivity to the remote system of the NTB transport queue 2142fce8a7bbSJon Mason * 2143fce8a7bbSJon Mason * RETURNS: true for link up or false for link down 2144fce8a7bbSJon Mason */ 2145fce8a7bbSJon Mason bool ntb_transport_link_query(struct ntb_transport_qp *qp) 2146fce8a7bbSJon Mason { 2147186f27ffSJon Mason if (!qp) 2148186f27ffSJon Mason return false; 2149186f27ffSJon Mason 2150e26a5843SAllen Hubbe return qp->link_is_up; 2151fce8a7bbSJon Mason } 2152fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_link_query); 2153fce8a7bbSJon Mason 2154fce8a7bbSJon Mason /** 2155fce8a7bbSJon Mason * ntb_transport_qp_num - Query the qp number 2156fce8a7bbSJon Mason * @qp: NTB transport layer queue to be queried 2157fce8a7bbSJon Mason * 2158fce8a7bbSJon Mason * Query qp number of the NTB transport queue 2159fce8a7bbSJon Mason * 2160fce8a7bbSJon Mason * RETURNS: a zero based number specifying the qp number 2161fce8a7bbSJon Mason */ 2162fce8a7bbSJon Mason unsigned char ntb_transport_qp_num(struct ntb_transport_qp *qp) 2163fce8a7bbSJon Mason { 2164186f27ffSJon Mason if (!qp) 2165186f27ffSJon Mason return 0; 2166186f27ffSJon Mason 2167fce8a7bbSJon Mason return qp->qp_num; 2168fce8a7bbSJon Mason } 2169fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_qp_num); 2170fce8a7bbSJon Mason 2171fce8a7bbSJon Mason /** 2172fce8a7bbSJon Mason * ntb_transport_max_size - Query the max payload size of a qp 2173fce8a7bbSJon Mason * @qp: NTB transport layer queue to be queried 2174fce8a7bbSJon Mason * 2175fce8a7bbSJon Mason * Query the maximum payload size permissible on the given qp 2176fce8a7bbSJon Mason * 2177fce8a7bbSJon Mason * RETURNS: the max payload size of a qp 2178fce8a7bbSJon Mason */ 2179ef114ed5SJon Mason unsigned int ntb_transport_max_size(struct ntb_transport_qp *qp) 2180fce8a7bbSJon Mason { 218104afde45SDave Jiang unsigned int max_size; 2182569410caSDave Jiang unsigned int copy_align; 218304afde45SDave Jiang struct dma_chan *rx_chan, *tx_chan; 2184282a2feeSJon Mason 2185186f27ffSJon Mason if (!qp) 2186186f27ffSJon Mason return 0; 2187186f27ffSJon Mason 218804afde45SDave Jiang rx_chan = qp->rx_dma_chan; 218904afde45SDave Jiang tx_chan = qp->tx_dma_chan; 2190282a2feeSJon Mason 219104afde45SDave Jiang copy_align = max(rx_chan ? rx_chan->device->copy_align : 0, 219204afde45SDave Jiang tx_chan ? tx_chan->device->copy_align : 0); 2193569410caSDave Jiang 2194282a2feeSJon Mason /* If DMA engine usage is possible, try to find the max size for that */ 219504afde45SDave Jiang max_size = qp->tx_max_frame - sizeof(struct ntb_payload_header); 219604afde45SDave Jiang max_size = round_down(max_size, 1 << copy_align); 2197282a2feeSJon Mason 219804afde45SDave Jiang return max_size; 2199fce8a7bbSJon Mason } 2200fce8a7bbSJon Mason EXPORT_SYMBOL_GPL(ntb_transport_max_size); 2201e26a5843SAllen Hubbe 2202e74bfeedSDave Jiang unsigned int ntb_transport_tx_free_entry(struct ntb_transport_qp *qp) 2203e74bfeedSDave Jiang { 2204e74bfeedSDave Jiang unsigned int head = qp->tx_index; 2205e74bfeedSDave Jiang unsigned int tail = qp->remote_rx_info->entry; 2206e74bfeedSDave Jiang 2207e74bfeedSDave Jiang return tail > head ? tail - head : qp->tx_max_entry + tail - head; 2208e74bfeedSDave Jiang } 2209e74bfeedSDave Jiang EXPORT_SYMBOL_GPL(ntb_transport_tx_free_entry); 2210e74bfeedSDave Jiang 2211e26a5843SAllen Hubbe static void ntb_transport_doorbell_callback(void *data, int vector) 2212e26a5843SAllen Hubbe { 2213e26a5843SAllen Hubbe struct ntb_transport_ctx *nt = data; 2214e26a5843SAllen Hubbe struct ntb_transport_qp *qp; 2215e26a5843SAllen Hubbe u64 db_bits; 2216e26a5843SAllen Hubbe unsigned int qp_num; 2217e26a5843SAllen Hubbe 2218e26a5843SAllen Hubbe db_bits = (nt->qp_bitmap & ~nt->qp_bitmap_free & 2219e26a5843SAllen Hubbe ntb_db_vector_mask(nt->ndev, vector)); 2220e26a5843SAllen Hubbe 2221e26a5843SAllen Hubbe while (db_bits) { 2222e26a5843SAllen Hubbe qp_num = __ffs(db_bits); 2223e26a5843SAllen Hubbe qp = &nt->qp_vec[qp_num]; 2224e26a5843SAllen Hubbe 2225e9021331SDave Jiang if (qp->active) 2226e26a5843SAllen Hubbe tasklet_schedule(&qp->rxc_db_work); 2227e26a5843SAllen Hubbe 2228e26a5843SAllen Hubbe db_bits &= ~BIT_ULL(qp_num); 2229e26a5843SAllen Hubbe } 2230e26a5843SAllen Hubbe } 2231e26a5843SAllen Hubbe 2232e26a5843SAllen Hubbe static const struct ntb_ctx_ops ntb_transport_ops = { 2233e26a5843SAllen Hubbe .link_event = ntb_transport_event_callback, 2234e26a5843SAllen Hubbe .db_event = ntb_transport_doorbell_callback, 2235e26a5843SAllen Hubbe }; 2236e26a5843SAllen Hubbe 2237e26a5843SAllen Hubbe static struct ntb_client ntb_transport_client = { 2238e26a5843SAllen Hubbe .ops = { 2239e26a5843SAllen Hubbe .probe = ntb_transport_probe, 2240e26a5843SAllen Hubbe .remove = ntb_transport_free, 2241e26a5843SAllen Hubbe }, 2242e26a5843SAllen Hubbe }; 2243e26a5843SAllen Hubbe 2244e26a5843SAllen Hubbe static int __init ntb_transport_init(void) 2245e26a5843SAllen Hubbe { 2246e26a5843SAllen Hubbe int rc; 2247e26a5843SAllen Hubbe 22487eb38781SDave Jiang pr_info("%s, version %s\n", NTB_TRANSPORT_DESC, NTB_TRANSPORT_VER); 22497eb38781SDave Jiang 2250e26a5843SAllen Hubbe if (debugfs_initialized()) 2251e26a5843SAllen Hubbe nt_debugfs_dir = debugfs_create_dir(KBUILD_MODNAME, NULL); 2252e26a5843SAllen Hubbe 2253e26a5843SAllen Hubbe rc = bus_register(&ntb_transport_bus); 2254e26a5843SAllen Hubbe if (rc) 2255e26a5843SAllen Hubbe goto err_bus; 2256e26a5843SAllen Hubbe 2257e26a5843SAllen Hubbe rc = ntb_register_client(&ntb_transport_client); 2258e26a5843SAllen Hubbe if (rc) 2259e26a5843SAllen Hubbe goto err_client; 2260e26a5843SAllen Hubbe 2261e26a5843SAllen Hubbe return 0; 2262e26a5843SAllen Hubbe 2263e26a5843SAllen Hubbe err_client: 2264e26a5843SAllen Hubbe bus_unregister(&ntb_transport_bus); 2265e26a5843SAllen Hubbe err_bus: 2266e26a5843SAllen Hubbe debugfs_remove_recursive(nt_debugfs_dir); 2267e26a5843SAllen Hubbe return rc; 2268e26a5843SAllen Hubbe } 2269e26a5843SAllen Hubbe module_init(ntb_transport_init); 2270e26a5843SAllen Hubbe 2271e26a5843SAllen Hubbe static void __exit ntb_transport_exit(void) 2272e26a5843SAllen Hubbe { 2273e26a5843SAllen Hubbe debugfs_remove_recursive(nt_debugfs_dir); 2274e26a5843SAllen Hubbe 2275e26a5843SAllen Hubbe ntb_unregister_client(&ntb_transport_client); 2276e26a5843SAllen Hubbe bus_unregister(&ntb_transport_bus); 2277e26a5843SAllen Hubbe } 2278e26a5843SAllen Hubbe module_exit(ntb_transport_exit); 2279