On Thu, Oct 5, 2017 at 8:07 AM, <chin.liang....@intel.com> wrote: > From: Chin Liang See <chin.liang....@intel.com> > > Add mailbox support for Stratix SoC > > Signed-off-by: Ley Foon Tan <ley.foon....@intel.com> > Signed-off-by: Chin Liang See <chin.liang....@intel.com> > --- > arch/arm/mach-socfpga/Makefile | 1 + > arch/arm/mach-socfpga/include/mach/mailbox_s10.h | 108 ++++++++++ > arch/arm/mach-socfpga/mailbox_s10.c | 238 > +++++++++++++++++++++++ > 3 files changed, 347 insertions(+) > create mode 100644 arch/arm/mach-socfpga/include/mach/mailbox_s10.h > create mode 100644 arch/arm/mach-socfpga/mailbox_s10.c > > diff --git a/arch/arm/mach-socfpga/Makefile b/arch/arm/mach-socfpga/Makefile > index b253914..43e18d2 100644 > --- a/arch/arm/mach-socfpga/Makefile > +++ b/arch/arm/mach-socfpga/Makefile > @@ -32,6 +32,7 @@ endif > > ifdef CONFIG_TARGET_SOCFPGA_STRATIX10 > obj-y += clock_manager_s10.o > +obj-y += mailbox_s10.o > obj-y += misc_s10.o > obj-y += reset_manager_s10.o > obj-y += system_manager_s10.o > diff --git a/arch/arm/mach-socfpga/include/mach/mailbox_s10.h > b/arch/arm/mach-socfpga/include/mach/mailbox_s10.h > new file mode 100644 > index 0000000..b9bddf6 > --- /dev/null > +++ b/arch/arm/mach-socfpga/include/mach/mailbox_s10.h > @@ -0,0 +1,108 @@ > +/* > + * Copyright (C) 2017 Intel Corporation <www.intel.com> > + * > + * SPDX-License-Identifier: GPL-2.0 > + */ > +#ifndef _MAILBOX_S10_H_ > +#define _MAILBOX_S10_H_ > + > +/* user define Uboot ID */ > +#define MBOX_CLIENT_ID_UBOOT 0xB > +#define MBOX_ID_UBOOT 0x1 > + > +#define MBOX_MAX_CMD_INDEX 2047 > +#define MBOX_CMD_BUFFER_SIZE 32 > +#define MBOX_RESP_BUFFER_SIZE 16 > + > +#define MBOX_HDR_CMD_LSB 0 > +#define MBOX_HDR_CMD_MSK (BIT(11) - 1) > +#define MBOX_HDR_I_LSB 11 > +#define MBOX_HDR_I_MSK BIT(11) > +#define MBOX_HDR_LEN_LSB 12 > +#define MBOX_HDR_LEN_MSK 0x007FF000 > +#define MBOX_HDR_ID_LSB 24 > +#define MBOX_HDR_ID_MSK 0x0F000000 > +#define MBOX_HDR_CLIENT_LSB 28 > +#define MBOX_HDR_CLIENT_MSK 0xF0000000 > + > +/* Interrupt flags */ > +#define MBOX_FLAGS_INT_COE BIT(0) /* COUT update interrupt enable */ > +#define MBOX_FLAGS_INT_RIE BIT(1) /* RIN update interrupt enable */ > +#define MBOX_FLAGS_INT_UAE BIT(8) /* Urgent ACK interrupt enable */ > +#define MBOX_ALL_INTRS (MBOX_FLAGS_INT_COE | \ > + MBOX_FLAGS_INT_RIE | \ > + MBOX_FLAGS_INT_UAE) > + > +/* Status */ > +#define MBOX_STATUS_UA_MSK BIT(8) > + > +#define MBOX_CMD_HEADER(client, id, len, cmd) \ > + (((cmd) << MBOX_HDR_CMD_LSB) & MBOX_HDR_CMD_MSK) | \ > + (((len) << MBOX_HDR_LEN_LSB) & MBOX_HDR_LEN_MSK) | \ > + (((id) << MBOX_HDR_ID_LSB) & MBOX_HDR_ID_MSK) | \ > + (((client) << MBOX_HDR_CLIENT_LSB) & MBOX_HDR_CLIENT_MSK) > + > +#define MBOX_RESP_ERR_GET(resp) \ > + (((resp) & MBOX_HDR_CMD_MSK) >> MBOX_HDR_CMD_LSB) > +#define MBOX_RESP_LEN_GET(resp) \ > + (((resp) & MBOX_HDR_LEN_MSK) >> MBOX_HDR_LEN_LSB) > +#define MBOX_RESP_ID_GET(resp) \ > + (((resp) & MBOX_HDR_ID_MSK) >> MBOX_HDR_ID_LSB) > +#define MBOX_RESP_CLIENT_GET(resp) \ > + (((resp) & MBOX_HDR_CLIENT_MSK) >> MBOX_HDR_CLIENT_LSB) > + > +/* Response error list */ > +typedef enum { > + /* CMD completed succesfully, but check resp ARGS for any errors */ > + MBOX_RESP_STATOK = 0, > + /* CMD is incorrectly formatted in some way */ > + MBOX_RESP_INVALID_COMMAND = 1, > + /* BootROM Command code not undesrtood */ > + MBOX_RESP_UNKNOWN_BR = 2, > + /* CMD code not recognized by firmware */ > + MBOX_RESP_UNKNOWN = 3, > + /* Indicates that the device is not configured */ > + MBOX_RESP_NOT_CONFIGURED = 256, > + /* Indicates that the device is busy */ > + MBOX_RESP_DEVICE_BUSY = 0x1FF, > + /* Indicates that there is no valid response available */ > + MBOX_RESP_NO_VALID_RESP_AVAILABLE = 0x2FF, > + /* General Error */ > + MBOX_RESP_ERROR = 0x3FF, > +} ALT_SDM_MBOX_RESP_CODE; > + > +/* Mailbox command list */ > +#define MBOX_RESTART 2 > +#define MBOX_QSPI_OPEN 50 > +#define MBOX_QSPI_CLOSE 51 > +#define MBOX_QSPI_DIRECT 59
Only 3 commands? > + > +struct socfpga_mailbox { > + u32 cin; /* command valid offset */ > + u32 rout; /* response output offset */ > + u32 urg; /* urgent command */ > + u32 flags; /* interrupt enables */ > + u32 pad_0x10_0x1f[4]; /* 0x10 - 0x1F reserved */ > + u32 cout; /* command free offset */ > + u32 rin; /* respond valid offset */ > + u32 pad_0x28; /* 0x28 reserved */ > + u32 status; /* mailbox status */ > + u32 pad_0x30_0x3f[4]; /* 0x30 - 0x3F reserved */ > + u32 cmd_buf[MBOX_CMD_BUFFER_SIZE]; /* 0x40 - 0xBC circular > command > + buffer to SDM */ > + u32 resp_buf[MBOX_RESP_BUFFER_SIZE]; /* 0xC0 - 0xFF circular > + response buffer */ > +}; > + > +/* Use define other than put into struct socfpga_mailbox to save spaces */ > +#define MBOX_DOORBELL_TO_SDM_REG (SOCFPGA_MAILBOX_ADDRESS + 0x400) > +#define MBOX_DOORBELL_FROM_SDM_REG (SOCFPGA_MAILBOX_ADDRESS + 0x480) > + > +int mbox_init(void); > + > +#ifdef CONFIG_CADENCE_QSPI > +int mbox_qspi_close(void); > +int mbox_qspi_open(void); > +#endif I think these should be in a separate patch. > + > +#endif /* _MAILBOX_S10_H_ */ > diff --git a/arch/arm/mach-socfpga/mailbox_s10.c > b/arch/arm/mach-socfpga/mailbox_s10.c > new file mode 100644 > index 0000000..de836b1 > --- /dev/null > +++ b/arch/arm/mach-socfpga/mailbox_s10.c > @@ -0,0 +1,238 @@ > +/* > + * Copyright (C) 2017 Intel Corporation <www.intel.com> > + * > + * SPDX-License-Identifier: GPL-2.0 > + */ > + > +#include <common.h> > +#include <wait_bit.h> > +#include <asm/io.h> > +#include <asm/arch/mailbox_s10.h> > + > +DECLARE_GLOBAL_DATA_PTR; > + > +static const struct socfpga_mailbox *mbox_base = > + (void *)SOCFPGA_MAILBOX_ADDRESS; > + > +#define MBOX_POLL_RESP_TIMEOUT 50 /* ms */ > + > +static int mbox_polling_resp(u32 rout) > +{ > + u32 rin; > + unsigned long start = get_timer(0); > + > + while (1) { > + rin = readl(&mbox_base->rin); > + if (rout != rin) > + return 0; > + > + if (get_timer(start) > MBOX_POLL_RESP_TIMEOUT) > + break; > + > + udelay(1); > + } > + > + debug("mailbox: polling response timeout\n"); > + return -ETIMEDOUT; > +} > + > +/* Check for available slot and write to circular buffer. > + * It also update command valid offset (cin) register. > + */ > +static int mbox_fill_cmd_circular_buff(u32 header, u32 len, u32 *arg) > +{ > + u32 cmd_free_offset; > + u32 i; > + > + /* checking available command free slot */ > + cmd_free_offset = readl(&mbox_base->cout); > + if (cmd_free_offset >= MBOX_CMD_BUFFER_SIZE) { > + error("ERROR: Not enough space, cout %d\n", cmd_free_offset); > + return -ENOMEM; > + } > + > + /* write header to circular buffer */ > + writel(header, &mbox_base->cmd_buf[cmd_free_offset++]); > + /* wrapping around when it reach the buffer size */ > + cmd_free_offset %= MBOX_CMD_BUFFER_SIZE; > + > + /* write arguments */ > + for (i = 0; i < len; i++) { > + writel(arg[i], &mbox_base->cmd_buf[cmd_free_offset++]); > + /* wrapping around when it reach the buffer size */ > + cmd_free_offset %= MBOX_CMD_BUFFER_SIZE; > + } > + > + /* write command valid offset */ > + writel(cmd_free_offset, &mbox_base->cin); > + return 0; > +} > + > +/* Support one command and up to 31 words argument length only */ > +int mbox_send_cmd(u8 id, u32 cmd, u32 len, u32 *arg, u8 urgent, > + u32 *resp_buf_len, u32 *resp_buf) > +{ > + u32 header; > + u32 rin; > + u32 resp; > + u32 rout; > + u32 status; > + u32 resp_len; > + u32 buf_len; > + int ret; > + > + /* Total lenght is command + argument length */ > + if ((len + 1) > MBOX_CMD_BUFFER_SIZE) { > + error("ERROR: command %d arguments too long, max %d\n", cmd, > + MBOX_CMD_BUFFER_SIZE - 1); > + return -EINVAL; > + } > + > + if (cmd > MBOX_MAX_CMD_INDEX) { > + error("ERROR: Unsupported command index %d\n", cmd); > + return -EINVAL; > + } > + > + header = MBOX_CMD_HEADER(MBOX_CLIENT_ID_UBOOT, id , len, cmd); > + > + ret = mbox_fill_cmd_circular_buff(header, len, arg); > + if (ret) > + return ret; > + > + if (urgent) { > + /* Send command as urgent command */ > + writel(1, &mbox_base->urg); > + } > + > + /* write doorbell */ > + writel(1, MBOX_DOORBELL_TO_SDM_REG); > + > + while (1) { > + /* Wait for doorbell from SDM */ > + ret = wait_for_bit(__func__, > + (const u32 *)MBOX_DOORBELL_FROM_SDM_REG, > + 1, true, 500000, false); Add a define for 500000. > + if (ret) { > + error("mailbox: timeout from SDM\n"); > + return ret; > + } > + > + /* clear interrupt */ > + writel(0, MBOX_DOORBELL_FROM_SDM_REG); > + > + if (urgent) { > + /* urgent command doesn't has response */ > + writel(0, &mbox_base->urg); > + status = readl(&mbox_base->status); > + if (status & MBOX_STATUS_UA_MSK) > + return 0; > + > + error("mailbox: cmd %d no urgent ACK\n", cmd); > + return -1; Use '-EPERM' for -1. > + } > + > + /* read current response offset */ > + rout = readl(&mbox_base->rout); > + > + /* read response valid offset */ > + rin = readl(&mbox_base->rin); > + > + if (rout != rin) { > + /* Response received */ > + resp = readl(&mbox_base->resp_buf[rout]); > + rout++; > + /* wrapping around when it reach the buffer size */ > + rout %= MBOX_RESP_BUFFER_SIZE; > + /* update next ROUT */ > + writel(rout, &mbox_base->rout); > + > + /* check client ID and ID */ > + if ((MBOX_RESP_CLIENT_GET(resp) == > + MBOX_CLIENT_ID_UBOOT) && > + (MBOX_RESP_ID_GET(resp) == id)) { > + ret = MBOX_RESP_ERR_GET(resp); > + if (ret) { > + error("mailbox send command %d error > %d\n", > + cmd, ret); > + return ret; > + } > + > + if (resp_buf_len) { > + buf_len = *resp_buf_len; > + *resp_buf_len = 0; > + } else { > + buf_len = 0; > + } > + > + resp_len = MBOX_RESP_LEN_GET(resp); > + while (resp_len) { > + ret = mbox_polling_resp(rout); > + if (ret) > + return ret; > + /* we need to process response buffer > + even caller doesn't need it */ Fix comment style. > + resp = > readl(&mbox_base->resp_buf[rout]); > + rout++; > + resp_len--; > + rout %= MBOX_RESP_BUFFER_SIZE; > + writel(rout, &mbox_base->rout); > + if (buf_len) { > + /* copy response to buffer */ > + resp_buf[*resp_buf_len] = > resp; > + (*resp_buf_len)++; > + buf_len--; > + } > + } > + return ret; > + } > + } > + }; > + > + return -EIO; > +} > + > +int mbox_init(void) > +{ > + int ret; > + > + /* enable mailbox interrupts */ > + writel(MBOX_ALL_INTRS, &mbox_base->flags); > + > + ret = mbox_send_cmd(MBOX_ID_UBOOT, MBOX_RESTART, 0, NULL, 1, 0, NULL); > + if (ret) > + return ret; > + > + /* Renable mailbox interrupts after MBOX_RESTART */ > + writel(MBOX_ALL_INTRS, &mbox_base->flags); > + > + return 0; > +} > + > +#ifdef CONFIG_CADENCE_QSPI I think this should be in a separate patch. Dinh _______________________________________________ U-Boot mailing list U-Boot@lists.denx.de https://lists.denx.de/listinfo/u-boot