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