xref: /openbmc/qemu/hw/usb/dev-storage.c (revision 79e2590c)
1f1ae32a1SGerd Hoffmann /*
2f1ae32a1SGerd Hoffmann  * USB Mass Storage Device emulation
3f1ae32a1SGerd Hoffmann  *
4f1ae32a1SGerd Hoffmann  * Copyright (c) 2006 CodeSourcery.
5f1ae32a1SGerd Hoffmann  * Written by Paul Brook
6f1ae32a1SGerd Hoffmann  *
7f1ae32a1SGerd Hoffmann  * This code is licensed under the LGPL.
8f1ae32a1SGerd Hoffmann  */
9f1ae32a1SGerd Hoffmann 
10f1ae32a1SGerd Hoffmann #include "qemu-common.h"
111de7afc9SPaolo Bonzini #include "qemu/option.h"
121de7afc9SPaolo Bonzini #include "qemu/config-file.h"
13f1ae32a1SGerd Hoffmann #include "hw/usb.h"
14f1ae32a1SGerd Hoffmann #include "hw/usb/desc.h"
150d09e41aSPaolo Bonzini #include "hw/scsi/scsi.h"
1628ecbaeeSPaolo Bonzini #include "ui/console.h"
1783c9089eSPaolo Bonzini #include "monitor/monitor.h"
189c17d615SPaolo Bonzini #include "sysemu/sysemu.h"
19fa1d36dfSMarkus Armbruster #include "sysemu/block-backend.h"
209c17d615SPaolo Bonzini #include "sysemu/blockdev.h"
2189f0762dSGonglei #include "qapi/visitor.h"
22f1ae32a1SGerd Hoffmann 
23f1ae32a1SGerd Hoffmann //#define DEBUG_MSD
24f1ae32a1SGerd Hoffmann 
25f1ae32a1SGerd Hoffmann #ifdef DEBUG_MSD
26f1ae32a1SGerd Hoffmann #define DPRINTF(fmt, ...) \
27f1ae32a1SGerd Hoffmann do { printf("usb-msd: " fmt , ## __VA_ARGS__); } while (0)
28f1ae32a1SGerd Hoffmann #else
29f1ae32a1SGerd Hoffmann #define DPRINTF(fmt, ...) do {} while(0)
30f1ae32a1SGerd Hoffmann #endif
31f1ae32a1SGerd Hoffmann 
32f1ae32a1SGerd Hoffmann /* USB requests.  */
33f1ae32a1SGerd Hoffmann #define MassStorageReset  0xff
34f1ae32a1SGerd Hoffmann #define GetMaxLun         0xfe
35f1ae32a1SGerd Hoffmann 
36f1ae32a1SGerd Hoffmann enum USBMSDMode {
37f1ae32a1SGerd Hoffmann     USB_MSDM_CBW, /* Command Block.  */
38f1ae32a1SGerd Hoffmann     USB_MSDM_DATAOUT, /* Transfer data to device.  */
39f1ae32a1SGerd Hoffmann     USB_MSDM_DATAIN, /* Transfer data from device.  */
40f1ae32a1SGerd Hoffmann     USB_MSDM_CSW /* Command Status.  */
41f1ae32a1SGerd Hoffmann };
42f1ae32a1SGerd Hoffmann 
43f1ae32a1SGerd Hoffmann struct usb_msd_csw {
44f1ae32a1SGerd Hoffmann     uint32_t sig;
45f1ae32a1SGerd Hoffmann     uint32_t tag;
46f1ae32a1SGerd Hoffmann     uint32_t residue;
47f1ae32a1SGerd Hoffmann     uint8_t status;
48f1ae32a1SGerd Hoffmann };
49f1ae32a1SGerd Hoffmann 
50f1ae32a1SGerd Hoffmann typedef struct {
51f1ae32a1SGerd Hoffmann     USBDevice dev;
52f1ae32a1SGerd Hoffmann     enum USBMSDMode mode;
531dc90367SGerd Hoffmann     uint32_t scsi_off;
54f1ae32a1SGerd Hoffmann     uint32_t scsi_len;
55f1ae32a1SGerd Hoffmann     uint32_t data_len;
56f1ae32a1SGerd Hoffmann     struct usb_msd_csw csw;
57f1ae32a1SGerd Hoffmann     SCSIRequest *req;
58f1ae32a1SGerd Hoffmann     SCSIBus bus;
59f1ae32a1SGerd Hoffmann     /* For async completion.  */
60f1ae32a1SGerd Hoffmann     USBPacket *packet;
6134707333SGerd Hoffmann     /* usb-storage only */
6234707333SGerd Hoffmann     BlockConf conf;
6334707333SGerd Hoffmann     uint32_t removable;
6489f0762dSGonglei     SCSIDevice *scsi_dev;
65f1ae32a1SGerd Hoffmann } MSDState;
66f1ae32a1SGerd Hoffmann 
67*79e2590cSGonglei #define TYPE_USB_STORAGE "usb-storage-dev"
68*79e2590cSGonglei #define USB_STORAGE_DEV(obj) OBJECT_CHECK(MSDState, (obj), TYPE_USB_STORAGE)
69*79e2590cSGonglei 
70f1ae32a1SGerd Hoffmann struct usb_msd_cbw {
71f1ae32a1SGerd Hoffmann     uint32_t sig;
72f1ae32a1SGerd Hoffmann     uint32_t tag;
73f1ae32a1SGerd Hoffmann     uint32_t data_len;
74f1ae32a1SGerd Hoffmann     uint8_t flags;
75f1ae32a1SGerd Hoffmann     uint8_t lun;
76f1ae32a1SGerd Hoffmann     uint8_t cmd_len;
77f1ae32a1SGerd Hoffmann     uint8_t cmd[16];
78f1ae32a1SGerd Hoffmann };
79f1ae32a1SGerd Hoffmann 
80f1ae32a1SGerd Hoffmann enum {
81f1ae32a1SGerd Hoffmann     STR_MANUFACTURER = 1,
82f1ae32a1SGerd Hoffmann     STR_PRODUCT,
83f1ae32a1SGerd Hoffmann     STR_SERIALNUMBER,
84f1ae32a1SGerd Hoffmann     STR_CONFIG_FULL,
85f1ae32a1SGerd Hoffmann     STR_CONFIG_HIGH,
8679b40459SGerd Hoffmann     STR_CONFIG_SUPER,
87f1ae32a1SGerd Hoffmann };
88f1ae32a1SGerd Hoffmann 
89f1ae32a1SGerd Hoffmann static const USBDescStrings desc_strings = {
9093bfef4cSCrístian Viana     [STR_MANUFACTURER] = "QEMU",
91f1ae32a1SGerd Hoffmann     [STR_PRODUCT]      = "QEMU USB HARDDRIVE",
92f1ae32a1SGerd Hoffmann     [STR_SERIALNUMBER] = "1",
93f1ae32a1SGerd Hoffmann     [STR_CONFIG_FULL]  = "Full speed config (usb 1.1)",
94f1ae32a1SGerd Hoffmann     [STR_CONFIG_HIGH]  = "High speed config (usb 2.0)",
9579b40459SGerd Hoffmann     [STR_CONFIG_SUPER] = "Super speed config (usb 3.0)",
96f1ae32a1SGerd Hoffmann };
97f1ae32a1SGerd Hoffmann 
98f1ae32a1SGerd Hoffmann static const USBDescIface desc_iface_full = {
99f1ae32a1SGerd Hoffmann     .bInterfaceNumber              = 0,
100f1ae32a1SGerd Hoffmann     .bNumEndpoints                 = 2,
101f1ae32a1SGerd Hoffmann     .bInterfaceClass               = USB_CLASS_MASS_STORAGE,
102f1ae32a1SGerd Hoffmann     .bInterfaceSubClass            = 0x06, /* SCSI */
103f1ae32a1SGerd Hoffmann     .bInterfaceProtocol            = 0x50, /* Bulk */
104f1ae32a1SGerd Hoffmann     .eps = (USBDescEndpoint[]) {
105f1ae32a1SGerd Hoffmann         {
106f1ae32a1SGerd Hoffmann             .bEndpointAddress      = USB_DIR_IN | 0x01,
107f1ae32a1SGerd Hoffmann             .bmAttributes          = USB_ENDPOINT_XFER_BULK,
108f1ae32a1SGerd Hoffmann             .wMaxPacketSize        = 64,
109f1ae32a1SGerd Hoffmann         },{
110f1ae32a1SGerd Hoffmann             .bEndpointAddress      = USB_DIR_OUT | 0x02,
111f1ae32a1SGerd Hoffmann             .bmAttributes          = USB_ENDPOINT_XFER_BULK,
112f1ae32a1SGerd Hoffmann             .wMaxPacketSize        = 64,
113f1ae32a1SGerd Hoffmann         },
114f1ae32a1SGerd Hoffmann     }
115f1ae32a1SGerd Hoffmann };
116f1ae32a1SGerd Hoffmann 
117f1ae32a1SGerd Hoffmann static const USBDescDevice desc_device_full = {
118f1ae32a1SGerd Hoffmann     .bcdUSB                        = 0x0200,
119f1ae32a1SGerd Hoffmann     .bMaxPacketSize0               = 8,
120f1ae32a1SGerd Hoffmann     .bNumConfigurations            = 1,
121f1ae32a1SGerd Hoffmann     .confs = (USBDescConfig[]) {
122f1ae32a1SGerd Hoffmann         {
123f1ae32a1SGerd Hoffmann             .bNumInterfaces        = 1,
124f1ae32a1SGerd Hoffmann             .bConfigurationValue   = 1,
125f1ae32a1SGerd Hoffmann             .iConfiguration        = STR_CONFIG_FULL,
126bd93976aSPantelis Koukousoulas             .bmAttributes          = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
127f1ae32a1SGerd Hoffmann             .nif = 1,
128f1ae32a1SGerd Hoffmann             .ifs = &desc_iface_full,
129f1ae32a1SGerd Hoffmann         },
130f1ae32a1SGerd Hoffmann     },
131f1ae32a1SGerd Hoffmann };
132f1ae32a1SGerd Hoffmann 
133f1ae32a1SGerd Hoffmann static const USBDescIface desc_iface_high = {
134f1ae32a1SGerd Hoffmann     .bInterfaceNumber              = 0,
135f1ae32a1SGerd Hoffmann     .bNumEndpoints                 = 2,
136f1ae32a1SGerd Hoffmann     .bInterfaceClass               = USB_CLASS_MASS_STORAGE,
137f1ae32a1SGerd Hoffmann     .bInterfaceSubClass            = 0x06, /* SCSI */
138f1ae32a1SGerd Hoffmann     .bInterfaceProtocol            = 0x50, /* Bulk */
139f1ae32a1SGerd Hoffmann     .eps = (USBDescEndpoint[]) {
140f1ae32a1SGerd Hoffmann         {
141f1ae32a1SGerd Hoffmann             .bEndpointAddress      = USB_DIR_IN | 0x01,
142f1ae32a1SGerd Hoffmann             .bmAttributes          = USB_ENDPOINT_XFER_BULK,
143f1ae32a1SGerd Hoffmann             .wMaxPacketSize        = 512,
144f1ae32a1SGerd Hoffmann         },{
145f1ae32a1SGerd Hoffmann             .bEndpointAddress      = USB_DIR_OUT | 0x02,
146f1ae32a1SGerd Hoffmann             .bmAttributes          = USB_ENDPOINT_XFER_BULK,
147f1ae32a1SGerd Hoffmann             .wMaxPacketSize        = 512,
148f1ae32a1SGerd Hoffmann         },
149f1ae32a1SGerd Hoffmann     }
150f1ae32a1SGerd Hoffmann };
151f1ae32a1SGerd Hoffmann 
152f1ae32a1SGerd Hoffmann static const USBDescDevice desc_device_high = {
153f1ae32a1SGerd Hoffmann     .bcdUSB                        = 0x0200,
154f1ae32a1SGerd Hoffmann     .bMaxPacketSize0               = 64,
155f1ae32a1SGerd Hoffmann     .bNumConfigurations            = 1,
156f1ae32a1SGerd Hoffmann     .confs = (USBDescConfig[]) {
157f1ae32a1SGerd Hoffmann         {
158f1ae32a1SGerd Hoffmann             .bNumInterfaces        = 1,
159f1ae32a1SGerd Hoffmann             .bConfigurationValue   = 1,
160f1ae32a1SGerd Hoffmann             .iConfiguration        = STR_CONFIG_HIGH,
161bd93976aSPantelis Koukousoulas             .bmAttributes          = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
162f1ae32a1SGerd Hoffmann             .nif = 1,
163f1ae32a1SGerd Hoffmann             .ifs = &desc_iface_high,
164f1ae32a1SGerd Hoffmann         },
165f1ae32a1SGerd Hoffmann     },
166f1ae32a1SGerd Hoffmann };
167f1ae32a1SGerd Hoffmann 
16879b40459SGerd Hoffmann static const USBDescIface desc_iface_super = {
16979b40459SGerd Hoffmann     .bInterfaceNumber              = 0,
17079b40459SGerd Hoffmann     .bNumEndpoints                 = 2,
17179b40459SGerd Hoffmann     .bInterfaceClass               = USB_CLASS_MASS_STORAGE,
17279b40459SGerd Hoffmann     .bInterfaceSubClass            = 0x06, /* SCSI */
17379b40459SGerd Hoffmann     .bInterfaceProtocol            = 0x50, /* Bulk */
17479b40459SGerd Hoffmann     .eps = (USBDescEndpoint[]) {
17579b40459SGerd Hoffmann         {
17679b40459SGerd Hoffmann             .bEndpointAddress      = USB_DIR_IN | 0x01,
17779b40459SGerd Hoffmann             .bmAttributes          = USB_ENDPOINT_XFER_BULK,
17879b40459SGerd Hoffmann             .wMaxPacketSize        = 1024,
17979b40459SGerd Hoffmann             .bMaxBurst             = 15,
18079b40459SGerd Hoffmann         },{
18179b40459SGerd Hoffmann             .bEndpointAddress      = USB_DIR_OUT | 0x02,
18279b40459SGerd Hoffmann             .bmAttributes          = USB_ENDPOINT_XFER_BULK,
18379b40459SGerd Hoffmann             .wMaxPacketSize        = 1024,
18479b40459SGerd Hoffmann             .bMaxBurst             = 15,
18579b40459SGerd Hoffmann         },
18679b40459SGerd Hoffmann     }
18779b40459SGerd Hoffmann };
18879b40459SGerd Hoffmann 
18979b40459SGerd Hoffmann static const USBDescDevice desc_device_super = {
19079b40459SGerd Hoffmann     .bcdUSB                        = 0x0300,
19179b40459SGerd Hoffmann     .bMaxPacketSize0               = 9,
19279b40459SGerd Hoffmann     .bNumConfigurations            = 1,
19379b40459SGerd Hoffmann     .confs = (USBDescConfig[]) {
19479b40459SGerd Hoffmann         {
19579b40459SGerd Hoffmann             .bNumInterfaces        = 1,
19679b40459SGerd Hoffmann             .bConfigurationValue   = 1,
19779b40459SGerd Hoffmann             .iConfiguration        = STR_CONFIG_SUPER,
198bd93976aSPantelis Koukousoulas             .bmAttributes          = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
19979b40459SGerd Hoffmann             .nif = 1,
20079b40459SGerd Hoffmann             .ifs = &desc_iface_super,
20179b40459SGerd Hoffmann         },
20279b40459SGerd Hoffmann     },
20379b40459SGerd Hoffmann };
20479b40459SGerd Hoffmann 
205f1ae32a1SGerd Hoffmann static const USBDesc desc = {
206f1ae32a1SGerd Hoffmann     .id = {
207f1ae32a1SGerd Hoffmann         .idVendor          = 0x46f4, /* CRC16() of "QEMU" */
208f1ae32a1SGerd Hoffmann         .idProduct         = 0x0001,
209f1ae32a1SGerd Hoffmann         .bcdDevice         = 0,
210f1ae32a1SGerd Hoffmann         .iManufacturer     = STR_MANUFACTURER,
211f1ae32a1SGerd Hoffmann         .iProduct          = STR_PRODUCT,
212f1ae32a1SGerd Hoffmann         .iSerialNumber     = STR_SERIALNUMBER,
213f1ae32a1SGerd Hoffmann     },
214f1ae32a1SGerd Hoffmann     .full  = &desc_device_full,
215f1ae32a1SGerd Hoffmann     .high  = &desc_device_high,
21679b40459SGerd Hoffmann     .super = &desc_device_super,
217f1ae32a1SGerd Hoffmann     .str   = desc_strings,
218f1ae32a1SGerd Hoffmann };
219f1ae32a1SGerd Hoffmann 
220f1ae32a1SGerd Hoffmann static void usb_msd_copy_data(MSDState *s, USBPacket *p)
221f1ae32a1SGerd Hoffmann {
222f1ae32a1SGerd Hoffmann     uint32_t len;
2239a77a0f5SHans de Goede     len = p->iov.size - p->actual_length;
224f1ae32a1SGerd Hoffmann     if (len > s->scsi_len)
225f1ae32a1SGerd Hoffmann         len = s->scsi_len;
2261dc90367SGerd Hoffmann     usb_packet_copy(p, scsi_req_get_buf(s->req) + s->scsi_off, len);
227f1ae32a1SGerd Hoffmann     s->scsi_len -= len;
2281dc90367SGerd Hoffmann     s->scsi_off += len;
229f1ae32a1SGerd Hoffmann     s->data_len -= len;
230f1ae32a1SGerd Hoffmann     if (s->scsi_len == 0 || s->data_len == 0) {
231f1ae32a1SGerd Hoffmann         scsi_req_continue(s->req);
232f1ae32a1SGerd Hoffmann     }
233f1ae32a1SGerd Hoffmann }
234f1ae32a1SGerd Hoffmann 
235f1ae32a1SGerd Hoffmann static void usb_msd_send_status(MSDState *s, USBPacket *p)
236f1ae32a1SGerd Hoffmann {
237f1ae32a1SGerd Hoffmann     int len;
238f1ae32a1SGerd Hoffmann 
239f1ae32a1SGerd Hoffmann     DPRINTF("Command status %d tag 0x%x, len %zd\n",
240e2854bf3SBenjamin Herrenschmidt             s->csw.status, le32_to_cpu(s->csw.tag), p->iov.size);
241f1ae32a1SGerd Hoffmann 
242e2854bf3SBenjamin Herrenschmidt     assert(s->csw.sig == cpu_to_le32(0x53425355));
243f1ae32a1SGerd Hoffmann     len = MIN(sizeof(s->csw), p->iov.size);
244f1ae32a1SGerd Hoffmann     usb_packet_copy(p, &s->csw, len);
245f1ae32a1SGerd Hoffmann     memset(&s->csw, 0, sizeof(s->csw));
246f1ae32a1SGerd Hoffmann }
247f1ae32a1SGerd Hoffmann 
2481e6ed80bSGerd Hoffmann static void usb_msd_packet_complete(MSDState *s)
2491e6ed80bSGerd Hoffmann {
2501e6ed80bSGerd Hoffmann     USBPacket *p = s->packet;
2511e6ed80bSGerd Hoffmann 
2521e6ed80bSGerd Hoffmann     /* Set s->packet to NULL before calling usb_packet_complete
2531e6ed80bSGerd Hoffmann        because another request may be issued before
2541e6ed80bSGerd Hoffmann        usb_packet_complete returns.  */
2551e6ed80bSGerd Hoffmann     DPRINTF("Packet complete %p\n", p);
2561e6ed80bSGerd Hoffmann     s->packet = NULL;
2571e6ed80bSGerd Hoffmann     usb_packet_complete(&s->dev, p);
2581e6ed80bSGerd Hoffmann }
2591e6ed80bSGerd Hoffmann 
260f1ae32a1SGerd Hoffmann static void usb_msd_transfer_data(SCSIRequest *req, uint32_t len)
261f1ae32a1SGerd Hoffmann {
262f1ae32a1SGerd Hoffmann     MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
263f1ae32a1SGerd Hoffmann     USBPacket *p = s->packet;
264f1ae32a1SGerd Hoffmann 
265f1ae32a1SGerd Hoffmann     assert((s->mode == USB_MSDM_DATAOUT) == (req->cmd.mode == SCSI_XFER_TO_DEV));
266f1ae32a1SGerd Hoffmann     s->scsi_len = len;
2671dc90367SGerd Hoffmann     s->scsi_off = 0;
268f1ae32a1SGerd Hoffmann     if (p) {
269f1ae32a1SGerd Hoffmann         usb_msd_copy_data(s, p);
270f1ae32a1SGerd Hoffmann         p = s->packet;
2719a77a0f5SHans de Goede         if (p && p->actual_length == p->iov.size) {
2729a77a0f5SHans de Goede             p->status = USB_RET_SUCCESS; /* Clear previous ASYNC status */
2731e6ed80bSGerd Hoffmann             usb_msd_packet_complete(s);
274f1ae32a1SGerd Hoffmann         }
275f1ae32a1SGerd Hoffmann     }
276f1ae32a1SGerd Hoffmann }
277f1ae32a1SGerd Hoffmann 
278f1ae32a1SGerd Hoffmann static void usb_msd_command_complete(SCSIRequest *req, uint32_t status, size_t resid)
279f1ae32a1SGerd Hoffmann {
280f1ae32a1SGerd Hoffmann     MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
281f1ae32a1SGerd Hoffmann     USBPacket *p = s->packet;
282f1ae32a1SGerd Hoffmann 
283f1ae32a1SGerd Hoffmann     DPRINTF("Command complete %d tag 0x%x\n", status, req->tag);
284f1ae32a1SGerd Hoffmann 
285f1ae32a1SGerd Hoffmann     s->csw.sig = cpu_to_le32(0x53425355);
286f1ae32a1SGerd Hoffmann     s->csw.tag = cpu_to_le32(req->tag);
2870659879eSGerd Hoffmann     s->csw.residue = cpu_to_le32(s->data_len);
288f1ae32a1SGerd Hoffmann     s->csw.status = status != 0;
289f1ae32a1SGerd Hoffmann 
290f1ae32a1SGerd Hoffmann     if (s->packet) {
291f1ae32a1SGerd Hoffmann         if (s->data_len == 0 && s->mode == USB_MSDM_DATAOUT) {
292f1ae32a1SGerd Hoffmann             /* A deferred packet with no write data remaining must be
293f1ae32a1SGerd Hoffmann                the status read packet.  */
294f1ae32a1SGerd Hoffmann             usb_msd_send_status(s, p);
295f1ae32a1SGerd Hoffmann             s->mode = USB_MSDM_CBW;
29654414218SGerd Hoffmann         } else if (s->mode == USB_MSDM_CSW) {
29754414218SGerd Hoffmann             usb_msd_send_status(s, p);
29854414218SGerd Hoffmann             s->mode = USB_MSDM_CBW;
299f1ae32a1SGerd Hoffmann         } else {
300f1ae32a1SGerd Hoffmann             if (s->data_len) {
3019a77a0f5SHans de Goede                 int len = (p->iov.size - p->actual_length);
302f1ae32a1SGerd Hoffmann                 usb_packet_skip(p, len);
303f1ae32a1SGerd Hoffmann                 s->data_len -= len;
304f1ae32a1SGerd Hoffmann             }
305f1ae32a1SGerd Hoffmann             if (s->data_len == 0) {
306f1ae32a1SGerd Hoffmann                 s->mode = USB_MSDM_CSW;
307f1ae32a1SGerd Hoffmann             }
308f1ae32a1SGerd Hoffmann         }
3099a77a0f5SHans de Goede         p->status = USB_RET_SUCCESS; /* Clear previous ASYNC status */
3101e6ed80bSGerd Hoffmann         usb_msd_packet_complete(s);
311f1ae32a1SGerd Hoffmann     } else if (s->data_len == 0) {
312f1ae32a1SGerd Hoffmann         s->mode = USB_MSDM_CSW;
313f1ae32a1SGerd Hoffmann     }
314f1ae32a1SGerd Hoffmann     scsi_req_unref(req);
315f1ae32a1SGerd Hoffmann     s->req = NULL;
316f1ae32a1SGerd Hoffmann }
317f1ae32a1SGerd Hoffmann 
318f1ae32a1SGerd Hoffmann static void usb_msd_request_cancelled(SCSIRequest *req)
319f1ae32a1SGerd Hoffmann {
320f1ae32a1SGerd Hoffmann     MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
321f1ae32a1SGerd Hoffmann 
322f1ae32a1SGerd Hoffmann     if (req == s->req) {
323f1ae32a1SGerd Hoffmann         scsi_req_unref(s->req);
324f1ae32a1SGerd Hoffmann         s->req = NULL;
325f1ae32a1SGerd Hoffmann         s->scsi_len = 0;
326f1ae32a1SGerd Hoffmann     }
327f1ae32a1SGerd Hoffmann }
328f1ae32a1SGerd Hoffmann 
329f1ae32a1SGerd Hoffmann static void usb_msd_handle_reset(USBDevice *dev)
330f1ae32a1SGerd Hoffmann {
331f1ae32a1SGerd Hoffmann     MSDState *s = (MSDState *)dev;
332f1ae32a1SGerd Hoffmann 
333f1ae32a1SGerd Hoffmann     DPRINTF("Reset\n");
334f1ae32a1SGerd Hoffmann     if (s->req) {
335f1ae32a1SGerd Hoffmann         scsi_req_cancel(s->req);
336f1ae32a1SGerd Hoffmann     }
337f1ae32a1SGerd Hoffmann     assert(s->req == NULL);
338f1ae32a1SGerd Hoffmann 
339f1ae32a1SGerd Hoffmann     if (s->packet) {
3409a77a0f5SHans de Goede         s->packet->status = USB_RET_STALL;
3411e6ed80bSGerd Hoffmann         usb_msd_packet_complete(s);
342f1ae32a1SGerd Hoffmann     }
343f1ae32a1SGerd Hoffmann 
344f1ae32a1SGerd Hoffmann     s->mode = USB_MSDM_CBW;
345f1ae32a1SGerd Hoffmann }
346f1ae32a1SGerd Hoffmann 
3479a77a0f5SHans de Goede static void usb_msd_handle_control(USBDevice *dev, USBPacket *p,
348f1ae32a1SGerd Hoffmann                int request, int value, int index, int length, uint8_t *data)
349f1ae32a1SGerd Hoffmann {
350f1ae32a1SGerd Hoffmann     MSDState *s = (MSDState *)dev;
35134707333SGerd Hoffmann     SCSIDevice *scsi_dev;
35234707333SGerd Hoffmann     int ret, maxlun;
353f1ae32a1SGerd Hoffmann 
354f1ae32a1SGerd Hoffmann     ret = usb_desc_handle_control(dev, p, request, value, index, length, data);
355f1ae32a1SGerd Hoffmann     if (ret >= 0) {
3569a77a0f5SHans de Goede         return;
357f1ae32a1SGerd Hoffmann     }
358f1ae32a1SGerd Hoffmann 
359f1ae32a1SGerd Hoffmann     switch (request) {
360f1ae32a1SGerd Hoffmann     case EndpointOutRequest | USB_REQ_CLEAR_FEATURE:
361f1ae32a1SGerd Hoffmann         break;
362f1ae32a1SGerd Hoffmann         /* Class specific requests.  */
363f1ae32a1SGerd Hoffmann     case ClassInterfaceOutRequest | MassStorageReset:
364f1ae32a1SGerd Hoffmann         /* Reset state ready for the next CBW.  */
365f1ae32a1SGerd Hoffmann         s->mode = USB_MSDM_CBW;
366f1ae32a1SGerd Hoffmann         break;
367f1ae32a1SGerd Hoffmann     case ClassInterfaceRequest | GetMaxLun:
36834707333SGerd Hoffmann         maxlun = 0;
36934707333SGerd Hoffmann         for (;;) {
37034707333SGerd Hoffmann             scsi_dev = scsi_device_find(&s->bus, 0, 0, maxlun+1);
37134707333SGerd Hoffmann             if (scsi_dev == NULL) {
37234707333SGerd Hoffmann                 break;
37334707333SGerd Hoffmann             }
37434707333SGerd Hoffmann             if (scsi_dev->lun != maxlun+1) {
37534707333SGerd Hoffmann                 break;
37634707333SGerd Hoffmann             }
37734707333SGerd Hoffmann             maxlun++;
37834707333SGerd Hoffmann         }
37934707333SGerd Hoffmann         DPRINTF("MaxLun %d\n", maxlun);
38034707333SGerd Hoffmann         data[0] = maxlun;
3819a77a0f5SHans de Goede         p->actual_length = 1;
382f1ae32a1SGerd Hoffmann         break;
383f1ae32a1SGerd Hoffmann     default:
3849a77a0f5SHans de Goede         p->status = USB_RET_STALL;
385f1ae32a1SGerd Hoffmann         break;
386f1ae32a1SGerd Hoffmann     }
387f1ae32a1SGerd Hoffmann }
388f1ae32a1SGerd Hoffmann 
389f1ae32a1SGerd Hoffmann static void usb_msd_cancel_io(USBDevice *dev, USBPacket *p)
390f1ae32a1SGerd Hoffmann {
391*79e2590cSGonglei     MSDState *s = USB_STORAGE_DEV(dev);
392f1ae32a1SGerd Hoffmann 
3936d7aeeebSGerd Hoffmann     assert(s->packet == p);
3946d7aeeebSGerd Hoffmann     s->packet = NULL;
3956d7aeeebSGerd Hoffmann 
396f1ae32a1SGerd Hoffmann     if (s->req) {
397f1ae32a1SGerd Hoffmann         scsi_req_cancel(s->req);
398f1ae32a1SGerd Hoffmann     }
399f1ae32a1SGerd Hoffmann }
400f1ae32a1SGerd Hoffmann 
4019a77a0f5SHans de Goede static void usb_msd_handle_data(USBDevice *dev, USBPacket *p)
402f1ae32a1SGerd Hoffmann {
403f1ae32a1SGerd Hoffmann     MSDState *s = (MSDState *)dev;
404f1ae32a1SGerd Hoffmann     uint32_t tag;
405f1ae32a1SGerd Hoffmann     struct usb_msd_cbw cbw;
406f1ae32a1SGerd Hoffmann     uint8_t devep = p->ep->nr;
40734707333SGerd Hoffmann     SCSIDevice *scsi_dev;
4089db7c414SGerd Hoffmann     uint32_t len;
409f1ae32a1SGerd Hoffmann 
410f1ae32a1SGerd Hoffmann     switch (p->pid) {
411f1ae32a1SGerd Hoffmann     case USB_TOKEN_OUT:
412f1ae32a1SGerd Hoffmann         if (devep != 2)
413f1ae32a1SGerd Hoffmann             goto fail;
414f1ae32a1SGerd Hoffmann 
415f1ae32a1SGerd Hoffmann         switch (s->mode) {
416f1ae32a1SGerd Hoffmann         case USB_MSDM_CBW:
417f1ae32a1SGerd Hoffmann             if (p->iov.size != 31) {
418f5dc5978SGonglei                 error_report("usb-msd: Bad CBW size");
419f1ae32a1SGerd Hoffmann                 goto fail;
420f1ae32a1SGerd Hoffmann             }
421f1ae32a1SGerd Hoffmann             usb_packet_copy(p, &cbw, 31);
422f1ae32a1SGerd Hoffmann             if (le32_to_cpu(cbw.sig) != 0x43425355) {
423f5dc5978SGonglei                 error_report("usb-msd: Bad signature %08x",
424f1ae32a1SGerd Hoffmann                              le32_to_cpu(cbw.sig));
425f1ae32a1SGerd Hoffmann                 goto fail;
426f1ae32a1SGerd Hoffmann             }
427f1ae32a1SGerd Hoffmann             DPRINTF("Command on LUN %d\n", cbw.lun);
42834707333SGerd Hoffmann             scsi_dev = scsi_device_find(&s->bus, 0, 0, cbw.lun);
42934707333SGerd Hoffmann             if (scsi_dev == NULL) {
430f5dc5978SGonglei                 error_report("usb-msd: Bad LUN %d", cbw.lun);
431f1ae32a1SGerd Hoffmann                 goto fail;
432f1ae32a1SGerd Hoffmann             }
433f1ae32a1SGerd Hoffmann             tag = le32_to_cpu(cbw.tag);
434f1ae32a1SGerd Hoffmann             s->data_len = le32_to_cpu(cbw.data_len);
435f1ae32a1SGerd Hoffmann             if (s->data_len == 0) {
436f1ae32a1SGerd Hoffmann                 s->mode = USB_MSDM_CSW;
437f1ae32a1SGerd Hoffmann             } else if (cbw.flags & 0x80) {
438f1ae32a1SGerd Hoffmann                 s->mode = USB_MSDM_DATAIN;
439f1ae32a1SGerd Hoffmann             } else {
440f1ae32a1SGerd Hoffmann                 s->mode = USB_MSDM_DATAOUT;
441f1ae32a1SGerd Hoffmann             }
442f1ae32a1SGerd Hoffmann             DPRINTF("Command tag 0x%x flags %08x len %d data %d\n",
443f1ae32a1SGerd Hoffmann                     tag, cbw.flags, cbw.cmd_len, s->data_len);
4440659879eSGerd Hoffmann             assert(le32_to_cpu(s->csw.residue) == 0);
445f1ae32a1SGerd Hoffmann             s->scsi_len = 0;
44634707333SGerd Hoffmann             s->req = scsi_req_new(scsi_dev, tag, cbw.lun, cbw.cmd, NULL);
44706f9847dSGerd Hoffmann #ifdef DEBUG_MSD
44806f9847dSGerd Hoffmann             scsi_req_print(s->req);
44906f9847dSGerd Hoffmann #endif
4509db7c414SGerd Hoffmann             len = scsi_req_enqueue(s->req);
4519db7c414SGerd Hoffmann             if (len) {
452f1ae32a1SGerd Hoffmann                 scsi_req_continue(s->req);
453f1ae32a1SGerd Hoffmann             }
454f1ae32a1SGerd Hoffmann             break;
455f1ae32a1SGerd Hoffmann 
456f1ae32a1SGerd Hoffmann         case USB_MSDM_DATAOUT:
457f1ae32a1SGerd Hoffmann             DPRINTF("Data out %zd/%d\n", p->iov.size, s->data_len);
458f1ae32a1SGerd Hoffmann             if (p->iov.size > s->data_len) {
459f1ae32a1SGerd Hoffmann                 goto fail;
460f1ae32a1SGerd Hoffmann             }
461f1ae32a1SGerd Hoffmann 
462f1ae32a1SGerd Hoffmann             if (s->scsi_len) {
463f1ae32a1SGerd Hoffmann                 usb_msd_copy_data(s, p);
464f1ae32a1SGerd Hoffmann             }
4650659879eSGerd Hoffmann             if (le32_to_cpu(s->csw.residue)) {
4669a77a0f5SHans de Goede                 int len = p->iov.size - p->actual_length;
467f1ae32a1SGerd Hoffmann                 if (len) {
468f1ae32a1SGerd Hoffmann                     usb_packet_skip(p, len);
469f1ae32a1SGerd Hoffmann                     s->data_len -= len;
470f1ae32a1SGerd Hoffmann                     if (s->data_len == 0) {
471f1ae32a1SGerd Hoffmann                         s->mode = USB_MSDM_CSW;
472f1ae32a1SGerd Hoffmann                     }
473f1ae32a1SGerd Hoffmann                 }
474f1ae32a1SGerd Hoffmann             }
4759a77a0f5SHans de Goede             if (p->actual_length < p->iov.size) {
47606f9847dSGerd Hoffmann                 DPRINTF("Deferring packet %p [wait data-out]\n", p);
477f1ae32a1SGerd Hoffmann                 s->packet = p;
4789a77a0f5SHans de Goede                 p->status = USB_RET_ASYNC;
479f1ae32a1SGerd Hoffmann             }
480f1ae32a1SGerd Hoffmann             break;
481f1ae32a1SGerd Hoffmann 
482f1ae32a1SGerd Hoffmann         default:
483f1ae32a1SGerd Hoffmann             DPRINTF("Unexpected write (len %zd)\n", p->iov.size);
484f1ae32a1SGerd Hoffmann             goto fail;
485f1ae32a1SGerd Hoffmann         }
486f1ae32a1SGerd Hoffmann         break;
487f1ae32a1SGerd Hoffmann 
488f1ae32a1SGerd Hoffmann     case USB_TOKEN_IN:
489f1ae32a1SGerd Hoffmann         if (devep != 1)
490f1ae32a1SGerd Hoffmann             goto fail;
491f1ae32a1SGerd Hoffmann 
492f1ae32a1SGerd Hoffmann         switch (s->mode) {
493f1ae32a1SGerd Hoffmann         case USB_MSDM_DATAOUT:
494f1ae32a1SGerd Hoffmann             if (s->data_len != 0 || p->iov.size < 13) {
495f1ae32a1SGerd Hoffmann                 goto fail;
496f1ae32a1SGerd Hoffmann             }
497f1ae32a1SGerd Hoffmann             /* Waiting for SCSI write to complete.  */
498f1ae32a1SGerd Hoffmann             s->packet = p;
4999a77a0f5SHans de Goede             p->status = USB_RET_ASYNC;
500f1ae32a1SGerd Hoffmann             break;
501f1ae32a1SGerd Hoffmann 
502f1ae32a1SGerd Hoffmann         case USB_MSDM_CSW:
503f1ae32a1SGerd Hoffmann             if (p->iov.size < 13) {
504f1ae32a1SGerd Hoffmann                 goto fail;
505f1ae32a1SGerd Hoffmann             }
506f1ae32a1SGerd Hoffmann 
507f1ae32a1SGerd Hoffmann             if (s->req) {
508f1ae32a1SGerd Hoffmann                 /* still in flight */
50906f9847dSGerd Hoffmann                 DPRINTF("Deferring packet %p [wait status]\n", p);
510f1ae32a1SGerd Hoffmann                 s->packet = p;
5119a77a0f5SHans de Goede                 p->status = USB_RET_ASYNC;
512f1ae32a1SGerd Hoffmann             } else {
513f1ae32a1SGerd Hoffmann                 usb_msd_send_status(s, p);
514f1ae32a1SGerd Hoffmann                 s->mode = USB_MSDM_CBW;
515f1ae32a1SGerd Hoffmann             }
516f1ae32a1SGerd Hoffmann             break;
517f1ae32a1SGerd Hoffmann 
518f1ae32a1SGerd Hoffmann         case USB_MSDM_DATAIN:
519f1ae32a1SGerd Hoffmann             DPRINTF("Data in %zd/%d, scsi_len %d\n",
520f1ae32a1SGerd Hoffmann                     p->iov.size, s->data_len, s->scsi_len);
521f1ae32a1SGerd Hoffmann             if (s->scsi_len) {
522f1ae32a1SGerd Hoffmann                 usb_msd_copy_data(s, p);
523f1ae32a1SGerd Hoffmann             }
5240659879eSGerd Hoffmann             if (le32_to_cpu(s->csw.residue)) {
5259a77a0f5SHans de Goede                 int len = p->iov.size - p->actual_length;
526f1ae32a1SGerd Hoffmann                 if (len) {
527f1ae32a1SGerd Hoffmann                     usb_packet_skip(p, len);
528f1ae32a1SGerd Hoffmann                     s->data_len -= len;
529f1ae32a1SGerd Hoffmann                     if (s->data_len == 0) {
530f1ae32a1SGerd Hoffmann                         s->mode = USB_MSDM_CSW;
531f1ae32a1SGerd Hoffmann                     }
532f1ae32a1SGerd Hoffmann                 }
533f1ae32a1SGerd Hoffmann             }
5349a77a0f5SHans de Goede             if (p->actual_length < p->iov.size) {
53506f9847dSGerd Hoffmann                 DPRINTF("Deferring packet %p [wait data-in]\n", p);
536f1ae32a1SGerd Hoffmann                 s->packet = p;
5379a77a0f5SHans de Goede                 p->status = USB_RET_ASYNC;
538f1ae32a1SGerd Hoffmann             }
539f1ae32a1SGerd Hoffmann             break;
540f1ae32a1SGerd Hoffmann 
541f1ae32a1SGerd Hoffmann         default:
542f1ae32a1SGerd Hoffmann             DPRINTF("Unexpected read (len %zd)\n", p->iov.size);
543f1ae32a1SGerd Hoffmann             goto fail;
544f1ae32a1SGerd Hoffmann         }
545f1ae32a1SGerd Hoffmann         break;
546f1ae32a1SGerd Hoffmann 
547f1ae32a1SGerd Hoffmann     default:
548f1ae32a1SGerd Hoffmann         DPRINTF("Bad token\n");
549f1ae32a1SGerd Hoffmann     fail:
5509a77a0f5SHans de Goede         p->status = USB_RET_STALL;
551f1ae32a1SGerd Hoffmann         break;
552f1ae32a1SGerd Hoffmann     }
553f1ae32a1SGerd Hoffmann }
554f1ae32a1SGerd Hoffmann 
555f1ae32a1SGerd Hoffmann static void usb_msd_password_cb(void *opaque, int err)
556f1ae32a1SGerd Hoffmann {
557f1ae32a1SGerd Hoffmann     MSDState *s = opaque;
5587d553f27SGonglei     Error *local_err = NULL;
559f1ae32a1SGerd Hoffmann 
5607d553f27SGonglei     if (!err) {
5617d553f27SGonglei         usb_device_attach(&s->dev, &local_err);
5627d553f27SGonglei     }
563f1ae32a1SGerd Hoffmann 
5647d553f27SGonglei     if (local_err) {
565c326529bSMarkus Armbruster         error_report_err(local_err);
56656f9107eSLuiz Capitulino         qdev_unplug(&s->dev.qdev, NULL);
567f1ae32a1SGerd Hoffmann     }
5687d553f27SGonglei }
569f1ae32a1SGerd Hoffmann 
5705de88b1dSGerd Hoffmann static void *usb_msd_load_request(QEMUFile *f, SCSIRequest *req)
5715de88b1dSGerd Hoffmann {
5725de88b1dSGerd Hoffmann     MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
5735de88b1dSGerd Hoffmann 
5745de88b1dSGerd Hoffmann     /* nothing to load, just store req in our state struct */
5755de88b1dSGerd Hoffmann     assert(s->req == NULL);
5765de88b1dSGerd Hoffmann     scsi_req_ref(req);
5775de88b1dSGerd Hoffmann     s->req = req;
5785de88b1dSGerd Hoffmann     return NULL;
5795de88b1dSGerd Hoffmann }
5805de88b1dSGerd Hoffmann 
58134707333SGerd Hoffmann static const struct SCSIBusInfo usb_msd_scsi_info_storage = {
582f1ae32a1SGerd Hoffmann     .tcq = false,
583f1ae32a1SGerd Hoffmann     .max_target = 0,
584f1ae32a1SGerd Hoffmann     .max_lun = 0,
585f1ae32a1SGerd Hoffmann 
586f1ae32a1SGerd Hoffmann     .transfer_data = usb_msd_transfer_data,
587f1ae32a1SGerd Hoffmann     .complete = usb_msd_command_complete,
5885de88b1dSGerd Hoffmann     .cancel = usb_msd_request_cancelled,
5895de88b1dSGerd Hoffmann     .load_request = usb_msd_load_request,
590f1ae32a1SGerd Hoffmann };
591f1ae32a1SGerd Hoffmann 
59234707333SGerd Hoffmann static const struct SCSIBusInfo usb_msd_scsi_info_bot = {
59334707333SGerd Hoffmann     .tcq = false,
59434707333SGerd Hoffmann     .max_target = 0,
59534707333SGerd Hoffmann     .max_lun = 15,
59634707333SGerd Hoffmann 
59734707333SGerd Hoffmann     .transfer_data = usb_msd_transfer_data,
59834707333SGerd Hoffmann     .complete = usb_msd_command_complete,
59934707333SGerd Hoffmann     .cancel = usb_msd_request_cancelled,
60034707333SGerd Hoffmann     .load_request = usb_msd_load_request,
60134707333SGerd Hoffmann };
60234707333SGerd Hoffmann 
6035a882e40SGonglei static void usb_msd_realize_storage(USBDevice *dev, Error **errp)
604f1ae32a1SGerd Hoffmann {
605*79e2590cSGonglei     MSDState *s = USB_STORAGE_DEV(dev);
6064be74634SMarkus Armbruster     BlockBackend *blk = s->conf.blk;
60734707333SGerd Hoffmann     SCSIDevice *scsi_dev;
608caad4eb3SAndreas Färber     Error *err = NULL;
609f1ae32a1SGerd Hoffmann 
6104be74634SMarkus Armbruster     if (!blk) {
6115a882e40SGonglei         error_setg(errp, "drive property not set");
6125a882e40SGonglei         return;
613f1ae32a1SGerd Hoffmann     }
614f1ae32a1SGerd Hoffmann 
6157afcc1f9SMarkus Armbruster     bdrv_add_key(blk_bs(blk), NULL, &err);
6167afcc1f9SMarkus Armbruster     if (err) {
6177afcc1f9SMarkus Armbruster         if (monitor_cur_is_qmp()) {
6187afcc1f9SMarkus Armbruster             error_propagate(errp, err);
6197afcc1f9SMarkus Armbruster             return;
6207afcc1f9SMarkus Armbruster         }
6217afcc1f9SMarkus Armbruster         error_free(err);
6227afcc1f9SMarkus Armbruster         err = NULL;
6237afcc1f9SMarkus Armbruster         if (cur_mon) {
6247afcc1f9SMarkus Armbruster             monitor_read_bdrv_key_start(cur_mon, blk_bs(blk),
6257afcc1f9SMarkus Armbruster                                         usb_msd_password_cb, s);
6267afcc1f9SMarkus Armbruster             s->dev.auto_attach = 0;
6277afcc1f9SMarkus Armbruster         } else {
6287afcc1f9SMarkus Armbruster             autostart = 0;
6297afcc1f9SMarkus Armbruster         }
6307afcc1f9SMarkus Armbruster     }
6317afcc1f9SMarkus Armbruster 
63271938a09SGerd Hoffmann     blkconf_serial(&s->conf, &dev->serial);
6330eb28a42SEkaterina Tumanova     blkconf_blocksizes(&s->conf);
634911525dbSMarkus Armbruster 
635f1ae32a1SGerd Hoffmann     /*
636f1ae32a1SGerd Hoffmann      * Hack alert: this pretends to be a block device, but it's really
637f1ae32a1SGerd Hoffmann      * a SCSI bus that can serve only a single device, which it
638f1ae32a1SGerd Hoffmann      * creates automatically.  But first it needs to detach from its
639f1ae32a1SGerd Hoffmann      * blockdev, or else scsi_bus_legacy_add_drive() dies when it
640f1ae32a1SGerd Hoffmann      * attaches again.
641f1ae32a1SGerd Hoffmann      *
642f1ae32a1SGerd Hoffmann      * The hack is probably a bad idea.
643f1ae32a1SGerd Hoffmann      */
6444be74634SMarkus Armbruster     blk_detach_dev(blk, &s->dev.qdev);
6454be74634SMarkus Armbruster     s->conf.blk = NULL;
646f1ae32a1SGerd Hoffmann 
6479d55d1adSGerd Hoffmann     usb_desc_create_serial(dev);
648f1ae32a1SGerd Hoffmann     usb_desc_init(dev);
649b1187b51SAndreas Färber     scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(dev),
650b1187b51SAndreas Färber                  &usb_msd_scsi_info_storage, NULL);
6514be74634SMarkus Armbruster     scsi_dev = scsi_bus_legacy_add_drive(&s->bus, blk, 0, !!s->removable,
652caad4eb3SAndreas Färber                                          s->conf.bootindex, dev->serial,
653caad4eb3SAndreas Färber                                          &err);
65434707333SGerd Hoffmann     if (!scsi_dev) {
6555a882e40SGonglei         error_propagate(errp, err);
6565a882e40SGonglei         return;
657f1ae32a1SGerd Hoffmann     }
658f1ae32a1SGerd Hoffmann     usb_msd_handle_reset(dev);
65989f0762dSGonglei     s->scsi_dev = scsi_dev;
660f1ae32a1SGerd Hoffmann }
661f1ae32a1SGerd Hoffmann 
6625a882e40SGonglei static void usb_msd_realize_bot(USBDevice *dev, Error **errp)
66334707333SGerd Hoffmann {
664*79e2590cSGonglei     MSDState *s = USB_STORAGE_DEV(dev);
66534707333SGerd Hoffmann 
66634707333SGerd Hoffmann     usb_desc_create_serial(dev);
66734707333SGerd Hoffmann     usb_desc_init(dev);
668b1187b51SAndreas Färber     scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(dev),
669b1187b51SAndreas Färber                  &usb_msd_scsi_info_bot, NULL);
67034707333SGerd Hoffmann     usb_msd_handle_reset(dev);
67134707333SGerd Hoffmann }
67234707333SGerd Hoffmann 
673f1ae32a1SGerd Hoffmann static USBDevice *usb_msd_init(USBBus *bus, const char *filename)
674f1ae32a1SGerd Hoffmann {
675f1ae32a1SGerd Hoffmann     static int nr=0;
6769b3d111aSMarkus Armbruster     Error *err = NULL;
677f1ae32a1SGerd Hoffmann     char id[8];
678f1ae32a1SGerd Hoffmann     QemuOpts *opts;
679f1ae32a1SGerd Hoffmann     DriveInfo *dinfo;
680f1ae32a1SGerd Hoffmann     USBDevice *dev;
681f1ae32a1SGerd Hoffmann     const char *p1;
682f1ae32a1SGerd Hoffmann     char fmt[32];
683f1ae32a1SGerd Hoffmann 
684f1ae32a1SGerd Hoffmann     /* parse -usbdevice disk: syntax into drive opts */
68531376776SMarkus Armbruster     do {
686f1ae32a1SGerd Hoffmann         snprintf(id, sizeof(id), "usb%d", nr++);
68731376776SMarkus Armbruster         opts = qemu_opts_create(qemu_find_opts("drive"), id, 1, NULL);
68831376776SMarkus Armbruster     } while (!opts);
689f1ae32a1SGerd Hoffmann 
690f1ae32a1SGerd Hoffmann     p1 = strchr(filename, ':');
691f1ae32a1SGerd Hoffmann     if (p1++) {
692f1ae32a1SGerd Hoffmann         const char *p2;
693f1ae32a1SGerd Hoffmann 
694f1ae32a1SGerd Hoffmann         if (strstart(filename, "format=", &p2)) {
695f1ae32a1SGerd Hoffmann             int len = MIN(p1 - p2, sizeof(fmt));
696f1ae32a1SGerd Hoffmann             pstrcpy(fmt, len, p2);
697f43e47dbSMarkus Armbruster             qemu_opt_set(opts, "format", fmt, &error_abort);
698f1ae32a1SGerd Hoffmann         } else if (*filename != ':') {
699f5dc5978SGonglei             error_report("unrecognized USB mass-storage option %s", filename);
700f1ae32a1SGerd Hoffmann             return NULL;
701f1ae32a1SGerd Hoffmann         }
702f1ae32a1SGerd Hoffmann         filename = p1;
703f1ae32a1SGerd Hoffmann     }
704f1ae32a1SGerd Hoffmann     if (!*filename) {
705f5dc5978SGonglei         error_report("block device specification needed");
706f1ae32a1SGerd Hoffmann         return NULL;
707f1ae32a1SGerd Hoffmann     }
708f43e47dbSMarkus Armbruster     qemu_opt_set(opts, "file", filename, &error_abort);
709f43e47dbSMarkus Armbruster     qemu_opt_set(opts, "if", "none", &error_abort);
710f1ae32a1SGerd Hoffmann 
711f1ae32a1SGerd Hoffmann     /* create host drive */
71260e19e06SMarkus Armbruster     dinfo = drive_new(opts, 0);
713f1ae32a1SGerd Hoffmann     if (!dinfo) {
714f1ae32a1SGerd Hoffmann         qemu_opts_del(opts);
715f1ae32a1SGerd Hoffmann         return NULL;
716f1ae32a1SGerd Hoffmann     }
717f1ae32a1SGerd Hoffmann 
718f1ae32a1SGerd Hoffmann     /* create guest device */
719f1ae32a1SGerd Hoffmann     dev = usb_create(bus, "usb-storage");
7209b3d111aSMarkus Armbruster     qdev_prop_set_drive(&dev->qdev, "drive", blk_by_legacy_dinfo(dinfo),
7219b3d111aSMarkus Armbruster                         &err);
7229b3d111aSMarkus Armbruster     if (err) {
7239b3d111aSMarkus Armbruster         error_report_err(err);
72402a5c4c9SStefan Hajnoczi         object_unparent(OBJECT(dev));
725f1ae32a1SGerd Hoffmann         return NULL;
726f1ae32a1SGerd Hoffmann     }
727f1ae32a1SGerd Hoffmann     return dev;
728f1ae32a1SGerd Hoffmann }
729f1ae32a1SGerd Hoffmann 
730f1ae32a1SGerd Hoffmann static const VMStateDescription vmstate_usb_msd = {
731f1ae32a1SGerd Hoffmann     .name = "usb-storage",
732f1ae32a1SGerd Hoffmann     .version_id = 1,
733f1ae32a1SGerd Hoffmann     .minimum_version_id = 1,
734f1ae32a1SGerd Hoffmann     .fields = (VMStateField[]) {
735f1ae32a1SGerd Hoffmann         VMSTATE_USB_DEVICE(dev, MSDState),
7365de88b1dSGerd Hoffmann         VMSTATE_UINT32(mode, MSDState),
7375de88b1dSGerd Hoffmann         VMSTATE_UINT32(scsi_len, MSDState),
7385de88b1dSGerd Hoffmann         VMSTATE_UINT32(scsi_off, MSDState),
7395de88b1dSGerd Hoffmann         VMSTATE_UINT32(data_len, MSDState),
7405de88b1dSGerd Hoffmann         VMSTATE_UINT32(csw.sig, MSDState),
7415de88b1dSGerd Hoffmann         VMSTATE_UINT32(csw.tag, MSDState),
7425de88b1dSGerd Hoffmann         VMSTATE_UINT32(csw.residue, MSDState),
7435de88b1dSGerd Hoffmann         VMSTATE_UINT8(csw.status, MSDState),
744f1ae32a1SGerd Hoffmann         VMSTATE_END_OF_LIST()
745f1ae32a1SGerd Hoffmann     }
746f1ae32a1SGerd Hoffmann };
747f1ae32a1SGerd Hoffmann 
748f1ae32a1SGerd Hoffmann static Property msd_properties[] = {
749f1ae32a1SGerd Hoffmann     DEFINE_BLOCK_PROPERTIES(MSDState, conf),
750f1ae32a1SGerd Hoffmann     DEFINE_PROP_BIT("removable", MSDState, removable, 0, false),
751f1ae32a1SGerd Hoffmann     DEFINE_PROP_END_OF_LIST(),
752f1ae32a1SGerd Hoffmann };
753f1ae32a1SGerd Hoffmann 
754*79e2590cSGonglei static void usb_msd_class_initfn_common(ObjectClass *klass, void *data)
755f1ae32a1SGerd Hoffmann {
756f1ae32a1SGerd Hoffmann     DeviceClass *dc = DEVICE_CLASS(klass);
757f1ae32a1SGerd Hoffmann     USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
758f1ae32a1SGerd Hoffmann 
759f1ae32a1SGerd Hoffmann     uc->product_desc   = "QEMU USB MSD";
760f1ae32a1SGerd Hoffmann     uc->usb_desc       = &desc;
761f1ae32a1SGerd Hoffmann     uc->cancel_packet  = usb_msd_cancel_io;
762f1ae32a1SGerd Hoffmann     uc->handle_attach  = usb_desc_attach;
763f1ae32a1SGerd Hoffmann     uc->handle_reset   = usb_msd_handle_reset;
764f1ae32a1SGerd Hoffmann     uc->handle_control = usb_msd_handle_control;
765f1ae32a1SGerd Hoffmann     uc->handle_data    = usb_msd_handle_data;
766125ee0edSMarcel Apfelbaum     set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
767f1ae32a1SGerd Hoffmann     dc->fw_name = "storage";
768f1ae32a1SGerd Hoffmann     dc->vmsd = &vmstate_usb_msd;
76934707333SGerd Hoffmann }
77034707333SGerd Hoffmann 
77134707333SGerd Hoffmann static void usb_msd_class_initfn_storage(ObjectClass *klass, void *data)
77234707333SGerd Hoffmann {
77334707333SGerd Hoffmann     DeviceClass *dc = DEVICE_CLASS(klass);
77434707333SGerd Hoffmann     USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
77534707333SGerd Hoffmann 
7765a882e40SGonglei     uc->realize = usb_msd_realize_storage;
777f1ae32a1SGerd Hoffmann     dc->props = msd_properties;
77834707333SGerd Hoffmann }
77934707333SGerd Hoffmann 
78089f0762dSGonglei static void usb_msd_get_bootindex(Object *obj, Visitor *v, void *opaque,
78189f0762dSGonglei                                   const char *name, Error **errp)
78289f0762dSGonglei {
78389f0762dSGonglei     USBDevice *dev = USB_DEVICE(obj);
784*79e2590cSGonglei     MSDState *s = USB_STORAGE_DEV(dev);
78589f0762dSGonglei 
78689f0762dSGonglei     visit_type_int32(v, &s->conf.bootindex, name, errp);
78789f0762dSGonglei }
78889f0762dSGonglei 
78989f0762dSGonglei static void usb_msd_set_bootindex(Object *obj, Visitor *v, void *opaque,
79089f0762dSGonglei                                   const char *name, Error **errp)
79189f0762dSGonglei {
79289f0762dSGonglei     USBDevice *dev = USB_DEVICE(obj);
793*79e2590cSGonglei     MSDState *s = USB_STORAGE_DEV(dev);
79489f0762dSGonglei     int32_t boot_index;
79589f0762dSGonglei     Error *local_err = NULL;
79689f0762dSGonglei 
79789f0762dSGonglei     visit_type_int32(v, &boot_index, name, &local_err);
79889f0762dSGonglei     if (local_err) {
79989f0762dSGonglei         goto out;
80089f0762dSGonglei     }
80189f0762dSGonglei     /* check whether bootindex is present in fw_boot_order list  */
80289f0762dSGonglei     check_boot_index(boot_index, &local_err);
80389f0762dSGonglei     if (local_err) {
80489f0762dSGonglei         goto out;
80589f0762dSGonglei     }
80689f0762dSGonglei     /* change bootindex to a new one */
80789f0762dSGonglei     s->conf.bootindex = boot_index;
80889f0762dSGonglei 
80989f0762dSGonglei     if (s->scsi_dev) {
81089f0762dSGonglei         object_property_set_int(OBJECT(s->scsi_dev), boot_index, "bootindex",
81189f0762dSGonglei                                 &error_abort);
81289f0762dSGonglei     }
81389f0762dSGonglei 
81489f0762dSGonglei out:
81589f0762dSGonglei     if (local_err) {
81689f0762dSGonglei         error_propagate(errp, local_err);
81789f0762dSGonglei     }
81889f0762dSGonglei }
81989f0762dSGonglei 
820*79e2590cSGonglei static const TypeInfo usb_storage_dev_type_info = {
821*79e2590cSGonglei     .name = TYPE_USB_STORAGE,
822*79e2590cSGonglei     .parent = TYPE_USB_DEVICE,
823*79e2590cSGonglei     .instance_size = sizeof(MSDState),
824*79e2590cSGonglei     .abstract = true,
825*79e2590cSGonglei     .class_init = usb_msd_class_initfn_common,
826*79e2590cSGonglei };
827*79e2590cSGonglei 
82889f0762dSGonglei static void usb_msd_instance_init(Object *obj)
82989f0762dSGonglei {
83089f0762dSGonglei     object_property_add(obj, "bootindex", "int32",
83189f0762dSGonglei                         usb_msd_get_bootindex,
83289f0762dSGonglei                         usb_msd_set_bootindex, NULL, NULL, NULL);
83389f0762dSGonglei     object_property_set_int(obj, -1, "bootindex", NULL);
83489f0762dSGonglei }
83589f0762dSGonglei 
83634707333SGerd Hoffmann static void usb_msd_class_initfn_bot(ObjectClass *klass, void *data)
83734707333SGerd Hoffmann {
83834707333SGerd Hoffmann     USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
839e9fd12aaSIgor Mammedov     DeviceClass *dc = DEVICE_CLASS(klass);
84034707333SGerd Hoffmann 
8415a882e40SGonglei     uc->realize = usb_msd_realize_bot;
842e9fd12aaSIgor Mammedov     dc->hotpluggable = false;
843f1ae32a1SGerd Hoffmann }
844f1ae32a1SGerd Hoffmann 
8458c43a6f0SAndreas Färber static const TypeInfo msd_info = {
846f1ae32a1SGerd Hoffmann     .name          = "usb-storage",
847*79e2590cSGonglei     .parent        = TYPE_USB_STORAGE,
84834707333SGerd Hoffmann     .class_init    = usb_msd_class_initfn_storage,
84989f0762dSGonglei     .instance_init = usb_msd_instance_init,
85034707333SGerd Hoffmann };
85134707333SGerd Hoffmann 
85234707333SGerd Hoffmann static const TypeInfo bot_info = {
85334707333SGerd Hoffmann     .name          = "usb-bot",
854*79e2590cSGonglei     .parent        = TYPE_USB_STORAGE,
85534707333SGerd Hoffmann     .class_init    = usb_msd_class_initfn_bot,
856f1ae32a1SGerd Hoffmann };
857f1ae32a1SGerd Hoffmann 
858f1ae32a1SGerd Hoffmann static void usb_msd_register_types(void)
859f1ae32a1SGerd Hoffmann {
860*79e2590cSGonglei     type_register_static(&usb_storage_dev_type_info);
861f1ae32a1SGerd Hoffmann     type_register_static(&msd_info);
86234707333SGerd Hoffmann     type_register_static(&bot_info);
863f1ae32a1SGerd Hoffmann     usb_legacy_register("usb-storage", "disk", usb_msd_init);
864f1ae32a1SGerd Hoffmann }
865f1ae32a1SGerd Hoffmann 
866f1ae32a1SGerd Hoffmann type_init(usb_msd_register_types)
867