1c0f28ce6SDave Jiang /* 2c0f28ce6SDave Jiang * Intel I/OAT DMA Linux driver 3c0f28ce6SDave Jiang * Copyright(c) 2004 - 2015 Intel Corporation. 4c0f28ce6SDave Jiang * 5c0f28ce6SDave Jiang * This program is free software; you can redistribute it and/or modify it 6c0f28ce6SDave Jiang * under the terms and conditions of the GNU General Public License, 7c0f28ce6SDave Jiang * version 2, as published by the Free Software Foundation. 8c0f28ce6SDave Jiang * 9c0f28ce6SDave Jiang * This program is distributed in the hope that it will be useful, but WITHOUT 10c0f28ce6SDave Jiang * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 11c0f28ce6SDave Jiang * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 12c0f28ce6SDave Jiang * more details. 13c0f28ce6SDave Jiang * 14c0f28ce6SDave Jiang * The full GNU General Public License is included in this distribution in 15c0f28ce6SDave Jiang * the file called "COPYING". 16c0f28ce6SDave Jiang * 17c0f28ce6SDave Jiang */ 18c0f28ce6SDave Jiang 19c0f28ce6SDave Jiang #include <linux/init.h> 20c0f28ce6SDave Jiang #include <linux/module.h> 21c0f28ce6SDave Jiang #include <linux/slab.h> 22c0f28ce6SDave Jiang #include <linux/pci.h> 23c0f28ce6SDave Jiang #include <linux/interrupt.h> 24c0f28ce6SDave Jiang #include <linux/dmaengine.h> 25c0f28ce6SDave Jiang #include <linux/delay.h> 26c0f28ce6SDave Jiang #include <linux/dma-mapping.h> 27c0f28ce6SDave Jiang #include <linux/workqueue.h> 28c0f28ce6SDave Jiang #include <linux/prefetch.h> 29c0f28ce6SDave Jiang #include <linux/dca.h> 30c0f28ce6SDave Jiang #include "dma.h" 31c0f28ce6SDave Jiang #include "registers.h" 32c0f28ce6SDave Jiang #include "hw.h" 33c0f28ce6SDave Jiang 34c0f28ce6SDave Jiang #include "../dmaengine.h" 35c0f28ce6SDave Jiang 36c0f28ce6SDave Jiang MODULE_VERSION(IOAT_DMA_VERSION); 37c0f28ce6SDave Jiang MODULE_LICENSE("Dual BSD/GPL"); 38c0f28ce6SDave Jiang MODULE_AUTHOR("Intel Corporation"); 39c0f28ce6SDave Jiang 40c0f28ce6SDave Jiang static struct pci_device_id ioat_pci_tbl[] = { 41c0f28ce6SDave Jiang /* I/OAT v3 platforms */ 42c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG0) }, 43c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG1) }, 44c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG2) }, 45c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG3) }, 46c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG4) }, 47c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG5) }, 48c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG6) }, 49c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG7) }, 50c0f28ce6SDave Jiang 51c0f28ce6SDave Jiang /* I/OAT v3.2 platforms */ 52c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF0) }, 53c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF1) }, 54c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF2) }, 55c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF3) }, 56c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF4) }, 57c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF5) }, 58c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF6) }, 59c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF7) }, 60c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF8) }, 61c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF9) }, 62c0f28ce6SDave Jiang 63c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB0) }, 64c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB1) }, 65c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB2) }, 66c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB3) }, 67c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB4) }, 68c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB5) }, 69c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB6) }, 70c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB7) }, 71c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB8) }, 72c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB9) }, 73c0f28ce6SDave Jiang 74c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB0) }, 75c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB1) }, 76c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB2) }, 77c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB3) }, 78c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB4) }, 79c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB5) }, 80c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB6) }, 81c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB7) }, 82c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB8) }, 83c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB9) }, 84c0f28ce6SDave Jiang 85c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW0) }, 86c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW1) }, 87c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW2) }, 88c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW3) }, 89c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW4) }, 90c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW5) }, 91c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW6) }, 92c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW7) }, 93c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW8) }, 94c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW9) }, 95c0f28ce6SDave Jiang 96c0f28ce6SDave Jiang /* I/OAT v3.3 platforms */ 97c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BWD0) }, 98c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BWD1) }, 99c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BWD2) }, 100c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BWD3) }, 101c0f28ce6SDave Jiang 102c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDXDE0) }, 103c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDXDE1) }, 104c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDXDE2) }, 105c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDXDE3) }, 106c0f28ce6SDave Jiang 107c0f28ce6SDave Jiang { 0, } 108c0f28ce6SDave Jiang }; 109c0f28ce6SDave Jiang MODULE_DEVICE_TABLE(pci, ioat_pci_tbl); 110c0f28ce6SDave Jiang 111c0f28ce6SDave Jiang static int ioat_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id); 112c0f28ce6SDave Jiang static void ioat_remove(struct pci_dev *pdev); 113599d49deSDave Jiang static void 114599d49deSDave Jiang ioat_init_channel(struct ioatdma_device *ioat_dma, 115599d49deSDave Jiang struct ioatdma_chan *ioat_chan, int idx); 116ef97bd0fSDave Jiang static void ioat_intr_quirk(struct ioatdma_device *ioat_dma); 117ef97bd0fSDave Jiang static int ioat_enumerate_channels(struct ioatdma_device *ioat_dma); 118ef97bd0fSDave Jiang static int ioat3_dma_self_test(struct ioatdma_device *ioat_dma); 119c0f28ce6SDave Jiang 120c0f28ce6SDave Jiang static int ioat_dca_enabled = 1; 121c0f28ce6SDave Jiang module_param(ioat_dca_enabled, int, 0644); 122c0f28ce6SDave Jiang MODULE_PARM_DESC(ioat_dca_enabled, "control support of dca service (default: 1)"); 123c0f28ce6SDave Jiang int ioat_pending_level = 4; 124c0f28ce6SDave Jiang module_param(ioat_pending_level, int, 0644); 125c0f28ce6SDave Jiang MODULE_PARM_DESC(ioat_pending_level, 126c0f28ce6SDave Jiang "high-water mark for pushing ioat descriptors (default: 4)"); 127c0f28ce6SDave Jiang int ioat_ring_alloc_order = 8; 128c0f28ce6SDave Jiang module_param(ioat_ring_alloc_order, int, 0644); 129c0f28ce6SDave Jiang MODULE_PARM_DESC(ioat_ring_alloc_order, 130c0f28ce6SDave Jiang "ioat+: allocate 2^n descriptors per channel (default: 8 max: 16)"); 131c0f28ce6SDave Jiang int ioat_ring_max_alloc_order = IOAT_MAX_ORDER; 132c0f28ce6SDave Jiang module_param(ioat_ring_max_alloc_order, int, 0644); 133c0f28ce6SDave Jiang MODULE_PARM_DESC(ioat_ring_max_alloc_order, 134c0f28ce6SDave Jiang "ioat+: upper limit for ring size (default: 16)"); 135c0f28ce6SDave Jiang static char ioat_interrupt_style[32] = "msix"; 136c0f28ce6SDave Jiang module_param_string(ioat_interrupt_style, ioat_interrupt_style, 137c0f28ce6SDave Jiang sizeof(ioat_interrupt_style), 0644); 138c0f28ce6SDave Jiang MODULE_PARM_DESC(ioat_interrupt_style, 139c0f28ce6SDave Jiang "set ioat interrupt style: msix (default), msi, intx"); 140c0f28ce6SDave Jiang 141c0f28ce6SDave Jiang struct kmem_cache *ioat_cache; 142c0f28ce6SDave Jiang struct kmem_cache *ioat_sed_cache; 143c0f28ce6SDave Jiang 144c0f28ce6SDave Jiang static bool is_jf_ioat(struct pci_dev *pdev) 145c0f28ce6SDave Jiang { 146c0f28ce6SDave Jiang switch (pdev->device) { 147c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF0: 148c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF1: 149c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF2: 150c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF3: 151c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF4: 152c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF5: 153c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF6: 154c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF7: 155c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF8: 156c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF9: 157c0f28ce6SDave Jiang return true; 158c0f28ce6SDave Jiang default: 159c0f28ce6SDave Jiang return false; 160c0f28ce6SDave Jiang } 161c0f28ce6SDave Jiang } 162c0f28ce6SDave Jiang 163c0f28ce6SDave Jiang static bool is_snb_ioat(struct pci_dev *pdev) 164c0f28ce6SDave Jiang { 165c0f28ce6SDave Jiang switch (pdev->device) { 166c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB0: 167c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB1: 168c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB2: 169c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB3: 170c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB4: 171c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB5: 172c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB6: 173c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB7: 174c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB8: 175c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB9: 176c0f28ce6SDave Jiang return true; 177c0f28ce6SDave Jiang default: 178c0f28ce6SDave Jiang return false; 179c0f28ce6SDave Jiang } 180c0f28ce6SDave Jiang } 181c0f28ce6SDave Jiang 182c0f28ce6SDave Jiang static bool is_ivb_ioat(struct pci_dev *pdev) 183c0f28ce6SDave Jiang { 184c0f28ce6SDave Jiang switch (pdev->device) { 185c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB0: 186c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB1: 187c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB2: 188c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB3: 189c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB4: 190c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB5: 191c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB6: 192c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB7: 193c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB8: 194c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB9: 195c0f28ce6SDave Jiang return true; 196c0f28ce6SDave Jiang default: 197c0f28ce6SDave Jiang return false; 198c0f28ce6SDave Jiang } 199c0f28ce6SDave Jiang 200c0f28ce6SDave Jiang } 201c0f28ce6SDave Jiang 202c0f28ce6SDave Jiang static bool is_hsw_ioat(struct pci_dev *pdev) 203c0f28ce6SDave Jiang { 204c0f28ce6SDave Jiang switch (pdev->device) { 205c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW0: 206c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW1: 207c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW2: 208c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW3: 209c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW4: 210c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW5: 211c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW6: 212c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW7: 213c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW8: 214c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW9: 215c0f28ce6SDave Jiang return true; 216c0f28ce6SDave Jiang default: 217c0f28ce6SDave Jiang return false; 218c0f28ce6SDave Jiang } 219c0f28ce6SDave Jiang 220c0f28ce6SDave Jiang } 221c0f28ce6SDave Jiang 222c0f28ce6SDave Jiang static bool is_xeon_cb32(struct pci_dev *pdev) 223c0f28ce6SDave Jiang { 224c0f28ce6SDave Jiang return is_jf_ioat(pdev) || is_snb_ioat(pdev) || is_ivb_ioat(pdev) || 225c0f28ce6SDave Jiang is_hsw_ioat(pdev); 226c0f28ce6SDave Jiang } 227c0f28ce6SDave Jiang 228c0f28ce6SDave Jiang bool is_bwd_ioat(struct pci_dev *pdev) 229c0f28ce6SDave Jiang { 230c0f28ce6SDave Jiang switch (pdev->device) { 231c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BWD0: 232c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BWD1: 233c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BWD2: 234c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BWD3: 235c0f28ce6SDave Jiang /* even though not Atom, BDX-DE has same DMA silicon */ 236c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE0: 237c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE1: 238c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE2: 239c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE3: 240c0f28ce6SDave Jiang return true; 241c0f28ce6SDave Jiang default: 242c0f28ce6SDave Jiang return false; 243c0f28ce6SDave Jiang } 244c0f28ce6SDave Jiang } 245c0f28ce6SDave Jiang 246c0f28ce6SDave Jiang static bool is_bwd_noraid(struct pci_dev *pdev) 247c0f28ce6SDave Jiang { 248c0f28ce6SDave Jiang switch (pdev->device) { 249c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BWD2: 250c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BWD3: 251c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE0: 252c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE1: 253c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE2: 254c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE3: 255c0f28ce6SDave Jiang return true; 256c0f28ce6SDave Jiang default: 257c0f28ce6SDave Jiang return false; 258c0f28ce6SDave Jiang } 259c0f28ce6SDave Jiang 260c0f28ce6SDave Jiang } 261c0f28ce6SDave Jiang 262c0f28ce6SDave Jiang /* 263c0f28ce6SDave Jiang * Perform a IOAT transaction to verify the HW works. 264c0f28ce6SDave Jiang */ 265c0f28ce6SDave Jiang #define IOAT_TEST_SIZE 2000 266c0f28ce6SDave Jiang 267c0f28ce6SDave Jiang static void ioat_dma_test_callback(void *dma_async_param) 268c0f28ce6SDave Jiang { 269c0f28ce6SDave Jiang struct completion *cmp = dma_async_param; 270c0f28ce6SDave Jiang 271c0f28ce6SDave Jiang complete(cmp); 272c0f28ce6SDave Jiang } 273c0f28ce6SDave Jiang 274c0f28ce6SDave Jiang /** 275c0f28ce6SDave Jiang * ioat_dma_self_test - Perform a IOAT transaction to verify the HW works. 276c0f28ce6SDave Jiang * @ioat_dma: dma device to be tested 277c0f28ce6SDave Jiang */ 278599d49deSDave Jiang static int ioat_dma_self_test(struct ioatdma_device *ioat_dma) 279c0f28ce6SDave Jiang { 280c0f28ce6SDave Jiang int i; 281c0f28ce6SDave Jiang u8 *src; 282c0f28ce6SDave Jiang u8 *dest; 283c0f28ce6SDave Jiang struct dma_device *dma = &ioat_dma->dma_dev; 284c0f28ce6SDave Jiang struct device *dev = &ioat_dma->pdev->dev; 285c0f28ce6SDave Jiang struct dma_chan *dma_chan; 286c0f28ce6SDave Jiang struct dma_async_tx_descriptor *tx; 287c0f28ce6SDave Jiang dma_addr_t dma_dest, dma_src; 288c0f28ce6SDave Jiang dma_cookie_t cookie; 289c0f28ce6SDave Jiang int err = 0; 290c0f28ce6SDave Jiang struct completion cmp; 291c0f28ce6SDave Jiang unsigned long tmo; 292c0f28ce6SDave Jiang unsigned long flags; 293c0f28ce6SDave Jiang 294c0f28ce6SDave Jiang src = kzalloc(sizeof(u8) * IOAT_TEST_SIZE, GFP_KERNEL); 295c0f28ce6SDave Jiang if (!src) 296c0f28ce6SDave Jiang return -ENOMEM; 297c0f28ce6SDave Jiang dest = kzalloc(sizeof(u8) * IOAT_TEST_SIZE, GFP_KERNEL); 298c0f28ce6SDave Jiang if (!dest) { 299c0f28ce6SDave Jiang kfree(src); 300c0f28ce6SDave Jiang return -ENOMEM; 301c0f28ce6SDave Jiang } 302c0f28ce6SDave Jiang 303c0f28ce6SDave Jiang /* Fill in src buffer */ 304c0f28ce6SDave Jiang for (i = 0; i < IOAT_TEST_SIZE; i++) 305c0f28ce6SDave Jiang src[i] = (u8)i; 306c0f28ce6SDave Jiang 307c0f28ce6SDave Jiang /* Start copy, using first DMA channel */ 308c0f28ce6SDave Jiang dma_chan = container_of(dma->channels.next, struct dma_chan, 309c0f28ce6SDave Jiang device_node); 310c0f28ce6SDave Jiang if (dma->device_alloc_chan_resources(dma_chan) < 1) { 311c0f28ce6SDave Jiang dev_err(dev, "selftest cannot allocate chan resource\n"); 312c0f28ce6SDave Jiang err = -ENODEV; 313c0f28ce6SDave Jiang goto out; 314c0f28ce6SDave Jiang } 315c0f28ce6SDave Jiang 316c0f28ce6SDave Jiang dma_src = dma_map_single(dev, src, IOAT_TEST_SIZE, DMA_TO_DEVICE); 317c0f28ce6SDave Jiang if (dma_mapping_error(dev, dma_src)) { 318c0f28ce6SDave Jiang dev_err(dev, "mapping src buffer failed\n"); 319c0f28ce6SDave Jiang goto free_resources; 320c0f28ce6SDave Jiang } 321c0f28ce6SDave Jiang dma_dest = dma_map_single(dev, dest, IOAT_TEST_SIZE, DMA_FROM_DEVICE); 322c0f28ce6SDave Jiang if (dma_mapping_error(dev, dma_dest)) { 323c0f28ce6SDave Jiang dev_err(dev, "mapping dest buffer failed\n"); 324c0f28ce6SDave Jiang goto unmap_src; 325c0f28ce6SDave Jiang } 326c0f28ce6SDave Jiang flags = DMA_PREP_INTERRUPT; 327c0f28ce6SDave Jiang tx = ioat_dma->dma_dev.device_prep_dma_memcpy(dma_chan, dma_dest, 328c0f28ce6SDave Jiang dma_src, IOAT_TEST_SIZE, 329c0f28ce6SDave Jiang flags); 330c0f28ce6SDave Jiang if (!tx) { 331c0f28ce6SDave Jiang dev_err(dev, "Self-test prep failed, disabling\n"); 332c0f28ce6SDave Jiang err = -ENODEV; 333c0f28ce6SDave Jiang goto unmap_dma; 334c0f28ce6SDave Jiang } 335c0f28ce6SDave Jiang 336c0f28ce6SDave Jiang async_tx_ack(tx); 337c0f28ce6SDave Jiang init_completion(&cmp); 338c0f28ce6SDave Jiang tx->callback = ioat_dma_test_callback; 339c0f28ce6SDave Jiang tx->callback_param = &cmp; 340c0f28ce6SDave Jiang cookie = tx->tx_submit(tx); 341c0f28ce6SDave Jiang if (cookie < 0) { 342c0f28ce6SDave Jiang dev_err(dev, "Self-test setup failed, disabling\n"); 343c0f28ce6SDave Jiang err = -ENODEV; 344c0f28ce6SDave Jiang goto unmap_dma; 345c0f28ce6SDave Jiang } 346c0f28ce6SDave Jiang dma->device_issue_pending(dma_chan); 347c0f28ce6SDave Jiang 348c0f28ce6SDave Jiang tmo = wait_for_completion_timeout(&cmp, msecs_to_jiffies(3000)); 349c0f28ce6SDave Jiang 350c0f28ce6SDave Jiang if (tmo == 0 || 351c0f28ce6SDave Jiang dma->device_tx_status(dma_chan, cookie, NULL) 352c0f28ce6SDave Jiang != DMA_COMPLETE) { 353c0f28ce6SDave Jiang dev_err(dev, "Self-test copy timed out, disabling\n"); 354c0f28ce6SDave Jiang err = -ENODEV; 355c0f28ce6SDave Jiang goto unmap_dma; 356c0f28ce6SDave Jiang } 357c0f28ce6SDave Jiang if (memcmp(src, dest, IOAT_TEST_SIZE)) { 358c0f28ce6SDave Jiang dev_err(dev, "Self-test copy failed compare, disabling\n"); 359c0f28ce6SDave Jiang err = -ENODEV; 360c0f28ce6SDave Jiang goto free_resources; 361c0f28ce6SDave Jiang } 362c0f28ce6SDave Jiang 363c0f28ce6SDave Jiang unmap_dma: 364c0f28ce6SDave Jiang dma_unmap_single(dev, dma_dest, IOAT_TEST_SIZE, DMA_FROM_DEVICE); 365c0f28ce6SDave Jiang unmap_src: 366c0f28ce6SDave Jiang dma_unmap_single(dev, dma_src, IOAT_TEST_SIZE, DMA_TO_DEVICE); 367c0f28ce6SDave Jiang free_resources: 368c0f28ce6SDave Jiang dma->device_free_chan_resources(dma_chan); 369c0f28ce6SDave Jiang out: 370c0f28ce6SDave Jiang kfree(src); 371c0f28ce6SDave Jiang kfree(dest); 372c0f28ce6SDave Jiang return err; 373c0f28ce6SDave Jiang } 374c0f28ce6SDave Jiang 375c0f28ce6SDave Jiang /** 376c0f28ce6SDave Jiang * ioat_dma_setup_interrupts - setup interrupt handler 377c0f28ce6SDave Jiang * @ioat_dma: ioat dma device 378c0f28ce6SDave Jiang */ 379c0f28ce6SDave Jiang int ioat_dma_setup_interrupts(struct ioatdma_device *ioat_dma) 380c0f28ce6SDave Jiang { 381c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan; 382c0f28ce6SDave Jiang struct pci_dev *pdev = ioat_dma->pdev; 383c0f28ce6SDave Jiang struct device *dev = &pdev->dev; 384c0f28ce6SDave Jiang struct msix_entry *msix; 385c0f28ce6SDave Jiang int i, j, msixcnt; 386c0f28ce6SDave Jiang int err = -EINVAL; 387c0f28ce6SDave Jiang u8 intrctrl = 0; 388c0f28ce6SDave Jiang 389c0f28ce6SDave Jiang if (!strcmp(ioat_interrupt_style, "msix")) 390c0f28ce6SDave Jiang goto msix; 391c0f28ce6SDave Jiang if (!strcmp(ioat_interrupt_style, "msi")) 392c0f28ce6SDave Jiang goto msi; 393c0f28ce6SDave Jiang if (!strcmp(ioat_interrupt_style, "intx")) 394c0f28ce6SDave Jiang goto intx; 395c0f28ce6SDave Jiang dev_err(dev, "invalid ioat_interrupt_style %s\n", ioat_interrupt_style); 396c0f28ce6SDave Jiang goto err_no_irq; 397c0f28ce6SDave Jiang 398c0f28ce6SDave Jiang msix: 399c0f28ce6SDave Jiang /* The number of MSI-X vectors should equal the number of channels */ 400c0f28ce6SDave Jiang msixcnt = ioat_dma->dma_dev.chancnt; 401c0f28ce6SDave Jiang for (i = 0; i < msixcnt; i++) 402c0f28ce6SDave Jiang ioat_dma->msix_entries[i].entry = i; 403c0f28ce6SDave Jiang 404c0f28ce6SDave Jiang err = pci_enable_msix_exact(pdev, ioat_dma->msix_entries, msixcnt); 405c0f28ce6SDave Jiang if (err) 406c0f28ce6SDave Jiang goto msi; 407c0f28ce6SDave Jiang 408c0f28ce6SDave Jiang for (i = 0; i < msixcnt; i++) { 409c0f28ce6SDave Jiang msix = &ioat_dma->msix_entries[i]; 410c0f28ce6SDave Jiang ioat_chan = ioat_chan_by_index(ioat_dma, i); 411c0f28ce6SDave Jiang err = devm_request_irq(dev, msix->vector, 412c0f28ce6SDave Jiang ioat_dma_do_interrupt_msix, 0, 413c0f28ce6SDave Jiang "ioat-msix", ioat_chan); 414c0f28ce6SDave Jiang if (err) { 415c0f28ce6SDave Jiang for (j = 0; j < i; j++) { 416c0f28ce6SDave Jiang msix = &ioat_dma->msix_entries[j]; 417c0f28ce6SDave Jiang ioat_chan = ioat_chan_by_index(ioat_dma, j); 418c0f28ce6SDave Jiang devm_free_irq(dev, msix->vector, ioat_chan); 419c0f28ce6SDave Jiang } 420c0f28ce6SDave Jiang goto msi; 421c0f28ce6SDave Jiang } 422c0f28ce6SDave Jiang } 423c0f28ce6SDave Jiang intrctrl |= IOAT_INTRCTRL_MSIX_VECTOR_CONTROL; 424c0f28ce6SDave Jiang ioat_dma->irq_mode = IOAT_MSIX; 425c0f28ce6SDave Jiang goto done; 426c0f28ce6SDave Jiang 427c0f28ce6SDave Jiang msi: 428c0f28ce6SDave Jiang err = pci_enable_msi(pdev); 429c0f28ce6SDave Jiang if (err) 430c0f28ce6SDave Jiang goto intx; 431c0f28ce6SDave Jiang 432c0f28ce6SDave Jiang err = devm_request_irq(dev, pdev->irq, ioat_dma_do_interrupt, 0, 433c0f28ce6SDave Jiang "ioat-msi", ioat_dma); 434c0f28ce6SDave Jiang if (err) { 435c0f28ce6SDave Jiang pci_disable_msi(pdev); 436c0f28ce6SDave Jiang goto intx; 437c0f28ce6SDave Jiang } 438c0f28ce6SDave Jiang ioat_dma->irq_mode = IOAT_MSI; 439c0f28ce6SDave Jiang goto done; 440c0f28ce6SDave Jiang 441c0f28ce6SDave Jiang intx: 442c0f28ce6SDave Jiang err = devm_request_irq(dev, pdev->irq, ioat_dma_do_interrupt, 443c0f28ce6SDave Jiang IRQF_SHARED, "ioat-intx", ioat_dma); 444c0f28ce6SDave Jiang if (err) 445c0f28ce6SDave Jiang goto err_no_irq; 446c0f28ce6SDave Jiang 447c0f28ce6SDave Jiang ioat_dma->irq_mode = IOAT_INTX; 448c0f28ce6SDave Jiang done: 449ef97bd0fSDave Jiang if (is_bwd_ioat(pdev)) 450ef97bd0fSDave Jiang ioat_intr_quirk(ioat_dma); 451c0f28ce6SDave Jiang intrctrl |= IOAT_INTRCTRL_MASTER_INT_EN; 452c0f28ce6SDave Jiang writeb(intrctrl, ioat_dma->reg_base + IOAT_INTRCTRL_OFFSET); 453c0f28ce6SDave Jiang return 0; 454c0f28ce6SDave Jiang 455c0f28ce6SDave Jiang err_no_irq: 456c0f28ce6SDave Jiang /* Disable all interrupt generation */ 457c0f28ce6SDave Jiang writeb(0, ioat_dma->reg_base + IOAT_INTRCTRL_OFFSET); 458c0f28ce6SDave Jiang ioat_dma->irq_mode = IOAT_NOIRQ; 459c0f28ce6SDave Jiang dev_err(dev, "no usable interrupts\n"); 460c0f28ce6SDave Jiang return err; 461c0f28ce6SDave Jiang } 462c0f28ce6SDave Jiang 463c0f28ce6SDave Jiang static void ioat_disable_interrupts(struct ioatdma_device *ioat_dma) 464c0f28ce6SDave Jiang { 465c0f28ce6SDave Jiang /* Disable all interrupt generation */ 466c0f28ce6SDave Jiang writeb(0, ioat_dma->reg_base + IOAT_INTRCTRL_OFFSET); 467c0f28ce6SDave Jiang } 468c0f28ce6SDave Jiang 469599d49deSDave Jiang static int ioat_probe(struct ioatdma_device *ioat_dma) 470c0f28ce6SDave Jiang { 471c0f28ce6SDave Jiang int err = -ENODEV; 472c0f28ce6SDave Jiang struct dma_device *dma = &ioat_dma->dma_dev; 473c0f28ce6SDave Jiang struct pci_dev *pdev = ioat_dma->pdev; 474c0f28ce6SDave Jiang struct device *dev = &pdev->dev; 475c0f28ce6SDave Jiang 476c0f28ce6SDave Jiang /* DMA coherent memory pool for DMA descriptor allocations */ 477c0f28ce6SDave Jiang ioat_dma->dma_pool = pci_pool_create("dma_desc_pool", pdev, 478c0f28ce6SDave Jiang sizeof(struct ioat_dma_descriptor), 479c0f28ce6SDave Jiang 64, 0); 480c0f28ce6SDave Jiang if (!ioat_dma->dma_pool) { 481c0f28ce6SDave Jiang err = -ENOMEM; 482c0f28ce6SDave Jiang goto err_dma_pool; 483c0f28ce6SDave Jiang } 484c0f28ce6SDave Jiang 485c0f28ce6SDave Jiang ioat_dma->completion_pool = pci_pool_create("completion_pool", pdev, 486c0f28ce6SDave Jiang sizeof(u64), 487c0f28ce6SDave Jiang SMP_CACHE_BYTES, 488c0f28ce6SDave Jiang SMP_CACHE_BYTES); 489c0f28ce6SDave Jiang 490c0f28ce6SDave Jiang if (!ioat_dma->completion_pool) { 491c0f28ce6SDave Jiang err = -ENOMEM; 492c0f28ce6SDave Jiang goto err_completion_pool; 493c0f28ce6SDave Jiang } 494c0f28ce6SDave Jiang 495ef97bd0fSDave Jiang ioat_enumerate_channels(ioat_dma); 496c0f28ce6SDave Jiang 497c0f28ce6SDave Jiang dma_cap_set(DMA_MEMCPY, dma->cap_mask); 498c0f28ce6SDave Jiang dma->dev = &pdev->dev; 499c0f28ce6SDave Jiang 500c0f28ce6SDave Jiang if (!dma->chancnt) { 501c0f28ce6SDave Jiang dev_err(dev, "channel enumeration error\n"); 502c0f28ce6SDave Jiang goto err_setup_interrupts; 503c0f28ce6SDave Jiang } 504c0f28ce6SDave Jiang 505c0f28ce6SDave Jiang err = ioat_dma_setup_interrupts(ioat_dma); 506c0f28ce6SDave Jiang if (err) 507c0f28ce6SDave Jiang goto err_setup_interrupts; 508c0f28ce6SDave Jiang 509ef97bd0fSDave Jiang err = ioat3_dma_self_test(ioat_dma); 510c0f28ce6SDave Jiang if (err) 511c0f28ce6SDave Jiang goto err_self_test; 512c0f28ce6SDave Jiang 513c0f28ce6SDave Jiang return 0; 514c0f28ce6SDave Jiang 515c0f28ce6SDave Jiang err_self_test: 516c0f28ce6SDave Jiang ioat_disable_interrupts(ioat_dma); 517c0f28ce6SDave Jiang err_setup_interrupts: 518c0f28ce6SDave Jiang pci_pool_destroy(ioat_dma->completion_pool); 519c0f28ce6SDave Jiang err_completion_pool: 520c0f28ce6SDave Jiang pci_pool_destroy(ioat_dma->dma_pool); 521c0f28ce6SDave Jiang err_dma_pool: 522c0f28ce6SDave Jiang return err; 523c0f28ce6SDave Jiang } 524c0f28ce6SDave Jiang 525599d49deSDave Jiang static int ioat_register(struct ioatdma_device *ioat_dma) 526c0f28ce6SDave Jiang { 527c0f28ce6SDave Jiang int err = dma_async_device_register(&ioat_dma->dma_dev); 528c0f28ce6SDave Jiang 529c0f28ce6SDave Jiang if (err) { 530c0f28ce6SDave Jiang ioat_disable_interrupts(ioat_dma); 531c0f28ce6SDave Jiang pci_pool_destroy(ioat_dma->completion_pool); 532c0f28ce6SDave Jiang pci_pool_destroy(ioat_dma->dma_pool); 533c0f28ce6SDave Jiang } 534c0f28ce6SDave Jiang 535c0f28ce6SDave Jiang return err; 536c0f28ce6SDave Jiang } 537c0f28ce6SDave Jiang 538599d49deSDave Jiang static void ioat_dma_remove(struct ioatdma_device *ioat_dma) 539c0f28ce6SDave Jiang { 540c0f28ce6SDave Jiang struct dma_device *dma = &ioat_dma->dma_dev; 541c0f28ce6SDave Jiang 542c0f28ce6SDave Jiang ioat_disable_interrupts(ioat_dma); 543c0f28ce6SDave Jiang 544c0f28ce6SDave Jiang ioat_kobject_del(ioat_dma); 545c0f28ce6SDave Jiang 546c0f28ce6SDave Jiang dma_async_device_unregister(dma); 547c0f28ce6SDave Jiang 548c0f28ce6SDave Jiang pci_pool_destroy(ioat_dma->dma_pool); 549c0f28ce6SDave Jiang pci_pool_destroy(ioat_dma->completion_pool); 550c0f28ce6SDave Jiang 551c0f28ce6SDave Jiang INIT_LIST_HEAD(&dma->channels); 552c0f28ce6SDave Jiang } 553c0f28ce6SDave Jiang 554c0f28ce6SDave Jiang /** 555c0f28ce6SDave Jiang * ioat_enumerate_channels - find and initialize the device's channels 556c0f28ce6SDave Jiang * @ioat_dma: the ioat dma device to be enumerated 557c0f28ce6SDave Jiang */ 558599d49deSDave Jiang static int ioat_enumerate_channels(struct ioatdma_device *ioat_dma) 559c0f28ce6SDave Jiang { 560c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan; 561c0f28ce6SDave Jiang struct device *dev = &ioat_dma->pdev->dev; 562c0f28ce6SDave Jiang struct dma_device *dma = &ioat_dma->dma_dev; 563c0f28ce6SDave Jiang u8 xfercap_log; 564c0f28ce6SDave Jiang int i; 565c0f28ce6SDave Jiang 566c0f28ce6SDave Jiang INIT_LIST_HEAD(&dma->channels); 567c0f28ce6SDave Jiang dma->chancnt = readb(ioat_dma->reg_base + IOAT_CHANCNT_OFFSET); 568c0f28ce6SDave Jiang dma->chancnt &= 0x1f; /* bits [4:0] valid */ 569c0f28ce6SDave Jiang if (dma->chancnt > ARRAY_SIZE(ioat_dma->idx)) { 570c0f28ce6SDave Jiang dev_warn(dev, "(%d) exceeds max supported channels (%zu)\n", 571c0f28ce6SDave Jiang dma->chancnt, ARRAY_SIZE(ioat_dma->idx)); 572c0f28ce6SDave Jiang dma->chancnt = ARRAY_SIZE(ioat_dma->idx); 573c0f28ce6SDave Jiang } 574c0f28ce6SDave Jiang xfercap_log = readb(ioat_dma->reg_base + IOAT_XFERCAP_OFFSET); 575c0f28ce6SDave Jiang xfercap_log &= 0x1f; /* bits [4:0] valid */ 576c0f28ce6SDave Jiang if (xfercap_log == 0) 577c0f28ce6SDave Jiang return 0; 578c0f28ce6SDave Jiang dev_dbg(dev, "%s: xfercap = %d\n", __func__, 1 << xfercap_log); 579c0f28ce6SDave Jiang 580c0f28ce6SDave Jiang for (i = 0; i < dma->chancnt; i++) { 581c0f28ce6SDave Jiang ioat_chan = devm_kzalloc(dev, sizeof(*ioat_chan), GFP_KERNEL); 582c0f28ce6SDave Jiang if (!ioat_chan) 583c0f28ce6SDave Jiang break; 584c0f28ce6SDave Jiang 585c0f28ce6SDave Jiang ioat_init_channel(ioat_dma, ioat_chan, i); 586c0f28ce6SDave Jiang ioat_chan->xfercap_log = xfercap_log; 587c0f28ce6SDave Jiang spin_lock_init(&ioat_chan->prep_lock); 588ef97bd0fSDave Jiang if (ioat_reset_hw(ioat_chan)) { 589c0f28ce6SDave Jiang i = 0; 590c0f28ce6SDave Jiang break; 591c0f28ce6SDave Jiang } 592c0f28ce6SDave Jiang } 593c0f28ce6SDave Jiang dma->chancnt = i; 594c0f28ce6SDave Jiang return i; 595c0f28ce6SDave Jiang } 596c0f28ce6SDave Jiang 597c0f28ce6SDave Jiang /** 598c0f28ce6SDave Jiang * ioat_free_chan_resources - release all the descriptors 599c0f28ce6SDave Jiang * @chan: the channel to be cleaned 600c0f28ce6SDave Jiang */ 601599d49deSDave Jiang static void ioat_free_chan_resources(struct dma_chan *c) 602c0f28ce6SDave Jiang { 603c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan = to_ioat_chan(c); 604c0f28ce6SDave Jiang struct ioatdma_device *ioat_dma = ioat_chan->ioat_dma; 605c0f28ce6SDave Jiang struct ioat_ring_ent *desc; 606c0f28ce6SDave Jiang const int total_descs = 1 << ioat_chan->alloc_order; 607c0f28ce6SDave Jiang int descs; 608c0f28ce6SDave Jiang int i; 609c0f28ce6SDave Jiang 610c0f28ce6SDave Jiang /* Before freeing channel resources first check 611c0f28ce6SDave Jiang * if they have been previously allocated for this channel. 612c0f28ce6SDave Jiang */ 613c0f28ce6SDave Jiang if (!ioat_chan->ring) 614c0f28ce6SDave Jiang return; 615c0f28ce6SDave Jiang 616c0f28ce6SDave Jiang ioat_stop(ioat_chan); 617ef97bd0fSDave Jiang ioat_reset_hw(ioat_chan); 618c0f28ce6SDave Jiang 619c0f28ce6SDave Jiang spin_lock_bh(&ioat_chan->cleanup_lock); 620c0f28ce6SDave Jiang spin_lock_bh(&ioat_chan->prep_lock); 621c0f28ce6SDave Jiang descs = ioat_ring_space(ioat_chan); 622c0f28ce6SDave Jiang dev_dbg(to_dev(ioat_chan), "freeing %d idle descriptors\n", descs); 623c0f28ce6SDave Jiang for (i = 0; i < descs; i++) { 624c0f28ce6SDave Jiang desc = ioat_get_ring_ent(ioat_chan, ioat_chan->head + i); 625c0f28ce6SDave Jiang ioat_free_ring_ent(desc, c); 626c0f28ce6SDave Jiang } 627c0f28ce6SDave Jiang 628c0f28ce6SDave Jiang if (descs < total_descs) 629c0f28ce6SDave Jiang dev_err(to_dev(ioat_chan), "Freeing %d in use descriptors!\n", 630c0f28ce6SDave Jiang total_descs - descs); 631c0f28ce6SDave Jiang 632c0f28ce6SDave Jiang for (i = 0; i < total_descs - descs; i++) { 633c0f28ce6SDave Jiang desc = ioat_get_ring_ent(ioat_chan, ioat_chan->tail + i); 634c0f28ce6SDave Jiang dump_desc_dbg(ioat_chan, desc); 635c0f28ce6SDave Jiang ioat_free_ring_ent(desc, c); 636c0f28ce6SDave Jiang } 637c0f28ce6SDave Jiang 638c0f28ce6SDave Jiang kfree(ioat_chan->ring); 639c0f28ce6SDave Jiang ioat_chan->ring = NULL; 640c0f28ce6SDave Jiang ioat_chan->alloc_order = 0; 641c0f28ce6SDave Jiang pci_pool_free(ioat_dma->completion_pool, ioat_chan->completion, 642c0f28ce6SDave Jiang ioat_chan->completion_dma); 643c0f28ce6SDave Jiang spin_unlock_bh(&ioat_chan->prep_lock); 644c0f28ce6SDave Jiang spin_unlock_bh(&ioat_chan->cleanup_lock); 645c0f28ce6SDave Jiang 646c0f28ce6SDave Jiang ioat_chan->last_completion = 0; 647c0f28ce6SDave Jiang ioat_chan->completion_dma = 0; 648c0f28ce6SDave Jiang ioat_chan->dmacount = 0; 649c0f28ce6SDave Jiang } 650c0f28ce6SDave Jiang 651c0f28ce6SDave Jiang /* ioat_alloc_chan_resources - allocate/initialize ioat descriptor ring 652c0f28ce6SDave Jiang * @chan: channel to be initialized 653c0f28ce6SDave Jiang */ 654599d49deSDave Jiang static int ioat_alloc_chan_resources(struct dma_chan *c) 655c0f28ce6SDave Jiang { 656c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan = to_ioat_chan(c); 657c0f28ce6SDave Jiang struct ioat_ring_ent **ring; 658c0f28ce6SDave Jiang u64 status; 659c0f28ce6SDave Jiang int order; 660c0f28ce6SDave Jiang int i = 0; 661c0f28ce6SDave Jiang u32 chanerr; 662c0f28ce6SDave Jiang 663c0f28ce6SDave Jiang /* have we already been set up? */ 664c0f28ce6SDave Jiang if (ioat_chan->ring) 665c0f28ce6SDave Jiang return 1 << ioat_chan->alloc_order; 666c0f28ce6SDave Jiang 667c0f28ce6SDave Jiang /* Setup register to interrupt and write completion status on error */ 668c0f28ce6SDave Jiang writew(IOAT_CHANCTRL_RUN, ioat_chan->reg_base + IOAT_CHANCTRL_OFFSET); 669c0f28ce6SDave Jiang 670c0f28ce6SDave Jiang /* allocate a completion writeback area */ 671c0f28ce6SDave Jiang /* doing 2 32bit writes to mmio since 1 64b write doesn't work */ 672c0f28ce6SDave Jiang ioat_chan->completion = 673c0f28ce6SDave Jiang pci_pool_alloc(ioat_chan->ioat_dma->completion_pool, 674c0f28ce6SDave Jiang GFP_KERNEL, &ioat_chan->completion_dma); 675c0f28ce6SDave Jiang if (!ioat_chan->completion) 676c0f28ce6SDave Jiang return -ENOMEM; 677c0f28ce6SDave Jiang 678c0f28ce6SDave Jiang memset(ioat_chan->completion, 0, sizeof(*ioat_chan->completion)); 679c0f28ce6SDave Jiang writel(((u64)ioat_chan->completion_dma) & 0x00000000FFFFFFFF, 680c0f28ce6SDave Jiang ioat_chan->reg_base + IOAT_CHANCMP_OFFSET_LOW); 681c0f28ce6SDave Jiang writel(((u64)ioat_chan->completion_dma) >> 32, 682c0f28ce6SDave Jiang ioat_chan->reg_base + IOAT_CHANCMP_OFFSET_HIGH); 683c0f28ce6SDave Jiang 684c0f28ce6SDave Jiang order = ioat_get_alloc_order(); 685c0f28ce6SDave Jiang ring = ioat_alloc_ring(c, order, GFP_KERNEL); 686c0f28ce6SDave Jiang if (!ring) 687c0f28ce6SDave Jiang return -ENOMEM; 688c0f28ce6SDave Jiang 689c0f28ce6SDave Jiang spin_lock_bh(&ioat_chan->cleanup_lock); 690c0f28ce6SDave Jiang spin_lock_bh(&ioat_chan->prep_lock); 691c0f28ce6SDave Jiang ioat_chan->ring = ring; 692c0f28ce6SDave Jiang ioat_chan->head = 0; 693c0f28ce6SDave Jiang ioat_chan->issued = 0; 694c0f28ce6SDave Jiang ioat_chan->tail = 0; 695c0f28ce6SDave Jiang ioat_chan->alloc_order = order; 696c0f28ce6SDave Jiang set_bit(IOAT_RUN, &ioat_chan->state); 697c0f28ce6SDave Jiang spin_unlock_bh(&ioat_chan->prep_lock); 698c0f28ce6SDave Jiang spin_unlock_bh(&ioat_chan->cleanup_lock); 699c0f28ce6SDave Jiang 700c0f28ce6SDave Jiang ioat_start_null_desc(ioat_chan); 701c0f28ce6SDave Jiang 702c0f28ce6SDave Jiang /* check that we got off the ground */ 703c0f28ce6SDave Jiang do { 704c0f28ce6SDave Jiang udelay(1); 705c0f28ce6SDave Jiang status = ioat_chansts(ioat_chan); 706c0f28ce6SDave Jiang } while (i++ < 20 && !is_ioat_active(status) && !is_ioat_idle(status)); 707c0f28ce6SDave Jiang 708c0f28ce6SDave Jiang if (is_ioat_active(status) || is_ioat_idle(status)) 709c0f28ce6SDave Jiang return 1 << ioat_chan->alloc_order; 710c0f28ce6SDave Jiang 711c0f28ce6SDave Jiang chanerr = readl(ioat_chan->reg_base + IOAT_CHANERR_OFFSET); 712c0f28ce6SDave Jiang 713c0f28ce6SDave Jiang dev_WARN(to_dev(ioat_chan), 714c0f28ce6SDave Jiang "failed to start channel chanerr: %#x\n", chanerr); 715c0f28ce6SDave Jiang ioat_free_chan_resources(c); 716c0f28ce6SDave Jiang return -EFAULT; 717c0f28ce6SDave Jiang } 718c0f28ce6SDave Jiang 719c0f28ce6SDave Jiang /* common channel initialization */ 720599d49deSDave Jiang static void 721c0f28ce6SDave Jiang ioat_init_channel(struct ioatdma_device *ioat_dma, 722c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan, int idx) 723c0f28ce6SDave Jiang { 724c0f28ce6SDave Jiang struct dma_device *dma = &ioat_dma->dma_dev; 725c0f28ce6SDave Jiang struct dma_chan *c = &ioat_chan->dma_chan; 726c0f28ce6SDave Jiang unsigned long data = (unsigned long) c; 727c0f28ce6SDave Jiang 728c0f28ce6SDave Jiang ioat_chan->ioat_dma = ioat_dma; 729c0f28ce6SDave Jiang ioat_chan->reg_base = ioat_dma->reg_base + (0x80 * (idx + 1)); 730c0f28ce6SDave Jiang spin_lock_init(&ioat_chan->cleanup_lock); 731c0f28ce6SDave Jiang ioat_chan->dma_chan.device = dma; 732c0f28ce6SDave Jiang dma_cookie_init(&ioat_chan->dma_chan); 733c0f28ce6SDave Jiang list_add_tail(&ioat_chan->dma_chan.device_node, &dma->channels); 734c0f28ce6SDave Jiang ioat_dma->idx[idx] = ioat_chan; 735c0f28ce6SDave Jiang init_timer(&ioat_chan->timer); 736ef97bd0fSDave Jiang ioat_chan->timer.function = ioat_timer_event; 737c0f28ce6SDave Jiang ioat_chan->timer.data = data; 738ef97bd0fSDave Jiang tasklet_init(&ioat_chan->cleanup_task, ioat_cleanup_event, data); 739c0f28ce6SDave Jiang } 740c0f28ce6SDave Jiang 741c0f28ce6SDave Jiang #define IOAT_NUM_SRC_TEST 6 /* must be <= 8 */ 742c0f28ce6SDave Jiang static int ioat_xor_val_self_test(struct ioatdma_device *ioat_dma) 743c0f28ce6SDave Jiang { 744c0f28ce6SDave Jiang int i, src_idx; 745c0f28ce6SDave Jiang struct page *dest; 746c0f28ce6SDave Jiang struct page *xor_srcs[IOAT_NUM_SRC_TEST]; 747c0f28ce6SDave Jiang struct page *xor_val_srcs[IOAT_NUM_SRC_TEST + 1]; 748c0f28ce6SDave Jiang dma_addr_t dma_srcs[IOAT_NUM_SRC_TEST + 1]; 749c0f28ce6SDave Jiang dma_addr_t dest_dma; 750c0f28ce6SDave Jiang struct dma_async_tx_descriptor *tx; 751c0f28ce6SDave Jiang struct dma_chan *dma_chan; 752c0f28ce6SDave Jiang dma_cookie_t cookie; 753c0f28ce6SDave Jiang u8 cmp_byte = 0; 754c0f28ce6SDave Jiang u32 cmp_word; 755c0f28ce6SDave Jiang u32 xor_val_result; 756c0f28ce6SDave Jiang int err = 0; 757c0f28ce6SDave Jiang struct completion cmp; 758c0f28ce6SDave Jiang unsigned long tmo; 759c0f28ce6SDave Jiang struct device *dev = &ioat_dma->pdev->dev; 760c0f28ce6SDave Jiang struct dma_device *dma = &ioat_dma->dma_dev; 761c0f28ce6SDave Jiang u8 op = 0; 762c0f28ce6SDave Jiang 763c0f28ce6SDave Jiang dev_dbg(dev, "%s\n", __func__); 764c0f28ce6SDave Jiang 765c0f28ce6SDave Jiang if (!dma_has_cap(DMA_XOR, dma->cap_mask)) 766c0f28ce6SDave Jiang return 0; 767c0f28ce6SDave Jiang 768c0f28ce6SDave Jiang for (src_idx = 0; src_idx < IOAT_NUM_SRC_TEST; src_idx++) { 769c0f28ce6SDave Jiang xor_srcs[src_idx] = alloc_page(GFP_KERNEL); 770c0f28ce6SDave Jiang if (!xor_srcs[src_idx]) { 771c0f28ce6SDave Jiang while (src_idx--) 772c0f28ce6SDave Jiang __free_page(xor_srcs[src_idx]); 773c0f28ce6SDave Jiang return -ENOMEM; 774c0f28ce6SDave Jiang } 775c0f28ce6SDave Jiang } 776c0f28ce6SDave Jiang 777c0f28ce6SDave Jiang dest = alloc_page(GFP_KERNEL); 778c0f28ce6SDave Jiang if (!dest) { 779c0f28ce6SDave Jiang while (src_idx--) 780c0f28ce6SDave Jiang __free_page(xor_srcs[src_idx]); 781c0f28ce6SDave Jiang return -ENOMEM; 782c0f28ce6SDave Jiang } 783c0f28ce6SDave Jiang 784c0f28ce6SDave Jiang /* Fill in src buffers */ 785c0f28ce6SDave Jiang for (src_idx = 0; src_idx < IOAT_NUM_SRC_TEST; src_idx++) { 786c0f28ce6SDave Jiang u8 *ptr = page_address(xor_srcs[src_idx]); 787c0f28ce6SDave Jiang 788c0f28ce6SDave Jiang for (i = 0; i < PAGE_SIZE; i++) 789c0f28ce6SDave Jiang ptr[i] = (1 << src_idx); 790c0f28ce6SDave Jiang } 791c0f28ce6SDave Jiang 792c0f28ce6SDave Jiang for (src_idx = 0; src_idx < IOAT_NUM_SRC_TEST; src_idx++) 793c0f28ce6SDave Jiang cmp_byte ^= (u8) (1 << src_idx); 794c0f28ce6SDave Jiang 795c0f28ce6SDave Jiang cmp_word = (cmp_byte << 24) | (cmp_byte << 16) | 796c0f28ce6SDave Jiang (cmp_byte << 8) | cmp_byte; 797c0f28ce6SDave Jiang 798c0f28ce6SDave Jiang memset(page_address(dest), 0, PAGE_SIZE); 799c0f28ce6SDave Jiang 800c0f28ce6SDave Jiang dma_chan = container_of(dma->channels.next, struct dma_chan, 801c0f28ce6SDave Jiang device_node); 802c0f28ce6SDave Jiang if (dma->device_alloc_chan_resources(dma_chan) < 1) { 803c0f28ce6SDave Jiang err = -ENODEV; 804c0f28ce6SDave Jiang goto out; 805c0f28ce6SDave Jiang } 806c0f28ce6SDave Jiang 807c0f28ce6SDave Jiang /* test xor */ 808c0f28ce6SDave Jiang op = IOAT_OP_XOR; 809c0f28ce6SDave Jiang 810c0f28ce6SDave Jiang dest_dma = dma_map_page(dev, dest, 0, PAGE_SIZE, DMA_FROM_DEVICE); 811c0f28ce6SDave Jiang if (dma_mapping_error(dev, dest_dma)) 812c0f28ce6SDave Jiang goto dma_unmap; 813c0f28ce6SDave Jiang 814c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST; i++) 815c0f28ce6SDave Jiang dma_srcs[i] = DMA_ERROR_CODE; 816c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST; i++) { 817c0f28ce6SDave Jiang dma_srcs[i] = dma_map_page(dev, xor_srcs[i], 0, PAGE_SIZE, 818c0f28ce6SDave Jiang DMA_TO_DEVICE); 819c0f28ce6SDave Jiang if (dma_mapping_error(dev, dma_srcs[i])) 820c0f28ce6SDave Jiang goto dma_unmap; 821c0f28ce6SDave Jiang } 822c0f28ce6SDave Jiang tx = dma->device_prep_dma_xor(dma_chan, dest_dma, dma_srcs, 823c0f28ce6SDave Jiang IOAT_NUM_SRC_TEST, PAGE_SIZE, 824c0f28ce6SDave Jiang DMA_PREP_INTERRUPT); 825c0f28ce6SDave Jiang 826c0f28ce6SDave Jiang if (!tx) { 827c0f28ce6SDave Jiang dev_err(dev, "Self-test xor prep failed\n"); 828c0f28ce6SDave Jiang err = -ENODEV; 829c0f28ce6SDave Jiang goto dma_unmap; 830c0f28ce6SDave Jiang } 831c0f28ce6SDave Jiang 832c0f28ce6SDave Jiang async_tx_ack(tx); 833c0f28ce6SDave Jiang init_completion(&cmp); 8343372de58SDave Jiang tx->callback = ioat_dma_test_callback; 835c0f28ce6SDave Jiang tx->callback_param = &cmp; 836c0f28ce6SDave Jiang cookie = tx->tx_submit(tx); 837c0f28ce6SDave Jiang if (cookie < 0) { 838c0f28ce6SDave Jiang dev_err(dev, "Self-test xor setup failed\n"); 839c0f28ce6SDave Jiang err = -ENODEV; 840c0f28ce6SDave Jiang goto dma_unmap; 841c0f28ce6SDave Jiang } 842c0f28ce6SDave Jiang dma->device_issue_pending(dma_chan); 843c0f28ce6SDave Jiang 844c0f28ce6SDave Jiang tmo = wait_for_completion_timeout(&cmp, msecs_to_jiffies(3000)); 845c0f28ce6SDave Jiang 846c0f28ce6SDave Jiang if (tmo == 0 || 847c0f28ce6SDave Jiang dma->device_tx_status(dma_chan, cookie, NULL) != DMA_COMPLETE) { 848c0f28ce6SDave Jiang dev_err(dev, "Self-test xor timed out\n"); 849c0f28ce6SDave Jiang err = -ENODEV; 850c0f28ce6SDave Jiang goto dma_unmap; 851c0f28ce6SDave Jiang } 852c0f28ce6SDave Jiang 853c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST; i++) 854c0f28ce6SDave Jiang dma_unmap_page(dev, dma_srcs[i], PAGE_SIZE, DMA_TO_DEVICE); 855c0f28ce6SDave Jiang 856c0f28ce6SDave Jiang dma_sync_single_for_cpu(dev, dest_dma, PAGE_SIZE, DMA_FROM_DEVICE); 857c0f28ce6SDave Jiang for (i = 0; i < (PAGE_SIZE / sizeof(u32)); i++) { 858c0f28ce6SDave Jiang u32 *ptr = page_address(dest); 859c0f28ce6SDave Jiang 860c0f28ce6SDave Jiang if (ptr[i] != cmp_word) { 861c0f28ce6SDave Jiang dev_err(dev, "Self-test xor failed compare\n"); 862c0f28ce6SDave Jiang err = -ENODEV; 863c0f28ce6SDave Jiang goto free_resources; 864c0f28ce6SDave Jiang } 865c0f28ce6SDave Jiang } 866c0f28ce6SDave Jiang dma_sync_single_for_device(dev, dest_dma, PAGE_SIZE, DMA_FROM_DEVICE); 867c0f28ce6SDave Jiang 868c0f28ce6SDave Jiang dma_unmap_page(dev, dest_dma, PAGE_SIZE, DMA_FROM_DEVICE); 869c0f28ce6SDave Jiang 870c0f28ce6SDave Jiang /* skip validate if the capability is not present */ 871c0f28ce6SDave Jiang if (!dma_has_cap(DMA_XOR_VAL, dma_chan->device->cap_mask)) 872c0f28ce6SDave Jiang goto free_resources; 873c0f28ce6SDave Jiang 874c0f28ce6SDave Jiang op = IOAT_OP_XOR_VAL; 875c0f28ce6SDave Jiang 876c0f28ce6SDave Jiang /* validate the sources with the destintation page */ 877c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST; i++) 878c0f28ce6SDave Jiang xor_val_srcs[i] = xor_srcs[i]; 879c0f28ce6SDave Jiang xor_val_srcs[i] = dest; 880c0f28ce6SDave Jiang 881c0f28ce6SDave Jiang xor_val_result = 1; 882c0f28ce6SDave Jiang 883c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) 884c0f28ce6SDave Jiang dma_srcs[i] = DMA_ERROR_CODE; 885c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) { 886c0f28ce6SDave Jiang dma_srcs[i] = dma_map_page(dev, xor_val_srcs[i], 0, PAGE_SIZE, 887c0f28ce6SDave Jiang DMA_TO_DEVICE); 888c0f28ce6SDave Jiang if (dma_mapping_error(dev, dma_srcs[i])) 889c0f28ce6SDave Jiang goto dma_unmap; 890c0f28ce6SDave Jiang } 891c0f28ce6SDave Jiang tx = dma->device_prep_dma_xor_val(dma_chan, dma_srcs, 892c0f28ce6SDave Jiang IOAT_NUM_SRC_TEST + 1, PAGE_SIZE, 893c0f28ce6SDave Jiang &xor_val_result, DMA_PREP_INTERRUPT); 894c0f28ce6SDave Jiang if (!tx) { 895c0f28ce6SDave Jiang dev_err(dev, "Self-test zero prep failed\n"); 896c0f28ce6SDave Jiang err = -ENODEV; 897c0f28ce6SDave Jiang goto dma_unmap; 898c0f28ce6SDave Jiang } 899c0f28ce6SDave Jiang 900c0f28ce6SDave Jiang async_tx_ack(tx); 901c0f28ce6SDave Jiang init_completion(&cmp); 9023372de58SDave Jiang tx->callback = ioat_dma_test_callback; 903c0f28ce6SDave Jiang tx->callback_param = &cmp; 904c0f28ce6SDave Jiang cookie = tx->tx_submit(tx); 905c0f28ce6SDave Jiang if (cookie < 0) { 906c0f28ce6SDave Jiang dev_err(dev, "Self-test zero setup failed\n"); 907c0f28ce6SDave Jiang err = -ENODEV; 908c0f28ce6SDave Jiang goto dma_unmap; 909c0f28ce6SDave Jiang } 910c0f28ce6SDave Jiang dma->device_issue_pending(dma_chan); 911c0f28ce6SDave Jiang 912c0f28ce6SDave Jiang tmo = wait_for_completion_timeout(&cmp, msecs_to_jiffies(3000)); 913c0f28ce6SDave Jiang 914c0f28ce6SDave Jiang if (tmo == 0 || 915c0f28ce6SDave Jiang dma->device_tx_status(dma_chan, cookie, NULL) != DMA_COMPLETE) { 916c0f28ce6SDave Jiang dev_err(dev, "Self-test validate timed out\n"); 917c0f28ce6SDave Jiang err = -ENODEV; 918c0f28ce6SDave Jiang goto dma_unmap; 919c0f28ce6SDave Jiang } 920c0f28ce6SDave Jiang 921c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) 922c0f28ce6SDave Jiang dma_unmap_page(dev, dma_srcs[i], PAGE_SIZE, DMA_TO_DEVICE); 923c0f28ce6SDave Jiang 924c0f28ce6SDave Jiang if (xor_val_result != 0) { 925c0f28ce6SDave Jiang dev_err(dev, "Self-test validate failed compare\n"); 926c0f28ce6SDave Jiang err = -ENODEV; 927c0f28ce6SDave Jiang goto free_resources; 928c0f28ce6SDave Jiang } 929c0f28ce6SDave Jiang 930c0f28ce6SDave Jiang memset(page_address(dest), 0, PAGE_SIZE); 931c0f28ce6SDave Jiang 932c0f28ce6SDave Jiang /* test for non-zero parity sum */ 933c0f28ce6SDave Jiang op = IOAT_OP_XOR_VAL; 934c0f28ce6SDave Jiang 935c0f28ce6SDave Jiang xor_val_result = 0; 936c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) 937c0f28ce6SDave Jiang dma_srcs[i] = DMA_ERROR_CODE; 938c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) { 939c0f28ce6SDave Jiang dma_srcs[i] = dma_map_page(dev, xor_val_srcs[i], 0, PAGE_SIZE, 940c0f28ce6SDave Jiang DMA_TO_DEVICE); 941c0f28ce6SDave Jiang if (dma_mapping_error(dev, dma_srcs[i])) 942c0f28ce6SDave Jiang goto dma_unmap; 943c0f28ce6SDave Jiang } 944c0f28ce6SDave Jiang tx = dma->device_prep_dma_xor_val(dma_chan, dma_srcs, 945c0f28ce6SDave Jiang IOAT_NUM_SRC_TEST + 1, PAGE_SIZE, 946c0f28ce6SDave Jiang &xor_val_result, DMA_PREP_INTERRUPT); 947c0f28ce6SDave Jiang if (!tx) { 948c0f28ce6SDave Jiang dev_err(dev, "Self-test 2nd zero prep failed\n"); 949c0f28ce6SDave Jiang err = -ENODEV; 950c0f28ce6SDave Jiang goto dma_unmap; 951c0f28ce6SDave Jiang } 952c0f28ce6SDave Jiang 953c0f28ce6SDave Jiang async_tx_ack(tx); 954c0f28ce6SDave Jiang init_completion(&cmp); 9553372de58SDave Jiang tx->callback = ioat_dma_test_callback; 956c0f28ce6SDave Jiang tx->callback_param = &cmp; 957c0f28ce6SDave Jiang cookie = tx->tx_submit(tx); 958c0f28ce6SDave Jiang if (cookie < 0) { 959c0f28ce6SDave Jiang dev_err(dev, "Self-test 2nd zero setup failed\n"); 960c0f28ce6SDave Jiang err = -ENODEV; 961c0f28ce6SDave Jiang goto dma_unmap; 962c0f28ce6SDave Jiang } 963c0f28ce6SDave Jiang dma->device_issue_pending(dma_chan); 964c0f28ce6SDave Jiang 965c0f28ce6SDave Jiang tmo = wait_for_completion_timeout(&cmp, msecs_to_jiffies(3000)); 966c0f28ce6SDave Jiang 967c0f28ce6SDave Jiang if (tmo == 0 || 968c0f28ce6SDave Jiang dma->device_tx_status(dma_chan, cookie, NULL) != DMA_COMPLETE) { 969c0f28ce6SDave Jiang dev_err(dev, "Self-test 2nd validate timed out\n"); 970c0f28ce6SDave Jiang err = -ENODEV; 971c0f28ce6SDave Jiang goto dma_unmap; 972c0f28ce6SDave Jiang } 973c0f28ce6SDave Jiang 974c0f28ce6SDave Jiang if (xor_val_result != SUM_CHECK_P_RESULT) { 975c0f28ce6SDave Jiang dev_err(dev, "Self-test validate failed compare\n"); 976c0f28ce6SDave Jiang err = -ENODEV; 977c0f28ce6SDave Jiang goto dma_unmap; 978c0f28ce6SDave Jiang } 979c0f28ce6SDave Jiang 980c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) 981c0f28ce6SDave Jiang dma_unmap_page(dev, dma_srcs[i], PAGE_SIZE, DMA_TO_DEVICE); 982c0f28ce6SDave Jiang 983c0f28ce6SDave Jiang goto free_resources; 984c0f28ce6SDave Jiang dma_unmap: 985c0f28ce6SDave Jiang if (op == IOAT_OP_XOR) { 986c0f28ce6SDave Jiang if (dest_dma != DMA_ERROR_CODE) 987c0f28ce6SDave Jiang dma_unmap_page(dev, dest_dma, PAGE_SIZE, 988c0f28ce6SDave Jiang DMA_FROM_DEVICE); 989c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST; i++) 990c0f28ce6SDave Jiang if (dma_srcs[i] != DMA_ERROR_CODE) 991c0f28ce6SDave Jiang dma_unmap_page(dev, dma_srcs[i], PAGE_SIZE, 992c0f28ce6SDave Jiang DMA_TO_DEVICE); 993c0f28ce6SDave Jiang } else if (op == IOAT_OP_XOR_VAL) { 994c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) 995c0f28ce6SDave Jiang if (dma_srcs[i] != DMA_ERROR_CODE) 996c0f28ce6SDave Jiang dma_unmap_page(dev, dma_srcs[i], PAGE_SIZE, 997c0f28ce6SDave Jiang DMA_TO_DEVICE); 998c0f28ce6SDave Jiang } 999c0f28ce6SDave Jiang free_resources: 1000c0f28ce6SDave Jiang dma->device_free_chan_resources(dma_chan); 1001c0f28ce6SDave Jiang out: 1002c0f28ce6SDave Jiang src_idx = IOAT_NUM_SRC_TEST; 1003c0f28ce6SDave Jiang while (src_idx--) 1004c0f28ce6SDave Jiang __free_page(xor_srcs[src_idx]); 1005c0f28ce6SDave Jiang __free_page(dest); 1006c0f28ce6SDave Jiang return err; 1007c0f28ce6SDave Jiang } 1008c0f28ce6SDave Jiang 1009c0f28ce6SDave Jiang static int ioat3_dma_self_test(struct ioatdma_device *ioat_dma) 1010c0f28ce6SDave Jiang { 1011*64f1d0ffSDave Jiang int rc; 1012c0f28ce6SDave Jiang 1013*64f1d0ffSDave Jiang rc = ioat_dma_self_test(ioat_dma); 1014c0f28ce6SDave Jiang if (rc) 1015c0f28ce6SDave Jiang return rc; 1016c0f28ce6SDave Jiang 1017c0f28ce6SDave Jiang rc = ioat_xor_val_self_test(ioat_dma); 1018c0f28ce6SDave Jiang 1019*64f1d0ffSDave Jiang return rc; 1020c0f28ce6SDave Jiang } 1021c0f28ce6SDave Jiang 10223372de58SDave Jiang static void ioat_intr_quirk(struct ioatdma_device *ioat_dma) 1023c0f28ce6SDave Jiang { 1024c0f28ce6SDave Jiang struct dma_device *dma; 1025c0f28ce6SDave Jiang struct dma_chan *c; 1026c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan; 1027c0f28ce6SDave Jiang u32 errmask; 1028c0f28ce6SDave Jiang 1029c0f28ce6SDave Jiang dma = &ioat_dma->dma_dev; 1030c0f28ce6SDave Jiang 1031c0f28ce6SDave Jiang /* 1032c0f28ce6SDave Jiang * if we have descriptor write back error status, we mask the 1033c0f28ce6SDave Jiang * error interrupts 1034c0f28ce6SDave Jiang */ 1035c0f28ce6SDave Jiang if (ioat_dma->cap & IOAT_CAP_DWBES) { 1036c0f28ce6SDave Jiang list_for_each_entry(c, &dma->channels, device_node) { 1037c0f28ce6SDave Jiang ioat_chan = to_ioat_chan(c); 1038c0f28ce6SDave Jiang errmask = readl(ioat_chan->reg_base + 1039c0f28ce6SDave Jiang IOAT_CHANERR_MASK_OFFSET); 1040c0f28ce6SDave Jiang errmask |= IOAT_CHANERR_XOR_P_OR_CRC_ERR | 1041c0f28ce6SDave Jiang IOAT_CHANERR_XOR_Q_ERR; 1042c0f28ce6SDave Jiang writel(errmask, ioat_chan->reg_base + 1043c0f28ce6SDave Jiang IOAT_CHANERR_MASK_OFFSET); 1044c0f28ce6SDave Jiang } 1045c0f28ce6SDave Jiang } 1046c0f28ce6SDave Jiang } 1047c0f28ce6SDave Jiang 1048599d49deSDave Jiang static int ioat3_dma_probe(struct ioatdma_device *ioat_dma, int dca) 1049c0f28ce6SDave Jiang { 1050c0f28ce6SDave Jiang struct pci_dev *pdev = ioat_dma->pdev; 1051c0f28ce6SDave Jiang int dca_en = system_has_dca_enabled(pdev); 1052c0f28ce6SDave Jiang struct dma_device *dma; 1053c0f28ce6SDave Jiang struct dma_chan *c; 1054c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan; 1055c0f28ce6SDave Jiang bool is_raid_device = false; 1056c0f28ce6SDave Jiang int err; 1057c0f28ce6SDave Jiang 1058c0f28ce6SDave Jiang dma = &ioat_dma->dma_dev; 1059c0f28ce6SDave Jiang dma->device_prep_dma_memcpy = ioat_dma_prep_memcpy_lock; 1060c0f28ce6SDave Jiang dma->device_issue_pending = ioat_issue_pending; 1061c0f28ce6SDave Jiang dma->device_alloc_chan_resources = ioat_alloc_chan_resources; 1062c0f28ce6SDave Jiang dma->device_free_chan_resources = ioat_free_chan_resources; 1063c0f28ce6SDave Jiang 1064c0f28ce6SDave Jiang dma_cap_set(DMA_INTERRUPT, dma->cap_mask); 1065c0f28ce6SDave Jiang dma->device_prep_dma_interrupt = ioat_prep_interrupt_lock; 1066c0f28ce6SDave Jiang 1067c0f28ce6SDave Jiang ioat_dma->cap = readl(ioat_dma->reg_base + IOAT_DMA_CAP_OFFSET); 1068c0f28ce6SDave Jiang 1069c0f28ce6SDave Jiang if (is_xeon_cb32(pdev) || is_bwd_noraid(pdev)) 1070c0f28ce6SDave Jiang ioat_dma->cap &= 1071c0f28ce6SDave Jiang ~(IOAT_CAP_XOR | IOAT_CAP_PQ | IOAT_CAP_RAID16SS); 1072c0f28ce6SDave Jiang 1073c0f28ce6SDave Jiang /* dca is incompatible with raid operations */ 1074c0f28ce6SDave Jiang if (dca_en && (ioat_dma->cap & (IOAT_CAP_XOR|IOAT_CAP_PQ))) 1075c0f28ce6SDave Jiang ioat_dma->cap &= ~(IOAT_CAP_XOR|IOAT_CAP_PQ); 1076c0f28ce6SDave Jiang 1077c0f28ce6SDave Jiang if (ioat_dma->cap & IOAT_CAP_XOR) { 1078c0f28ce6SDave Jiang is_raid_device = true; 1079c0f28ce6SDave Jiang dma->max_xor = 8; 1080c0f28ce6SDave Jiang 1081c0f28ce6SDave Jiang dma_cap_set(DMA_XOR, dma->cap_mask); 1082c0f28ce6SDave Jiang dma->device_prep_dma_xor = ioat_prep_xor; 1083c0f28ce6SDave Jiang 1084c0f28ce6SDave Jiang dma_cap_set(DMA_XOR_VAL, dma->cap_mask); 1085c0f28ce6SDave Jiang dma->device_prep_dma_xor_val = ioat_prep_xor_val; 1086c0f28ce6SDave Jiang } 1087c0f28ce6SDave Jiang 1088c0f28ce6SDave Jiang if (ioat_dma->cap & IOAT_CAP_PQ) { 1089c0f28ce6SDave Jiang is_raid_device = true; 1090c0f28ce6SDave Jiang 1091c0f28ce6SDave Jiang dma->device_prep_dma_pq = ioat_prep_pq; 1092c0f28ce6SDave Jiang dma->device_prep_dma_pq_val = ioat_prep_pq_val; 1093c0f28ce6SDave Jiang dma_cap_set(DMA_PQ, dma->cap_mask); 1094c0f28ce6SDave Jiang dma_cap_set(DMA_PQ_VAL, dma->cap_mask); 1095c0f28ce6SDave Jiang 1096c0f28ce6SDave Jiang if (ioat_dma->cap & IOAT_CAP_RAID16SS) 1097c0f28ce6SDave Jiang dma_set_maxpq(dma, 16, 0); 1098c0f28ce6SDave Jiang else 1099c0f28ce6SDave Jiang dma_set_maxpq(dma, 8, 0); 1100c0f28ce6SDave Jiang 1101c0f28ce6SDave Jiang if (!(ioat_dma->cap & IOAT_CAP_XOR)) { 1102c0f28ce6SDave Jiang dma->device_prep_dma_xor = ioat_prep_pqxor; 1103c0f28ce6SDave Jiang dma->device_prep_dma_xor_val = ioat_prep_pqxor_val; 1104c0f28ce6SDave Jiang dma_cap_set(DMA_XOR, dma->cap_mask); 1105c0f28ce6SDave Jiang dma_cap_set(DMA_XOR_VAL, dma->cap_mask); 1106c0f28ce6SDave Jiang 1107c0f28ce6SDave Jiang if (ioat_dma->cap & IOAT_CAP_RAID16SS) 1108c0f28ce6SDave Jiang dma->max_xor = 16; 1109c0f28ce6SDave Jiang else 1110c0f28ce6SDave Jiang dma->max_xor = 8; 1111c0f28ce6SDave Jiang } 1112c0f28ce6SDave Jiang } 1113c0f28ce6SDave Jiang 1114c0f28ce6SDave Jiang dma->device_tx_status = ioat_tx_status; 1115c0f28ce6SDave Jiang 1116c0f28ce6SDave Jiang /* starting with CB3.3 super extended descriptors are supported */ 1117c0f28ce6SDave Jiang if (ioat_dma->cap & IOAT_CAP_RAID16SS) { 1118c0f28ce6SDave Jiang char pool_name[14]; 1119c0f28ce6SDave Jiang int i; 1120c0f28ce6SDave Jiang 1121c0f28ce6SDave Jiang for (i = 0; i < MAX_SED_POOLS; i++) { 1122c0f28ce6SDave Jiang snprintf(pool_name, 14, "ioat_hw%d_sed", i); 1123c0f28ce6SDave Jiang 1124c0f28ce6SDave Jiang /* allocate SED DMA pool */ 1125c0f28ce6SDave Jiang ioat_dma->sed_hw_pool[i] = dmam_pool_create(pool_name, 1126c0f28ce6SDave Jiang &pdev->dev, 1127c0f28ce6SDave Jiang SED_SIZE * (i + 1), 64, 0); 1128c0f28ce6SDave Jiang if (!ioat_dma->sed_hw_pool[i]) 1129c0f28ce6SDave Jiang return -ENOMEM; 1130c0f28ce6SDave Jiang 1131c0f28ce6SDave Jiang } 1132c0f28ce6SDave Jiang } 1133c0f28ce6SDave Jiang 1134c0f28ce6SDave Jiang if (!(ioat_dma->cap & (IOAT_CAP_XOR | IOAT_CAP_PQ))) 1135c0f28ce6SDave Jiang dma_cap_set(DMA_PRIVATE, dma->cap_mask); 1136c0f28ce6SDave Jiang 1137c0f28ce6SDave Jiang err = ioat_probe(ioat_dma); 1138c0f28ce6SDave Jiang if (err) 1139c0f28ce6SDave Jiang return err; 1140c0f28ce6SDave Jiang 1141c0f28ce6SDave Jiang list_for_each_entry(c, &dma->channels, device_node) { 1142c0f28ce6SDave Jiang ioat_chan = to_ioat_chan(c); 1143c0f28ce6SDave Jiang writel(IOAT_DMA_DCA_ANY_CPU, 1144c0f28ce6SDave Jiang ioat_chan->reg_base + IOAT_DCACTRL_OFFSET); 1145c0f28ce6SDave Jiang } 1146c0f28ce6SDave Jiang 1147c0f28ce6SDave Jiang err = ioat_register(ioat_dma); 1148c0f28ce6SDave Jiang if (err) 1149c0f28ce6SDave Jiang return err; 1150c0f28ce6SDave Jiang 1151c0f28ce6SDave Jiang ioat_kobject_add(ioat_dma, &ioat_ktype); 1152c0f28ce6SDave Jiang 1153c0f28ce6SDave Jiang if (dca) 11543372de58SDave Jiang ioat_dma->dca = ioat_dca_init(pdev, ioat_dma->reg_base); 1155c0f28ce6SDave Jiang 1156c0f28ce6SDave Jiang return 0; 1157c0f28ce6SDave Jiang } 1158c0f28ce6SDave Jiang 1159c0f28ce6SDave Jiang #define DRV_NAME "ioatdma" 1160c0f28ce6SDave Jiang 1161c0f28ce6SDave Jiang static struct pci_driver ioat_pci_driver = { 1162c0f28ce6SDave Jiang .name = DRV_NAME, 1163c0f28ce6SDave Jiang .id_table = ioat_pci_tbl, 1164c0f28ce6SDave Jiang .probe = ioat_pci_probe, 1165c0f28ce6SDave Jiang .remove = ioat_remove, 1166c0f28ce6SDave Jiang }; 1167c0f28ce6SDave Jiang 1168c0f28ce6SDave Jiang static struct ioatdma_device * 1169c0f28ce6SDave Jiang alloc_ioatdma(struct pci_dev *pdev, void __iomem *iobase) 1170c0f28ce6SDave Jiang { 1171c0f28ce6SDave Jiang struct device *dev = &pdev->dev; 1172c0f28ce6SDave Jiang struct ioatdma_device *d = devm_kzalloc(dev, sizeof(*d), GFP_KERNEL); 1173c0f28ce6SDave Jiang 1174c0f28ce6SDave Jiang if (!d) 1175c0f28ce6SDave Jiang return NULL; 1176c0f28ce6SDave Jiang d->pdev = pdev; 1177c0f28ce6SDave Jiang d->reg_base = iobase; 1178c0f28ce6SDave Jiang return d; 1179c0f28ce6SDave Jiang } 1180c0f28ce6SDave Jiang 1181c0f28ce6SDave Jiang static int ioat_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) 1182c0f28ce6SDave Jiang { 1183c0f28ce6SDave Jiang void __iomem * const *iomap; 1184c0f28ce6SDave Jiang struct device *dev = &pdev->dev; 1185c0f28ce6SDave Jiang struct ioatdma_device *device; 1186c0f28ce6SDave Jiang int err; 1187c0f28ce6SDave Jiang 1188c0f28ce6SDave Jiang err = pcim_enable_device(pdev); 1189c0f28ce6SDave Jiang if (err) 1190c0f28ce6SDave Jiang return err; 1191c0f28ce6SDave Jiang 1192c0f28ce6SDave Jiang err = pcim_iomap_regions(pdev, 1 << IOAT_MMIO_BAR, DRV_NAME); 1193c0f28ce6SDave Jiang if (err) 1194c0f28ce6SDave Jiang return err; 1195c0f28ce6SDave Jiang iomap = pcim_iomap_table(pdev); 1196c0f28ce6SDave Jiang if (!iomap) 1197c0f28ce6SDave Jiang return -ENOMEM; 1198c0f28ce6SDave Jiang 1199c0f28ce6SDave Jiang err = pci_set_dma_mask(pdev, DMA_BIT_MASK(64)); 1200c0f28ce6SDave Jiang if (err) 1201c0f28ce6SDave Jiang err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); 1202c0f28ce6SDave Jiang if (err) 1203c0f28ce6SDave Jiang return err; 1204c0f28ce6SDave Jiang 1205c0f28ce6SDave Jiang err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); 1206c0f28ce6SDave Jiang if (err) 1207c0f28ce6SDave Jiang err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)); 1208c0f28ce6SDave Jiang if (err) 1209c0f28ce6SDave Jiang return err; 1210c0f28ce6SDave Jiang 1211c0f28ce6SDave Jiang device = alloc_ioatdma(pdev, iomap[IOAT_MMIO_BAR]); 1212c0f28ce6SDave Jiang if (!device) 1213c0f28ce6SDave Jiang return -ENOMEM; 1214c0f28ce6SDave Jiang pci_set_master(pdev); 1215c0f28ce6SDave Jiang pci_set_drvdata(pdev, device); 1216c0f28ce6SDave Jiang 1217c0f28ce6SDave Jiang device->version = readb(device->reg_base + IOAT_VER_OFFSET); 1218c0f28ce6SDave Jiang if (device->version >= IOAT_VER_3_0) 1219c0f28ce6SDave Jiang err = ioat3_dma_probe(device, ioat_dca_enabled); 1220c0f28ce6SDave Jiang else 1221c0f28ce6SDave Jiang return -ENODEV; 1222c0f28ce6SDave Jiang 1223c0f28ce6SDave Jiang if (err) { 1224c0f28ce6SDave Jiang dev_err(dev, "Intel(R) I/OAT DMA Engine init failed\n"); 1225c0f28ce6SDave Jiang return -ENODEV; 1226c0f28ce6SDave Jiang } 1227c0f28ce6SDave Jiang 1228c0f28ce6SDave Jiang return 0; 1229c0f28ce6SDave Jiang } 1230c0f28ce6SDave Jiang 1231c0f28ce6SDave Jiang static void ioat_remove(struct pci_dev *pdev) 1232c0f28ce6SDave Jiang { 1233c0f28ce6SDave Jiang struct ioatdma_device *device = pci_get_drvdata(pdev); 1234c0f28ce6SDave Jiang 1235c0f28ce6SDave Jiang if (!device) 1236c0f28ce6SDave Jiang return; 1237c0f28ce6SDave Jiang 1238c0f28ce6SDave Jiang dev_err(&pdev->dev, "Removing dma and dca services\n"); 1239c0f28ce6SDave Jiang if (device->dca) { 1240c0f28ce6SDave Jiang unregister_dca_provider(device->dca, &pdev->dev); 1241c0f28ce6SDave Jiang free_dca_provider(device->dca); 1242c0f28ce6SDave Jiang device->dca = NULL; 1243c0f28ce6SDave Jiang } 1244c0f28ce6SDave Jiang ioat_dma_remove(device); 1245c0f28ce6SDave Jiang } 1246c0f28ce6SDave Jiang 1247c0f28ce6SDave Jiang static int __init ioat_init_module(void) 1248c0f28ce6SDave Jiang { 1249c0f28ce6SDave Jiang int err = -ENOMEM; 1250c0f28ce6SDave Jiang 1251c0f28ce6SDave Jiang pr_info("%s: Intel(R) QuickData Technology Driver %s\n", 1252c0f28ce6SDave Jiang DRV_NAME, IOAT_DMA_VERSION); 1253c0f28ce6SDave Jiang 1254c0f28ce6SDave Jiang ioat_cache = kmem_cache_create("ioat", sizeof(struct ioat_ring_ent), 1255c0f28ce6SDave Jiang 0, SLAB_HWCACHE_ALIGN, NULL); 1256c0f28ce6SDave Jiang if (!ioat_cache) 1257c0f28ce6SDave Jiang return -ENOMEM; 1258c0f28ce6SDave Jiang 1259c0f28ce6SDave Jiang ioat_sed_cache = KMEM_CACHE(ioat_sed_ent, 0); 1260c0f28ce6SDave Jiang if (!ioat_sed_cache) 1261c0f28ce6SDave Jiang goto err_ioat_cache; 1262c0f28ce6SDave Jiang 1263c0f28ce6SDave Jiang err = pci_register_driver(&ioat_pci_driver); 1264c0f28ce6SDave Jiang if (err) 1265c0f28ce6SDave Jiang goto err_ioat3_cache; 1266c0f28ce6SDave Jiang 1267c0f28ce6SDave Jiang return 0; 1268c0f28ce6SDave Jiang 1269c0f28ce6SDave Jiang err_ioat3_cache: 1270c0f28ce6SDave Jiang kmem_cache_destroy(ioat_sed_cache); 1271c0f28ce6SDave Jiang 1272c0f28ce6SDave Jiang err_ioat_cache: 1273c0f28ce6SDave Jiang kmem_cache_destroy(ioat_cache); 1274c0f28ce6SDave Jiang 1275c0f28ce6SDave Jiang return err; 1276c0f28ce6SDave Jiang } 1277c0f28ce6SDave Jiang module_init(ioat_init_module); 1278c0f28ce6SDave Jiang 1279c0f28ce6SDave Jiang static void __exit ioat_exit_module(void) 1280c0f28ce6SDave Jiang { 1281c0f28ce6SDave Jiang pci_unregister_driver(&ioat_pci_driver); 1282c0f28ce6SDave Jiang kmem_cache_destroy(ioat_cache); 1283c0f28ce6SDave Jiang } 1284c0f28ce6SDave Jiang module_exit(ioat_exit_module); 1285