usb: device_next: report medium error on Mass Storage failed writes

End Write command with Medium Error / Write Error when underlying disk
write or sync fails.

Signed-off-by: Tomasz Moń <tomasz.mon@nordicsemi.no>

Author: tmon-nordic

subsys/usb/device_next/class/usbd_msc_scsi.c

@@ -373,6 +373,15 @@ static size_t not_ready(struct scsi_ctx *ctx, enum scsi_additional_sense_code as
 	return 0;
 }
 
+static size_t medium_error(struct scsi_ctx *ctx, enum scsi_additional_sense_code asc)
+{
+	ctx->status = CHECK_CONDITION;
+	ctx->sense_key = MEDIUM_ERROR;
+	ctx->asc = asc;
+
+	return 0;
+}
+
 void scsi_init(struct scsi_ctx *ctx, const char *disk, const char *vendor,
 	       const char *product, const char *revision)
 {
@@ -738,24 +747,32 @@ static size_t store_write_10(struct scsi_ctx *ctx, const uint8_t *buf, size_t le
 {
 	uint32_t remaining_sectors;
 	uint32_t sectors;
+	bool error = false;
 
 	remaining_sectors = ctx->remaining_data / ctx->sector_size;
 	sectors = MIN(length, ctx->remaining_data) / ctx->sector_size;
 	if (disk_access_write(ctx->disk, buf, ctx->lba, sectors) != 0) {
 		/* Flush cache and terminate transfer */
 		sectors = 0;
 		remaining_sectors = 0;
+		error = true;
 	}
 
 	/* Flush cache if this is the last sector in transfer */
 	if (remaining_sectors - sectors == 0) {
 		if (disk_access_ioctl(ctx->disk, DISK_IOCTL_CTRL_SYNC, NULL)) {
 			LOG_ERR("Disk cache sync failed");
+			error = true;
 		}
 	}
 
 	ctx->lba += sectors;
-	return sectors * ctx->sector_size;
+
+	if (error) {
+		return medium_error(ctx, WRITE_ERROR);
+	} else {
+		return sectors * ctx->sector_size;
+	}
 }
 
 SCSI_CMD_HANDLER(WRITE_10)

subsys/usb/device_next/class/usbd_msc_scsi.h

@@ -58,6 +58,7 @@ enum scsi_additional_sense_code {
 	INVALID_FIELD_IN_CDB = 0x2400,
 	MEDIUM_NOT_PRESENT = 0x3A00,
 	MEDIUM_REMOVAL_PREVENTED = 0x5302,
+	WRITE_ERROR = 0x0C00,
 };
 
 struct scsi_ctx {