1 | /* |
---|
2 | * QEMU USB emulation |
---|
3 | * |
---|
4 | * Copyright (c) 2005 Fabrice Bellard |
---|
5 | * |
---|
6 | * Permission is hereby granted, free of charge, to any person obtaining a copy |
---|
7 | * of this software and associated documentation files (the "Software"), to deal |
---|
8 | * in the Software without restriction, including without limitation the rights |
---|
9 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
---|
10 | * copies of the Software, and to permit persons to whom the Software is |
---|
11 | * furnished to do so, subject to the following conditions: |
---|
12 | * |
---|
13 | * The above copyright notice and this permission notice shall be included in |
---|
14 | * all copies or substantial portions of the Software. |
---|
15 | * |
---|
16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
---|
17 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
---|
18 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
---|
19 | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
---|
20 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
---|
21 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
---|
22 | * THE SOFTWARE. |
---|
23 | */ |
---|
24 | #include "vl.h" |
---|
25 | |
---|
26 | void usb_attach(USBPort *port, USBDevice *dev) |
---|
27 | { |
---|
28 | port->attach(port, dev); |
---|
29 | } |
---|
30 | |
---|
31 | /**********************/ |
---|
32 | /* generic USB device helpers (you are not forced to use them when |
---|
33 | writing your USB device driver, but they help handling the |
---|
34 | protocol) |
---|
35 | */ |
---|
36 | |
---|
37 | #define SETUP_STATE_IDLE 0 |
---|
38 | #define SETUP_STATE_DATA 1 |
---|
39 | #define SETUP_STATE_ACK 2 |
---|
40 | |
---|
41 | int usb_generic_handle_packet(USBDevice *s, int pid, |
---|
42 | uint8_t devaddr, uint8_t devep, |
---|
43 | uint8_t *data, int len) |
---|
44 | { |
---|
45 | int l, ret = 0; |
---|
46 | |
---|
47 | switch(pid) { |
---|
48 | case USB_MSG_ATTACH: |
---|
49 | s->state = USB_STATE_ATTACHED; |
---|
50 | break; |
---|
51 | case USB_MSG_DETACH: |
---|
52 | s->state = USB_STATE_NOTATTACHED; |
---|
53 | break; |
---|
54 | case USB_MSG_RESET: |
---|
55 | s->remote_wakeup = 0; |
---|
56 | s->addr = 0; |
---|
57 | s->state = USB_STATE_DEFAULT; |
---|
58 | s->handle_reset(s); |
---|
59 | break; |
---|
60 | case USB_TOKEN_SETUP: |
---|
61 | if (s->state < USB_STATE_DEFAULT || devaddr != s->addr) |
---|
62 | return USB_RET_NODEV; |
---|
63 | if (len != 8) |
---|
64 | goto fail; |
---|
65 | memcpy(s->setup_buf, data, 8); |
---|
66 | s->setup_len = (s->setup_buf[7] << 8) | s->setup_buf[6]; |
---|
67 | s->setup_index = 0; |
---|
68 | if (s->setup_buf[0] & USB_DIR_IN) { |
---|
69 | ret = s->handle_control(s, |
---|
70 | (s->setup_buf[0] << 8) | s->setup_buf[1], |
---|
71 | (s->setup_buf[3] << 8) | s->setup_buf[2], |
---|
72 | (s->setup_buf[5] << 8) | s->setup_buf[4], |
---|
73 | s->setup_len, |
---|
74 | s->data_buf); |
---|
75 | if (ret < 0) |
---|
76 | return ret; |
---|
77 | if (ret < s->setup_len) |
---|
78 | s->setup_len = ret; |
---|
79 | s->setup_state = SETUP_STATE_DATA; |
---|
80 | } else { |
---|
81 | if (s->setup_len == 0) |
---|
82 | s->setup_state = SETUP_STATE_ACK; |
---|
83 | else |
---|
84 | s->setup_state = SETUP_STATE_DATA; |
---|
85 | } |
---|
86 | break; |
---|
87 | case USB_TOKEN_IN: |
---|
88 | if (s->state < USB_STATE_DEFAULT || devaddr != s->addr) |
---|
89 | return USB_RET_NODEV; |
---|
90 | switch(devep) { |
---|
91 | case 0: |
---|
92 | switch(s->setup_state) { |
---|
93 | case SETUP_STATE_ACK: |
---|
94 | if (!(s->setup_buf[0] & USB_DIR_IN)) { |
---|
95 | s->setup_state = SETUP_STATE_IDLE; |
---|
96 | ret = s->handle_control(s, |
---|
97 | (s->setup_buf[0] << 8) | s->setup_buf[1], |
---|
98 | (s->setup_buf[3] << 8) | s->setup_buf[2], |
---|
99 | (s->setup_buf[5] << 8) | s->setup_buf[4], |
---|
100 | s->setup_len, |
---|
101 | s->data_buf); |
---|
102 | if (ret > 0) |
---|
103 | ret = 0; |
---|
104 | } else { |
---|
105 | /* return 0 byte */ |
---|
106 | } |
---|
107 | break; |
---|
108 | case SETUP_STATE_DATA: |
---|
109 | if (s->setup_buf[0] & USB_DIR_IN) { |
---|
110 | l = s->setup_len - s->setup_index; |
---|
111 | if (l > len) |
---|
112 | l = len; |
---|
113 | memcpy(data, s->data_buf + s->setup_index, l); |
---|
114 | s->setup_index += l; |
---|
115 | if (s->setup_index >= s->setup_len) |
---|
116 | s->setup_state = SETUP_STATE_ACK; |
---|
117 | ret = l; |
---|
118 | } else { |
---|
119 | s->setup_state = SETUP_STATE_IDLE; |
---|
120 | goto fail; |
---|
121 | } |
---|
122 | break; |
---|
123 | default: |
---|
124 | goto fail; |
---|
125 | } |
---|
126 | break; |
---|
127 | default: |
---|
128 | ret = s->handle_data(s, pid, devep, data, len); |
---|
129 | break; |
---|
130 | } |
---|
131 | break; |
---|
132 | case USB_TOKEN_OUT: |
---|
133 | if (s->state < USB_STATE_DEFAULT || devaddr != s->addr) |
---|
134 | return USB_RET_NODEV; |
---|
135 | switch(devep) { |
---|
136 | case 0: |
---|
137 | switch(s->setup_state) { |
---|
138 | case SETUP_STATE_ACK: |
---|
139 | if (s->setup_buf[0] & USB_DIR_IN) { |
---|
140 | s->setup_state = SETUP_STATE_IDLE; |
---|
141 | /* transfer OK */ |
---|
142 | } else { |
---|
143 | /* ignore additionnal output */ |
---|
144 | } |
---|
145 | break; |
---|
146 | case SETUP_STATE_DATA: |
---|
147 | if (!(s->setup_buf[0] & USB_DIR_IN)) { |
---|
148 | l = s->setup_len - s->setup_index; |
---|
149 | if (l > len) |
---|
150 | l = len; |
---|
151 | memcpy(s->data_buf + s->setup_index, data, l); |
---|
152 | s->setup_index += l; |
---|
153 | if (s->setup_index >= s->setup_len) |
---|
154 | s->setup_state = SETUP_STATE_ACK; |
---|
155 | ret = l; |
---|
156 | } else { |
---|
157 | s->setup_state = SETUP_STATE_IDLE; |
---|
158 | goto fail; |
---|
159 | } |
---|
160 | break; |
---|
161 | default: |
---|
162 | goto fail; |
---|
163 | } |
---|
164 | break; |
---|
165 | default: |
---|
166 | ret = s->handle_data(s, pid, devep, data, len); |
---|
167 | break; |
---|
168 | } |
---|
169 | break; |
---|
170 | default: |
---|
171 | fail: |
---|
172 | ret = USB_RET_STALL; |
---|
173 | break; |
---|
174 | } |
---|
175 | return ret; |
---|
176 | } |
---|
177 | |
---|
178 | /* XXX: fix overflow */ |
---|
179 | int set_usb_string(uint8_t *buf, const char *str) |
---|
180 | { |
---|
181 | int len, i; |
---|
182 | uint8_t *q; |
---|
183 | |
---|
184 | q = buf; |
---|
185 | len = strlen(str); |
---|
186 | *q++ = 2 * len + 2; |
---|
187 | *q++ = 3; |
---|
188 | for(i = 0; i < len; i++) { |
---|
189 | *q++ = str[i]; |
---|
190 | *q++ = 0; |
---|
191 | } |
---|
192 | return q - buf; |
---|
193 | } |
---|
194 | |
---|
195 | void generic_usb_save(QEMUFile* f, void *opaque) |
---|
196 | { |
---|
197 | USBDevice *s = (USBDevice*)opaque; |
---|
198 | |
---|
199 | qemu_put_be32s(f, &s->speed); |
---|
200 | qemu_put_8s(f, &s->addr); |
---|
201 | qemu_put_be32s(f, &s->state); |
---|
202 | |
---|
203 | qemu_put_buffer(f, s->setup_buf, 8); |
---|
204 | qemu_put_buffer(f, s->data_buf, 1024); |
---|
205 | |
---|
206 | qemu_put_be32s(f, &s->remote_wakeup); |
---|
207 | qemu_put_be32s(f, &s->setup_state); |
---|
208 | qemu_put_be32s(f, &s->setup_len); |
---|
209 | qemu_put_be32s(f, &s->setup_index); |
---|
210 | |
---|
211 | } |
---|
212 | |
---|
213 | int generic_usb_load(QEMUFile* f, void *opaque, int version_id) |
---|
214 | { |
---|
215 | USBDevice *s = (USBDevice*)opaque; |
---|
216 | |
---|
217 | if (version_id != 1) |
---|
218 | return -EINVAL; |
---|
219 | |
---|
220 | qemu_get_be32s(f, &s->speed); |
---|
221 | qemu_get_8s(f, &s->addr); |
---|
222 | qemu_get_be32s(f, &s->state); |
---|
223 | |
---|
224 | qemu_get_buffer(f, s->setup_buf, 8); |
---|
225 | qemu_get_buffer(f, s->data_buf, 1024); |
---|
226 | |
---|
227 | qemu_get_be32s(f, &s->remote_wakeup); |
---|
228 | qemu_get_be32s(f, &s->setup_state); |
---|
229 | qemu_get_be32s(f, &s->setup_len); |
---|
230 | qemu_get_be32s(f, &s->setup_index); |
---|
231 | |
---|
232 | return 0; |
---|
233 | } |
---|