summaryrefslogtreecommitdiff
path: root/drivers/firmware
diff options
context:
space:
mode:
authorIbai Erkiaga <ibai.erkiaga-elorza@xilinx.com>2019-09-27 11:37:00 +0100
committerMichal Simek <michal.simek@xilinx.com>2019-10-08 09:55:11 +0200
commit490f6273168287139bd7a1c703d1c7eef65e5a05 (patch)
tree31de1fbc1c7c1aa028f458f3f91eedd0321b79f9 /drivers/firmware
parent17eb88e4e59111199279c5f53bbdb2b34fcedadd (diff)
downloadu-boot-490f6273168287139bd7a1c703d1c7eef65e5a05.tar.gz
firmware: zynqmp: get fw version with mailbox driver
Implements the function to get PMU Firmware version using the mailbox driver or smc call based on if running SPL or not. Additionally gets version as part of the ZynqMP Firmware driver probing Signed-off-by: Ibai Erkiaga <ibai.erkiaga-elorza@xilinx.com> Signed-off-by: Michal Simek <michal.simek@xilinx.com>
Diffstat (limited to 'drivers/firmware')
-rw-r--r--drivers/firmware/firmware-zynqmp.c76
1 files changed, 74 insertions, 2 deletions
diff --git a/drivers/firmware/firmware-zynqmp.c b/drivers/firmware/firmware-zynqmp.c
index 5ed2b32c11..d1fff328e8 100644
--- a/drivers/firmware/firmware-zynqmp.c
+++ b/drivers/firmware/firmware-zynqmp.c
@@ -12,11 +12,76 @@
#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;
+}
+
+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) {
+ if (IS_ENABLED(CONFIG_SPL_BUILD)) {
+ const u32 request[] = { PM_GET_API_VERSION };
+
+ ret = ipi_req(request, ARRAY_SIZE(request),
+ ret_payload, 2);
+ } else {
+ ret = invoke_smc(ZYNQMP_SIP_SVC_GET_API_VERSION, 0, 0,
+ 0, 0, ret_payload);
+ };
+
+ 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;
+};
+
static int zynqmp_power_probe(struct udevice *dev)
{
int ret = 0;
@@ -30,10 +95,17 @@ static int zynqmp_power_probe(struct udevice *dev)
}
ret = mbox_get_by_name(dev, "rx", &zynqmp_power.rx_chan);
- if (ret)
+ if (ret) {
debug("%s, cannot 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[] = {