1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include "qemu/osdep.h"
23#include "hw/usb.h"
24#include "sysemu/dma.h"
25
26int usb_packet_map(USBPacket *p, QEMUSGList *sgl)
27{
28 DMADirection dir = (p->pid == USB_TOKEN_IN) ?
29 DMA_DIRECTION_FROM_DEVICE : DMA_DIRECTION_TO_DEVICE;
30 void *mem;
31 int i;
32
33 for (i = 0; i < sgl->nsg; i++) {
34 dma_addr_t base = sgl->sg[i].base;
35 dma_addr_t len = sgl->sg[i].len;
36
37 while (len) {
38 dma_addr_t xlen = len;
39 mem = dma_memory_map(sgl->as, base, &xlen, dir,
40 MEMTXATTRS_UNSPECIFIED);
41 if (!mem) {
42 goto err;
43 }
44 if (xlen > len) {
45 xlen = len;
46 }
47 qemu_iovec_add(&p->iov, mem, xlen);
48 len -= xlen;
49 base += xlen;
50 }
51 }
52 return 0;
53
54err:
55 usb_packet_unmap(p, sgl);
56 return -1;
57}
58
59void usb_packet_unmap(USBPacket *p, QEMUSGList *sgl)
60{
61 DMADirection dir = (p->pid == USB_TOKEN_IN) ?
62 DMA_DIRECTION_FROM_DEVICE : DMA_DIRECTION_TO_DEVICE;
63 int i;
64
65 for (i = 0; i < p->iov.niov; i++) {
66 dma_memory_unmap(sgl->as, p->iov.iov[i].iov_base,
67 p->iov.iov[i].iov_len, dir,
68 p->iov.iov[i].iov_len);
69 }
70}
71