[PATCH v2 130/148] net/ice/base: detect and store device sensor reading capability

[Anatoly Burakov]

From: Ian Stokes <ian.sto...@intel.com>

The driver can use this capability to see if temperature sensor reading or other
HW sensor reading capabilities are supported before reading them using the Get
Sensor Reading AQ command.

Signed-off-by: Eric Joyner <eric.joy...@intel.com>
Signed-off-by: Ian Stokes <ian.sto...@intel.com>
---
 drivers/net/ice/base/ice_adminq_cmd.h |  1 +
 drivers/net/ice/base/ice_common.c     | 23 +++++++++++++++++++++++
 drivers/net/ice/base/ice_type.h       |  3 +++
 3 files changed, 27 insertions(+)

diff --git a/drivers/net/ice/base/ice_adminq_cmd.h 
b/drivers/net/ice/base/ice_adminq_cmd.h
index cc4c2ce89e..90b15ed9ae 100644
--- a/drivers/net/ice/base/ice_adminq_cmd.h
+++ b/drivers/net/ice/base/ice_adminq_cmd.h
@@ -119,6 +119,7 @@ struct ice_aqc_list_caps_elem {
 #define ICE_AQC_CAPS_1588                              0x0046
 #define ICE_AQC_CAPS_MAX_MTU                           0x0047
 #define ICE_AQC_CAPS_IWARP                             0x0051
+#define ICE_AQC_CAPS_SENSOR_READING                    0x0067
 #define ICE_AQC_CAPS_PCIE_RESET_AVOIDANCE              0x0076
 #define ICE_AQC_CAPS_POST_UPDATE_RESET_RESTRICT                0x0077
 #define ICE_AQC_CAPS_NVM_MGMT                          0x0080
diff --git a/drivers/net/ice/base/ice_common.c 
b/drivers/net/ice/base/ice_common.c
index 5694c840bc..fcd40e398b 100644
--- a/drivers/net/ice/base/ice_common.c
+++ b/drivers/net/ice/base/ice_common.c
@@ -2853,6 +2853,26 @@ ice_parse_nac_topo_dev_caps(struct ice_hw *hw, struct 
ice_hw_dev_caps *dev_p,
                  dev_p->nac_topo.id);
 }
 
+/**
+ * ice_parse_sensor_reading_cap - Parse ICE_AQC_CAPS_SENSOR_READING cap
+ * @hw: pointer to the HW struct
+ * @dev_p: pointer to device capabilities structure
+ * @cap: capability element to parse
+ *
+ * Parse ICE_AQC_CAPS_SENSOR_READING for device capability for reading
+ * enabled sensors.
+ */
+static void
+ice_parse_sensor_reading_cap(struct ice_hw *hw, struct ice_hw_dev_caps *dev_p,
+                            struct ice_aqc_list_caps_elem *cap)
+{
+       dev_p->supported_sensors = LE32_TO_CPU(cap->number);
+
+       ice_debug(hw, ICE_DBG_INIT,
+                 "dev caps: supported sensors (bitmap) = 0x%x\n",
+                 dev_p->supported_sensors);
+}
+
 /**
  * ice_parse_dev_caps - Parse device capabilities
  * @hw: pointer to the HW struct
@@ -2901,6 +2921,9 @@ ice_parse_dev_caps(struct ice_hw *hw, struct 
ice_hw_dev_caps *dev_p,
                case ICE_AQC_CAPS_NAC_TOPOLOGY:
                        ice_parse_nac_topo_dev_caps(hw, dev_p, &cap_resp[i]);
                        break;
+               case ICE_AQC_CAPS_SENSOR_READING:
+                       ice_parse_sensor_reading_cap(hw, dev_p, &cap_resp[i]);
+                       break;
                default:
                        /* Don't list common capabilities as unknown */
                        if (!found)
diff --git a/drivers/net/ice/base/ice_type.h b/drivers/net/ice/base/ice_type.h
index ff37487636..5d4d85ff16 100644
--- a/drivers/net/ice/base/ice_type.h
+++ b/drivers/net/ice/base/ice_type.h
@@ -827,6 +827,9 @@ struct ice_hw_dev_caps {
        struct ice_ts_dev_info ts_dev_info;
        u32 num_funcs;
        struct ice_nac_topology nac_topo;
+       /* bitmap of supported sensors */
+       u32 supported_sensors;
+#define ICE_SENSOR_SUPPORT_E810_INT_TEMP       BIT(0)
 };
 
 /* Information about MAC such as address, etc... */
-- 
2.43.0