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