Merge tag 'xilinx-for-v2020.01-part2' of https://gitlab.denx.de/u-boot/custodians...

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

diff --git a/drivers/firmware/firmware-zynqmp.c b/drivers/firmware/firmware-zynqmp.c
index adcef15e22aa115e719e6b27a4872cbc9c73c935..dea58b5581022148190ad5693aafad197f935809 100644 (file)
--- a/drivers/firmware/firmware-zynqmp.c
+++ b/drivers/firmware/firmware-zynqmp.c
@@ -110,19 +110,19 @@ void zynqmp_pmufw_load_config_object(const void *cfg_obj, size_t size)
 
 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__);
+               debug("%s: Cannot find rx mailbox\n", __func__);
                return ret;
        }
 
@@ -156,8 +156,10 @@ int __maybe_unused xilinx_pm_request(u32 api_id, u32 arg0, u32 arg1, u32 arg2,
         */
        struct pt_regs regs;
 
-       if (current_el() == 3)
-               return 0;
+       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;