Merge remote-tracking branch 'kraxel/usb.31' into staging
This commit is contained in:
		
						commit
						a3baf1be67
					
				@ -2046,6 +2046,7 @@ static void ehci_advance_state(EHCIState *ehci,
 | 
				
			|||||||
            break;
 | 
					            break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
        case EST_WRITEBACK:
 | 
					        case EST_WRITEBACK:
 | 
				
			||||||
 | 
					            assert(q != NULL);
 | 
				
			||||||
            again = ehci_state_writeback(q, async);
 | 
					            again = ehci_state_writeback(q, async);
 | 
				
			||||||
            break;
 | 
					            break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
				
			|||||||
							
								
								
									
										65
									
								
								hw/usb-msd.c
									
									
									
									
									
								
							
							
						
						
									
										65
									
								
								hw/usb-msd.c
									
									
									
									
									
								
							@ -38,6 +38,13 @@ enum USBMSDMode {
 | 
				
			|||||||
    USB_MSDM_CSW /* Command Status.  */
 | 
					    USB_MSDM_CSW /* Command Status.  */
 | 
				
			||||||
};
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					struct usb_msd_csw {
 | 
				
			||||||
 | 
					    uint32_t sig;
 | 
				
			||||||
 | 
					    uint32_t tag;
 | 
				
			||||||
 | 
					    uint32_t residue;
 | 
				
			||||||
 | 
					    uint8_t status;
 | 
				
			||||||
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
typedef struct {
 | 
					typedef struct {
 | 
				
			||||||
    USBDevice dev;
 | 
					    USBDevice dev;
 | 
				
			||||||
    enum USBMSDMode mode;
 | 
					    enum USBMSDMode mode;
 | 
				
			||||||
@ -45,14 +52,13 @@ typedef struct {
 | 
				
			|||||||
    uint8_t *scsi_buf;
 | 
					    uint8_t *scsi_buf;
 | 
				
			||||||
    uint32_t data_len;
 | 
					    uint32_t data_len;
 | 
				
			||||||
    uint32_t residue;
 | 
					    uint32_t residue;
 | 
				
			||||||
    uint32_t tag;
 | 
					    struct usb_msd_csw csw;
 | 
				
			||||||
    SCSIRequest *req;
 | 
					    SCSIRequest *req;
 | 
				
			||||||
    SCSIBus bus;
 | 
					    SCSIBus bus;
 | 
				
			||||||
    BlockConf conf;
 | 
					    BlockConf conf;
 | 
				
			||||||
    char *serial;
 | 
					    char *serial;
 | 
				
			||||||
    SCSIDevice *scsi_dev;
 | 
					    SCSIDevice *scsi_dev;
 | 
				
			||||||
    uint32_t removable;
 | 
					    uint32_t removable;
 | 
				
			||||||
    int result;
 | 
					 | 
				
			||||||
    /* For async completion.  */
 | 
					    /* For async completion.  */
 | 
				
			||||||
    USBPacket *packet;
 | 
					    USBPacket *packet;
 | 
				
			||||||
} MSDState;
 | 
					} MSDState;
 | 
				
			||||||
@ -67,13 +73,6 @@ struct usb_msd_cbw {
 | 
				
			|||||||
    uint8_t cmd[16];
 | 
					    uint8_t cmd[16];
 | 
				
			||||||
};
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
struct usb_msd_csw {
 | 
					 | 
				
			||||||
    uint32_t sig;
 | 
					 | 
				
			||||||
    uint32_t tag;
 | 
					 | 
				
			||||||
    uint32_t residue;
 | 
					 | 
				
			||||||
    uint8_t status;
 | 
					 | 
				
			||||||
};
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
enum {
 | 
					enum {
 | 
				
			||||||
    STR_MANUFACTURER = 1,
 | 
					    STR_MANUFACTURER = 1,
 | 
				
			||||||
    STR_PRODUCT,
 | 
					    STR_PRODUCT,
 | 
				
			||||||
@ -191,17 +190,15 @@ static void usb_msd_copy_data(MSDState *s, USBPacket *p)
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
static void usb_msd_send_status(MSDState *s, USBPacket *p)
 | 
					static void usb_msd_send_status(MSDState *s, USBPacket *p)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
    struct usb_msd_csw csw;
 | 
					 | 
				
			||||||
    int len;
 | 
					    int len;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    csw.sig = cpu_to_le32(0x53425355);
 | 
					    DPRINTF("Command status %d tag 0x%x, len %zd\n",
 | 
				
			||||||
    csw.tag = cpu_to_le32(s->tag);
 | 
					            s->csw.status, s->csw.tag, p->iov.size);
 | 
				
			||||||
    csw.residue = s->residue;
 | 
					 | 
				
			||||||
    csw.status = s->result;
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
    len = MIN(sizeof(csw), p->iov.size);
 | 
					    assert(s->csw.sig == 0x53425355);
 | 
				
			||||||
    usb_packet_copy(p, &csw, len);
 | 
					    len = MIN(sizeof(s->csw), p->iov.size);
 | 
				
			||||||
    p->result = len;
 | 
					    usb_packet_copy(p, &s->csw, len);
 | 
				
			||||||
 | 
					    memset(&s->csw, 0, sizeof(s->csw));
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static void usb_msd_transfer_data(SCSIRequest *req, uint32_t len)
 | 
					static void usb_msd_transfer_data(SCSIRequest *req, uint32_t len)
 | 
				
			||||||
@ -231,9 +228,14 @@ static void usb_msd_command_complete(SCSIRequest *req, uint32_t status)
 | 
				
			|||||||
    MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
 | 
					    MSDState *s = DO_UPCAST(MSDState, dev.qdev, req->bus->qbus.parent);
 | 
				
			||||||
    USBPacket *p = s->packet;
 | 
					    USBPacket *p = s->packet;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    DPRINTF("Command complete %d\n", status);
 | 
					    DPRINTF("Command complete %d tag 0x%x\n", status, req->tag);
 | 
				
			||||||
    s->residue = s->data_len;
 | 
					    s->residue = s->data_len;
 | 
				
			||||||
    s->result = status != 0;
 | 
					
 | 
				
			||||||
 | 
					    s->csw.sig = cpu_to_le32(0x53425355);
 | 
				
			||||||
 | 
					    s->csw.tag = cpu_to_le32(req->tag);
 | 
				
			||||||
 | 
					    s->csw.residue = s->residue;
 | 
				
			||||||
 | 
					    s->csw.status = status != 0;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    if (s->packet) {
 | 
					    if (s->packet) {
 | 
				
			||||||
        if (s->data_len == 0 && s->mode == USB_MSDM_DATAOUT) {
 | 
					        if (s->data_len == 0 && s->mode == USB_MSDM_DATAOUT) {
 | 
				
			||||||
            /* A deferred packet with no write data remaining must be
 | 
					            /* A deferred packet with no write data remaining must be
 | 
				
			||||||
@ -334,6 +336,7 @@ static void usb_msd_cancel_io(USBDevice *dev, USBPacket *p)
 | 
				
			|||||||
static int usb_msd_handle_data(USBDevice *dev, USBPacket *p)
 | 
					static int usb_msd_handle_data(USBDevice *dev, USBPacket *p)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
    MSDState *s = (MSDState *)dev;
 | 
					    MSDState *s = (MSDState *)dev;
 | 
				
			||||||
 | 
					    uint32_t tag;
 | 
				
			||||||
    int ret = 0;
 | 
					    int ret = 0;
 | 
				
			||||||
    struct usb_msd_cbw cbw;
 | 
					    struct usb_msd_cbw cbw;
 | 
				
			||||||
    uint8_t devep = p->devep;
 | 
					    uint8_t devep = p->devep;
 | 
				
			||||||
@ -360,7 +363,7 @@ static int usb_msd_handle_data(USBDevice *dev, USBPacket *p)
 | 
				
			|||||||
                fprintf(stderr, "usb-msd: Bad LUN %d\n", cbw.lun);
 | 
					                fprintf(stderr, "usb-msd: Bad LUN %d\n", cbw.lun);
 | 
				
			||||||
                goto fail;
 | 
					                goto fail;
 | 
				
			||||||
            }
 | 
					            }
 | 
				
			||||||
            s->tag = le32_to_cpu(cbw.tag);
 | 
					            tag = le32_to_cpu(cbw.tag);
 | 
				
			||||||
            s->data_len = le32_to_cpu(cbw.data_len);
 | 
					            s->data_len = le32_to_cpu(cbw.data_len);
 | 
				
			||||||
            if (s->data_len == 0) {
 | 
					            if (s->data_len == 0) {
 | 
				
			||||||
                s->mode = USB_MSDM_CSW;
 | 
					                s->mode = USB_MSDM_CSW;
 | 
				
			||||||
@ -370,14 +373,12 @@ static int usb_msd_handle_data(USBDevice *dev, USBPacket *p)
 | 
				
			|||||||
                s->mode = USB_MSDM_DATAOUT;
 | 
					                s->mode = USB_MSDM_DATAOUT;
 | 
				
			||||||
            }
 | 
					            }
 | 
				
			||||||
            DPRINTF("Command tag 0x%x flags %08x len %d data %d\n",
 | 
					            DPRINTF("Command tag 0x%x flags %08x len %d data %d\n",
 | 
				
			||||||
                    s->tag, cbw.flags, cbw.cmd_len, s->data_len);
 | 
					                    tag, cbw.flags, cbw.cmd_len, s->data_len);
 | 
				
			||||||
            s->residue = 0;
 | 
					            s->residue = 0;
 | 
				
			||||||
            s->scsi_len = 0;
 | 
					            s->scsi_len = 0;
 | 
				
			||||||
            s->req = scsi_req_new(s->scsi_dev, s->tag, 0, cbw.cmd, NULL);
 | 
					            s->req = scsi_req_new(s->scsi_dev, tag, 0, cbw.cmd, NULL);
 | 
				
			||||||
            scsi_req_enqueue(s->req);
 | 
					            scsi_req_enqueue(s->req);
 | 
				
			||||||
            /* ??? Should check that USB and SCSI data transfer
 | 
					            if (s->req && s->req->cmd.xfer != SCSI_XFER_NONE) {
 | 
				
			||||||
               directions match.  */
 | 
					 | 
				
			||||||
            if (s->mode != USB_MSDM_CSW && s->residue == 0) {
 | 
					 | 
				
			||||||
                scsi_req_continue(s->req);
 | 
					                scsi_req_continue(s->req);
 | 
				
			||||||
            }
 | 
					            }
 | 
				
			||||||
            ret = p->result;
 | 
					            ret = p->result;
 | 
				
			||||||
@ -432,15 +433,19 @@ static int usb_msd_handle_data(USBDevice *dev, USBPacket *p)
 | 
				
			|||||||
            break;
 | 
					            break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
        case USB_MSDM_CSW:
 | 
					        case USB_MSDM_CSW:
 | 
				
			||||||
            DPRINTF("Command status %d tag 0x%x, len %zd\n",
 | 
					 | 
				
			||||||
                    s->result, s->tag, p->iov.size);
 | 
					 | 
				
			||||||
            if (p->iov.size < 13) {
 | 
					            if (p->iov.size < 13) {
 | 
				
			||||||
                goto fail;
 | 
					                goto fail;
 | 
				
			||||||
            }
 | 
					            }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
            usb_msd_send_status(s, p);
 | 
					            if (s->req) {
 | 
				
			||||||
            s->mode = USB_MSDM_CBW;
 | 
					                /* still in flight */
 | 
				
			||||||
            ret = 13;
 | 
					                s->packet = p;
 | 
				
			||||||
 | 
					                ret = USB_RET_ASYNC;
 | 
				
			||||||
 | 
					            } else {
 | 
				
			||||||
 | 
					                usb_msd_send_status(s, p);
 | 
				
			||||||
 | 
					                s->mode = USB_MSDM_CBW;
 | 
				
			||||||
 | 
					                ret = 13;
 | 
				
			||||||
 | 
					            }
 | 
				
			||||||
            break;
 | 
					            break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
        case USB_MSDM_DATAIN:
 | 
					        case USB_MSDM_DATAIN:
 | 
				
			||||||
 | 
				
			|||||||
@ -1568,7 +1568,12 @@ static int usb_host_scan_dev(void *opaque, USBScanFunc *func)
 | 
				
			|||||||
        if (line[0] == 'T' && line[1] == ':') {
 | 
					        if (line[0] == 'T' && line[1] == ':') {
 | 
				
			||||||
            if (device_count && (vendor_id || product_id)) {
 | 
					            if (device_count && (vendor_id || product_id)) {
 | 
				
			||||||
                /* New device.  Add the previously discovered device.  */
 | 
					                /* New device.  Add the previously discovered device.  */
 | 
				
			||||||
                ret = func(opaque, bus_num, addr, 0, class_id, vendor_id,
 | 
					                if (port > 0) {
 | 
				
			||||||
 | 
					                    snprintf(buf, sizeof(buf), "%d", port);
 | 
				
			||||||
 | 
					                } else {
 | 
				
			||||||
 | 
					                    snprintf(buf, sizeof(buf), "?");
 | 
				
			||||||
 | 
					                }
 | 
				
			||||||
 | 
					                ret = func(opaque, bus_num, addr, buf, class_id, vendor_id,
 | 
				
			||||||
                           product_id, product_name, speed);
 | 
					                           product_id, product_name, speed);
 | 
				
			||||||
                if (ret) {
 | 
					                if (ret) {
 | 
				
			||||||
                    goto the_end;
 | 
					                    goto the_end;
 | 
				
			||||||
 | 
				
			|||||||
		Loading…
	
	
			
			x
			
			
		
	
		Reference in New Issue
	
	Block a user