aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 1 | /* |
| 2 | * DMA helper functions |
| 3 | * |
| 4 | * Copyright (c) 2009 Red Hat |
| 5 | * |
| 6 | * This work is licensed under the terms of the GNU General Public License |
| 7 | * (GNU GPL), version 2 or later. |
| 8 | */ |
| 9 | |
Peter Maydell | d38ea87 | 2016-01-29 17:50:05 +0000 | [diff] [blame] | 10 | #include "qemu/osdep.h" |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 11 | #include "sysemu/block-backend.h" |
Paolo Bonzini | 9c17d61 | 2012-12-17 18:20:04 +0100 | [diff] [blame] | 12 | #include "sysemu/dma.h" |
Daniel P. Berrange | 0ab8ed1 | 2017-01-25 16:14:15 +0000 | [diff] [blame] | 13 | #include "trace-root.h" |
Paolo Bonzini | 1de7afc | 2012-12-17 18:20:00 +0100 | [diff] [blame] | 14 | #include "qemu/thread.h" |
Alex Bligh | 6a1751b | 2013-08-21 16:02:47 +0100 | [diff] [blame] | 15 | #include "qemu/main-loop.h" |
aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 16 | |
David Gibson | e5332e6 | 2012-06-27 14:50:43 +1000 | [diff] [blame] | 17 | /* #define DEBUG_IOMMU */ |
| 18 | |
Paolo Bonzini | df32fd1 | 2013-04-10 18:15:49 +0200 | [diff] [blame] | 19 | int dma_memory_set(AddressSpace *as, dma_addr_t addr, uint8_t c, dma_addr_t len) |
David Gibson | d86a77f | 2012-06-27 14:50:38 +1000 | [diff] [blame] | 20 | { |
Paolo Bonzini | df32fd1 | 2013-04-10 18:15:49 +0200 | [diff] [blame] | 21 | dma_barrier(as, DMA_DIRECTION_FROM_DEVICE); |
Paolo Bonzini | 24addbc | 2013-04-10 17:49:04 +0200 | [diff] [blame] | 22 | |
David Gibson | d86a77f | 2012-06-27 14:50:38 +1000 | [diff] [blame] | 23 | #define FILLBUF_SIZE 512 |
| 24 | uint8_t fillbuf[FILLBUF_SIZE]; |
| 25 | int l; |
Paolo Bonzini | 24addbc | 2013-04-10 17:49:04 +0200 | [diff] [blame] | 26 | bool error = false; |
David Gibson | d86a77f | 2012-06-27 14:50:38 +1000 | [diff] [blame] | 27 | |
| 28 | memset(fillbuf, c, FILLBUF_SIZE); |
| 29 | while (len > 0) { |
| 30 | l = len < FILLBUF_SIZE ? len : FILLBUF_SIZE; |
Peter Maydell | 5c9eb02 | 2015-04-26 16:49:24 +0100 | [diff] [blame] | 31 | error |= address_space_rw(as, addr, MEMTXATTRS_UNSPECIFIED, |
| 32 | fillbuf, l, true); |
Benjamin Herrenschmidt | bc9b78d | 2012-08-14 17:41:47 +1000 | [diff] [blame] | 33 | len -= l; |
| 34 | addr += l; |
David Gibson | d86a77f | 2012-06-27 14:50:38 +1000 | [diff] [blame] | 35 | } |
David Gibson | e5332e6 | 2012-06-27 14:50:43 +1000 | [diff] [blame] | 36 | |
Paolo Bonzini | 24addbc | 2013-04-10 17:49:04 +0200 | [diff] [blame] | 37 | return error; |
David Gibson | d86a77f | 2012-06-27 14:50:38 +1000 | [diff] [blame] | 38 | } |
| 39 | |
Paolo Bonzini | f487b67 | 2013-06-03 14:17:19 +0200 | [diff] [blame] | 40 | void qemu_sglist_init(QEMUSGList *qsg, DeviceState *dev, int alloc_hint, |
| 41 | AddressSpace *as) |
aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 42 | { |
Anthony Liguori | 7267c09 | 2011-08-20 22:09:37 -0500 | [diff] [blame] | 43 | qsg->sg = g_malloc(alloc_hint * sizeof(ScatterGatherEntry)); |
aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 44 | qsg->nsg = 0; |
| 45 | qsg->nalloc = alloc_hint; |
| 46 | qsg->size = 0; |
Paolo Bonzini | df32fd1 | 2013-04-10 18:15:49 +0200 | [diff] [blame] | 47 | qsg->as = as; |
Paolo Bonzini | f487b67 | 2013-06-03 14:17:19 +0200 | [diff] [blame] | 48 | qsg->dev = dev; |
| 49 | object_ref(OBJECT(dev)); |
aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 50 | } |
| 51 | |
David Gibson | d323118 | 2011-10-31 17:06:46 +1100 | [diff] [blame] | 52 | void qemu_sglist_add(QEMUSGList *qsg, dma_addr_t base, dma_addr_t len) |
aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 53 | { |
| 54 | if (qsg->nsg == qsg->nalloc) { |
| 55 | qsg->nalloc = 2 * qsg->nalloc + 1; |
Anthony Liguori | 7267c09 | 2011-08-20 22:09:37 -0500 | [diff] [blame] | 56 | qsg->sg = g_realloc(qsg->sg, qsg->nalloc * sizeof(ScatterGatherEntry)); |
aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 57 | } |
| 58 | qsg->sg[qsg->nsg].base = base; |
| 59 | qsg->sg[qsg->nsg].len = len; |
| 60 | qsg->size += len; |
| 61 | ++qsg->nsg; |
| 62 | } |
| 63 | |
| 64 | void qemu_sglist_destroy(QEMUSGList *qsg) |
| 65 | { |
Paolo Bonzini | f487b67 | 2013-06-03 14:17:19 +0200 | [diff] [blame] | 66 | object_unref(OBJECT(qsg->dev)); |
Anthony Liguori | 7267c09 | 2011-08-20 22:09:37 -0500 | [diff] [blame] | 67 | g_free(qsg->sg); |
Jason Baron | ea8d82a | 2012-08-03 15:57:10 -0400 | [diff] [blame] | 68 | memset(qsg, 0, sizeof(*qsg)); |
aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 69 | } |
| 70 | |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 71 | typedef struct { |
Markus Armbruster | 7c84b1b | 2014-10-07 13:59:14 +0200 | [diff] [blame] | 72 | BlockAIOCB common; |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 73 | AioContext *ctx; |
Markus Armbruster | 7c84b1b | 2014-10-07 13:59:14 +0200 | [diff] [blame] | 74 | BlockAIOCB *acb; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 75 | QEMUSGList *sg; |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 76 | uint32_t align; |
Eric Blake | d4f510e | 2016-05-06 10:26:31 -0600 | [diff] [blame] | 77 | uint64_t offset; |
David Gibson | 43cf8ae | 2012-03-27 13:42:23 +1100 | [diff] [blame] | 78 | DMADirection dir; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 79 | int sg_cur_index; |
David Gibson | d323118 | 2011-10-31 17:06:46 +1100 | [diff] [blame] | 80 | dma_addr_t sg_cur_byte; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 81 | QEMUIOVector iov; |
| 82 | QEMUBH *bh; |
Christoph Hellwig | cb144cc | 2011-05-19 10:57:59 +0200 | [diff] [blame] | 83 | DMAIOFunc *io_func; |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 84 | void *io_func_opaque; |
aliguori | 37b7842 | 2009-03-20 18:26:16 +0000 | [diff] [blame] | 85 | } DMAAIOCB; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 86 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 87 | static void dma_blk_cb(void *opaque, int ret); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 88 | |
| 89 | static void reschedule_dma(void *opaque) |
| 90 | { |
aliguori | 37b7842 | 2009-03-20 18:26:16 +0000 | [diff] [blame] | 91 | DMAAIOCB *dbs = (DMAAIOCB *)opaque; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 92 | |
| 93 | qemu_bh_delete(dbs->bh); |
| 94 | dbs->bh = NULL; |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 95 | dma_blk_cb(dbs, 0); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 96 | } |
| 97 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 98 | static void dma_blk_unmap(DMAAIOCB *dbs) |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 99 | { |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 100 | int i; |
| 101 | |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 102 | for (i = 0; i < dbs->iov.niov; ++i) { |
Paolo Bonzini | df32fd1 | 2013-04-10 18:15:49 +0200 | [diff] [blame] | 103 | dma_memory_unmap(dbs->sg->as, dbs->iov.iov[i].iov_base, |
David Gibson | c65bcef | 2012-06-27 14:50:40 +1000 | [diff] [blame] | 104 | dbs->iov.iov[i].iov_len, dbs->dir, |
| 105 | dbs->iov.iov[i].iov_len); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 106 | } |
Paolo Bonzini | c3adb5b | 2011-09-16 16:40:02 +0200 | [diff] [blame] | 107 | qemu_iovec_reset(&dbs->iov); |
| 108 | } |
| 109 | |
| 110 | static void dma_complete(DMAAIOCB *dbs, int ret) |
| 111 | { |
Kevin Wolf | c57c465 | 2011-11-24 06:15:28 -0500 | [diff] [blame] | 112 | trace_dma_complete(dbs, ret, dbs->common.cb); |
| 113 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 114 | dma_blk_unmap(dbs); |
Paolo Bonzini | c3adb5b | 2011-09-16 16:40:02 +0200 | [diff] [blame] | 115 | if (dbs->common.cb) { |
| 116 | dbs->common.cb(dbs->common.opaque, ret); |
| 117 | } |
| 118 | qemu_iovec_destroy(&dbs->iov); |
| 119 | if (dbs->bh) { |
| 120 | qemu_bh_delete(dbs->bh); |
| 121 | dbs->bh = NULL; |
| 122 | } |
Fam Zheng | 8007429 | 2014-09-11 13:41:28 +0800 | [diff] [blame] | 123 | qemu_aio_unref(dbs); |
aliguori | 7403b14 | 2009-03-28 16:11:25 +0000 | [diff] [blame] | 124 | } |
| 125 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 126 | static void dma_blk_cb(void *opaque, int ret) |
aliguori | 7403b14 | 2009-03-28 16:11:25 +0000 | [diff] [blame] | 127 | { |
| 128 | DMAAIOCB *dbs = (DMAAIOCB *)opaque; |
David Gibson | c65bcef | 2012-06-27 14:50:40 +1000 | [diff] [blame] | 129 | dma_addr_t cur_addr, cur_len; |
aliguori | 7403b14 | 2009-03-28 16:11:25 +0000 | [diff] [blame] | 130 | void *mem; |
| 131 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 132 | trace_dma_blk_cb(dbs, ret); |
Kevin Wolf | c57c465 | 2011-11-24 06:15:28 -0500 | [diff] [blame] | 133 | |
aliguori | 7403b14 | 2009-03-28 16:11:25 +0000 | [diff] [blame] | 134 | dbs->acb = NULL; |
Eric Blake | d4f510e | 2016-05-06 10:26:31 -0600 | [diff] [blame] | 135 | dbs->offset += dbs->iov.size; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 136 | |
| 137 | if (dbs->sg_cur_index == dbs->sg->nsg || ret < 0) { |
Paolo Bonzini | c3adb5b | 2011-09-16 16:40:02 +0200 | [diff] [blame] | 138 | dma_complete(dbs, ret); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 139 | return; |
| 140 | } |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 141 | dma_blk_unmap(dbs); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 142 | |
| 143 | while (dbs->sg_cur_index < dbs->sg->nsg) { |
| 144 | cur_addr = dbs->sg->sg[dbs->sg_cur_index].base + dbs->sg_cur_byte; |
| 145 | cur_len = dbs->sg->sg[dbs->sg_cur_index].len - dbs->sg_cur_byte; |
Paolo Bonzini | df32fd1 | 2013-04-10 18:15:49 +0200 | [diff] [blame] | 146 | mem = dma_memory_map(dbs->sg->as, cur_addr, &cur_len, dbs->dir); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 147 | if (!mem) |
| 148 | break; |
| 149 | qemu_iovec_add(&dbs->iov, mem, cur_len); |
| 150 | dbs->sg_cur_byte += cur_len; |
| 151 | if (dbs->sg_cur_byte == dbs->sg->sg[dbs->sg_cur_index].len) { |
| 152 | dbs->sg_cur_byte = 0; |
| 153 | ++dbs->sg_cur_index; |
| 154 | } |
| 155 | } |
| 156 | |
| 157 | if (dbs->iov.size == 0) { |
Kevin Wolf | c57c465 | 2011-11-24 06:15:28 -0500 | [diff] [blame] | 158 | trace_dma_map_wait(dbs); |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 159 | dbs->bh = aio_bh_new(dbs->ctx, reschedule_dma, dbs); |
Fam Zheng | e95205e | 2015-03-16 17:03:37 +0800 | [diff] [blame] | 160 | cpu_register_map_client(dbs->bh); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 161 | return; |
| 162 | } |
| 163 | |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 164 | if (!QEMU_IS_ALIGNED(dbs->iov.size, dbs->align)) { |
| 165 | qemu_iovec_discard_back(&dbs->iov, |
| 166 | QEMU_ALIGN_DOWN(dbs->iov.size, dbs->align)); |
Kevin Wolf | 58f423f | 2014-07-09 19:17:30 +0200 | [diff] [blame] | 167 | } |
| 168 | |
Paolo Bonzini | 1919631 | 2017-02-13 14:52:31 +0100 | [diff] [blame] | 169 | aio_context_acquire(dbs->ctx); |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 170 | dbs->acb = dbs->io_func(dbs->offset, &dbs->iov, |
| 171 | dma_blk_cb, dbs, dbs->io_func_opaque); |
Paolo Bonzini | 1919631 | 2017-02-13 14:52:31 +0100 | [diff] [blame] | 172 | aio_context_release(dbs->ctx); |
Paolo Bonzini | 6bee44e | 2011-11-14 17:50:52 +0100 | [diff] [blame] | 173 | assert(dbs->acb); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 174 | } |
| 175 | |
Markus Armbruster | 7c84b1b | 2014-10-07 13:59:14 +0200 | [diff] [blame] | 176 | static void dma_aio_cancel(BlockAIOCB *acb) |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 177 | { |
| 178 | DMAAIOCB *dbs = container_of(acb, DMAAIOCB, common); |
| 179 | |
Kevin Wolf | c57c465 | 2011-11-24 06:15:28 -0500 | [diff] [blame] | 180 | trace_dma_aio_cancel(dbs); |
| 181 | |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 182 | if (dbs->acb) { |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 183 | blk_aio_cancel_async(dbs->acb); |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 184 | } |
Fam Zheng | e95205e | 2015-03-16 17:03:37 +0800 | [diff] [blame] | 185 | if (dbs->bh) { |
| 186 | cpu_unregister_map_client(dbs->bh); |
| 187 | qemu_bh_delete(dbs->bh); |
| 188 | dbs->bh = NULL; |
| 189 | } |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 190 | } |
| 191 | |
Stefan Hajnoczi | 5fa78b2 | 2016-06-20 20:36:57 +0100 | [diff] [blame] | 192 | static AioContext *dma_get_aio_context(BlockAIOCB *acb) |
| 193 | { |
| 194 | DMAAIOCB *dbs = container_of(acb, DMAAIOCB, common); |
| 195 | |
| 196 | return dbs->ctx; |
| 197 | } |
Fam Zheng | 9bb9da4 | 2014-09-11 13:41:14 +0800 | [diff] [blame] | 198 | |
Stefan Hajnoczi | d7331be | 2012-10-31 16:34:37 +0100 | [diff] [blame] | 199 | static const AIOCBInfo dma_aiocb_info = { |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 200 | .aiocb_size = sizeof(DMAAIOCB), |
Fam Zheng | 9bb9da4 | 2014-09-11 13:41:14 +0800 | [diff] [blame] | 201 | .cancel_async = dma_aio_cancel, |
Stefan Hajnoczi | 5fa78b2 | 2016-06-20 20:36:57 +0100 | [diff] [blame] | 202 | .get_aio_context = dma_get_aio_context, |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 203 | }; |
| 204 | |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 205 | BlockAIOCB *dma_blk_io(AioContext *ctx, |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 206 | QEMUSGList *sg, uint64_t offset, uint32_t align, |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 207 | DMAIOFunc *io_func, void *io_func_opaque, |
| 208 | BlockCompletionFunc *cb, |
David Gibson | 43cf8ae | 2012-03-27 13:42:23 +1100 | [diff] [blame] | 209 | void *opaque, DMADirection dir) |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 210 | { |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 211 | DMAAIOCB *dbs = qemu_aio_get(&dma_aiocb_info, NULL, cb, opaque); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 212 | |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 213 | trace_dma_blk_io(dbs, io_func_opaque, offset, (dir == DMA_DIRECTION_TO_DEVICE)); |
Kevin Wolf | c57c465 | 2011-11-24 06:15:28 -0500 | [diff] [blame] | 214 | |
aliguori | 37b7842 | 2009-03-20 18:26:16 +0000 | [diff] [blame] | 215 | dbs->acb = NULL; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 216 | dbs->sg = sg; |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 217 | dbs->ctx = ctx; |
Paolo Bonzini | cbe0ed6 | 2016-05-23 14:54:05 +0200 | [diff] [blame] | 218 | dbs->offset = offset; |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 219 | dbs->align = align; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 220 | dbs->sg_cur_index = 0; |
| 221 | dbs->sg_cur_byte = 0; |
David Gibson | 43cf8ae | 2012-03-27 13:42:23 +1100 | [diff] [blame] | 222 | dbs->dir = dir; |
Christoph Hellwig | cb144cc | 2011-05-19 10:57:59 +0200 | [diff] [blame] | 223 | dbs->io_func = io_func; |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 224 | dbs->io_func_opaque = io_func_opaque; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 225 | dbs->bh = NULL; |
| 226 | qemu_iovec_init(&dbs->iov, sg->nsg); |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 227 | dma_blk_cb(dbs, 0); |
aliguori | 37b7842 | 2009-03-20 18:26:16 +0000 | [diff] [blame] | 228 | return &dbs->common; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 229 | } |
| 230 | |
| 231 | |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 232 | static |
| 233 | BlockAIOCB *dma_blk_read_io_func(int64_t offset, QEMUIOVector *iov, |
| 234 | BlockCompletionFunc *cb, void *cb_opaque, |
| 235 | void *opaque) |
| 236 | { |
| 237 | BlockBackend *blk = opaque; |
| 238 | return blk_aio_preadv(blk, offset, iov, 0, cb, cb_opaque); |
| 239 | } |
| 240 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 241 | BlockAIOCB *dma_blk_read(BlockBackend *blk, |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 242 | QEMUSGList *sg, uint64_t offset, uint32_t align, |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 243 | void (*cb)(void *opaque, int ret), void *opaque) |
| 244 | { |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 245 | return dma_blk_io(blk_get_aio_context(blk), sg, offset, align, |
| 246 | dma_blk_read_io_func, blk, cb, opaque, |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 247 | DMA_DIRECTION_FROM_DEVICE); |
| 248 | } |
| 249 | |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 250 | static |
| 251 | BlockAIOCB *dma_blk_write_io_func(int64_t offset, QEMUIOVector *iov, |
| 252 | BlockCompletionFunc *cb, void *cb_opaque, |
| 253 | void *opaque) |
| 254 | { |
| 255 | BlockBackend *blk = opaque; |
| 256 | return blk_aio_pwritev(blk, offset, iov, 0, cb, cb_opaque); |
| 257 | } |
| 258 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 259 | BlockAIOCB *dma_blk_write(BlockBackend *blk, |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 260 | QEMUSGList *sg, uint64_t offset, uint32_t align, |
Markus Armbruster | 7c84b1b | 2014-10-07 13:59:14 +0200 | [diff] [blame] | 261 | void (*cb)(void *opaque, int ret), void *opaque) |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 262 | { |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 263 | return dma_blk_io(blk_get_aio_context(blk), sg, offset, align, |
| 264 | dma_blk_write_io_func, blk, cb, opaque, |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 265 | DMA_DIRECTION_TO_DEVICE); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 266 | } |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 267 | |
| 268 | |
David Gibson | c65bcef | 2012-06-27 14:50:40 +1000 | [diff] [blame] | 269 | static uint64_t dma_buf_rw(uint8_t *ptr, int32_t len, QEMUSGList *sg, |
| 270 | DMADirection dir) |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 271 | { |
| 272 | uint64_t resid; |
| 273 | int sg_cur_index; |
| 274 | |
| 275 | resid = sg->size; |
| 276 | sg_cur_index = 0; |
| 277 | len = MIN(len, resid); |
| 278 | while (len > 0) { |
| 279 | ScatterGatherEntry entry = sg->sg[sg_cur_index++]; |
| 280 | int32_t xfer = MIN(len, entry.len); |
Paolo Bonzini | df32fd1 | 2013-04-10 18:15:49 +0200 | [diff] [blame] | 281 | dma_memory_rw(sg->as, entry.base, ptr, xfer, dir); |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 282 | ptr += xfer; |
| 283 | len -= xfer; |
| 284 | resid -= xfer; |
| 285 | } |
| 286 | |
| 287 | return resid; |
| 288 | } |
| 289 | |
| 290 | uint64_t dma_buf_read(uint8_t *ptr, int32_t len, QEMUSGList *sg) |
| 291 | { |
David Gibson | c65bcef | 2012-06-27 14:50:40 +1000 | [diff] [blame] | 292 | return dma_buf_rw(ptr, len, sg, DMA_DIRECTION_FROM_DEVICE); |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 293 | } |
| 294 | |
| 295 | uint64_t dma_buf_write(uint8_t *ptr, int32_t len, QEMUSGList *sg) |
| 296 | { |
David Gibson | c65bcef | 2012-06-27 14:50:40 +1000 | [diff] [blame] | 297 | return dma_buf_rw(ptr, len, sg, DMA_DIRECTION_TO_DEVICE); |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 298 | } |
Paolo Bonzini | 84a6935 | 2011-09-05 14:20:29 +0200 | [diff] [blame] | 299 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 300 | void dma_acct_start(BlockBackend *blk, BlockAcctCookie *cookie, |
Paolo Bonzini | 84a6935 | 2011-09-05 14:20:29 +0200 | [diff] [blame] | 301 | QEMUSGList *sg, enum BlockAcctType type) |
| 302 | { |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 303 | block_acct_start(blk_get_stats(blk), cookie, sg->size, type); |
Paolo Bonzini | 84a6935 | 2011-09-05 14:20:29 +0200 | [diff] [blame] | 304 | } |