blob: 597d8fd18455958f1b46ddd5c6e0e6d58321d287 [file] [log] [blame]
ths5fafdf22007-09-16 21:08:06 +00001/*
pbrook2e5d83b2006-05-25 23:58:51 +00002 * USB Mass Storage Device emulation
3 *
4 * Copyright (c) 2006 CodeSourcery.
5 * Written by Paul Brook
6 *
Matthew Fernandez8e31bf32011-06-26 12:21:35 +10007 * This code is licensed under the LGPL.
pbrook2e5d83b2006-05-25 23:58:51 +00008 */
9
pbrook87ecb682007-11-17 17:14:51 +000010#include "qemu-common.h"
Markus Armbrusterd49b6832015-03-17 18:29:20 +010011#include "qemu/error-report.h"
Paolo Bonzini1de7afc2012-12-17 18:20:00 +010012#include "qemu/option.h"
13#include "qemu/config-file.h"
Gerd Hoffmannf1ae32a2012-03-07 14:55:18 +010014#include "hw/usb.h"
15#include "hw/usb/desc.h"
Paolo Bonzini0d09e412013-02-05 17:06:20 +010016#include "hw/scsi/scsi.h"
Paolo Bonzini28ecbae2012-11-28 12:06:30 +010017#include "ui/console.h"
Paolo Bonzini83c90892012-12-17 18:19:49 +010018#include "monitor/monitor.h"
Paolo Bonzini9c17d612012-12-17 18:20:04 +010019#include "sysemu/sysemu.h"
Markus Armbrusterfa1d36d2014-10-07 13:59:13 +020020#include "sysemu/block-backend.h"
Paolo Bonzini9c17d612012-12-17 18:20:04 +010021#include "sysemu/blockdev.h"
Gonglei89f07622014-10-07 16:00:33 +080022#include "qapi/visitor.h"
pbrook2e5d83b2006-05-25 23:58:51 +000023
24//#define DEBUG_MSD
25
26#ifdef DEBUG_MSD
Blue Swirl001faf32009-05-13 17:53:17 +000027#define DPRINTF(fmt, ...) \
28do { printf("usb-msd: " fmt , ## __VA_ARGS__); } while (0)
pbrook2e5d83b2006-05-25 23:58:51 +000029#else
Blue Swirl001faf32009-05-13 17:53:17 +000030#define DPRINTF(fmt, ...) do {} while(0)
pbrook2e5d83b2006-05-25 23:58:51 +000031#endif
32
33/* USB requests. */
34#define MassStorageReset 0xff
35#define GetMaxLun 0xfe
36
37enum USBMSDMode {
38 USB_MSDM_CBW, /* Command Block. */
Brad Hards94843f62011-04-13 19:45:31 +100039 USB_MSDM_DATAOUT, /* Transfer data to device. */
pbrook2e5d83b2006-05-25 23:58:51 +000040 USB_MSDM_DATAIN, /* Transfer data from device. */
41 USB_MSDM_CSW /* Command Status. */
42};
43
Gerd Hoffmann92a114f2011-11-21 11:29:27 +010044struct usb_msd_csw {
45 uint32_t sig;
46 uint32_t tag;
47 uint32_t residue;
48 uint8_t status;
49};
50
pbrook2e5d83b2006-05-25 23:58:51 +000051typedef struct {
52 USBDevice dev;
53 enum USBMSDMode mode;
Gerd Hoffmann1dc90362012-05-16 15:03:40 +020054 uint32_t scsi_off;
pbrooka917d382006-08-29 04:52:16 +000055 uint32_t scsi_len;
pbrook2e5d83b2006-05-25 23:58:51 +000056 uint32_t data_len;
Gerd Hoffmann92a114f2011-11-21 11:29:27 +010057 struct usb_msd_csw csw;
Hannes Reinecke5c6c0e52011-04-18 12:35:39 +020058 SCSIRequest *req;
Gerd Hoffmannca9c39f2009-09-16 22:25:28 +020059 SCSIBus bus;
pbrook4d611c92006-08-12 01:04:27 +000060 /* For async completion. */
61 USBPacket *packet;
Gerd Hoffmann34707332013-01-14 15:29:44 +010062 /* usb-storage only */
63 BlockConf conf;
Gerd Hoffmann34707332013-01-14 15:29:44 +010064 uint32_t removable;
Gonglei89f07622014-10-07 16:00:33 +080065 SCSIDevice *scsi_dev;
pbrook2e5d83b2006-05-25 23:58:51 +000066} MSDState;
67
Gonglei79e25902015-05-06 20:55:32 +080068#define TYPE_USB_STORAGE "usb-storage-dev"
69#define USB_STORAGE_DEV(obj) OBJECT_CHECK(MSDState, (obj), TYPE_USB_STORAGE)
70
pbrooka917d382006-08-29 04:52:16 +000071struct 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
Gerd Hoffmann81bfd2f2010-11-17 11:05:41 +010081enum {
82 STR_MANUFACTURER = 1,
83 STR_PRODUCT,
84 STR_SERIALNUMBER,
Gerd Hoffmannca0c7302010-12-03 17:12:49 +010085 STR_CONFIG_FULL,
86 STR_CONFIG_HIGH,
Gerd Hoffmann79b40452012-08-28 17:29:15 +020087 STR_CONFIG_SUPER,
pbrook2e5d83b2006-05-25 23:58:51 +000088};
89
Gerd Hoffmann81bfd2f2010-11-17 11:05:41 +010090static const USBDescStrings desc_strings = {
Crístian Viana93bfef42012-05-30 00:35:51 -030091 [STR_MANUFACTURER] = "QEMU",
Gerd Hoffmann81bfd2f2010-11-17 11:05:41 +010092 [STR_PRODUCT] = "QEMU USB HARDDRIVE",
93 [STR_SERIALNUMBER] = "1",
Gerd Hoffmannca0c7302010-12-03 17:12:49 +010094 [STR_CONFIG_FULL] = "Full speed config (usb 1.1)",
95 [STR_CONFIG_HIGH] = "High speed config (usb 2.0)",
Gerd Hoffmann79b40452012-08-28 17:29:15 +020096 [STR_CONFIG_SUPER] = "Super speed config (usb 3.0)",
Gerd Hoffmann81bfd2f2010-11-17 11:05:41 +010097};
pbrook2e5d83b2006-05-25 23:58:51 +000098
Gerd Hoffmannca0c7302010-12-03 17:12:49 +010099static const USBDescIface desc_iface_full = {
Gerd Hoffmann81bfd2f2010-11-17 11:05:41 +0100100 .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};
ths3b46e622007-09-17 08:09:54 +0000117
Gerd Hoffmannca0c7302010-12-03 17:12:49 +0100118static const USBDescDevice desc_device_full = {
119 .bcdUSB = 0x0200,
Gerd Hoffmann81bfd2f2010-11-17 11:05:41 +0100120 .bMaxPacketSize0 = 8,
121 .bNumConfigurations = 1,
122 .confs = (USBDescConfig[]) {
123 {
124 .bNumInterfaces = 1,
125 .bConfigurationValue = 1,
Gerd Hoffmannca0c7302010-12-03 17:12:49 +0100126 .iConfiguration = STR_CONFIG_FULL,
Pantelis Koukousoulasbd939762013-12-16 09:42:49 +0200127 .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
Brad Hardsadd75082011-04-03 15:33:19 +1000128 .nif = 1,
Gerd Hoffmannca0c7302010-12-03 17:12:49 +0100129 .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,
Pantelis Koukousoulasbd939762013-12-16 09:42:49 +0200162 .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
Brad Hardsadd75082011-04-03 15:33:19 +1000163 .nif = 1,
Gerd Hoffmannca0c7302010-12-03 17:12:49 +0100164 .ifs = &desc_iface_high,
Gerd Hoffmann81bfd2f2010-11-17 11:05:41 +0100165 },
166 },
167};
ths3b46e622007-09-17 08:09:54 +0000168
Gerd Hoffmann79b40452012-08-28 17:29:15 +0200169static 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,
Pantelis Koukousoulasbd939762013-12-16 09:42:49 +0200199 .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
Gerd Hoffmann79b40452012-08-28 17:29:15 +0200200 .nif = 1,
201 .ifs = &desc_iface_super,
202 },
203 },
204};
205
Gerd Hoffmann81bfd2f2010-11-17 11:05:41 +0100206static const USBDesc desc = {
207 .id = {
Roy Tamdb803582011-09-15 11:25:47 +0800208 .idVendor = 0x46f4, /* CRC16() of "QEMU" */
209 .idProduct = 0x0001,
Gerd Hoffmann81bfd2f2010-11-17 11:05:41 +0100210 .bcdDevice = 0,
211 .iManufacturer = STR_MANUFACTURER,
212 .iProduct = STR_PRODUCT,
213 .iSerialNumber = STR_SERIALNUMBER,
214 },
Gerd Hoffmann79b40452012-08-28 17:29:15 +0200215 .full = &desc_device_full,
216 .high = &desc_device_high,
217 .super = &desc_device_super,
218 .str = desc_strings,
pbrook2e5d83b2006-05-25 23:58:51 +0000219};
220
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200221static void usb_msd_copy_data(MSDState *s, USBPacket *p)
pbrooka917d382006-08-29 04:52:16 +0000222{
223 uint32_t len;
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100224 len = p->iov.size - p->actual_length;
pbrooka917d382006-08-29 04:52:16 +0000225 if (len > s->scsi_len)
226 len = s->scsi_len;
Gerd Hoffmann1dc90362012-05-16 15:03:40 +0200227 usb_packet_copy(p, scsi_req_get_buf(s->req) + s->scsi_off, len);
pbrooka917d382006-08-29 04:52:16 +0000228 s->scsi_len -= len;
Gerd Hoffmann1dc90362012-05-16 15:03:40 +0200229 s->scsi_off += len;
pbrooka917d382006-08-29 04:52:16 +0000230 s->data_len -= len;
Gerd Hoffmannfa7935c2010-12-09 23:31:49 +0100231 if (s->scsi_len == 0 || s->data_len == 0) {
Paolo Bonziniad3376c2011-04-18 15:28:11 +0200232 scsi_req_continue(s->req);
pbrooka917d382006-08-29 04:52:16 +0000233 }
234}
235
Gerd Hoffmannab4797a2010-12-09 10:36:35 +0100236static void usb_msd_send_status(MSDState *s, USBPacket *p)
pbrooka917d382006-08-29 04:52:16 +0000237{
Gerd Hoffmannab4797a2010-12-09 10:36:35 +0100238 int len;
pbrooka917d382006-08-29 04:52:16 +0000239
Gerd Hoffmanne04da7c2011-11-21 11:17:59 +0100240 DPRINTF("Command status %d tag 0x%x, len %zd\n",
Benjamin Herrenschmidte2854bf2012-03-08 11:41:10 +1100241 s->csw.status, le32_to_cpu(s->csw.tag), p->iov.size);
Gerd Hoffmannab4797a2010-12-09 10:36:35 +0100242
Benjamin Herrenschmidte2854bf2012-03-08 11:41:10 +1100243 assert(s->csw.sig == cpu_to_le32(0x53425355));
Gerd Hoffmann92a114f2011-11-21 11:29:27 +0100244 len = MIN(sizeof(s->csw), p->iov.size);
245 usb_packet_copy(p, &s->csw, len);
246 memset(&s->csw, 0, sizeof(s->csw));
pbrooka917d382006-08-29 04:52:16 +0000247}
248
Gerd Hoffmann1e6ed802012-05-22 14:30:20 +0200249static 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
Paolo Bonziniaba1f022011-05-20 20:18:07 +0200261static void usb_msd_transfer_data(SCSIRequest *req, uint32_t len)
pbrook2e5d83b2006-05-25 23:58:51 +0000262{
Hannes Reinecke5c6c0e52011-04-18 12:35:39 +0200263 MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
pbrooka917d382006-08-29 04:52:16 +0000264 USBPacket *p = s->packet;
pbrook2e5d83b2006-05-25 23:58:51 +0000265
Paolo Bonziniad3376c2011-04-18 15:28:11 +0200266 assert((s->mode == USB_MSDM_DATAOUT) == (req->cmd.mode == SCSI_XFER_TO_DEV));
Paolo Bonziniaba1f022011-05-20 20:18:07 +0200267 s->scsi_len = len;
Gerd Hoffmann1dc90362012-05-16 15:03:40 +0200268 s->scsi_off = 0;
pbrooka917d382006-08-29 04:52:16 +0000269 if (p) {
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200270 usb_msd_copy_data(s, p);
271 p = s->packet;
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100272 if (p && p->actual_length == p->iov.size) {
273 p->status = USB_RET_SUCCESS; /* Clear previous ASYNC status */
Gerd Hoffmann1e6ed802012-05-22 14:30:20 +0200274 usb_msd_packet_complete(s);
pbrooka917d382006-08-29 04:52:16 +0000275 }
pbrook4d611c92006-08-12 01:04:27 +0000276 }
pbrook2e5d83b2006-05-25 23:58:51 +0000277}
278
Paolo Bonzini01e95452011-07-06 11:55:37 +0200279static void usb_msd_command_complete(SCSIRequest *req, uint32_t status, size_t resid)
Paolo Bonzinic6df7102011-04-22 12:27:30 +0200280{
281 MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
282 USBPacket *p = s->packet;
283
Gerd Hoffmann7b863f42011-11-21 11:36:17 +0100284 DPRINTF("Command complete %d tag 0x%x\n", status, req->tag);
Gerd Hoffmann92a114f2011-11-21 11:29:27 +0100285
286 s->csw.sig = cpu_to_le32(0x53425355);
Gerd Hoffmann7b863f42011-11-21 11:36:17 +0100287 s->csw.tag = cpu_to_le32(req->tag);
Gerd Hoffmann06598792012-05-14 14:00:02 +0200288 s->csw.residue = cpu_to_le32(s->data_len);
Gerd Hoffmann414c4602011-11-21 11:41:30 +0100289 s->csw.status = status != 0;
Gerd Hoffmann92a114f2011-11-21 11:29:27 +0100290
Paolo Bonzinic6df7102011-04-22 12:27:30 +0200291 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;
Gerd Hoffmann54414212012-07-13 11:38:13 +0200297 } else if (s->mode == USB_MSDM_CSW) {
298 usb_msd_send_status(s, p);
299 s->mode = USB_MSDM_CBW;
Paolo Bonzinic6df7102011-04-22 12:27:30 +0200300 } else {
301 if (s->data_len) {
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100302 int len = (p->iov.size - p->actual_length);
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200303 usb_packet_skip(p, len);
304 s->data_len -= len;
Paolo Bonzinic6df7102011-04-22 12:27:30 +0200305 }
306 if (s->data_len == 0) {
307 s->mode = USB_MSDM_CSW;
308 }
309 }
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100310 p->status = USB_RET_SUCCESS; /* Clear previous ASYNC status */
Gerd Hoffmann1e6ed802012-05-22 14:30:20 +0200311 usb_msd_packet_complete(s);
Paolo Bonzinic6df7102011-04-22 12:27:30 +0200312 } else if (s->data_len == 0) {
313 s->mode = USB_MSDM_CSW;
314 }
315 scsi_req_unref(req);
316 s->req = NULL;
317}
318
Paolo Bonzini94d3f982011-04-18 22:53:08 +0200319static 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;
Paolo Bonzini94d3f982011-04-18 22:53:08 +0200326 s->scsi_len = 0;
327 }
328}
329
bellard059809e2006-07-19 18:06:15 +0000330static void usb_msd_handle_reset(USBDevice *dev)
pbrook2e5d83b2006-05-25 23:58:51 +0000331{
332 MSDState *s = (MSDState *)dev;
333
334 DPRINTF("Reset\n");
Gerd Hoffmann24a5bbe2012-01-04 18:13:54 +0100335 if (s->req) {
336 scsi_req_cancel(s->req);
337 }
338 assert(s->req == NULL);
339
340 if (s->packet) {
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100341 s->packet->status = USB_RET_STALL;
Gerd Hoffmann1e6ed802012-05-22 14:30:20 +0200342 usb_msd_packet_complete(s);
Gerd Hoffmann24a5bbe2012-01-04 18:13:54 +0100343 }
344
pbrook2e5d83b2006-05-25 23:58:51 +0000345 s->mode = USB_MSDM_CBW;
pbrook2e5d83b2006-05-25 23:58:51 +0000346}
347
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100348static void usb_msd_handle_control(USBDevice *dev, USBPacket *p,
Hans de Goede007fd622011-02-02 16:33:13 +0100349 int request, int value, int index, int length, uint8_t *data)
pbrook2e5d83b2006-05-25 23:58:51 +0000350{
351 MSDState *s = (MSDState *)dev;
Gerd Hoffmann34707332013-01-14 15:29:44 +0100352 SCSIDevice *scsi_dev;
353 int ret, maxlun;
pbrook2e5d83b2006-05-25 23:58:51 +0000354
Hans de Goede007fd622011-02-02 16:33:13 +0100355 ret = usb_desc_handle_control(dev, p, request, value, index, length, data);
Gerd Hoffmann81bfd2f2010-11-17 11:05:41 +0100356 if (ret >= 0) {
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100357 return;
Gerd Hoffmann81bfd2f2010-11-17 11:05:41 +0100358 }
359
pbrook2e5d83b2006-05-25 23:58:51 +0000360 switch (request) {
pbrook2e5d83b2006-05-25 23:58:51 +0000361 case EndpointOutRequest | USB_REQ_CLEAR_FEATURE:
Arnaud Patard (Rtp)e5322f72010-03-10 10:45:12 +0100362 break;
pbrook2e5d83b2006-05-25 23:58:51 +0000363 /* Class specific requests. */
Max Reitzf3571b12010-03-14 12:19:03 +0100364 case ClassInterfaceOutRequest | MassStorageReset:
pbrook2e5d83b2006-05-25 23:58:51 +0000365 /* Reset state ready for the next CBW. */
366 s->mode = USB_MSDM_CBW;
pbrook2e5d83b2006-05-25 23:58:51 +0000367 break;
Max Reitzf3571b12010-03-14 12:19:03 +0100368 case ClassInterfaceRequest | GetMaxLun:
Gerd Hoffmann34707332013-01-14 15:29:44 +0100369 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;
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100382 p->actual_length = 1;
pbrook2e5d83b2006-05-25 23:58:51 +0000383 break;
384 default:
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100385 p->status = USB_RET_STALL;
pbrook2e5d83b2006-05-25 23:58:51 +0000386 break;
387 }
pbrook2e5d83b2006-05-25 23:58:51 +0000388}
389
Gerd Hoffmanneb5e6802011-05-16 10:34:53 +0200390static void usb_msd_cancel_io(USBDevice *dev, USBPacket *p)
pbrook4d611c92006-08-12 01:04:27 +0000391{
Gonglei79e25902015-05-06 20:55:32 +0800392 MSDState *s = USB_STORAGE_DEV(dev);
Gerd Hoffmannd3ac1a82011-09-02 13:05:13 +0200393
Gerd Hoffmann6d7aeee2012-04-18 12:08:29 +0200394 assert(s->packet == p);
395 s->packet = NULL;
396
Gerd Hoffmannd3ac1a82011-09-02 13:05:13 +0200397 if (s->req) {
398 scsi_req_cancel(s->req);
399 }
pbrook4d611c92006-08-12 01:04:27 +0000400}
401
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100402static void usb_msd_handle_data(USBDevice *dev, USBPacket *p)
pbrook2e5d83b2006-05-25 23:58:51 +0000403{
404 MSDState *s = (MSDState *)dev;
Gerd Hoffmann7b863f42011-11-21 11:36:17 +0100405 uint32_t tag;
pbrook2e5d83b2006-05-25 23:58:51 +0000406 struct usb_msd_cbw cbw;
Gerd Hoffmann079d0b72012-01-12 13:23:01 +0100407 uint8_t devep = p->ep->nr;
Gerd Hoffmann34707332013-01-14 15:29:44 +0100408 SCSIDevice *scsi_dev;
Gerd Hoffmann9db7c412013-01-22 14:17:05 +0100409 uint32_t len;
pbrook2e5d83b2006-05-25 23:58:51 +0000410
pbrook4d611c92006-08-12 01:04:27 +0000411 switch (p->pid) {
pbrook2e5d83b2006-05-25 23:58:51 +0000412 case USB_TOKEN_OUT:
413 if (devep != 2)
414 goto fail;
415
416 switch (s->mode) {
417 case USB_MSDM_CBW:
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200418 if (p->iov.size != 31) {
Gongleif5dc5972014-09-19 14:48:30 +0800419 error_report("usb-msd: Bad CBW size");
pbrook2e5d83b2006-05-25 23:58:51 +0000420 goto fail;
421 }
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200422 usb_packet_copy(p, &cbw, 31);
pbrook2e5d83b2006-05-25 23:58:51 +0000423 if (le32_to_cpu(cbw.sig) != 0x43425355) {
Gongleif5dc5972014-09-19 14:48:30 +0800424 error_report("usb-msd: Bad signature %08x",
425 le32_to_cpu(cbw.sig));
pbrook2e5d83b2006-05-25 23:58:51 +0000426 goto fail;
427 }
428 DPRINTF("Command on LUN %d\n", cbw.lun);
Gerd Hoffmann34707332013-01-14 15:29:44 +0100429 scsi_dev = scsi_device_find(&s->bus, 0, 0, cbw.lun);
430 if (scsi_dev == NULL) {
Gongleif5dc5972014-09-19 14:48:30 +0800431 error_report("usb-msd: Bad LUN %d", cbw.lun);
pbrook2e5d83b2006-05-25 23:58:51 +0000432 goto fail;
433 }
Gerd Hoffmann7b863f42011-11-21 11:36:17 +0100434 tag = le32_to_cpu(cbw.tag);
pbrook2e5d83b2006-05-25 23:58:51 +0000435 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",
Gerd Hoffmann7b863f42011-11-21 11:36:17 +0100444 tag, cbw.flags, cbw.cmd_len, s->data_len);
Gerd Hoffmann06598792012-05-14 14:00:02 +0200445 assert(le32_to_cpu(s->csw.residue) == 0);
Gerd Hoffmannef0bdf72011-05-04 16:49:56 +0200446 s->scsi_len = 0;
Gerd Hoffmann34707332013-01-14 15:29:44 +0100447 s->req = scsi_req_new(scsi_dev, tag, cbw.lun, cbw.cmd, NULL);
Gerd Hoffmann06f98472012-07-13 11:35:51 +0200448#ifdef DEBUG_MSD
449 scsi_req_print(s->req);
450#endif
Gerd Hoffmann9db7c412013-01-22 14:17:05 +0100451 len = scsi_req_enqueue(s->req);
452 if (len) {
Paolo Bonziniad3376c2011-04-18 15:28:11 +0200453 scsi_req_continue(s->req);
pbrooka917d382006-08-29 04:52:16 +0000454 }
pbrook2e5d83b2006-05-25 23:58:51 +0000455 break;
456
457 case USB_MSDM_DATAOUT:
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200458 DPRINTF("Data out %zd/%d\n", p->iov.size, s->data_len);
459 if (p->iov.size > s->data_len) {
pbrook2e5d83b2006-05-25 23:58:51 +0000460 goto fail;
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200461 }
pbrook2e5d83b2006-05-25 23:58:51 +0000462
pbrooka917d382006-08-29 04:52:16 +0000463 if (s->scsi_len) {
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200464 usb_msd_copy_data(s, p);
pbrooka917d382006-08-29 04:52:16 +0000465 }
Gerd Hoffmann06598792012-05-14 14:00:02 +0200466 if (le32_to_cpu(s->csw.residue)) {
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100467 int len = p->iov.size - p->actual_length;
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200468 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 }
pbrooka917d382006-08-29 04:52:16 +0000475 }
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100476 if (p->actual_length < p->iov.size) {
Gerd Hoffmann06f98472012-07-13 11:35:51 +0200477 DPRINTF("Deferring packet %p [wait data-out]\n", p);
pbrook4d611c92006-08-12 01:04:27 +0000478 s->packet = p;
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100479 p->status = USB_RET_ASYNC;
pbrook4d611c92006-08-12 01:04:27 +0000480 }
pbrook2e5d83b2006-05-25 23:58:51 +0000481 break;
482
483 default:
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200484 DPRINTF("Unexpected write (len %zd)\n", p->iov.size);
pbrook2e5d83b2006-05-25 23:58:51 +0000485 goto fail;
486 }
487 break;
488
489 case USB_TOKEN_IN:
490 if (devep != 1)
491 goto fail;
492
493 switch (s->mode) {
pbrooka917d382006-08-29 04:52:16 +0000494 case USB_MSDM_DATAOUT:
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200495 if (s->data_len != 0 || p->iov.size < 13) {
pbrooka917d382006-08-29 04:52:16 +0000496 goto fail;
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200497 }
pbrooka917d382006-08-29 04:52:16 +0000498 /* Waiting for SCSI write to complete. */
pbrooka917d382006-08-29 04:52:16 +0000499 s->packet = p;
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100500 p->status = USB_RET_ASYNC;
pbrooka917d382006-08-29 04:52:16 +0000501 break;
502
pbrook2e5d83b2006-05-25 23:58:51 +0000503 case USB_MSDM_CSW:
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200504 if (p->iov.size < 13) {
pbrook2e5d83b2006-05-25 23:58:51 +0000505 goto fail;
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200506 }
pbrook2e5d83b2006-05-25 23:58:51 +0000507
Gerd Hoffmann59310652011-11-21 14:01:26 +0100508 if (s->req) {
509 /* still in flight */
Gerd Hoffmann06f98472012-07-13 11:35:51 +0200510 DPRINTF("Deferring packet %p [wait status]\n", p);
Gerd Hoffmann59310652011-11-21 14:01:26 +0100511 s->packet = p;
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100512 p->status = USB_RET_ASYNC;
Gerd Hoffmann59310652011-11-21 14:01:26 +0100513 } else {
514 usb_msd_send_status(s, p);
515 s->mode = USB_MSDM_CBW;
Gerd Hoffmann59310652011-11-21 14:01:26 +0100516 }
pbrook2e5d83b2006-05-25 23:58:51 +0000517 break;
518
519 case USB_MSDM_DATAIN:
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200520 DPRINTF("Data in %zd/%d, scsi_len %d\n",
521 p->iov.size, s->data_len, s->scsi_len);
pbrooka917d382006-08-29 04:52:16 +0000522 if (s->scsi_len) {
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200523 usb_msd_copy_data(s, p);
pbrooka917d382006-08-29 04:52:16 +0000524 }
Gerd Hoffmann06598792012-05-14 14:00:02 +0200525 if (le32_to_cpu(s->csw.residue)) {
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100526 int len = p->iov.size - p->actual_length;
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200527 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 }
pbrooka917d382006-08-29 04:52:16 +0000534 }
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100535 if (p->actual_length < p->iov.size) {
Gerd Hoffmann06f98472012-07-13 11:35:51 +0200536 DPRINTF("Deferring packet %p [wait data-in]\n", p);
pbrook4d611c92006-08-12 01:04:27 +0000537 s->packet = p;
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100538 p->status = USB_RET_ASYNC;
pbrook4d611c92006-08-12 01:04:27 +0000539 }
pbrook2e5d83b2006-05-25 23:58:51 +0000540 break;
541
542 default:
Gerd Hoffmann29c74f72011-07-13 12:32:06 +0200543 DPRINTF("Unexpected read (len %zd)\n", p->iov.size);
pbrook2e5d83b2006-05-25 23:58:51 +0000544 goto fail;
545 }
546 break;
547
548 default:
549 DPRINTF("Bad token\n");
550 fail:
Hans de Goede9a77a0f2012-11-01 17:15:01 +0100551 p->status = USB_RET_STALL;
pbrook2e5d83b2006-05-25 23:58:51 +0000552 break;
553 }
pbrook2e5d83b2006-05-25 23:58:51 +0000554}
555
Gerd Hoffmannb3e461d2009-10-26 15:56:49 +0100556static void usb_msd_password_cb(void *opaque, int err)
557{
558 MSDState *s = opaque;
Gonglei7d553f22014-09-19 14:48:24 +0800559 Error *local_err = NULL;
Gerd Hoffmannb3e461d2009-10-26 15:56:49 +0100560
Gonglei7d553f22014-09-19 14:48:24 +0800561 if (!err) {
562 usb_device_attach(&s->dev, &local_err);
563 }
Hans de Goedefa19bf82011-05-27 19:05:15 +0200564
Gonglei7d553f22014-09-19 14:48:24 +0800565 if (local_err) {
Markus Armbrusterc3265292015-03-12 17:26:50 +0100566 error_report_err(local_err);
Luiz Capitulino56f91072012-03-14 17:37:38 -0300567 qdev_unplug(&s->dev.qdev, NULL);
Gonglei7d553f22014-09-19 14:48:24 +0800568 }
Gerd Hoffmannb3e461d2009-10-26 15:56:49 +0100569}
570
Gerd Hoffmann5de88b12012-05-14 13:56:40 +0200571static 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
Gerd Hoffmann34707332013-01-14 15:29:44 +0100582static const struct SCSIBusInfo usb_msd_scsi_info_storage = {
Paolo Bonziniafd40302011-08-13 15:44:45 +0200583 .tcq = false,
Paolo Bonzini7e0380b2011-08-13 18:55:17 +0200584 .max_target = 0,
585 .max_lun = 0,
Paolo Bonziniafd40302011-08-13 15:44:45 +0200586
Paolo Bonzinic6df7102011-04-22 12:27:30 +0200587 .transfer_data = usb_msd_transfer_data,
Paolo Bonzini94d3f982011-04-18 22:53:08 +0200588 .complete = usb_msd_command_complete,
Gerd Hoffmann5de88b12012-05-14 13:56:40 +0200589 .cancel = usb_msd_request_cancelled,
590 .load_request = usb_msd_load_request,
Paolo Bonzinicfdc1bb2011-04-18 17:11:14 +0200591};
592
Gerd Hoffmann34707332013-01-14 15:29:44 +0100593static 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
Gonglei5a882e42014-09-19 14:48:29 +0800604static void usb_msd_realize_storage(USBDevice *dev, Error **errp)
Gerd Hoffmann806b6022009-08-31 14:23:59 +0200605{
Gonglei79e25902015-05-06 20:55:32 +0800606 MSDState *s = USB_STORAGE_DEV(dev);
Markus Armbruster4be74632014-10-07 13:59:18 +0200607 BlockBackend *blk = s->conf.blk;
Gerd Hoffmann34707332013-01-14 15:29:44 +0100608 SCSIDevice *scsi_dev;
Andreas Färbercaad4eb2013-07-21 12:16:34 +0200609 Error *err = NULL;
Gerd Hoffmann806b6022009-08-31 14:23:59 +0200610
Markus Armbruster4be74632014-10-07 13:59:18 +0200611 if (!blk) {
Gonglei5a882e42014-09-19 14:48:29 +0800612 error_setg(errp, "drive property not set");
613 return;
Gerd Hoffmann7fc2f2c2009-08-31 14:24:05 +0200614 }
615
Max Reitz7d3467d2015-10-19 17:53:17 +0200616 if (blk_bs(blk)) {
617 bdrv_add_key(blk_bs(blk), NULL, &err);
618 if (err) {
619 if (monitor_cur_is_qmp()) {
620 error_propagate(errp, err);
621 return;
622 }
623 error_free(err);
624 err = NULL;
625 if (cur_mon) {
626 monitor_read_bdrv_key_start(cur_mon, blk_bs(blk),
627 usb_msd_password_cb, s);
628 s->dev.auto_attach = 0;
629 } else {
630 autostart = 0;
631 }
Markus Armbruster7afcc1f2015-03-12 17:26:49 +0100632 }
633 }
634
Gerd Hoffmann71938a02013-06-12 13:01:49 +0200635 blkconf_serial(&s->conf, &dev->serial);
Ekaterina Tumanova0eb28a42015-02-16 12:47:58 +0100636 blkconf_blocksizes(&s->conf);
Markus Armbruster911525d2012-07-11 15:08:37 +0200637
Markus Armbruster14bafc52010-06-25 08:09:10 +0200638 /*
639 * Hack alert: this pretends to be a block device, but it's really
640 * a SCSI bus that can serve only a single device, which it
Markus Armbruster18846de2010-06-29 16:58:30 +0200641 * creates automatically. But first it needs to detach from its
642 * blockdev, or else scsi_bus_legacy_add_drive() dies when it
643 * attaches again.
Markus Armbruster14bafc52010-06-25 08:09:10 +0200644 *
645 * The hack is probably a bad idea.
646 */
Markus Armbruster4be74632014-10-07 13:59:18 +0200647 blk_detach_dev(blk, &s->dev.qdev);
648 s->conf.blk = NULL;
Markus Armbruster14bafc52010-06-25 08:09:10 +0200649
Gerd Hoffmann71938a02013-06-12 13:01:49 +0200650 usb_desc_create_serial(dev);
Gerd Hoffmanna980a062010-11-26 20:20:41 +0100651 usb_desc_init(dev);
Andreas Färberb1187b52013-08-23 20:30:03 +0200652 scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(dev),
653 &usb_msd_scsi_info_storage, NULL);
Markus Armbruster4be74632014-10-07 13:59:18 +0200654 scsi_dev = scsi_bus_legacy_add_drive(&s->bus, blk, 0, !!s->removable,
Andreas Färbercaad4eb2013-07-21 12:16:34 +0200655 s->conf.bootindex, dev->serial,
656 &err);
Gerd Hoffmann34707332013-01-14 15:29:44 +0100657 if (!scsi_dev) {
Gonglei5a882e42014-09-19 14:48:29 +0800658 error_propagate(errp, err);
659 return;
Markus Armbrusterfa66b902010-06-25 18:53:21 +0200660 }
Gerd Hoffmann7fc2f2c2009-08-31 14:24:05 +0200661 usb_msd_handle_reset(dev);
Gonglei89f07622014-10-07 16:00:33 +0800662 s->scsi_dev = scsi_dev;
Gerd Hoffmann806b6022009-08-31 14:23:59 +0200663}
664
Gonglei5a882e42014-09-19 14:48:29 +0800665static void usb_msd_realize_bot(USBDevice *dev, Error **errp)
Gerd Hoffmann34707332013-01-14 15:29:44 +0100666{
Gonglei79e25902015-05-06 20:55:32 +0800667 MSDState *s = USB_STORAGE_DEV(dev);
Gerd Hoffmann34707332013-01-14 15:29:44 +0100668
669 usb_desc_create_serial(dev);
670 usb_desc_init(dev);
Andreas Färberb1187b52013-08-23 20:30:03 +0200671 scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(dev),
672 &usb_msd_scsi_info_bot, NULL);
Gerd Hoffmann34707332013-01-14 15:29:44 +0100673 usb_msd_handle_reset(dev);
Gerd Hoffmann34707332013-01-14 15:29:44 +0100674}
675
Jan Kiszka37417152012-02-27 15:18:47 +0100676static USBDevice *usb_msd_init(USBBus *bus, const char *filename)
pbrook2e5d83b2006-05-25 23:58:51 +0000677{
Gerd Hoffmann7fc2f2c2009-08-31 14:24:05 +0200678 static int nr=0;
Markus Armbruster9b3d1112015-03-09 19:17:26 +0100679 Error *err = NULL;
Gerd Hoffmann7fc2f2c2009-08-31 14:24:05 +0200680 char id[8];
681 QemuOpts *opts;
682 DriveInfo *dinfo;
Gerd Hoffmann806b6022009-08-31 14:23:59 +0200683 USBDevice *dev;
aurel32334c0242008-08-21 22:24:32 +0000684 const char *p1;
685 char fmt[32];
686
Gerd Hoffmann7fc2f2c2009-08-31 14:24:05 +0200687 /* parse -usbdevice disk: syntax into drive opts */
Markus Armbruster31376772014-09-12 21:24:34 +0200688 do {
689 snprintf(id, sizeof(id), "usb%d", nr++);
690 opts = qemu_opts_create(qemu_find_opts("drive"), id, 1, NULL);
691 } while (!opts);
Gerd Hoffmann7fc2f2c2009-08-31 14:24:05 +0200692
aurel32334c0242008-08-21 22:24:32 +0000693 p1 = strchr(filename, ':');
694 if (p1++) {
695 const char *p2;
696
697 if (strstart(filename, "format=", &p2)) {
698 int len = MIN(p1 - p2, sizeof(fmt));
699 pstrcpy(fmt, len, p2);
Markus Armbrusterf43e47d2015-02-12 17:52:20 +0100700 qemu_opt_set(opts, "format", fmt, &error_abort);
aurel32334c0242008-08-21 22:24:32 +0000701 } else if (*filename != ':') {
Gongleif5dc5972014-09-19 14:48:30 +0800702 error_report("unrecognized USB mass-storage option %s", filename);
aurel32334c0242008-08-21 22:24:32 +0000703 return NULL;
704 }
aurel32334c0242008-08-21 22:24:32 +0000705 filename = p1;
706 }
aurel32334c0242008-08-21 22:24:32 +0000707 if (!*filename) {
Gongleif5dc5972014-09-19 14:48:30 +0800708 error_report("block device specification needed");
aurel32334c0242008-08-21 22:24:32 +0000709 return NULL;
710 }
Markus Armbrusterf43e47d2015-02-12 17:52:20 +0100711 qemu_opt_set(opts, "file", filename, &error_abort);
712 qemu_opt_set(opts, "if", "none", &error_abort);
pbrook2e5d83b2006-05-25 23:58:51 +0000713
Gerd Hoffmann7fc2f2c2009-08-31 14:24:05 +0200714 /* create host drive */
Markus Armbruster60e19e02014-06-06 14:50:58 +0200715 dinfo = drive_new(opts, 0);
Gerd Hoffmann7fc2f2c2009-08-31 14:24:05 +0200716 if (!dinfo) {
717 qemu_opts_del(opts);
Gerd Hoffmann806b6022009-08-31 14:23:59 +0200718 return NULL;
Gerd Hoffmann7fc2f2c2009-08-31 14:24:05 +0200719 }
Gerd Hoffmann806b6022009-08-31 14:23:59 +0200720
Gerd Hoffmann7fc2f2c2009-08-31 14:24:05 +0200721 /* create guest device */
Jan Kiszka37417152012-02-27 15:18:47 +0100722 dev = usb_create(bus, "usb-storage");
Markus Armbruster9b3d1112015-03-09 19:17:26 +0100723 qdev_prop_set_drive(&dev->qdev, "drive", blk_by_legacy_dinfo(dinfo),
724 &err);
725 if (err) {
726 error_report_err(err);
Stefan Hajnoczi02a5c4c2013-09-11 14:54:09 +0200727 object_unparent(OBJECT(dev));
Markus Armbruster18846de2010-06-29 16:58:30 +0200728 return NULL;
729 }
Gerd Hoffmann7fc2f2c2009-08-31 14:24:05 +0200730 return dev;
pbrook2e5d83b2006-05-25 23:58:51 +0000731}
aliguoribb5fc202009-03-05 23:01:15 +0000732
Gerd Hoffmannf54b6562010-12-10 14:58:41 +0100733static const VMStateDescription vmstate_usb_msd = {
734 .name = "usb-storage",
Gerd Hoffmannf54b6562010-12-10 14:58:41 +0100735 .version_id = 1,
736 .minimum_version_id = 1,
Juan Quintela6e3d6522014-04-16 13:31:26 +0200737 .fields = (VMStateField[]) {
Gerd Hoffmannf54b6562010-12-10 14:58:41 +0100738 VMSTATE_USB_DEVICE(dev, MSDState),
Gerd Hoffmann5de88b12012-05-14 13:56:40 +0200739 VMSTATE_UINT32(mode, MSDState),
740 VMSTATE_UINT32(scsi_len, MSDState),
741 VMSTATE_UINT32(scsi_off, MSDState),
742 VMSTATE_UINT32(data_len, MSDState),
743 VMSTATE_UINT32(csw.sig, MSDState),
744 VMSTATE_UINT32(csw.tag, MSDState),
745 VMSTATE_UINT32(csw.residue, MSDState),
746 VMSTATE_UINT8(csw.status, MSDState),
Gerd Hoffmannf54b6562010-12-10 14:58:41 +0100747 VMSTATE_END_OF_LIST()
748 }
749};
750
Anthony Liguori39bffca2011-12-07 21:34:16 -0600751static Property msd_properties[] = {
752 DEFINE_BLOCK_PROPERTIES(MSDState, conf),
Anthony Liguori39bffca2011-12-07 21:34:16 -0600753 DEFINE_PROP_BIT("removable", MSDState, removable, 0, false),
754 DEFINE_PROP_END_OF_LIST(),
755};
756
Gonglei79e25902015-05-06 20:55:32 +0800757static void usb_msd_class_initfn_common(ObjectClass *klass, void *data)
Anthony Liguori62aed762011-12-15 14:53:10 -0600758{
Anthony Liguori39bffca2011-12-07 21:34:16 -0600759 DeviceClass *dc = DEVICE_CLASS(klass);
Anthony Liguori62aed762011-12-15 14:53:10 -0600760 USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
761
Anthony Liguori62aed762011-12-15 14:53:10 -0600762 uc->product_desc = "QEMU USB MSD";
763 uc->usb_desc = &desc;
Anthony Liguori62aed762011-12-15 14:53:10 -0600764 uc->cancel_packet = usb_msd_cancel_io;
765 uc->handle_attach = usb_desc_attach;
766 uc->handle_reset = usb_msd_handle_reset;
767 uc->handle_control = usb_msd_handle_control;
768 uc->handle_data = usb_msd_handle_data;
Marcel Apfelbaum125ee0e2013-07-29 17:17:45 +0300769 set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
Anthony Liguori39bffca2011-12-07 21:34:16 -0600770 dc->fw_name = "storage";
771 dc->vmsd = &vmstate_usb_msd;
Gerd Hoffmann34707332013-01-14 15:29:44 +0100772}
773
774static void usb_msd_class_initfn_storage(ObjectClass *klass, void *data)
775{
776 DeviceClass *dc = DEVICE_CLASS(klass);
777 USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
778
Gonglei5a882e42014-09-19 14:48:29 +0800779 uc->realize = usb_msd_realize_storage;
Anthony Liguori39bffca2011-12-07 21:34:16 -0600780 dc->props = msd_properties;
Gerd Hoffmann34707332013-01-14 15:29:44 +0100781}
782
Gonglei89f07622014-10-07 16:00:33 +0800783static void usb_msd_get_bootindex(Object *obj, Visitor *v, void *opaque,
784 const char *name, Error **errp)
785{
786 USBDevice *dev = USB_DEVICE(obj);
Gonglei79e25902015-05-06 20:55:32 +0800787 MSDState *s = USB_STORAGE_DEV(dev);
Gonglei89f07622014-10-07 16:00:33 +0800788
789 visit_type_int32(v, &s->conf.bootindex, name, errp);
790}
791
792static void usb_msd_set_bootindex(Object *obj, Visitor *v, void *opaque,
793 const char *name, Error **errp)
794{
795 USBDevice *dev = USB_DEVICE(obj);
Gonglei79e25902015-05-06 20:55:32 +0800796 MSDState *s = USB_STORAGE_DEV(dev);
Gonglei89f07622014-10-07 16:00:33 +0800797 int32_t boot_index;
798 Error *local_err = NULL;
799
800 visit_type_int32(v, &boot_index, name, &local_err);
801 if (local_err) {
802 goto out;
803 }
804 /* check whether bootindex is present in fw_boot_order list */
805 check_boot_index(boot_index, &local_err);
806 if (local_err) {
807 goto out;
808 }
809 /* change bootindex to a new one */
810 s->conf.bootindex = boot_index;
811
812 if (s->scsi_dev) {
813 object_property_set_int(OBJECT(s->scsi_dev), boot_index, "bootindex",
814 &error_abort);
815 }
816
817out:
818 if (local_err) {
819 error_propagate(errp, local_err);
820 }
821}
822
Gonglei79e25902015-05-06 20:55:32 +0800823static const TypeInfo usb_storage_dev_type_info = {
824 .name = TYPE_USB_STORAGE,
825 .parent = TYPE_USB_DEVICE,
826 .instance_size = sizeof(MSDState),
827 .abstract = true,
828 .class_init = usb_msd_class_initfn_common,
829};
830
Gonglei89f07622014-10-07 16:00:33 +0800831static void usb_msd_instance_init(Object *obj)
832{
833 object_property_add(obj, "bootindex", "int32",
834 usb_msd_get_bootindex,
835 usb_msd_set_bootindex, NULL, NULL, NULL);
836 object_property_set_int(obj, -1, "bootindex", NULL);
837}
838
Gerd Hoffmann34707332013-01-14 15:29:44 +0100839static void usb_msd_class_initfn_bot(ObjectClass *klass, void *data)
840{
841 USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
Igor Mammedove9fd12a2014-09-26 09:28:35 +0000842 DeviceClass *dc = DEVICE_CLASS(klass);
Gerd Hoffmann34707332013-01-14 15:29:44 +0100843
Gonglei5a882e42014-09-19 14:48:29 +0800844 uc->realize = usb_msd_realize_bot;
Igor Mammedove9fd12a2014-09-26 09:28:35 +0000845 dc->hotpluggable = false;
Anthony Liguori62aed762011-12-15 14:53:10 -0600846}
847
Andreas Färber8c43a6f2013-01-10 16:19:07 +0100848static const TypeInfo msd_info = {
Anthony Liguori39bffca2011-12-07 21:34:16 -0600849 .name = "usb-storage",
Gonglei79e25902015-05-06 20:55:32 +0800850 .parent = TYPE_USB_STORAGE,
Gerd Hoffmann34707332013-01-14 15:29:44 +0100851 .class_init = usb_msd_class_initfn_storage,
Gonglei89f07622014-10-07 16:00:33 +0800852 .instance_init = usb_msd_instance_init,
Gerd Hoffmann34707332013-01-14 15:29:44 +0100853};
854
855static const TypeInfo bot_info = {
856 .name = "usb-bot",
Gonglei79e25902015-05-06 20:55:32 +0800857 .parent = TYPE_USB_STORAGE,
Gerd Hoffmann34707332013-01-14 15:29:44 +0100858 .class_init = usb_msd_class_initfn_bot,
Gerd Hoffmann806b6022009-08-31 14:23:59 +0200859};
860
Andreas Färber83f7d432012-02-09 15:20:55 +0100861static void usb_msd_register_types(void)
Gerd Hoffmann806b6022009-08-31 14:23:59 +0200862{
Gonglei79e25902015-05-06 20:55:32 +0800863 type_register_static(&usb_storage_dev_type_info);
Anthony Liguori39bffca2011-12-07 21:34:16 -0600864 type_register_static(&msd_info);
Gerd Hoffmann34707332013-01-14 15:29:44 +0100865 type_register_static(&bot_info);
Anthony Liguoriba024302011-12-08 14:56:53 -0600866 usb_legacy_register("usb-storage", "disk", usb_msd_init);
Gerd Hoffmann806b6022009-08-31 14:23:59 +0200867}
Andreas Färber83f7d432012-02-09 15:20:55 +0100868
869type_init(usb_msd_register_types)