1 files changed, 34 insertions, 2 deletions

diff --git a/drivers/scsi/scsi_lib.c b/drivers/scsi/scsi_lib.c
index bf80a4c5a48..6d5c7ff43f5 100644
--- a/drivers/scsi/scsi_lib.c
+++ b/drivers/scsi/scsi_lib.c
@@ -667,6 +667,30 @@ void scsi_release_buffers(struct scsi_cmnd *cmd)
 }
 EXPORT_SYMBOL(scsi_release_buffers);
 
+static int __scsi_error_from_host_byte(struct scsi_cmnd *cmd, int result)
+{
+        int error = 0;
+
+        switch(host_byte(result)) {
+        case DID_TRANSPORT_FAILFAST:
+                error = -ENOLINK;
+                break;
+        case DID_TARGET_FAILURE:
+                cmd->result |= (DID_OK << 16);
+                error = -EREMOTEIO;
+                break;
+        case DID_NEXUS_FAILURE:
+                cmd->result |= (DID_OK << 16);
+                error = -EBADE;
+                break;
+        default:
+                error = -EIO;
+                break;
+        }
+
+        return error;
+}
+
 /*
  * Function:    scsi_io_completion()
  *
@@ -737,7 +761,7 @@ void scsi_io_completion(struct scsi_cmnd *cmd, unsigned int good_bytes)
                                 req->sense_len = len;
                         }
                         if (!sense_deferred)
-                                error = -EIO;
+                                error = __scsi_error_from_host_byte(cmd, result);
                 }
 
                 req->resid_len = scsi_get_resid(cmd);
@@ -796,7 +820,7 @@ void scsi_io_completion(struct scsi_cmnd *cmd, unsigned int good_bytes)
         if (scsi_end_request(cmd, error, good_bytes, result == 0) == NULL)
                 return;
 
-        error = -EIO;
+        error = __scsi_error_from_host_byte(cmd, result);
 
         if (host_byte(result) == DID_RESET) {
                 /* Third party bus reset or reset for error recovery
@@ -843,6 +867,13 @@ void scsi_io_completion(struct scsi_cmnd *cmd, unsigned int good_bytes)
                                 description = "Host Data Integrity Failure";
                                 action = ACTION_FAIL;
                                 error = -EILSEQ;
+                        /* INVALID COMMAND OPCODE or INVALID FIELD IN CDB */
+                        } else if ((sshdr.asc == 0x20 || sshdr.asc == 0x24) &&
+                                   (cmd->cmnd[0] == UNMAP ||
+                                    cmd->cmnd[0] == WRITE_SAME_16 ||
+                                    cmd->cmnd[0] == WRITE_SAME)) {
+                                description = "Discard failure";
+                                action = ACTION_FAIL;
                         } else
                                 action = ACTION_FAIL;
                         break;
@@ -1038,6 +1069,7 @@ static struct scsi_cmnd *scsi_get_cmd_from_req(struct scsi_device *sdev,
         cmd->request = req;
 
         cmd->cmnd = req->cmd;
+        cmd->prot_op = SCSI_PROT_NORMAL;
 
         return cmd;
 }