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> 304222a907SDave Jiang #include <linux/aer.h> 31c0f28ce6SDave Jiang #include "dma.h" 32c0f28ce6SDave Jiang #include "registers.h" 33c0f28ce6SDave Jiang #include "hw.h" 34c0f28ce6SDave Jiang 35c0f28ce6SDave Jiang #include "../dmaengine.h" 36c0f28ce6SDave Jiang 37c0f28ce6SDave Jiang MODULE_VERSION(IOAT_DMA_VERSION); 38c0f28ce6SDave Jiang MODULE_LICENSE("Dual BSD/GPL"); 39c0f28ce6SDave Jiang MODULE_AUTHOR("Intel Corporation"); 40c0f28ce6SDave Jiang 41c0f28ce6SDave Jiang static struct pci_device_id ioat_pci_tbl[] = { 42c0f28ce6SDave Jiang /* I/OAT v3 platforms */ 43c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG0) }, 44c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG1) }, 45c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG2) }, 46c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG3) }, 47c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG4) }, 48c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG5) }, 49c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG6) }, 50c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_TBG7) }, 51c0f28ce6SDave Jiang 52c0f28ce6SDave Jiang /* I/OAT v3.2 platforms */ 53c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF0) }, 54c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF1) }, 55c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF2) }, 56c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF3) }, 57c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF4) }, 58c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF5) }, 59c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF6) }, 60c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF7) }, 61c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF8) }, 62c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_JSF9) }, 63c0f28ce6SDave Jiang 64c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB0) }, 65c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB1) }, 66c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB2) }, 67c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB3) }, 68c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB4) }, 69c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB5) }, 70c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB6) }, 71c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB7) }, 72c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB8) }, 73c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_SNB9) }, 74c0f28ce6SDave Jiang 75c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB0) }, 76c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB1) }, 77c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB2) }, 78c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB3) }, 79c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB4) }, 80c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB5) }, 81c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB6) }, 82c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB7) }, 83c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB8) }, 84c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_IVB9) }, 85c0f28ce6SDave Jiang 86c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW0) }, 87c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW1) }, 88c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW2) }, 89c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW3) }, 90c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW4) }, 91c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW5) }, 92c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW6) }, 93c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW7) }, 94c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW8) }, 95c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_HSW9) }, 96c0f28ce6SDave Jiang 97ab98193dSDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDX0) }, 98ab98193dSDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDX1) }, 99ab98193dSDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDX2) }, 100ab98193dSDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDX3) }, 101ab98193dSDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDX4) }, 102ab98193dSDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDX5) }, 103ab98193dSDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDX6) }, 104ab98193dSDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDX7) }, 105ab98193dSDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDX8) }, 106ab98193dSDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDX9) }, 107ab98193dSDave Jiang 108c0f28ce6SDave Jiang /* I/OAT v3.3 platforms */ 109c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BWD0) }, 110c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BWD1) }, 111c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BWD2) }, 112c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BWD3) }, 113c0f28ce6SDave Jiang 114c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDXDE0) }, 115c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDXDE1) }, 116c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDXDE2) }, 117c0f28ce6SDave Jiang { PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_IOAT_BDXDE3) }, 118c0f28ce6SDave Jiang 119c0f28ce6SDave Jiang { 0, } 120c0f28ce6SDave Jiang }; 121c0f28ce6SDave Jiang MODULE_DEVICE_TABLE(pci, ioat_pci_tbl); 122c0f28ce6SDave Jiang 123c0f28ce6SDave Jiang static int ioat_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id); 124c0f28ce6SDave Jiang static void ioat_remove(struct pci_dev *pdev); 125599d49deSDave Jiang static void 126599d49deSDave Jiang ioat_init_channel(struct ioatdma_device *ioat_dma, 127599d49deSDave Jiang struct ioatdma_chan *ioat_chan, int idx); 128ef97bd0fSDave Jiang static void ioat_intr_quirk(struct ioatdma_device *ioat_dma); 129ef97bd0fSDave Jiang static int ioat_enumerate_channels(struct ioatdma_device *ioat_dma); 130ef97bd0fSDave Jiang static int ioat3_dma_self_test(struct ioatdma_device *ioat_dma); 131c0f28ce6SDave Jiang 132c0f28ce6SDave Jiang static int ioat_dca_enabled = 1; 133c0f28ce6SDave Jiang module_param(ioat_dca_enabled, int, 0644); 134c0f28ce6SDave Jiang MODULE_PARM_DESC(ioat_dca_enabled, "control support of dca service (default: 1)"); 135c0f28ce6SDave Jiang int ioat_pending_level = 4; 136c0f28ce6SDave Jiang module_param(ioat_pending_level, int, 0644); 137c0f28ce6SDave Jiang MODULE_PARM_DESC(ioat_pending_level, 138c0f28ce6SDave Jiang "high-water mark for pushing ioat descriptors (default: 4)"); 139c0f28ce6SDave Jiang int ioat_ring_alloc_order = 8; 140c0f28ce6SDave Jiang module_param(ioat_ring_alloc_order, int, 0644); 141c0f28ce6SDave Jiang MODULE_PARM_DESC(ioat_ring_alloc_order, 142c0f28ce6SDave Jiang "ioat+: allocate 2^n descriptors per channel (default: 8 max: 16)"); 143c0f28ce6SDave Jiang int ioat_ring_max_alloc_order = IOAT_MAX_ORDER; 144c0f28ce6SDave Jiang module_param(ioat_ring_max_alloc_order, int, 0644); 145c0f28ce6SDave Jiang MODULE_PARM_DESC(ioat_ring_max_alloc_order, 146c0f28ce6SDave Jiang "ioat+: upper limit for ring size (default: 16)"); 147c0f28ce6SDave Jiang static char ioat_interrupt_style[32] = "msix"; 148c0f28ce6SDave Jiang module_param_string(ioat_interrupt_style, ioat_interrupt_style, 149c0f28ce6SDave Jiang sizeof(ioat_interrupt_style), 0644); 150c0f28ce6SDave Jiang MODULE_PARM_DESC(ioat_interrupt_style, 151c0f28ce6SDave Jiang "set ioat interrupt style: msix (default), msi, intx"); 152c0f28ce6SDave Jiang 153c0f28ce6SDave Jiang struct kmem_cache *ioat_cache; 154c0f28ce6SDave Jiang struct kmem_cache *ioat_sed_cache; 155c0f28ce6SDave Jiang 156c0f28ce6SDave Jiang static bool is_jf_ioat(struct pci_dev *pdev) 157c0f28ce6SDave Jiang { 158c0f28ce6SDave Jiang switch (pdev->device) { 159c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF0: 160c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF1: 161c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF2: 162c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF3: 163c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF4: 164c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF5: 165c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF6: 166c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF7: 167c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF8: 168c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_JSF9: 169c0f28ce6SDave Jiang return true; 170c0f28ce6SDave Jiang default: 171c0f28ce6SDave Jiang return false; 172c0f28ce6SDave Jiang } 173c0f28ce6SDave Jiang } 174c0f28ce6SDave Jiang 175c0f28ce6SDave Jiang static bool is_snb_ioat(struct pci_dev *pdev) 176c0f28ce6SDave Jiang { 177c0f28ce6SDave Jiang switch (pdev->device) { 178c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB0: 179c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB1: 180c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB2: 181c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB3: 182c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB4: 183c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB5: 184c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB6: 185c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB7: 186c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB8: 187c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_SNB9: 188c0f28ce6SDave Jiang return true; 189c0f28ce6SDave Jiang default: 190c0f28ce6SDave Jiang return false; 191c0f28ce6SDave Jiang } 192c0f28ce6SDave Jiang } 193c0f28ce6SDave Jiang 194c0f28ce6SDave Jiang static bool is_ivb_ioat(struct pci_dev *pdev) 195c0f28ce6SDave Jiang { 196c0f28ce6SDave Jiang switch (pdev->device) { 197c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB0: 198c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB1: 199c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB2: 200c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB3: 201c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB4: 202c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB5: 203c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB6: 204c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB7: 205c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB8: 206c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_IVB9: 207c0f28ce6SDave Jiang return true; 208c0f28ce6SDave Jiang default: 209c0f28ce6SDave Jiang return false; 210c0f28ce6SDave Jiang } 211c0f28ce6SDave Jiang 212c0f28ce6SDave Jiang } 213c0f28ce6SDave Jiang 214c0f28ce6SDave Jiang static bool is_hsw_ioat(struct pci_dev *pdev) 215c0f28ce6SDave Jiang { 216c0f28ce6SDave Jiang switch (pdev->device) { 217c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW0: 218c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW1: 219c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW2: 220c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW3: 221c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW4: 222c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW5: 223c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW6: 224c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW7: 225c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW8: 226c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_HSW9: 227c0f28ce6SDave Jiang return true; 228c0f28ce6SDave Jiang default: 229c0f28ce6SDave Jiang return false; 230c0f28ce6SDave Jiang } 231c0f28ce6SDave Jiang 232c0f28ce6SDave Jiang } 233c0f28ce6SDave Jiang 234ab98193dSDave Jiang static bool is_bdx_ioat(struct pci_dev *pdev) 235ab98193dSDave Jiang { 236ab98193dSDave Jiang switch (pdev->device) { 237ab98193dSDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDX0: 238ab98193dSDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDX1: 239ab98193dSDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDX2: 240ab98193dSDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDX3: 241ab98193dSDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDX4: 242ab98193dSDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDX5: 243ab98193dSDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDX6: 244ab98193dSDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDX7: 245ab98193dSDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDX8: 246ab98193dSDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDX9: 247ab98193dSDave Jiang return true; 248ab98193dSDave Jiang default: 249ab98193dSDave Jiang return false; 250ab98193dSDave Jiang } 251ab98193dSDave Jiang } 252ab98193dSDave Jiang 253c0f28ce6SDave Jiang static bool is_xeon_cb32(struct pci_dev *pdev) 254c0f28ce6SDave Jiang { 255c0f28ce6SDave Jiang return is_jf_ioat(pdev) || is_snb_ioat(pdev) || is_ivb_ioat(pdev) || 256ab98193dSDave Jiang is_hsw_ioat(pdev) || is_bdx_ioat(pdev); 257c0f28ce6SDave Jiang } 258c0f28ce6SDave Jiang 259c0f28ce6SDave Jiang bool is_bwd_ioat(struct pci_dev *pdev) 260c0f28ce6SDave Jiang { 261c0f28ce6SDave Jiang switch (pdev->device) { 262c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BWD0: 263c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BWD1: 264c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BWD2: 265c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BWD3: 266c0f28ce6SDave Jiang /* even though not Atom, BDX-DE has same DMA silicon */ 267c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE0: 268c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE1: 269c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE2: 270c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE3: 271c0f28ce6SDave Jiang return true; 272c0f28ce6SDave Jiang default: 273c0f28ce6SDave Jiang return false; 274c0f28ce6SDave Jiang } 275c0f28ce6SDave Jiang } 276c0f28ce6SDave Jiang 277c0f28ce6SDave Jiang static bool is_bwd_noraid(struct pci_dev *pdev) 278c0f28ce6SDave Jiang { 279c0f28ce6SDave Jiang switch (pdev->device) { 280c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BWD2: 281c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BWD3: 282c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE0: 283c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE1: 284c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE2: 285c0f28ce6SDave Jiang case PCI_DEVICE_ID_INTEL_IOAT_BDXDE3: 286c0f28ce6SDave Jiang return true; 287c0f28ce6SDave Jiang default: 288c0f28ce6SDave Jiang return false; 289c0f28ce6SDave Jiang } 290c0f28ce6SDave Jiang 291c0f28ce6SDave Jiang } 292c0f28ce6SDave Jiang 293c0f28ce6SDave Jiang /* 294c0f28ce6SDave Jiang * Perform a IOAT transaction to verify the HW works. 295c0f28ce6SDave Jiang */ 296c0f28ce6SDave Jiang #define IOAT_TEST_SIZE 2000 297c0f28ce6SDave Jiang 298c0f28ce6SDave Jiang static void ioat_dma_test_callback(void *dma_async_param) 299c0f28ce6SDave Jiang { 300c0f28ce6SDave Jiang struct completion *cmp = dma_async_param; 301c0f28ce6SDave Jiang 302c0f28ce6SDave Jiang complete(cmp); 303c0f28ce6SDave Jiang } 304c0f28ce6SDave Jiang 305c0f28ce6SDave Jiang /** 306c0f28ce6SDave Jiang * ioat_dma_self_test - Perform a IOAT transaction to verify the HW works. 307c0f28ce6SDave Jiang * @ioat_dma: dma device to be tested 308c0f28ce6SDave Jiang */ 309599d49deSDave Jiang static int ioat_dma_self_test(struct ioatdma_device *ioat_dma) 310c0f28ce6SDave Jiang { 311c0f28ce6SDave Jiang int i; 312c0f28ce6SDave Jiang u8 *src; 313c0f28ce6SDave Jiang u8 *dest; 314c0f28ce6SDave Jiang struct dma_device *dma = &ioat_dma->dma_dev; 315c0f28ce6SDave Jiang struct device *dev = &ioat_dma->pdev->dev; 316c0f28ce6SDave Jiang struct dma_chan *dma_chan; 317c0f28ce6SDave Jiang struct dma_async_tx_descriptor *tx; 318c0f28ce6SDave Jiang dma_addr_t dma_dest, dma_src; 319c0f28ce6SDave Jiang dma_cookie_t cookie; 320c0f28ce6SDave Jiang int err = 0; 321c0f28ce6SDave Jiang struct completion cmp; 322c0f28ce6SDave Jiang unsigned long tmo; 323c0f28ce6SDave Jiang unsigned long flags; 324c0f28ce6SDave Jiang 325c0f28ce6SDave Jiang src = kzalloc(sizeof(u8) * IOAT_TEST_SIZE, GFP_KERNEL); 326c0f28ce6SDave Jiang if (!src) 327c0f28ce6SDave Jiang return -ENOMEM; 328c0f28ce6SDave Jiang dest = kzalloc(sizeof(u8) * IOAT_TEST_SIZE, GFP_KERNEL); 329c0f28ce6SDave Jiang if (!dest) { 330c0f28ce6SDave Jiang kfree(src); 331c0f28ce6SDave Jiang return -ENOMEM; 332c0f28ce6SDave Jiang } 333c0f28ce6SDave Jiang 334c0f28ce6SDave Jiang /* Fill in src buffer */ 335c0f28ce6SDave Jiang for (i = 0; i < IOAT_TEST_SIZE; i++) 336c0f28ce6SDave Jiang src[i] = (u8)i; 337c0f28ce6SDave Jiang 338c0f28ce6SDave Jiang /* Start copy, using first DMA channel */ 339c0f28ce6SDave Jiang dma_chan = container_of(dma->channels.next, struct dma_chan, 340c0f28ce6SDave Jiang device_node); 341c0f28ce6SDave Jiang if (dma->device_alloc_chan_resources(dma_chan) < 1) { 342c0f28ce6SDave Jiang dev_err(dev, "selftest cannot allocate chan resource\n"); 343c0f28ce6SDave Jiang err = -ENODEV; 344c0f28ce6SDave Jiang goto out; 345c0f28ce6SDave Jiang } 346c0f28ce6SDave Jiang 347c0f28ce6SDave Jiang dma_src = dma_map_single(dev, src, IOAT_TEST_SIZE, DMA_TO_DEVICE); 348c0f28ce6SDave Jiang if (dma_mapping_error(dev, dma_src)) { 349c0f28ce6SDave Jiang dev_err(dev, "mapping src buffer failed\n"); 350c0f28ce6SDave Jiang goto free_resources; 351c0f28ce6SDave Jiang } 352c0f28ce6SDave Jiang dma_dest = dma_map_single(dev, dest, IOAT_TEST_SIZE, DMA_FROM_DEVICE); 353c0f28ce6SDave Jiang if (dma_mapping_error(dev, dma_dest)) { 354c0f28ce6SDave Jiang dev_err(dev, "mapping dest buffer failed\n"); 355c0f28ce6SDave Jiang goto unmap_src; 356c0f28ce6SDave Jiang } 357c0f28ce6SDave Jiang flags = DMA_PREP_INTERRUPT; 358c0f28ce6SDave Jiang tx = ioat_dma->dma_dev.device_prep_dma_memcpy(dma_chan, dma_dest, 359c0f28ce6SDave Jiang dma_src, IOAT_TEST_SIZE, 360c0f28ce6SDave Jiang flags); 361c0f28ce6SDave Jiang if (!tx) { 362c0f28ce6SDave Jiang dev_err(dev, "Self-test prep failed, disabling\n"); 363c0f28ce6SDave Jiang err = -ENODEV; 364c0f28ce6SDave Jiang goto unmap_dma; 365c0f28ce6SDave Jiang } 366c0f28ce6SDave Jiang 367c0f28ce6SDave Jiang async_tx_ack(tx); 368c0f28ce6SDave Jiang init_completion(&cmp); 369c0f28ce6SDave Jiang tx->callback = ioat_dma_test_callback; 370c0f28ce6SDave Jiang tx->callback_param = &cmp; 371c0f28ce6SDave Jiang cookie = tx->tx_submit(tx); 372c0f28ce6SDave Jiang if (cookie < 0) { 373c0f28ce6SDave Jiang dev_err(dev, "Self-test setup failed, disabling\n"); 374c0f28ce6SDave Jiang err = -ENODEV; 375c0f28ce6SDave Jiang goto unmap_dma; 376c0f28ce6SDave Jiang } 377c0f28ce6SDave Jiang dma->device_issue_pending(dma_chan); 378c0f28ce6SDave Jiang 379c0f28ce6SDave Jiang tmo = wait_for_completion_timeout(&cmp, msecs_to_jiffies(3000)); 380c0f28ce6SDave Jiang 381c0f28ce6SDave Jiang if (tmo == 0 || 382c0f28ce6SDave Jiang dma->device_tx_status(dma_chan, cookie, NULL) 383c0f28ce6SDave Jiang != DMA_COMPLETE) { 384c0f28ce6SDave Jiang dev_err(dev, "Self-test copy timed out, disabling\n"); 385c0f28ce6SDave Jiang err = -ENODEV; 386c0f28ce6SDave Jiang goto unmap_dma; 387c0f28ce6SDave Jiang } 388c0f28ce6SDave Jiang if (memcmp(src, dest, IOAT_TEST_SIZE)) { 389c0f28ce6SDave Jiang dev_err(dev, "Self-test copy failed compare, disabling\n"); 390c0f28ce6SDave Jiang err = -ENODEV; 391c0f28ce6SDave Jiang goto free_resources; 392c0f28ce6SDave Jiang } 393c0f28ce6SDave Jiang 394c0f28ce6SDave Jiang unmap_dma: 395c0f28ce6SDave Jiang dma_unmap_single(dev, dma_dest, IOAT_TEST_SIZE, DMA_FROM_DEVICE); 396c0f28ce6SDave Jiang unmap_src: 397c0f28ce6SDave Jiang dma_unmap_single(dev, dma_src, IOAT_TEST_SIZE, DMA_TO_DEVICE); 398c0f28ce6SDave Jiang free_resources: 399c0f28ce6SDave Jiang dma->device_free_chan_resources(dma_chan); 400c0f28ce6SDave Jiang out: 401c0f28ce6SDave Jiang kfree(src); 402c0f28ce6SDave Jiang kfree(dest); 403c0f28ce6SDave Jiang return err; 404c0f28ce6SDave Jiang } 405c0f28ce6SDave Jiang 406c0f28ce6SDave Jiang /** 407c0f28ce6SDave Jiang * ioat_dma_setup_interrupts - setup interrupt handler 408c0f28ce6SDave Jiang * @ioat_dma: ioat dma device 409c0f28ce6SDave Jiang */ 410c0f28ce6SDave Jiang int ioat_dma_setup_interrupts(struct ioatdma_device *ioat_dma) 411c0f28ce6SDave Jiang { 412c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan; 413c0f28ce6SDave Jiang struct pci_dev *pdev = ioat_dma->pdev; 414c0f28ce6SDave Jiang struct device *dev = &pdev->dev; 415c0f28ce6SDave Jiang struct msix_entry *msix; 416c0f28ce6SDave Jiang int i, j, msixcnt; 417c0f28ce6SDave Jiang int err = -EINVAL; 418c0f28ce6SDave Jiang u8 intrctrl = 0; 419c0f28ce6SDave Jiang 420c0f28ce6SDave Jiang if (!strcmp(ioat_interrupt_style, "msix")) 421c0f28ce6SDave Jiang goto msix; 422c0f28ce6SDave Jiang if (!strcmp(ioat_interrupt_style, "msi")) 423c0f28ce6SDave Jiang goto msi; 424c0f28ce6SDave Jiang if (!strcmp(ioat_interrupt_style, "intx")) 425c0f28ce6SDave Jiang goto intx; 426c0f28ce6SDave Jiang dev_err(dev, "invalid ioat_interrupt_style %s\n", ioat_interrupt_style); 427c0f28ce6SDave Jiang goto err_no_irq; 428c0f28ce6SDave Jiang 429c0f28ce6SDave Jiang msix: 430c0f28ce6SDave Jiang /* The number of MSI-X vectors should equal the number of channels */ 431c0f28ce6SDave Jiang msixcnt = ioat_dma->dma_dev.chancnt; 432c0f28ce6SDave Jiang for (i = 0; i < msixcnt; i++) 433c0f28ce6SDave Jiang ioat_dma->msix_entries[i].entry = i; 434c0f28ce6SDave Jiang 435c0f28ce6SDave Jiang err = pci_enable_msix_exact(pdev, ioat_dma->msix_entries, msixcnt); 436c0f28ce6SDave Jiang if (err) 437c0f28ce6SDave Jiang goto msi; 438c0f28ce6SDave Jiang 439c0f28ce6SDave Jiang for (i = 0; i < msixcnt; i++) { 440c0f28ce6SDave Jiang msix = &ioat_dma->msix_entries[i]; 441c0f28ce6SDave Jiang ioat_chan = ioat_chan_by_index(ioat_dma, i); 442c0f28ce6SDave Jiang err = devm_request_irq(dev, msix->vector, 443c0f28ce6SDave Jiang ioat_dma_do_interrupt_msix, 0, 444c0f28ce6SDave Jiang "ioat-msix", ioat_chan); 445c0f28ce6SDave Jiang if (err) { 446c0f28ce6SDave Jiang for (j = 0; j < i; j++) { 447c0f28ce6SDave Jiang msix = &ioat_dma->msix_entries[j]; 448c0f28ce6SDave Jiang ioat_chan = ioat_chan_by_index(ioat_dma, j); 449c0f28ce6SDave Jiang devm_free_irq(dev, msix->vector, ioat_chan); 450c0f28ce6SDave Jiang } 451c0f28ce6SDave Jiang goto msi; 452c0f28ce6SDave Jiang } 453c0f28ce6SDave Jiang } 454c0f28ce6SDave Jiang intrctrl |= IOAT_INTRCTRL_MSIX_VECTOR_CONTROL; 455c0f28ce6SDave Jiang ioat_dma->irq_mode = IOAT_MSIX; 456c0f28ce6SDave Jiang goto done; 457c0f28ce6SDave Jiang 458c0f28ce6SDave Jiang msi: 459c0f28ce6SDave Jiang err = pci_enable_msi(pdev); 460c0f28ce6SDave Jiang if (err) 461c0f28ce6SDave Jiang goto intx; 462c0f28ce6SDave Jiang 463c0f28ce6SDave Jiang err = devm_request_irq(dev, pdev->irq, ioat_dma_do_interrupt, 0, 464c0f28ce6SDave Jiang "ioat-msi", ioat_dma); 465c0f28ce6SDave Jiang if (err) { 466c0f28ce6SDave Jiang pci_disable_msi(pdev); 467c0f28ce6SDave Jiang goto intx; 468c0f28ce6SDave Jiang } 469c0f28ce6SDave Jiang ioat_dma->irq_mode = IOAT_MSI; 470c0f28ce6SDave Jiang goto done; 471c0f28ce6SDave Jiang 472c0f28ce6SDave Jiang intx: 473c0f28ce6SDave Jiang err = devm_request_irq(dev, pdev->irq, ioat_dma_do_interrupt, 474c0f28ce6SDave Jiang IRQF_SHARED, "ioat-intx", ioat_dma); 475c0f28ce6SDave Jiang if (err) 476c0f28ce6SDave Jiang goto err_no_irq; 477c0f28ce6SDave Jiang 478c0f28ce6SDave Jiang ioat_dma->irq_mode = IOAT_INTX; 479c0f28ce6SDave Jiang done: 480ef97bd0fSDave Jiang if (is_bwd_ioat(pdev)) 481ef97bd0fSDave Jiang ioat_intr_quirk(ioat_dma); 482c0f28ce6SDave Jiang intrctrl |= IOAT_INTRCTRL_MASTER_INT_EN; 483c0f28ce6SDave Jiang writeb(intrctrl, ioat_dma->reg_base + IOAT_INTRCTRL_OFFSET); 484c0f28ce6SDave Jiang return 0; 485c0f28ce6SDave Jiang 486c0f28ce6SDave Jiang err_no_irq: 487c0f28ce6SDave Jiang /* Disable all interrupt generation */ 488c0f28ce6SDave Jiang writeb(0, ioat_dma->reg_base + IOAT_INTRCTRL_OFFSET); 489c0f28ce6SDave Jiang ioat_dma->irq_mode = IOAT_NOIRQ; 490c0f28ce6SDave Jiang dev_err(dev, "no usable interrupts\n"); 491c0f28ce6SDave Jiang return err; 492c0f28ce6SDave Jiang } 493c0f28ce6SDave Jiang 494c0f28ce6SDave Jiang static void ioat_disable_interrupts(struct ioatdma_device *ioat_dma) 495c0f28ce6SDave Jiang { 496c0f28ce6SDave Jiang /* Disable all interrupt generation */ 497c0f28ce6SDave Jiang writeb(0, ioat_dma->reg_base + IOAT_INTRCTRL_OFFSET); 498c0f28ce6SDave Jiang } 499c0f28ce6SDave Jiang 500599d49deSDave Jiang static int ioat_probe(struct ioatdma_device *ioat_dma) 501c0f28ce6SDave Jiang { 502c0f28ce6SDave Jiang int err = -ENODEV; 503c0f28ce6SDave Jiang struct dma_device *dma = &ioat_dma->dma_dev; 504c0f28ce6SDave Jiang struct pci_dev *pdev = ioat_dma->pdev; 505c0f28ce6SDave Jiang struct device *dev = &pdev->dev; 506c0f28ce6SDave Jiang 507c0f28ce6SDave Jiang /* DMA coherent memory pool for DMA descriptor allocations */ 508*679cfbf7SDave Jiang ioat_dma->dma_pool = dma_pool_create("dma_desc_pool", dev, 509c0f28ce6SDave Jiang sizeof(struct ioat_dma_descriptor), 510c0f28ce6SDave Jiang 64, 0); 511c0f28ce6SDave Jiang if (!ioat_dma->dma_pool) { 512c0f28ce6SDave Jiang err = -ENOMEM; 513c0f28ce6SDave Jiang goto err_dma_pool; 514c0f28ce6SDave Jiang } 515c0f28ce6SDave Jiang 516*679cfbf7SDave Jiang ioat_dma->completion_pool = dma_pool_create("completion_pool", dev, 517c0f28ce6SDave Jiang sizeof(u64), 518c0f28ce6SDave Jiang SMP_CACHE_BYTES, 519c0f28ce6SDave Jiang SMP_CACHE_BYTES); 520c0f28ce6SDave Jiang 521c0f28ce6SDave Jiang if (!ioat_dma->completion_pool) { 522c0f28ce6SDave Jiang err = -ENOMEM; 523c0f28ce6SDave Jiang goto err_completion_pool; 524c0f28ce6SDave Jiang } 525c0f28ce6SDave Jiang 526ef97bd0fSDave Jiang ioat_enumerate_channels(ioat_dma); 527c0f28ce6SDave Jiang 528c0f28ce6SDave Jiang dma_cap_set(DMA_MEMCPY, dma->cap_mask); 529c0f28ce6SDave Jiang dma->dev = &pdev->dev; 530c0f28ce6SDave Jiang 531c0f28ce6SDave Jiang if (!dma->chancnt) { 532c0f28ce6SDave Jiang dev_err(dev, "channel enumeration error\n"); 533c0f28ce6SDave Jiang goto err_setup_interrupts; 534c0f28ce6SDave Jiang } 535c0f28ce6SDave Jiang 536c0f28ce6SDave Jiang err = ioat_dma_setup_interrupts(ioat_dma); 537c0f28ce6SDave Jiang if (err) 538c0f28ce6SDave Jiang goto err_setup_interrupts; 539c0f28ce6SDave Jiang 540ef97bd0fSDave Jiang err = ioat3_dma_self_test(ioat_dma); 541c0f28ce6SDave Jiang if (err) 542c0f28ce6SDave Jiang goto err_self_test; 543c0f28ce6SDave Jiang 544c0f28ce6SDave Jiang return 0; 545c0f28ce6SDave Jiang 546c0f28ce6SDave Jiang err_self_test: 547c0f28ce6SDave Jiang ioat_disable_interrupts(ioat_dma); 548c0f28ce6SDave Jiang err_setup_interrupts: 549*679cfbf7SDave Jiang dma_pool_destroy(ioat_dma->completion_pool); 550c0f28ce6SDave Jiang err_completion_pool: 551*679cfbf7SDave Jiang dma_pool_destroy(ioat_dma->dma_pool); 552c0f28ce6SDave Jiang err_dma_pool: 553c0f28ce6SDave Jiang return err; 554c0f28ce6SDave Jiang } 555c0f28ce6SDave Jiang 556599d49deSDave Jiang static int ioat_register(struct ioatdma_device *ioat_dma) 557c0f28ce6SDave Jiang { 558c0f28ce6SDave Jiang int err = dma_async_device_register(&ioat_dma->dma_dev); 559c0f28ce6SDave Jiang 560c0f28ce6SDave Jiang if (err) { 561c0f28ce6SDave Jiang ioat_disable_interrupts(ioat_dma); 562*679cfbf7SDave Jiang dma_pool_destroy(ioat_dma->completion_pool); 563*679cfbf7SDave Jiang dma_pool_destroy(ioat_dma->dma_pool); 564c0f28ce6SDave Jiang } 565c0f28ce6SDave Jiang 566c0f28ce6SDave Jiang return err; 567c0f28ce6SDave Jiang } 568c0f28ce6SDave Jiang 569599d49deSDave Jiang static void ioat_dma_remove(struct ioatdma_device *ioat_dma) 570c0f28ce6SDave Jiang { 571c0f28ce6SDave Jiang struct dma_device *dma = &ioat_dma->dma_dev; 572c0f28ce6SDave Jiang 573c0f28ce6SDave Jiang ioat_disable_interrupts(ioat_dma); 574c0f28ce6SDave Jiang 575c0f28ce6SDave Jiang ioat_kobject_del(ioat_dma); 576c0f28ce6SDave Jiang 577c0f28ce6SDave Jiang dma_async_device_unregister(dma); 578c0f28ce6SDave Jiang 579*679cfbf7SDave Jiang dma_pool_destroy(ioat_dma->dma_pool); 580*679cfbf7SDave Jiang dma_pool_destroy(ioat_dma->completion_pool); 581c0f28ce6SDave Jiang 582c0f28ce6SDave Jiang INIT_LIST_HEAD(&dma->channels); 583c0f28ce6SDave Jiang } 584c0f28ce6SDave Jiang 585c0f28ce6SDave Jiang /** 586c0f28ce6SDave Jiang * ioat_enumerate_channels - find and initialize the device's channels 587c0f28ce6SDave Jiang * @ioat_dma: the ioat dma device to be enumerated 588c0f28ce6SDave Jiang */ 589599d49deSDave Jiang static int ioat_enumerate_channels(struct ioatdma_device *ioat_dma) 590c0f28ce6SDave Jiang { 591c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan; 592c0f28ce6SDave Jiang struct device *dev = &ioat_dma->pdev->dev; 593c0f28ce6SDave Jiang struct dma_device *dma = &ioat_dma->dma_dev; 594c0f28ce6SDave Jiang u8 xfercap_log; 595c0f28ce6SDave Jiang int i; 596c0f28ce6SDave Jiang 597c0f28ce6SDave Jiang INIT_LIST_HEAD(&dma->channels); 598c0f28ce6SDave Jiang dma->chancnt = readb(ioat_dma->reg_base + IOAT_CHANCNT_OFFSET); 599c0f28ce6SDave Jiang dma->chancnt &= 0x1f; /* bits [4:0] valid */ 600c0f28ce6SDave Jiang if (dma->chancnt > ARRAY_SIZE(ioat_dma->idx)) { 601c0f28ce6SDave Jiang dev_warn(dev, "(%d) exceeds max supported channels (%zu)\n", 602c0f28ce6SDave Jiang dma->chancnt, ARRAY_SIZE(ioat_dma->idx)); 603c0f28ce6SDave Jiang dma->chancnt = ARRAY_SIZE(ioat_dma->idx); 604c0f28ce6SDave Jiang } 605c0f28ce6SDave Jiang xfercap_log = readb(ioat_dma->reg_base + IOAT_XFERCAP_OFFSET); 606c0f28ce6SDave Jiang xfercap_log &= 0x1f; /* bits [4:0] valid */ 607c0f28ce6SDave Jiang if (xfercap_log == 0) 608c0f28ce6SDave Jiang return 0; 609c0f28ce6SDave Jiang dev_dbg(dev, "%s: xfercap = %d\n", __func__, 1 << xfercap_log); 610c0f28ce6SDave Jiang 611c0f28ce6SDave Jiang for (i = 0; i < dma->chancnt; i++) { 612c0f28ce6SDave Jiang ioat_chan = devm_kzalloc(dev, sizeof(*ioat_chan), GFP_KERNEL); 613c0f28ce6SDave Jiang if (!ioat_chan) 614c0f28ce6SDave Jiang break; 615c0f28ce6SDave Jiang 616c0f28ce6SDave Jiang ioat_init_channel(ioat_dma, ioat_chan, i); 617c0f28ce6SDave Jiang ioat_chan->xfercap_log = xfercap_log; 618c0f28ce6SDave Jiang spin_lock_init(&ioat_chan->prep_lock); 619ef97bd0fSDave Jiang if (ioat_reset_hw(ioat_chan)) { 620c0f28ce6SDave Jiang i = 0; 621c0f28ce6SDave Jiang break; 622c0f28ce6SDave Jiang } 623c0f28ce6SDave Jiang } 624c0f28ce6SDave Jiang dma->chancnt = i; 625c0f28ce6SDave Jiang return i; 626c0f28ce6SDave Jiang } 627c0f28ce6SDave Jiang 628c0f28ce6SDave Jiang /** 629c0f28ce6SDave Jiang * ioat_free_chan_resources - release all the descriptors 630c0f28ce6SDave Jiang * @chan: the channel to be cleaned 631c0f28ce6SDave Jiang */ 632599d49deSDave Jiang static void ioat_free_chan_resources(struct dma_chan *c) 633c0f28ce6SDave Jiang { 634c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan = to_ioat_chan(c); 635c0f28ce6SDave Jiang struct ioatdma_device *ioat_dma = ioat_chan->ioat_dma; 636c0f28ce6SDave Jiang struct ioat_ring_ent *desc; 637c0f28ce6SDave Jiang const int total_descs = 1 << ioat_chan->alloc_order; 638c0f28ce6SDave Jiang int descs; 639c0f28ce6SDave Jiang int i; 640c0f28ce6SDave Jiang 641c0f28ce6SDave Jiang /* Before freeing channel resources first check 642c0f28ce6SDave Jiang * if they have been previously allocated for this channel. 643c0f28ce6SDave Jiang */ 644c0f28ce6SDave Jiang if (!ioat_chan->ring) 645c0f28ce6SDave Jiang return; 646c0f28ce6SDave Jiang 647c0f28ce6SDave Jiang ioat_stop(ioat_chan); 648ef97bd0fSDave Jiang ioat_reset_hw(ioat_chan); 649c0f28ce6SDave Jiang 650c0f28ce6SDave Jiang spin_lock_bh(&ioat_chan->cleanup_lock); 651c0f28ce6SDave Jiang spin_lock_bh(&ioat_chan->prep_lock); 652c0f28ce6SDave Jiang descs = ioat_ring_space(ioat_chan); 653c0f28ce6SDave Jiang dev_dbg(to_dev(ioat_chan), "freeing %d idle descriptors\n", descs); 654c0f28ce6SDave Jiang for (i = 0; i < descs; i++) { 655c0f28ce6SDave Jiang desc = ioat_get_ring_ent(ioat_chan, ioat_chan->head + i); 656c0f28ce6SDave Jiang ioat_free_ring_ent(desc, c); 657c0f28ce6SDave Jiang } 658c0f28ce6SDave Jiang 659c0f28ce6SDave Jiang if (descs < total_descs) 660c0f28ce6SDave Jiang dev_err(to_dev(ioat_chan), "Freeing %d in use descriptors!\n", 661c0f28ce6SDave Jiang total_descs - descs); 662c0f28ce6SDave Jiang 663c0f28ce6SDave Jiang for (i = 0; i < total_descs - descs; i++) { 664c0f28ce6SDave Jiang desc = ioat_get_ring_ent(ioat_chan, ioat_chan->tail + i); 665c0f28ce6SDave Jiang dump_desc_dbg(ioat_chan, desc); 666c0f28ce6SDave Jiang ioat_free_ring_ent(desc, c); 667c0f28ce6SDave Jiang } 668c0f28ce6SDave Jiang 669c0f28ce6SDave Jiang kfree(ioat_chan->ring); 670c0f28ce6SDave Jiang ioat_chan->ring = NULL; 671c0f28ce6SDave Jiang ioat_chan->alloc_order = 0; 672*679cfbf7SDave Jiang dma_pool_free(ioat_dma->completion_pool, ioat_chan->completion, 673c0f28ce6SDave Jiang ioat_chan->completion_dma); 674c0f28ce6SDave Jiang spin_unlock_bh(&ioat_chan->prep_lock); 675c0f28ce6SDave Jiang spin_unlock_bh(&ioat_chan->cleanup_lock); 676c0f28ce6SDave Jiang 677c0f28ce6SDave Jiang ioat_chan->last_completion = 0; 678c0f28ce6SDave Jiang ioat_chan->completion_dma = 0; 679c0f28ce6SDave Jiang ioat_chan->dmacount = 0; 680c0f28ce6SDave Jiang } 681c0f28ce6SDave Jiang 682c0f28ce6SDave Jiang /* ioat_alloc_chan_resources - allocate/initialize ioat descriptor ring 683c0f28ce6SDave Jiang * @chan: channel to be initialized 684c0f28ce6SDave Jiang */ 685599d49deSDave Jiang static int ioat_alloc_chan_resources(struct dma_chan *c) 686c0f28ce6SDave Jiang { 687c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan = to_ioat_chan(c); 688c0f28ce6SDave Jiang struct ioat_ring_ent **ring; 689c0f28ce6SDave Jiang u64 status; 690c0f28ce6SDave Jiang int order; 691c0f28ce6SDave Jiang int i = 0; 692c0f28ce6SDave Jiang u32 chanerr; 693c0f28ce6SDave Jiang 694c0f28ce6SDave Jiang /* have we already been set up? */ 695c0f28ce6SDave Jiang if (ioat_chan->ring) 696c0f28ce6SDave Jiang return 1 << ioat_chan->alloc_order; 697c0f28ce6SDave Jiang 698c0f28ce6SDave Jiang /* Setup register to interrupt and write completion status on error */ 699c0f28ce6SDave Jiang writew(IOAT_CHANCTRL_RUN, ioat_chan->reg_base + IOAT_CHANCTRL_OFFSET); 700c0f28ce6SDave Jiang 701c0f28ce6SDave Jiang /* allocate a completion writeback area */ 702c0f28ce6SDave Jiang /* doing 2 32bit writes to mmio since 1 64b write doesn't work */ 703c0f28ce6SDave Jiang ioat_chan->completion = 704*679cfbf7SDave Jiang dma_pool_alloc(ioat_chan->ioat_dma->completion_pool, 705c0f28ce6SDave Jiang GFP_KERNEL, &ioat_chan->completion_dma); 706c0f28ce6SDave Jiang if (!ioat_chan->completion) 707c0f28ce6SDave Jiang return -ENOMEM; 708c0f28ce6SDave Jiang 709c0f28ce6SDave Jiang memset(ioat_chan->completion, 0, sizeof(*ioat_chan->completion)); 710c0f28ce6SDave Jiang writel(((u64)ioat_chan->completion_dma) & 0x00000000FFFFFFFF, 711c0f28ce6SDave Jiang ioat_chan->reg_base + IOAT_CHANCMP_OFFSET_LOW); 712c0f28ce6SDave Jiang writel(((u64)ioat_chan->completion_dma) >> 32, 713c0f28ce6SDave Jiang ioat_chan->reg_base + IOAT_CHANCMP_OFFSET_HIGH); 714c0f28ce6SDave Jiang 715c0f28ce6SDave Jiang order = ioat_get_alloc_order(); 716c0f28ce6SDave Jiang ring = ioat_alloc_ring(c, order, GFP_KERNEL); 717c0f28ce6SDave Jiang if (!ring) 718c0f28ce6SDave Jiang return -ENOMEM; 719c0f28ce6SDave Jiang 720c0f28ce6SDave Jiang spin_lock_bh(&ioat_chan->cleanup_lock); 721c0f28ce6SDave Jiang spin_lock_bh(&ioat_chan->prep_lock); 722c0f28ce6SDave Jiang ioat_chan->ring = ring; 723c0f28ce6SDave Jiang ioat_chan->head = 0; 724c0f28ce6SDave Jiang ioat_chan->issued = 0; 725c0f28ce6SDave Jiang ioat_chan->tail = 0; 726c0f28ce6SDave Jiang ioat_chan->alloc_order = order; 727c0f28ce6SDave Jiang set_bit(IOAT_RUN, &ioat_chan->state); 728c0f28ce6SDave Jiang spin_unlock_bh(&ioat_chan->prep_lock); 729c0f28ce6SDave Jiang spin_unlock_bh(&ioat_chan->cleanup_lock); 730c0f28ce6SDave Jiang 731c0f28ce6SDave Jiang ioat_start_null_desc(ioat_chan); 732c0f28ce6SDave Jiang 733c0f28ce6SDave Jiang /* check that we got off the ground */ 734c0f28ce6SDave Jiang do { 735c0f28ce6SDave Jiang udelay(1); 736c0f28ce6SDave Jiang status = ioat_chansts(ioat_chan); 737c0f28ce6SDave Jiang } while (i++ < 20 && !is_ioat_active(status) && !is_ioat_idle(status)); 738c0f28ce6SDave Jiang 739c0f28ce6SDave Jiang if (is_ioat_active(status) || is_ioat_idle(status)) 740c0f28ce6SDave Jiang return 1 << ioat_chan->alloc_order; 741c0f28ce6SDave Jiang 742c0f28ce6SDave Jiang chanerr = readl(ioat_chan->reg_base + IOAT_CHANERR_OFFSET); 743c0f28ce6SDave Jiang 744c0f28ce6SDave Jiang dev_WARN(to_dev(ioat_chan), 745c0f28ce6SDave Jiang "failed to start channel chanerr: %#x\n", chanerr); 746c0f28ce6SDave Jiang ioat_free_chan_resources(c); 747c0f28ce6SDave Jiang return -EFAULT; 748c0f28ce6SDave Jiang } 749c0f28ce6SDave Jiang 750c0f28ce6SDave Jiang /* common channel initialization */ 751599d49deSDave Jiang static void 752c0f28ce6SDave Jiang ioat_init_channel(struct ioatdma_device *ioat_dma, 753c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan, int idx) 754c0f28ce6SDave Jiang { 755c0f28ce6SDave Jiang struct dma_device *dma = &ioat_dma->dma_dev; 756c0f28ce6SDave Jiang struct dma_chan *c = &ioat_chan->dma_chan; 757c0f28ce6SDave Jiang unsigned long data = (unsigned long) c; 758c0f28ce6SDave Jiang 759c0f28ce6SDave Jiang ioat_chan->ioat_dma = ioat_dma; 760c0f28ce6SDave Jiang ioat_chan->reg_base = ioat_dma->reg_base + (0x80 * (idx + 1)); 761c0f28ce6SDave Jiang spin_lock_init(&ioat_chan->cleanup_lock); 762c0f28ce6SDave Jiang ioat_chan->dma_chan.device = dma; 763c0f28ce6SDave Jiang dma_cookie_init(&ioat_chan->dma_chan); 764c0f28ce6SDave Jiang list_add_tail(&ioat_chan->dma_chan.device_node, &dma->channels); 765c0f28ce6SDave Jiang ioat_dma->idx[idx] = ioat_chan; 766c0f28ce6SDave Jiang init_timer(&ioat_chan->timer); 767ef97bd0fSDave Jiang ioat_chan->timer.function = ioat_timer_event; 768c0f28ce6SDave Jiang ioat_chan->timer.data = data; 769ef97bd0fSDave Jiang tasklet_init(&ioat_chan->cleanup_task, ioat_cleanup_event, data); 770c0f28ce6SDave Jiang } 771c0f28ce6SDave Jiang 772c0f28ce6SDave Jiang #define IOAT_NUM_SRC_TEST 6 /* must be <= 8 */ 773c0f28ce6SDave Jiang static int ioat_xor_val_self_test(struct ioatdma_device *ioat_dma) 774c0f28ce6SDave Jiang { 775c0f28ce6SDave Jiang int i, src_idx; 776c0f28ce6SDave Jiang struct page *dest; 777c0f28ce6SDave Jiang struct page *xor_srcs[IOAT_NUM_SRC_TEST]; 778c0f28ce6SDave Jiang struct page *xor_val_srcs[IOAT_NUM_SRC_TEST + 1]; 779c0f28ce6SDave Jiang dma_addr_t dma_srcs[IOAT_NUM_SRC_TEST + 1]; 780c0f28ce6SDave Jiang dma_addr_t dest_dma; 781c0f28ce6SDave Jiang struct dma_async_tx_descriptor *tx; 782c0f28ce6SDave Jiang struct dma_chan *dma_chan; 783c0f28ce6SDave Jiang dma_cookie_t cookie; 784c0f28ce6SDave Jiang u8 cmp_byte = 0; 785c0f28ce6SDave Jiang u32 cmp_word; 786c0f28ce6SDave Jiang u32 xor_val_result; 787c0f28ce6SDave Jiang int err = 0; 788c0f28ce6SDave Jiang struct completion cmp; 789c0f28ce6SDave Jiang unsigned long tmo; 790c0f28ce6SDave Jiang struct device *dev = &ioat_dma->pdev->dev; 791c0f28ce6SDave Jiang struct dma_device *dma = &ioat_dma->dma_dev; 792c0f28ce6SDave Jiang u8 op = 0; 793c0f28ce6SDave Jiang 794c0f28ce6SDave Jiang dev_dbg(dev, "%s\n", __func__); 795c0f28ce6SDave Jiang 796c0f28ce6SDave Jiang if (!dma_has_cap(DMA_XOR, dma->cap_mask)) 797c0f28ce6SDave Jiang return 0; 798c0f28ce6SDave Jiang 799c0f28ce6SDave Jiang for (src_idx = 0; src_idx < IOAT_NUM_SRC_TEST; src_idx++) { 800c0f28ce6SDave Jiang xor_srcs[src_idx] = alloc_page(GFP_KERNEL); 801c0f28ce6SDave Jiang if (!xor_srcs[src_idx]) { 802c0f28ce6SDave Jiang while (src_idx--) 803c0f28ce6SDave Jiang __free_page(xor_srcs[src_idx]); 804c0f28ce6SDave Jiang return -ENOMEM; 805c0f28ce6SDave Jiang } 806c0f28ce6SDave Jiang } 807c0f28ce6SDave Jiang 808c0f28ce6SDave Jiang dest = alloc_page(GFP_KERNEL); 809c0f28ce6SDave Jiang if (!dest) { 810c0f28ce6SDave Jiang while (src_idx--) 811c0f28ce6SDave Jiang __free_page(xor_srcs[src_idx]); 812c0f28ce6SDave Jiang return -ENOMEM; 813c0f28ce6SDave Jiang } 814c0f28ce6SDave Jiang 815c0f28ce6SDave Jiang /* Fill in src buffers */ 816c0f28ce6SDave Jiang for (src_idx = 0; src_idx < IOAT_NUM_SRC_TEST; src_idx++) { 817c0f28ce6SDave Jiang u8 *ptr = page_address(xor_srcs[src_idx]); 818c0f28ce6SDave Jiang 819c0f28ce6SDave Jiang for (i = 0; i < PAGE_SIZE; i++) 820c0f28ce6SDave Jiang ptr[i] = (1 << src_idx); 821c0f28ce6SDave Jiang } 822c0f28ce6SDave Jiang 823c0f28ce6SDave Jiang for (src_idx = 0; src_idx < IOAT_NUM_SRC_TEST; src_idx++) 824c0f28ce6SDave Jiang cmp_byte ^= (u8) (1 << src_idx); 825c0f28ce6SDave Jiang 826c0f28ce6SDave Jiang cmp_word = (cmp_byte << 24) | (cmp_byte << 16) | 827c0f28ce6SDave Jiang (cmp_byte << 8) | cmp_byte; 828c0f28ce6SDave Jiang 829c0f28ce6SDave Jiang memset(page_address(dest), 0, PAGE_SIZE); 830c0f28ce6SDave Jiang 831c0f28ce6SDave Jiang dma_chan = container_of(dma->channels.next, struct dma_chan, 832c0f28ce6SDave Jiang device_node); 833c0f28ce6SDave Jiang if (dma->device_alloc_chan_resources(dma_chan) < 1) { 834c0f28ce6SDave Jiang err = -ENODEV; 835c0f28ce6SDave Jiang goto out; 836c0f28ce6SDave Jiang } 837c0f28ce6SDave Jiang 838c0f28ce6SDave Jiang /* test xor */ 839c0f28ce6SDave Jiang op = IOAT_OP_XOR; 840c0f28ce6SDave Jiang 841c0f28ce6SDave Jiang dest_dma = dma_map_page(dev, dest, 0, PAGE_SIZE, DMA_FROM_DEVICE); 842c0f28ce6SDave Jiang if (dma_mapping_error(dev, dest_dma)) 843c0f28ce6SDave Jiang goto dma_unmap; 844c0f28ce6SDave Jiang 845c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST; i++) 846c0f28ce6SDave Jiang dma_srcs[i] = DMA_ERROR_CODE; 847c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST; i++) { 848c0f28ce6SDave Jiang dma_srcs[i] = dma_map_page(dev, xor_srcs[i], 0, PAGE_SIZE, 849c0f28ce6SDave Jiang DMA_TO_DEVICE); 850c0f28ce6SDave Jiang if (dma_mapping_error(dev, dma_srcs[i])) 851c0f28ce6SDave Jiang goto dma_unmap; 852c0f28ce6SDave Jiang } 853c0f28ce6SDave Jiang tx = dma->device_prep_dma_xor(dma_chan, dest_dma, dma_srcs, 854c0f28ce6SDave Jiang IOAT_NUM_SRC_TEST, PAGE_SIZE, 855c0f28ce6SDave Jiang DMA_PREP_INTERRUPT); 856c0f28ce6SDave Jiang 857c0f28ce6SDave Jiang if (!tx) { 858c0f28ce6SDave Jiang dev_err(dev, "Self-test xor prep failed\n"); 859c0f28ce6SDave Jiang err = -ENODEV; 860c0f28ce6SDave Jiang goto dma_unmap; 861c0f28ce6SDave Jiang } 862c0f28ce6SDave Jiang 863c0f28ce6SDave Jiang async_tx_ack(tx); 864c0f28ce6SDave Jiang init_completion(&cmp); 8653372de58SDave Jiang tx->callback = ioat_dma_test_callback; 866c0f28ce6SDave Jiang tx->callback_param = &cmp; 867c0f28ce6SDave Jiang cookie = tx->tx_submit(tx); 868c0f28ce6SDave Jiang if (cookie < 0) { 869c0f28ce6SDave Jiang dev_err(dev, "Self-test xor setup failed\n"); 870c0f28ce6SDave Jiang err = -ENODEV; 871c0f28ce6SDave Jiang goto dma_unmap; 872c0f28ce6SDave Jiang } 873c0f28ce6SDave Jiang dma->device_issue_pending(dma_chan); 874c0f28ce6SDave Jiang 875c0f28ce6SDave Jiang tmo = wait_for_completion_timeout(&cmp, msecs_to_jiffies(3000)); 876c0f28ce6SDave Jiang 877c0f28ce6SDave Jiang if (tmo == 0 || 878c0f28ce6SDave Jiang dma->device_tx_status(dma_chan, cookie, NULL) != DMA_COMPLETE) { 879c0f28ce6SDave Jiang dev_err(dev, "Self-test xor timed out\n"); 880c0f28ce6SDave Jiang err = -ENODEV; 881c0f28ce6SDave Jiang goto dma_unmap; 882c0f28ce6SDave Jiang } 883c0f28ce6SDave Jiang 884c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST; i++) 885c0f28ce6SDave Jiang dma_unmap_page(dev, dma_srcs[i], PAGE_SIZE, DMA_TO_DEVICE); 886c0f28ce6SDave Jiang 887c0f28ce6SDave Jiang dma_sync_single_for_cpu(dev, dest_dma, PAGE_SIZE, DMA_FROM_DEVICE); 888c0f28ce6SDave Jiang for (i = 0; i < (PAGE_SIZE / sizeof(u32)); i++) { 889c0f28ce6SDave Jiang u32 *ptr = page_address(dest); 890c0f28ce6SDave Jiang 891c0f28ce6SDave Jiang if (ptr[i] != cmp_word) { 892c0f28ce6SDave Jiang dev_err(dev, "Self-test xor failed compare\n"); 893c0f28ce6SDave Jiang err = -ENODEV; 894c0f28ce6SDave Jiang goto free_resources; 895c0f28ce6SDave Jiang } 896c0f28ce6SDave Jiang } 897c0f28ce6SDave Jiang dma_sync_single_for_device(dev, dest_dma, PAGE_SIZE, DMA_FROM_DEVICE); 898c0f28ce6SDave Jiang 899c0f28ce6SDave Jiang dma_unmap_page(dev, dest_dma, PAGE_SIZE, DMA_FROM_DEVICE); 900c0f28ce6SDave Jiang 901c0f28ce6SDave Jiang /* skip validate if the capability is not present */ 902c0f28ce6SDave Jiang if (!dma_has_cap(DMA_XOR_VAL, dma_chan->device->cap_mask)) 903c0f28ce6SDave Jiang goto free_resources; 904c0f28ce6SDave Jiang 905c0f28ce6SDave Jiang op = IOAT_OP_XOR_VAL; 906c0f28ce6SDave Jiang 907c0f28ce6SDave Jiang /* validate the sources with the destintation page */ 908c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST; i++) 909c0f28ce6SDave Jiang xor_val_srcs[i] = xor_srcs[i]; 910c0f28ce6SDave Jiang xor_val_srcs[i] = dest; 911c0f28ce6SDave Jiang 912c0f28ce6SDave Jiang xor_val_result = 1; 913c0f28ce6SDave Jiang 914c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) 915c0f28ce6SDave Jiang dma_srcs[i] = DMA_ERROR_CODE; 916c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) { 917c0f28ce6SDave Jiang dma_srcs[i] = dma_map_page(dev, xor_val_srcs[i], 0, PAGE_SIZE, 918c0f28ce6SDave Jiang DMA_TO_DEVICE); 919c0f28ce6SDave Jiang if (dma_mapping_error(dev, dma_srcs[i])) 920c0f28ce6SDave Jiang goto dma_unmap; 921c0f28ce6SDave Jiang } 922c0f28ce6SDave Jiang tx = dma->device_prep_dma_xor_val(dma_chan, dma_srcs, 923c0f28ce6SDave Jiang IOAT_NUM_SRC_TEST + 1, PAGE_SIZE, 924c0f28ce6SDave Jiang &xor_val_result, DMA_PREP_INTERRUPT); 925c0f28ce6SDave Jiang if (!tx) { 926c0f28ce6SDave Jiang dev_err(dev, "Self-test zero prep failed\n"); 927c0f28ce6SDave Jiang err = -ENODEV; 928c0f28ce6SDave Jiang goto dma_unmap; 929c0f28ce6SDave Jiang } 930c0f28ce6SDave Jiang 931c0f28ce6SDave Jiang async_tx_ack(tx); 932c0f28ce6SDave Jiang init_completion(&cmp); 9333372de58SDave Jiang tx->callback = ioat_dma_test_callback; 934c0f28ce6SDave Jiang tx->callback_param = &cmp; 935c0f28ce6SDave Jiang cookie = tx->tx_submit(tx); 936c0f28ce6SDave Jiang if (cookie < 0) { 937c0f28ce6SDave Jiang dev_err(dev, "Self-test zero setup failed\n"); 938c0f28ce6SDave Jiang err = -ENODEV; 939c0f28ce6SDave Jiang goto dma_unmap; 940c0f28ce6SDave Jiang } 941c0f28ce6SDave Jiang dma->device_issue_pending(dma_chan); 942c0f28ce6SDave Jiang 943c0f28ce6SDave Jiang tmo = wait_for_completion_timeout(&cmp, msecs_to_jiffies(3000)); 944c0f28ce6SDave Jiang 945c0f28ce6SDave Jiang if (tmo == 0 || 946c0f28ce6SDave Jiang dma->device_tx_status(dma_chan, cookie, NULL) != DMA_COMPLETE) { 947c0f28ce6SDave Jiang dev_err(dev, "Self-test validate timed out\n"); 948c0f28ce6SDave Jiang err = -ENODEV; 949c0f28ce6SDave Jiang goto dma_unmap; 950c0f28ce6SDave Jiang } 951c0f28ce6SDave Jiang 952c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) 953c0f28ce6SDave Jiang dma_unmap_page(dev, dma_srcs[i], PAGE_SIZE, DMA_TO_DEVICE); 954c0f28ce6SDave Jiang 955c0f28ce6SDave Jiang if (xor_val_result != 0) { 956c0f28ce6SDave Jiang dev_err(dev, "Self-test validate failed compare\n"); 957c0f28ce6SDave Jiang err = -ENODEV; 958c0f28ce6SDave Jiang goto free_resources; 959c0f28ce6SDave Jiang } 960c0f28ce6SDave Jiang 961c0f28ce6SDave Jiang memset(page_address(dest), 0, PAGE_SIZE); 962c0f28ce6SDave Jiang 963c0f28ce6SDave Jiang /* test for non-zero parity sum */ 964c0f28ce6SDave Jiang op = IOAT_OP_XOR_VAL; 965c0f28ce6SDave Jiang 966c0f28ce6SDave Jiang xor_val_result = 0; 967c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) 968c0f28ce6SDave Jiang dma_srcs[i] = DMA_ERROR_CODE; 969c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) { 970c0f28ce6SDave Jiang dma_srcs[i] = dma_map_page(dev, xor_val_srcs[i], 0, PAGE_SIZE, 971c0f28ce6SDave Jiang DMA_TO_DEVICE); 972c0f28ce6SDave Jiang if (dma_mapping_error(dev, dma_srcs[i])) 973c0f28ce6SDave Jiang goto dma_unmap; 974c0f28ce6SDave Jiang } 975c0f28ce6SDave Jiang tx = dma->device_prep_dma_xor_val(dma_chan, dma_srcs, 976c0f28ce6SDave Jiang IOAT_NUM_SRC_TEST + 1, PAGE_SIZE, 977c0f28ce6SDave Jiang &xor_val_result, DMA_PREP_INTERRUPT); 978c0f28ce6SDave Jiang if (!tx) { 979c0f28ce6SDave Jiang dev_err(dev, "Self-test 2nd zero prep failed\n"); 980c0f28ce6SDave Jiang err = -ENODEV; 981c0f28ce6SDave Jiang goto dma_unmap; 982c0f28ce6SDave Jiang } 983c0f28ce6SDave Jiang 984c0f28ce6SDave Jiang async_tx_ack(tx); 985c0f28ce6SDave Jiang init_completion(&cmp); 9863372de58SDave Jiang tx->callback = ioat_dma_test_callback; 987c0f28ce6SDave Jiang tx->callback_param = &cmp; 988c0f28ce6SDave Jiang cookie = tx->tx_submit(tx); 989c0f28ce6SDave Jiang if (cookie < 0) { 990c0f28ce6SDave Jiang dev_err(dev, "Self-test 2nd zero setup failed\n"); 991c0f28ce6SDave Jiang err = -ENODEV; 992c0f28ce6SDave Jiang goto dma_unmap; 993c0f28ce6SDave Jiang } 994c0f28ce6SDave Jiang dma->device_issue_pending(dma_chan); 995c0f28ce6SDave Jiang 996c0f28ce6SDave Jiang tmo = wait_for_completion_timeout(&cmp, msecs_to_jiffies(3000)); 997c0f28ce6SDave Jiang 998c0f28ce6SDave Jiang if (tmo == 0 || 999c0f28ce6SDave Jiang dma->device_tx_status(dma_chan, cookie, NULL) != DMA_COMPLETE) { 1000c0f28ce6SDave Jiang dev_err(dev, "Self-test 2nd validate timed out\n"); 1001c0f28ce6SDave Jiang err = -ENODEV; 1002c0f28ce6SDave Jiang goto dma_unmap; 1003c0f28ce6SDave Jiang } 1004c0f28ce6SDave Jiang 1005c0f28ce6SDave Jiang if (xor_val_result != SUM_CHECK_P_RESULT) { 1006c0f28ce6SDave Jiang dev_err(dev, "Self-test validate failed compare\n"); 1007c0f28ce6SDave Jiang err = -ENODEV; 1008c0f28ce6SDave Jiang goto dma_unmap; 1009c0f28ce6SDave Jiang } 1010c0f28ce6SDave Jiang 1011c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) 1012c0f28ce6SDave Jiang dma_unmap_page(dev, dma_srcs[i], PAGE_SIZE, DMA_TO_DEVICE); 1013c0f28ce6SDave Jiang 1014c0f28ce6SDave Jiang goto free_resources; 1015c0f28ce6SDave Jiang dma_unmap: 1016c0f28ce6SDave Jiang if (op == IOAT_OP_XOR) { 1017c0f28ce6SDave Jiang if (dest_dma != DMA_ERROR_CODE) 1018c0f28ce6SDave Jiang dma_unmap_page(dev, dest_dma, PAGE_SIZE, 1019c0f28ce6SDave Jiang DMA_FROM_DEVICE); 1020c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST; i++) 1021c0f28ce6SDave Jiang if (dma_srcs[i] != DMA_ERROR_CODE) 1022c0f28ce6SDave Jiang dma_unmap_page(dev, dma_srcs[i], PAGE_SIZE, 1023c0f28ce6SDave Jiang DMA_TO_DEVICE); 1024c0f28ce6SDave Jiang } else if (op == IOAT_OP_XOR_VAL) { 1025c0f28ce6SDave Jiang for (i = 0; i < IOAT_NUM_SRC_TEST + 1; i++) 1026c0f28ce6SDave Jiang if (dma_srcs[i] != DMA_ERROR_CODE) 1027c0f28ce6SDave Jiang dma_unmap_page(dev, dma_srcs[i], PAGE_SIZE, 1028c0f28ce6SDave Jiang DMA_TO_DEVICE); 1029c0f28ce6SDave Jiang } 1030c0f28ce6SDave Jiang free_resources: 1031c0f28ce6SDave Jiang dma->device_free_chan_resources(dma_chan); 1032c0f28ce6SDave Jiang out: 1033c0f28ce6SDave Jiang src_idx = IOAT_NUM_SRC_TEST; 1034c0f28ce6SDave Jiang while (src_idx--) 1035c0f28ce6SDave Jiang __free_page(xor_srcs[src_idx]); 1036c0f28ce6SDave Jiang __free_page(dest); 1037c0f28ce6SDave Jiang return err; 1038c0f28ce6SDave Jiang } 1039c0f28ce6SDave Jiang 1040c0f28ce6SDave Jiang static int ioat3_dma_self_test(struct ioatdma_device *ioat_dma) 1041c0f28ce6SDave Jiang { 104264f1d0ffSDave Jiang int rc; 1043c0f28ce6SDave Jiang 104464f1d0ffSDave Jiang rc = ioat_dma_self_test(ioat_dma); 1045c0f28ce6SDave Jiang if (rc) 1046c0f28ce6SDave Jiang return rc; 1047c0f28ce6SDave Jiang 1048c0f28ce6SDave Jiang rc = ioat_xor_val_self_test(ioat_dma); 1049c0f28ce6SDave Jiang 105064f1d0ffSDave Jiang return rc; 1051c0f28ce6SDave Jiang } 1052c0f28ce6SDave Jiang 10533372de58SDave Jiang static void ioat_intr_quirk(struct ioatdma_device *ioat_dma) 1054c0f28ce6SDave Jiang { 1055c0f28ce6SDave Jiang struct dma_device *dma; 1056c0f28ce6SDave Jiang struct dma_chan *c; 1057c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan; 1058c0f28ce6SDave Jiang u32 errmask; 1059c0f28ce6SDave Jiang 1060c0f28ce6SDave Jiang dma = &ioat_dma->dma_dev; 1061c0f28ce6SDave Jiang 1062c0f28ce6SDave Jiang /* 1063c0f28ce6SDave Jiang * if we have descriptor write back error status, we mask the 1064c0f28ce6SDave Jiang * error interrupts 1065c0f28ce6SDave Jiang */ 1066c0f28ce6SDave Jiang if (ioat_dma->cap & IOAT_CAP_DWBES) { 1067c0f28ce6SDave Jiang list_for_each_entry(c, &dma->channels, device_node) { 1068c0f28ce6SDave Jiang ioat_chan = to_ioat_chan(c); 1069c0f28ce6SDave Jiang errmask = readl(ioat_chan->reg_base + 1070c0f28ce6SDave Jiang IOAT_CHANERR_MASK_OFFSET); 1071c0f28ce6SDave Jiang errmask |= IOAT_CHANERR_XOR_P_OR_CRC_ERR | 1072c0f28ce6SDave Jiang IOAT_CHANERR_XOR_Q_ERR; 1073c0f28ce6SDave Jiang writel(errmask, ioat_chan->reg_base + 1074c0f28ce6SDave Jiang IOAT_CHANERR_MASK_OFFSET); 1075c0f28ce6SDave Jiang } 1076c0f28ce6SDave Jiang } 1077c0f28ce6SDave Jiang } 1078c0f28ce6SDave Jiang 1079599d49deSDave Jiang static int ioat3_dma_probe(struct ioatdma_device *ioat_dma, int dca) 1080c0f28ce6SDave Jiang { 1081c0f28ce6SDave Jiang struct pci_dev *pdev = ioat_dma->pdev; 1082c0f28ce6SDave Jiang int dca_en = system_has_dca_enabled(pdev); 1083c0f28ce6SDave Jiang struct dma_device *dma; 1084c0f28ce6SDave Jiang struct dma_chan *c; 1085c0f28ce6SDave Jiang struct ioatdma_chan *ioat_chan; 1086c0f28ce6SDave Jiang bool is_raid_device = false; 1087c0f28ce6SDave Jiang int err; 1088c0f28ce6SDave Jiang 1089c0f28ce6SDave Jiang dma = &ioat_dma->dma_dev; 1090c0f28ce6SDave Jiang dma->device_prep_dma_memcpy = ioat_dma_prep_memcpy_lock; 1091c0f28ce6SDave Jiang dma->device_issue_pending = ioat_issue_pending; 1092c0f28ce6SDave Jiang dma->device_alloc_chan_resources = ioat_alloc_chan_resources; 1093c0f28ce6SDave Jiang dma->device_free_chan_resources = ioat_free_chan_resources; 1094c0f28ce6SDave Jiang 1095c0f28ce6SDave Jiang dma_cap_set(DMA_INTERRUPT, dma->cap_mask); 1096c0f28ce6SDave Jiang dma->device_prep_dma_interrupt = ioat_prep_interrupt_lock; 1097c0f28ce6SDave Jiang 1098c0f28ce6SDave Jiang ioat_dma->cap = readl(ioat_dma->reg_base + IOAT_DMA_CAP_OFFSET); 1099c0f28ce6SDave Jiang 1100c0f28ce6SDave Jiang if (is_xeon_cb32(pdev) || is_bwd_noraid(pdev)) 1101c0f28ce6SDave Jiang ioat_dma->cap &= 1102c0f28ce6SDave Jiang ~(IOAT_CAP_XOR | IOAT_CAP_PQ | IOAT_CAP_RAID16SS); 1103c0f28ce6SDave Jiang 1104c0f28ce6SDave Jiang /* dca is incompatible with raid operations */ 1105c0f28ce6SDave Jiang if (dca_en && (ioat_dma->cap & (IOAT_CAP_XOR|IOAT_CAP_PQ))) 1106c0f28ce6SDave Jiang ioat_dma->cap &= ~(IOAT_CAP_XOR|IOAT_CAP_PQ); 1107c0f28ce6SDave Jiang 1108c0f28ce6SDave Jiang if (ioat_dma->cap & IOAT_CAP_XOR) { 1109c0f28ce6SDave Jiang is_raid_device = true; 1110c0f28ce6SDave Jiang dma->max_xor = 8; 1111c0f28ce6SDave Jiang 1112c0f28ce6SDave Jiang dma_cap_set(DMA_XOR, dma->cap_mask); 1113c0f28ce6SDave Jiang dma->device_prep_dma_xor = ioat_prep_xor; 1114c0f28ce6SDave Jiang 1115c0f28ce6SDave Jiang dma_cap_set(DMA_XOR_VAL, dma->cap_mask); 1116c0f28ce6SDave Jiang dma->device_prep_dma_xor_val = ioat_prep_xor_val; 1117c0f28ce6SDave Jiang } 1118c0f28ce6SDave Jiang 1119c0f28ce6SDave Jiang if (ioat_dma->cap & IOAT_CAP_PQ) { 1120c0f28ce6SDave Jiang is_raid_device = true; 1121c0f28ce6SDave Jiang 1122c0f28ce6SDave Jiang dma->device_prep_dma_pq = ioat_prep_pq; 1123c0f28ce6SDave Jiang dma->device_prep_dma_pq_val = ioat_prep_pq_val; 1124c0f28ce6SDave Jiang dma_cap_set(DMA_PQ, dma->cap_mask); 1125c0f28ce6SDave Jiang dma_cap_set(DMA_PQ_VAL, dma->cap_mask); 1126c0f28ce6SDave Jiang 1127c0f28ce6SDave Jiang if (ioat_dma->cap & IOAT_CAP_RAID16SS) 1128c0f28ce6SDave Jiang dma_set_maxpq(dma, 16, 0); 1129c0f28ce6SDave Jiang else 1130c0f28ce6SDave Jiang dma_set_maxpq(dma, 8, 0); 1131c0f28ce6SDave Jiang 1132c0f28ce6SDave Jiang if (!(ioat_dma->cap & IOAT_CAP_XOR)) { 1133c0f28ce6SDave Jiang dma->device_prep_dma_xor = ioat_prep_pqxor; 1134c0f28ce6SDave Jiang dma->device_prep_dma_xor_val = ioat_prep_pqxor_val; 1135c0f28ce6SDave Jiang dma_cap_set(DMA_XOR, dma->cap_mask); 1136c0f28ce6SDave Jiang dma_cap_set(DMA_XOR_VAL, dma->cap_mask); 1137c0f28ce6SDave Jiang 1138c0f28ce6SDave Jiang if (ioat_dma->cap & IOAT_CAP_RAID16SS) 1139c0f28ce6SDave Jiang dma->max_xor = 16; 1140c0f28ce6SDave Jiang else 1141c0f28ce6SDave Jiang dma->max_xor = 8; 1142c0f28ce6SDave Jiang } 1143c0f28ce6SDave Jiang } 1144c0f28ce6SDave Jiang 1145c0f28ce6SDave Jiang dma->device_tx_status = ioat_tx_status; 1146c0f28ce6SDave Jiang 1147c0f28ce6SDave Jiang /* starting with CB3.3 super extended descriptors are supported */ 1148c0f28ce6SDave Jiang if (ioat_dma->cap & IOAT_CAP_RAID16SS) { 1149c0f28ce6SDave Jiang char pool_name[14]; 1150c0f28ce6SDave Jiang int i; 1151c0f28ce6SDave Jiang 1152c0f28ce6SDave Jiang for (i = 0; i < MAX_SED_POOLS; i++) { 1153c0f28ce6SDave Jiang snprintf(pool_name, 14, "ioat_hw%d_sed", i); 1154c0f28ce6SDave Jiang 1155c0f28ce6SDave Jiang /* allocate SED DMA pool */ 1156c0f28ce6SDave Jiang ioat_dma->sed_hw_pool[i] = dmam_pool_create(pool_name, 1157c0f28ce6SDave Jiang &pdev->dev, 1158c0f28ce6SDave Jiang SED_SIZE * (i + 1), 64, 0); 1159c0f28ce6SDave Jiang if (!ioat_dma->sed_hw_pool[i]) 1160c0f28ce6SDave Jiang return -ENOMEM; 1161c0f28ce6SDave Jiang 1162c0f28ce6SDave Jiang } 1163c0f28ce6SDave Jiang } 1164c0f28ce6SDave Jiang 1165c0f28ce6SDave Jiang if (!(ioat_dma->cap & (IOAT_CAP_XOR | IOAT_CAP_PQ))) 1166c0f28ce6SDave Jiang dma_cap_set(DMA_PRIVATE, dma->cap_mask); 1167c0f28ce6SDave Jiang 1168c0f28ce6SDave Jiang err = ioat_probe(ioat_dma); 1169c0f28ce6SDave Jiang if (err) 1170c0f28ce6SDave Jiang return err; 1171c0f28ce6SDave Jiang 1172c0f28ce6SDave Jiang list_for_each_entry(c, &dma->channels, device_node) { 1173c0f28ce6SDave Jiang ioat_chan = to_ioat_chan(c); 1174c0f28ce6SDave Jiang writel(IOAT_DMA_DCA_ANY_CPU, 1175c0f28ce6SDave Jiang ioat_chan->reg_base + IOAT_DCACTRL_OFFSET); 1176c0f28ce6SDave Jiang } 1177c0f28ce6SDave Jiang 1178c0f28ce6SDave Jiang err = ioat_register(ioat_dma); 1179c0f28ce6SDave Jiang if (err) 1180c0f28ce6SDave Jiang return err; 1181c0f28ce6SDave Jiang 1182c0f28ce6SDave Jiang ioat_kobject_add(ioat_dma, &ioat_ktype); 1183c0f28ce6SDave Jiang 1184c0f28ce6SDave Jiang if (dca) 11853372de58SDave Jiang ioat_dma->dca = ioat_dca_init(pdev, ioat_dma->reg_base); 1186c0f28ce6SDave Jiang 1187c0f28ce6SDave Jiang return 0; 1188c0f28ce6SDave Jiang } 1189c0f28ce6SDave Jiang 1190ad4a7b50SDave Jiang static void ioat_shutdown(struct pci_dev *pdev) 1191ad4a7b50SDave Jiang { 1192ad4a7b50SDave Jiang struct ioatdma_device *ioat_dma = pci_get_drvdata(pdev); 1193ad4a7b50SDave Jiang struct ioatdma_chan *ioat_chan; 1194ad4a7b50SDave Jiang int i; 1195ad4a7b50SDave Jiang 1196ad4a7b50SDave Jiang if (!ioat_dma) 1197ad4a7b50SDave Jiang return; 1198ad4a7b50SDave Jiang 1199ad4a7b50SDave Jiang for (i = 0; i < IOAT_MAX_CHANS; i++) { 1200ad4a7b50SDave Jiang ioat_chan = ioat_dma->idx[i]; 1201ad4a7b50SDave Jiang if (!ioat_chan) 1202ad4a7b50SDave Jiang continue; 1203ad4a7b50SDave Jiang 1204ad4a7b50SDave Jiang spin_lock_bh(&ioat_chan->prep_lock); 1205ad4a7b50SDave Jiang set_bit(IOAT_CHAN_DOWN, &ioat_chan->state); 1206ad4a7b50SDave Jiang del_timer_sync(&ioat_chan->timer); 1207ad4a7b50SDave Jiang spin_unlock_bh(&ioat_chan->prep_lock); 1208ad4a7b50SDave Jiang /* this should quiesce then reset */ 1209ad4a7b50SDave Jiang ioat_reset_hw(ioat_chan); 1210ad4a7b50SDave Jiang } 1211ad4a7b50SDave Jiang 1212ad4a7b50SDave Jiang ioat_disable_interrupts(ioat_dma); 1213ad4a7b50SDave Jiang } 1214ad4a7b50SDave Jiang 12154222a907SDave Jiang void ioat_resume(struct ioatdma_device *ioat_dma) 12164222a907SDave Jiang { 12174222a907SDave Jiang struct ioatdma_chan *ioat_chan; 12184222a907SDave Jiang u32 chanerr; 12194222a907SDave Jiang int i; 12204222a907SDave Jiang 12214222a907SDave Jiang for (i = 0; i < IOAT_MAX_CHANS; i++) { 12224222a907SDave Jiang ioat_chan = ioat_dma->idx[i]; 12234222a907SDave Jiang if (!ioat_chan) 12244222a907SDave Jiang continue; 12254222a907SDave Jiang 12264222a907SDave Jiang spin_lock_bh(&ioat_chan->prep_lock); 12274222a907SDave Jiang clear_bit(IOAT_CHAN_DOWN, &ioat_chan->state); 12284222a907SDave Jiang spin_unlock_bh(&ioat_chan->prep_lock); 12294222a907SDave Jiang 12304222a907SDave Jiang chanerr = readl(ioat_chan->reg_base + IOAT_CHANERR_OFFSET); 12314222a907SDave Jiang writel(chanerr, ioat_chan->reg_base + IOAT_CHANERR_OFFSET); 12324222a907SDave Jiang 12334222a907SDave Jiang /* no need to reset as shutdown already did that */ 12344222a907SDave Jiang } 12354222a907SDave Jiang } 12364222a907SDave Jiang 1237c0f28ce6SDave Jiang #define DRV_NAME "ioatdma" 1238c0f28ce6SDave Jiang 12394222a907SDave Jiang static pci_ers_result_t ioat_pcie_error_detected(struct pci_dev *pdev, 12404222a907SDave Jiang enum pci_channel_state error) 12414222a907SDave Jiang { 12424222a907SDave Jiang dev_dbg(&pdev->dev, "%s: PCIe AER error %d\n", DRV_NAME, error); 12434222a907SDave Jiang 12444222a907SDave Jiang /* quiesce and block I/O */ 12454222a907SDave Jiang ioat_shutdown(pdev); 12464222a907SDave Jiang 12474222a907SDave Jiang return PCI_ERS_RESULT_NEED_RESET; 12484222a907SDave Jiang } 12494222a907SDave Jiang 12504222a907SDave Jiang static pci_ers_result_t ioat_pcie_error_slot_reset(struct pci_dev *pdev) 12514222a907SDave Jiang { 12524222a907SDave Jiang pci_ers_result_t result = PCI_ERS_RESULT_RECOVERED; 12534222a907SDave Jiang int err; 12544222a907SDave Jiang 12554222a907SDave Jiang dev_dbg(&pdev->dev, "%s post reset handling\n", DRV_NAME); 12564222a907SDave Jiang 12574222a907SDave Jiang if (pci_enable_device_mem(pdev) < 0) { 12584222a907SDave Jiang dev_err(&pdev->dev, 12594222a907SDave Jiang "Failed to enable PCIe device after reset.\n"); 12604222a907SDave Jiang result = PCI_ERS_RESULT_DISCONNECT; 12614222a907SDave Jiang } else { 12624222a907SDave Jiang pci_set_master(pdev); 12634222a907SDave Jiang pci_restore_state(pdev); 12644222a907SDave Jiang pci_save_state(pdev); 12654222a907SDave Jiang pci_wake_from_d3(pdev, false); 12664222a907SDave Jiang } 12674222a907SDave Jiang 12684222a907SDave Jiang err = pci_cleanup_aer_uncorrect_error_status(pdev); 12694222a907SDave Jiang if (err) { 12704222a907SDave Jiang dev_err(&pdev->dev, 12714222a907SDave Jiang "AER uncorrect error status clear failed: %#x\n", err); 12724222a907SDave Jiang } 12734222a907SDave Jiang 12744222a907SDave Jiang return result; 12754222a907SDave Jiang } 12764222a907SDave Jiang 12774222a907SDave Jiang static void ioat_pcie_error_resume(struct pci_dev *pdev) 12784222a907SDave Jiang { 12794222a907SDave Jiang struct ioatdma_device *ioat_dma = pci_get_drvdata(pdev); 12804222a907SDave Jiang 12814222a907SDave Jiang dev_dbg(&pdev->dev, "%s: AER handling resuming\n", DRV_NAME); 12824222a907SDave Jiang 12834222a907SDave Jiang /* initialize and bring everything back */ 12844222a907SDave Jiang ioat_resume(ioat_dma); 12854222a907SDave Jiang } 12864222a907SDave Jiang 12874222a907SDave Jiang static const struct pci_error_handlers ioat_err_handler = { 12884222a907SDave Jiang .error_detected = ioat_pcie_error_detected, 12894222a907SDave Jiang .slot_reset = ioat_pcie_error_slot_reset, 12904222a907SDave Jiang .resume = ioat_pcie_error_resume, 12914222a907SDave Jiang }; 12924222a907SDave Jiang 1293c0f28ce6SDave Jiang static struct pci_driver ioat_pci_driver = { 1294c0f28ce6SDave Jiang .name = DRV_NAME, 1295c0f28ce6SDave Jiang .id_table = ioat_pci_tbl, 1296c0f28ce6SDave Jiang .probe = ioat_pci_probe, 1297c0f28ce6SDave Jiang .remove = ioat_remove, 1298ad4a7b50SDave Jiang .shutdown = ioat_shutdown, 12994222a907SDave Jiang .err_handler = &ioat_err_handler, 1300c0f28ce6SDave Jiang }; 1301c0f28ce6SDave Jiang 1302c0f28ce6SDave Jiang static struct ioatdma_device * 1303c0f28ce6SDave Jiang alloc_ioatdma(struct pci_dev *pdev, void __iomem *iobase) 1304c0f28ce6SDave Jiang { 1305c0f28ce6SDave Jiang struct device *dev = &pdev->dev; 1306c0f28ce6SDave Jiang struct ioatdma_device *d = devm_kzalloc(dev, sizeof(*d), GFP_KERNEL); 1307c0f28ce6SDave Jiang 1308c0f28ce6SDave Jiang if (!d) 1309c0f28ce6SDave Jiang return NULL; 1310c0f28ce6SDave Jiang d->pdev = pdev; 1311c0f28ce6SDave Jiang d->reg_base = iobase; 1312c0f28ce6SDave Jiang return d; 1313c0f28ce6SDave Jiang } 1314c0f28ce6SDave Jiang 1315c0f28ce6SDave Jiang static int ioat_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) 1316c0f28ce6SDave Jiang { 1317c0f28ce6SDave Jiang void __iomem * const *iomap; 1318c0f28ce6SDave Jiang struct device *dev = &pdev->dev; 1319c0f28ce6SDave Jiang struct ioatdma_device *device; 1320c0f28ce6SDave Jiang int err; 1321c0f28ce6SDave Jiang 1322c0f28ce6SDave Jiang err = pcim_enable_device(pdev); 1323c0f28ce6SDave Jiang if (err) 1324c0f28ce6SDave Jiang return err; 1325c0f28ce6SDave Jiang 1326c0f28ce6SDave Jiang err = pcim_iomap_regions(pdev, 1 << IOAT_MMIO_BAR, DRV_NAME); 1327c0f28ce6SDave Jiang if (err) 1328c0f28ce6SDave Jiang return err; 1329c0f28ce6SDave Jiang iomap = pcim_iomap_table(pdev); 1330c0f28ce6SDave Jiang if (!iomap) 1331c0f28ce6SDave Jiang return -ENOMEM; 1332c0f28ce6SDave Jiang 1333c0f28ce6SDave Jiang err = pci_set_dma_mask(pdev, DMA_BIT_MASK(64)); 1334c0f28ce6SDave Jiang if (err) 1335c0f28ce6SDave Jiang err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); 1336c0f28ce6SDave Jiang if (err) 1337c0f28ce6SDave Jiang return err; 1338c0f28ce6SDave Jiang 1339c0f28ce6SDave Jiang err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); 1340c0f28ce6SDave Jiang if (err) 1341c0f28ce6SDave Jiang err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)); 1342c0f28ce6SDave Jiang if (err) 1343c0f28ce6SDave Jiang return err; 1344c0f28ce6SDave Jiang 1345c0f28ce6SDave Jiang device = alloc_ioatdma(pdev, iomap[IOAT_MMIO_BAR]); 1346c0f28ce6SDave Jiang if (!device) 1347c0f28ce6SDave Jiang return -ENOMEM; 1348c0f28ce6SDave Jiang pci_set_master(pdev); 1349c0f28ce6SDave Jiang pci_set_drvdata(pdev, device); 1350c0f28ce6SDave Jiang 1351c0f28ce6SDave Jiang device->version = readb(device->reg_base + IOAT_VER_OFFSET); 13524222a907SDave Jiang if (device->version >= IOAT_VER_3_0) { 1353c0f28ce6SDave Jiang err = ioat3_dma_probe(device, ioat_dca_enabled); 13544222a907SDave Jiang 13554222a907SDave Jiang if (device->version >= IOAT_VER_3_3) 13564222a907SDave Jiang pci_enable_pcie_error_reporting(pdev); 13574222a907SDave Jiang } else 1358c0f28ce6SDave Jiang return -ENODEV; 1359c0f28ce6SDave Jiang 1360c0f28ce6SDave Jiang if (err) { 1361c0f28ce6SDave Jiang dev_err(dev, "Intel(R) I/OAT DMA Engine init failed\n"); 13624222a907SDave Jiang pci_disable_pcie_error_reporting(pdev); 1363c0f28ce6SDave Jiang return -ENODEV; 1364c0f28ce6SDave Jiang } 1365c0f28ce6SDave Jiang 1366c0f28ce6SDave Jiang return 0; 1367c0f28ce6SDave Jiang } 1368c0f28ce6SDave Jiang 1369c0f28ce6SDave Jiang static void ioat_remove(struct pci_dev *pdev) 1370c0f28ce6SDave Jiang { 1371c0f28ce6SDave Jiang struct ioatdma_device *device = pci_get_drvdata(pdev); 1372c0f28ce6SDave Jiang 1373c0f28ce6SDave Jiang if (!device) 1374c0f28ce6SDave Jiang return; 1375c0f28ce6SDave Jiang 1376c0f28ce6SDave Jiang dev_err(&pdev->dev, "Removing dma and dca services\n"); 1377c0f28ce6SDave Jiang if (device->dca) { 1378c0f28ce6SDave Jiang unregister_dca_provider(device->dca, &pdev->dev); 1379c0f28ce6SDave Jiang free_dca_provider(device->dca); 1380c0f28ce6SDave Jiang device->dca = NULL; 1381c0f28ce6SDave Jiang } 13824222a907SDave Jiang 13834222a907SDave Jiang pci_disable_pcie_error_reporting(pdev); 1384c0f28ce6SDave Jiang ioat_dma_remove(device); 1385c0f28ce6SDave Jiang } 1386c0f28ce6SDave Jiang 1387c0f28ce6SDave Jiang static int __init ioat_init_module(void) 1388c0f28ce6SDave Jiang { 1389c0f28ce6SDave Jiang int err = -ENOMEM; 1390c0f28ce6SDave Jiang 1391c0f28ce6SDave Jiang pr_info("%s: Intel(R) QuickData Technology Driver %s\n", 1392c0f28ce6SDave Jiang DRV_NAME, IOAT_DMA_VERSION); 1393c0f28ce6SDave Jiang 1394c0f28ce6SDave Jiang ioat_cache = kmem_cache_create("ioat", sizeof(struct ioat_ring_ent), 1395c0f28ce6SDave Jiang 0, SLAB_HWCACHE_ALIGN, NULL); 1396c0f28ce6SDave Jiang if (!ioat_cache) 1397c0f28ce6SDave Jiang return -ENOMEM; 1398c0f28ce6SDave Jiang 1399c0f28ce6SDave Jiang ioat_sed_cache = KMEM_CACHE(ioat_sed_ent, 0); 1400c0f28ce6SDave Jiang if (!ioat_sed_cache) 1401c0f28ce6SDave Jiang goto err_ioat_cache; 1402c0f28ce6SDave Jiang 1403c0f28ce6SDave Jiang err = pci_register_driver(&ioat_pci_driver); 1404c0f28ce6SDave Jiang if (err) 1405c0f28ce6SDave Jiang goto err_ioat3_cache; 1406c0f28ce6SDave Jiang 1407c0f28ce6SDave Jiang return 0; 1408c0f28ce6SDave Jiang 1409c0f28ce6SDave Jiang err_ioat3_cache: 1410c0f28ce6SDave Jiang kmem_cache_destroy(ioat_sed_cache); 1411c0f28ce6SDave Jiang 1412c0f28ce6SDave Jiang err_ioat_cache: 1413c0f28ce6SDave Jiang kmem_cache_destroy(ioat_cache); 1414c0f28ce6SDave Jiang 1415c0f28ce6SDave Jiang return err; 1416c0f28ce6SDave Jiang } 1417c0f28ce6SDave Jiang module_init(ioat_init_module); 1418c0f28ce6SDave Jiang 1419c0f28ce6SDave Jiang static void __exit ioat_exit_module(void) 1420c0f28ce6SDave Jiang { 1421c0f28ce6SDave Jiang pci_unregister_driver(&ioat_pci_driver); 1422c0f28ce6SDave Jiang kmem_cache_destroy(ioat_cache); 1423c0f28ce6SDave Jiang } 1424c0f28ce6SDave Jiang module_exit(ioat_exit_module); 1425