From: Dave Marquardt <[email protected]>

Add extended FPIN handling to ibmvfc driver. Tell VIOS ibmvfc can
handle extended FPIN messages, convert any received FPIN messages to
struct fc_els descriptors, and extend ibmvfc_process_async_work to
handle extended FPIN messages.

Signed-off-by: Dave Marquardt <[email protected]>
---
 drivers/scsi/ibmvscsi/ibmvfc.c       |  55 ++++++++++++++++-
 drivers/scsi/ibmvscsi/ibmvfc.h       |  31 ++++++++++
 drivers/scsi/ibmvscsi/ibmvfc_kunit.c | 114 ++++++++++++++++++++++++++++++++++-
 3 files changed, 194 insertions(+), 6 deletions(-)

diff --git a/drivers/scsi/ibmvscsi/ibmvfc.c b/drivers/scsi/ibmvscsi/ibmvfc.c
index 36abca0bbd34..93622cb76adc 100644
--- a/drivers/scsi/ibmvscsi/ibmvfc.c
+++ b/drivers/scsi/ibmvscsi/ibmvfc.c
@@ -1515,7 +1515,8 @@ static void ibmvfc_set_login_info(struct ibmvfc_host 
*vhost)
        login_info->capabilities =
                cpu_to_be64(IBMVFC_CAN_MIGRATE | IBMVFC_CAN_SEND_VF_WWPN |
                            IBMVFC_CAN_USE_NOOP_CMD | IBMVFC_YES_SCSI |
-                           IBMVFC_USE_ASYNC_SUBQ | IBMVFC_CAN_HANDLE_FPIN);
+                           IBMVFC_USE_ASYNC_SUBQ | IBMVFC_CAN_HANDLE_FPIN |
+                           IBMVFC_CAN_HANDLE_FPIN_EXT);
 
        if (vhost->mq_enabled || vhost->using_channels)
                login_info->capabilities |= 
cpu_to_be64(IBMVFC_CAN_USE_CHANNELS);
@@ -3371,12 +3372,48 @@ ibmvfc_full_fpin_to_desc(struct ibmvfc_async_subq 
*ibmvfc_fpin)
                                          cpu_to_be32(1));
 }
 
+/**
+ * ibmvfc_ext_fpin_to_desc(): allocate and populate a struct fc_els_fpin struct
+ * containing a descriptor.
+ * @ibmvfc_fpin: Pointer to async subq FPIN data
+ *
+ * Allocate a struct fc_els_fpin containing a descriptor and populate
+ * based on data from *ibmvfc_fpin.
+ *
+ * Return:
+ * NULL     - unable to allocate structure
+ * non-NULL - pointer to populated struct fc_els_fpin
+ */
+static struct fc_els_fpin *
+ibmvfc_ext_fpin_to_desc(struct ibmvfc_async_subq_fpin *ibmvfc_fpin)
+{
+       u8 flags = ibmvfc_fpin->fpin_data.flags;
+       __be32 threshold = cpu_to_be32(IBMVFC_FPIN_DEFAULT_EVENT_THRESHOLD);
+       __be16 modifier = 0;
+       __be32 count = cpu_to_be32(1);
+       __be16 type = 0;
+
+       if (flags & IBMVFC_FPIN_EVENT_TYPE_VALID)
+               type = ibmvfc_fpin->fpin_data.event_type;
+       if (flags & IBMVFC_FPIN_MODIFIER_VALID)
+               modifier = ibmvfc_fpin->fpin_data.event_type_modifier;
+       if (flags & IBMVFC_FPIN_THRESHOLD_VALID)
+               threshold = ibmvfc_fpin->fpin_data.event_threshold;
+       if (flags & IBMVFC_FPIN_EVENT_COUNT_VALID)
+               count = ibmvfc_fpin->fpin_data.event_data.event_count;
+
+       return ibmvfc_common_fpin_to_desc(ibmvfc_fpin->fpin_status,
+                                         ibmvfc_fpin->wwpn, type,
+                                         modifier, threshold, count);
+}
+
 /**
  * ibmvfc_process_async_work - Process IBMVFC_AE_FPIN async CRQ from work queue
  * @work: pointer to work_struct
  */
 static void ibmvfc_process_async_work(struct work_struct *work)
 {
+       struct ibmvfc_async_subq_fpin *sqfpin;
        struct ibmvfc_target *tgt, *next;
        struct ibmvfc_async_subq *subq = NULL;
        struct ibmvfc_async_work *aw;
@@ -3437,8 +3474,20 @@ static void ibmvfc_process_async_work(struct work_struct 
*work)
 
        if (crq)
                fpin = ibmvfc_basic_fpin_to_desc(crq, tgt->wwpn);
-       else
-               fpin = ibmvfc_full_fpin_to_desc(subq);
+       else {
+               sqfpin = (struct ibmvfc_async_subq_fpin *)subq;
+               if ((subq->flags & IBMVFC_ASYNC_IS_FPIN_EXT) == 0) {
+                       fpin = ibmvfc_full_fpin_to_desc(subq);
+               } else if (!(sqfpin->fpin_data.flags & 
IBMVFC_FPIN_EVENT_TYPE_VALID)) {
+                       dev_err_ratelimited(vhost->dev,
+                                           "Invalid extended FPIN event 
received\n");
+               } else if (!ibmvfc_check_caps(vhost, IBMVFC_SUPPORT_FPIN_EXT)) {
+                       dev_err_ratelimited(vhost->dev,
+                                           "Unexpected extended FPIN event 
received\n");
+               } else {
+                       fpin = ibmvfc_ext_fpin_to_desc(sqfpin);
+               }
+       }
 
        if (fpin) {
                fc_host_fpin_rcv(tgt->vhost->host,
diff --git a/drivers/scsi/ibmvscsi/ibmvfc.h b/drivers/scsi/ibmvscsi/ibmvfc.h
index bbf19220af70..d9ee270e0ef9 100644
--- a/drivers/scsi/ibmvscsi/ibmvfc.h
+++ b/drivers/scsi/ibmvscsi/ibmvfc.h
@@ -184,6 +184,7 @@ struct ibmvfc_npiv_login {
 #define IBMVFC_YES_SCSI                        0x040
 #define IBMVFC_USE_ASYNC_SUBQ          0x100
 #define IBMVFC_CAN_USE_NOOP_CMD                0x200
+#define IBMVFC_CAN_HANDLE_FPIN_EXT     0x800
        __be64 node_name;
        struct srp_direct_buf async;
        u8 partition_name[IBMVFC_MAX_NAME];
@@ -233,6 +234,7 @@ struct ibmvfc_npiv_login_resp {
 #define IBMVFC_SUPPORT_SCSI            0x0200
 #define IBMVFC_SUPPORT_ASYNC_SUBQ      0x0800
 #define IBMVFC_SUPPORT_NOOP_CMD                0x1000
+#define IBMVFC_SUPPORT_FPIN_EXT                0x2000
        __be32 max_cmds;
        __be32 scsi_id_sz;
        __be64 max_dma_len;
@@ -715,6 +717,7 @@ struct ibmvfc_async_crq {
 struct ibmvfc_async_subq {
        volatile u8 valid;
 #define IBMVFC_ASYNC_ID_IS_ASSOC_ID    0x01
+#define IBMVFC_ASYNC_IS_FPIN_EXT       0x02
 #define IBMVFC_FC_EEH                  0x04
 #define IBMVFC_FC_FW_UPDATE            0x08
 #define IBMVFC_FC_FW_DUMP              0x10
@@ -731,6 +734,34 @@ struct ibmvfc_async_subq {
        } id;
 } __packed __aligned(8);
 
+struct ibmvfc_fpin_data {
+#define IBMVFC_FPIN_EVENT_TYPE_VALID   0x01
+#define IBMVFC_FPIN_MODIFIER_VALID     0x02
+#define IBMVFC_FPIN_THRESHOLD_VALID    0x04
+#define IBMVFC_FPIN_SEVERITY_VALID     0x08
+#define IBMVFC_FPIN_EVENT_COUNT_VALID  0x10
+       u8 flags;
+       u8 reserved[3];
+       __be16 event_type;
+       __be16 event_type_modifier;
+       __be32 event_threshold;
+       union {
+               u8 severity;
+               __be32 event_count;
+       } event_data;
+} __packed __aligned(8);
+
+struct ibmvfc_async_subq_fpin {
+       volatile u8 valid;
+       u8 flags;
+       u8 link_state;
+       u8 fpin_status;
+       __be16 event;
+       __be16 pad;
+       volatile __be64 wwpn;
+       struct ibmvfc_fpin_data fpin_data;
+} __packed __aligned(8);
+
 struct ibmvfc_async_work {
        struct ibmvfc_host *vhost;
        bool is_subq;
diff --git a/drivers/scsi/ibmvscsi/ibmvfc_kunit.c 
b/drivers/scsi/ibmvscsi/ibmvfc_kunit.c
index 6bde92197549..fab36891dbc2 100644
--- a/drivers/scsi/ibmvscsi/ibmvfc_kunit.c
+++ b/drivers/scsi/ibmvscsi/ibmvfc_kunit.c
@@ -3,6 +3,7 @@
 #include <kunit/visibility.h>
 #include <scsi/scsi_device.h>
 #include <scsi/scsi_transport_fc.h>
+#include <scsi/fc/fc_els.h>
 #include <linux/list.h>
 #include <linux/delay.h>
 #include "ibmvfc.h"
@@ -61,8 +62,6 @@ static void ibmvfc_async_fpin_test(struct kunit *test)
                msleep(1U);
        }
 
-       msleep(500U);
-
        post[IBMVFC_AE_FPIN_LINK_CONGESTED] = 
READ_ONCE(fc_host->fpin_stats.cn_device_specific);
        post[IBMVFC_AE_FPIN_PORT_CONGESTED] = 
READ_ONCE(tgt->rport->fpin_stats.cn);
        post[IBMVFC_AE_FPIN_PORT_CLEARED] = 
READ_ONCE(tgt->rport->fpin_stats.cn_clear);
@@ -115,8 +114,117 @@ static void ibmvfc_async_fpin_test(struct kunit *test)
                        post[IBMVFC_AE_FPIN_CONGESTION_CLEARED]);
 }
 
+#define IBMVFC_TEST_FPIN_EXT(fs, ev, stat, crq) {              \
+       crq.valid = 0x80;                                       \
+       crq.flags = IBMVFC_ASYNC_IS_FPIN_EXT;                   \
+       crq.link_state = IBMVFC_AE_LS_LINK_UP;                  \
+       crq.fpin_status = (fs);                                 \
+       crq.event = cpu_to_be16(IBMVFC_AE_FPIN);                \
+       crq.wwpn = cpu_to_be64(tgt->wwpn);                      \
+       crq.fpin_data.flags = IBMVFC_FPIN_EVENT_TYPE_VALID;     \
+       crq.fpin_data.event_type = cpu_to_be16((ev));           \
+       pre = READ_ONCE(tgt->rport->fpin_stats.stat);           \
+       ibmvfc_handle_async((struct ibmvfc_crq *)&crq, vhost, true);    \
+       msleep(1U);                                                     \
+       post = READ_ONCE(tgt->rport->fpin_stats.stat);          \
+}
+
+/**
+ * ibmvfc_extended_fpin_test - unit test for extended FPIN events
+ * @test: pointer to kunit structure
+ *
+ * Tests
+ *
+ * Return: void
+ */
+static void ibmvfc_extended_fpin_test(struct kunit *test)
+{
+       enum ibmvfc_ae_fpin_status fs;
+       struct ibmvfc_async_subq_fpin crq[IBMVFC_AE_FPIN_CONGESTION_CLEARED+1];
+       struct ibmvfc_async_subq_fpin
+               crqcn[IBMVFC_AE_FPIN_PORT_CONGESTED][FPIN_CONGN_DEVICE_SPEC+1];
+       struct ibmvfc_async_subq_fpin crqportdg[FPIN_LI_DEVICE_SPEC+1];
+       struct ibmvfc_target *tgt;
+       struct ibmvfc_host *vhost;
+       struct list_head *headp;
+       LIST_HEAD(evt_doneq);
+       u64 pre, post;
+
+       headp = ibmvfc_get_headp();
+       KUNIT_ASSERT_FALSE_MSG(test, list_empty(headp), "No ibmvfc devices 
available\n");
+       vhost = list_first_entry(headp, struct ibmvfc_host, queue);
+       KUNIT_ASSERT_GE_MSG(test, vhost->num_targets, 1, "No targets");
+
+       tgt = list_first_entry(&vhost->targets, struct ibmvfc_target, queue);
+       KUNIT_ASSERT_NOT_NULL(test, tgt->rport);
+
+       for (fs = IBMVFC_AE_FPIN_LINK_CONGESTED; fs <= 
IBMVFC_AE_FPIN_CONGESTION_CLEARED; fs++) {
+               switch (fs) {
+               case IBMVFC_AE_FPIN_PORT_CLEARED:
+               case IBMVFC_AE_FPIN_CONGESTION_CLEARED:
+                       crq[fs].valid = 0x80;
+                       crq[fs].flags = IBMVFC_ASYNC_IS_FPIN_EXT;
+                       crq[fs].link_state = IBMVFC_AE_LS_LINK_UP;
+                       crq[fs].fpin_status = fs;
+                       crq[fs].event = cpu_to_be16(IBMVFC_AE_FPIN);
+                       crq[fs].wwpn = cpu_to_be64(tgt->wwpn);
+                       crq[fs].fpin_data.flags = IBMVFC_FPIN_EVENT_TYPE_VALID;
+                       crq[fs].fpin_data.event_type = 
cpu_to_be16(FPIN_CONGN_CLEAR);
+                       pre = READ_ONCE(tgt->rport->fpin_stats.cn_clear);
+                       ibmvfc_handle_async((struct ibmvfc_crq *)&crq[fs], 
vhost, true);
+                       msleep(1U);
+                       post = READ_ONCE(tgt->rport->fpin_stats.cn_clear);
+                       break;
+               case IBMVFC_AE_FPIN_LINK_CONGESTED:
+               case IBMVFC_AE_FPIN_PORT_CONGESTED:
+                       IBMVFC_TEST_FPIN_EXT(fs, FPIN_CONGN_CLEAR, cn_clear,
+                                            crqcn[fs-1][FPIN_CONGN_CLEAR]);
+                       IBMVFC_TEST_FPIN_EXT(fs, FPIN_CONGN_LOST_CREDIT,
+                                            cn_lost_credit,
+                                            
crqcn[fs-1][FPIN_CONGN_LOST_CREDIT]);
+                       IBMVFC_TEST_FPIN_EXT(fs, FPIN_CONGN_CREDIT_STALL,
+                                            cn_credit_stall,
+                                            
crqcn[fs-1][FPIN_CONGN_CREDIT_STALL]);
+                       IBMVFC_TEST_FPIN_EXT(fs, FPIN_CONGN_OVERSUBSCRIPTION,
+                                            cn_oversubscription,
+                                            
crqcn[fs-1][FPIN_CONGN_OVERSUBSCRIPTION]);
+                       IBMVFC_TEST_FPIN_EXT(fs, FPIN_CONGN_DEVICE_SPEC,
+                                            cn_device_specific,
+                                            
crqcn[fs-1][FPIN_CONGN_DEVICE_SPEC]);
+                       break;
+               case IBMVFC_AE_FPIN_PORT_DEGRADED:
+                       IBMVFC_TEST_FPIN_EXT(fs, FPIN_LI_UNKNOWN,
+                                            li_failure_unknown,
+                                            crqportdg[FPIN_LI_UNKNOWN]);
+                       IBMVFC_TEST_FPIN_EXT(fs, FPIN_LI_LINK_FAILURE,
+                                            li_link_failure_count,
+                                            crqportdg[FPIN_LI_LINK_FAILURE]);
+                       IBMVFC_TEST_FPIN_EXT(fs, FPIN_LI_LOSS_OF_SYNC,
+                                            li_loss_of_sync_count,
+                                            crqportdg[FPIN_LI_LOSS_OF_SYNC]);
+                       IBMVFC_TEST_FPIN_EXT(fs, FPIN_LI_LOSS_OF_SIG,
+                                            li_loss_of_signals_count,
+                                            crqportdg[FPIN_LI_LOSS_OF_SIG]);
+                       IBMVFC_TEST_FPIN_EXT(fs, FPIN_LI_PRIM_SEQ_ERR,
+                                            li_prim_seq_err_count,
+                                            crqportdg[FPIN_LI_PRIM_SEQ_ERR]);
+                       IBMVFC_TEST_FPIN_EXT(fs, FPIN_LI_INVALID_TX_WD,
+                                            li_invalid_tx_word_count,
+                                            crqportdg[FPIN_LI_INVALID_TX_WD]);
+                       IBMVFC_TEST_FPIN_EXT(fs, FPIN_LI_INVALID_CRC,
+                                            li_invalid_crc_count,
+                                            crqportdg[FPIN_LI_INVALID_CRC]);
+                       IBMVFC_TEST_FPIN_EXT(fs, FPIN_LI_DEVICE_SPEC,
+                                            li_device_specific,
+                                            crqportdg[FPIN_LI_DEVICE_SPEC]);
+                       break;
+               }
+       }
+}
+
 static struct kunit_case ibmvfc_fpin_test_cases[] = {
-       KUNIT_CASE_SLOW(ibmvfc_async_fpin_test),
+       KUNIT_CASE(ibmvfc_async_fpin_test),
+       KUNIT_CASE(ibmvfc_extended_fpin_test),
        {},
 };
 

-- 
2.54.0



Reply via email to