Merge branch 'master' of https://gitlab.denx.de/u-boot/custodians/u-boot-spi

[oweals/u-boot.git] / drivers / firmware / firmware-zynqmp.c

diff --git a/drivers/firmware/firmware-zynqmp.c b/drivers/firmware/firmware-zynqmp.c
index 5ed2b32c1128139f3bfa852aab6bf0a127f2ad13..c37642569ddaf27453ab21a63068dd56d78002e9 100644 (file)
--- a/drivers/firmware/firmware-zynqmp.c
+++ b/drivers/firmware/firmware-zynqmp.c
@@ -7,33 +7,131 @@
 
 #include <common.h>
 #include <dm.h>
+#include <zynqmp_firmware.h>
 
 #if defined(CONFIG_ZYNQMP_IPI)
 #include <mailbox.h>
 #include <asm/arch/sys_proto.h>
 
+#define PMUFW_PAYLOAD_ARG_CNT  8
+
 struct zynqmp_power {
        struct mbox_chan tx_chan;
        struct mbox_chan rx_chan;
 } zynqmp_power;
 
+static int ipi_req(const u32 *req, size_t req_len, u32 *res, size_t res_maxlen)
+{
+       struct zynqmp_ipi_msg msg;
+       int ret;
+
+       if (req_len > PMUFW_PAYLOAD_ARG_CNT ||
+           res_maxlen > PMUFW_PAYLOAD_ARG_CNT)
+               return -EINVAL;
+
+       if (!(zynqmp_power.tx_chan.dev) || !(&zynqmp_power.rx_chan.dev))
+               return -EINVAL;
+
+       msg.buf = (u32 *)req;
+       msg.len = req_len;
+       ret = mbox_send(&zynqmp_power.tx_chan, &msg);
+       if (ret) {
+               debug("%s: Sending message failed\n", __func__);
+               return ret;
+       }
+
+       msg.buf = res;
+       msg.len = res_maxlen;
+       ret = mbox_recv(&zynqmp_power.rx_chan, &msg, 100);
+       if (ret)
+               debug("%s: Receiving message failed\n", __func__);
+
+       return ret;
+}
+
+static int send_req(const u32 *req, size_t req_len, u32 *res, size_t res_maxlen)
+{
+       if (IS_ENABLED(CONFIG_SPL_BUILD) || current_el() == 3)
+               return ipi_req(req, req_len, res, res_maxlen);
+
+       return xilinx_pm_request(req[0], 0, 0, 0, 0, res);
+}
+
+unsigned int zynqmp_firmware_version(void)
+{
+       int ret;
+       u32 ret_payload[PAYLOAD_ARG_CNT];
+       static u32 pm_api_version = ZYNQMP_PM_VERSION_INVALID;
+
+       /*
+        * Get PMU version only once and later
+        * just return stored values instead of
+        * asking PMUFW again.
+        **/
+       if (pm_api_version == ZYNQMP_PM_VERSION_INVALID) {
+               const u32 request[] = { PM_GET_API_VERSION };
+
+               ret = send_req(request, ARRAY_SIZE(request), ret_payload, 2);
+               if (ret)
+                       panic("PMUFW is not found - Please load it!\n");
+
+               pm_api_version = ret_payload[1];
+               if (pm_api_version < ZYNQMP_PM_VERSION)
+                       panic("PMUFW version error. Expected: v%d.%d\n",
+                             ZYNQMP_PM_VERSION_MAJOR, ZYNQMP_PM_VERSION_MINOR);
+       }
+
+       return pm_api_version;
+};
+
+/**
+ * Send a configuration object to the PMU firmware.
+ *
+ * @cfg_obj: Pointer to the configuration object
+ * @size:    Size of @cfg_obj in bytes
+ */
+void zynqmp_pmufw_load_config_object(const void *cfg_obj, size_t size)
+{
+       const u32 request[] = {
+               PM_SET_CONFIGURATION,
+               (u32)((u64)cfg_obj)
+       };
+       u32 response;
+       int err;
+
+       printf("Loading new PMUFW cfg obj (%ld bytes)\n", size);
+
+       err = send_req(request, ARRAY_SIZE(request), &response, 1);
+       if (err)
+               panic("Cannot load PMUFW configuration object (%d)\n", err);
+       if (response != 0)
+               panic("PMUFW returned 0x%08x status!\n", response);
+}
+
 static int zynqmp_power_probe(struct udevice *dev)
 {
-       int ret = 0;
+       int ret;
 
        debug("%s, (dev=%p)\n", __func__, dev);
 
        ret = mbox_get_by_name(dev, "tx", &zynqmp_power.tx_chan);
        if (ret) {
-               debug("%s, cannot tx mailbox\n", __func__);
+               debug("%s: Cannot find tx mailbox\n", __func__);
                return ret;
        }
 
        ret = mbox_get_by_name(dev, "rx", &zynqmp_power.rx_chan);
-       if (ret)
-               debug("%s, cannot rx mailbox\n", __func__);
+       if (ret) {
+               debug("%s: Cannot find rx mailbox\n", __func__);
+               return ret;
+       }
 
-       return ret;
+       ret = zynqmp_firmware_version();
+       printf("PMUFW:\tv%d.%d\n",
+              ret >> ZYNQMP_PM_VERSION_MAJOR_SHIFT,
+              ret & ZYNQMP_PM_VERSION_MINOR_MASK);
+
+       return 0;
 };
 
 static const struct udevice_id zynqmp_power_ids[] = {
@@ -49,6 +147,37 @@ U_BOOT_DRIVER(zynqmp_power) = {
 };
 #endif
 
+int __maybe_unused xilinx_pm_request(u32 api_id, u32 arg0, u32 arg1, u32 arg2,
+                                    u32 arg3, u32 *ret_payload)
+{
+       /*
+        * Added SIP service call Function Identifier
+        * Make sure to stay in x0 register
+        */
+       struct pt_regs regs;
+
+       if (current_el() == 3) {
+               printf("%s: Can't call SMC from EL3 context\n", __func__);
+               return -EPERM;
+       }
+
+       regs.regs[0] = PM_SIP_SVC | api_id;
+       regs.regs[1] = ((u64)arg1 << 32) | arg0;
+       regs.regs[2] = ((u64)arg3 << 32) | arg2;
+
+       smc_call(&regs);
+
+       if (ret_payload) {
+               ret_payload[0] = (u32)regs.regs[0];
+               ret_payload[1] = upper_32_bits(regs.regs[0]);
+               ret_payload[2] = (u32)regs.regs[1];
+               ret_payload[3] = upper_32_bits(regs.regs[1]);
+               ret_payload[4] = (u32)regs.regs[2];
+       }
+
+       return regs.regs[0];
+}
+
 static const struct udevice_id zynqmp_firmware_ids[] = {
        { .compatible = "xlnx,zynqmp-firmware" },
        { .compatible = "xlnx,versal-firmware"},
@@ -58,6 +187,5 @@ static const struct udevice_id zynqmp_firmware_ids[] = {
 U_BOOT_DRIVER(zynqmp_firmware) = {
        .id = UCLASS_FIRMWARE,
        .name = "zynqmp-firmware",
-       .probe = dm_scan_fdt_dev,
        .of_match = zynqmp_firmware_ids,
 };