]> Git Repo - qemu.git/blame - hw/usb/dev-storage.c
hw/block/fdc: Implement tray status
[qemu.git] / hw / usb / dev-storage.c
CommitLineData
5fafdf24 1/*
2e5d83bb
PB
2 * USB Mass Storage Device emulation
3 *
4 * Copyright (c) 2006 CodeSourcery.
5 * Written by Paul Brook
6 *
8e31bf38 7 * This code is licensed under the LGPL.
2e5d83bb
PB
8 */
9
87ecb68b 10#include "qemu-common.h"
d49b6836 11#include "qemu/error-report.h"
1de7afc9
PB
12#include "qemu/option.h"
13#include "qemu/config-file.h"
f1ae32a1
GH
14#include "hw/usb.h"
15#include "hw/usb/desc.h"
0d09e41a 16#include "hw/scsi/scsi.h"
28ecbaee 17#include "ui/console.h"
83c9089e 18#include "monitor/monitor.h"
9c17d615 19#include "sysemu/sysemu.h"
fa1d36df 20#include "sysemu/block-backend.h"
9c17d615 21#include "sysemu/blockdev.h"
89f0762d 22#include "qapi/visitor.h"
2e5d83bb
PB
23
24//#define DEBUG_MSD
25
26#ifdef DEBUG_MSD
001faf32
BS
27#define DPRINTF(fmt, ...) \
28do { printf("usb-msd: " fmt , ## __VA_ARGS__); } while (0)
2e5d83bb 29#else
001faf32 30#define DPRINTF(fmt, ...) do {} while(0)
2e5d83bb
PB
31#endif
32
33/* USB requests. */
34#define MassStorageReset 0xff
35#define GetMaxLun 0xfe
36
37enum USBMSDMode {
38 USB_MSDM_CBW, /* Command Block. */
94843f66 39 USB_MSDM_DATAOUT, /* Transfer data to device. */
2e5d83bb
PB
40 USB_MSDM_DATAIN, /* Transfer data from device. */
41 USB_MSDM_CSW /* Command Status. */
42};
43
92a114f6
GH
44struct usb_msd_csw {
45 uint32_t sig;
46 uint32_t tag;
47 uint32_t residue;
48 uint8_t status;
49};
50
2e5d83bb
PB
51typedef struct {
52 USBDevice dev;
53 enum USBMSDMode mode;
1dc90367 54 uint32_t scsi_off;
a917d384 55 uint32_t scsi_len;
2e5d83bb 56 uint32_t data_len;
92a114f6 57 struct usb_msd_csw csw;
5c6c0e51 58 SCSIRequest *req;
ca9c39fa 59 SCSIBus bus;
34707333
GH
60 /* For async completion. */
61 USBPacket *packet;
62 /* usb-storage only */
428c149b 63 BlockConf conf;
6bb7b867 64 uint32_t removable;
89f0762d 65 SCSIDevice *scsi_dev;
2e5d83bb
PB
66} MSDState;
67
79e2590c
GA
68#define TYPE_USB_STORAGE "usb-storage-dev"
69#define USB_STORAGE_DEV(obj) OBJECT_CHECK(MSDState, (obj), TYPE_USB_STORAGE)
70
a917d384
PB
71struct usb_msd_cbw {
72 uint32_t sig;
73 uint32_t tag;
74 uint32_t data_len;
75 uint8_t flags;
76 uint8_t lun;
77 uint8_t cmd_len;
78 uint8_t cmd[16];
79};
80
81bfd2f2
GH
81enum {
82 STR_MANUFACTURER = 1,
83 STR_PRODUCT,
84 STR_SERIALNUMBER,
ca0c730d
GH
85 STR_CONFIG_FULL,
86 STR_CONFIG_HIGH,
79b40459 87 STR_CONFIG_SUPER,
2e5d83bb
PB
88};
89
81bfd2f2 90static const USBDescStrings desc_strings = {
93bfef4c 91 [STR_MANUFACTURER] = "QEMU",
81bfd2f2
GH
92 [STR_PRODUCT] = "QEMU USB HARDDRIVE",
93 [STR_SERIALNUMBER] = "1",
ca0c730d
GH
94 [STR_CONFIG_FULL] = "Full speed config (usb 1.1)",
95 [STR_CONFIG_HIGH] = "High speed config (usb 2.0)",
79b40459 96 [STR_CONFIG_SUPER] = "Super speed config (usb 3.0)",
81bfd2f2
GH
97};
98
ca0c730d 99static const USBDescIface desc_iface_full = {
81bfd2f2
GH
100 .bInterfaceNumber = 0,
101 .bNumEndpoints = 2,
102 .bInterfaceClass = USB_CLASS_MASS_STORAGE,
103 .bInterfaceSubClass = 0x06, /* SCSI */
104 .bInterfaceProtocol = 0x50, /* Bulk */
105 .eps = (USBDescEndpoint[]) {
106 {
107 .bEndpointAddress = USB_DIR_IN | 0x01,
108 .bmAttributes = USB_ENDPOINT_XFER_BULK,
109 .wMaxPacketSize = 64,
110 },{
111 .bEndpointAddress = USB_DIR_OUT | 0x02,
112 .bmAttributes = USB_ENDPOINT_XFER_BULK,
113 .wMaxPacketSize = 64,
114 },
115 }
116};
117
ca0c730d
GH
118static const USBDescDevice desc_device_full = {
119 .bcdUSB = 0x0200,
81bfd2f2
GH
120 .bMaxPacketSize0 = 8,
121 .bNumConfigurations = 1,
122 .confs = (USBDescConfig[]) {
123 {
124 .bNumInterfaces = 1,
125 .bConfigurationValue = 1,
ca0c730d 126 .iConfiguration = STR_CONFIG_FULL,
bd93976a 127 .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
add75088 128 .nif = 1,
ca0c730d
GH
129 .ifs = &desc_iface_full,
130 },
131 },
132};
133
134static const USBDescIface desc_iface_high = {
135 .bInterfaceNumber = 0,
136 .bNumEndpoints = 2,
137 .bInterfaceClass = USB_CLASS_MASS_STORAGE,
138 .bInterfaceSubClass = 0x06, /* SCSI */
139 .bInterfaceProtocol = 0x50, /* Bulk */
140 .eps = (USBDescEndpoint[]) {
141 {
142 .bEndpointAddress = USB_DIR_IN | 0x01,
143 .bmAttributes = USB_ENDPOINT_XFER_BULK,
144 .wMaxPacketSize = 512,
145 },{
146 .bEndpointAddress = USB_DIR_OUT | 0x02,
147 .bmAttributes = USB_ENDPOINT_XFER_BULK,
148 .wMaxPacketSize = 512,
149 },
150 }
151};
152
153static const USBDescDevice desc_device_high = {
154 .bcdUSB = 0x0200,
155 .bMaxPacketSize0 = 64,
156 .bNumConfigurations = 1,
157 .confs = (USBDescConfig[]) {
158 {
159 .bNumInterfaces = 1,
160 .bConfigurationValue = 1,
161 .iConfiguration = STR_CONFIG_HIGH,
bd93976a 162 .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
add75088 163 .nif = 1,
ca0c730d 164 .ifs = &desc_iface_high,
81bfd2f2
GH
165 },
166 },
167};
168
79b40459
GH
169static const USBDescIface desc_iface_super = {
170 .bInterfaceNumber = 0,
171 .bNumEndpoints = 2,
172 .bInterfaceClass = USB_CLASS_MASS_STORAGE,
173 .bInterfaceSubClass = 0x06, /* SCSI */
174 .bInterfaceProtocol = 0x50, /* Bulk */
175 .eps = (USBDescEndpoint[]) {
176 {
177 .bEndpointAddress = USB_DIR_IN | 0x01,
178 .bmAttributes = USB_ENDPOINT_XFER_BULK,
179 .wMaxPacketSize = 1024,
180 .bMaxBurst = 15,
181 },{
182 .bEndpointAddress = USB_DIR_OUT | 0x02,
183 .bmAttributes = USB_ENDPOINT_XFER_BULK,
184 .wMaxPacketSize = 1024,
185 .bMaxBurst = 15,
186 },
187 }
188};
189
190static const USBDescDevice desc_device_super = {
191 .bcdUSB = 0x0300,
192 .bMaxPacketSize0 = 9,
193 .bNumConfigurations = 1,
194 .confs = (USBDescConfig[]) {
195 {
196 .bNumInterfaces = 1,
197 .bConfigurationValue = 1,
198 .iConfiguration = STR_CONFIG_SUPER,
bd93976a 199 .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
79b40459
GH
200 .nif = 1,
201 .ifs = &desc_iface_super,
202 },
203 },
204};
205
81bfd2f2
GH
206static const USBDesc desc = {
207 .id = {
db80358a
RT
208 .idVendor = 0x46f4, /* CRC16() of "QEMU" */
209 .idProduct = 0x0001,
81bfd2f2
GH
210 .bcdDevice = 0,
211 .iManufacturer = STR_MANUFACTURER,
212 .iProduct = STR_PRODUCT,
213 .iSerialNumber = STR_SERIALNUMBER,
214 },
79b40459
GH
215 .full = &desc_device_full,
216 .high = &desc_device_high,
217 .super = &desc_device_super,
218 .str = desc_strings,
2e5d83bb
PB
219};
220
29c74f76 221static void usb_msd_copy_data(MSDState *s, USBPacket *p)
a917d384
PB
222{
223 uint32_t len;
9a77a0f5 224 len = p->iov.size - p->actual_length;
a917d384
PB
225 if (len > s->scsi_len)
226 len = s->scsi_len;
1dc90367 227 usb_packet_copy(p, scsi_req_get_buf(s->req) + s->scsi_off, len);
a917d384 228 s->scsi_len -= len;
1dc90367 229 s->scsi_off += len;
a917d384 230 s->data_len -= len;
fa7935c1 231 if (s->scsi_len == 0 || s->data_len == 0) {
ad3376cc 232 scsi_req_continue(s->req);
a917d384
PB
233 }
234}
235
ab4797ad 236static void usb_msd_send_status(MSDState *s, USBPacket *p)
a917d384 237{
ab4797ad 238 int len;
a917d384 239
e04da7c3 240 DPRINTF("Command status %d tag 0x%x, len %zd\n",
e2854bf3 241 s->csw.status, le32_to_cpu(s->csw.tag), p->iov.size);
92a114f6 242
e2854bf3 243 assert(s->csw.sig == cpu_to_le32(0x53425355));
92a114f6
GH
244 len = MIN(sizeof(s->csw), p->iov.size);
245 usb_packet_copy(p, &s->csw, len);
246 memset(&s->csw, 0, sizeof(s->csw));
a917d384
PB
247}
248
1e6ed80b
GH
249static void usb_msd_packet_complete(MSDState *s)
250{
251 USBPacket *p = s->packet;
252
253 /* Set s->packet to NULL before calling usb_packet_complete
254 because another request may be issued before
255 usb_packet_complete returns. */
256 DPRINTF("Packet complete %p\n", p);
257 s->packet = NULL;
258 usb_packet_complete(&s->dev, p);
259}
260
aba1f023 261static void usb_msd_transfer_data(SCSIRequest *req, uint32_t len)
2e5d83bb 262{
5c6c0e51 263 MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
a917d384 264 USBPacket *p = s->packet;
4d611c9a 265
ad3376cc 266 assert((s->mode == USB_MSDM_DATAOUT) == (req->cmd.mode == SCSI_XFER_TO_DEV));
aba1f023 267 s->scsi_len = len;
1dc90367 268 s->scsi_off = 0;
a917d384 269 if (p) {
29c74f76
GH
270 usb_msd_copy_data(s, p);
271 p = s->packet;
9a77a0f5
HG
272 if (p && p->actual_length == p->iov.size) {
273 p->status = USB_RET_SUCCESS; /* Clear previous ASYNC status */
1e6ed80b 274 usb_msd_packet_complete(s);
a917d384 275 }
4d611c9a 276 }
2e5d83bb
PB
277}
278
01e95455 279static void usb_msd_command_complete(SCSIRequest *req, uint32_t status, size_t resid)
c6df7102
PB
280{
281 MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
282 USBPacket *p = s->packet;
283
7b863f41 284 DPRINTF("Command complete %d tag 0x%x\n", status, req->tag);
92a114f6
GH
285
286 s->csw.sig = cpu_to_le32(0x53425355);
7b863f41 287 s->csw.tag = cpu_to_le32(req->tag);
0659879e 288 s->csw.residue = cpu_to_le32(s->data_len);
414c4604 289 s->csw.status = status != 0;
92a114f6 290
c6df7102
PB
291 if (s->packet) {
292 if (s->data_len == 0 && s->mode == USB_MSDM_DATAOUT) {
293 /* A deferred packet with no write data remaining must be
294 the status read packet. */
295 usb_msd_send_status(s, p);
296 s->mode = USB_MSDM_CBW;
54414218
GH
297 } else if (s->mode == USB_MSDM_CSW) {
298 usb_msd_send_status(s, p);
299 s->mode = USB_MSDM_CBW;
c6df7102
PB
300 } else {
301 if (s->data_len) {
9a77a0f5 302 int len = (p->iov.size - p->actual_length);
29c74f76
GH
303 usb_packet_skip(p, len);
304 s->data_len -= len;
c6df7102
PB
305 }
306 if (s->data_len == 0) {
307 s->mode = USB_MSDM_CSW;
308 }
309 }
9a77a0f5 310 p->status = USB_RET_SUCCESS; /* Clear previous ASYNC status */
1e6ed80b 311 usb_msd_packet_complete(s);
c6df7102
PB
312 } else if (s->data_len == 0) {
313 s->mode = USB_MSDM_CSW;
314 }
315 scsi_req_unref(req);
316 s->req = NULL;
317}
318
94d3f98a
PB
319static void usb_msd_request_cancelled(SCSIRequest *req)
320{
321 MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
322
323 if (req == s->req) {
324 scsi_req_unref(s->req);
325 s->req = NULL;
94d3f98a
PB
326 s->scsi_len = 0;
327 }
328}
329
059809e4 330static void usb_msd_handle_reset(USBDevice *dev)
2e5d83bb
PB
331{
332 MSDState *s = (MSDState *)dev;
333
334 DPRINTF("Reset\n");
24a5bbe1
GH
335 if (s->req) {
336 scsi_req_cancel(s->req);
337 }
338 assert(s->req == NULL);
339
340 if (s->packet) {
9a77a0f5 341 s->packet->status = USB_RET_STALL;
1e6ed80b 342 usb_msd_packet_complete(s);
24a5bbe1
GH
343 }
344
2e5d83bb 345 s->mode = USB_MSDM_CBW;
2e5d83bb
PB
346}
347
9a77a0f5 348static void usb_msd_handle_control(USBDevice *dev, USBPacket *p,
007fd62f 349 int request, int value, int index, int length, uint8_t *data)
2e5d83bb
PB
350{
351 MSDState *s = (MSDState *)dev;
34707333
GH
352 SCSIDevice *scsi_dev;
353 int ret, maxlun;
2e5d83bb 354
007fd62f 355 ret = usb_desc_handle_control(dev, p, request, value, index, length, data);
81bfd2f2 356 if (ret >= 0) {
9a77a0f5 357 return;
81bfd2f2
GH
358 }
359
2e5d83bb 360 switch (request) {
2e5d83bb 361 case EndpointOutRequest | USB_REQ_CLEAR_FEATURE:
e5322f76 362 break;
2e5d83bb 363 /* Class specific requests. */
f3571b1a 364 case ClassInterfaceOutRequest | MassStorageReset:
2e5d83bb
PB
365 /* Reset state ready for the next CBW. */
366 s->mode = USB_MSDM_CBW;
2e5d83bb 367 break;
f3571b1a 368 case ClassInterfaceRequest | GetMaxLun:
34707333
GH
369 maxlun = 0;
370 for (;;) {
371 scsi_dev = scsi_device_find(&s->bus, 0, 0, maxlun+1);
372 if (scsi_dev == NULL) {
373 break;
374 }
375 if (scsi_dev->lun != maxlun+1) {
376 break;
377 }
378 maxlun++;
379 }
380 DPRINTF("MaxLun %d\n", maxlun);
381 data[0] = maxlun;
9a77a0f5 382 p->actual_length = 1;
2e5d83bb
PB
383 break;
384 default:
9a77a0f5 385 p->status = USB_RET_STALL;
2e5d83bb
PB
386 break;
387 }
2e5d83bb
PB
388}
389
eb5e680a 390static void usb_msd_cancel_io(USBDevice *dev, USBPacket *p)
4d611c9a 391{
79e2590c 392 MSDState *s = USB_STORAGE_DEV(dev);
d3ac1a87 393
6d7aeeeb
GH
394 assert(s->packet == p);
395 s->packet = NULL;
396
d3ac1a87
GH
397 if (s->req) {
398 scsi_req_cancel(s->req);
399 }
4d611c9a
PB
400}
401
9a77a0f5 402static void usb_msd_handle_data(USBDevice *dev, USBPacket *p)
2e5d83bb
PB
403{
404 MSDState *s = (MSDState *)dev;
7b863f41 405 uint32_t tag;
2e5d83bb 406 struct usb_msd_cbw cbw;
079d0b7f 407 uint8_t devep = p->ep->nr;
34707333 408 SCSIDevice *scsi_dev;
9db7c414 409 uint32_t len;
2e5d83bb 410
4d611c9a 411 switch (p->pid) {
2e5d83bb
PB
412 case USB_TOKEN_OUT:
413 if (devep != 2)
414 goto fail;
415
416 switch (s->mode) {
417 case USB_MSDM_CBW:
29c74f76 418 if (p->iov.size != 31) {
f5dc5978 419 error_report("usb-msd: Bad CBW size");
2e5d83bb
PB
420 goto fail;
421 }
29c74f76 422 usb_packet_copy(p, &cbw, 31);
2e5d83bb 423 if (le32_to_cpu(cbw.sig) != 0x43425355) {
f5dc5978
GA
424 error_report("usb-msd: Bad signature %08x",
425 le32_to_cpu(cbw.sig));
2e5d83bb
PB
426 goto fail;
427 }
428 DPRINTF("Command on LUN %d\n", cbw.lun);
34707333
GH
429 scsi_dev = scsi_device_find(&s->bus, 0, 0, cbw.lun);
430 if (scsi_dev == NULL) {
f5dc5978 431 error_report("usb-msd: Bad LUN %d", cbw.lun);
2e5d83bb
PB
432 goto fail;
433 }
7b863f41 434 tag = le32_to_cpu(cbw.tag);
2e5d83bb
PB
435 s->data_len = le32_to_cpu(cbw.data_len);
436 if (s->data_len == 0) {
437 s->mode = USB_MSDM_CSW;
438 } else if (cbw.flags & 0x80) {
439 s->mode = USB_MSDM_DATAIN;
440 } else {
441 s->mode = USB_MSDM_DATAOUT;
442 }
443 DPRINTF("Command tag 0x%x flags %08x len %d data %d\n",
7b863f41 444 tag, cbw.flags, cbw.cmd_len, s->data_len);
0659879e 445 assert(le32_to_cpu(s->csw.residue) == 0);
ef0bdf77 446 s->scsi_len = 0;
34707333 447 s->req = scsi_req_new(scsi_dev, tag, cbw.lun, cbw.cmd, NULL);
06f9847d
GH
448#ifdef DEBUG_MSD
449 scsi_req_print(s->req);
450#endif
9db7c414
GH
451 len = scsi_req_enqueue(s->req);
452 if (len) {
ad3376cc 453 scsi_req_continue(s->req);
a917d384 454 }
2e5d83bb
PB
455 break;
456
457 case USB_MSDM_DATAOUT:
29c74f76
GH
458 DPRINTF("Data out %zd/%d\n", p->iov.size, s->data_len);
459 if (p->iov.size > s->data_len) {
2e5d83bb 460 goto fail;
29c74f76 461 }
2e5d83bb 462
a917d384 463 if (s->scsi_len) {
29c74f76 464 usb_msd_copy_data(s, p);
a917d384 465 }
0659879e 466 if (le32_to_cpu(s->csw.residue)) {
9a77a0f5 467 int len = p->iov.size - p->actual_length;
29c74f76
GH
468 if (len) {
469 usb_packet_skip(p, len);
470 s->data_len -= len;
471 if (s->data_len == 0) {
472 s->mode = USB_MSDM_CSW;
473 }
474 }
a917d384 475 }
9a77a0f5 476 if (p->actual_length < p->iov.size) {
06f9847d 477 DPRINTF("Deferring packet %p [wait data-out]\n", p);
4d611c9a 478 s->packet = p;
9a77a0f5 479 p->status = USB_RET_ASYNC;
4d611c9a 480 }
2e5d83bb
PB
481 break;
482
483 default:
29c74f76 484 DPRINTF("Unexpected write (len %zd)\n", p->iov.size);
2e5d83bb
PB
485 goto fail;
486 }
487 break;
488
489 case USB_TOKEN_IN:
490 if (devep != 1)
491 goto fail;
492
493 switch (s->mode) {
a917d384 494 case USB_MSDM_DATAOUT:
29c74f76 495 if (s->data_len != 0 || p->iov.size < 13) {
a917d384 496 goto fail;
29c74f76 497 }
a917d384 498 /* Waiting for SCSI write to complete. */
a917d384 499 s->packet = p;
9a77a0f5 500 p->status = USB_RET_ASYNC;
a917d384
PB
501 break;
502
2e5d83bb 503 case USB_MSDM_CSW:
29c74f76 504 if (p->iov.size < 13) {
2e5d83bb 505 goto fail;
29c74f76 506 }
2e5d83bb 507
59310659
GH
508 if (s->req) {
509 /* still in flight */
06f9847d 510 DPRINTF("Deferring packet %p [wait status]\n", p);
59310659 511 s->packet = p;
9a77a0f5 512 p->status = USB_RET_ASYNC;
59310659
GH
513 } else {
514 usb_msd_send_status(s, p);
515 s->mode = USB_MSDM_CBW;
59310659 516 }
2e5d83bb
PB
517 break;
518
519 case USB_MSDM_DATAIN:
29c74f76
GH
520 DPRINTF("Data in %zd/%d, scsi_len %d\n",
521 p->iov.size, s->data_len, s->scsi_len);
a917d384 522 if (s->scsi_len) {
29c74f76 523 usb_msd_copy_data(s, p);
a917d384 524 }
0659879e 525 if (le32_to_cpu(s->csw.residue)) {
9a77a0f5 526 int len = p->iov.size - p->actual_length;
29c74f76
GH
527 if (len) {
528 usb_packet_skip(p, len);
529 s->data_len -= len;
530 if (s->data_len == 0) {
531 s->mode = USB_MSDM_CSW;
532 }
533 }
a917d384 534 }
9a77a0f5 535 if (p->actual_length < p->iov.size) {
06f9847d 536 DPRINTF("Deferring packet %p [wait data-in]\n", p);
4d611c9a 537 s->packet = p;
9a77a0f5 538 p->status = USB_RET_ASYNC;
4d611c9a 539 }
2e5d83bb
PB
540 break;
541
542 default:
29c74f76 543 DPRINTF("Unexpected read (len %zd)\n", p->iov.size);
2e5d83bb
PB
544 goto fail;
545 }
546 break;
547
548 default:
549 DPRINTF("Bad token\n");
550 fail:
9a77a0f5 551 p->status = USB_RET_STALL;
2e5d83bb
PB
552 break;
553 }
2e5d83bb
PB
554}
555
b3e461d3
GH
556static void usb_msd_password_cb(void *opaque, int err)
557{
558 MSDState *s = opaque;
7d553f27 559 Error *local_err = NULL;
b3e461d3 560
7d553f27
GA
561 if (!err) {
562 usb_device_attach(&s->dev, &local_err);
563 }
fa19bf83 564
7d553f27 565 if (local_err) {
c326529b 566 error_report_err(local_err);
56f9107e 567 qdev_unplug(&s->dev.qdev, NULL);
7d553f27 568 }
b3e461d3
GH
569}
570
5de88b1d
GH
571static void *usb_msd_load_request(QEMUFile *f, SCSIRequest *req)
572{
573 MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
574
575 /* nothing to load, just store req in our state struct */
576 assert(s->req == NULL);
577 scsi_req_ref(req);
578 s->req = req;
579 return NULL;
580}
581
34707333 582static const struct SCSIBusInfo usb_msd_scsi_info_storage = {
afd4030c 583 .tcq = false,
7e0380b9
PB
584 .max_target = 0,
585 .max_lun = 0,
afd4030c 586
c6df7102 587 .transfer_data = usb_msd_transfer_data,
94d3f98a 588 .complete = usb_msd_command_complete,
5de88b1d
GH
589 .cancel = usb_msd_request_cancelled,
590 .load_request = usb_msd_load_request,
cfdc1bb0
PB
591};
592
34707333
GH
593static const struct SCSIBusInfo usb_msd_scsi_info_bot = {
594 .tcq = false,
595 .max_target = 0,
596 .max_lun = 15,
597
598 .transfer_data = usb_msd_transfer_data,
599 .complete = usb_msd_command_complete,
600 .cancel = usb_msd_request_cancelled,
601 .load_request = usb_msd_load_request,
602};
603
5a882e40 604static void usb_msd_realize_storage(USBDevice *dev, Error **errp)
806b6024 605{
79e2590c 606 MSDState *s = USB_STORAGE_DEV(dev);
4be74634 607 BlockBackend *blk = s->conf.blk;
34707333 608 SCSIDevice *scsi_dev;
caad4eb3 609 Error *err = NULL;
806b6024 610
4be74634 611 if (!blk) {
5a882e40
GA
612 error_setg(errp, "drive property not set");
613 return;
7fc2f2c0
GH
614 }
615
7afcc1f9
MA
616 bdrv_add_key(blk_bs(blk), NULL, &err);
617 if (err) {
618 if (monitor_cur_is_qmp()) {
619 error_propagate(errp, err);
620 return;
621 }
622 error_free(err);
623 err = NULL;
624 if (cur_mon) {
625 monitor_read_bdrv_key_start(cur_mon, blk_bs(blk),
626 usb_msd_password_cb, s);
627 s->dev.auto_attach = 0;
628 } else {
629 autostart = 0;
630 }
631 }
632
71938a09 633 blkconf_serial(&s->conf, &dev->serial);
0eb28a42 634 blkconf_blocksizes(&s->conf);
911525db 635
14bafc54
MA
636 /*
637 * Hack alert: this pretends to be a block device, but it's really
638 * a SCSI bus that can serve only a single device, which it
18846dee
MA
639 * creates automatically. But first it needs to detach from its
640 * blockdev, or else scsi_bus_legacy_add_drive() dies when it
641 * attaches again.
14bafc54
MA
642 *
643 * The hack is probably a bad idea.
644 */
4be74634
MA
645 blk_detach_dev(blk, &s->dev.qdev);
646 s->conf.blk = NULL;
14bafc54 647
71938a09 648 usb_desc_create_serial(dev);
a980a065 649 usb_desc_init(dev);
b1187b51
AF
650 scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(dev),
651 &usb_msd_scsi_info_storage, NULL);
4be74634 652 scsi_dev = scsi_bus_legacy_add_drive(&s->bus, blk, 0, !!s->removable,
caad4eb3
AF
653 s->conf.bootindex, dev->serial,
654 &err);
34707333 655 if (!scsi_dev) {
5a882e40
GA
656 error_propagate(errp, err);
657 return;
fa66b909 658 }
7fc2f2c0 659 usb_msd_handle_reset(dev);
89f0762d 660 s->scsi_dev = scsi_dev;
806b6024
GH
661}
662
5a882e40 663static void usb_msd_realize_bot(USBDevice *dev, Error **errp)
34707333 664{
79e2590c 665 MSDState *s = USB_STORAGE_DEV(dev);
34707333
GH
666
667 usb_desc_create_serial(dev);
668 usb_desc_init(dev);
b1187b51
AF
669 scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(dev),
670 &usb_msd_scsi_info_bot, NULL);
34707333 671 usb_msd_handle_reset(dev);
34707333
GH
672}
673
3741715c 674static USBDevice *usb_msd_init(USBBus *bus, const char *filename)
2e5d83bb 675{
7fc2f2c0 676 static int nr=0;
9b3d111a 677 Error *err = NULL;
7fc2f2c0
GH
678 char id[8];
679 QemuOpts *opts;
680 DriveInfo *dinfo;
806b6024 681 USBDevice *dev;
334c0241
AJ
682 const char *p1;
683 char fmt[32];
684
7fc2f2c0 685 /* parse -usbdevice disk: syntax into drive opts */
31376776
MA
686 do {
687 snprintf(id, sizeof(id), "usb%d", nr++);
688 opts = qemu_opts_create(qemu_find_opts("drive"), id, 1, NULL);
689 } while (!opts);
7fc2f2c0 690
334c0241
AJ
691 p1 = strchr(filename, ':');
692 if (p1++) {
693 const char *p2;
694
695 if (strstart(filename, "format=", &p2)) {
696 int len = MIN(p1 - p2, sizeof(fmt));
697 pstrcpy(fmt, len, p2);
f43e47db 698 qemu_opt_set(opts, "format", fmt, &error_abort);
334c0241 699 } else if (*filename != ':') {
f5dc5978 700 error_report("unrecognized USB mass-storage option %s", filename);
334c0241
AJ
701 return NULL;
702 }
334c0241
AJ
703 filename = p1;
704 }
334c0241 705 if (!*filename) {
f5dc5978 706 error_report("block device specification needed");
334c0241
AJ
707 return NULL;
708 }
f43e47db
MA
709 qemu_opt_set(opts, "file", filename, &error_abort);
710 qemu_opt_set(opts, "if", "none", &error_abort);
2e5d83bb 711
7fc2f2c0 712 /* create host drive */
60e19e06 713 dinfo = drive_new(opts, 0);
7fc2f2c0
GH
714 if (!dinfo) {
715 qemu_opts_del(opts);
806b6024 716 return NULL;
7fc2f2c0 717 }
2e5d83bb 718
7fc2f2c0 719 /* create guest device */
3741715c 720 dev = usb_create(bus, "usb-storage");
9b3d111a
MA
721 qdev_prop_set_drive(&dev->qdev, "drive", blk_by_legacy_dinfo(dinfo),
722 &err);
723 if (err) {
724 error_report_err(err);
02a5c4c9 725 object_unparent(OBJECT(dev));
18846dee
MA
726 return NULL;
727 }
7fc2f2c0 728 return dev;
2e5d83bb 729}
bb5fc20f 730
f54b6563
GH
731static const VMStateDescription vmstate_usb_msd = {
732 .name = "usb-storage",
f54b6563
GH
733 .version_id = 1,
734 .minimum_version_id = 1,
6e3d652a 735 .fields = (VMStateField[]) {
f54b6563 736 VMSTATE_USB_DEVICE(dev, MSDState),
5de88b1d
GH
737 VMSTATE_UINT32(mode, MSDState),
738 VMSTATE_UINT32(scsi_len, MSDState),
739 VMSTATE_UINT32(scsi_off, MSDState),
740 VMSTATE_UINT32(data_len, MSDState),
741 VMSTATE_UINT32(csw.sig, MSDState),
742 VMSTATE_UINT32(csw.tag, MSDState),
743 VMSTATE_UINT32(csw.residue, MSDState),
744 VMSTATE_UINT8(csw.status, MSDState),
f54b6563
GH
745 VMSTATE_END_OF_LIST()
746 }
747};
748
39bffca2
AL
749static Property msd_properties[] = {
750 DEFINE_BLOCK_PROPERTIES(MSDState, conf),
39bffca2
AL
751 DEFINE_PROP_BIT("removable", MSDState, removable, 0, false),
752 DEFINE_PROP_END_OF_LIST(),
753};
754
79e2590c 755static void usb_msd_class_initfn_common(ObjectClass *klass, void *data)
62aed765 756{
39bffca2 757 DeviceClass *dc = DEVICE_CLASS(klass);
62aed765
AL
758 USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
759
62aed765
AL
760 uc->product_desc = "QEMU USB MSD";
761 uc->usb_desc = &desc;
62aed765
AL
762 uc->cancel_packet = usb_msd_cancel_io;
763 uc->handle_attach = usb_desc_attach;
764 uc->handle_reset = usb_msd_handle_reset;
765 uc->handle_control = usb_msd_handle_control;
766 uc->handle_data = usb_msd_handle_data;
125ee0ed 767 set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
39bffca2
AL
768 dc->fw_name = "storage";
769 dc->vmsd = &vmstate_usb_msd;
34707333
GH
770}
771
772static void usb_msd_class_initfn_storage(ObjectClass *klass, void *data)
773{
774 DeviceClass *dc = DEVICE_CLASS(klass);
775 USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
776
5a882e40 777 uc->realize = usb_msd_realize_storage;
39bffca2 778 dc->props = msd_properties;
34707333
GH
779}
780
89f0762d
GA
781static void usb_msd_get_bootindex(Object *obj, Visitor *v, void *opaque,
782 const char *name, Error **errp)
783{
784 USBDevice *dev = USB_DEVICE(obj);
79e2590c 785 MSDState *s = USB_STORAGE_DEV(dev);
89f0762d
GA
786
787 visit_type_int32(v, &s->conf.bootindex, name, errp);
788}
789
790static void usb_msd_set_bootindex(Object *obj, Visitor *v, void *opaque,
791 const char *name, Error **errp)
792{
793 USBDevice *dev = USB_DEVICE(obj);
79e2590c 794 MSDState *s = USB_STORAGE_DEV(dev);
89f0762d
GA
795 int32_t boot_index;
796 Error *local_err = NULL;
797
798 visit_type_int32(v, &boot_index, name, &local_err);
799 if (local_err) {
800 goto out;
801 }
802 /* check whether bootindex is present in fw_boot_order list */
803 check_boot_index(boot_index, &local_err);
804 if (local_err) {
805 goto out;
806 }
807 /* change bootindex to a new one */
808 s->conf.bootindex = boot_index;
809
810 if (s->scsi_dev) {
811 object_property_set_int(OBJECT(s->scsi_dev), boot_index, "bootindex",
812 &error_abort);
813 }
814
815out:
816 if (local_err) {
817 error_propagate(errp, local_err);
818 }
819}
820
79e2590c
GA
821static const TypeInfo usb_storage_dev_type_info = {
822 .name = TYPE_USB_STORAGE,
823 .parent = TYPE_USB_DEVICE,
824 .instance_size = sizeof(MSDState),
825 .abstract = true,
826 .class_init = usb_msd_class_initfn_common,
827};
828
89f0762d
GA
829static void usb_msd_instance_init(Object *obj)
830{
831 object_property_add(obj, "bootindex", "int32",
832 usb_msd_get_bootindex,
833 usb_msd_set_bootindex, NULL, NULL, NULL);
834 object_property_set_int(obj, -1, "bootindex", NULL);
835}
836
34707333
GH
837static void usb_msd_class_initfn_bot(ObjectClass *klass, void *data)
838{
839 USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
e9fd12aa 840 DeviceClass *dc = DEVICE_CLASS(klass);
34707333 841
5a882e40 842 uc->realize = usb_msd_realize_bot;
e9fd12aa 843 dc->hotpluggable = false;
62aed765
AL
844}
845
8c43a6f0 846static const TypeInfo msd_info = {
39bffca2 847 .name = "usb-storage",
79e2590c 848 .parent = TYPE_USB_STORAGE,
34707333 849 .class_init = usb_msd_class_initfn_storage,
89f0762d 850 .instance_init = usb_msd_instance_init,
34707333
GH
851};
852
853static const TypeInfo bot_info = {
854 .name = "usb-bot",
79e2590c 855 .parent = TYPE_USB_STORAGE,
34707333 856 .class_init = usb_msd_class_initfn_bot,
806b6024
GH
857};
858
83f7d43a 859static void usb_msd_register_types(void)
806b6024 860{
79e2590c 861 type_register_static(&usb_storage_dev_type_info);
39bffca2 862 type_register_static(&msd_info);
34707333 863 type_register_static(&bot_info);
ba02430f 864 usb_legacy_register("usb-storage", "disk", usb_msd_init);
806b6024 865}
83f7d43a
AF
866
867type_init(usb_msd_register_types)
This page took 1.07249 seconds and 4 git commands to generate.