drivers: scmi: add cpu lpm interface api

add scmi_cpu_pd_lpm_set api for nxp imx scmi interface

Signed-off-by: Yongxu Wang <[email protected]>

Author: yongxu-wang15

drivers/firmware/scmi/nxp/cpu.c

@@ -45,3 +45,39 @@ int scmi_cpu_sleep_mode_set(struct scmi_cpu_sleep_mode_config *cfg)
 
 	return 0;
 }
+
+int scmi_cpu_pd_lpm_set(struct scmi_cpu_pd_lpm_config *cfg)
+{
+	struct scmi_protocol *proto = &SCMI_PROTOCOL_NAME(SCMI_PROTOCOL_CPU_DOMAIN);
+	struct scmi_message msg, reply;
+	int status, ret;
+
+	/* sanity checks */
+	if (!proto || !cfg) {
+		return -EINVAL;
+	}
+
+	if (proto->id != SCMI_PROTOCOL_CPU_DOMAIN) {
+		return -EINVAL;
+	}
+
+	msg.hdr = SCMI_MESSAGE_HDR_MAKE(SCMI_CPU_DOMAIN_MSG_CPU_PD_LPM_CONFIG_SET, SCMI_COMMAND,
+					proto->id, 0x0);
+	msg.len = sizeof(*cfg);
+	msg.content = cfg;
+
+	reply.hdr = msg.hdr;
+	reply.len = sizeof(status);
+	reply.content = &status;
+
+	ret = scmi_send_message(proto, &msg, &reply, true);
+	if (ret < 0) {
+		return ret;
+	}
+
+	if (status != SCMI_SUCCESS) {
+		return scmi_status_to_errno(status);
+	}
+
+	return 0;
+}

include/zephyr/drivers/firmware/scmi/nxp/cpu.h

@@ -21,6 +21,8 @@
 
 #define SCMI_PROTOCOL_CPU_DOMAIN 130
 
+#define SCMI_CPU_MAX_PDCONFIGS_T 7U
+
 /**
  * @struct scmi_cpu_sleep_mode_config
  *
@@ -33,6 +35,23 @@ struct scmi_cpu_sleep_mode_config {
 	uint32_t sleep_mode;
 };
 
+struct scmi_pd_lpm_settings {
+	uint32_t domainId;
+	uint32_t lpmSetting;
+	uint32_t retMask;
+};
+
+/**
+ * @struct scmi_cpu_pd_lpm_config
+ *
+ * @brief Describes cpu power domain low power mode setting
+ */
+struct scmi_cpu_pd_lpm_config {
+	uint32_t cpu_id;
+	uint32_t num_cfg;
+	struct scmi_pd_lpm_settings cfgs[SCMI_CPU_MAX_PDCONFIGS_T];
+};
+
 /**
  * @brief CPU domain protocol command message IDs
  */
@@ -64,4 +83,14 @@ enum scmi_cpu_domain_message {
  */
 int scmi_cpu_sleep_mode_set(struct scmi_cpu_sleep_mode_config *cfg);
 
+/**
+ * @brief Send the SCMI_CPU_DOMAIN_MSG_CPU_PD_LPM_CONFIG_SET command and get its reply
+ *
+ * @param cfg pointer to structure containing configuration
+ * to be set
+ *
+ * @retval 0 if successful
+ * @retval negative errno if failure
+ */
+int scmi_cpu_pd_lpm_set(struct scmi_cpu_pd_lpm_config *cfg);
 #endif /* _INCLUDE_ZEPHYR_DRIVERS_FIRMWARE_SCMI_CPU_H_ */