From 27722ac1b0e27bf829da8bc9582804784721eeda Mon Sep 17 00:00:00 2001 From: Filip Drazic Date: Wed, 15 Mar 2017 11:50:47 +0100 Subject: [PATCH] zynqmp: pm: Implement PM_INIT_FINALIZE PM API call The PM_INIT_FINALIZE PM API is required to inform the PFW that APU is done with requesting nodes and that not-requested nodes can be powered down. If PM is not enabled, this call will never be made and PFW will never power down any of the nodes which APU can use. Signed-off-by: Filip Drazic --- plat/xilinx/zynqmp/pm_service/pm_api_sys.c | 16 ++++++++++++++++ plat/xilinx/zynqmp/pm_service/pm_api_sys.h | 1 + plat/xilinx/zynqmp/pm_service/pm_svc_main.c | 4 ++++ 3 files changed, 21 insertions(+) diff --git a/plat/xilinx/zynqmp/pm_service/pm_api_sys.c b/plat/xilinx/zynqmp/pm_service/pm_api_sys.c index e84c4547e..d746c2865 100644 --- a/plat/xilinx/zynqmp/pm_service/pm_api_sys.c +++ b/plat/xilinx/zynqmp/pm_service/pm_api_sys.c @@ -338,6 +338,22 @@ enum pm_ret_status pm_set_configuration(unsigned int phys_addr) return PM_RET_ERROR_NOTSUPPORTED; } +/** + * pm_init_finalize() - Call to notify PMU firmware that master has power + * management enabled and that it has finished its + * initialization + * + * @return Status returned by the PMU firmware + */ +enum pm_ret_status pm_init_finalize(void) +{ + uint32_t payload[PAYLOAD_ARG_CNT]; + + /* Send request to the PMU */ + PM_PACK_PAYLOAD1(payload, PM_INIT_FINALIZE); + return pm_ipi_send_sync(primary_proc, payload, NULL, 0); +} + /** * pm_get_node_status() - PM call to request a node's current status * @nid Node id diff --git a/plat/xilinx/zynqmp/pm_service/pm_api_sys.h b/plat/xilinx/zynqmp/pm_service/pm_api_sys.h index bdb0eac52..135bcc800 100644 --- a/plat/xilinx/zynqmp/pm_service/pm_api_sys.h +++ b/plat/xilinx/zynqmp/pm_service/pm_api_sys.h @@ -76,6 +76,7 @@ enum pm_ret_status pm_set_max_latency(enum pm_node_id nid, /* Miscellaneous API functions */ enum pm_ret_status pm_get_api_version(unsigned int *version); enum pm_ret_status pm_set_configuration(unsigned int phys_addr); +enum pm_ret_status pm_init_finalize(void); enum pm_ret_status pm_get_node_status(enum pm_node_id node, uint32_t *ret_buff); enum pm_ret_status pm_register_notifier(enum pm_node_id nid, diff --git a/plat/xilinx/zynqmp/pm_service/pm_svc_main.c b/plat/xilinx/zynqmp/pm_service/pm_svc_main.c index 02d2f2d2f..5a4da90eb 100644 --- a/plat/xilinx/zynqmp/pm_service/pm_svc_main.c +++ b/plat/xilinx/zynqmp/pm_service/pm_svc_main.c @@ -183,6 +183,10 @@ uint64_t pm_smc_handler(uint32_t smc_fid, uint64_t x1, uint64_t x2, uint64_t x3, ret = pm_set_configuration(pm_arg[0]); SMC_RET1(handle, (uint64_t)ret); + case PM_INIT_FINALIZE: + ret = pm_init_finalize(); + SMC_RET1(handle, (uint64_t)ret); + case PM_GET_NODE_STATUS: { uint32_t buff[3]; -- GitLab