root / hw / usb-bt.c @ 0dad6c35
History | View | Annotate | Download (16.7 kB)
1 | e6a6d5ab | balrog | /*
|
---|---|---|---|
2 | e6a6d5ab | balrog | * QEMU Bluetooth HCI USB Transport Layer v1.0
|
3 | e6a6d5ab | balrog | *
|
4 | e6a6d5ab | balrog | * Copyright (C) 2007 OpenMoko, Inc.
|
5 | e6a6d5ab | balrog | * Copyright (C) 2008 Andrzej Zaborowski <balrog@zabor.org>
|
6 | e6a6d5ab | balrog | *
|
7 | e6a6d5ab | balrog | * This program is free software; you can redistribute it and/or
|
8 | e6a6d5ab | balrog | * modify it under the terms of the GNU General Public License as
|
9 | e6a6d5ab | balrog | * published by the Free Software Foundation; either version 2 or
|
10 | e6a6d5ab | balrog | * (at your option) version 3 of the License.
|
11 | e6a6d5ab | balrog | *
|
12 | e6a6d5ab | balrog | * This program is distributed in the hope that it will be useful,
|
13 | e6a6d5ab | balrog | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
14 | e6a6d5ab | balrog | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
15 | e6a6d5ab | balrog | * GNU General Public License for more details.
|
16 | e6a6d5ab | balrog | *
|
17 | fad6cb1a | aurel32 | * You should have received a copy of the GNU General Public License along
|
18 | 8167ee88 | Blue Swirl | * with this program; if not, see <http://www.gnu.org/licenses/>.
|
19 | e6a6d5ab | balrog | */
|
20 | e6a6d5ab | balrog | |
21 | e6a6d5ab | balrog | #include "qemu-common.h" |
22 | e6a6d5ab | balrog | #include "usb.h" |
23 | 4696425c | Gerd Hoffmann | #include "usb-desc.h" |
24 | e6a6d5ab | balrog | #include "net.h" |
25 | e6a6d5ab | balrog | #include "bt.h" |
26 | e6a6d5ab | balrog | |
27 | e6a6d5ab | balrog | struct USBBtState {
|
28 | e6a6d5ab | balrog | USBDevice dev; |
29 | e6a6d5ab | balrog | struct HCIInfo *hci;
|
30 | e6a6d5ab | balrog | |
31 | e6a6d5ab | balrog | int config;
|
32 | e6a6d5ab | balrog | |
33 | e6a6d5ab | balrog | #define CFIFO_LEN_MASK 255 |
34 | e6a6d5ab | balrog | #define DFIFO_LEN_MASK 4095 |
35 | e6a6d5ab | balrog | struct usb_hci_in_fifo_s {
|
36 | e6a6d5ab | balrog | uint8_t data[(DFIFO_LEN_MASK + 1) * 2]; |
37 | e6a6d5ab | balrog | struct {
|
38 | e6a6d5ab | balrog | uint8_t *data; |
39 | e6a6d5ab | balrog | int len;
|
40 | e6a6d5ab | balrog | } fifo[CFIFO_LEN_MASK + 1];
|
41 | e6a6d5ab | balrog | int dstart, dlen, dsize, start, len;
|
42 | e6a6d5ab | balrog | } evt, acl, sco; |
43 | e6a6d5ab | balrog | |
44 | e6a6d5ab | balrog | struct usb_hci_out_fifo_s {
|
45 | e6a6d5ab | balrog | uint8_t data[4096];
|
46 | e6a6d5ab | balrog | int len;
|
47 | e6a6d5ab | balrog | } outcmd, outacl, outsco; |
48 | e6a6d5ab | balrog | }; |
49 | e6a6d5ab | balrog | |
50 | e6a6d5ab | balrog | #define USB_EVT_EP 1 |
51 | e6a6d5ab | balrog | #define USB_ACL_EP 2 |
52 | e6a6d5ab | balrog | #define USB_SCO_EP 3 |
53 | e6a6d5ab | balrog | |
54 | 4696425c | Gerd Hoffmann | enum {
|
55 | 4696425c | Gerd Hoffmann | STR_MANUFACTURER = 1,
|
56 | 4696425c | Gerd Hoffmann | STR_SERIALNUMBER, |
57 | 4696425c | Gerd Hoffmann | }; |
58 | e6a6d5ab | balrog | |
59 | 4696425c | Gerd Hoffmann | static const USBDescStrings desc_strings = { |
60 | 4696425c | Gerd Hoffmann | [STR_MANUFACTURER] = "QEMU " QEMU_VERSION,
|
61 | 4696425c | Gerd Hoffmann | [STR_SERIALNUMBER] = "1",
|
62 | 4696425c | Gerd Hoffmann | }; |
63 | e6a6d5ab | balrog | |
64 | 4696425c | Gerd Hoffmann | static const USBDescIface desc_iface_bluetooth[] = { |
65 | 4696425c | Gerd Hoffmann | { |
66 | 4696425c | Gerd Hoffmann | .bInterfaceNumber = 0,
|
67 | 4696425c | Gerd Hoffmann | .bNumEndpoints = 3,
|
68 | 4696425c | Gerd Hoffmann | .bInterfaceClass = 0xe0, /* Wireless */ |
69 | 4696425c | Gerd Hoffmann | .bInterfaceSubClass = 0x01, /* Radio Frequency */ |
70 | 4696425c | Gerd Hoffmann | .bInterfaceProtocol = 0x01, /* Bluetooth */ |
71 | 4696425c | Gerd Hoffmann | .eps = (USBDescEndpoint[]) { |
72 | 4696425c | Gerd Hoffmann | { |
73 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_IN | USB_EVT_EP, |
74 | 4696425c | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_INT, |
75 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0x10,
|
76 | 4696425c | Gerd Hoffmann | .bInterval = 0x02,
|
77 | 4696425c | Gerd Hoffmann | }, |
78 | 4696425c | Gerd Hoffmann | { |
79 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_OUT | USB_ACL_EP, |
80 | 4696425c | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_BULK, |
81 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0x40,
|
82 | 4696425c | Gerd Hoffmann | .bInterval = 0x0a,
|
83 | 4696425c | Gerd Hoffmann | }, |
84 | 4696425c | Gerd Hoffmann | { |
85 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_IN | USB_ACL_EP, |
86 | 4696425c | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_BULK, |
87 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0x40,
|
88 | 4696425c | Gerd Hoffmann | .bInterval = 0x0a,
|
89 | 4696425c | Gerd Hoffmann | }, |
90 | 4696425c | Gerd Hoffmann | }, |
91 | 4696425c | Gerd Hoffmann | },{ |
92 | 4696425c | Gerd Hoffmann | .bInterfaceNumber = 1,
|
93 | 4696425c | Gerd Hoffmann | .bAlternateSetting = 0,
|
94 | 4696425c | Gerd Hoffmann | .bNumEndpoints = 2,
|
95 | 4696425c | Gerd Hoffmann | .bInterfaceClass = 0xe0, /* Wireless */ |
96 | 4696425c | Gerd Hoffmann | .bInterfaceSubClass = 0x01, /* Radio Frequency */ |
97 | 4696425c | Gerd Hoffmann | .bInterfaceProtocol = 0x01, /* Bluetooth */ |
98 | 4696425c | Gerd Hoffmann | .eps = (USBDescEndpoint[]) { |
99 | 4696425c | Gerd Hoffmann | { |
100 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_OUT | USB_SCO_EP, |
101 | dd850cf2 | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_ISOC, |
102 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0,
|
103 | 4696425c | Gerd Hoffmann | .bInterval = 0x01,
|
104 | 4696425c | Gerd Hoffmann | }, |
105 | 4696425c | Gerd Hoffmann | { |
106 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_IN | USB_SCO_EP, |
107 | dd850cf2 | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_ISOC, |
108 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0,
|
109 | 4696425c | Gerd Hoffmann | .bInterval = 0x01,
|
110 | 4696425c | Gerd Hoffmann | }, |
111 | 4696425c | Gerd Hoffmann | }, |
112 | 4696425c | Gerd Hoffmann | },{ |
113 | 4696425c | Gerd Hoffmann | .bInterfaceNumber = 1,
|
114 | 4696425c | Gerd Hoffmann | .bAlternateSetting = 1,
|
115 | 4696425c | Gerd Hoffmann | .bNumEndpoints = 2,
|
116 | 4696425c | Gerd Hoffmann | .bInterfaceClass = 0xe0, /* Wireless */ |
117 | 4696425c | Gerd Hoffmann | .bInterfaceSubClass = 0x01, /* Radio Frequency */ |
118 | 4696425c | Gerd Hoffmann | .bInterfaceProtocol = 0x01, /* Bluetooth */ |
119 | 4696425c | Gerd Hoffmann | .eps = (USBDescEndpoint[]) { |
120 | 4696425c | Gerd Hoffmann | { |
121 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_OUT | USB_SCO_EP, |
122 | dd850cf2 | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_ISOC, |
123 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0x09,
|
124 | 4696425c | Gerd Hoffmann | .bInterval = 0x01,
|
125 | 4696425c | Gerd Hoffmann | }, |
126 | 4696425c | Gerd Hoffmann | { |
127 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_IN | USB_SCO_EP, |
128 | dd850cf2 | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_ISOC, |
129 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0x09,
|
130 | 4696425c | Gerd Hoffmann | .bInterval = 0x01,
|
131 | 4696425c | Gerd Hoffmann | }, |
132 | 4696425c | Gerd Hoffmann | }, |
133 | 4696425c | Gerd Hoffmann | },{ |
134 | 4696425c | Gerd Hoffmann | .bInterfaceNumber = 1,
|
135 | 4696425c | Gerd Hoffmann | .bAlternateSetting = 2,
|
136 | 4696425c | Gerd Hoffmann | .bNumEndpoints = 2,
|
137 | 4696425c | Gerd Hoffmann | .bInterfaceClass = 0xe0, /* Wireless */ |
138 | 4696425c | Gerd Hoffmann | .bInterfaceSubClass = 0x01, /* Radio Frequency */ |
139 | 4696425c | Gerd Hoffmann | .bInterfaceProtocol = 0x01, /* Bluetooth */ |
140 | 4696425c | Gerd Hoffmann | .eps = (USBDescEndpoint[]) { |
141 | 4696425c | Gerd Hoffmann | { |
142 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_OUT | USB_SCO_EP, |
143 | dd850cf2 | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_ISOC, |
144 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0x11,
|
145 | 4696425c | Gerd Hoffmann | .bInterval = 0x01,
|
146 | 4696425c | Gerd Hoffmann | }, |
147 | 4696425c | Gerd Hoffmann | { |
148 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_IN | USB_SCO_EP, |
149 | dd850cf2 | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_ISOC, |
150 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0x11,
|
151 | 4696425c | Gerd Hoffmann | .bInterval = 0x01,
|
152 | 4696425c | Gerd Hoffmann | }, |
153 | 4696425c | Gerd Hoffmann | }, |
154 | 4696425c | Gerd Hoffmann | },{ |
155 | 4696425c | Gerd Hoffmann | .bInterfaceNumber = 1,
|
156 | 4696425c | Gerd Hoffmann | .bAlternateSetting = 3,
|
157 | 4696425c | Gerd Hoffmann | .bNumEndpoints = 2,
|
158 | 4696425c | Gerd Hoffmann | .bInterfaceClass = 0xe0, /* Wireless */ |
159 | 4696425c | Gerd Hoffmann | .bInterfaceSubClass = 0x01, /* Radio Frequency */ |
160 | 4696425c | Gerd Hoffmann | .bInterfaceProtocol = 0x01, /* Bluetooth */ |
161 | 4696425c | Gerd Hoffmann | .eps = (USBDescEndpoint[]) { |
162 | 4696425c | Gerd Hoffmann | { |
163 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_OUT | USB_SCO_EP, |
164 | dd850cf2 | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_ISOC, |
165 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0x19,
|
166 | 4696425c | Gerd Hoffmann | .bInterval = 0x01,
|
167 | 4696425c | Gerd Hoffmann | }, |
168 | 4696425c | Gerd Hoffmann | { |
169 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_IN | USB_SCO_EP, |
170 | dd850cf2 | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_ISOC, |
171 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0x19,
|
172 | 4696425c | Gerd Hoffmann | .bInterval = 0x01,
|
173 | 4696425c | Gerd Hoffmann | }, |
174 | 4696425c | Gerd Hoffmann | }, |
175 | 4696425c | Gerd Hoffmann | },{ |
176 | 4696425c | Gerd Hoffmann | .bInterfaceNumber = 1,
|
177 | 4696425c | Gerd Hoffmann | .bAlternateSetting = 4,
|
178 | 4696425c | Gerd Hoffmann | .bNumEndpoints = 2,
|
179 | 4696425c | Gerd Hoffmann | .bInterfaceClass = 0xe0, /* Wireless */ |
180 | 4696425c | Gerd Hoffmann | .bInterfaceSubClass = 0x01, /* Radio Frequency */ |
181 | 4696425c | Gerd Hoffmann | .bInterfaceProtocol = 0x01, /* Bluetooth */ |
182 | 4696425c | Gerd Hoffmann | .eps = (USBDescEndpoint[]) { |
183 | 4696425c | Gerd Hoffmann | { |
184 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_OUT | USB_SCO_EP, |
185 | dd850cf2 | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_ISOC, |
186 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0x21,
|
187 | 4696425c | Gerd Hoffmann | .bInterval = 0x01,
|
188 | 4696425c | Gerd Hoffmann | }, |
189 | 4696425c | Gerd Hoffmann | { |
190 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_IN | USB_SCO_EP, |
191 | dd850cf2 | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_ISOC, |
192 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0x21,
|
193 | 4696425c | Gerd Hoffmann | .bInterval = 0x01,
|
194 | 4696425c | Gerd Hoffmann | }, |
195 | 4696425c | Gerd Hoffmann | }, |
196 | 4696425c | Gerd Hoffmann | },{ |
197 | 4696425c | Gerd Hoffmann | .bInterfaceNumber = 1,
|
198 | 4696425c | Gerd Hoffmann | .bAlternateSetting = 5,
|
199 | 4696425c | Gerd Hoffmann | .bNumEndpoints = 2,
|
200 | 4696425c | Gerd Hoffmann | .bInterfaceClass = 0xe0, /* Wireless */ |
201 | 4696425c | Gerd Hoffmann | .bInterfaceSubClass = 0x01, /* Radio Frequency */ |
202 | 4696425c | Gerd Hoffmann | .bInterfaceProtocol = 0x01, /* Bluetooth */ |
203 | 4696425c | Gerd Hoffmann | .eps = (USBDescEndpoint[]) { |
204 | 4696425c | Gerd Hoffmann | { |
205 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_OUT | USB_SCO_EP, |
206 | dd850cf2 | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_ISOC, |
207 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0x31,
|
208 | 4696425c | Gerd Hoffmann | .bInterval = 0x01,
|
209 | 4696425c | Gerd Hoffmann | }, |
210 | 4696425c | Gerd Hoffmann | { |
211 | 4696425c | Gerd Hoffmann | .bEndpointAddress = USB_DIR_IN | USB_SCO_EP, |
212 | dd850cf2 | Gerd Hoffmann | .bmAttributes = USB_ENDPOINT_XFER_ISOC, |
213 | 4696425c | Gerd Hoffmann | .wMaxPacketSize = 0x31,
|
214 | 4696425c | Gerd Hoffmann | .bInterval = 0x01,
|
215 | 4696425c | Gerd Hoffmann | }, |
216 | 4696425c | Gerd Hoffmann | }, |
217 | 4696425c | Gerd Hoffmann | } |
218 | 4696425c | Gerd Hoffmann | }; |
219 | e6a6d5ab | balrog | |
220 | 4696425c | Gerd Hoffmann | static const USBDescDevice desc_device_bluetooth = { |
221 | 4696425c | Gerd Hoffmann | .bcdUSB = 0x0110,
|
222 | 4696425c | Gerd Hoffmann | .bDeviceClass = 0xe0, /* Wireless */ |
223 | 4696425c | Gerd Hoffmann | .bDeviceSubClass = 0x01, /* Radio Frequency */ |
224 | 4696425c | Gerd Hoffmann | .bDeviceProtocol = 0x01, /* Bluetooth */ |
225 | 4696425c | Gerd Hoffmann | .bMaxPacketSize0 = 64,
|
226 | 4696425c | Gerd Hoffmann | .bNumConfigurations = 1,
|
227 | 4696425c | Gerd Hoffmann | .confs = (USBDescConfig[]) { |
228 | 4696425c | Gerd Hoffmann | { |
229 | 4696425c | Gerd Hoffmann | .bNumInterfaces = 2,
|
230 | 4696425c | Gerd Hoffmann | .bConfigurationValue = 1,
|
231 | 4696425c | Gerd Hoffmann | .bmAttributes = 0xc0,
|
232 | 4696425c | Gerd Hoffmann | .bMaxPower = 0,
|
233 | 4696425c | Gerd Hoffmann | .nif = ARRAY_SIZE(desc_iface_bluetooth), |
234 | 4696425c | Gerd Hoffmann | .ifs = desc_iface_bluetooth, |
235 | 4696425c | Gerd Hoffmann | }, |
236 | 4696425c | Gerd Hoffmann | }, |
237 | e6a6d5ab | balrog | }; |
238 | e6a6d5ab | balrog | |
239 | 4696425c | Gerd Hoffmann | static const USBDesc desc_bluetooth = { |
240 | 4696425c | Gerd Hoffmann | .id = { |
241 | 4696425c | Gerd Hoffmann | .idVendor = 0x0a12,
|
242 | 4696425c | Gerd Hoffmann | .idProduct = 0x0001,
|
243 | 4696425c | Gerd Hoffmann | .bcdDevice = 0x1958,
|
244 | 4696425c | Gerd Hoffmann | .iManufacturer = STR_MANUFACTURER, |
245 | 4696425c | Gerd Hoffmann | .iProduct = 0,
|
246 | 4696425c | Gerd Hoffmann | .iSerialNumber = STR_SERIALNUMBER, |
247 | 4696425c | Gerd Hoffmann | }, |
248 | 4696425c | Gerd Hoffmann | .full = &desc_device_bluetooth, |
249 | 4696425c | Gerd Hoffmann | .str = desc_strings, |
250 | e6a6d5ab | balrog | }; |
251 | e6a6d5ab | balrog | |
252 | e6a6d5ab | balrog | static void usb_bt_fifo_reset(struct usb_hci_in_fifo_s *fifo) |
253 | e6a6d5ab | balrog | { |
254 | e6a6d5ab | balrog | fifo->dstart = 0;
|
255 | e6a6d5ab | balrog | fifo->dlen = 0;
|
256 | e6a6d5ab | balrog | fifo->dsize = DFIFO_LEN_MASK + 1;
|
257 | e6a6d5ab | balrog | fifo->start = 0;
|
258 | e6a6d5ab | balrog | fifo->len = 0;
|
259 | e6a6d5ab | balrog | } |
260 | e6a6d5ab | balrog | |
261 | e6a6d5ab | balrog | static void usb_bt_fifo_enqueue(struct usb_hci_in_fifo_s *fifo, |
262 | e6a6d5ab | balrog | const uint8_t *data, int len) |
263 | e6a6d5ab | balrog | { |
264 | e6a6d5ab | balrog | int off = fifo->dstart + fifo->dlen;
|
265 | e6a6d5ab | balrog | uint8_t *buf; |
266 | e6a6d5ab | balrog | |
267 | e6a6d5ab | balrog | fifo->dlen += len; |
268 | e6a6d5ab | balrog | if (off <= DFIFO_LEN_MASK) {
|
269 | e6a6d5ab | balrog | if (off + len > DFIFO_LEN_MASK + 1 && |
270 | e6a6d5ab | balrog | (fifo->dsize = off + len) > (DFIFO_LEN_MASK + 1) * 2) { |
271 | e6a6d5ab | balrog | fprintf(stderr, "%s: can't alloc %i bytes\n", __FUNCTION__, len);
|
272 | e6a6d5ab | balrog | exit(-1);
|
273 | e6a6d5ab | balrog | } |
274 | e6a6d5ab | balrog | buf = fifo->data + off; |
275 | e6a6d5ab | balrog | } else {
|
276 | e6a6d5ab | balrog | if (fifo->dlen > fifo->dsize) {
|
277 | e6a6d5ab | balrog | fprintf(stderr, "%s: can't alloc %i bytes\n", __FUNCTION__, len);
|
278 | e6a6d5ab | balrog | exit(-1);
|
279 | e6a6d5ab | balrog | } |
280 | e6a6d5ab | balrog | buf = fifo->data + off - fifo->dsize; |
281 | e6a6d5ab | balrog | } |
282 | e6a6d5ab | balrog | |
283 | e6a6d5ab | balrog | off = (fifo->start + fifo->len ++) & CFIFO_LEN_MASK; |
284 | e6a6d5ab | balrog | fifo->fifo[off].data = memcpy(buf, data, len); |
285 | e6a6d5ab | balrog | fifo->fifo[off].len = len; |
286 | e6a6d5ab | balrog | } |
287 | e6a6d5ab | balrog | |
288 | e6a6d5ab | balrog | static inline int usb_bt_fifo_dequeue(struct usb_hci_in_fifo_s *fifo, |
289 | e6a6d5ab | balrog | USBPacket *p) |
290 | e6a6d5ab | balrog | { |
291 | e6a6d5ab | balrog | int len;
|
292 | e6a6d5ab | balrog | |
293 | e6a6d5ab | balrog | if (likely(!fifo->len))
|
294 | e6a6d5ab | balrog | return USB_RET_STALL;
|
295 | e6a6d5ab | balrog | |
296 | 4f4321c1 | Gerd Hoffmann | len = MIN(p->iov.size, fifo->fifo[fifo->start].len); |
297 | 4f4321c1 | Gerd Hoffmann | usb_packet_copy(p, fifo->fifo[fifo->start].data, len); |
298 | 4f4321c1 | Gerd Hoffmann | if (len == p->iov.size) {
|
299 | e6a6d5ab | balrog | fifo->fifo[fifo->start].len -= len; |
300 | e6a6d5ab | balrog | fifo->fifo[fifo->start].data += len; |
301 | e6a6d5ab | balrog | } else {
|
302 | e6a6d5ab | balrog | fifo->start ++; |
303 | e6a6d5ab | balrog | fifo->start &= CFIFO_LEN_MASK; |
304 | e6a6d5ab | balrog | fifo->len --; |
305 | e6a6d5ab | balrog | } |
306 | e6a6d5ab | balrog | |
307 | e6a6d5ab | balrog | fifo->dstart += len; |
308 | e6a6d5ab | balrog | fifo->dlen -= len; |
309 | e6a6d5ab | balrog | if (fifo->dstart >= fifo->dsize) {
|
310 | e6a6d5ab | balrog | fifo->dstart = 0;
|
311 | e6a6d5ab | balrog | fifo->dsize = DFIFO_LEN_MASK + 1;
|
312 | e6a6d5ab | balrog | } |
313 | e6a6d5ab | balrog | |
314 | e6a6d5ab | balrog | return len;
|
315 | e6a6d5ab | balrog | } |
316 | e6a6d5ab | balrog | |
317 | 86178a57 | Juan Quintela | static inline void usb_bt_fifo_out_enqueue(struct USBBtState *s, |
318 | e6a6d5ab | balrog | struct usb_hci_out_fifo_s *fifo,
|
319 | e6a6d5ab | balrog | void (*send)(struct HCIInfo *, const uint8_t *, int), |
320 | e6a6d5ab | balrog | int (*complete)(const uint8_t *, int), |
321 | 4f4321c1 | Gerd Hoffmann | USBPacket *p) |
322 | e6a6d5ab | balrog | { |
323 | 4f4321c1 | Gerd Hoffmann | usb_packet_copy(p, fifo->data + fifo->len, p->iov.size); |
324 | 4f4321c1 | Gerd Hoffmann | fifo->len += p->iov.size; |
325 | 4f4321c1 | Gerd Hoffmann | if (complete(fifo->data, fifo->len)) {
|
326 | 4f4321c1 | Gerd Hoffmann | send(s->hci, fifo->data, fifo->len); |
327 | 4f4321c1 | Gerd Hoffmann | fifo->len = 0;
|
328 | e6a6d5ab | balrog | } |
329 | e6a6d5ab | balrog | |
330 | e6a6d5ab | balrog | /* TODO: do we need to loop? */
|
331 | e6a6d5ab | balrog | } |
332 | e6a6d5ab | balrog | |
333 | e6a6d5ab | balrog | static int usb_bt_hci_cmd_complete(const uint8_t *data, int len) |
334 | e6a6d5ab | balrog | { |
335 | e6a6d5ab | balrog | len -= HCI_COMMAND_HDR_SIZE; |
336 | e6a6d5ab | balrog | return len >= 0 && |
337 | e6a6d5ab | balrog | len >= ((struct hci_command_hdr *) data)->plen;
|
338 | e6a6d5ab | balrog | } |
339 | e6a6d5ab | balrog | |
340 | e6a6d5ab | balrog | static int usb_bt_hci_acl_complete(const uint8_t *data, int len) |
341 | e6a6d5ab | balrog | { |
342 | e6a6d5ab | balrog | len -= HCI_ACL_HDR_SIZE; |
343 | e6a6d5ab | balrog | return len >= 0 && |
344 | e6a6d5ab | balrog | len >= le16_to_cpu(((struct hci_acl_hdr *) data)->dlen);
|
345 | e6a6d5ab | balrog | } |
346 | e6a6d5ab | balrog | |
347 | e6a6d5ab | balrog | static int usb_bt_hci_sco_complete(const uint8_t *data, int len) |
348 | e6a6d5ab | balrog | { |
349 | e6a6d5ab | balrog | len -= HCI_SCO_HDR_SIZE; |
350 | e6a6d5ab | balrog | return len >= 0 && |
351 | e6a6d5ab | balrog | len >= ((struct hci_sco_hdr *) data)->dlen;
|
352 | e6a6d5ab | balrog | } |
353 | e6a6d5ab | balrog | |
354 | e6a6d5ab | balrog | static void usb_bt_handle_reset(USBDevice *dev) |
355 | e6a6d5ab | balrog | { |
356 | e6a6d5ab | balrog | struct USBBtState *s = (struct USBBtState *) dev->opaque; |
357 | e6a6d5ab | balrog | |
358 | e6a6d5ab | balrog | usb_bt_fifo_reset(&s->evt); |
359 | e6a6d5ab | balrog | usb_bt_fifo_reset(&s->acl); |
360 | e6a6d5ab | balrog | usb_bt_fifo_reset(&s->sco); |
361 | e6a6d5ab | balrog | s->outcmd.len = 0;
|
362 | e6a6d5ab | balrog | s->outacl.len = 0;
|
363 | e6a6d5ab | balrog | s->outsco.len = 0;
|
364 | e6a6d5ab | balrog | } |
365 | e6a6d5ab | balrog | |
366 | 007fd62f | Hans de Goede | static int usb_bt_handle_control(USBDevice *dev, USBPacket *p, |
367 | 007fd62f | Hans de Goede | int request, int value, int index, int length, uint8_t *data) |
368 | e6a6d5ab | balrog | { |
369 | e6a6d5ab | balrog | struct USBBtState *s = (struct USBBtState *) dev->opaque; |
370 | 4696425c | Gerd Hoffmann | int ret;
|
371 | 4696425c | Gerd Hoffmann | |
372 | 007fd62f | Hans de Goede | ret = usb_desc_handle_control(dev, p, request, value, index, length, data); |
373 | 4696425c | Gerd Hoffmann | if (ret >= 0) { |
374 | a980a065 | Gerd Hoffmann | switch (request) {
|
375 | a980a065 | Gerd Hoffmann | case DeviceRequest | USB_REQ_GET_CONFIGURATION:
|
376 | a980a065 | Gerd Hoffmann | s->config = 0;
|
377 | a980a065 | Gerd Hoffmann | break;
|
378 | a980a065 | Gerd Hoffmann | case DeviceOutRequest | USB_REQ_SET_CONFIGURATION:
|
379 | a980a065 | Gerd Hoffmann | s->config = 1;
|
380 | a980a065 | Gerd Hoffmann | usb_bt_fifo_reset(&s->evt); |
381 | a980a065 | Gerd Hoffmann | usb_bt_fifo_reset(&s->acl); |
382 | a980a065 | Gerd Hoffmann | usb_bt_fifo_reset(&s->sco); |
383 | a980a065 | Gerd Hoffmann | break;
|
384 | a980a065 | Gerd Hoffmann | } |
385 | 4696425c | Gerd Hoffmann | return ret;
|
386 | 4696425c | Gerd Hoffmann | } |
387 | e6a6d5ab | balrog | |
388 | 4696425c | Gerd Hoffmann | ret = 0;
|
389 | e6a6d5ab | balrog | switch (request) {
|
390 | e6a6d5ab | balrog | case InterfaceRequest | USB_REQ_GET_STATUS:
|
391 | e6a6d5ab | balrog | case EndpointRequest | USB_REQ_GET_STATUS:
|
392 | ed5a83dd | Gerd Hoffmann | data[0] = 0x00; |
393 | e6a6d5ab | balrog | data[1] = 0x00; |
394 | e6a6d5ab | balrog | ret = 2;
|
395 | e6a6d5ab | balrog | break;
|
396 | e6a6d5ab | balrog | case InterfaceOutRequest | USB_REQ_CLEAR_FEATURE:
|
397 | e6a6d5ab | balrog | case EndpointOutRequest | USB_REQ_CLEAR_FEATURE:
|
398 | ed5a83dd | Gerd Hoffmann | goto fail;
|
399 | e6a6d5ab | balrog | case InterfaceOutRequest | USB_REQ_SET_FEATURE:
|
400 | e6a6d5ab | balrog | case EndpointOutRequest | USB_REQ_SET_FEATURE:
|
401 | ed5a83dd | Gerd Hoffmann | goto fail;
|
402 | e6a6d5ab | balrog | break;
|
403 | e6a6d5ab | balrog | case ((USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_DEVICE) << 8): |
404 | e6a6d5ab | balrog | if (s->config)
|
405 | e6a6d5ab | balrog | usb_bt_fifo_out_enqueue(s, &s->outcmd, s->hci->cmd_send, |
406 | 4f4321c1 | Gerd Hoffmann | usb_bt_hci_cmd_complete, p); |
407 | e6a6d5ab | balrog | break;
|
408 | e6a6d5ab | balrog | default:
|
409 | e6a6d5ab | balrog | fail:
|
410 | e6a6d5ab | balrog | ret = USB_RET_STALL; |
411 | e6a6d5ab | balrog | break;
|
412 | e6a6d5ab | balrog | } |
413 | e6a6d5ab | balrog | return ret;
|
414 | e6a6d5ab | balrog | } |
415 | e6a6d5ab | balrog | |
416 | e6a6d5ab | balrog | static int usb_bt_handle_data(USBDevice *dev, USBPacket *p) |
417 | e6a6d5ab | balrog | { |
418 | e6a6d5ab | balrog | struct USBBtState *s = (struct USBBtState *) dev->opaque; |
419 | e6a6d5ab | balrog | int ret = 0; |
420 | e6a6d5ab | balrog | |
421 | e6a6d5ab | balrog | if (!s->config)
|
422 | e6a6d5ab | balrog | goto fail;
|
423 | e6a6d5ab | balrog | |
424 | e6a6d5ab | balrog | switch (p->pid) {
|
425 | e6a6d5ab | balrog | case USB_TOKEN_IN:
|
426 | e6a6d5ab | balrog | switch (p->devep & 0xf) { |
427 | e6a6d5ab | balrog | case USB_EVT_EP:
|
428 | e6a6d5ab | balrog | ret = usb_bt_fifo_dequeue(&s->evt, p); |
429 | e6a6d5ab | balrog | break;
|
430 | e6a6d5ab | balrog | |
431 | e6a6d5ab | balrog | case USB_ACL_EP:
|
432 | e6a6d5ab | balrog | ret = usb_bt_fifo_dequeue(&s->acl, p); |
433 | e6a6d5ab | balrog | break;
|
434 | e6a6d5ab | balrog | |
435 | e6a6d5ab | balrog | case USB_SCO_EP:
|
436 | e6a6d5ab | balrog | ret = usb_bt_fifo_dequeue(&s->sco, p); |
437 | e6a6d5ab | balrog | break;
|
438 | e6a6d5ab | balrog | |
439 | e6a6d5ab | balrog | default:
|
440 | e6a6d5ab | balrog | goto fail;
|
441 | e6a6d5ab | balrog | } |
442 | e6a6d5ab | balrog | break;
|
443 | e6a6d5ab | balrog | |
444 | e6a6d5ab | balrog | case USB_TOKEN_OUT:
|
445 | e6a6d5ab | balrog | switch (p->devep & 0xf) { |
446 | e6a6d5ab | balrog | case USB_ACL_EP:
|
447 | e6a6d5ab | balrog | usb_bt_fifo_out_enqueue(s, &s->outacl, s->hci->acl_send, |
448 | 4f4321c1 | Gerd Hoffmann | usb_bt_hci_acl_complete, p); |
449 | e6a6d5ab | balrog | break;
|
450 | e6a6d5ab | balrog | |
451 | e6a6d5ab | balrog | case USB_SCO_EP:
|
452 | e6a6d5ab | balrog | usb_bt_fifo_out_enqueue(s, &s->outsco, s->hci->sco_send, |
453 | 4f4321c1 | Gerd Hoffmann | usb_bt_hci_sco_complete, p); |
454 | e6a6d5ab | balrog | break;
|
455 | e6a6d5ab | balrog | |
456 | e6a6d5ab | balrog | default:
|
457 | e6a6d5ab | balrog | goto fail;
|
458 | e6a6d5ab | balrog | } |
459 | e6a6d5ab | balrog | break;
|
460 | e6a6d5ab | balrog | |
461 | e6a6d5ab | balrog | default:
|
462 | e6a6d5ab | balrog | fail:
|
463 | e6a6d5ab | balrog | ret = USB_RET_STALL; |
464 | e6a6d5ab | balrog | break;
|
465 | e6a6d5ab | balrog | } |
466 | e6a6d5ab | balrog | |
467 | e6a6d5ab | balrog | return ret;
|
468 | e6a6d5ab | balrog | } |
469 | e6a6d5ab | balrog | |
470 | e6a6d5ab | balrog | static void usb_bt_out_hci_packet_event(void *opaque, |
471 | e6a6d5ab | balrog | const uint8_t *data, int len) |
472 | e6a6d5ab | balrog | { |
473 | e6a6d5ab | balrog | struct USBBtState *s = (struct USBBtState *) opaque; |
474 | e6a6d5ab | balrog | |
475 | e6a6d5ab | balrog | usb_bt_fifo_enqueue(&s->evt, data, len); |
476 | e6a6d5ab | balrog | } |
477 | e6a6d5ab | balrog | |
478 | e6a6d5ab | balrog | static void usb_bt_out_hci_packet_acl(void *opaque, |
479 | e6a6d5ab | balrog | const uint8_t *data, int len) |
480 | e6a6d5ab | balrog | { |
481 | e6a6d5ab | balrog | struct USBBtState *s = (struct USBBtState *) opaque; |
482 | e6a6d5ab | balrog | |
483 | e6a6d5ab | balrog | usb_bt_fifo_enqueue(&s->acl, data, len); |
484 | e6a6d5ab | balrog | } |
485 | e6a6d5ab | balrog | |
486 | e6a6d5ab | balrog | static void usb_bt_handle_destroy(USBDevice *dev) |
487 | e6a6d5ab | balrog | { |
488 | e6a6d5ab | balrog | struct USBBtState *s = (struct USBBtState *) dev->opaque; |
489 | e6a6d5ab | balrog | |
490 | 511d2b14 | blueswir1 | s->hci->opaque = NULL;
|
491 | 511d2b14 | blueswir1 | s->hci->evt_recv = NULL;
|
492 | 511d2b14 | blueswir1 | s->hci->acl_recv = NULL;
|
493 | e6a6d5ab | balrog | } |
494 | e6a6d5ab | balrog | |
495 | 806b6024 | Gerd Hoffmann | static int usb_bt_initfn(USBDevice *dev) |
496 | 806b6024 | Gerd Hoffmann | { |
497 | a980a065 | Gerd Hoffmann | usb_desc_init(dev); |
498 | 806b6024 | Gerd Hoffmann | return 0; |
499 | 806b6024 | Gerd Hoffmann | } |
500 | 806b6024 | Gerd Hoffmann | |
501 | e6a6d5ab | balrog | USBDevice *usb_bt_init(HCIInfo *hci) |
502 | e6a6d5ab | balrog | { |
503 | 806b6024 | Gerd Hoffmann | USBDevice *dev; |
504 | e6a6d5ab | balrog | struct USBBtState *s;
|
505 | e6a6d5ab | balrog | |
506 | 2d564691 | balrog | if (!hci)
|
507 | 2d564691 | balrog | return NULL; |
508 | 556cd098 | Markus Armbruster | dev = usb_create_simple(NULL /* FIXME */, "usb-bt-dongle"); |
509 | 2af2a1b8 | Gerd Hoffmann | if (!dev) {
|
510 | 2af2a1b8 | Gerd Hoffmann | return NULL; |
511 | 2af2a1b8 | Gerd Hoffmann | } |
512 | 806b6024 | Gerd Hoffmann | s = DO_UPCAST(struct USBBtState, dev, dev);
|
513 | e6a6d5ab | balrog | s->dev.opaque = s; |
514 | e6a6d5ab | balrog | |
515 | e6a6d5ab | balrog | s->hci = hci; |
516 | e6a6d5ab | balrog | s->hci->opaque = s; |
517 | e6a6d5ab | balrog | s->hci->evt_recv = usb_bt_out_hci_packet_event; |
518 | e6a6d5ab | balrog | s->hci->acl_recv = usb_bt_out_hci_packet_acl; |
519 | e6a6d5ab | balrog | |
520 | e6a6d5ab | balrog | usb_bt_handle_reset(&s->dev); |
521 | e6a6d5ab | balrog | |
522 | 806b6024 | Gerd Hoffmann | return dev;
|
523 | 806b6024 | Gerd Hoffmann | } |
524 | 806b6024 | Gerd Hoffmann | |
525 | 2474e505 | Gerd Hoffmann | static const VMStateDescription vmstate_usb_bt = { |
526 | 2474e505 | Gerd Hoffmann | .name = "usb-bt",
|
527 | 2474e505 | Gerd Hoffmann | .unmigratable = 1,
|
528 | 2474e505 | Gerd Hoffmann | }; |
529 | 2474e505 | Gerd Hoffmann | |
530 | 62aed765 | Anthony Liguori | static void usb_bt_class_initfn(ObjectClass *klass, void *data) |
531 | 62aed765 | Anthony Liguori | { |
532 | 39bffca2 | Anthony Liguori | DeviceClass *dc = DEVICE_CLASS(klass); |
533 | 62aed765 | Anthony Liguori | USBDeviceClass *uc = USB_DEVICE_CLASS(klass); |
534 | 62aed765 | Anthony Liguori | |
535 | 62aed765 | Anthony Liguori | uc->init = usb_bt_initfn; |
536 | 62aed765 | Anthony Liguori | uc->product_desc = "QEMU BT dongle";
|
537 | 62aed765 | Anthony Liguori | uc->usb_desc = &desc_bluetooth; |
538 | 62aed765 | Anthony Liguori | uc->handle_packet = usb_generic_handle_packet; |
539 | 62aed765 | Anthony Liguori | uc->handle_reset = usb_bt_handle_reset; |
540 | 62aed765 | Anthony Liguori | uc->handle_control = usb_bt_handle_control; |
541 | 62aed765 | Anthony Liguori | uc->handle_data = usb_bt_handle_data; |
542 | 62aed765 | Anthony Liguori | uc->handle_destroy = usb_bt_handle_destroy; |
543 | 39bffca2 | Anthony Liguori | dc->vmsd = &vmstate_usb_bt; |
544 | 62aed765 | Anthony Liguori | } |
545 | 62aed765 | Anthony Liguori | |
546 | 39bffca2 | Anthony Liguori | static TypeInfo bt_info = {
|
547 | 39bffca2 | Anthony Liguori | .name = "usb-bt-dongle",
|
548 | 39bffca2 | Anthony Liguori | .parent = TYPE_USB_DEVICE, |
549 | 39bffca2 | Anthony Liguori | .instance_size = sizeof(struct USBBtState), |
550 | 39bffca2 | Anthony Liguori | .class_init = usb_bt_class_initfn, |
551 | 806b6024 | Gerd Hoffmann | }; |
552 | 806b6024 | Gerd Hoffmann | |
553 | 806b6024 | Gerd Hoffmann | static void usb_bt_register_devices(void) |
554 | 806b6024 | Gerd Hoffmann | { |
555 | 39bffca2 | Anthony Liguori | type_register_static(&bt_info); |
556 | e6a6d5ab | balrog | } |
557 | 806b6024 | Gerd Hoffmann | device_init(usb_bt_register_devices) |