2 * UAS (USB Attached SCSI) emulation
4 * Copyright Red Hat, Inc. 2012
6 * Author: Gerd Hoffmann <kraxel@redhat.com>
8 * This work is licensed under the terms of the GNU GPL, version 2 or later.
9 * See the COPYING file in the top-level directory.
12 #include "qemu-common.h"
13 #include "qemu-option.h"
14 #include "qemu-config.h"
18 #include "hw/usb/desc.h"
20 #include "hw/scsi-defs.h"
22 /* --------------------------------------------------------------------- */
24 #define UAS_UI_COMMAND 0x01
25 #define UAS_UI_SENSE 0x03
26 #define UAS_UI_RESPONSE 0x04
27 #define UAS_UI_TASK_MGMT 0x05
28 #define UAS_UI_READ_READY 0x06
29 #define UAS_UI_WRITE_READY 0x07
31 #define UAS_RC_TMF_COMPLETE 0x00
32 #define UAS_RC_INVALID_INFO_UNIT 0x02
33 #define UAS_RC_TMF_NOT_SUPPORTED 0x04
34 #define UAS_RC_TMF_FAILED 0x05
35 #define UAS_RC_TMF_SUCCEEDED 0x08
36 #define UAS_RC_INCORRECT_LUN 0x09
37 #define UAS_RC_OVERLAPPED_TAG 0x0a
39 #define UAS_TMF_ABORT_TASK 0x01
40 #define UAS_TMF_ABORT_TASK_SET 0x02
41 #define UAS_TMF_CLEAR_TASK_SET 0x04
42 #define UAS_TMF_LOGICAL_UNIT_RESET 0x08
43 #define UAS_TMF_I_T_NEXUS_RESET 0x10
44 #define UAS_TMF_CLEAR_ACA 0x40
45 #define UAS_TMF_QUERY_TASK 0x80
46 #define UAS_TMF_QUERY_TASK_SET 0x81
47 #define UAS_TMF_QUERY_ASYNC_EVENT 0x82
49 #define UAS_PIPE_ID_COMMAND 0x01
50 #define UAS_PIPE_ID_STATUS 0x02
51 #define UAS_PIPE_ID_DATA_IN 0x03
52 #define UAS_PIPE_ID_DATA_OUT 0x04
58 } QEMU_PACKED uas_ui_header
;
61 uint8_t prio_taskattr
; /* 6:3 priority, 2:0 task attribute */
63 uint8_t add_cdb_length
; /* 7:2 additional adb length (dwords) */
68 } QEMU_PACKED uas_ui_command
;
71 uint16_t status_qualifier
;
74 uint16_t sense_length
;
75 uint8_t sense_data
[18];
76 } QEMU_PACKED uas_ui_sense
;
79 uint16_t add_response_info
;
80 uint8_t response_code
;
81 } QEMU_PACKED uas_ui_response
;
88 } QEMU_PACKED uas_ui_task_mgmt
;
93 uas_ui_command command
;
95 uas_ui_task_mgmt task
;
96 uas_ui_response response
;
100 /* --------------------------------------------------------------------- */
102 typedef struct UASDevice UASDevice
;
103 typedef struct UASRequest UASRequest
;
104 typedef struct UASStatus UASStatus
;
113 QTAILQ_HEAD(, UASStatus
) results
;
114 QTAILQ_HEAD(, UASRequest
) requests
;
131 QTAILQ_ENTRY(UASRequest
) next
;
137 QTAILQ_ENTRY(UASStatus
) next
;
140 /* --------------------------------------------------------------------- */
143 STR_MANUFACTURER
= 1,
149 static const USBDescStrings desc_strings
= {
150 [STR_MANUFACTURER
] = "QEMU",
151 [STR_PRODUCT
] = "USB Attached SCSI HBA",
152 [STR_SERIALNUMBER
] = "27842",
153 [STR_CONFIG_HIGH
] = "High speed config (usb 2.0)",
156 static const USBDescIface desc_iface_high
= {
157 .bInterfaceNumber
= 0,
159 .bInterfaceClass
= USB_CLASS_MASS_STORAGE
,
160 .bInterfaceSubClass
= 0x06, /* SCSI */
161 .bInterfaceProtocol
= 0x62, /* UAS */
162 .eps
= (USBDescEndpoint
[]) {
164 .bEndpointAddress
= USB_DIR_OUT
| UAS_PIPE_ID_COMMAND
,
165 .bmAttributes
= USB_ENDPOINT_XFER_BULK
,
166 .wMaxPacketSize
= 512,
167 .extra
= (uint8_t[]) {
168 0x04, /* u8 bLength */
169 0x24, /* u8 bDescriptorType */
171 0x00, /* u8 bReserved */
174 .bEndpointAddress
= USB_DIR_IN
| UAS_PIPE_ID_STATUS
,
175 .bmAttributes
= USB_ENDPOINT_XFER_BULK
,
176 .wMaxPacketSize
= 512,
177 .extra
= (uint8_t[]) {
178 0x04, /* u8 bLength */
179 0x24, /* u8 bDescriptorType */
181 0x00, /* u8 bReserved */
184 .bEndpointAddress
= USB_DIR_IN
| UAS_PIPE_ID_DATA_IN
,
185 .bmAttributes
= USB_ENDPOINT_XFER_BULK
,
186 .wMaxPacketSize
= 512,
187 .extra
= (uint8_t[]) {
188 0x04, /* u8 bLength */
189 0x24, /* u8 bDescriptorType */
191 0x00, /* u8 bReserved */
194 .bEndpointAddress
= USB_DIR_OUT
| UAS_PIPE_ID_DATA_OUT
,
195 .bmAttributes
= USB_ENDPOINT_XFER_BULK
,
196 .wMaxPacketSize
= 512,
197 .extra
= (uint8_t[]) {
198 0x04, /* u8 bLength */
199 0x24, /* u8 bDescriptorType */
200 UAS_PIPE_ID_DATA_OUT
,
201 0x00, /* u8 bReserved */
207 static const USBDescDevice desc_device_high
= {
209 .bMaxPacketSize0
= 64,
210 .bNumConfigurations
= 1,
211 .confs
= (USBDescConfig
[]) {
214 .bConfigurationValue
= 1,
215 .iConfiguration
= STR_CONFIG_HIGH
,
216 .bmAttributes
= 0xc0,
218 .ifs
= &desc_iface_high
,
223 static const USBDesc desc
= {
225 .idVendor
= 0x46f4, /* CRC16() of "QEMU" */
228 .iManufacturer
= STR_MANUFACTURER
,
229 .iProduct
= STR_PRODUCT
,
230 .iSerialNumber
= STR_SERIALNUMBER
,
232 .high
= &desc_device_high
,
236 /* --------------------------------------------------------------------- */
238 static UASStatus
*usb_uas_alloc_status(uint8_t id
, uint16_t tag
)
240 UASStatus
*st
= g_new0(UASStatus
, 1);
242 st
->status
.hdr
.id
= id
;
243 st
->status
.hdr
.tag
= cpu_to_be16(tag
);
244 st
->length
= sizeof(uas_ui_header
);
248 static void usb_uas_send_status_bh(void *opaque
)
250 UASDevice
*uas
= opaque
;
251 UASStatus
*st
= QTAILQ_FIRST(&uas
->results
);
252 USBPacket
*p
= uas
->status
;
258 usb_packet_copy(p
, &st
->status
, st
->length
);
259 p
->result
= st
->length
;
260 QTAILQ_REMOVE(&uas
->results
, st
, next
);
263 usb_packet_complete(&uas
->dev
, p
);
266 static void usb_uas_queue_status(UASDevice
*uas
, UASStatus
*st
, int length
)
268 st
->length
+= length
;
269 QTAILQ_INSERT_TAIL(&uas
->results
, st
, next
);
272 * Just schedule bh make sure any in-flight data transaction
273 * is finished before completing (sending) the status packet.
275 qemu_bh_schedule(uas
->status_bh
);
277 USBEndpoint
*ep
= usb_ep_get(&uas
->dev
, USB_TOKEN_IN
,
283 static void usb_uas_queue_response(UASDevice
*uas
, uint16_t tag
,
284 uint8_t code
, uint16_t add_info
)
286 UASStatus
*st
= usb_uas_alloc_status(UAS_UI_RESPONSE
, tag
);
288 trace_usb_uas_response(uas
->dev
.addr
, tag
, code
);
289 st
->status
.response
.response_code
= code
;
290 st
->status
.response
.add_response_info
= cpu_to_be16(add_info
);
291 usb_uas_queue_status(uas
, st
, sizeof(uas_ui_response
));
294 static void usb_uas_queue_sense(UASRequest
*req
, uint8_t status
)
296 UASStatus
*st
= usb_uas_alloc_status(UAS_UI_SENSE
, req
->tag
);
299 trace_usb_uas_sense(req
->uas
->dev
.addr
, req
->tag
, status
);
300 st
->status
.sense
.status
= status
;
301 st
->status
.sense
.status_qualifier
= cpu_to_be16(0);
302 if (status
!= GOOD
) {
303 slen
= scsi_req_get_sense(req
->req
, st
->status
.sense
.sense_data
,
304 sizeof(st
->status
.sense
.sense_data
));
305 st
->status
.sense
.sense_length
= cpu_to_be16(slen
);
307 len
= sizeof(uas_ui_sense
) - sizeof(st
->status
.sense
.sense_data
) + slen
;
308 usb_uas_queue_status(req
->uas
, st
, len
);
311 static void usb_uas_queue_read_ready(UASRequest
*req
)
313 UASStatus
*st
= usb_uas_alloc_status(UAS_UI_READ_READY
, req
->tag
);
315 trace_usb_uas_read_ready(req
->uas
->dev
.addr
, req
->tag
);
316 usb_uas_queue_status(req
->uas
, st
, 0);
319 static void usb_uas_queue_write_ready(UASRequest
*req
)
321 UASStatus
*st
= usb_uas_alloc_status(UAS_UI_WRITE_READY
, req
->tag
);
323 trace_usb_uas_write_ready(req
->uas
->dev
.addr
, req
->tag
);
324 usb_uas_queue_status(req
->uas
, st
, 0);
327 /* --------------------------------------------------------------------- */
329 static int usb_uas_get_lun(uint64_t lun64
)
331 return (lun64
>> 48) & 0xff;
334 static SCSIDevice
*usb_uas_get_dev(UASDevice
*uas
, uint64_t lun64
)
336 if ((lun64
>> 56) != 0x00) {
339 return scsi_device_find(&uas
->bus
, 0, 0, usb_uas_get_lun(lun64
));
342 static void usb_uas_complete_data_packet(UASRequest
*req
)
346 if (!req
->data_async
) {
351 req
->data_async
= false;
352 usb_packet_complete(&req
->uas
->dev
, p
);
355 static void usb_uas_copy_data(UASRequest
*req
)
359 length
= MIN(req
->buf_size
- req
->buf_off
,
360 req
->data
->iov
.size
- req
->data
->result
);
361 trace_usb_uas_xfer_data(req
->uas
->dev
.addr
, req
->tag
, length
,
362 req
->data
->result
, req
->data
->iov
.size
,
363 req
->buf_off
, req
->buf_size
);
364 usb_packet_copy(req
->data
, scsi_req_get_buf(req
->req
) + req
->buf_off
,
366 req
->buf_off
+= length
;
367 req
->data_off
+= length
;
369 if (req
->data
->result
== req
->data
->iov
.size
) {
370 usb_uas_complete_data_packet(req
);
372 if (req
->buf_size
&& req
->buf_off
== req
->buf_size
) {
375 scsi_req_continue(req
->req
);
379 static void usb_uas_start_next_transfer(UASDevice
*uas
)
383 QTAILQ_FOREACH(req
, &uas
->requests
, next
) {
384 if (req
->active
|| req
->complete
) {
387 if (req
->req
->cmd
.mode
== SCSI_XFER_FROM_DEV
&& uas
->datain
== NULL
) {
389 usb_uas_queue_read_ready(req
);
393 if (req
->req
->cmd
.mode
== SCSI_XFER_TO_DEV
&& uas
->dataout
== NULL
) {
395 usb_uas_queue_write_ready(req
);
402 static UASRequest
*usb_uas_alloc_request(UASDevice
*uas
, uas_ui
*ui
)
406 req
= g_new0(UASRequest
, 1);
408 req
->tag
= be16_to_cpu(ui
->hdr
.tag
);
409 req
->lun
= be64_to_cpu(ui
->command
.lun
);
410 req
->dev
= usb_uas_get_dev(req
->uas
, req
->lun
);
414 static void usb_uas_scsi_free_request(SCSIBus
*bus
, void *priv
)
416 UASRequest
*req
= priv
;
417 UASDevice
*uas
= req
->uas
;
419 if (req
== uas
->datain
) {
422 if (req
== uas
->dataout
) {
425 QTAILQ_REMOVE(&uas
->requests
, req
, next
);
427 usb_uas_start_next_transfer(uas
);
430 static UASRequest
*usb_uas_find_request(UASDevice
*uas
, uint16_t tag
)
434 QTAILQ_FOREACH(req
, &uas
->requests
, next
) {
435 if (req
->tag
== tag
) {
442 static void usb_uas_scsi_transfer_data(SCSIRequest
*r
, uint32_t len
)
444 UASRequest
*req
= r
->hba_private
;
446 trace_usb_uas_scsi_data(req
->uas
->dev
.addr
, req
->tag
, len
);
450 usb_uas_copy_data(req
);
452 usb_uas_start_next_transfer(req
->uas
);
456 static void usb_uas_scsi_command_complete(SCSIRequest
*r
,
457 uint32_t status
, size_t resid
)
459 UASRequest
*req
= r
->hba_private
;
461 trace_usb_uas_scsi_complete(req
->uas
->dev
.addr
, req
->tag
, status
, resid
);
462 req
->complete
= true;
464 usb_uas_complete_data_packet(req
);
466 usb_uas_queue_sense(req
, status
);
467 scsi_req_unref(req
->req
);
470 static void usb_uas_scsi_request_cancelled(SCSIRequest
*r
)
472 UASRequest
*req
= r
->hba_private
;
474 /* FIXME: queue notification to status pipe? */
475 scsi_req_unref(req
->req
);
478 static const struct SCSIBusInfo usb_uas_scsi_info
= {
483 .transfer_data
= usb_uas_scsi_transfer_data
,
484 .complete
= usb_uas_scsi_command_complete
,
485 .cancel
= usb_uas_scsi_request_cancelled
,
486 .free_request
= usb_uas_scsi_free_request
,
489 /* --------------------------------------------------------------------- */
491 static void usb_uas_handle_reset(USBDevice
*dev
)
493 UASDevice
*uas
= DO_UPCAST(UASDevice
, dev
, dev
);
494 UASRequest
*req
, *nreq
;
497 trace_usb_uas_reset(dev
->addr
);
498 QTAILQ_FOREACH_SAFE(req
, &uas
->requests
, next
, nreq
) {
499 scsi_req_cancel(req
->req
);
501 QTAILQ_FOREACH_SAFE(st
, &uas
->results
, next
, nst
) {
502 QTAILQ_REMOVE(&uas
->results
, st
, next
);
507 static int usb_uas_handle_control(USBDevice
*dev
, USBPacket
*p
,
508 int request
, int value
, int index
, int length
, uint8_t *data
)
512 ret
= usb_desc_handle_control(dev
, p
, request
, value
, index
, length
, data
);
516 fprintf(stderr
, "%s: unhandled control request\n", __func__
);
517 return USB_RET_STALL
;
520 static void usb_uas_cancel_io(USBDevice
*dev
, USBPacket
*p
)
522 UASDevice
*uas
= DO_UPCAST(UASDevice
, dev
, dev
);
523 UASRequest
*req
, *nreq
;
525 if (uas
->status
== p
) {
527 qemu_bh_cancel(uas
->status_bh
);
530 QTAILQ_FOREACH_SAFE(req
, &uas
->requests
, next
, nreq
) {
531 if (req
->data
== p
) {
536 assert(!"canceled usb packet not found");
539 static void usb_uas_command(UASDevice
*uas
, uas_ui
*ui
)
544 req
= usb_uas_find_request(uas
, be16_to_cpu(ui
->hdr
.tag
));
548 req
= usb_uas_alloc_request(uas
, ui
);
549 if (req
->dev
== NULL
) {
553 trace_usb_uas_command(uas
->dev
.addr
, req
->tag
,
554 usb_uas_get_lun(req
->lun
),
555 req
->lun
>> 32, req
->lun
& 0xffffffff);
556 QTAILQ_INSERT_TAIL(&uas
->requests
, req
, next
);
557 req
->req
= scsi_req_new(req
->dev
, req
->tag
,
558 usb_uas_get_lun(req
->lun
),
559 ui
->command
.cdb
, req
);
560 len
= scsi_req_enqueue(req
->req
);
562 req
->data_size
= len
;
563 scsi_req_continue(req
->req
);
568 usb_uas_queue_response(uas
, req
->tag
, UAS_RC_OVERLAPPED_TAG
, 0);
573 * FIXME: Seems to upset linux, is this wrong?
574 * NOTE: Happens only with no scsi devices at the bus, not sure
575 * this is a valid UAS setup in the first place.
577 usb_uas_queue_response(uas
, req
->tag
, UAS_RC_INVALID_INFO_UNIT
, 0);
581 static void usb_uas_task(UASDevice
*uas
, uas_ui
*ui
)
583 uint16_t tag
= be16_to_cpu(ui
->hdr
.tag
);
584 uint64_t lun64
= be64_to_cpu(ui
->task
.lun
);
585 SCSIDevice
*dev
= usb_uas_get_dev(uas
, lun64
);
586 int lun
= usb_uas_get_lun(lun64
);
590 req
= usb_uas_find_request(uas
, be16_to_cpu(ui
->hdr
.tag
));
595 switch (ui
->task
.function
) {
596 case UAS_TMF_ABORT_TASK
:
597 task_tag
= be16_to_cpu(ui
->task
.task_tag
);
598 trace_usb_uas_tmf_abort_task(uas
->dev
.addr
, tag
, task_tag
);
602 if (dev
->lun
!= lun
) {
605 req
= usb_uas_find_request(uas
, task_tag
);
606 if (req
&& req
->dev
== dev
) {
607 scsi_req_cancel(req
->req
);
609 usb_uas_queue_response(uas
, tag
, UAS_RC_TMF_COMPLETE
, 0);
612 case UAS_TMF_LOGICAL_UNIT_RESET
:
613 trace_usb_uas_tmf_logical_unit_reset(uas
->dev
.addr
, tag
, lun
);
617 if (dev
->lun
!= lun
) {
620 qdev_reset_all(&dev
->qdev
);
621 usb_uas_queue_response(uas
, tag
, UAS_RC_TMF_COMPLETE
, 0);
625 trace_usb_uas_tmf_unsupported(uas
->dev
.addr
, tag
, ui
->task
.function
);
626 usb_uas_queue_response(uas
, tag
, UAS_RC_TMF_NOT_SUPPORTED
, 0);
632 usb_uas_queue_response(uas
, req
->tag
, UAS_RC_OVERLAPPED_TAG
, 0);
636 /* FIXME: correct? [see long comment in usb_uas_command()] */
637 usb_uas_queue_response(uas
, tag
, UAS_RC_INVALID_INFO_UNIT
, 0);
641 usb_uas_queue_response(uas
, tag
, UAS_RC_INCORRECT_LUN
, 0);
644 static int usb_uas_handle_data(USBDevice
*dev
, USBPacket
*p
)
646 UASDevice
*uas
= DO_UPCAST(UASDevice
, dev
, dev
);
653 case UAS_PIPE_ID_COMMAND
:
654 length
= MIN(sizeof(ui
), p
->iov
.size
);
655 usb_packet_copy(p
, &ui
, length
);
658 usb_uas_command(uas
, &ui
);
661 case UAS_UI_TASK_MGMT
:
662 usb_uas_task(uas
, &ui
);
666 fprintf(stderr
, "%s: unknown command ui: id 0x%x\n",
667 __func__
, ui
.hdr
.id
);
672 case UAS_PIPE_ID_STATUS
:
673 st
= QTAILQ_FIRST(&uas
->results
);
675 assert(uas
->status
== NULL
);
680 usb_packet_copy(p
, &st
->status
, st
->length
);
682 QTAILQ_REMOVE(&uas
->results
, st
, next
);
685 case UAS_PIPE_ID_DATA_IN
:
686 case UAS_PIPE_ID_DATA_OUT
:
687 req
= (p
->ep
->nr
== UAS_PIPE_ID_DATA_IN
) ? uas
->datain
: uas
->dataout
;
689 fprintf(stderr
, "%s: no inflight request\n", __func__
);
693 scsi_req_ref(req
->req
);
695 usb_uas_copy_data(req
);
696 if (p
->result
== p
->iov
.size
|| req
->complete
) {
700 req
->data_async
= true;
703 scsi_req_unref(req
->req
);
704 usb_uas_start_next_transfer(uas
);
707 fprintf(stderr
, "%s: invalid endpoint %d\n", __func__
, p
->ep
->nr
);
714 static void usb_uas_handle_destroy(USBDevice
*dev
)
716 UASDevice
*uas
= DO_UPCAST(UASDevice
, dev
, dev
);
718 qemu_bh_delete(uas
->status_bh
);
721 static int usb_uas_init(USBDevice
*dev
)
723 UASDevice
*uas
= DO_UPCAST(UASDevice
, dev
, dev
);
725 usb_desc_create_serial(dev
);
728 QTAILQ_INIT(&uas
->results
);
729 QTAILQ_INIT(&uas
->requests
);
730 uas
->status_bh
= qemu_bh_new(usb_uas_send_status_bh
, uas
);
732 scsi_bus_new(&uas
->bus
, &uas
->dev
.qdev
, &usb_uas_scsi_info
);
737 static const VMStateDescription vmstate_usb_uas
= {
740 .fields
= (VMStateField
[]) {
741 VMSTATE_USB_DEVICE(dev
, UASDevice
),
742 VMSTATE_END_OF_LIST()
746 static void usb_uas_class_initfn(ObjectClass
*klass
, void *data
)
748 DeviceClass
*dc
= DEVICE_CLASS(klass
);
749 USBDeviceClass
*uc
= USB_DEVICE_CLASS(klass
);
751 uc
->init
= usb_uas_init
;
752 uc
->product_desc
= desc_strings
[STR_PRODUCT
];
753 uc
->usb_desc
= &desc
;
754 uc
->cancel_packet
= usb_uas_cancel_io
;
755 uc
->handle_attach
= usb_desc_attach
;
756 uc
->handle_reset
= usb_uas_handle_reset
;
757 uc
->handle_control
= usb_uas_handle_control
;
758 uc
->handle_data
= usb_uas_handle_data
;
759 uc
->handle_destroy
= usb_uas_handle_destroy
;
760 dc
->fw_name
= "storage";
761 dc
->vmsd
= &vmstate_usb_uas
;
764 static TypeInfo uas_info
= {
766 .parent
= TYPE_USB_DEVICE
,
767 .instance_size
= sizeof(UASDevice
),
768 .class_init
= usb_uas_class_initfn
,
771 static void usb_uas_register_types(void)
773 type_register_static(&uas_info
);
776 type_init(usb_uas_register_types
)