Line | Count | Source |
1 | | /* |
2 | | * QEMU USB emulation, libhw bits. |
3 | | * |
4 | | * Permission is hereby granted, free of charge, to any person obtaining a copy |
5 | | * of this software and associated documentation files (the "Software"), to deal |
6 | | * in the Software without restriction, including without limitation the rights |
7 | | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
8 | | * copies of the Software, and to permit persons to whom the Software is |
9 | | * furnished to do so, subject to the following conditions: |
10 | | * |
11 | | * The above copyright notice and this permission notice shall be included in |
12 | | * all copies or substantial portions of the Software. |
13 | | * |
14 | | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
15 | | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
16 | | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
17 | | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
18 | | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
19 | | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
20 | | * THE SOFTWARE. |
21 | | */ |
22 | | #include "qemu/osdep.h" |
23 | | #include "hw/usb/usb.h" |
24 | | #include "system/dma.h" |
25 | | |
26 | | int usb_packet_map(USBPacket *p, QEMUSGList *sgl) |
27 | 32.4k | { |
28 | 32.4k | DMADirection dir = (p->pid == USB_TOKEN_IN) ? |
29 | 31.6k | DMA_DIRECTION_FROM_DEVICE : DMA_DIRECTION_TO_DEVICE; |
30 | 32.4k | void *mem; |
31 | 32.4k | int i; |
32 | | |
33 | 50.7k | for (i = 0; i < sgl->nsg; i++) { |
34 | 18.3k | dma_addr_t base = sgl->sg[i].base; |
35 | 18.3k | dma_addr_t len = sgl->sg[i].len; |
36 | | |
37 | 37.1k | while (len) { |
38 | 18.8k | dma_addr_t xlen = len; |
39 | 18.8k | mem = dma_memory_map(sgl->as, base, &xlen, dir, |
40 | 18.8k | MEMTXATTRS_UNSPECIFIED); |
41 | 18.8k | if (!mem) { |
42 | 87 | goto err; |
43 | 87 | } |
44 | 18.7k | if (xlen > len) { |
45 | 0 | xlen = len; |
46 | 0 | } |
47 | 18.7k | qemu_iovec_add(&p->iov, mem, xlen); |
48 | 18.7k | len -= xlen; |
49 | 18.7k | base += xlen; |
50 | 18.7k | } |
51 | 18.3k | } |
52 | 32.3k | return 0; |
53 | | |
54 | 87 | err: |
55 | 87 | usb_packet_unmap(p, sgl); |
56 | 87 | return -1; |
57 | 32.4k | } |
58 | | |
59 | | void usb_packet_unmap(USBPacket *p, QEMUSGList *sgl) |
60 | 40.3k | { |
61 | 40.3k | DMADirection dir = (p->pid == USB_TOKEN_IN) ? |
62 | 39.5k | DMA_DIRECTION_FROM_DEVICE : DMA_DIRECTION_TO_DEVICE; |
63 | 40.3k | int i; |
64 | | |
65 | 59.0k | for (i = 0; i < p->iov.niov; i++) { |
66 | 18.7k | dma_memory_unmap(sgl->as, p->iov.iov[i].iov_base, |
67 | 18.7k | p->iov.iov[i].iov_len, dir, |
68 | 18.7k | p->iov.iov[i].iov_len); |
69 | 18.7k | } |
70 | 40.3k | } |