ths | 5fafdf2 | 2007-09-16 21:08:06 +0000 | [diff] [blame] | 1 | /* |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 2 | * USB Mass Storage Device emulation |
| 3 | * |
| 4 | * Copyright (c) 2006 CodeSourcery. |
| 5 | * Written by Paul Brook |
| 6 | * |
Matthew Fernandez | 8e31bf3 | 2011-06-26 12:21:35 +1000 | [diff] [blame] | 7 | * This code is licensed under the LGPL. |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 8 | */ |
| 9 | |
pbrook | 87ecb68 | 2007-11-17 17:14:51 +0000 | [diff] [blame] | 10 | #include "qemu-common.h" |
Markus Armbruster | d49b683 | 2015-03-17 18:29:20 +0100 | [diff] [blame] | 11 | #include "qemu/error-report.h" |
Paolo Bonzini | 1de7afc | 2012-12-17 18:20:00 +0100 | [diff] [blame] | 12 | #include "qemu/option.h" |
| 13 | #include "qemu/config-file.h" |
Gerd Hoffmann | f1ae32a | 2012-03-07 14:55:18 +0100 | [diff] [blame] | 14 | #include "hw/usb.h" |
| 15 | #include "hw/usb/desc.h" |
Paolo Bonzini | 0d09e41 | 2013-02-05 17:06:20 +0100 | [diff] [blame] | 16 | #include "hw/scsi/scsi.h" |
Paolo Bonzini | 28ecbae | 2012-11-28 12:06:30 +0100 | [diff] [blame] | 17 | #include "ui/console.h" |
Paolo Bonzini | 83c9089 | 2012-12-17 18:19:49 +0100 | [diff] [blame] | 18 | #include "monitor/monitor.h" |
Paolo Bonzini | 9c17d61 | 2012-12-17 18:20:04 +0100 | [diff] [blame] | 19 | #include "sysemu/sysemu.h" |
Markus Armbruster | fa1d36d | 2014-10-07 13:59:13 +0200 | [diff] [blame] | 20 | #include "sysemu/block-backend.h" |
Paolo Bonzini | 9c17d61 | 2012-12-17 18:20:04 +0100 | [diff] [blame] | 21 | #include "sysemu/blockdev.h" |
Gonglei | 89f0762 | 2014-10-07 16:00:33 +0800 | [diff] [blame] | 22 | #include "qapi/visitor.h" |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 23 | |
| 24 | //#define DEBUG_MSD |
| 25 | |
| 26 | #ifdef DEBUG_MSD |
Blue Swirl | 001faf3 | 2009-05-13 17:53:17 +0000 | [diff] [blame] | 27 | #define DPRINTF(fmt, ...) \ |
| 28 | do { printf("usb-msd: " fmt , ## __VA_ARGS__); } while (0) |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 29 | #else |
Blue Swirl | 001faf3 | 2009-05-13 17:53:17 +0000 | [diff] [blame] | 30 | #define DPRINTF(fmt, ...) do {} while(0) |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 31 | #endif |
| 32 | |
| 33 | /* USB requests. */ |
| 34 | #define MassStorageReset 0xff |
| 35 | #define GetMaxLun 0xfe |
| 36 | |
| 37 | enum USBMSDMode { |
| 38 | USB_MSDM_CBW, /* Command Block. */ |
Brad Hards | 94843f6 | 2011-04-13 19:45:31 +1000 | [diff] [blame] | 39 | USB_MSDM_DATAOUT, /* Transfer data to device. */ |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 40 | USB_MSDM_DATAIN, /* Transfer data from device. */ |
| 41 | USB_MSDM_CSW /* Command Status. */ |
| 42 | }; |
| 43 | |
Gerd Hoffmann | 92a114f | 2011-11-21 11:29:27 +0100 | [diff] [blame] | 44 | struct usb_msd_csw { |
| 45 | uint32_t sig; |
| 46 | uint32_t tag; |
| 47 | uint32_t residue; |
| 48 | uint8_t status; |
| 49 | }; |
| 50 | |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 51 | typedef struct { |
| 52 | USBDevice dev; |
| 53 | enum USBMSDMode mode; |
Gerd Hoffmann | 1dc9036 | 2012-05-16 15:03:40 +0200 | [diff] [blame] | 54 | uint32_t scsi_off; |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 55 | uint32_t scsi_len; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 56 | uint32_t data_len; |
Gerd Hoffmann | 92a114f | 2011-11-21 11:29:27 +0100 | [diff] [blame] | 57 | struct usb_msd_csw csw; |
Hannes Reinecke | 5c6c0e5 | 2011-04-18 12:35:39 +0200 | [diff] [blame] | 58 | SCSIRequest *req; |
Gerd Hoffmann | ca9c39f | 2009-09-16 22:25:28 +0200 | [diff] [blame] | 59 | SCSIBus bus; |
pbrook | 4d611c9 | 2006-08-12 01:04:27 +0000 | [diff] [blame] | 60 | /* For async completion. */ |
| 61 | USBPacket *packet; |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 62 | /* usb-storage only */ |
| 63 | BlockConf conf; |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 64 | uint32_t removable; |
Gonglei | 89f0762 | 2014-10-07 16:00:33 +0800 | [diff] [blame] | 65 | SCSIDevice *scsi_dev; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 66 | } MSDState; |
| 67 | |
Gonglei | 79e2590 | 2015-05-06 20:55:32 +0800 | [diff] [blame] | 68 | #define TYPE_USB_STORAGE "usb-storage-dev" |
| 69 | #define USB_STORAGE_DEV(obj) OBJECT_CHECK(MSDState, (obj), TYPE_USB_STORAGE) |
| 70 | |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 71 | struct 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 Hoffmann | 81bfd2f | 2010-11-17 11:05:41 +0100 | [diff] [blame] | 81 | enum { |
| 82 | STR_MANUFACTURER = 1, |
| 83 | STR_PRODUCT, |
| 84 | STR_SERIALNUMBER, |
Gerd Hoffmann | ca0c730 | 2010-12-03 17:12:49 +0100 | [diff] [blame] | 85 | STR_CONFIG_FULL, |
| 86 | STR_CONFIG_HIGH, |
Gerd Hoffmann | 79b4045 | 2012-08-28 17:29:15 +0200 | [diff] [blame] | 87 | STR_CONFIG_SUPER, |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 88 | }; |
| 89 | |
Gerd Hoffmann | 81bfd2f | 2010-11-17 11:05:41 +0100 | [diff] [blame] | 90 | static const USBDescStrings desc_strings = { |
Crístian Viana | 93bfef4 | 2012-05-30 00:35:51 -0300 | [diff] [blame] | 91 | [STR_MANUFACTURER] = "QEMU", |
Gerd Hoffmann | 81bfd2f | 2010-11-17 11:05:41 +0100 | [diff] [blame] | 92 | [STR_PRODUCT] = "QEMU USB HARDDRIVE", |
| 93 | [STR_SERIALNUMBER] = "1", |
Gerd Hoffmann | ca0c730 | 2010-12-03 17:12:49 +0100 | [diff] [blame] | 94 | [STR_CONFIG_FULL] = "Full speed config (usb 1.1)", |
| 95 | [STR_CONFIG_HIGH] = "High speed config (usb 2.0)", |
Gerd Hoffmann | 79b4045 | 2012-08-28 17:29:15 +0200 | [diff] [blame] | 96 | [STR_CONFIG_SUPER] = "Super speed config (usb 3.0)", |
Gerd Hoffmann | 81bfd2f | 2010-11-17 11:05:41 +0100 | [diff] [blame] | 97 | }; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 98 | |
Gerd Hoffmann | ca0c730 | 2010-12-03 17:12:49 +0100 | [diff] [blame] | 99 | static const USBDescIface desc_iface_full = { |
Gerd Hoffmann | 81bfd2f | 2010-11-17 11:05:41 +0100 | [diff] [blame] | 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 | }; |
ths | 3b46e62 | 2007-09-17 08:09:54 +0000 | [diff] [blame] | 117 | |
Gerd Hoffmann | ca0c730 | 2010-12-03 17:12:49 +0100 | [diff] [blame] | 118 | static const USBDescDevice desc_device_full = { |
| 119 | .bcdUSB = 0x0200, |
Gerd Hoffmann | 81bfd2f | 2010-11-17 11:05:41 +0100 | [diff] [blame] | 120 | .bMaxPacketSize0 = 8, |
| 121 | .bNumConfigurations = 1, |
| 122 | .confs = (USBDescConfig[]) { |
| 123 | { |
| 124 | .bNumInterfaces = 1, |
| 125 | .bConfigurationValue = 1, |
Gerd Hoffmann | ca0c730 | 2010-12-03 17:12:49 +0100 | [diff] [blame] | 126 | .iConfiguration = STR_CONFIG_FULL, |
Pantelis Koukousoulas | bd93976 | 2013-12-16 09:42:49 +0200 | [diff] [blame] | 127 | .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER, |
Brad Hards | add7508 | 2011-04-03 15:33:19 +1000 | [diff] [blame] | 128 | .nif = 1, |
Gerd Hoffmann | ca0c730 | 2010-12-03 17:12:49 +0100 | [diff] [blame] | 129 | .ifs = &desc_iface_full, |
| 130 | }, |
| 131 | }, |
| 132 | }; |
| 133 | |
| 134 | static 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 | |
| 153 | static 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 Koukousoulas | bd93976 | 2013-12-16 09:42:49 +0200 | [diff] [blame] | 162 | .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER, |
Brad Hards | add7508 | 2011-04-03 15:33:19 +1000 | [diff] [blame] | 163 | .nif = 1, |
Gerd Hoffmann | ca0c730 | 2010-12-03 17:12:49 +0100 | [diff] [blame] | 164 | .ifs = &desc_iface_high, |
Gerd Hoffmann | 81bfd2f | 2010-11-17 11:05:41 +0100 | [diff] [blame] | 165 | }, |
| 166 | }, |
| 167 | }; |
ths | 3b46e62 | 2007-09-17 08:09:54 +0000 | [diff] [blame] | 168 | |
Gerd Hoffmann | 79b4045 | 2012-08-28 17:29:15 +0200 | [diff] [blame] | 169 | static 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 | |
| 190 | static 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 Koukousoulas | bd93976 | 2013-12-16 09:42:49 +0200 | [diff] [blame] | 199 | .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER, |
Gerd Hoffmann | 79b4045 | 2012-08-28 17:29:15 +0200 | [diff] [blame] | 200 | .nif = 1, |
| 201 | .ifs = &desc_iface_super, |
| 202 | }, |
| 203 | }, |
| 204 | }; |
| 205 | |
Gerd Hoffmann | 81bfd2f | 2010-11-17 11:05:41 +0100 | [diff] [blame] | 206 | static const USBDesc desc = { |
| 207 | .id = { |
Roy Tam | db80358 | 2011-09-15 11:25:47 +0800 | [diff] [blame] | 208 | .idVendor = 0x46f4, /* CRC16() of "QEMU" */ |
| 209 | .idProduct = 0x0001, |
Gerd Hoffmann | 81bfd2f | 2010-11-17 11:05:41 +0100 | [diff] [blame] | 210 | .bcdDevice = 0, |
| 211 | .iManufacturer = STR_MANUFACTURER, |
| 212 | .iProduct = STR_PRODUCT, |
| 213 | .iSerialNumber = STR_SERIALNUMBER, |
| 214 | }, |
Gerd Hoffmann | 79b4045 | 2012-08-28 17:29:15 +0200 | [diff] [blame] | 215 | .full = &desc_device_full, |
| 216 | .high = &desc_device_high, |
| 217 | .super = &desc_device_super, |
| 218 | .str = desc_strings, |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 219 | }; |
| 220 | |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 221 | static void usb_msd_copy_data(MSDState *s, USBPacket *p) |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 222 | { |
| 223 | uint32_t len; |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 224 | len = p->iov.size - p->actual_length; |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 225 | if (len > s->scsi_len) |
| 226 | len = s->scsi_len; |
Gerd Hoffmann | 1dc9036 | 2012-05-16 15:03:40 +0200 | [diff] [blame] | 227 | usb_packet_copy(p, scsi_req_get_buf(s->req) + s->scsi_off, len); |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 228 | s->scsi_len -= len; |
Gerd Hoffmann | 1dc9036 | 2012-05-16 15:03:40 +0200 | [diff] [blame] | 229 | s->scsi_off += len; |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 230 | s->data_len -= len; |
Gerd Hoffmann | fa7935c | 2010-12-09 23:31:49 +0100 | [diff] [blame] | 231 | if (s->scsi_len == 0 || s->data_len == 0) { |
Paolo Bonzini | ad3376c | 2011-04-18 15:28:11 +0200 | [diff] [blame] | 232 | scsi_req_continue(s->req); |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 233 | } |
| 234 | } |
| 235 | |
Gerd Hoffmann | ab4797a | 2010-12-09 10:36:35 +0100 | [diff] [blame] | 236 | static void usb_msd_send_status(MSDState *s, USBPacket *p) |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 237 | { |
Gerd Hoffmann | ab4797a | 2010-12-09 10:36:35 +0100 | [diff] [blame] | 238 | int len; |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 239 | |
Gerd Hoffmann | e04da7c | 2011-11-21 11:17:59 +0100 | [diff] [blame] | 240 | DPRINTF("Command status %d tag 0x%x, len %zd\n", |
Benjamin Herrenschmidt | e2854bf | 2012-03-08 11:41:10 +1100 | [diff] [blame] | 241 | s->csw.status, le32_to_cpu(s->csw.tag), p->iov.size); |
Gerd Hoffmann | ab4797a | 2010-12-09 10:36:35 +0100 | [diff] [blame] | 242 | |
Benjamin Herrenschmidt | e2854bf | 2012-03-08 11:41:10 +1100 | [diff] [blame] | 243 | assert(s->csw.sig == cpu_to_le32(0x53425355)); |
Gerd Hoffmann | 92a114f | 2011-11-21 11:29:27 +0100 | [diff] [blame] | 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)); |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 247 | } |
| 248 | |
Gerd Hoffmann | 1e6ed80 | 2012-05-22 14:30:20 +0200 | [diff] [blame] | 249 | static 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 Bonzini | aba1f02 | 2011-05-20 20:18:07 +0200 | [diff] [blame] | 261 | static void usb_msd_transfer_data(SCSIRequest *req, uint32_t len) |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 262 | { |
Hannes Reinecke | 5c6c0e5 | 2011-04-18 12:35:39 +0200 | [diff] [blame] | 263 | MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent); |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 264 | USBPacket *p = s->packet; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 265 | |
Paolo Bonzini | ad3376c | 2011-04-18 15:28:11 +0200 | [diff] [blame] | 266 | assert((s->mode == USB_MSDM_DATAOUT) == (req->cmd.mode == SCSI_XFER_TO_DEV)); |
Paolo Bonzini | aba1f02 | 2011-05-20 20:18:07 +0200 | [diff] [blame] | 267 | s->scsi_len = len; |
Gerd Hoffmann | 1dc9036 | 2012-05-16 15:03:40 +0200 | [diff] [blame] | 268 | s->scsi_off = 0; |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 269 | if (p) { |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 270 | usb_msd_copy_data(s, p); |
| 271 | p = s->packet; |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 272 | if (p && p->actual_length == p->iov.size) { |
| 273 | p->status = USB_RET_SUCCESS; /* Clear previous ASYNC status */ |
Gerd Hoffmann | 1e6ed80 | 2012-05-22 14:30:20 +0200 | [diff] [blame] | 274 | usb_msd_packet_complete(s); |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 275 | } |
pbrook | 4d611c9 | 2006-08-12 01:04:27 +0000 | [diff] [blame] | 276 | } |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 277 | } |
| 278 | |
Paolo Bonzini | 01e9545 | 2011-07-06 11:55:37 +0200 | [diff] [blame] | 279 | static void usb_msd_command_complete(SCSIRequest *req, uint32_t status, size_t resid) |
Paolo Bonzini | c6df710 | 2011-04-22 12:27:30 +0200 | [diff] [blame] | 280 | { |
| 281 | MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent); |
| 282 | USBPacket *p = s->packet; |
| 283 | |
Gerd Hoffmann | 7b863f4 | 2011-11-21 11:36:17 +0100 | [diff] [blame] | 284 | DPRINTF("Command complete %d tag 0x%x\n", status, req->tag); |
Gerd Hoffmann | 92a114f | 2011-11-21 11:29:27 +0100 | [diff] [blame] | 285 | |
| 286 | s->csw.sig = cpu_to_le32(0x53425355); |
Gerd Hoffmann | 7b863f4 | 2011-11-21 11:36:17 +0100 | [diff] [blame] | 287 | s->csw.tag = cpu_to_le32(req->tag); |
Gerd Hoffmann | 0659879 | 2012-05-14 14:00:02 +0200 | [diff] [blame] | 288 | s->csw.residue = cpu_to_le32(s->data_len); |
Gerd Hoffmann | 414c460 | 2011-11-21 11:41:30 +0100 | [diff] [blame] | 289 | s->csw.status = status != 0; |
Gerd Hoffmann | 92a114f | 2011-11-21 11:29:27 +0100 | [diff] [blame] | 290 | |
Paolo Bonzini | c6df710 | 2011-04-22 12:27:30 +0200 | [diff] [blame] | 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; |
Gerd Hoffmann | 5441421 | 2012-07-13 11:38:13 +0200 | [diff] [blame] | 297 | } else if (s->mode == USB_MSDM_CSW) { |
| 298 | usb_msd_send_status(s, p); |
| 299 | s->mode = USB_MSDM_CBW; |
Paolo Bonzini | c6df710 | 2011-04-22 12:27:30 +0200 | [diff] [blame] | 300 | } else { |
| 301 | if (s->data_len) { |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 302 | int len = (p->iov.size - p->actual_length); |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 303 | usb_packet_skip(p, len); |
| 304 | s->data_len -= len; |
Paolo Bonzini | c6df710 | 2011-04-22 12:27:30 +0200 | [diff] [blame] | 305 | } |
| 306 | if (s->data_len == 0) { |
| 307 | s->mode = USB_MSDM_CSW; |
| 308 | } |
| 309 | } |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 310 | p->status = USB_RET_SUCCESS; /* Clear previous ASYNC status */ |
Gerd Hoffmann | 1e6ed80 | 2012-05-22 14:30:20 +0200 | [diff] [blame] | 311 | usb_msd_packet_complete(s); |
Paolo Bonzini | c6df710 | 2011-04-22 12:27:30 +0200 | [diff] [blame] | 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 | |
Paolo Bonzini | 94d3f98 | 2011-04-18 22:53:08 +0200 | [diff] [blame] | 319 | static 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 Bonzini | 94d3f98 | 2011-04-18 22:53:08 +0200 | [diff] [blame] | 326 | s->scsi_len = 0; |
| 327 | } |
| 328 | } |
| 329 | |
bellard | 059809e | 2006-07-19 18:06:15 +0000 | [diff] [blame] | 330 | static void usb_msd_handle_reset(USBDevice *dev) |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 331 | { |
| 332 | MSDState *s = (MSDState *)dev; |
| 333 | |
| 334 | DPRINTF("Reset\n"); |
Gerd Hoffmann | 24a5bbe | 2012-01-04 18:13:54 +0100 | [diff] [blame] | 335 | if (s->req) { |
| 336 | scsi_req_cancel(s->req); |
| 337 | } |
| 338 | assert(s->req == NULL); |
| 339 | |
| 340 | if (s->packet) { |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 341 | s->packet->status = USB_RET_STALL; |
Gerd Hoffmann | 1e6ed80 | 2012-05-22 14:30:20 +0200 | [diff] [blame] | 342 | usb_msd_packet_complete(s); |
Gerd Hoffmann | 24a5bbe | 2012-01-04 18:13:54 +0100 | [diff] [blame] | 343 | } |
| 344 | |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 345 | s->mode = USB_MSDM_CBW; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 346 | } |
| 347 | |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 348 | static void usb_msd_handle_control(USBDevice *dev, USBPacket *p, |
Hans de Goede | 007fd62 | 2011-02-02 16:33:13 +0100 | [diff] [blame] | 349 | int request, int value, int index, int length, uint8_t *data) |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 350 | { |
| 351 | MSDState *s = (MSDState *)dev; |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 352 | SCSIDevice *scsi_dev; |
| 353 | int ret, maxlun; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 354 | |
Hans de Goede | 007fd62 | 2011-02-02 16:33:13 +0100 | [diff] [blame] | 355 | ret = usb_desc_handle_control(dev, p, request, value, index, length, data); |
Gerd Hoffmann | 81bfd2f | 2010-11-17 11:05:41 +0100 | [diff] [blame] | 356 | if (ret >= 0) { |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 357 | return; |
Gerd Hoffmann | 81bfd2f | 2010-11-17 11:05:41 +0100 | [diff] [blame] | 358 | } |
| 359 | |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 360 | switch (request) { |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 361 | case EndpointOutRequest | USB_REQ_CLEAR_FEATURE: |
Arnaud Patard (Rtp) | e5322f7 | 2010-03-10 10:45:12 +0100 | [diff] [blame] | 362 | break; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 363 | /* Class specific requests. */ |
Max Reitz | f3571b1 | 2010-03-14 12:19:03 +0100 | [diff] [blame] | 364 | case ClassInterfaceOutRequest | MassStorageReset: |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 365 | /* Reset state ready for the next CBW. */ |
| 366 | s->mode = USB_MSDM_CBW; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 367 | break; |
Max Reitz | f3571b1 | 2010-03-14 12:19:03 +0100 | [diff] [blame] | 368 | case ClassInterfaceRequest | GetMaxLun: |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 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; |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 382 | p->actual_length = 1; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 383 | break; |
| 384 | default: |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 385 | p->status = USB_RET_STALL; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 386 | break; |
| 387 | } |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 388 | } |
| 389 | |
Gerd Hoffmann | eb5e680 | 2011-05-16 10:34:53 +0200 | [diff] [blame] | 390 | static void usb_msd_cancel_io(USBDevice *dev, USBPacket *p) |
pbrook | 4d611c9 | 2006-08-12 01:04:27 +0000 | [diff] [blame] | 391 | { |
Gonglei | 79e2590 | 2015-05-06 20:55:32 +0800 | [diff] [blame] | 392 | MSDState *s = USB_STORAGE_DEV(dev); |
Gerd Hoffmann | d3ac1a8 | 2011-09-02 13:05:13 +0200 | [diff] [blame] | 393 | |
Gerd Hoffmann | 6d7aeee | 2012-04-18 12:08:29 +0200 | [diff] [blame] | 394 | assert(s->packet == p); |
| 395 | s->packet = NULL; |
| 396 | |
Gerd Hoffmann | d3ac1a8 | 2011-09-02 13:05:13 +0200 | [diff] [blame] | 397 | if (s->req) { |
| 398 | scsi_req_cancel(s->req); |
| 399 | } |
pbrook | 4d611c9 | 2006-08-12 01:04:27 +0000 | [diff] [blame] | 400 | } |
| 401 | |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 402 | static void usb_msd_handle_data(USBDevice *dev, USBPacket *p) |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 403 | { |
| 404 | MSDState *s = (MSDState *)dev; |
Gerd Hoffmann | 7b863f4 | 2011-11-21 11:36:17 +0100 | [diff] [blame] | 405 | uint32_t tag; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 406 | struct usb_msd_cbw cbw; |
Gerd Hoffmann | 079d0b7 | 2012-01-12 13:23:01 +0100 | [diff] [blame] | 407 | uint8_t devep = p->ep->nr; |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 408 | SCSIDevice *scsi_dev; |
Gerd Hoffmann | 9db7c41 | 2013-01-22 14:17:05 +0100 | [diff] [blame] | 409 | uint32_t len; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 410 | |
pbrook | 4d611c9 | 2006-08-12 01:04:27 +0000 | [diff] [blame] | 411 | switch (p->pid) { |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 412 | case USB_TOKEN_OUT: |
| 413 | if (devep != 2) |
| 414 | goto fail; |
| 415 | |
| 416 | switch (s->mode) { |
| 417 | case USB_MSDM_CBW: |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 418 | if (p->iov.size != 31) { |
Gonglei | f5dc597 | 2014-09-19 14:48:30 +0800 | [diff] [blame] | 419 | error_report("usb-msd: Bad CBW size"); |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 420 | goto fail; |
| 421 | } |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 422 | usb_packet_copy(p, &cbw, 31); |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 423 | if (le32_to_cpu(cbw.sig) != 0x43425355) { |
Gonglei | f5dc597 | 2014-09-19 14:48:30 +0800 | [diff] [blame] | 424 | error_report("usb-msd: Bad signature %08x", |
| 425 | le32_to_cpu(cbw.sig)); |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 426 | goto fail; |
| 427 | } |
| 428 | DPRINTF("Command on LUN %d\n", cbw.lun); |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 429 | scsi_dev = scsi_device_find(&s->bus, 0, 0, cbw.lun); |
| 430 | if (scsi_dev == NULL) { |
Gonglei | f5dc597 | 2014-09-19 14:48:30 +0800 | [diff] [blame] | 431 | error_report("usb-msd: Bad LUN %d", cbw.lun); |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 432 | goto fail; |
| 433 | } |
Gerd Hoffmann | 7b863f4 | 2011-11-21 11:36:17 +0100 | [diff] [blame] | 434 | tag = le32_to_cpu(cbw.tag); |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 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", |
Gerd Hoffmann | 7b863f4 | 2011-11-21 11:36:17 +0100 | [diff] [blame] | 444 | tag, cbw.flags, cbw.cmd_len, s->data_len); |
Gerd Hoffmann | 0659879 | 2012-05-14 14:00:02 +0200 | [diff] [blame] | 445 | assert(le32_to_cpu(s->csw.residue) == 0); |
Gerd Hoffmann | ef0bdf7 | 2011-05-04 16:49:56 +0200 | [diff] [blame] | 446 | s->scsi_len = 0; |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 447 | s->req = scsi_req_new(scsi_dev, tag, cbw.lun, cbw.cmd, NULL); |
Gerd Hoffmann | 06f9847 | 2012-07-13 11:35:51 +0200 | [diff] [blame] | 448 | #ifdef DEBUG_MSD |
| 449 | scsi_req_print(s->req); |
| 450 | #endif |
Gerd Hoffmann | 9db7c41 | 2013-01-22 14:17:05 +0100 | [diff] [blame] | 451 | len = scsi_req_enqueue(s->req); |
| 452 | if (len) { |
Paolo Bonzini | ad3376c | 2011-04-18 15:28:11 +0200 | [diff] [blame] | 453 | scsi_req_continue(s->req); |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 454 | } |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 455 | break; |
| 456 | |
| 457 | case USB_MSDM_DATAOUT: |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 458 | DPRINTF("Data out %zd/%d\n", p->iov.size, s->data_len); |
| 459 | if (p->iov.size > s->data_len) { |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 460 | goto fail; |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 461 | } |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 462 | |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 463 | if (s->scsi_len) { |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 464 | usb_msd_copy_data(s, p); |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 465 | } |
Gerd Hoffmann | 0659879 | 2012-05-14 14:00:02 +0200 | [diff] [blame] | 466 | if (le32_to_cpu(s->csw.residue)) { |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 467 | int len = p->iov.size - p->actual_length; |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 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 | } |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 475 | } |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 476 | if (p->actual_length < p->iov.size) { |
Gerd Hoffmann | 06f9847 | 2012-07-13 11:35:51 +0200 | [diff] [blame] | 477 | DPRINTF("Deferring packet %p [wait data-out]\n", p); |
pbrook | 4d611c9 | 2006-08-12 01:04:27 +0000 | [diff] [blame] | 478 | s->packet = p; |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 479 | p->status = USB_RET_ASYNC; |
pbrook | 4d611c9 | 2006-08-12 01:04:27 +0000 | [diff] [blame] | 480 | } |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 481 | break; |
| 482 | |
| 483 | default: |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 484 | DPRINTF("Unexpected write (len %zd)\n", p->iov.size); |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 485 | goto fail; |
| 486 | } |
| 487 | break; |
| 488 | |
| 489 | case USB_TOKEN_IN: |
| 490 | if (devep != 1) |
| 491 | goto fail; |
| 492 | |
| 493 | switch (s->mode) { |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 494 | case USB_MSDM_DATAOUT: |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 495 | if (s->data_len != 0 || p->iov.size < 13) { |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 496 | goto fail; |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 497 | } |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 498 | /* Waiting for SCSI write to complete. */ |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 499 | s->packet = p; |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 500 | p->status = USB_RET_ASYNC; |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 501 | break; |
| 502 | |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 503 | case USB_MSDM_CSW: |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 504 | if (p->iov.size < 13) { |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 505 | goto fail; |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 506 | } |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 507 | |
Gerd Hoffmann | 5931065 | 2011-11-21 14:01:26 +0100 | [diff] [blame] | 508 | if (s->req) { |
| 509 | /* still in flight */ |
Gerd Hoffmann | 06f9847 | 2012-07-13 11:35:51 +0200 | [diff] [blame] | 510 | DPRINTF("Deferring packet %p [wait status]\n", p); |
Gerd Hoffmann | 5931065 | 2011-11-21 14:01:26 +0100 | [diff] [blame] | 511 | s->packet = p; |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 512 | p->status = USB_RET_ASYNC; |
Gerd Hoffmann | 5931065 | 2011-11-21 14:01:26 +0100 | [diff] [blame] | 513 | } else { |
| 514 | usb_msd_send_status(s, p); |
| 515 | s->mode = USB_MSDM_CBW; |
Gerd Hoffmann | 5931065 | 2011-11-21 14:01:26 +0100 | [diff] [blame] | 516 | } |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 517 | break; |
| 518 | |
| 519 | case USB_MSDM_DATAIN: |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 520 | DPRINTF("Data in %zd/%d, scsi_len %d\n", |
| 521 | p->iov.size, s->data_len, s->scsi_len); |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 522 | if (s->scsi_len) { |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 523 | usb_msd_copy_data(s, p); |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 524 | } |
Gerd Hoffmann | 0659879 | 2012-05-14 14:00:02 +0200 | [diff] [blame] | 525 | if (le32_to_cpu(s->csw.residue)) { |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 526 | int len = p->iov.size - p->actual_length; |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 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 | } |
pbrook | a917d38 | 2006-08-29 04:52:16 +0000 | [diff] [blame] | 534 | } |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 535 | if (p->actual_length < p->iov.size) { |
Gerd Hoffmann | 06f9847 | 2012-07-13 11:35:51 +0200 | [diff] [blame] | 536 | DPRINTF("Deferring packet %p [wait data-in]\n", p); |
pbrook | 4d611c9 | 2006-08-12 01:04:27 +0000 | [diff] [blame] | 537 | s->packet = p; |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 538 | p->status = USB_RET_ASYNC; |
pbrook | 4d611c9 | 2006-08-12 01:04:27 +0000 | [diff] [blame] | 539 | } |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 540 | break; |
| 541 | |
| 542 | default: |
Gerd Hoffmann | 29c74f7 | 2011-07-13 12:32:06 +0200 | [diff] [blame] | 543 | DPRINTF("Unexpected read (len %zd)\n", p->iov.size); |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 544 | goto fail; |
| 545 | } |
| 546 | break; |
| 547 | |
| 548 | default: |
| 549 | DPRINTF("Bad token\n"); |
| 550 | fail: |
Hans de Goede | 9a77a0f | 2012-11-01 17:15:01 +0100 | [diff] [blame] | 551 | p->status = USB_RET_STALL; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 552 | break; |
| 553 | } |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 554 | } |
| 555 | |
Gerd Hoffmann | b3e461d | 2009-10-26 15:56:49 +0100 | [diff] [blame] | 556 | static void usb_msd_password_cb(void *opaque, int err) |
| 557 | { |
| 558 | MSDState *s = opaque; |
Gonglei | 7d553f2 | 2014-09-19 14:48:24 +0800 | [diff] [blame] | 559 | Error *local_err = NULL; |
Gerd Hoffmann | b3e461d | 2009-10-26 15:56:49 +0100 | [diff] [blame] | 560 | |
Gonglei | 7d553f2 | 2014-09-19 14:48:24 +0800 | [diff] [blame] | 561 | if (!err) { |
| 562 | usb_device_attach(&s->dev, &local_err); |
| 563 | } |
Hans de Goede | fa19bf8 | 2011-05-27 19:05:15 +0200 | [diff] [blame] | 564 | |
Gonglei | 7d553f2 | 2014-09-19 14:48:24 +0800 | [diff] [blame] | 565 | if (local_err) { |
Markus Armbruster | c326529 | 2015-03-12 17:26:50 +0100 | [diff] [blame] | 566 | error_report_err(local_err); |
Luiz Capitulino | 56f9107 | 2012-03-14 17:37:38 -0300 | [diff] [blame] | 567 | qdev_unplug(&s->dev.qdev, NULL); |
Gonglei | 7d553f2 | 2014-09-19 14:48:24 +0800 | [diff] [blame] | 568 | } |
Gerd Hoffmann | b3e461d | 2009-10-26 15:56:49 +0100 | [diff] [blame] | 569 | } |
| 570 | |
Gerd Hoffmann | 5de88b1 | 2012-05-14 13:56:40 +0200 | [diff] [blame] | 571 | static 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 Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 582 | static const struct SCSIBusInfo usb_msd_scsi_info_storage = { |
Paolo Bonzini | afd4030 | 2011-08-13 15:44:45 +0200 | [diff] [blame] | 583 | .tcq = false, |
Paolo Bonzini | 7e0380b | 2011-08-13 18:55:17 +0200 | [diff] [blame] | 584 | .max_target = 0, |
| 585 | .max_lun = 0, |
Paolo Bonzini | afd4030 | 2011-08-13 15:44:45 +0200 | [diff] [blame] | 586 | |
Paolo Bonzini | c6df710 | 2011-04-22 12:27:30 +0200 | [diff] [blame] | 587 | .transfer_data = usb_msd_transfer_data, |
Paolo Bonzini | 94d3f98 | 2011-04-18 22:53:08 +0200 | [diff] [blame] | 588 | .complete = usb_msd_command_complete, |
Gerd Hoffmann | 5de88b1 | 2012-05-14 13:56:40 +0200 | [diff] [blame] | 589 | .cancel = usb_msd_request_cancelled, |
| 590 | .load_request = usb_msd_load_request, |
Paolo Bonzini | cfdc1bb | 2011-04-18 17:11:14 +0200 | [diff] [blame] | 591 | }; |
| 592 | |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 593 | static 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 | |
Gonglei | 5a882e4 | 2014-09-19 14:48:29 +0800 | [diff] [blame] | 604 | static void usb_msd_realize_storage(USBDevice *dev, Error **errp) |
Gerd Hoffmann | 806b602 | 2009-08-31 14:23:59 +0200 | [diff] [blame] | 605 | { |
Gonglei | 79e2590 | 2015-05-06 20:55:32 +0800 | [diff] [blame] | 606 | MSDState *s = USB_STORAGE_DEV(dev); |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 607 | BlockBackend *blk = s->conf.blk; |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 608 | SCSIDevice *scsi_dev; |
Andreas Färber | caad4eb | 2013-07-21 12:16:34 +0200 | [diff] [blame] | 609 | Error *err = NULL; |
Gerd Hoffmann | 806b602 | 2009-08-31 14:23:59 +0200 | [diff] [blame] | 610 | |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 611 | if (!blk) { |
Gonglei | 5a882e4 | 2014-09-19 14:48:29 +0800 | [diff] [blame] | 612 | error_setg(errp, "drive property not set"); |
| 613 | return; |
Gerd Hoffmann | 7fc2f2c | 2009-08-31 14:24:05 +0200 | [diff] [blame] | 614 | } |
| 615 | |
Max Reitz | 7d3467d | 2015-10-19 17:53:17 +0200 | [diff] [blame] | 616 | 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 Armbruster | 7afcc1f | 2015-03-12 17:26:49 +0100 | [diff] [blame] | 632 | } |
| 633 | } |
| 634 | |
Gerd Hoffmann | 71938a0 | 2013-06-12 13:01:49 +0200 | [diff] [blame] | 635 | blkconf_serial(&s->conf, &dev->serial); |
Ekaterina Tumanova | 0eb28a4 | 2015-02-16 12:47:58 +0100 | [diff] [blame] | 636 | blkconf_blocksizes(&s->conf); |
Markus Armbruster | 911525d | 2012-07-11 15:08:37 +0200 | [diff] [blame] | 637 | |
Markus Armbruster | 14bafc5 | 2010-06-25 08:09:10 +0200 | [diff] [blame] | 638 | /* |
| 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 Armbruster | 18846de | 2010-06-29 16:58:30 +0200 | [diff] [blame] | 641 | * 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 Armbruster | 14bafc5 | 2010-06-25 08:09:10 +0200 | [diff] [blame] | 644 | * |
| 645 | * The hack is probably a bad idea. |
| 646 | */ |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 647 | blk_detach_dev(blk, &s->dev.qdev); |
| 648 | s->conf.blk = NULL; |
Markus Armbruster | 14bafc5 | 2010-06-25 08:09:10 +0200 | [diff] [blame] | 649 | |
Gerd Hoffmann | 71938a0 | 2013-06-12 13:01:49 +0200 | [diff] [blame] | 650 | usb_desc_create_serial(dev); |
Gerd Hoffmann | a980a06 | 2010-11-26 20:20:41 +0100 | [diff] [blame] | 651 | usb_desc_init(dev); |
Andreas Färber | b1187b5 | 2013-08-23 20:30:03 +0200 | [diff] [blame] | 652 | scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(dev), |
| 653 | &usb_msd_scsi_info_storage, NULL); |
Markus Armbruster | 4be7463 | 2014-10-07 13:59:18 +0200 | [diff] [blame] | 654 | scsi_dev = scsi_bus_legacy_add_drive(&s->bus, blk, 0, !!s->removable, |
Andreas Färber | caad4eb | 2013-07-21 12:16:34 +0200 | [diff] [blame] | 655 | s->conf.bootindex, dev->serial, |
| 656 | &err); |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 657 | if (!scsi_dev) { |
Gonglei | 5a882e4 | 2014-09-19 14:48:29 +0800 | [diff] [blame] | 658 | error_propagate(errp, err); |
| 659 | return; |
Markus Armbruster | fa66b90 | 2010-06-25 18:53:21 +0200 | [diff] [blame] | 660 | } |
Gerd Hoffmann | 7fc2f2c | 2009-08-31 14:24:05 +0200 | [diff] [blame] | 661 | usb_msd_handle_reset(dev); |
Gonglei | 89f0762 | 2014-10-07 16:00:33 +0800 | [diff] [blame] | 662 | s->scsi_dev = scsi_dev; |
Gerd Hoffmann | 806b602 | 2009-08-31 14:23:59 +0200 | [diff] [blame] | 663 | } |
| 664 | |
Gonglei | 5a882e4 | 2014-09-19 14:48:29 +0800 | [diff] [blame] | 665 | static void usb_msd_realize_bot(USBDevice *dev, Error **errp) |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 666 | { |
Gonglei | 79e2590 | 2015-05-06 20:55:32 +0800 | [diff] [blame] | 667 | MSDState *s = USB_STORAGE_DEV(dev); |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 668 | |
| 669 | usb_desc_create_serial(dev); |
| 670 | usb_desc_init(dev); |
Andreas Färber | b1187b5 | 2013-08-23 20:30:03 +0200 | [diff] [blame] | 671 | scsi_bus_new(&s->bus, sizeof(s->bus), DEVICE(dev), |
| 672 | &usb_msd_scsi_info_bot, NULL); |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 673 | usb_msd_handle_reset(dev); |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 674 | } |
| 675 | |
Jan Kiszka | 3741715 | 2012-02-27 15:18:47 +0100 | [diff] [blame] | 676 | static USBDevice *usb_msd_init(USBBus *bus, const char *filename) |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 677 | { |
Gerd Hoffmann | 7fc2f2c | 2009-08-31 14:24:05 +0200 | [diff] [blame] | 678 | static int nr=0; |
Markus Armbruster | 9b3d111 | 2015-03-09 19:17:26 +0100 | [diff] [blame] | 679 | Error *err = NULL; |
Gerd Hoffmann | 7fc2f2c | 2009-08-31 14:24:05 +0200 | [diff] [blame] | 680 | char id[8]; |
| 681 | QemuOpts *opts; |
| 682 | DriveInfo *dinfo; |
Gerd Hoffmann | 806b602 | 2009-08-31 14:23:59 +0200 | [diff] [blame] | 683 | USBDevice *dev; |
aurel32 | 334c024 | 2008-08-21 22:24:32 +0000 | [diff] [blame] | 684 | const char *p1; |
| 685 | char fmt[32]; |
| 686 | |
Gerd Hoffmann | 7fc2f2c | 2009-08-31 14:24:05 +0200 | [diff] [blame] | 687 | /* parse -usbdevice disk: syntax into drive opts */ |
Markus Armbruster | 3137677 | 2014-09-12 21:24:34 +0200 | [diff] [blame] | 688 | 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 Hoffmann | 7fc2f2c | 2009-08-31 14:24:05 +0200 | [diff] [blame] | 692 | |
aurel32 | 334c024 | 2008-08-21 22:24:32 +0000 | [diff] [blame] | 693 | 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 Armbruster | f43e47d | 2015-02-12 17:52:20 +0100 | [diff] [blame] | 700 | qemu_opt_set(opts, "format", fmt, &error_abort); |
aurel32 | 334c024 | 2008-08-21 22:24:32 +0000 | [diff] [blame] | 701 | } else if (*filename != ':') { |
Gonglei | f5dc597 | 2014-09-19 14:48:30 +0800 | [diff] [blame] | 702 | error_report("unrecognized USB mass-storage option %s", filename); |
aurel32 | 334c024 | 2008-08-21 22:24:32 +0000 | [diff] [blame] | 703 | return NULL; |
| 704 | } |
aurel32 | 334c024 | 2008-08-21 22:24:32 +0000 | [diff] [blame] | 705 | filename = p1; |
| 706 | } |
aurel32 | 334c024 | 2008-08-21 22:24:32 +0000 | [diff] [blame] | 707 | if (!*filename) { |
Gonglei | f5dc597 | 2014-09-19 14:48:30 +0800 | [diff] [blame] | 708 | error_report("block device specification needed"); |
aurel32 | 334c024 | 2008-08-21 22:24:32 +0000 | [diff] [blame] | 709 | return NULL; |
| 710 | } |
Markus Armbruster | f43e47d | 2015-02-12 17:52:20 +0100 | [diff] [blame] | 711 | qemu_opt_set(opts, "file", filename, &error_abort); |
| 712 | qemu_opt_set(opts, "if", "none", &error_abort); |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 713 | |
Gerd Hoffmann | 7fc2f2c | 2009-08-31 14:24:05 +0200 | [diff] [blame] | 714 | /* create host drive */ |
Markus Armbruster | 60e19e0 | 2014-06-06 14:50:58 +0200 | [diff] [blame] | 715 | dinfo = drive_new(opts, 0); |
Gerd Hoffmann | 7fc2f2c | 2009-08-31 14:24:05 +0200 | [diff] [blame] | 716 | if (!dinfo) { |
| 717 | qemu_opts_del(opts); |
Gerd Hoffmann | 806b602 | 2009-08-31 14:23:59 +0200 | [diff] [blame] | 718 | return NULL; |
Gerd Hoffmann | 7fc2f2c | 2009-08-31 14:24:05 +0200 | [diff] [blame] | 719 | } |
Gerd Hoffmann | 806b602 | 2009-08-31 14:23:59 +0200 | [diff] [blame] | 720 | |
Gerd Hoffmann | 7fc2f2c | 2009-08-31 14:24:05 +0200 | [diff] [blame] | 721 | /* create guest device */ |
Jan Kiszka | 3741715 | 2012-02-27 15:18:47 +0100 | [diff] [blame] | 722 | dev = usb_create(bus, "usb-storage"); |
Markus Armbruster | 9b3d111 | 2015-03-09 19:17:26 +0100 | [diff] [blame] | 723 | qdev_prop_set_drive(&dev->qdev, "drive", blk_by_legacy_dinfo(dinfo), |
| 724 | &err); |
| 725 | if (err) { |
| 726 | error_report_err(err); |
Stefan Hajnoczi | 02a5c4c | 2013-09-11 14:54:09 +0200 | [diff] [blame] | 727 | object_unparent(OBJECT(dev)); |
Markus Armbruster | 18846de | 2010-06-29 16:58:30 +0200 | [diff] [blame] | 728 | return NULL; |
| 729 | } |
Gerd Hoffmann | 7fc2f2c | 2009-08-31 14:24:05 +0200 | [diff] [blame] | 730 | return dev; |
pbrook | 2e5d83b | 2006-05-25 23:58:51 +0000 | [diff] [blame] | 731 | } |
aliguori | bb5fc20 | 2009-03-05 23:01:15 +0000 | [diff] [blame] | 732 | |
Gerd Hoffmann | f54b656 | 2010-12-10 14:58:41 +0100 | [diff] [blame] | 733 | static const VMStateDescription vmstate_usb_msd = { |
| 734 | .name = "usb-storage", |
Gerd Hoffmann | f54b656 | 2010-12-10 14:58:41 +0100 | [diff] [blame] | 735 | .version_id = 1, |
| 736 | .minimum_version_id = 1, |
Juan Quintela | 6e3d652 | 2014-04-16 13:31:26 +0200 | [diff] [blame] | 737 | .fields = (VMStateField[]) { |
Gerd Hoffmann | f54b656 | 2010-12-10 14:58:41 +0100 | [diff] [blame] | 738 | VMSTATE_USB_DEVICE(dev, MSDState), |
Gerd Hoffmann | 5de88b1 | 2012-05-14 13:56:40 +0200 | [diff] [blame] | 739 | 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 Hoffmann | f54b656 | 2010-12-10 14:58:41 +0100 | [diff] [blame] | 747 | VMSTATE_END_OF_LIST() |
| 748 | } |
| 749 | }; |
| 750 | |
Anthony Liguori | 39bffca | 2011-12-07 21:34:16 -0600 | [diff] [blame] | 751 | static Property msd_properties[] = { |
| 752 | DEFINE_BLOCK_PROPERTIES(MSDState, conf), |
Anthony Liguori | 39bffca | 2011-12-07 21:34:16 -0600 | [diff] [blame] | 753 | DEFINE_PROP_BIT("removable", MSDState, removable, 0, false), |
| 754 | DEFINE_PROP_END_OF_LIST(), |
| 755 | }; |
| 756 | |
Gonglei | 79e2590 | 2015-05-06 20:55:32 +0800 | [diff] [blame] | 757 | static void usb_msd_class_initfn_common(ObjectClass *klass, void *data) |
Anthony Liguori | 62aed76 | 2011-12-15 14:53:10 -0600 | [diff] [blame] | 758 | { |
Anthony Liguori | 39bffca | 2011-12-07 21:34:16 -0600 | [diff] [blame] | 759 | DeviceClass *dc = DEVICE_CLASS(klass); |
Anthony Liguori | 62aed76 | 2011-12-15 14:53:10 -0600 | [diff] [blame] | 760 | USBDeviceClass *uc = USB_DEVICE_CLASS(klass); |
| 761 | |
Anthony Liguori | 62aed76 | 2011-12-15 14:53:10 -0600 | [diff] [blame] | 762 | uc->product_desc = "QEMU USB MSD"; |
| 763 | uc->usb_desc = &desc; |
Anthony Liguori | 62aed76 | 2011-12-15 14:53:10 -0600 | [diff] [blame] | 764 | 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 Apfelbaum | 125ee0e | 2013-07-29 17:17:45 +0300 | [diff] [blame] | 769 | set_bit(DEVICE_CATEGORY_STORAGE, dc->categories); |
Anthony Liguori | 39bffca | 2011-12-07 21:34:16 -0600 | [diff] [blame] | 770 | dc->fw_name = "storage"; |
| 771 | dc->vmsd = &vmstate_usb_msd; |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 772 | } |
| 773 | |
| 774 | static 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 | |
Gonglei | 5a882e4 | 2014-09-19 14:48:29 +0800 | [diff] [blame] | 779 | uc->realize = usb_msd_realize_storage; |
Anthony Liguori | 39bffca | 2011-12-07 21:34:16 -0600 | [diff] [blame] | 780 | dc->props = msd_properties; |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 781 | } |
| 782 | |
Gonglei | 89f0762 | 2014-10-07 16:00:33 +0800 | [diff] [blame] | 783 | static void usb_msd_get_bootindex(Object *obj, Visitor *v, void *opaque, |
| 784 | const char *name, Error **errp) |
| 785 | { |
| 786 | USBDevice *dev = USB_DEVICE(obj); |
Gonglei | 79e2590 | 2015-05-06 20:55:32 +0800 | [diff] [blame] | 787 | MSDState *s = USB_STORAGE_DEV(dev); |
Gonglei | 89f0762 | 2014-10-07 16:00:33 +0800 | [diff] [blame] | 788 | |
| 789 | visit_type_int32(v, &s->conf.bootindex, name, errp); |
| 790 | } |
| 791 | |
| 792 | static void usb_msd_set_bootindex(Object *obj, Visitor *v, void *opaque, |
| 793 | const char *name, Error **errp) |
| 794 | { |
| 795 | USBDevice *dev = USB_DEVICE(obj); |
Gonglei | 79e2590 | 2015-05-06 20:55:32 +0800 | [diff] [blame] | 796 | MSDState *s = USB_STORAGE_DEV(dev); |
Gonglei | 89f0762 | 2014-10-07 16:00:33 +0800 | [diff] [blame] | 797 | 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 | |
| 817 | out: |
| 818 | if (local_err) { |
| 819 | error_propagate(errp, local_err); |
| 820 | } |
| 821 | } |
| 822 | |
Gonglei | 79e2590 | 2015-05-06 20:55:32 +0800 | [diff] [blame] | 823 | static 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 | |
Gonglei | 89f0762 | 2014-10-07 16:00:33 +0800 | [diff] [blame] | 831 | static 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 Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 839 | static void usb_msd_class_initfn_bot(ObjectClass *klass, void *data) |
| 840 | { |
| 841 | USBDeviceClass *uc = USB_DEVICE_CLASS(klass); |
Igor Mammedov | e9fd12a | 2014-09-26 09:28:35 +0000 | [diff] [blame] | 842 | DeviceClass *dc = DEVICE_CLASS(klass); |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 843 | |
Gonglei | 5a882e4 | 2014-09-19 14:48:29 +0800 | [diff] [blame] | 844 | uc->realize = usb_msd_realize_bot; |
Igor Mammedov | e9fd12a | 2014-09-26 09:28:35 +0000 | [diff] [blame] | 845 | dc->hotpluggable = false; |
Anthony Liguori | 62aed76 | 2011-12-15 14:53:10 -0600 | [diff] [blame] | 846 | } |
| 847 | |
Andreas Färber | 8c43a6f | 2013-01-10 16:19:07 +0100 | [diff] [blame] | 848 | static const TypeInfo msd_info = { |
Anthony Liguori | 39bffca | 2011-12-07 21:34:16 -0600 | [diff] [blame] | 849 | .name = "usb-storage", |
Gonglei | 79e2590 | 2015-05-06 20:55:32 +0800 | [diff] [blame] | 850 | .parent = TYPE_USB_STORAGE, |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 851 | .class_init = usb_msd_class_initfn_storage, |
Gonglei | 89f0762 | 2014-10-07 16:00:33 +0800 | [diff] [blame] | 852 | .instance_init = usb_msd_instance_init, |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 853 | }; |
| 854 | |
| 855 | static const TypeInfo bot_info = { |
| 856 | .name = "usb-bot", |
Gonglei | 79e2590 | 2015-05-06 20:55:32 +0800 | [diff] [blame] | 857 | .parent = TYPE_USB_STORAGE, |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 858 | .class_init = usb_msd_class_initfn_bot, |
Gerd Hoffmann | 806b602 | 2009-08-31 14:23:59 +0200 | [diff] [blame] | 859 | }; |
| 860 | |
Andreas Färber | 83f7d43 | 2012-02-09 15:20:55 +0100 | [diff] [blame] | 861 | static void usb_msd_register_types(void) |
Gerd Hoffmann | 806b602 | 2009-08-31 14:23:59 +0200 | [diff] [blame] | 862 | { |
Gonglei | 79e2590 | 2015-05-06 20:55:32 +0800 | [diff] [blame] | 863 | type_register_static(&usb_storage_dev_type_info); |
Anthony Liguori | 39bffca | 2011-12-07 21:34:16 -0600 | [diff] [blame] | 864 | type_register_static(&msd_info); |
Gerd Hoffmann | 3470733 | 2013-01-14 15:29:44 +0100 | [diff] [blame] | 865 | type_register_static(&bot_info); |
Anthony Liguori | ba02430 | 2011-12-08 14:56:53 -0600 | [diff] [blame] | 866 | usb_legacy_register("usb-storage", "disk", usb_msd_init); |
Gerd Hoffmann | 806b602 | 2009-08-31 14:23:59 +0200 | [diff] [blame] | 867 | } |
Andreas Färber | 83f7d43 | 2012-02-09 15:20:55 +0100 | [diff] [blame] | 868 | |
| 869 | type_init(usb_msd_register_types) |