| /* |
| * Copyright (c) 2019-2021, Xilinx, Inc. All rights reserved. |
| * |
| * SPDX-License-Identifier: BSD-3-Clause |
| */ |
| |
| /* |
| * Versal system level PM-API functions and communication with PMC via |
| * IPI interrupts |
| */ |
| |
| #include <pm_common.h> |
| #include <pm_ipi.h> |
| #include <plat/common/platform.h> |
| #include "pm_api_sys.h" |
| #include "pm_client.h" |
| #include "pm_defs.h" |
| #include "pm_svc_main.h" |
| #include "../drivers/arm/gic/v3/gicv3_private.h" |
| |
| /********************************************************************* |
| * Target module IDs macros |
| ********************************************************************/ |
| #define LIBPM_MODULE_ID 0x2U |
| #define LOADER_MODULE_ID 0x7U |
| |
| #define MODE 0x80000000U |
| /* default shutdown/reboot scope is system(2) */ |
| static unsigned int pm_shutdown_scope = XPM_SHUTDOWN_SUBTYPE_RST_SYSTEM; |
| |
| /** |
| * pm_get_shutdown_scope() - Get the currently set shutdown scope |
| * |
| * @return Shutdown scope value |
| */ |
| unsigned int pm_get_shutdown_scope(void) |
| { |
| return pm_shutdown_scope; |
| } |
| |
| /** |
| * Assigning of argument values into array elements. |
| */ |
| #define PM_PACK_PAYLOAD1(pl, mid, flag, arg0) { \ |
| pl[0] = (uint32_t)(((uint32_t)(arg0) & 0xFFU) | ((mid) << 8U) | ((flag) << 24U)); \ |
| } |
| |
| #define PM_PACK_PAYLOAD2(pl, mid, flag, arg0, arg1) { \ |
| pl[1] = (uint32_t)(arg1); \ |
| PM_PACK_PAYLOAD1(pl, (mid), (flag), (arg0)); \ |
| } |
| |
| #define PM_PACK_PAYLOAD3(pl, mid, flag, arg0, arg1, arg2) { \ |
| pl[2] = (uint32_t)(arg2); \ |
| PM_PACK_PAYLOAD2(pl, (mid), (flag), (arg0), (arg1)); \ |
| } |
| |
| #define PM_PACK_PAYLOAD4(pl, mid, flag, arg0, arg1, arg2, arg3) { \ |
| pl[3] = (uint32_t)(arg3); \ |
| PM_PACK_PAYLOAD3(pl, (mid), (flag), (arg0), (arg1), (arg2)); \ |
| } |
| |
| #define PM_PACK_PAYLOAD5(pl, mid, flag, arg0, arg1, arg2, arg3, arg4) { \ |
| pl[4] = (uint32_t)(arg4); \ |
| PM_PACK_PAYLOAD4(pl, (mid), (flag), (arg0), (arg1), (arg2), (arg3)); \ |
| } |
| |
| #define PM_PACK_PAYLOAD6(pl, mid, flag, arg0, arg1, arg2, arg3, arg4, arg5) { \ |
| pl[5] = (uint32_t)(arg5); \ |
| PM_PACK_PAYLOAD5(pl, (mid), (flag), (arg0), (arg1), (arg2), (arg3), (arg4)); \ |
| } |
| |
| /* PM API functions */ |
| |
| /** |
| * pm_get_api_version() - Get version number of PMC PM firmware |
| * @version Returns 32-bit version number of PMC Power Management Firmware |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_get_api_version(unsigned int *version, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD1(payload, LIBPM_MODULE_ID, flag, PM_GET_API_VERSION); |
| return pm_ipi_send_sync(primary_proc, payload, version, 1); |
| } |
| |
| /** |
| * pm_init_finalize() - Call to notify PMC PM firmware that master has power |
| * management enabled and that it has finished its |
| * initialization |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Status returned by the PMU firmware |
| */ |
| enum pm_ret_status pm_init_finalize(uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMU */ |
| PM_PACK_PAYLOAD1(payload, LIBPM_MODULE_ID, flag, PM_INIT_FINALIZE); |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_self_suspend() - PM call for processor to suspend itself |
| * @nid Node id of the processor or subsystem |
| * @latency Requested maximum wakeup latency (not supported) |
| * @state Requested state |
| * @address Resume address |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * This is a blocking call, it will return only once PMU has responded. |
| * On a wakeup, resume address will be automatically set by PMU. |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_self_suspend(uint32_t nid, |
| unsigned int latency, |
| unsigned int state, |
| uintptr_t address, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| unsigned int cpuid = plat_my_core_pos(); |
| const struct pm_proc *proc = pm_get_proc(cpuid); |
| |
| if (!proc) { |
| WARN("Failed to get proc %d\n", cpuid); |
| return PM_RET_ERROR_INTERNAL; |
| } |
| |
| /* |
| * Do client specific suspend operations |
| * (e.g. set powerdown request bit) |
| */ |
| pm_client_suspend(proc, state); |
| |
| /* Send request to the PLM */ |
| PM_PACK_PAYLOAD6(payload, LIBPM_MODULE_ID, flag, PM_SELF_SUSPEND, |
| proc->node_id, latency, state, address, |
| (address >> 32)); |
| return pm_ipi_send_sync(proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_abort_suspend() - PM call to announce that a prior suspend request |
| * is to be aborted. |
| * @reason Reason for the abort |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * Calling PU expects the PMU to abort the initiated suspend procedure. |
| * This is a non-blocking call without any acknowledge. |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_abort_suspend(enum pm_abort_reason reason, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* |
| * Do client specific abort suspend operations |
| * (e.g. enable interrupts and clear powerdown request bit) |
| */ |
| pm_client_abort_suspend(); |
| |
| /* Send request to the PLM */ |
| PM_PACK_PAYLOAD3(payload, LIBPM_MODULE_ID, flag, PM_ABORT_SUSPEND, |
| reason, primary_proc->node_id); |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_req_suspend() - PM call to request for another PU or subsystem to |
| * be suspended gracefully. |
| * @target Node id of the targeted PU or subsystem |
| * @ack Flag to specify whether acknowledge is requested |
| * @latency Requested wakeup latency (not supported) |
| * @state Requested state (not supported) |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_req_suspend(uint32_t target, uint8_t ack, |
| unsigned int latency, unsigned int state, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMU */ |
| PM_PACK_PAYLOAD4(payload, LIBPM_MODULE_ID, flag, PM_REQ_SUSPEND, target, |
| latency, state); |
| if (ack == IPI_BLOCKING) { |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } else { |
| return pm_ipi_send(primary_proc, payload); |
| } |
| } |
| |
| /** |
| * pm_req_wakeup() - PM call for processor to wake up selected processor |
| * or subsystem |
| * @target Device ID of the processor or subsystem to wake up |
| * @set_address Resume address presence indicator |
| * 1 - resume address specified, 0 - otherwise |
| * @address Resume address |
| * @ack Flag to specify whether acknowledge requested |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * This API function is either used to power up another APU core for SMP |
| * (by PSCI) or to power up an entirely different PU or subsystem, such |
| * as RPU0, RPU, or PL_CORE_xx. Resume address for the target PU will be |
| * automatically set by PMC. |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_req_wakeup(uint32_t target, uint32_t set_address, |
| uintptr_t address, uint8_t ack, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC to perform the wake of the PU */ |
| PM_PACK_PAYLOAD5(payload, LIBPM_MODULE_ID, flag, PM_REQ_WAKEUP, target, |
| set_address, address, ack); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_request_device() - Request a device |
| * @device_id Device ID |
| * @capabilities Requested capabilities for the device |
| * @qos Required Quality of Service |
| * @ack Flag to specify whether acknowledge requested |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_request_device(uint32_t device_id, uint32_t capabilities, |
| uint32_t qos, uint32_t ack, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD5(payload, LIBPM_MODULE_ID, flag, PM_REQUEST_DEVICE, |
| device_id, capabilities, qos, ack); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_release_device() - Release a device |
| * @device_id Device ID |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_release_device(uint32_t device_id, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, PM_RELEASE_DEVICE, |
| device_id); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_set_requirement() - Set requirement for the device |
| * @device_id Device ID |
| * @capabilities Requested capabilities for the device |
| * @latency Requested maximum latency |
| * @qos Required Quality of Service |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_set_requirement(uint32_t device_id, uint32_t capabilities, |
| uint32_t latency, uint32_t qos, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD5(payload, LIBPM_MODULE_ID, flag, PM_SET_REQUIREMENT, |
| device_id, capabilities, latency, qos); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_get_device_status() - Get device's status |
| * @device_id Device ID |
| * @response Buffer to store device status response |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_get_device_status(uint32_t device_id, uint32_t *response, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, PM_GET_DEVICE_STATUS, |
| device_id); |
| |
| return pm_ipi_send_sync(primary_proc, payload, response, 3); |
| } |
| |
| /** |
| * pm_reset_assert() - Assert/De-assert reset |
| * @reset Reset ID |
| * @assert Assert (1) or de-assert (0) |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_reset_assert(uint32_t reset, bool assert, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD3(payload, LIBPM_MODULE_ID, flag, PM_RESET_ASSERT, reset, |
| assert); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_reset_get_status() - Get current status of a reset line |
| * @reset Reset ID |
| * @status Returns current status of selected reset ID |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_reset_get_status(uint32_t reset, uint32_t *status, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, PM_RESET_ASSERT, |
| reset); |
| |
| return pm_ipi_send_sync(primary_proc, payload, status, 1); |
| } |
| |
| /** |
| * pm_get_callbackdata() - Read from IPI response buffer |
| * @data - array of PAYLOAD_ARG_CNT elements |
| * @flag - 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * Read value from ipi buffer response buffer. |
| */ |
| void pm_get_callbackdata(uint32_t *data, size_t count, uint32_t flag) |
| { |
| /* Return if interrupt is not from PMU */ |
| if (!pm_ipi_irq_status(primary_proc)) { |
| return; |
| } |
| |
| pm_ipi_buff_read_callb(data, count); |
| pm_ipi_irq_clear(primary_proc); |
| } |
| |
| /** |
| * pm_pinctrl_request() - Request a pin |
| * @pin Pin ID |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_pinctrl_request(uint32_t pin, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, PM_PINCTRL_REQUEST, |
| pin); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_pinctrl_release() - Release a pin |
| * @pin Pin ID |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_pinctrl_release(uint32_t pin, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, PM_PINCTRL_RELEASE, |
| pin); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_pinctrl_set_function() - Set pin function |
| * @pin Pin ID |
| * @function Function ID |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_pinctrl_set_function(uint32_t pin, uint32_t function, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD3(payload, LIBPM_MODULE_ID, flag, |
| PM_PINCTRL_SET_FUNCTION, pin, function) |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_pinctrl_get_function() - Get function set on the pin |
| * @pin Pin ID |
| * @function Function set on the pin |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_pinctrl_get_function(uint32_t pin, uint32_t *function, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, |
| PM_PINCTRL_SET_FUNCTION, pin); |
| |
| return pm_ipi_send_sync(primary_proc, payload, function, 1); |
| } |
| |
| /** |
| * pm_pinctrl_set_pin_param() - Set configuration parameter for the pin |
| * @pin Pin ID |
| * @param Parameter ID |
| * @value Parameter value |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_pinctrl_set_pin_param(uint32_t pin, uint32_t param, |
| uint32_t value, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD4(payload, LIBPM_MODULE_ID, flag, |
| PM_PINCTRL_CONFIG_PARAM_SET, pin, param, value); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_pinctrl_get_pin_param() - Get configuration parameter value for the pin |
| * @pin Pin ID |
| * @param Parameter ID |
| * @value Buffer to store parameter value |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_pinctrl_get_pin_param(uint32_t pin, uint32_t param, |
| uint32_t *value, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD3(payload, LIBPM_MODULE_ID, flag, |
| PM_PINCTRL_CONFIG_PARAM_GET, pin, param); |
| |
| return pm_ipi_send_sync(primary_proc, payload, value, 1); |
| } |
| |
| /** |
| * pm_clock_enable() - Enable the clock |
| * @clk_id Clock ID |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_clock_enable(uint32_t clk_id, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, PM_CLOCK_ENABLE, |
| clk_id); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_clock_disable() - Disable the clock |
| * @clk_id Clock ID |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_clock_disable(uint32_t clk_id, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, PM_CLOCK_DISABLE, |
| clk_id); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_clock_get_state() - Get clock status |
| * @clk_id Clock ID |
| * @state: Buffer to store clock status (1: Enabled, 0:Disabled) |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_clock_get_state(uint32_t clk_id, uint32_t *state, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, PM_CLOCK_GETSTATE, |
| clk_id); |
| |
| return pm_ipi_send_sync(primary_proc, payload, state, 1); |
| } |
| |
| /** |
| * pm_clock_set_divider() - Set divider for the clock |
| * @clk_id Clock ID |
| * @divider Divider value |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_clock_set_divider(uint32_t clk_id, uint32_t divider, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD3(payload, LIBPM_MODULE_ID, flag, PM_CLOCK_SETDIVIDER, |
| clk_id, divider); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_clock_get_divider() - Get divider value for the clock |
| * @clk_id Clock ID |
| * @divider: Buffer to store clock divider value |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_clock_get_divider(uint32_t clk_id, uint32_t *divider, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, PM_CLOCK_GETDIVIDER, |
| clk_id); |
| |
| return pm_ipi_send_sync(primary_proc, payload, divider, 1); |
| } |
| |
| /** |
| * pm_clock_set_parent() - Set parent for the clock |
| * @clk_id Clock ID |
| * @parent Parent ID |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_clock_set_parent(uint32_t clk_id, uint32_t parent, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD3(payload, LIBPM_MODULE_ID, flag, PM_CLOCK_SETPARENT, |
| clk_id, parent); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_clock_get_parent() - Get parent value for the clock |
| * @clk_id Clock ID |
| * @parent: Buffer to store clock parent value |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_clock_get_parent(uint32_t clk_id, uint32_t *parent, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, PM_CLOCK_GETPARENT, |
| clk_id); |
| |
| return pm_ipi_send_sync(primary_proc, payload, parent, 1); |
| } |
| /** |
| * pm_clock_get_rate() - Get the rate value for the clock |
| * @clk_id Clock ID |
| * @rate: Buffer to store clock rate value |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_clock_get_rate(uint32_t clk_id, uint32_t *clk_rate, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, PM_CLOCK_GETRATE, |
| clk_id); |
| |
| return pm_ipi_send_sync(primary_proc, payload, clk_rate, 2); |
| } |
| |
| /** |
| * pm_pll_set_param() - Set PLL parameter |
| * @clk_id PLL clock ID |
| * @param PLL parameter ID |
| * @value Value to set for PLL parameter |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_pll_set_param(uint32_t clk_id, uint32_t param, |
| uint32_t value, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD4(payload, LIBPM_MODULE_ID, flag, PM_PLL_SET_PARAMETER, |
| clk_id, param, value); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_pll_get_param() - Get PLL parameter value |
| * @clk_id PLL clock ID |
| * @param PLL parameter ID |
| * @value: Buffer to store PLL parameter value |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_pll_get_param(uint32_t clk_id, uint32_t param, |
| uint32_t *value, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD3(payload, LIBPM_MODULE_ID, flag, PM_PLL_GET_PARAMETER, |
| clk_id, param); |
| |
| return pm_ipi_send_sync(primary_proc, payload, value, 1); |
| } |
| |
| /** |
| * pm_pll_set_mode() - Set PLL mode |
| * @clk_id PLL clock ID |
| * @mode PLL mode |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_pll_set_mode(uint32_t clk_id, uint32_t mode, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD3(payload, LIBPM_MODULE_ID, flag, PM_PLL_SET_MODE, |
| clk_id, mode); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_pll_get_mode() - Get PLL mode |
| * @clk_id PLL clock ID |
| * @mode: Buffer to store PLL mode |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_pll_get_mode(uint32_t clk_id, uint32_t *mode, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, PM_PLL_GET_MODE, |
| clk_id); |
| |
| return pm_ipi_send_sync(primary_proc, payload, mode, 1); |
| } |
| |
| /** |
| * pm_force_powerdown() - PM call to request for another PU or subsystem to |
| * be powered down forcefully |
| * @target Device ID of the PU node to be forced powered down. |
| * @ack Flag to specify whether acknowledge is requested |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_force_powerdown(uint32_t target, uint8_t ack, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD3(payload, LIBPM_MODULE_ID, flag, PM_FORCE_POWERDOWN, |
| target, ack); |
| |
| if (ack == IPI_BLOCKING) { |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } else { |
| return pm_ipi_send(primary_proc, payload); |
| } |
| } |
| |
| /** |
| * pm_system_shutdown() - PM call to request a system shutdown or restart |
| * @type Shutdown or restart? 0=shutdown, 1=restart, 2=setscope |
| * @subtype Scope: 0=APU-subsystem, 1=PS, 2=system |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_system_shutdown(uint32_t type, uint32_t subtype, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| if (type == XPM_SHUTDOWN_TYPE_SETSCOPE_ONLY) { |
| /* Setting scope for subsequent PSCI reboot or shutdown */ |
| pm_shutdown_scope = subtype; |
| return PM_RET_SUCCESS; |
| } |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD3(payload, LIBPM_MODULE_ID, flag, PM_SYSTEM_SHUTDOWN, |
| type, subtype); |
| |
| return pm_ipi_send_non_blocking(primary_proc, payload); |
| } |
| |
| /** |
| * pm_query_data() - PM API for querying firmware data |
| * @qid The type of data to query |
| * @arg1 Argument 1 to requested query data call |
| * @arg2 Argument 2 to requested query data call |
| * @arg3 Argument 3 to requested query data call |
| * @data Returned output data |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * This function returns requested data. |
| */ |
| enum pm_ret_status pm_query_data(uint32_t qid, uint32_t arg1, uint32_t arg2, |
| uint32_t arg3, uint32_t *data, uint32_t flag) |
| { |
| uint32_t ret; |
| uint32_t version; |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| uint32_t fw_api_version; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD5(payload, LIBPM_MODULE_ID, flag, PM_QUERY_DATA, qid, |
| arg1, arg2, arg3); |
| |
| ret = pm_feature_check(PM_QUERY_DATA, &version, flag); |
| if (PM_RET_SUCCESS == ret) { |
| fw_api_version = version & 0xFFFFU; |
| if ((2U == fw_api_version) && |
| ((XPM_QID_CLOCK_GET_NAME == qid) || |
| (XPM_QID_PINCTRL_GET_FUNCTION_NAME == qid))) { |
| ret = pm_ipi_send_sync(primary_proc, payload, data, 8); |
| ret = data[0]; |
| data[0] = data[1]; |
| data[1] = data[2]; |
| data[2] = data[3]; |
| } else { |
| ret = pm_ipi_send_sync(primary_proc, payload, data, 4); |
| } |
| } |
| return ret; |
| } |
| /** |
| * pm_api_ioctl() - PM IOCTL API for device control and configs |
| * @device_id Device ID |
| * @ioctl_id ID of the requested IOCTL |
| * @arg1 Argument 1 to requested IOCTL call |
| * @arg2 Argument 2 to requested IOCTL call |
| * @value Returned output value |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * This function calls IOCTL to firmware for device control and configuration. |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_api_ioctl(uint32_t device_id, uint32_t ioctl_id, |
| uint32_t arg1, uint32_t arg2, uint32_t *value, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| enum pm_ret_status ret; |
| |
| switch (ioctl_id) { |
| case IOCTL_SET_PLL_FRAC_MODE: |
| ret = pm_pll_set_mode(arg1, arg2, flag); |
| break; |
| case IOCTL_GET_PLL_FRAC_MODE: |
| ret = pm_pll_get_mode(arg1, value, flag); |
| break; |
| case IOCTL_SET_PLL_FRAC_DATA: |
| ret = pm_pll_set_param(arg1, PM_PLL_PARAM_DATA, arg2, flag); |
| break; |
| case IOCTL_GET_PLL_FRAC_DATA: |
| ret = pm_pll_get_param(arg1, PM_PLL_PARAM_DATA, value, flag); |
| break; |
| case IOCTL_SET_SGI: |
| /* Get the sgi number */ |
| if (pm_register_sgi(arg1) != 0) { |
| return PM_RET_ERROR_ARGS; |
| } |
| gicd_write_irouter(gicv3_driver_data->gicd_base, |
| (unsigned int)PLAT_VERSAL_IPI_IRQ, MODE); |
| ret = PM_RET_SUCCESS; |
| break; |
| default: |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD5(payload, LIBPM_MODULE_ID, flag, PM_IOCTL, |
| device_id, ioctl_id, arg1, arg2); |
| ret = pm_ipi_send_sync(primary_proc, payload, value, 1); |
| break; |
| } |
| |
| return ret; |
| } |
| |
| /** |
| * pm_set_wakeup_source() - PM call to specify the wakeup source while suspended |
| * @target Device id of the targeted PU or subsystem |
| * @wkup_node Device id of the wakeup peripheral |
| * @enable Enable or disable the specified peripheral as wake source |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_set_wakeup_source(uint32_t target, uint32_t wkup_device, |
| uint8_t enable, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| PM_PACK_PAYLOAD4(payload, LIBPM_MODULE_ID, flag, PM_SET_WAKEUP_SOURCE, |
| target, wkup_device, enable); |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_get_chipid() - Read silicon ID registers |
| * @value Buffer for return values. Must be large enough |
| * to hold 8 bytes. |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns silicon ID registers |
| */ |
| enum pm_ret_status pm_get_chipid(uint32_t *value, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD1(payload, LIBPM_MODULE_ID, flag, PM_GET_CHIPID); |
| |
| return pm_ipi_send_sync(primary_proc, payload, value, 2); |
| } |
| |
| /** |
| * pm_feature_check() - Returns the supported API version if supported |
| * @api_id API ID to check |
| * @value Returned supported API version |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_feature_check(uint32_t api_id, unsigned int *version, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT], fw_api_version; |
| enum pm_ret_status status = PM_RET_ERROR_NOFEATURE; |
| |
| switch (api_id) { |
| case PM_GET_CALLBACK_DATA: |
| case PM_GET_TRUSTZONE_VERSION: |
| case PM_LOAD_PDI: |
| *version = (PM_API_BASE_VERSION << 16); |
| status = PM_RET_SUCCESS; |
| break; |
| case PM_GET_API_VERSION: |
| case PM_GET_DEVICE_STATUS: |
| case PM_GET_OP_CHARACTERISTIC: |
| case PM_REQ_SUSPEND: |
| case PM_SELF_SUSPEND: |
| case PM_FORCE_POWERDOWN: |
| case PM_ABORT_SUSPEND: |
| case PM_REQ_WAKEUP: |
| case PM_SET_WAKEUP_SOURCE: |
| case PM_SYSTEM_SHUTDOWN: |
| case PM_REQUEST_DEVICE: |
| case PM_RELEASE_DEVICE: |
| case PM_SET_REQUIREMENT: |
| case PM_RESET_ASSERT: |
| case PM_RESET_GET_STATUS: |
| case PM_GET_CHIPID: |
| case PM_PINCTRL_REQUEST: |
| case PM_PINCTRL_RELEASE: |
| case PM_PINCTRL_GET_FUNCTION: |
| case PM_PINCTRL_SET_FUNCTION: |
| case PM_PINCTRL_CONFIG_PARAM_GET: |
| case PM_PINCTRL_CONFIG_PARAM_SET: |
| case PM_IOCTL: |
| case PM_CLOCK_ENABLE: |
| case PM_CLOCK_DISABLE: |
| case PM_CLOCK_GETSTATE: |
| case PM_CLOCK_SETDIVIDER: |
| case PM_CLOCK_GETDIVIDER: |
| case PM_CLOCK_SETPARENT: |
| case PM_CLOCK_GETPARENT: |
| case PM_CLOCK_GETRATE: |
| case PM_PLL_SET_PARAMETER: |
| case PM_PLL_GET_PARAMETER: |
| case PM_PLL_SET_MODE: |
| case PM_PLL_GET_MODE: |
| case PM_FEATURE_CHECK: |
| case PM_INIT_FINALIZE: |
| case PM_SET_MAX_LATENCY: |
| case PM_REGISTER_NOTIFIER: |
| *version = (PM_API_BASE_VERSION << 16); |
| status = PM_RET_SUCCESS; |
| break; |
| case PM_QUERY_DATA: |
| *version = (PM_API_QUERY_DATA_VERSION << 16); |
| status = PM_RET_SUCCESS; |
| break; |
| default: |
| *version = 0U; |
| status = PM_RET_ERROR_NOFEATURE; |
| break; |
| } |
| |
| if (status != PM_RET_SUCCESS) { |
| goto done; |
| } |
| |
| PM_PACK_PAYLOAD2(payload, LIBPM_MODULE_ID, flag, |
| PM_FEATURE_CHECK, api_id); |
| |
| status = pm_ipi_send_sync(primary_proc, payload, &fw_api_version, 1); |
| if (status != PM_RET_SUCCESS) { |
| goto done; |
| } |
| |
| *version |= fw_api_version; |
| |
| status = PM_RET_SUCCESS; |
| |
| done: |
| return status; |
| } |
| |
| /** |
| * pm_load_pdi() - Load the PDI |
| * |
| * This function provides support to load PDI from linux |
| * |
| * src: Source device of pdi(DDR, OCM, SD etc) |
| * address_low: lower 32-bit Linear memory space address |
| * address_high: higher 32-bit Linear memory space address |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_load_pdi(uint32_t src, uint32_t address_low, |
| uint32_t address_high, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMU */ |
| PM_PACK_PAYLOAD4(payload, LOADER_MODULE_ID, flag, PM_LOAD_PDI, src, |
| address_high, address_low); |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_get_op_characteristic() - PM call to request operating characteristics |
| * of a device |
| * @device_id Device id |
| * @type Type of the operating characteristic |
| * (power, temperature and latency) |
| * @result Returns the operating characteristic for the requested device, |
| * specified by the type |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_get_op_characteristic(uint32_t device_id, |
| enum pm_opchar_type type, |
| uint32_t *result, uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD3(payload, LIBPM_MODULE_ID, flag, |
| PM_GET_OP_CHARACTERISTIC, device_id, type); |
| return pm_ipi_send_sync(primary_proc, payload, result, 1); |
| } |
| |
| /** |
| * pm_set_max_latency() - PM call to change in the maximum wake-up latency |
| * requirements for a specific device currently |
| * used by that CPU. |
| * @device_id Device ID |
| * @latency Latency value |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_set_max_latency(uint32_t device_id, uint32_t latency, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD3(payload, LIBPM_MODULE_ID, flag, PM_SET_MAX_LATENCY, |
| device_id, latency); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |
| |
| /** |
| * pm_register_notifier() - PM call to register a subsystem to be notified |
| * about the device event |
| * @device_id Device ID for the Node to which the event is related |
| * @event Event in question |
| * @wake Wake subsystem upon capturing the event if value 1 |
| * @enable Enable the registration for value 1, disable for value 0 |
| * @flag 0 - Call from secure source |
| * 1 - Call from non-secure source |
| * |
| * @return Returns status, either success or error+reason |
| */ |
| enum pm_ret_status pm_register_notifier(uint32_t device_id, uint32_t event, |
| uint32_t wake, uint32_t enable, |
| uint32_t flag) |
| { |
| uint32_t payload[PAYLOAD_ARG_CNT]; |
| |
| /* Send request to the PMC */ |
| PM_PACK_PAYLOAD5(payload, LIBPM_MODULE_ID, flag, PM_REGISTER_NOTIFIER, |
| device_id, event, wake, enable); |
| |
| return pm_ipi_send_sync(primary_proc, payload, NULL, 0); |
| } |