Avoid unnecessary stall condition

Author: Cacodemon345

src/usb/usb_msd.c

@@ -285,7 +285,7 @@ usb_device_msd_handle_data(usb_device_c *device, USBPacket *p)
             if (p->devep != 2)
                 goto fail;
 
-            if (scsi_devices[usb_msd->scsi_bus][usb_msd->current_lun].status == SCSI_STATUS_CHECK_CONDITION) {
+            if (usb_msd->phase != USB_MSDM_CBW && usb_msd->phase != USB_MSDM_CSW && scsi_devices[usb_msd->scsi_bus][usb_msd->current_lun].status == SCSI_STATUS_CHECK_CONDITION) {
                 usb_msd_log("Command failed\n");
                 usb_msd->phase = USB_MSDM_CSW;
                 usb_msd->current_csw.bCSWStatus = 0x01;
@@ -441,7 +441,7 @@ usb_device_msd_handle_data(usb_device_c *device, USBPacket *p)
             if (p->devep != 0x01)
                 goto fail;
 
-            if (scsi_devices[usb_msd->scsi_bus][usb_msd->current_lun].status == SCSI_STATUS_CHECK_CONDITION) {
+            if (usb_msd->phase != USB_MSDM_CBW && usb_msd->phase != USB_MSDM_CSW && scsi_devices[usb_msd->scsi_bus][usb_msd->current_lun].status == SCSI_STATUS_CHECK_CONDITION) {
                 usb_msd_log("Command failed (data in)\n");
                 usb_msd->phase = USB_MSDM_CSW;
                 usb_msd->current_csw.bCSWStatus = 0x01;