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 | |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 93 | assert(!dbs->acb && dbs->bh); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 94 | qemu_bh_delete(dbs->bh); |
| 95 | dbs->bh = NULL; |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 96 | dma_blk_cb(dbs, 0); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 97 | } |
| 98 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 99 | static void dma_blk_unmap(DMAAIOCB *dbs) |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 100 | { |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 101 | int i; |
| 102 | |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 103 | for (i = 0; i < dbs->iov.niov; ++i) { |
Paolo Bonzini | df32fd1 | 2013-04-10 18:15:49 +0200 | [diff] [blame] | 104 | dma_memory_unmap(dbs->sg->as, dbs->iov.iov[i].iov_base, |
David Gibson | c65bcef | 2012-06-27 14:50:40 +1000 | [diff] [blame] | 105 | dbs->iov.iov[i].iov_len, dbs->dir, |
| 106 | dbs->iov.iov[i].iov_len); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 107 | } |
Paolo Bonzini | c3adb5b | 2011-09-16 16:40:02 +0200 | [diff] [blame] | 108 | qemu_iovec_reset(&dbs->iov); |
| 109 | } |
| 110 | |
| 111 | static void dma_complete(DMAAIOCB *dbs, int ret) |
| 112 | { |
Kevin Wolf | c57c465 | 2011-11-24 06:15:28 -0500 | [diff] [blame] | 113 | trace_dma_complete(dbs, ret, dbs->common.cb); |
| 114 | |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 115 | assert(!dbs->acb && !dbs->bh); |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 116 | dma_blk_unmap(dbs); |
Paolo Bonzini | c3adb5b | 2011-09-16 16:40:02 +0200 | [diff] [blame] | 117 | if (dbs->common.cb) { |
| 118 | dbs->common.cb(dbs->common.opaque, ret); |
| 119 | } |
| 120 | qemu_iovec_destroy(&dbs->iov); |
Fam Zheng | 8007429 | 2014-09-11 13:41:28 +0800 | [diff] [blame] | 121 | qemu_aio_unref(dbs); |
aliguori | 7403b14 | 2009-03-28 16:11:25 +0000 | [diff] [blame] | 122 | } |
| 123 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 124 | static void dma_blk_cb(void *opaque, int ret) |
aliguori | 7403b14 | 2009-03-28 16:11:25 +0000 | [diff] [blame] | 125 | { |
| 126 | DMAAIOCB *dbs = (DMAAIOCB *)opaque; |
David Gibson | c65bcef | 2012-06-27 14:50:40 +1000 | [diff] [blame] | 127 | dma_addr_t cur_addr, cur_len; |
aliguori | 7403b14 | 2009-03-28 16:11:25 +0000 | [diff] [blame] | 128 | void *mem; |
| 129 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 130 | trace_dma_blk_cb(dbs, ret); |
Kevin Wolf | c57c465 | 2011-11-24 06:15:28 -0500 | [diff] [blame] | 131 | |
aliguori | 7403b14 | 2009-03-28 16:11:25 +0000 | [diff] [blame] | 132 | dbs->acb = NULL; |
Eric Blake | d4f510e | 2016-05-06 10:26:31 -0600 | [diff] [blame] | 133 | dbs->offset += dbs->iov.size; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 134 | |
| 135 | if (dbs->sg_cur_index == dbs->sg->nsg || ret < 0) { |
Paolo Bonzini | c3adb5b | 2011-09-16 16:40:02 +0200 | [diff] [blame] | 136 | dma_complete(dbs, ret); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 137 | return; |
| 138 | } |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 139 | dma_blk_unmap(dbs); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 140 | |
| 141 | while (dbs->sg_cur_index < dbs->sg->nsg) { |
| 142 | cur_addr = dbs->sg->sg[dbs->sg_cur_index].base + dbs->sg_cur_byte; |
| 143 | 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] | 144 | mem = dma_memory_map(dbs->sg->as, cur_addr, &cur_len, dbs->dir); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 145 | if (!mem) |
| 146 | break; |
| 147 | qemu_iovec_add(&dbs->iov, mem, cur_len); |
| 148 | dbs->sg_cur_byte += cur_len; |
| 149 | if (dbs->sg_cur_byte == dbs->sg->sg[dbs->sg_cur_index].len) { |
| 150 | dbs->sg_cur_byte = 0; |
| 151 | ++dbs->sg_cur_index; |
| 152 | } |
| 153 | } |
| 154 | |
| 155 | if (dbs->iov.size == 0) { |
Kevin Wolf | c57c465 | 2011-11-24 06:15:28 -0500 | [diff] [blame] | 156 | trace_dma_map_wait(dbs); |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 157 | dbs->bh = aio_bh_new(dbs->ctx, reschedule_dma, dbs); |
Fam Zheng | e95205e | 2015-03-16 17:03:37 +0800 | [diff] [blame] | 158 | cpu_register_map_client(dbs->bh); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 159 | return; |
| 160 | } |
| 161 | |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 162 | if (!QEMU_IS_ALIGNED(dbs->iov.size, dbs->align)) { |
| 163 | qemu_iovec_discard_back(&dbs->iov, |
| 164 | QEMU_ALIGN_DOWN(dbs->iov.size, dbs->align)); |
Kevin Wolf | 58f423f | 2014-07-09 19:17:30 +0200 | [diff] [blame] | 165 | } |
| 166 | |
Paolo Bonzini | 1919631 | 2017-02-13 14:52:31 +0100 | [diff] [blame] | 167 | aio_context_acquire(dbs->ctx); |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 168 | dbs->acb = dbs->io_func(dbs->offset, &dbs->iov, |
| 169 | dma_blk_cb, dbs, dbs->io_func_opaque); |
Paolo Bonzini | 1919631 | 2017-02-13 14:52:31 +0100 | [diff] [blame] | 170 | aio_context_release(dbs->ctx); |
Paolo Bonzini | 6bee44e | 2011-11-14 17:50:52 +0100 | [diff] [blame] | 171 | assert(dbs->acb); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 172 | } |
| 173 | |
Markus Armbruster | 7c84b1b | 2014-10-07 13:59:14 +0200 | [diff] [blame] | 174 | static void dma_aio_cancel(BlockAIOCB *acb) |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 175 | { |
| 176 | DMAAIOCB *dbs = container_of(acb, DMAAIOCB, common); |
| 177 | |
Kevin Wolf | c57c465 | 2011-11-24 06:15:28 -0500 | [diff] [blame] | 178 | trace_dma_aio_cancel(dbs); |
| 179 | |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 180 | assert(!(dbs->acb && dbs->bh)); |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 181 | if (dbs->acb) { |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 182 | /* This will invoke dma_blk_cb. */ |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 183 | blk_aio_cancel_async(dbs->acb); |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 184 | return; |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 185 | } |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 186 | |
Fam Zheng | e95205e | 2015-03-16 17:03:37 +0800 | [diff] [blame] | 187 | if (dbs->bh) { |
| 188 | cpu_unregister_map_client(dbs->bh); |
| 189 | qemu_bh_delete(dbs->bh); |
| 190 | dbs->bh = NULL; |
| 191 | } |
Paolo Bonzini | 539343c | 2019-07-29 23:34:16 +0200 | [diff] [blame] | 192 | if (dbs->common.cb) { |
| 193 | dbs->common.cb(dbs->common.opaque, -ECANCELED); |
| 194 | } |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 195 | } |
| 196 | |
Stefan Hajnoczi | 5fa78b2 | 2016-06-20 20:36:57 +0100 | [diff] [blame] | 197 | static AioContext *dma_get_aio_context(BlockAIOCB *acb) |
| 198 | { |
| 199 | DMAAIOCB *dbs = container_of(acb, DMAAIOCB, common); |
| 200 | |
| 201 | return dbs->ctx; |
| 202 | } |
Fam Zheng | 9bb9da4 | 2014-09-11 13:41:14 +0800 | [diff] [blame] | 203 | |
Stefan Hajnoczi | d7331be | 2012-10-31 16:34:37 +0100 | [diff] [blame] | 204 | static const AIOCBInfo dma_aiocb_info = { |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 205 | .aiocb_size = sizeof(DMAAIOCB), |
Fam Zheng | 9bb9da4 | 2014-09-11 13:41:14 +0800 | [diff] [blame] | 206 | .cancel_async = dma_aio_cancel, |
Stefan Hajnoczi | 5fa78b2 | 2016-06-20 20:36:57 +0100 | [diff] [blame] | 207 | .get_aio_context = dma_get_aio_context, |
Christoph Hellwig | c16b5a2 | 2009-05-25 12:37:32 +0200 | [diff] [blame] | 208 | }; |
| 209 | |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 210 | BlockAIOCB *dma_blk_io(AioContext *ctx, |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 211 | QEMUSGList *sg, uint64_t offset, uint32_t align, |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 212 | DMAIOFunc *io_func, void *io_func_opaque, |
| 213 | BlockCompletionFunc *cb, |
David Gibson | 43cf8ae | 2012-03-27 13:42:23 +1100 | [diff] [blame] | 214 | void *opaque, DMADirection dir) |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 215 | { |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 216 | DMAAIOCB *dbs = qemu_aio_get(&dma_aiocb_info, NULL, cb, opaque); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 217 | |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 218 | 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] | 219 | |
aliguori | 37b7842 | 2009-03-20 18:26:16 +0000 | [diff] [blame] | 220 | dbs->acb = NULL; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 221 | dbs->sg = sg; |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 222 | dbs->ctx = ctx; |
Paolo Bonzini | cbe0ed6 | 2016-05-23 14:54:05 +0200 | [diff] [blame] | 223 | dbs->offset = offset; |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 224 | dbs->align = align; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 225 | dbs->sg_cur_index = 0; |
| 226 | dbs->sg_cur_byte = 0; |
David Gibson | 43cf8ae | 2012-03-27 13:42:23 +1100 | [diff] [blame] | 227 | dbs->dir = dir; |
Christoph Hellwig | cb144cc | 2011-05-19 10:57:59 +0200 | [diff] [blame] | 228 | dbs->io_func = io_func; |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 229 | dbs->io_func_opaque = io_func_opaque; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 230 | dbs->bh = NULL; |
| 231 | qemu_iovec_init(&dbs->iov, sg->nsg); |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 232 | dma_blk_cb(dbs, 0); |
aliguori | 37b7842 | 2009-03-20 18:26:16 +0000 | [diff] [blame] | 233 | return &dbs->common; |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 234 | } |
| 235 | |
| 236 | |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 237 | static |
| 238 | BlockAIOCB *dma_blk_read_io_func(int64_t offset, QEMUIOVector *iov, |
| 239 | BlockCompletionFunc *cb, void *cb_opaque, |
| 240 | void *opaque) |
| 241 | { |
| 242 | BlockBackend *blk = opaque; |
| 243 | return blk_aio_preadv(blk, offset, iov, 0, cb, cb_opaque); |
| 244 | } |
| 245 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 246 | BlockAIOCB *dma_blk_read(BlockBackend *blk, |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 247 | QEMUSGList *sg, uint64_t offset, uint32_t align, |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 248 | void (*cb)(void *opaque, int ret), void *opaque) |
| 249 | { |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 250 | return dma_blk_io(blk_get_aio_context(blk), sg, offset, align, |
| 251 | dma_blk_read_io_func, blk, cb, opaque, |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 252 | DMA_DIRECTION_FROM_DEVICE); |
| 253 | } |
| 254 | |
Paolo Bonzini | 8a8e63e | 2016-05-23 14:54:06 +0200 | [diff] [blame] | 255 | static |
| 256 | BlockAIOCB *dma_blk_write_io_func(int64_t offset, QEMUIOVector *iov, |
| 257 | BlockCompletionFunc *cb, void *cb_opaque, |
| 258 | void *opaque) |
| 259 | { |
| 260 | BlockBackend *blk = opaque; |
| 261 | return blk_aio_pwritev(blk, offset, iov, 0, cb, cb_opaque); |
| 262 | } |
| 263 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 264 | BlockAIOCB *dma_blk_write(BlockBackend *blk, |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 265 | QEMUSGList *sg, uint64_t offset, uint32_t align, |
Markus Armbruster | 7c84b1b | 2014-10-07 13:59:14 +0200 | [diff] [blame] | 266 | void (*cb)(void *opaque, int ret), void *opaque) |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 267 | { |
Mark Cave-Ayland | 99868af | 2016-10-27 16:29:13 -0400 | [diff] [blame] | 268 | return dma_blk_io(blk_get_aio_context(blk), sg, offset, align, |
| 269 | dma_blk_write_io_func, blk, cb, opaque, |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 270 | DMA_DIRECTION_TO_DEVICE); |
aliguori | 59a703e | 2009-02-05 21:23:58 +0000 | [diff] [blame] | 271 | } |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 272 | |
| 273 | |
David Gibson | c65bcef | 2012-06-27 14:50:40 +1000 | [diff] [blame] | 274 | static uint64_t dma_buf_rw(uint8_t *ptr, int32_t len, QEMUSGList *sg, |
| 275 | DMADirection dir) |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 276 | { |
| 277 | uint64_t resid; |
| 278 | int sg_cur_index; |
| 279 | |
| 280 | resid = sg->size; |
| 281 | sg_cur_index = 0; |
| 282 | len = MIN(len, resid); |
| 283 | while (len > 0) { |
| 284 | ScatterGatherEntry entry = sg->sg[sg_cur_index++]; |
| 285 | int32_t xfer = MIN(len, entry.len); |
Paolo Bonzini | df32fd1 | 2013-04-10 18:15:49 +0200 | [diff] [blame] | 286 | dma_memory_rw(sg->as, entry.base, ptr, xfer, dir); |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 287 | ptr += xfer; |
| 288 | len -= xfer; |
| 289 | resid -= xfer; |
| 290 | } |
| 291 | |
| 292 | return resid; |
| 293 | } |
| 294 | |
| 295 | uint64_t dma_buf_read(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_FROM_DEVICE); |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 298 | } |
| 299 | |
| 300 | uint64_t dma_buf_write(uint8_t *ptr, int32_t len, QEMUSGList *sg) |
| 301 | { |
David Gibson | c65bcef | 2012-06-27 14:50:40 +1000 | [diff] [blame] | 302 | return dma_buf_rw(ptr, len, sg, DMA_DIRECTION_TO_DEVICE); |
Paolo Bonzini | 8171ee3 | 2011-07-06 08:02:14 +0200 | [diff] [blame] | 303 | } |
Paolo Bonzini | 84a6935 | 2011-09-05 14:20:29 +0200 | [diff] [blame] | 304 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 305 | void dma_acct_start(BlockBackend *blk, BlockAcctCookie *cookie, |
Paolo Bonzini | 84a6935 | 2011-09-05 14:20:29 +0200 | [diff] [blame] | 306 | QEMUSGList *sg, enum BlockAcctType type) |
| 307 | { |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 308 | block_acct_start(blk_get_stats(blk), cookie, sg->size, type); |
Paolo Bonzini | 84a6935 | 2011-09-05 14:20:29 +0200 | [diff] [blame] | 309 | } |