← Back to branch summary

~jderose/ubuntu/raring/qemu/vde-again

« back to all changes in this revision

Viewing changes to hw/usb-serial.c

  • Committer: Bazaar Package Importer
  • Author(s): Aurelien Jarno, Aurelien Jarno
  • Date: 2009-03-22 10:13:17 UTC
  • mfrom: (1.2.1 upstream) (6.1.1 sid)
  • Revision ID: james.westby@ubuntu.com-20090322101317-iigjtnu5qil35dtb
Tags: 0.10.1-1
http://bugs.debian.org/501400
[ Aurelien Jarno ]
* New upstream stable release:
  - patches/80_stable-branch.patch: remove.
* debian/control: 
  - Remove depends on proll.
  - Move depends on device-tree-compiler to build-depends.
  - Bump Standards-Version to 3.8.1 (no changes).
* patches/82_qemu-img_decimal.patch: new patch from upstream to make
  qemu-img accept sizes with decimal values (closes: bug#501400).

Show diffs side-by-side

added added

removed removed

Lines of Context:
hw/usb-serial.c
 
1
/*
 
2
 * FTDI FT232BM Device emulation
 
3
 *
 
4
 * Copyright (c) 2006 CodeSourcery.
 
5
 * Copyright (c) 2008 Samuel Thibault <samuel.thibault@ens-lyon.org>
 
6
 * Written by Paul Brook, reused for FTDI by Samuel Thibault
 
7
 *
 
8
 * This code is licenced under the LGPL.
 
9
 */
 
10
 
 
11
#include "qemu-common.h"
 
12
#include "usb.h"
 
13
#include "qemu-char.h"
 
14
 
 
15
//#define DEBUG_Serial
 
16
 
 
17
#ifdef DEBUG_Serial
 
18
#define DPRINTF(fmt, args...) \
 
19
do { printf("usb-serial: " fmt , ##args); } while (0)
 
20
#else
 
21
#define DPRINTF(fmt, args...) do {} while(0)
 
22
#endif
 
23
 
 
24
#define RECV_BUF 384
 
25
 
 
26
/* Commands */
 
27
#define FTDI_RESET              0
 
28
#define FTDI_SET_MDM_CTRL       1
 
29
#define FTDI_SET_FLOW_CTRL      2
 
30
#define FTDI_SET_BAUD           3
 
31
#define FTDI_SET_DATA           4
 
32
#define FTDI_GET_MDM_ST         5
 
33
#define FTDI_SET_EVENT_CHR      6
 
34
#define FTDI_SET_ERROR_CHR      7
 
35
#define FTDI_SET_LATENCY        9
 
36
#define FTDI_GET_LATENCY        10
 
37
 
 
38
#define DeviceOutVendor ((USB_DIR_OUT|USB_TYPE_VENDOR|USB_RECIP_DEVICE)<<8)
 
39
#define DeviceInVendor  ((USB_DIR_IN |USB_TYPE_VENDOR|USB_RECIP_DEVICE)<<8)
 
40
 
 
41
/* RESET */
 
42
 
 
43
#define FTDI_RESET_SIO  0
 
44
#define FTDI_RESET_RX   1
 
45
#define FTDI_RESET_TX   2
 
46
 
 
47
/* SET_MDM_CTRL */
 
48
 
 
49
#define FTDI_DTR        1
 
50
#define FTDI_SET_DTR    (FTDI_DTR << 8)
 
51
#define FTDI_RTS        2
 
52
#define FTDI_SET_RTS    (FTDI_RTS << 8)
 
53
 
 
54
/* SET_FLOW_CTRL */
 
55
 
 
56
#define FTDI_RTS_CTS_HS         1
 
57
#define FTDI_DTR_DSR_HS         2
 
58
#define FTDI_XON_XOFF_HS        4
 
59
 
 
60
/* SET_DATA */
 
61
 
 
62
#define FTDI_PARITY     (0x7 << 8)
 
63
#define FTDI_ODD        (0x1 << 8)
 
64
#define FTDI_EVEN       (0x2 << 8)
 
65
#define FTDI_MARK       (0x3 << 8)
 
66
#define FTDI_SPACE      (0x4 << 8)
 
67
 
 
68
#define FTDI_STOP       (0x3 << 11)
 
69
#define FTDI_STOP1      (0x0 << 11)
 
70
#define FTDI_STOP15     (0x1 << 11)
 
71
#define FTDI_STOP2      (0x2 << 11)
 
72
 
 
73
/* GET_MDM_ST */
 
74
/* TODO: should be sent every 40ms */
 
75
#define FTDI_CTS  (1<<4)        // CTS line status
 
76
#define FTDI_DSR  (1<<5)        // DSR line status
 
77
#define FTDI_RI   (1<<6)        // RI line status
 
78
#define FTDI_RLSD (1<<7)        // Receive Line Signal Detect
 
79
 
 
80
/* Status */
 
81
 
 
82
#define FTDI_DR   (1<<0)        // Data Ready
 
83
#define FTDI_OE   (1<<1)        // Overrun Err
 
84
#define FTDI_PE   (1<<2)        // Parity Err
 
85
#define FTDI_FE   (1<<3)        // Framing Err
 
86
#define FTDI_BI   (1<<4)        // Break Interrupt
 
87
#define FTDI_THRE (1<<5)        // Transmitter Holding Register
 
88
#define FTDI_TEMT (1<<6)        // Transmitter Empty
 
89
#define FTDI_FIFO (1<<7)        // Error in FIFO
 
90
 
 
91
typedef struct {
 
92
    USBDevice dev;
 
93
    uint16_t vendorid;
 
94
    uint16_t productid;
 
95
    uint8_t recv_buf[RECV_BUF];
 
96
    uint16_t recv_ptr;
 
97
    uint16_t recv_used;
 
98
    uint8_t event_chr;
 
99
    uint8_t error_chr;
 
100
    uint8_t event_trigger;
 
101
    QEMUSerialSetParams params;
 
102
    int latency;        /* ms */
 
103
    CharDriverState *cs;
 
104
} USBSerialState;
 
105
 
 
106
static const uint8_t qemu_serial_dev_descriptor[] = {
 
107
        0x12,       /*  u8 bLength; */
 
108
        0x01,       /*  u8 bDescriptorType; Device */
 
109
        0x00, 0x02, /*  u16 bcdUSB; v2.0 */
 
110
 
 
111
        0x00,       /*  u8  bDeviceClass; */
 
112
        0x00,       /*  u8  bDeviceSubClass; */
 
113
        0x00,       /*  u8  bDeviceProtocol; [ low/full speeds only ] */
 
114
        0x08,       /*  u8  bMaxPacketSize0; 8 Bytes */
 
115
 
 
116
        /* Vendor and product id are arbitrary.  */
 
117
        0x03, 0x04, /*  u16 idVendor; */
 
118
        0x00, 0xFF, /*  u16 idProduct; */
 
119
        0x00, 0x04, /*  u16 bcdDevice */
 
120
 
 
121
        0x01,       /*  u8  iManufacturer; */
 
122
        0x02,       /*  u8  iProduct; */
 
123
        0x03,       /*  u8  iSerialNumber; */
 
124
        0x01        /*  u8  bNumConfigurations; */
 
125
};
 
126
 
 
127
static const uint8_t qemu_serial_config_descriptor[] = {
 
128
 
 
129
        /* one configuration */
 
130
        0x09,       /*  u8  bLength; */
 
131
        0x02,       /*  u8  bDescriptorType; Configuration */
 
132
        0x20, 0x00, /*  u16 wTotalLength; */
 
133
        0x01,       /*  u8  bNumInterfaces; (1) */
 
134
        0x01,       /*  u8  bConfigurationValue; */
 
135
        0x00,       /*  u8  iConfiguration; */
 
136
        0x80,       /*  u8  bmAttributes;
 
137
                                 Bit 7: must be set,
 
138
                                     6: Self-powered,
 
139
                                     5: Remote wakeup,
 
140
                                     4..0: resvd */
 
141
        100/2,       /*  u8  MaxPower; */
 
142
 
 
143
        /* one interface */
 
144
        0x09,       /*  u8  if_bLength; */
 
145
        0x04,       /*  u8  if_bDescriptorType; Interface */
 
146
        0x00,       /*  u8  if_bInterfaceNumber; */
 
147
        0x00,       /*  u8  if_bAlternateSetting; */
 
148
        0x02,       /*  u8  if_bNumEndpoints; */
 
149
        0xff,       /*  u8  if_bInterfaceClass; Vendor Specific */
 
150
        0xff,       /*  u8  if_bInterfaceSubClass; Vendor Specific */
 
151
        0xff,       /*  u8  if_bInterfaceProtocol; Vendor Specific */
 
152
        0x02,       /*  u8  if_iInterface; */
 
153
 
 
154
        /* Bulk-In endpoint */
 
155
        0x07,       /*  u8  ep_bLength; */
 
156
        0x05,       /*  u8  ep_bDescriptorType; Endpoint */
 
157
        0x81,       /*  u8  ep_bEndpointAddress; IN Endpoint 1 */
 
158
        0x02,       /*  u8  ep_bmAttributes; Bulk */
 
159
        0x40, 0x00, /*  u16 ep_wMaxPacketSize; */
 
160
        0x00,       /*  u8  ep_bInterval; */
 
161
 
 
162
        /* Bulk-Out endpoint */
 
163
        0x07,       /*  u8  ep_bLength; */
 
164
        0x05,       /*  u8  ep_bDescriptorType; Endpoint */
 
165
        0x02,       /*  u8  ep_bEndpointAddress; OUT Endpoint 2 */
 
166
        0x02,       /*  u8  ep_bmAttributes; Bulk */
 
167
        0x40, 0x00, /*  u16 ep_wMaxPacketSize; */
 
168
        0x00        /*  u8  ep_bInterval; */
 
169
};
 
170
 
 
171
static void usb_serial_reset(USBSerialState *s)
 
172
{
 
173
    /* TODO: Set flow control to none */
 
174
    s->event_chr = 0x0d;
 
175
    s->event_trigger = 0;
 
176
    s->recv_ptr = 0;
 
177
    s->recv_used = 0;
 
178
    /* TODO: purge in char driver */
 
179
}
 
180
 
 
181
static void usb_serial_handle_reset(USBDevice *dev)
 
182
{
 
183
    USBSerialState *s = (USBSerialState *)dev;
 
184
 
 
185
    DPRINTF("Reset\n");
 
186
 
 
187
    usb_serial_reset(s);
 
188
    /* TODO: Reset char device, send BREAK? */
 
189
}
 
190
 
 
191
static uint8_t usb_get_modem_lines(USBSerialState *s)
 
192
{
 
193
    int flags;
 
194
    uint8_t ret;
 
195
 
 
196
    if (qemu_chr_ioctl(s->cs, CHR_IOCTL_SERIAL_GET_TIOCM, &flags) == -ENOTSUP)
 
197
        return FTDI_CTS|FTDI_DSR|FTDI_RLSD;
 
198
 
 
199
    ret = 0;
 
200
    if (flags & CHR_TIOCM_CTS)
 
201
        ret |= FTDI_CTS;
 
202
    if (flags & CHR_TIOCM_DSR)
 
203
        ret |= FTDI_DSR;
 
204
    if (flags & CHR_TIOCM_RI)
 
205
        ret |= FTDI_RI;
 
206
    if (flags & CHR_TIOCM_CAR)
 
207
        ret |= FTDI_RLSD;
 
208
 
 
209
    return ret;
 
210
}
 
211
 
 
212
static int usb_serial_handle_control(USBDevice *dev, int request, int value,
 
213
                                  int index, int length, uint8_t *data)
 
214
{
 
215
    USBSerialState *s = (USBSerialState *)dev;
 
216
    int ret = 0;
 
217
 
 
218
    //DPRINTF("got control %x, value %x\n",request, value);
 
219
    switch (request) {
 
220
    case DeviceRequest | USB_REQ_GET_STATUS:
 
221
        data[0] = (0 << USB_DEVICE_SELF_POWERED) |
 
222
            (dev->remote_wakeup << USB_DEVICE_REMOTE_WAKEUP);
 
223
        data[1] = 0x00;
 
224
        ret = 2;
 
225
        break;
 
226
    case DeviceOutRequest | USB_REQ_CLEAR_FEATURE:
 
227
        if (value == USB_DEVICE_REMOTE_WAKEUP) {
 
228
            dev->remote_wakeup = 0;
 
229
        } else {
 
230
            goto fail;
 
231
        }
 
232
        ret = 0;
 
233
        break;
 
234
    case DeviceOutRequest | USB_REQ_SET_FEATURE:
 
235
        if (value == USB_DEVICE_REMOTE_WAKEUP) {
 
236
            dev->remote_wakeup = 1;
 
237
        } else {
 
238
            goto fail;
 
239
        }
 
240
        ret = 0;
 
241
        break;
 
242
    case DeviceOutRequest | USB_REQ_SET_ADDRESS:
 
243
        dev->addr = value;
 
244
        ret = 0;
 
245
        break;
 
246
    case DeviceRequest | USB_REQ_GET_DESCRIPTOR:
 
247
        switch(value >> 8) {
 
248
        case USB_DT_DEVICE:
 
249
            memcpy(data, qemu_serial_dev_descriptor,
 
250
                   sizeof(qemu_serial_dev_descriptor));
 
251
            data[8] = s->vendorid & 0xff;
 
252
            data[9] = ((s->vendorid) >> 8) & 0xff;
 
253
            data[10] = s->productid & 0xff;
 
254
            data[11] = ((s->productid) >> 8) & 0xff;
 
255
            ret = sizeof(qemu_serial_dev_descriptor);
 
256
            break;
 
257
        case USB_DT_CONFIG:
 
258
            memcpy(data, qemu_serial_config_descriptor,
 
259
                   sizeof(qemu_serial_config_descriptor));
 
260
            ret = sizeof(qemu_serial_config_descriptor);
 
261
            break;
 
262
        case USB_DT_STRING:
 
263
            switch(value & 0xff) {
 
264
            case 0:
 
265
                /* language ids */
 
266
                data[0] = 4;
 
267
                data[1] = 3;
 
268
                data[2] = 0x09;
 
269
                data[3] = 0x04;
 
270
                ret = 4;
 
271
                break;
 
272
            case 1:
 
273
                /* vendor description */
 
274
                ret = set_usb_string(data, "QEMU " QEMU_VERSION);
 
275
                break;
 
276
            case 2:
 
277
                /* product description */
 
278
                ret = set_usb_string(data, "QEMU USB SERIAL");
 
279
                break;
 
280
            case 3:
 
281
                /* serial number */
 
282
                ret = set_usb_string(data, "1");
 
283
                break;
 
284
            default:
 
285
                goto fail;
 
286
            }
 
287
            break;
 
288
        default:
 
289
            goto fail;
 
290
        }
 
291
        break;
 
292
    case DeviceRequest | USB_REQ_GET_CONFIGURATION:
 
293
        data[0] = 1;
 
294
        ret = 1;
 
295
        break;
 
296
    case DeviceOutRequest | USB_REQ_SET_CONFIGURATION:
 
297
        ret = 0;
 
298
        break;
 
299
    case DeviceRequest | USB_REQ_GET_INTERFACE:
 
300
        data[0] = 0;
 
301
        ret = 1;
 
302
        break;
 
303
    case InterfaceOutRequest | USB_REQ_SET_INTERFACE:
 
304
        ret = 0;
 
305
        break;
 
306
    case EndpointOutRequest | USB_REQ_CLEAR_FEATURE:
 
307
        ret = 0;
 
308
        break;
 
309
 
 
310
        /* Class specific requests.  */
 
311
    case DeviceOutVendor | FTDI_RESET:
 
312
        switch (value) {
 
313
        case FTDI_RESET_SIO:
 
314
            usb_serial_reset(s);
 
315
            break;
 
316
        case FTDI_RESET_RX:
 
317
            s->recv_ptr = 0;
 
318
            s->recv_used = 0;
 
319
            /* TODO: purge from char device */
 
320
            break;
 
321
        case FTDI_RESET_TX:
 
322
            /* TODO: purge from char device */
 
323
            break;
 
324
        }
 
325
        break;
 
326
    case DeviceOutVendor | FTDI_SET_MDM_CTRL:
 
327
    {
 
328
        static int flags;
 
329
        qemu_chr_ioctl(s->cs,CHR_IOCTL_SERIAL_GET_TIOCM, &flags);
 
330
        if (value & FTDI_SET_RTS) {
 
331
            if (value & FTDI_RTS)
 
332
                flags |= CHR_TIOCM_RTS;
 
333
            else
 
334
                flags &= ~CHR_TIOCM_RTS;
 
335
        }
 
336
        if (value & FTDI_SET_DTR) {
 
337
            if (value & FTDI_DTR)
 
338
                flags |= CHR_TIOCM_DTR;
 
339
            else
 
340
                flags &= ~CHR_TIOCM_DTR;
 
341
        }
 
342
        qemu_chr_ioctl(s->cs,CHR_IOCTL_SERIAL_SET_TIOCM, &flags);
 
343
        break;
 
344
    }
 
345
    case DeviceOutVendor | FTDI_SET_FLOW_CTRL:
 
346
        /* TODO: ioctl */
 
347
        break;
 
348
    case DeviceOutVendor | FTDI_SET_BAUD: {
 
349
        static const int subdivisors8[8] = { 0, 4, 2, 1, 3, 5, 6, 7 };
 
350
        int subdivisor8 = subdivisors8[((value & 0xc000) >> 14)
 
351
                                     | ((index & 1) << 2)];
 
352
        int divisor = value & 0x3fff;
 
353
 
 
354
        /* chip special cases */
 
355
        if (divisor == 1 && subdivisor8 == 0)
 
356
            subdivisor8 = 4;
 
357
        if (divisor == 0 && subdivisor8 == 0)
 
358
            divisor = 1;
 
359
 
 
360
        s->params.speed = (48000000 / 2) / (8 * divisor + subdivisor8);
 
361
        qemu_chr_ioctl(s->cs, CHR_IOCTL_SERIAL_SET_PARAMS, &s->params);
 
362
        break;
 
363
    }
 
364
    case DeviceOutVendor | FTDI_SET_DATA:
 
365
        switch (value & FTDI_PARITY) {
 
366
            case 0:
 
367
                s->params.parity = 'N';
 
368
                break;
 
369
            case FTDI_ODD:
 
370
                s->params.parity = 'O';
 
371
                break;
 
372
            case FTDI_EVEN:
 
373
                s->params.parity = 'E';
 
374
                break;
 
375
            default:
 
376
                DPRINTF("unsupported parity %d\n", value & FTDI_PARITY);
 
377
                goto fail;
 
378
        }
 
379
        switch (value & FTDI_STOP) {
 
380
            case FTDI_STOP1:
 
381
                s->params.stop_bits = 1;
 
382
                break;
 
383
            case FTDI_STOP2:
 
384
                s->params.stop_bits = 2;
 
385
                break;
 
386
            default:
 
387
                DPRINTF("unsupported stop bits %d\n", value & FTDI_STOP);
 
388
                goto fail;
 
389
        }
 
390
        qemu_chr_ioctl(s->cs, CHR_IOCTL_SERIAL_SET_PARAMS, &s->params);
 
391
        /* TODO: TX ON/OFF */
 
392
        break;
 
393
    case DeviceInVendor | FTDI_GET_MDM_ST:
 
394
        data[0] = usb_get_modem_lines(s) | 1;
 
395
        data[1] = 0;
 
396
        ret = 2;
 
397
        break;
 
398
    case DeviceOutVendor | FTDI_SET_EVENT_CHR:
 
399
        /* TODO: handle it */
 
400
        s->event_chr = value;
 
401
        break;
 
402
    case DeviceOutVendor | FTDI_SET_ERROR_CHR:
 
403
        /* TODO: handle it */
 
404
        s->error_chr = value;
 
405
        break;
 
406
    case DeviceOutVendor | FTDI_SET_LATENCY:
 
407
        s->latency = value;
 
408
        break;
 
409
    case DeviceInVendor | FTDI_GET_LATENCY:
 
410
        data[0] = s->latency;
 
411
        ret = 1;
 
412
        break;
 
413
    default:
 
414
    fail:
 
415
        DPRINTF("got unsupported/bogus control %x, value %x\n", request, value);
 
416
        ret = USB_RET_STALL;
 
417
        break;
 
418
    }
 
419
    return ret;
 
420
}
 
421
 
 
422
static int usb_serial_handle_data(USBDevice *dev, USBPacket *p)
 
423
{
 
424
    USBSerialState *s = (USBSerialState *)dev;
 
425
    int ret = 0;
 
426
    uint8_t devep = p->devep;
 
427
    uint8_t *data = p->data;
 
428
    int len = p->len;
 
429
    int first_len;
 
430
 
 
431
    switch (p->pid) {
 
432
    case USB_TOKEN_OUT:
 
433
        if (devep != 2)
 
434
            goto fail;
 
435
        qemu_chr_write(s->cs, data, len);
 
436
        break;
 
437
 
 
438
    case USB_TOKEN_IN:
 
439
        if (devep != 1)
 
440
            goto fail;
 
441
        first_len = RECV_BUF - s->recv_ptr;
 
442
        if (len <= 2) {
 
443
            ret = USB_RET_NAK;
 
444
            break;
 
445
        }
 
446
        *data++ = usb_get_modem_lines(s) | 1;
 
447
        /* We do not have the uart details */
 
448
        *data++ = 0;
 
449
        len -= 2;
 
450
        if (len > s->recv_used)
 
451
            len = s->recv_used;
 
452
        if (!len) {
 
453
            ret = USB_RET_NAK;
 
454
            break;
 
455
        }
 
456
        if (first_len > len)
 
457
            first_len = len;
 
458
        memcpy(data, s->recv_buf + s->recv_ptr, first_len);
 
459
        if (len > first_len)
 
460
            memcpy(data + first_len, s->recv_buf, len - first_len);
 
461
        s->recv_used -= len;
 
462
        s->recv_ptr = (s->recv_ptr + len) % RECV_BUF;
 
463
        ret = len + 2;
 
464
        break;
 
465
 
 
466
    default:
 
467
        DPRINTF("Bad token\n");
 
468
    fail:
 
469
        ret = USB_RET_STALL;
 
470
        break;
 
471
    }
 
472
 
 
473
    return ret;
 
474
}
 
475
 
 
476
static void usb_serial_handle_destroy(USBDevice *dev)
 
477
{
 
478
    USBSerialState *s = (USBSerialState *)dev;
 
479
 
 
480
    qemu_chr_close(s->cs);
 
481
    qemu_free(s);
 
482
}
 
483
 
 
484
static int usb_serial_can_read(void *opaque)
 
485
{
 
486
    USBSerialState *s = opaque;
 
487
    return RECV_BUF - s->recv_used;
 
488
}
 
489
 
 
490
static void usb_serial_read(void *opaque, const uint8_t *buf, int size)
 
491
{
 
492
    USBSerialState *s = opaque;
 
493
    int first_size = RECV_BUF - s->recv_ptr;
 
494
    if (first_size > size)
 
495
        first_size = size;
 
496
    memcpy(s->recv_buf + s->recv_ptr + s->recv_used, buf, first_size);
 
497
    if (size > first_size)
 
498
        memcpy(s->recv_buf, buf + first_size, size - first_size);
 
499
    s->recv_used += size;
 
500
}
 
501
 
 
502
static void usb_serial_event(void *opaque, int event)
 
503
{
 
504
    USBSerialState *s = opaque;
 
505
 
 
506
    switch (event) {
 
507
        case CHR_EVENT_BREAK:
 
508
            /* TODO: Send Break to USB */
 
509
            break;
 
510
        case CHR_EVENT_FOCUS:
 
511
            break;
 
512
        case CHR_EVENT_RESET:
 
513
            usb_serial_reset(s);
 
514
            /* TODO: Reset USB port */
 
515
            break;
 
516
    }
 
517
}
 
518
 
 
519
USBDevice *usb_serial_init(const char *filename)
 
520
{
 
521
    USBSerialState *s;
 
522
    CharDriverState *cdrv;
 
523
    unsigned short vendorid = 0x0403, productid = 0x6001;
 
524
    char label[32];
 
525
    static int index;
 
526
 
 
527
    while (*filename && *filename != ':') {
 
528
        const char *p;
 
529
        char *e;
 
530
        if (strstart(filename, "vendorid=", &p)) {
 
531
            vendorid = strtol(p, &e, 16);
 
532
            if (e == p || (*e && *e != ',' && *e != ':')) {
 
533
                printf("bogus vendor ID %s\n", p);
 
534
                return NULL;
 
535
            }
 
536
            filename = e;
 
537
        } else if (strstart(filename, "productid=", &p)) {
 
538
            productid = strtol(p, &e, 16);
 
539
            if (e == p || (*e && *e != ',' && *e != ':')) {
 
540
                printf("bogus product ID %s\n", p);
 
541
                return NULL;
 
542
            }
 
543
            filename = e;
 
544
        } else {
 
545
            printf("unrecognized serial USB option %s\n", filename);
 
546
            return NULL;
 
547
        }
 
548
        while(*filename == ',')
 
549
            filename++;
 
550
    }
 
551
    if (!*filename) {
 
552
        printf("character device specification needed\n");
 
553
        return NULL;
 
554
    }
 
555
    filename++;
 
556
    s = qemu_mallocz(sizeof(USBSerialState));
 
557
 
 
558
    snprintf(label, sizeof(label), "usbserial%d", index++);
 
559
    cdrv = qemu_chr_open(label, filename, NULL);
 
560
    if (!cdrv)
 
561
        goto fail;
 
562
    s->cs = cdrv;
 
563
    qemu_chr_add_handlers(cdrv, usb_serial_can_read, usb_serial_read, usb_serial_event, s);
 
564
 
 
565
    s->dev.speed = USB_SPEED_FULL;
 
566
    s->dev.handle_packet = usb_generic_handle_packet;
 
567
 
 
568
    s->dev.handle_reset = usb_serial_handle_reset;
 
569
    s->dev.handle_control = usb_serial_handle_control;
 
570
    s->dev.handle_data = usb_serial_handle_data;
 
571
    s->dev.handle_destroy = usb_serial_handle_destroy;
 
572
 
 
573
    s->vendorid = vendorid;
 
574
    s->productid = productid;
 
575
 
 
576
    snprintf(s->dev.devname, sizeof(s->dev.devname), "QEMU USB Serial(%.16s)",
 
577
             filename);
 
578
 
 
579
    usb_serial_handle_reset((USBDevice *)s);
 
580
    return (USBDevice *)s;
 
581
 fail:
 
582
    qemu_free(s);
 
583
    return NULL;
 
584
}