drivers: firmware: scmi: add reset vector interface

Add scmi_cpu_reset_vector API for NXP SCMI CPU domain protocol.

This API allows setting CPU reset vector addresses using the
CPU_RESET_VECTOR_SET command. The vector address must point to
the initial address of the vector table

Supports 64-bit addresses and boot/start/resume vector flags.

Signed-off-by: Yongxu Wang <yongxu.wang@nxp.com>

Author: yongxu-wang15

drivers/firmware/scmi/nxp/cpu.c

@@ -114,3 +114,35 @@ int scmi_cpu_set_irq_mask(struct scmi_cpu_irq_mask_config *cfg)
 
 	return scmi_status_to_errno(status);
 }
+
+int scmi_cpu_reset_vector(struct scmi_cpu_vector_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_RESET_VECTOR_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;
+	}
+
+	return scmi_status_to_errno(status);
+}

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

@@ -25,6 +25,15 @@
 
 #define SCMI_CPU_IRQ_WAKE_NUM	22U
 
+/** CPU vector flag: Boot address (cold boot/reset) */
+#define SCMI_CPU_VEC_FLAGS_BOOT    BIT(29)
+
+/** CPU vector flag: Start address (warm start) */
+#define SCMI_CPU_VEC_FLAGS_START   BIT(30)
+
+/** CPU vector flag: Resume address (exit from suspend) */
+#define SCMI_CPU_VEC_FLAGS_RESUME  BIT(31)
+
 /**
  * @struct scmi_cpu_sleep_mode_config
  *
@@ -66,6 +75,18 @@ struct scmi_cpu_irq_mask_config {
 	uint32_t mask[SCMI_CPU_IRQ_WAKE_NUM];
 };
 
+/**
+ * @struct scmi_cpu_vector_config
+ *
+ * @brief Describes the parameters for the CPU_RESET_VECTOR_SET command
+ */
+struct scmi_cpu_vector_config {
+	uint32_t cpu_id;
+	uint32_t flags;
+	uint32_t vector_low;
+	uint32_t vector_high;
+};
+
 /**
  * @brief CPU domain protocol command message IDs
  */
@@ -117,4 +138,14 @@ int scmi_cpu_pd_lpm_set(struct scmi_cpu_pd_lpm_config *cfg);
  * @retval negative errno if failure
  */
 int scmi_cpu_set_irq_mask(struct scmi_cpu_irq_mask_config *cfg);
+
+/**
+ * @brief Send the CPU_RESET_VECTOR_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_reset_vector(struct scmi_cpu_vector_config *cfg);
 #endif /* _INCLUDE_ZEPHYR_DRIVERS_FIRMWARE_SCMI_CPU_H_ */