From: Brett Creeley <[email protected]>

Add a new capabilities field in struct pds_core_drv_identity,
which requires bumping the identity version to 2, i.e.
PDS_CORE_IDENTITY_VERSION_2. If version 2 negotiation fails,
then quietly fall back to version 1. If version 1 negotiation
fails, then driver load will fail.

Another patch in the series will make use of the capabilities
field.

Signed-off-by: Brett Creeley <[email protected]>
---
 drivers/net/ethernet/amd/pds_core/dev.c | 28 +++++++++++++++++++++++-----
 include/linux/pds/pds_core_if.h         |  4 ++++
 2 files changed, 27 insertions(+), 5 deletions(-)

diff --git a/drivers/net/ethernet/amd/pds_core/dev.c 
b/drivers/net/ethernet/amd/pds_core/dev.c
index 5b86d6cd0ac3..f77bd5e48b92 100644
--- a/drivers/net/ethernet/amd/pds_core/dev.c
+++ b/drivers/net/ethernet/amd/pds_core/dev.c
@@ -243,15 +243,17 @@ int pdsc_devcmd_reset(struct pdsc *pdsc)
        return pdsc_devcmd(pdsc, &cmd, &comp, pdsc->devcmd_timeout);
 }
 
-static int pdsc_devcmd_identify_locked(struct pdsc *pdsc)
+static int pdsc_devcmd_identify_locked(struct pdsc *pdsc, u8 drv_ident_ver,
+                                      bool do_msg)
 {
        union pds_core_dev_comp comp = {};
        union pds_core_dev_cmd cmd = {
                .identify.opcode = PDS_CORE_CMD_IDENTIFY,
-               .identify.ver = PDS_CORE_IDENTITY_VERSION_1,
+               .identify.ver = drv_ident_ver,
        };
 
-       return pdsc_devcmd_locked(pdsc, &cmd, &comp, pdsc->devcmd_timeout);
+       return __pdsc_devcmd_locked(pdsc, &cmd, &comp, pdsc->devcmd_timeout,
+                                   do_msg);
 }
 
 static void pdsc_init_devinfo(struct pdsc *pdsc)
@@ -274,8 +276,9 @@ static void pdsc_init_devinfo(struct pdsc *pdsc)
        dev_dbg(pdsc->dev, "fw_version %s\n", pdsc->dev_info.fw_version);
 }
 
-static int pdsc_identify(struct pdsc *pdsc)
+static int pdsc_identify_ver(struct pdsc *pdsc, u8 drv_ident_ver)
 {
+       bool do_msg = drv_ident_ver == PDS_CORE_IDENTITY_VERSION_1;
        struct pds_core_drv_identity drv = {};
        size_t sz;
        int err;
@@ -298,7 +301,7 @@ static int pdsc_identify(struct pdsc *pdsc)
        sz = min_t(size_t, sizeof(drv), sizeof(pdsc->cmd_regs->data));
        memcpy_toio(&pdsc->cmd_regs->data, &drv, sz);
 
-       err = pdsc_devcmd_identify_locked(pdsc);
+       err = pdsc_devcmd_identify_locked(pdsc, drv_ident_ver, do_msg);
        if (!err) {
                sz = min_t(size_t, sizeof(pdsc->dev_ident),
                           sizeof(pdsc->cmd_regs->data));
@@ -327,6 +330,21 @@ static int pdsc_identify(struct pdsc *pdsc)
        return 0;
 }
 
+static int pdsc_identify(struct pdsc *pdsc)
+{
+       int err;
+
+       /* Older firmware rejects anything but PDS_CORE_IDENTIFY_VERSION_1
+        * instead of returning the max supported identify version, so retry if
+        * firmware doesn't support PDS_CORE_IDENTIFY_VERSION_2
+        */
+       err = pdsc_identify_ver(pdsc, PDS_CORE_IDENTITY_VERSION_2);
+       if (err)
+               err = pdsc_identify_ver(pdsc, PDS_CORE_IDENTITY_VERSION_1);
+
+       return err;
+}
+
 void pdsc_dev_uninit(struct pdsc *pdsc)
 {
        if (pdsc->intr_info) {
diff --git a/include/linux/pds/pds_core_if.h b/include/linux/pds/pds_core_if.h
index 17a87c1a55d7..619186f26b5b 100644
--- a/include/linux/pds/pds_core_if.h
+++ b/include/linux/pds/pds_core_if.h
@@ -119,6 +119,8 @@ struct pds_core_drv_identity {
  *                   value in usecs to device units using:
  *                   device units = usecs * mult / div
  * @vif_types:        How many of each VIF device type is supported
+ * @capabilities:     Device capabilities
+ *                   only supported on version >= PDS_CORE_IDENTITY_VERSION_2
  */
 struct pds_core_dev_identity {
        u8     version;
@@ -131,9 +133,11 @@ struct pds_core_dev_identity {
        __le32 intr_coal_mult;
        __le32 intr_coal_div;
        __le16 vif_types[PDS_DEV_TYPE_MAX];
+       __le64 capabilities;
 };
 
 #define PDS_CORE_IDENTITY_VERSION_1    1
+#define PDS_CORE_IDENTITY_VERSION_2    2
 
 /**
  * struct pds_core_dev_identify_cmd - Driver/device identify command

-- 
2.43.0


Reply via email to