1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright(c) 2019 Intel Corporation. All rights rsvd. */
3 #include <linux/init.h>
4 #include <linux/kernel.h>
5 #include <linux/module.h>
7 #include <linux/device.h>
8 #include <linux/io-64-nonatomic-lo-hi.h>
9 #include <linux/dmaengine.h>
10 #include <uapi/linux/idxd.h>
11 #include "../dmaengine.h"
12 #include "registers.h"
15 static inline struct idxd_wq *to_idxd_wq(struct dma_chan *c)
17 struct idxd_dma_chan *idxd_chan;
19 idxd_chan = container_of(c, struct idxd_dma_chan, chan);
23 void idxd_dma_complete_txd(struct idxd_desc *desc,
24 enum idxd_complete_type comp_type,
27 struct idxd_device *idxd = desc->wq->idxd;
28 struct dma_async_tx_descriptor *tx;
29 struct dmaengine_result res;
32 if (desc->completion->status == DSA_COMP_SUCCESS) {
33 res.result = DMA_TRANS_NOERROR;
34 } else if (desc->completion->status) {
35 if (idxd->request_int_handles && comp_type != IDXD_COMPLETE_ABORT &&
36 desc->completion->status == DSA_COMP_INT_HANDLE_INVAL &&
37 idxd_queue_int_handle_resubmit(desc))
39 res.result = DMA_TRANS_WRITE_FAILED;
40 } else if (comp_type == IDXD_COMPLETE_ABORT) {
41 res.result = DMA_TRANS_ABORTED;
47 if (complete && tx->cookie) {
48 dma_cookie_complete(tx);
49 dma_descriptor_unmap(tx);
50 dmaengine_desc_get_callback_invoke(tx, &res);
52 tx->callback_result = NULL;
56 idxd_free_desc(desc->wq, desc);
59 static void op_flag_setup(unsigned long flags, u32 *desc_flags)
61 *desc_flags = IDXD_OP_FLAG_CRAV | IDXD_OP_FLAG_RCR;
62 if (flags & DMA_PREP_INTERRUPT)
63 *desc_flags |= IDXD_OP_FLAG_RCI;
66 static inline void set_completion_address(struct idxd_desc *desc,
69 *compl_addr = desc->compl_dma;
72 static inline void idxd_prep_desc_common(struct idxd_wq *wq,
73 struct dsa_hw_desc *hw, char opcode,
74 u64 addr_f1, u64 addr_f2, u64 len,
79 hw->src_addr = addr_f1;
80 hw->dst_addr = addr_f2;
83 * For dedicated WQ, this field is ignored and HW will use the WQCFG.priv
84 * field instead. This field should be set to 1 for kernel descriptors.
87 hw->completion_addr = compl;
90 static struct dma_async_tx_descriptor *
91 idxd_dma_prep_interrupt(struct dma_chan *c, unsigned long flags)
93 struct idxd_wq *wq = to_idxd_wq(c);
95 struct idxd_desc *desc;
97 if (wq->state != IDXD_WQ_ENABLED)
100 op_flag_setup(flags, &desc_flags);
101 desc = idxd_alloc_desc(wq, IDXD_OP_BLOCK);
105 idxd_prep_desc_common(wq, desc->hw, DSA_OPCODE_NOOP,
106 0, 0, 0, desc->compl_dma, desc_flags);
107 desc->txd.flags = flags;
111 static struct dma_async_tx_descriptor *
112 idxd_dma_submit_memcpy(struct dma_chan *c, dma_addr_t dma_dest,
113 dma_addr_t dma_src, size_t len, unsigned long flags)
115 struct idxd_wq *wq = to_idxd_wq(c);
117 struct idxd_device *idxd = wq->idxd;
118 struct idxd_desc *desc;
120 if (wq->state != IDXD_WQ_ENABLED)
123 if (len > idxd->max_xfer_bytes)
126 op_flag_setup(flags, &desc_flags);
127 desc = idxd_alloc_desc(wq, IDXD_OP_BLOCK);
131 idxd_prep_desc_common(wq, desc->hw, DSA_OPCODE_MEMMOVE,
132 dma_src, dma_dest, len, desc->compl_dma,
135 desc->txd.flags = flags;
140 static int idxd_dma_alloc_chan_resources(struct dma_chan *chan)
142 struct idxd_wq *wq = to_idxd_wq(chan);
143 struct device *dev = &wq->idxd->pdev->dev;
146 dev_dbg(dev, "%s: client_count: %d\n", __func__,
147 idxd_wq_refcount(wq));
151 static void idxd_dma_free_chan_resources(struct dma_chan *chan)
153 struct idxd_wq *wq = to_idxd_wq(chan);
154 struct device *dev = &wq->idxd->pdev->dev;
157 dev_dbg(dev, "%s: client_count: %d\n", __func__,
158 idxd_wq_refcount(wq));
161 static enum dma_status idxd_dma_tx_status(struct dma_chan *dma_chan,
163 struct dma_tx_state *txstate)
165 return DMA_OUT_OF_ORDER;
169 * issue_pending() does not need to do anything since tx_submit() does the job
172 static void idxd_dma_issue_pending(struct dma_chan *dma_chan)
176 static dma_cookie_t idxd_dma_tx_submit(struct dma_async_tx_descriptor *tx)
178 struct dma_chan *c = tx->chan;
179 struct idxd_wq *wq = to_idxd_wq(c);
182 struct idxd_desc *desc = container_of(tx, struct idxd_desc, txd);
184 cookie = dma_cookie_assign(tx);
186 rc = idxd_submit_desc(wq, desc);
188 idxd_free_desc(wq, desc);
195 static void idxd_dma_release(struct dma_device *device)
197 struct idxd_dma_dev *idxd_dma = container_of(device, struct idxd_dma_dev, dma);
202 int idxd_register_dma_device(struct idxd_device *idxd)
204 struct idxd_dma_dev *idxd_dma;
205 struct dma_device *dma;
206 struct device *dev = &idxd->pdev->dev;
209 idxd_dma = kzalloc_node(sizeof(*idxd_dma), GFP_KERNEL, dev_to_node(dev));
213 dma = &idxd_dma->dma;
214 INIT_LIST_HEAD(&dma->channels);
217 dma_cap_set(DMA_INTERRUPT, dma->cap_mask);
218 dma_cap_set(DMA_PRIVATE, dma->cap_mask);
219 dma_cap_set(DMA_COMPLETION_NO_ORDER, dma->cap_mask);
220 dma->device_release = idxd_dma_release;
222 dma->device_prep_dma_interrupt = idxd_dma_prep_interrupt;
223 if (idxd->hw.opcap.bits[0] & IDXD_OPCAP_MEMMOVE) {
224 dma_cap_set(DMA_MEMCPY, dma->cap_mask);
225 dma->device_prep_dma_memcpy = idxd_dma_submit_memcpy;
228 dma->device_tx_status = idxd_dma_tx_status;
229 dma->device_issue_pending = idxd_dma_issue_pending;
230 dma->device_alloc_chan_resources = idxd_dma_alloc_chan_resources;
231 dma->device_free_chan_resources = idxd_dma_free_chan_resources;
233 rc = dma_async_device_register(dma);
239 idxd_dma->idxd = idxd;
241 * This pointer is protected by the refs taken by the dma_chan. It will remain valid
242 * as long as there are outstanding channels.
244 idxd->idxd_dma = idxd_dma;
248 void idxd_unregister_dma_device(struct idxd_device *idxd)
250 dma_async_device_unregister(&idxd->idxd_dma->dma);
253 static int idxd_register_dma_channel(struct idxd_wq *wq)
255 struct idxd_device *idxd = wq->idxd;
256 struct dma_device *dma = &idxd->idxd_dma->dma;
257 struct device *dev = &idxd->pdev->dev;
258 struct idxd_dma_chan *idxd_chan;
259 struct dma_chan *chan;
262 idxd_chan = kzalloc_node(sizeof(*idxd_chan), GFP_KERNEL, dev_to_node(dev));
266 chan = &idxd_chan->chan;
268 list_add_tail(&chan->device_node, &dma->channels);
270 for (i = 0; i < wq->num_descs; i++) {
271 struct idxd_desc *desc = wq->descs[i];
273 dma_async_tx_descriptor_init(&desc->txd, chan);
274 desc->txd.tx_submit = idxd_dma_tx_submit;
277 rc = dma_async_device_channel_register(dma, chan);
283 wq->idxd_chan = idxd_chan;
285 get_device(wq_confdev(wq));
290 static void idxd_unregister_dma_channel(struct idxd_wq *wq)
292 struct idxd_dma_chan *idxd_chan = wq->idxd_chan;
293 struct dma_chan *chan = &idxd_chan->chan;
294 struct idxd_dma_dev *idxd_dma = wq->idxd->idxd_dma;
296 dma_async_device_channel_unregister(&idxd_dma->dma, chan);
297 list_del(&chan->device_node);
298 kfree(wq->idxd_chan);
299 wq->idxd_chan = NULL;
300 put_device(wq_confdev(wq));
303 static int idxd_dmaengine_drv_probe(struct idxd_dev *idxd_dev)
305 struct device *dev = &idxd_dev->conf_dev;
306 struct idxd_wq *wq = idxd_dev_to_wq(idxd_dev);
307 struct idxd_device *idxd = wq->idxd;
310 if (idxd->state != IDXD_DEV_ENABLED)
313 mutex_lock(&wq->wq_lock);
314 wq->type = IDXD_WQT_KERNEL;
316 rc = drv_enable_wq(wq);
318 dev_dbg(dev, "Enable wq %d failed: %d\n", wq->id, rc);
323 rc = idxd_register_dma_channel(wq);
325 idxd->cmd_status = IDXD_SCMD_DMA_CHAN_ERR;
326 dev_dbg(dev, "Failed to register dma channel\n");
330 idxd->cmd_status = 0;
331 mutex_unlock(&wq->wq_lock);
337 wq->type = IDXD_WQT_NONE;
338 mutex_unlock(&wq->wq_lock);
342 static void idxd_dmaengine_drv_remove(struct idxd_dev *idxd_dev)
344 struct idxd_wq *wq = idxd_dev_to_wq(idxd_dev);
346 mutex_lock(&wq->wq_lock);
347 __idxd_wq_quiesce(wq);
348 idxd_unregister_dma_channel(wq);
350 mutex_unlock(&wq->wq_lock);
353 static enum idxd_dev_type dev_types[] = {
358 struct idxd_device_driver idxd_dmaengine_drv = {
359 .probe = idxd_dmaengine_drv_probe,
360 .remove = idxd_dmaengine_drv_remove,
364 EXPORT_SYMBOL_GPL(idxd_dmaengine_drv);