mirror of
https://source.denx.de/u-boot/u-boot.git
synced 2026-05-06 05:06:13 +02:00
misc: mpfs_syscontroller: add functions to read device tree overlays
Include functions to use the system controller to read the device tree overlays which supports auto update functionality. Signed-off-by: Jamie Gibbons <jamie.gibbons@microchip.com> Reviewed-by: Leo Yu-Chi Liang <ycliang@andestech.com>
This commit is contained in:
Jamie Gibbons
Leo Yu-Chi Liang
parent
39eda3f037
commit
7fa1ee7fb9
@ -22,7 +22,27 @@
|
||||
#include <misc.h>
|
||||
#include <mpfs-mailbox.h>
|
||||
|
||||
#define SYS_SPI_CMD 0x50
|
||||
#define SYS_SPI_MAILBOX_DATA_LEN 17
|
||||
#define SYS_SPI_MAILBOX_SRC_OFFSET 8
|
||||
#define SYS_SPI_MAILBOX_LENGTH_OFFSET 12
|
||||
#define SYS_SPI_MAILBOX_FREQ_OFFSET 16
|
||||
#define SYS_SPI_MAILBOX_FREQ 3
|
||||
#define SPI_FLASH_ADDR 0x400
|
||||
|
||||
/* Descriptor table */
|
||||
#define START_OFFSET 4
|
||||
#define END_OFFSET 8
|
||||
#define SIZE_OFFSET 12
|
||||
#define DESC_NEXT 12
|
||||
#define DESC_RESERVED_SIZE 0
|
||||
#define DESC_SIZE 16
|
||||
|
||||
#define DESIGN_MAGIC_0 0x4d /* 'M' */
|
||||
#define DESIGN_MAGIC_1 0x43 /* 'C'*/
|
||||
#define DESIGN_MAGIC_2 0x48 /* 'H'*/
|
||||
#define DESIGN_MAGIC_3 0x50 /* 'P'*/
|
||||
|
||||
#define CMD_OPCODE 0x0u
|
||||
#define CMD_DATA_SIZE 0U
|
||||
#define CMD_DATA NULL
|
||||
@ -109,6 +129,186 @@ int mpfs_syscontroller_read_sernum(struct mpfs_sys_serv *sys_serv_priv, u8 *devi
|
||||
}
|
||||
EXPORT_SYMBOL(mpfs_syscontroller_read_sernum);
|
||||
|
||||
static u16 mpfs_syscontroller_service_spi_copy(struct mpfs_sys_serv *sys_serv_priv, u64 dst_addr, u32 src_addr, u32 length)
|
||||
{
|
||||
int ret;
|
||||
u32 mailbox_format[SYS_SPI_MAILBOX_DATA_LEN];
|
||||
|
||||
*(u64 *)mailbox_format = dst_addr;
|
||||
mailbox_format[SYS_SPI_MAILBOX_SRC_OFFSET/4] = src_addr;
|
||||
mailbox_format[SYS_SPI_MAILBOX_LENGTH_OFFSET/4] = length;
|
||||
mailbox_format[SYS_SPI_MAILBOX_FREQ_OFFSET/4] = SYS_SPI_MAILBOX_FREQ;
|
||||
|
||||
struct mpfs_mss_response response = {
|
||||
.resp_status = 0U,
|
||||
.resp_msg = mailbox_format,
|
||||
.resp_size = RESP_BYTES};
|
||||
struct mpfs_mss_msg msg = {
|
||||
.cmd_opcode = SYS_SPI_CMD,
|
||||
.cmd_data_size = SYS_SPI_MAILBOX_DATA_LEN,
|
||||
.response = &response,
|
||||
.cmd_data = (u8 *)mailbox_format,
|
||||
.mbox_offset = MBOX_OFFSET,
|
||||
.resp_offset = RESP_OFFSET};
|
||||
|
||||
ret = mpfs_syscontroller_run_service(sys_serv_priv->sys_controller, &msg);
|
||||
if (ret) {
|
||||
dev_err(sys_serv_priv->sys_controller->chan.dev, "Service failed: %d, abort. Failure: %u\n", ret, msg.response->resp_status);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static u16 mpfs_syscontroller_get_dtbo_desc_header(struct mpfs_sys_serv *sys_serv_priv, u8 *desc_data, u32 desc_addr)
|
||||
{
|
||||
u32 length, no_of_descs;
|
||||
int ret = -ENOENT;
|
||||
|
||||
/* Get first four bytes to calculate length */
|
||||
ret = mpfs_syscontroller_service_spi_copy(sys_serv_priv, (u64)desc_data, desc_addr, BYTES_4);
|
||||
if (!ret) {
|
||||
no_of_descs = *((u32 *)desc_data);
|
||||
if (no_of_descs) {
|
||||
length = DESC_SIZE + ((no_of_descs - 1) * DESC_SIZE);
|
||||
ret = mpfs_syscontroller_service_spi_copy(sys_serv_priv, (u64)desc_data, desc_addr,
|
||||
length);
|
||||
}
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static u8 *mpfs_syscontroller_get_dtbo(struct mpfs_sys_serv *sys_serv_priv, u32 start_addr, u32 size)
|
||||
{
|
||||
int ret;
|
||||
u8 *dtbo;
|
||||
|
||||
/* Intentionally never freed, even on success so that u-boot "userspace" can access it. */
|
||||
dtbo = (u8 *)malloc(size);
|
||||
|
||||
ret = mpfs_syscontroller_service_spi_copy(sys_serv_priv, (u64)dtbo, start_addr, size);
|
||||
if (ret) {
|
||||
free(dtbo);
|
||||
dtbo = NULL;
|
||||
}
|
||||
|
||||
return dtbo;
|
||||
}
|
||||
|
||||
static void mpfs_syscontroller_parse_desc_header(struct mpfs_sys_serv *sys_serv_priv, u8 *desc_header, u8 *no_of_dtbo, u32 *dtbos_size)
|
||||
{
|
||||
u32 dtbo_desc_start_addr;
|
||||
u32 dtbo_desc_size;
|
||||
u32 no_of_descs;
|
||||
u16 i;
|
||||
u8 dtbo_name[16];
|
||||
u8 dtbo_addr[20];
|
||||
u8 *desc;
|
||||
u8 *dtbo;
|
||||
|
||||
no_of_descs = *((u32 *)desc_header);
|
||||
|
||||
for (i = 0; i < no_of_descs; i++) {
|
||||
desc = &desc_header[START_OFFSET + (DESC_NEXT * i)];
|
||||
/*
|
||||
* The dtbo info structure contains addresses that are relative
|
||||
* to the start of structure, so the offset of the structure in
|
||||
* flash must be added to get the actual start address.
|
||||
*/
|
||||
dtbo_desc_start_addr = *((u32 *)desc) + SPI_FLASH_ADDR;
|
||||
|
||||
desc = &desc_header[SIZE_OFFSET + (DESC_NEXT * i)];
|
||||
dtbo_desc_size = *((u32 *)desc);
|
||||
|
||||
dtbo = mpfs_syscontroller_get_dtbo(sys_serv_priv, dtbo_desc_start_addr, dtbo_desc_size);
|
||||
if (dtbo) {
|
||||
sprintf(dtbo_name, "dtbo_image%d", *no_of_dtbo);
|
||||
sprintf(dtbo_addr, "0x%llx", (u64)dtbo);
|
||||
env_set(dtbo_name, dtbo_addr);
|
||||
++*no_of_dtbo;
|
||||
*dtbos_size += dtbo_desc_size;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void mpfs_syscontroller_process_dtbo(struct mpfs_sys_serv *sys_serv_priv)
|
||||
{
|
||||
u32 desc_length;
|
||||
u32 dtbo_desc_addr;
|
||||
u32 dtbo_addr[5];
|
||||
u16 i, hart, no_of_harts;
|
||||
u8 design_info_desc[256];
|
||||
u8 dtbo_desc_data[256];
|
||||
u8 no_of_dtbos[8];
|
||||
u8 dtbo_size[8];
|
||||
u8 *desc;
|
||||
u8 no_of_dtbo = 0;
|
||||
u32 dtbos_size = 0;
|
||||
int ret;
|
||||
|
||||
/* Read first 10 bytes to verify the descriptor is found or not */
|
||||
ret = mpfs_syscontroller_service_spi_copy(sys_serv_priv, (u64)design_info_desc, SPI_FLASH_ADDR, 10);
|
||||
if (ret) {
|
||||
sprintf(no_of_dtbos, "%d", no_of_dtbo);
|
||||
env_set("no_of_overlays", no_of_dtbos);
|
||||
sprintf(dtbo_size, "%d", dtbos_size);
|
||||
env_set("dtbo_size", dtbo_size);
|
||||
return;
|
||||
}
|
||||
|
||||
if (design_info_desc[0] != DESIGN_MAGIC_0 ||
|
||||
design_info_desc[1] != DESIGN_MAGIC_1 ||
|
||||
design_info_desc[2] != DESIGN_MAGIC_2 ||
|
||||
design_info_desc[3] != DESIGN_MAGIC_3) {
|
||||
dev_dbg(sys_serv_priv->dev, "magic not found in desc structure.\n");
|
||||
sprintf(no_of_dtbos, "%d", no_of_dtbo);
|
||||
env_set("no_of_overlays", no_of_dtbos);
|
||||
sprintf(dtbo_size, "%d", dtbos_size);
|
||||
env_set("dtbo_size", dtbo_size);
|
||||
return;
|
||||
}
|
||||
desc_length = *((u32 *)&design_info_desc[4]);
|
||||
/* Read Design descriptor */
|
||||
ret = mpfs_syscontroller_service_spi_copy(sys_serv_priv, (u64)design_info_desc,
|
||||
SPI_FLASH_ADDR, desc_length);
|
||||
if (ret)
|
||||
return;
|
||||
|
||||
no_of_harts = *((u16 *)&design_info_desc[10]);
|
||||
|
||||
for (hart = 0; hart < no_of_harts; hart++) {
|
||||
/* Start address of DTBO descriptor */
|
||||
desc = &design_info_desc[(0x4 * hart) + 0xc];
|
||||
|
||||
dtbo_desc_addr = *((u32 *)desc);
|
||||
dtbo_addr[hart] = dtbo_desc_addr;
|
||||
|
||||
if (!dtbo_addr[hart])
|
||||
continue;
|
||||
|
||||
for (i = 0; i < hart; i++) {
|
||||
if (dtbo_addr[hart] == dtbo_addr[i])
|
||||
continue;
|
||||
}
|
||||
|
||||
if (hart && hart == i)
|
||||
continue;
|
||||
|
||||
dtbo_desc_addr += SPI_FLASH_ADDR;
|
||||
ret = mpfs_syscontroller_get_dtbo_desc_header(sys_serv_priv, dtbo_desc_data,
|
||||
dtbo_desc_addr);
|
||||
if (ret)
|
||||
continue;
|
||||
else
|
||||
mpfs_syscontroller_parse_desc_header(sys_serv_priv, dtbo_desc_data, &no_of_dtbo, &dtbos_size);
|
||||
}
|
||||
sprintf(no_of_dtbos, "%d", no_of_dtbo);
|
||||
env_set("no_of_overlays", no_of_dtbos);
|
||||
sprintf(dtbo_size, "%d", dtbos_size);
|
||||
env_set("dtbo_size", dtbo_size);
|
||||
}
|
||||
EXPORT_SYMBOL(mpfs_syscontroller_process_dtbo);
|
||||
|
||||
static int mpfs_syscontroller_probe(struct udevice *dev)
|
||||
{
|
||||
struct mpfs_syscontroller_priv *sys_controller = dev_get_priv(dev);
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user