mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-12-12 06:12:58 +00:00
fac46bc446
Add command "zynqmp pmufw node close" to disable permission to load additional pmufw config overlays. This command will make sure that any other sw will ask for changing permission. Signed-off-by: Michal Simek <michal.simek@xilinx.com> Link: https://lore.kernel.org/r/cfa5cc7909eb8deb23eb0f11c26954cbaddeb861.1642163135.git.michal.simek@xilinx.com
304 lines
7.3 KiB
C
304 lines
7.3 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Xilinx Zynq MPSoC Firmware driver
|
|
*
|
|
* Copyright (C) 2018-2019 Xilinx, Inc.
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <cpu_func.h>
|
|
#include <dm.h>
|
|
#include <dm/lists.h>
|
|
#include <log.h>
|
|
#include <zynqmp_firmware.h>
|
|
#include <asm/cache.h>
|
|
#include <asm/ptrace.h>
|
|
|
|
#if defined(CONFIG_ZYNQMP_IPI)
|
|
#include <mailbox.h>
|
|
#include <asm/arch/sys_proto.h>
|
|
|
|
#define PMUFW_PAYLOAD_ARG_CNT 8
|
|
|
|
#define XST_PM_NO_ACCESS 2002L
|
|
#define XST_PM_ALREADY_CONFIGURED 2009L
|
|
|
|
struct zynqmp_power {
|
|
struct mbox_chan tx_chan;
|
|
struct mbox_chan rx_chan;
|
|
} zynqmp_power;
|
|
|
|
#define NODE_ID_LOCATION 5
|
|
|
|
static unsigned int xpm_configobject[] = {
|
|
/**********************************************************************/
|
|
/* HEADER */
|
|
2, /* Number of remaining words in the header */
|
|
1, /* Number of sections included in config object */
|
|
PM_CONFIG_OBJECT_TYPE_OVERLAY, /* Type of Config object as overlay */
|
|
/**********************************************************************/
|
|
/* SLAVE SECTION */
|
|
|
|
PM_CONFIG_SLAVE_SECTION_ID, /* Section ID */
|
|
1, /* Number of slaves */
|
|
|
|
0, /* Node ID which will be changed below */
|
|
PM_SLAVE_FLAG_IS_SHAREABLE,
|
|
PM_CONFIG_IPI_PSU_CORTEXA53_0_MASK |
|
|
PM_CONFIG_IPI_PSU_CORTEXR5_0_MASK |
|
|
PM_CONFIG_IPI_PSU_CORTEXR5_1_MASK, /* IPI Mask */
|
|
};
|
|
|
|
static unsigned int xpm_configobject_close[] = {
|
|
/**********************************************************************/
|
|
/* HEADER */
|
|
2, /* Number of remaining words in the header */
|
|
1, /* Number of sections included in config object */
|
|
PM_CONFIG_OBJECT_TYPE_OVERLAY, /* Type of Config object as overlay */
|
|
/**********************************************************************/
|
|
/* SET CONFIG SECTION */
|
|
PM_CONFIG_SET_CONFIG_SECTION_ID,
|
|
0U, /* Loading permission to Overlay config object */
|
|
};
|
|
|
|
int zynqmp_pmufw_config_close(void)
|
|
{
|
|
zynqmp_pmufw_load_config_object(xpm_configobject_close,
|
|
sizeof(xpm_configobject_close));
|
|
return 0;
|
|
}
|
|
|
|
int zynqmp_pmufw_node(u32 id)
|
|
{
|
|
/* Record power domain id */
|
|
xpm_configobject[NODE_ID_LOCATION] = id;
|
|
|
|
zynqmp_pmufw_load_config_object(xpm_configobject,
|
|
sizeof(xpm_configobject));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ipi_req(const u32 *req, size_t req_len, u32 *res, size_t res_maxlen)
|
|
{
|
|
struct zynqmp_ipi_msg msg;
|
|
int ret;
|
|
u32 buffer[PAYLOAD_ARG_CNT];
|
|
|
|
if (!res)
|
|
res = buffer;
|
|
|
|
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;
|
|
|
|
debug("%s, Sending IPI message with ID: 0x%0x\n", __func__, req[0]);
|
|
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) {
|
|
|
|
ret = xilinx_pm_request(PM_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;
|
|
};
|
|
|
|
/**
|
|
* 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)
|
|
{
|
|
int err;
|
|
u32 ret_payload[PAYLOAD_ARG_CNT];
|
|
|
|
if (IS_ENABLED(CONFIG_SPL_BUILD))
|
|
printf("Loading new PMUFW cfg obj (%ld bytes)\n", size);
|
|
|
|
flush_dcache_range((ulong)cfg_obj, (ulong)(cfg_obj + size));
|
|
|
|
err = xilinx_pm_request(PM_SET_CONFIGURATION, (u32)(u64)cfg_obj, 0, 0,
|
|
0, ret_payload);
|
|
if (err == XST_PM_NO_ACCESS) {
|
|
printf("PMUFW no permission to change config object\n");
|
|
return;
|
|
}
|
|
|
|
if (err == XST_PM_ALREADY_CONFIGURED) {
|
|
debug("PMUFW Node is already configured\n");
|
|
return;
|
|
}
|
|
|
|
if (err)
|
|
printf("Cannot load PMUFW configuration object (%d)\n", err);
|
|
|
|
if (ret_payload[0])
|
|
printf("PMUFW returned 0x%08x status!\n", ret_payload[0]);
|
|
|
|
if ((err || ret_payload[0]) && IS_ENABLED(CONFIG_SPL_BUILD))
|
|
panic("PMUFW config object loading failed in EL3\n");
|
|
}
|
|
|
|
static int zynqmp_power_probe(struct udevice *dev)
|
|
{
|
|
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 find tx mailbox\n", __func__);
|
|
return ret;
|
|
}
|
|
|
|
ret = mbox_get_by_name(dev, "rx", &zynqmp_power.rx_chan);
|
|
if (ret) {
|
|
debug("%s: Cannot find rx mailbox\n", __func__);
|
|
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[] = {
|
|
{ .compatible = "xlnx,zynqmp-power" },
|
|
{ }
|
|
};
|
|
|
|
U_BOOT_DRIVER(zynqmp_power) = {
|
|
.name = "zynqmp_power",
|
|
.id = UCLASS_FIRMWARE,
|
|
.of_match = zynqmp_power_ids,
|
|
.probe = zynqmp_power_probe,
|
|
};
|
|
#endif
|
|
|
|
int __maybe_unused xilinx_pm_request(u32 api_id, u32 arg0, u32 arg1, u32 arg2,
|
|
u32 arg3, u32 *ret_payload)
|
|
{
|
|
debug("%s at EL%d, API ID: 0x%0x\n", __func__, current_el(), api_id);
|
|
|
|
if (IS_ENABLED(CONFIG_SPL_BUILD) || current_el() == 3) {
|
|
#if defined(CONFIG_ZYNQMP_IPI)
|
|
/*
|
|
* Use fixed payload and arg size as the EL2 call. The firmware
|
|
* is capable to handle PMUFW_PAYLOAD_ARG_CNT bytes but the
|
|
* firmware API is limited by the SMC call size
|
|
*/
|
|
u32 regs[] = {api_id, arg0, arg1, arg2, arg3};
|
|
int ret;
|
|
|
|
if (api_id == PM_FPGA_LOAD) {
|
|
/* Swap addr_hi/low because of incompatibility */
|
|
u32 temp = regs[1];
|
|
|
|
regs[1] = regs[2];
|
|
regs[2] = temp;
|
|
}
|
|
|
|
ret = ipi_req(regs, PAYLOAD_ARG_CNT, ret_payload,
|
|
PAYLOAD_ARG_CNT);
|
|
if (ret)
|
|
return ret;
|
|
#else
|
|
return -EPERM;
|
|
#endif
|
|
} else {
|
|
/*
|
|
* Added SIP service call Function Identifier
|
|
* Make sure to stay in x0 register
|
|
*/
|
|
struct pt_regs regs;
|
|
|
|
regs.regs[0] = PM_SIP_SVC | api_id;
|
|
regs.regs[1] = ((u64)arg1 << 32) | arg0;
|
|
regs.regs[2] = ((u64)arg3 << 32) | arg2;
|
|
|
|
smc_call(®s);
|
|
|
|
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 (ret_payload) ? ret_payload[0] : 0;
|
|
}
|
|
|
|
static const struct udevice_id zynqmp_firmware_ids[] = {
|
|
{ .compatible = "xlnx,zynqmp-firmware" },
|
|
{ .compatible = "xlnx,versal-firmware"},
|
|
{ }
|
|
};
|
|
|
|
static int zynqmp_firmware_bind(struct udevice *dev)
|
|
{
|
|
int ret;
|
|
struct udevice *child;
|
|
|
|
if (IS_ENABLED(CONFIG_ZYNQMP_POWER_DOMAIN)) {
|
|
ret = device_bind_driver_to_node(dev, "zynqmp_power_domain",
|
|
"zynqmp_power_domain",
|
|
dev_ofnode(dev), &child);
|
|
if (ret) {
|
|
printf("zynqmp power domain driver is not bound: %d\n", ret);
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
return dm_scan_fdt_dev(dev);
|
|
}
|
|
|
|
U_BOOT_DRIVER(zynqmp_firmware) = {
|
|
.id = UCLASS_FIRMWARE,
|
|
.name = "zynqmp_firmware",
|
|
.of_match = zynqmp_firmware_ids,
|
|
.bind = zynqmp_firmware_bind,
|
|
};
|