[SCSI] zfcp: support for hardware data router

FICON Express8S supports hardware data router, which requires an
adapted qdio request format.
This part 2/2 exploits the functionality in zfcp.

Signed-off-by: Swen Schillig <swen@vnet.ibm.com>
Signed-off-by: Steffen Maier <maier@linux.vnet.ibm.com>
Signed-off-by: James Bottomley <JBottomley@Parallels.com>

1 files changed, 36 insertions, 0 deletions

diff --git a/drivers/s390/scsi/zfcp_dbf.c b/drivers/s390/scsi/zfcp_dbf.c
index 96d1462e0bf5..967e7b70e977 100644
--- a/drivers/s390/scsi/zfcp_dbf.c
+++ b/drivers/s390/scsi/zfcp_dbf.c
@@ -163,6 +163,42 @@ void zfcp_dbf_hba_bit_err(char *tag, struct zfcp_fsf_req *req)
         spin_unlock_irqrestore(&dbf->hba_lock, flags);
 }
 
+/**
+ * zfcp_dbf_hba_def_err - trace event for deferred error messages
+ * @adapter: pointer to struct zfcp_adapter
+ * @req_id: request id which caused the deferred error message
+ * @scount: number of sbals incl. the signaling sbal
+ * @pl: array of all involved sbals
+ */
+void zfcp_dbf_hba_def_err(struct zfcp_adapter *adapter, u64 req_id, u16 scount,
+                          void **pl)
+{
+        struct zfcp_dbf *dbf = adapter->dbf;
+        struct zfcp_dbf_pay *payload = &dbf->pay_buf;
+        unsigned long flags;
+        u16 length;
+
+        if (!pl)
+                return;
+
+        spin_lock_irqsave(&dbf->pay_lock, flags);
+        memset(payload, 0, sizeof(*payload));
+
+        memcpy(payload->area, "def_err", 7);
+        payload->fsf_req_id = req_id;
+        payload->counter = 0;
+        length = min((u16)sizeof(struct qdio_buffer),
+                     (u16)ZFCP_DBF_PAY_MAX_REC);
+
+        while ((char *)pl[payload->counter] && payload->counter < scount) {
+                memcpy(payload->data, (char *)pl[payload->counter], length);
+                debug_event(dbf->pay, 1, payload, zfcp_dbf_plen(length));
+                payload->counter++;
+        }
+
+        spin_unlock_irqrestore(&dbf->pay_lock, flags);
+}
+
 static void zfcp_dbf_set_common(struct zfcp_dbf_rec *rec,
                                 struct zfcp_adapter *adapter,
                                 struct zfcp_port *port,