firmware: zynqmp: Add support for set sd config and is function supported

Add firmware API's to set SD configuration and to check if a purticular
function is supported.

Signed-off-by: Ashok Reddy Soma <ashok.reddy.soma@xilinx.com>
Signed-off-by: Michal Simek <michal.simek@xilinx.com>
Link: https://lore.kernel.org/r/f64fa2f73e4775e9ad2f4d91339d6c74b43116a3.1645626962.git.michal.simek@xilinx.com

diff --git a/drivers/firmware/firmware-zynqmp.c b/drivers/firmware/firmware-zynqmp.c
index 8d8492d99f7e96fc14705e3d426bd61d4607e3de..8916c558963519f67093767300f55b6d50593d35 100644 (file)
--- a/drivers/firmware/firmware-zynqmp.c
+++ b/drivers/firmware/firmware-zynqmp.c
@@ -140,6 +140,57 @@ unsigned int zynqmp_firmware_version(void)
        return pm_api_version;
 };
 
+int zynqmp_pm_set_sd_config(u32 node, enum pm_sd_config_type config, u32 value)
+{
+       int ret;
+
+       ret = xilinx_pm_request(PM_IOCTL, node, IOCTL_SET_SD_CONFIG,
+                               config, value, NULL);
+       if (ret)
+               printf("%s: node %d: set_sd_config %d failed\n",
+                      __func__, node, config);
+
+       return ret;
+}
+
+int zynqmp_pm_is_function_supported(const u32 api_id, const u32 id)
+{
+       int ret;
+       u32 *bit_mask;
+       u32 ret_payload[PAYLOAD_ARG_CNT];
+
+       /* Input arguments validation */
+       if (id >= 64 || (api_id != PM_IOCTL && api_id != PM_QUERY_DATA))
+               return -EINVAL;
+
+       /* Check feature check API version */
+       ret = xilinx_pm_request(PM_FEATURE_CHECK, PM_FEATURE_CHECK, 0, 0, 0,
+                               ret_payload);
+       if (ret)
+               return ret;
+
+       /* Check if feature check version 2 is supported or not */
+       if ((ret_payload[1] & FIRMWARE_VERSION_MASK) == PM_API_VERSION_2) {
+               /*
+                * Call feature check for IOCTL/QUERY API to get IOCTL ID or
+                * QUERY ID feature status.
+                */
+
+               ret = xilinx_pm_request(PM_FEATURE_CHECK, api_id, 0, 0, 0,
+                                       ret_payload);
+               if (ret)
+                       return ret;
+
+               bit_mask = &ret_payload[2];
+               if ((bit_mask[(id / 32)] & BIT((id % 32))) == 0)
+                       return -EOPNOTSUPP;
+       } else {
+               return -ENODATA;
+       }
+
+       return 0;
+}
+
 /**
  * Send a configuration object to the PMU firmware.
  *

diff --git a/include/zynqmp_firmware.h b/include/zynqmp_firmware.h
index 9033cc0e7386c6a8a9c0738245d003cd5c94713a..60c3df3da41a5f87561149870f4beef0c1e81cf7 100644 (file)
--- a/include/zynqmp_firmware.h
+++ b/include/zynqmp_firmware.h
@@ -395,6 +395,8 @@ int zynqmp_pmufw_config_close(void);
 void zynqmp_pmufw_load_config_object(const void *cfg_obj, size_t size);
 int xilinx_pm_request(u32 api_id, u32 arg0, u32 arg1, u32 arg2,
                      u32 arg3, u32 *ret_payload);
+int zynqmp_pm_set_sd_config(u32 node, enum pm_sd_config_type config, u32 value);
+int zynqmp_pm_is_function_supported(const u32 api_id, const u32 id);
 
 /* Type of Config Object */
 #define PM_CONFIG_OBJECT_TYPE_BASE     0x1U
@@ -426,5 +428,9 @@ enum zynqmp_pm_request_ack {
 #define ZYNQMP_PM_CAPABILITY_UNUSABLE  0x8U
 
 #define ZYNQMP_PM_MAX_QOS              100U
+/* Firmware feature check version mask */
+#define FIRMWARE_VERSION_MASK          GENMASK(15, 0)
+/* PM API versions */
+#define PM_API_VERSION_2               2
 
 #endif /* _ZYNQMP_FIRMWARE_H_ */