xref: /openbmc/linux/drivers/dma/ioat/init.c (revision ef97bd0f)
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 {
1011c0f28ce6SDave Jiang 	int rc = ioat_dma_self_test(ioat_dma);
1012c0f28ce6SDave Jiang 
1013c0f28ce6SDave Jiang 	if (rc)
1014c0f28ce6SDave Jiang 		return rc;
1015c0f28ce6SDave Jiang 
1016c0f28ce6SDave Jiang 	rc = ioat_xor_val_self_test(ioat_dma);
1017c0f28ce6SDave Jiang 	if (rc)
1018c0f28ce6SDave Jiang 		return rc;
1019c0f28ce6SDave Jiang 
1020c0f28ce6SDave Jiang 	return 0;
1021c0f28ce6SDave Jiang }
1022c0f28ce6SDave Jiang 
10233372de58SDave Jiang static void ioat_intr_quirk(struct ioatdma_device *ioat_dma)
1024c0f28ce6SDave Jiang {
1025c0f28ce6SDave Jiang 	struct dma_device *dma;
1026c0f28ce6SDave Jiang 	struct dma_chan *c;
1027c0f28ce6SDave Jiang 	struct ioatdma_chan *ioat_chan;
1028c0f28ce6SDave Jiang 	u32 errmask;
1029c0f28ce6SDave Jiang 
1030c0f28ce6SDave Jiang 	dma = &ioat_dma->dma_dev;
1031c0f28ce6SDave Jiang 
1032c0f28ce6SDave Jiang 	/*
1033c0f28ce6SDave Jiang 	 * if we have descriptor write back error status, we mask the
1034c0f28ce6SDave Jiang 	 * error interrupts
1035c0f28ce6SDave Jiang 	 */
1036c0f28ce6SDave Jiang 	if (ioat_dma->cap & IOAT_CAP_DWBES) {
1037c0f28ce6SDave Jiang 		list_for_each_entry(c, &dma->channels, device_node) {
1038c0f28ce6SDave Jiang 			ioat_chan = to_ioat_chan(c);
1039c0f28ce6SDave Jiang 			errmask = readl(ioat_chan->reg_base +
1040c0f28ce6SDave Jiang 					IOAT_CHANERR_MASK_OFFSET);
1041c0f28ce6SDave Jiang 			errmask |= IOAT_CHANERR_XOR_P_OR_CRC_ERR |
1042c0f28ce6SDave Jiang 				   IOAT_CHANERR_XOR_Q_ERR;
1043c0f28ce6SDave Jiang 			writel(errmask, ioat_chan->reg_base +
1044c0f28ce6SDave Jiang 					IOAT_CHANERR_MASK_OFFSET);
1045c0f28ce6SDave Jiang 		}
1046c0f28ce6SDave Jiang 	}
1047c0f28ce6SDave Jiang }
1048c0f28ce6SDave Jiang 
1049599d49deSDave Jiang static int ioat3_dma_probe(struct ioatdma_device *ioat_dma, int dca)
1050c0f28ce6SDave Jiang {
1051c0f28ce6SDave Jiang 	struct pci_dev *pdev = ioat_dma->pdev;
1052c0f28ce6SDave Jiang 	int dca_en = system_has_dca_enabled(pdev);
1053c0f28ce6SDave Jiang 	struct dma_device *dma;
1054c0f28ce6SDave Jiang 	struct dma_chan *c;
1055c0f28ce6SDave Jiang 	struct ioatdma_chan *ioat_chan;
1056c0f28ce6SDave Jiang 	bool is_raid_device = false;
1057c0f28ce6SDave Jiang 	int err;
1058c0f28ce6SDave Jiang 
1059c0f28ce6SDave Jiang 	dma = &ioat_dma->dma_dev;
1060c0f28ce6SDave Jiang 	dma->device_prep_dma_memcpy = ioat_dma_prep_memcpy_lock;
1061c0f28ce6SDave Jiang 	dma->device_issue_pending = ioat_issue_pending;
1062c0f28ce6SDave Jiang 	dma->device_alloc_chan_resources = ioat_alloc_chan_resources;
1063c0f28ce6SDave Jiang 	dma->device_free_chan_resources = ioat_free_chan_resources;
1064c0f28ce6SDave Jiang 
1065c0f28ce6SDave Jiang 	dma_cap_set(DMA_INTERRUPT, dma->cap_mask);
1066c0f28ce6SDave Jiang 	dma->device_prep_dma_interrupt = ioat_prep_interrupt_lock;
1067c0f28ce6SDave Jiang 
1068c0f28ce6SDave Jiang 	ioat_dma->cap = readl(ioat_dma->reg_base + IOAT_DMA_CAP_OFFSET);
1069c0f28ce6SDave Jiang 
1070c0f28ce6SDave Jiang 	if (is_xeon_cb32(pdev) || is_bwd_noraid(pdev))
1071c0f28ce6SDave Jiang 		ioat_dma->cap &=
1072c0f28ce6SDave Jiang 			~(IOAT_CAP_XOR | IOAT_CAP_PQ | IOAT_CAP_RAID16SS);
1073c0f28ce6SDave Jiang 
1074c0f28ce6SDave Jiang 	/* dca is incompatible with raid operations */
1075c0f28ce6SDave Jiang 	if (dca_en && (ioat_dma->cap & (IOAT_CAP_XOR|IOAT_CAP_PQ)))
1076c0f28ce6SDave Jiang 		ioat_dma->cap &= ~(IOAT_CAP_XOR|IOAT_CAP_PQ);
1077c0f28ce6SDave Jiang 
1078c0f28ce6SDave Jiang 	if (ioat_dma->cap & IOAT_CAP_XOR) {
1079c0f28ce6SDave Jiang 		is_raid_device = true;
1080c0f28ce6SDave Jiang 		dma->max_xor = 8;
1081c0f28ce6SDave Jiang 
1082c0f28ce6SDave Jiang 		dma_cap_set(DMA_XOR, dma->cap_mask);
1083c0f28ce6SDave Jiang 		dma->device_prep_dma_xor = ioat_prep_xor;
1084c0f28ce6SDave Jiang 
1085c0f28ce6SDave Jiang 		dma_cap_set(DMA_XOR_VAL, dma->cap_mask);
1086c0f28ce6SDave Jiang 		dma->device_prep_dma_xor_val = ioat_prep_xor_val;
1087c0f28ce6SDave Jiang 	}
1088c0f28ce6SDave Jiang 
1089c0f28ce6SDave Jiang 	if (ioat_dma->cap & IOAT_CAP_PQ) {
1090c0f28ce6SDave Jiang 		is_raid_device = true;
1091c0f28ce6SDave Jiang 
1092c0f28ce6SDave Jiang 		dma->device_prep_dma_pq = ioat_prep_pq;
1093c0f28ce6SDave Jiang 		dma->device_prep_dma_pq_val = ioat_prep_pq_val;
1094c0f28ce6SDave Jiang 		dma_cap_set(DMA_PQ, dma->cap_mask);
1095c0f28ce6SDave Jiang 		dma_cap_set(DMA_PQ_VAL, dma->cap_mask);
1096c0f28ce6SDave Jiang 
1097c0f28ce6SDave Jiang 		if (ioat_dma->cap & IOAT_CAP_RAID16SS)
1098c0f28ce6SDave Jiang 			dma_set_maxpq(dma, 16, 0);
1099c0f28ce6SDave Jiang 		else
1100c0f28ce6SDave Jiang 			dma_set_maxpq(dma, 8, 0);
1101c0f28ce6SDave Jiang 
1102c0f28ce6SDave Jiang 		if (!(ioat_dma->cap & IOAT_CAP_XOR)) {
1103c0f28ce6SDave Jiang 			dma->device_prep_dma_xor = ioat_prep_pqxor;
1104c0f28ce6SDave Jiang 			dma->device_prep_dma_xor_val = ioat_prep_pqxor_val;
1105c0f28ce6SDave Jiang 			dma_cap_set(DMA_XOR, dma->cap_mask);
1106c0f28ce6SDave Jiang 			dma_cap_set(DMA_XOR_VAL, dma->cap_mask);
1107c0f28ce6SDave Jiang 
1108c0f28ce6SDave Jiang 			if (ioat_dma->cap & IOAT_CAP_RAID16SS)
1109c0f28ce6SDave Jiang 				dma->max_xor = 16;
1110c0f28ce6SDave Jiang 			else
1111c0f28ce6SDave Jiang 				dma->max_xor = 8;
1112c0f28ce6SDave Jiang 		}
1113c0f28ce6SDave Jiang 	}
1114c0f28ce6SDave Jiang 
1115c0f28ce6SDave Jiang 	dma->device_tx_status = ioat_tx_status;
1116c0f28ce6SDave Jiang 
1117c0f28ce6SDave Jiang 	/* starting with CB3.3 super extended descriptors are supported */
1118c0f28ce6SDave Jiang 	if (ioat_dma->cap & IOAT_CAP_RAID16SS) {
1119c0f28ce6SDave Jiang 		char pool_name[14];
1120c0f28ce6SDave Jiang 		int i;
1121c0f28ce6SDave Jiang 
1122c0f28ce6SDave Jiang 		for (i = 0; i < MAX_SED_POOLS; i++) {
1123c0f28ce6SDave Jiang 			snprintf(pool_name, 14, "ioat_hw%d_sed", i);
1124c0f28ce6SDave Jiang 
1125c0f28ce6SDave Jiang 			/* allocate SED DMA pool */
1126c0f28ce6SDave Jiang 			ioat_dma->sed_hw_pool[i] = dmam_pool_create(pool_name,
1127c0f28ce6SDave Jiang 					&pdev->dev,
1128c0f28ce6SDave Jiang 					SED_SIZE * (i + 1), 64, 0);
1129c0f28ce6SDave Jiang 			if (!ioat_dma->sed_hw_pool[i])
1130c0f28ce6SDave Jiang 				return -ENOMEM;
1131c0f28ce6SDave Jiang 
1132c0f28ce6SDave Jiang 		}
1133c0f28ce6SDave Jiang 	}
1134c0f28ce6SDave Jiang 
1135c0f28ce6SDave Jiang 	if (!(ioat_dma->cap & (IOAT_CAP_XOR | IOAT_CAP_PQ)))
1136c0f28ce6SDave Jiang 		dma_cap_set(DMA_PRIVATE, dma->cap_mask);
1137c0f28ce6SDave Jiang 
1138c0f28ce6SDave Jiang 	err = ioat_probe(ioat_dma);
1139c0f28ce6SDave Jiang 	if (err)
1140c0f28ce6SDave Jiang 		return err;
1141c0f28ce6SDave Jiang 
1142c0f28ce6SDave Jiang 	list_for_each_entry(c, &dma->channels, device_node) {
1143c0f28ce6SDave Jiang 		ioat_chan = to_ioat_chan(c);
1144c0f28ce6SDave Jiang 		writel(IOAT_DMA_DCA_ANY_CPU,
1145c0f28ce6SDave Jiang 		       ioat_chan->reg_base + IOAT_DCACTRL_OFFSET);
1146c0f28ce6SDave Jiang 	}
1147c0f28ce6SDave Jiang 
1148c0f28ce6SDave Jiang 	err = ioat_register(ioat_dma);
1149c0f28ce6SDave Jiang 	if (err)
1150c0f28ce6SDave Jiang 		return err;
1151c0f28ce6SDave Jiang 
1152c0f28ce6SDave Jiang 	ioat_kobject_add(ioat_dma, &ioat_ktype);
1153c0f28ce6SDave Jiang 
1154c0f28ce6SDave Jiang 	if (dca)
11553372de58SDave Jiang 		ioat_dma->dca = ioat_dca_init(pdev, ioat_dma->reg_base);
1156c0f28ce6SDave Jiang 
1157c0f28ce6SDave Jiang 	return 0;
1158c0f28ce6SDave Jiang }
1159c0f28ce6SDave Jiang 
1160c0f28ce6SDave Jiang #define DRV_NAME "ioatdma"
1161c0f28ce6SDave Jiang 
1162c0f28ce6SDave Jiang static struct pci_driver ioat_pci_driver = {
1163c0f28ce6SDave Jiang 	.name		= DRV_NAME,
1164c0f28ce6SDave Jiang 	.id_table	= ioat_pci_tbl,
1165c0f28ce6SDave Jiang 	.probe		= ioat_pci_probe,
1166c0f28ce6SDave Jiang 	.remove		= ioat_remove,
1167c0f28ce6SDave Jiang };
1168c0f28ce6SDave Jiang 
1169c0f28ce6SDave Jiang static struct ioatdma_device *
1170c0f28ce6SDave Jiang alloc_ioatdma(struct pci_dev *pdev, void __iomem *iobase)
1171c0f28ce6SDave Jiang {
1172c0f28ce6SDave Jiang 	struct device *dev = &pdev->dev;
1173c0f28ce6SDave Jiang 	struct ioatdma_device *d = devm_kzalloc(dev, sizeof(*d), GFP_KERNEL);
1174c0f28ce6SDave Jiang 
1175c0f28ce6SDave Jiang 	if (!d)
1176c0f28ce6SDave Jiang 		return NULL;
1177c0f28ce6SDave Jiang 	d->pdev = pdev;
1178c0f28ce6SDave Jiang 	d->reg_base = iobase;
1179c0f28ce6SDave Jiang 	return d;
1180c0f28ce6SDave Jiang }
1181c0f28ce6SDave Jiang 
1182c0f28ce6SDave Jiang static int ioat_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id)
1183c0f28ce6SDave Jiang {
1184c0f28ce6SDave Jiang 	void __iomem * const *iomap;
1185c0f28ce6SDave Jiang 	struct device *dev = &pdev->dev;
1186c0f28ce6SDave Jiang 	struct ioatdma_device *device;
1187c0f28ce6SDave Jiang 	int err;
1188c0f28ce6SDave Jiang 
1189c0f28ce6SDave Jiang 	err = pcim_enable_device(pdev);
1190c0f28ce6SDave Jiang 	if (err)
1191c0f28ce6SDave Jiang 		return err;
1192c0f28ce6SDave Jiang 
1193c0f28ce6SDave Jiang 	err = pcim_iomap_regions(pdev, 1 << IOAT_MMIO_BAR, DRV_NAME);
1194c0f28ce6SDave Jiang 	if (err)
1195c0f28ce6SDave Jiang 		return err;
1196c0f28ce6SDave Jiang 	iomap = pcim_iomap_table(pdev);
1197c0f28ce6SDave Jiang 	if (!iomap)
1198c0f28ce6SDave Jiang 		return -ENOMEM;
1199c0f28ce6SDave Jiang 
1200c0f28ce6SDave Jiang 	err = pci_set_dma_mask(pdev, DMA_BIT_MASK(64));
1201c0f28ce6SDave Jiang 	if (err)
1202c0f28ce6SDave Jiang 		err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
1203c0f28ce6SDave Jiang 	if (err)
1204c0f28ce6SDave Jiang 		return err;
1205c0f28ce6SDave Jiang 
1206c0f28ce6SDave Jiang 	err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64));
1207c0f28ce6SDave Jiang 	if (err)
1208c0f28ce6SDave Jiang 		err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32));
1209c0f28ce6SDave Jiang 	if (err)
1210c0f28ce6SDave Jiang 		return err;
1211c0f28ce6SDave Jiang 
1212c0f28ce6SDave Jiang 	device = alloc_ioatdma(pdev, iomap[IOAT_MMIO_BAR]);
1213c0f28ce6SDave Jiang 	if (!device)
1214c0f28ce6SDave Jiang 		return -ENOMEM;
1215c0f28ce6SDave Jiang 	pci_set_master(pdev);
1216c0f28ce6SDave Jiang 	pci_set_drvdata(pdev, device);
1217c0f28ce6SDave Jiang 
1218c0f28ce6SDave Jiang 	device->version = readb(device->reg_base + IOAT_VER_OFFSET);
1219c0f28ce6SDave Jiang 	if (device->version >= IOAT_VER_3_0)
1220c0f28ce6SDave Jiang 		err = ioat3_dma_probe(device, ioat_dca_enabled);
1221c0f28ce6SDave Jiang 	else
1222c0f28ce6SDave Jiang 		return -ENODEV;
1223c0f28ce6SDave Jiang 
1224c0f28ce6SDave Jiang 	if (err) {
1225c0f28ce6SDave Jiang 		dev_err(dev, "Intel(R) I/OAT DMA Engine init failed\n");
1226c0f28ce6SDave Jiang 		return -ENODEV;
1227c0f28ce6SDave Jiang 	}
1228c0f28ce6SDave Jiang 
1229c0f28ce6SDave Jiang 	return 0;
1230c0f28ce6SDave Jiang }
1231c0f28ce6SDave Jiang 
1232c0f28ce6SDave Jiang static void ioat_remove(struct pci_dev *pdev)
1233c0f28ce6SDave Jiang {
1234c0f28ce6SDave Jiang 	struct ioatdma_device *device = pci_get_drvdata(pdev);
1235c0f28ce6SDave Jiang 
1236c0f28ce6SDave Jiang 	if (!device)
1237c0f28ce6SDave Jiang 		return;
1238c0f28ce6SDave Jiang 
1239c0f28ce6SDave Jiang 	dev_err(&pdev->dev, "Removing dma and dca services\n");
1240c0f28ce6SDave Jiang 	if (device->dca) {
1241c0f28ce6SDave Jiang 		unregister_dca_provider(device->dca, &pdev->dev);
1242c0f28ce6SDave Jiang 		free_dca_provider(device->dca);
1243c0f28ce6SDave Jiang 		device->dca = NULL;
1244c0f28ce6SDave Jiang 	}
1245c0f28ce6SDave Jiang 	ioat_dma_remove(device);
1246c0f28ce6SDave Jiang }
1247c0f28ce6SDave Jiang 
1248c0f28ce6SDave Jiang static int __init ioat_init_module(void)
1249c0f28ce6SDave Jiang {
1250c0f28ce6SDave Jiang 	int err = -ENOMEM;
1251c0f28ce6SDave Jiang 
1252c0f28ce6SDave Jiang 	pr_info("%s: Intel(R) QuickData Technology Driver %s\n",
1253c0f28ce6SDave Jiang 		DRV_NAME, IOAT_DMA_VERSION);
1254c0f28ce6SDave Jiang 
1255c0f28ce6SDave Jiang 	ioat_cache = kmem_cache_create("ioat", sizeof(struct ioat_ring_ent),
1256c0f28ce6SDave Jiang 					0, SLAB_HWCACHE_ALIGN, NULL);
1257c0f28ce6SDave Jiang 	if (!ioat_cache)
1258c0f28ce6SDave Jiang 		return -ENOMEM;
1259c0f28ce6SDave Jiang 
1260c0f28ce6SDave Jiang 	ioat_sed_cache = KMEM_CACHE(ioat_sed_ent, 0);
1261c0f28ce6SDave Jiang 	if (!ioat_sed_cache)
1262c0f28ce6SDave Jiang 		goto err_ioat_cache;
1263c0f28ce6SDave Jiang 
1264c0f28ce6SDave Jiang 	err = pci_register_driver(&ioat_pci_driver);
1265c0f28ce6SDave Jiang 	if (err)
1266c0f28ce6SDave Jiang 		goto err_ioat3_cache;
1267c0f28ce6SDave Jiang 
1268c0f28ce6SDave Jiang 	return 0;
1269c0f28ce6SDave Jiang 
1270c0f28ce6SDave Jiang  err_ioat3_cache:
1271c0f28ce6SDave Jiang 	kmem_cache_destroy(ioat_sed_cache);
1272c0f28ce6SDave Jiang 
1273c0f28ce6SDave Jiang  err_ioat_cache:
1274c0f28ce6SDave Jiang 	kmem_cache_destroy(ioat_cache);
1275c0f28ce6SDave Jiang 
1276c0f28ce6SDave Jiang 	return err;
1277c0f28ce6SDave Jiang }
1278c0f28ce6SDave Jiang module_init(ioat_init_module);
1279c0f28ce6SDave Jiang 
1280c0f28ce6SDave Jiang static void __exit ioat_exit_module(void)
1281c0f28ce6SDave Jiang {
1282c0f28ce6SDave Jiang 	pci_unregister_driver(&ioat_pci_driver);
1283c0f28ce6SDave Jiang 	kmem_cache_destroy(ioat_cache);
1284c0f28ce6SDave Jiang }
1285c0f28ce6SDave Jiang module_exit(ioat_exit_module);
1286