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" |
Paolo Bonzini | 243af02 | 2020-02-04 12:20:10 +0100 | [diff] [blame] | 13 | #include "trace/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" |
Pavel Dovgalyuk | 5fb0a6b | 2020-06-03 13:22:02 +0300 | [diff] [blame] | 16 | #include "sysemu/cpus.h" |
| 17 | #include "qemu/range.h" |
aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 18 | |
David Gibson | e5332e6 | 2012-06-27 14:50:43 +1000 | [diff] [blame] | 19 | /* #define DEBUG_IOMMU */ |
| 20 | |
Paolo Bonzini | df32fd1 | 2013-04-10 18:15:49 +0200 | [diff] [blame] | 21 | 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] | 22 | { |
Paolo Bonzini | df32fd1 | 2013-04-10 18:15:49 +0200 | [diff] [blame] | 23 | dma_barrier(as, DMA_DIRECTION_FROM_DEVICE); |
Paolo Bonzini | 24addbc | 2013-04-10 17:49:04 +0200 | [diff] [blame] | 24 | |
David Gibson | d86a77f | 2012-06-27 14:50:38 +1000 | [diff] [blame] | 25 | #define FILLBUF_SIZE 512 |
| 26 | uint8_t fillbuf[FILLBUF_SIZE]; |
| 27 | int l; |
Paolo Bonzini | 24addbc | 2013-04-10 17:49:04 +0200 | [diff] [blame] | 28 | bool error = false; |
David Gibson | d86a77f | 2012-06-27 14:50:38 +1000 | [diff] [blame] | 29 | |
| 30 | memset(fillbuf, c, FILLBUF_SIZE); |
| 31 | while (len > 0) { |
| 32 | l = len < FILLBUF_SIZE ? len : FILLBUF_SIZE; |
Peter Maydell | 19f7034 | 2020-02-18 11:24:57 +0000 | [diff] [blame] | 33 | error |= address_space_write(as, addr, MEMTXATTRS_UNSPECIFIED, |
| 34 | fillbuf, l); |
Benjamin Herrenschmidt | bc9b78d | 2012-08-14 17:41:47 +1000 | [diff] [blame] | 35 | len -= l; |
| 36 | addr += l; |
David Gibson | d86a77f | 2012-06-27 14:50:38 +1000 | [diff] [blame] | 37 | } |
David Gibson | e5332e6 | 2012-06-27 14:50:43 +1000 | [diff] [blame] | 38 | |
Paolo Bonzini | 24addbc | 2013-04-10 17:49:04 +0200 | [diff] [blame] | 39 | return error; |
David Gibson | d86a77f | 2012-06-27 14:50:38 +1000 | [diff] [blame] | 40 | } |
| 41 | |
Paolo Bonzini | f487b67 | 2013-06-03 14:17:19 +0200 | [diff] [blame] | 42 | void qemu_sglist_init(QEMUSGList *qsg, DeviceState *dev, int alloc_hint, |
| 43 | AddressSpace *as) |
aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 44 | { |
Anthony Liguori | 7267c09 | 2011-08-20 22:09:37 -0500 | [diff] [blame] | 45 | qsg->sg = g_malloc(alloc_hint * sizeof(ScatterGatherEntry)); |
aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 46 | qsg->nsg = 0; |
| 47 | qsg->nalloc = alloc_hint; |
| 48 | qsg->size = 0; |
Paolo Bonzini | df32fd1 | 2013-04-10 18:15:49 +0200 | [diff] [blame] | 49 | qsg->as = as; |
Paolo Bonzini | f487b67 | 2013-06-03 14:17:19 +0200 | [diff] [blame] | 50 | qsg->dev = dev; |
| 51 | object_ref(OBJECT(dev)); |
aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 52 | } |
| 53 | |
David Gibson | d323118 | 2011-10-31 17:06:46 +1100 | [diff] [blame] | 54 | 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] | 55 | { |
| 56 | if (qsg->nsg == qsg->nalloc) { |
| 57 | qsg->nalloc = 2 * qsg->nalloc + 1; |
Anthony Liguori | 7267c09 | 2011-08-20 22:09:37 -0500 | [diff] [blame] | 58 | qsg->sg = g_realloc(qsg->sg, qsg->nalloc * sizeof(ScatterGatherEntry)); |
aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 59 | } |
| 60 | qsg->sg[qsg->nsg].base = base; |
| 61 | qsg->sg[qsg->nsg].len = len; |
| 62 | qsg->size += len; |
| 63 | ++qsg->nsg; |
| 64 | } |
| 65 | |
| 66 | void qemu_sglist_destroy(QEMUSGList *qsg) |
| 67 | { |
Paolo Bonzini | f487b67 | 2013-06-03 14:17:19 +0200 | [diff] [blame] | 68 | object_unref(OBJECT(qsg->dev)); |
Anthony Liguori | 7267c09 | 2011-08-20 22:09:37 -0500 | [diff] [blame] | 69 | g_free(qsg->sg); |
Jason Baron | ea8d82a | 2012-08-03 15:57:10 -0400 | [diff] [blame] | 70 | memset(qsg, 0, sizeof(*qsg)); |
aliguori | 244ab90 | 2009-02-05 21:23:50 +0000 | [diff] [blame] | 71 | } |
| 72 | |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 73 | typedef struct { |
Markus Armbruster | 7c84b1b | 2014-10-07 13:59:14 +0200 | [diff] [blame] | 74 | BlockAIOCB common; |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 75 | AioContext *ctx; |
Markus Armbruster | 7c84b1b | 2014-10-07 13:59:14 +0200 | [diff] [blame] | 76 | BlockAIOCB *acb; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 77 | QEMUSGList *sg; |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 78 | uint32_t align; |
Eric Blake | d4f510e | 2016-05-06 10:26:31 -0600 | [diff] [blame] | 79 | uint64_t offset; |
David Gibson | 43cf8ae | 2012-03-27 13:42:23 +1100 | [diff] [blame] | 80 | DMADirection dir; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 81 | int sg_cur_index; |
David Gibson | d323118 | 2011-10-31 17:06:46 +1100 | [diff] [blame] | 82 | dma_addr_t sg_cur_byte; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 83 | QEMUIOVector iov; |
| 84 | QEMUBH *bh; |
Christoph Hellwig | cb144cc | 2011-05-19 10:57:59 +0200 | [diff] [blame] | 85 | DMAIOFunc *io_func; |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 86 | void *io_func_opaque; |
aliguori | 37b7842 | 2009-03-20 18:26:16 +0000 | [diff] [blame] | 87 | } DMAAIOCB; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 88 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 89 | static void dma_blk_cb(void *opaque, int ret); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 90 | |
| 91 | static void reschedule_dma(void *opaque) |
| 92 | { |
aliguori | 37b7842 | 2009-03-20 18:26:16 +0000 | [diff] [blame] | 93 | DMAAIOCB *dbs = (DMAAIOCB *)opaque; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 94 | |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 95 | assert(!dbs->acb && dbs->bh); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 96 | qemu_bh_delete(dbs->bh); |
| 97 | dbs->bh = NULL; |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 98 | dma_blk_cb(dbs, 0); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 99 | } |
| 100 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 101 | static void dma_blk_unmap(DMAAIOCB *dbs) |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 102 | { |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 103 | int i; |
| 104 | |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 105 | for (i = 0; i < dbs->iov.niov; ++i) { |
Paolo Bonzini | df32fd1 | 2013-04-10 18:15:49 +0200 | [diff] [blame] | 106 | dma_memory_unmap(dbs->sg->as, dbs->iov.iov[i].iov_base, |
David Gibson | c65bcef | 2012-06-27 14:50:40 +1000 | [diff] [blame] | 107 | dbs->iov.iov[i].iov_len, dbs->dir, |
| 108 | dbs->iov.iov[i].iov_len); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 109 | } |
Paolo Bonzini | c3adb5b | 2011-09-16 16:40:02 +0200 | [diff] [blame] | 110 | qemu_iovec_reset(&dbs->iov); |
| 111 | } |
| 112 | |
| 113 | static void dma_complete(DMAAIOCB *dbs, int ret) |
| 114 | { |
Kevin Wolf | c57c465 | 2011-11-24 06:15:28 -0500 | [diff] [blame] | 115 | trace_dma_complete(dbs, ret, dbs->common.cb); |
| 116 | |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 117 | assert(!dbs->acb && !dbs->bh); |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 118 | dma_blk_unmap(dbs); |
Paolo Bonzini | c3adb5b | 2011-09-16 16:40:02 +0200 | [diff] [blame] | 119 | if (dbs->common.cb) { |
| 120 | dbs->common.cb(dbs->common.opaque, ret); |
| 121 | } |
| 122 | qemu_iovec_destroy(&dbs->iov); |
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); |
Pavel Dovgalyuk | 5fb0a6b | 2020-06-03 13:22:02 +0300 | [diff] [blame] | 147 | /* |
| 148 | * Make reads deterministic in icount mode. Windows sometimes issues |
| 149 | * disk read requests with overlapping SGs. It leads |
| 150 | * to non-determinism, because resulting buffer contents may be mixed |
| 151 | * from several sectors. This code splits all SGs into several |
| 152 | * groups. SGs in every group do not overlap. |
| 153 | */ |
| 154 | if (mem && use_icount && dbs->dir == DMA_DIRECTION_FROM_DEVICE) { |
| 155 | int i; |
| 156 | for (i = 0 ; i < dbs->iov.niov ; ++i) { |
| 157 | if (ranges_overlap((intptr_t)dbs->iov.iov[i].iov_base, |
| 158 | dbs->iov.iov[i].iov_len, (intptr_t)mem, |
| 159 | cur_len)) { |
| 160 | dma_memory_unmap(dbs->sg->as, mem, cur_len, |
| 161 | dbs->dir, cur_len); |
| 162 | mem = NULL; |
| 163 | break; |
| 164 | } |
| 165 | } |
| 166 | } |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 167 | if (!mem) |
| 168 | break; |
| 169 | qemu_iovec_add(&dbs->iov, mem, cur_len); |
| 170 | dbs->sg_cur_byte += cur_len; |
| 171 | if (dbs->sg_cur_byte == dbs->sg->sg[dbs->sg_cur_index].len) { |
| 172 | dbs->sg_cur_byte = 0; |
| 173 | ++dbs->sg_cur_index; |
| 174 | } |
| 175 | } |
| 176 | |
| 177 | if (dbs->iov.size == 0) { |
Kevin Wolf | c57c465 | 2011-11-24 06:15:28 -0500 | [diff] [blame] | 178 | trace_dma_map_wait(dbs); |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 179 | dbs->bh = aio_bh_new(dbs->ctx, reschedule_dma, dbs); |
Fam Zheng | e95205e | 2015-03-16 17:03:37 +0800 | [diff] [blame] | 180 | cpu_register_map_client(dbs->bh); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 181 | return; |
| 182 | } |
| 183 | |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 184 | if (!QEMU_IS_ALIGNED(dbs->iov.size, dbs->align)) { |
| 185 | qemu_iovec_discard_back(&dbs->iov, |
| 186 | QEMU_ALIGN_DOWN(dbs->iov.size, dbs->align)); |
Kevin Wolf | 58f423f | 2014-07-09 19:17:30 +0200 | [diff] [blame] | 187 | } |
| 188 | |
Paolo Bonzini | 1919631 | 2017-02-13 14:52:31 +0100 | [diff] [blame] | 189 | aio_context_acquire(dbs->ctx); |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 190 | dbs->acb = dbs->io_func(dbs->offset, &dbs->iov, |
| 191 | dma_blk_cb, dbs, dbs->io_func_opaque); |
Paolo Bonzini | 1919631 | 2017-02-13 14:52:31 +0100 | [diff] [blame] | 192 | aio_context_release(dbs->ctx); |
Paolo Bonzini | 6bee44e | 2011-11-14 17:50:52 +0100 | [diff] [blame] | 193 | assert(dbs->acb); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 194 | } |
| 195 | |
Markus Armbruster | 7c84b1b | 2014-10-07 13:59:14 +0200 | [diff] [blame] | 196 | static void dma_aio_cancel(BlockAIOCB *acb) |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 197 | { |
| 198 | DMAAIOCB *dbs = container_of(acb, DMAAIOCB, common); |
| 199 | |
Kevin Wolf | c57c465 | 2011-11-24 06:15:28 -0500 | [diff] [blame] | 200 | trace_dma_aio_cancel(dbs); |
| 201 | |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 202 | assert(!(dbs->acb && dbs->bh)); |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 203 | if (dbs->acb) { |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 204 | /* This will invoke dma_blk_cb. */ |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 205 | blk_aio_cancel_async(dbs->acb); |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 206 | return; |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 207 | } |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 208 | |
Fam Zheng | e95205e | 2015-03-16 17:03:37 +0800 | [diff] [blame] | 209 | if (dbs->bh) { |
| 210 | cpu_unregister_map_client(dbs->bh); |
| 211 | qemu_bh_delete(dbs->bh); |
| 212 | dbs->bh = NULL; |
| 213 | } |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 214 | if (dbs->common.cb) { |
| 215 | dbs->common.cb(dbs->common.opaque, -ECANCELED); |
| 216 | } |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 217 | } |
| 218 | |
Stefan Hajnoczi | 5fa78b2 | 2016-06-20 20:36:57 +0100 | [diff] [blame] | 219 | static AioContext *dma_get_aio_context(BlockAIOCB *acb) |
| 220 | { |
| 221 | DMAAIOCB *dbs = container_of(acb, DMAAIOCB, common); |
| 222 | |
| 223 | return dbs->ctx; |
| 224 | } |
Fam Zheng | 9bb9da4 | 2014-09-11 13:41:14 +0800 | [diff] [blame] | 225 | |
Stefan Hajnoczi | d7331be | 2012-10-31 16:34:37 +0100 | [diff] [blame] | 226 | static const AIOCBInfo dma_aiocb_info = { |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 227 | .aiocb_size = sizeof(DMAAIOCB), |
Fam Zheng | 9bb9da4 | 2014-09-11 13:41:14 +0800 | [diff] [blame] | 228 | .cancel_async = dma_aio_cancel, |
Stefan Hajnoczi | 5fa78b2 | 2016-06-20 20:36:57 +0100 | [diff] [blame] | 229 | .get_aio_context = dma_get_aio_context, |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 230 | }; |
| 231 | |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 232 | BlockAIOCB *dma_blk_io(AioContext *ctx, |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 233 | QEMUSGList *sg, uint64_t offset, uint32_t align, |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 234 | DMAIOFunc *io_func, void *io_func_opaque, |
| 235 | BlockCompletionFunc *cb, |
David Gibson | 43cf8ae | 2012-03-27 13:42:23 +1100 | [diff] [blame] | 236 | void *opaque, DMADirection dir) |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 237 | { |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 238 | DMAAIOCB *dbs = qemu_aio_get(&dma_aiocb_info, NULL, cb, opaque); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 239 | |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 240 | 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] | 241 | |
aliguori | 37b7842 | 2009-03-20 18:26:16 +0000 | [diff] [blame] | 242 | dbs->acb = NULL; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 243 | dbs->sg = sg; |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 244 | dbs->ctx = ctx; |
Paolo Bonzini | cbe0ed6 | 2016-05-23 14:54:05 +0200 | [diff] [blame] | 245 | dbs->offset = offset; |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 246 | dbs->align = align; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 247 | dbs->sg_cur_index = 0; |
| 248 | dbs->sg_cur_byte = 0; |
David Gibson | 43cf8ae | 2012-03-27 13:42:23 +1100 | [diff] [blame] | 249 | dbs->dir = dir; |
Christoph Hellwig | cb144cc | 2011-05-19 10:57:59 +0200 | [diff] [blame] | 250 | dbs->io_func = io_func; |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 251 | dbs->io_func_opaque = io_func_opaque; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 252 | dbs->bh = NULL; |
| 253 | qemu_iovec_init(&dbs->iov, sg->nsg); |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 254 | dma_blk_cb(dbs, 0); |
aliguori | 37b7842 | 2009-03-20 18:26:16 +0000 | [diff] [blame] | 255 | return &dbs->common; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 256 | } |
| 257 | |
| 258 | |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 259 | static |
| 260 | BlockAIOCB *dma_blk_read_io_func(int64_t offset, QEMUIOVector *iov, |
| 261 | BlockCompletionFunc *cb, void *cb_opaque, |
| 262 | void *opaque) |
| 263 | { |
| 264 | BlockBackend *blk = opaque; |
| 265 | return blk_aio_preadv(blk, offset, iov, 0, cb, cb_opaque); |
| 266 | } |
| 267 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 268 | BlockAIOCB *dma_blk_read(BlockBackend *blk, |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 269 | QEMUSGList *sg, uint64_t offset, uint32_t align, |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 270 | void (*cb)(void *opaque, int ret), void *opaque) |
| 271 | { |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 272 | return dma_blk_io(blk_get_aio_context(blk), sg, offset, align, |
| 273 | dma_blk_read_io_func, blk, cb, opaque, |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 274 | DMA_DIRECTION_FROM_DEVICE); |
| 275 | } |
| 276 | |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 277 | static |
| 278 | BlockAIOCB *dma_blk_write_io_func(int64_t offset, QEMUIOVector *iov, |
| 279 | BlockCompletionFunc *cb, void *cb_opaque, |
| 280 | void *opaque) |
| 281 | { |
| 282 | BlockBackend *blk = opaque; |
| 283 | return blk_aio_pwritev(blk, offset, iov, 0, cb, cb_opaque); |
| 284 | } |
| 285 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 286 | BlockAIOCB *dma_blk_write(BlockBackend *blk, |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 287 | QEMUSGList *sg, uint64_t offset, uint32_t align, |
Markus Armbruster | 7c84b1b | 2014-10-07 13:59:14 +0200 | [diff] [blame] | 288 | void (*cb)(void *opaque, int ret), void *opaque) |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 289 | { |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 290 | return dma_blk_io(blk_get_aio_context(blk), sg, offset, align, |
| 291 | dma_blk_write_io_func, blk, cb, opaque, |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 292 | DMA_DIRECTION_TO_DEVICE); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 293 | } |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 294 | |
| 295 | |
David Gibson | c65bcef | 2012-06-27 14:50:40 +1000 | [diff] [blame] | 296 | static uint64_t dma_buf_rw(uint8_t *ptr, int32_t len, QEMUSGList *sg, |
| 297 | DMADirection dir) |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 298 | { |
| 299 | uint64_t resid; |
| 300 | int sg_cur_index; |
| 301 | |
| 302 | resid = sg->size; |
| 303 | sg_cur_index = 0; |
| 304 | len = MIN(len, resid); |
| 305 | while (len > 0) { |
| 306 | ScatterGatherEntry entry = sg->sg[sg_cur_index++]; |
| 307 | int32_t xfer = MIN(len, entry.len); |
Paolo Bonzini | df32fd1 | 2013-04-10 18:15:49 +0200 | [diff] [blame] | 308 | dma_memory_rw(sg->as, entry.base, ptr, xfer, dir); |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 309 | ptr += xfer; |
| 310 | len -= xfer; |
| 311 | resid -= xfer; |
| 312 | } |
| 313 | |
| 314 | return resid; |
| 315 | } |
| 316 | |
| 317 | uint64_t dma_buf_read(uint8_t *ptr, int32_t len, QEMUSGList *sg) |
| 318 | { |
David Gibson | c65bcef | 2012-06-27 14:50:40 +1000 | [diff] [blame] | 319 | return dma_buf_rw(ptr, len, sg, DMA_DIRECTION_FROM_DEVICE); |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 320 | } |
| 321 | |
| 322 | uint64_t dma_buf_write(uint8_t *ptr, int32_t len, QEMUSGList *sg) |
| 323 | { |
David Gibson | c65bcef | 2012-06-27 14:50:40 +1000 | [diff] [blame] | 324 | return dma_buf_rw(ptr, len, sg, DMA_DIRECTION_TO_DEVICE); |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 325 | } |
Paolo Bonzini | 84a6935 | 2011-09-05 14:20:29 +0200 | [diff] [blame] | 326 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 327 | void dma_acct_start(BlockBackend *blk, BlockAcctCookie *cookie, |
Paolo Bonzini | 84a6935 | 2011-09-05 14:20:29 +0200 | [diff] [blame] | 328 | QEMUSGList *sg, enum BlockAcctType type) |
| 329 | { |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 330 | block_acct_start(blk_get_stats(blk), cookie, sg->size, type); |
Paolo Bonzini | 84a6935 | 2011-09-05 14:20:29 +0200 | [diff] [blame] | 331 | } |