[U-Boot] [PATCH v3 4/4] arm: socfpga: Add FPGA driver support for Arria 10
chee skywind
skywindctf at gmail.com
Thu May 18 07:40:26 UTC 2017
On Thu, May 18, 2017 at 3:03 AM, Dinh Nguyen <dinguyen at kernel.org> wrote:
>
>
> On 05/15/2017 05:52 AM, tien.fong.chee at intel.com wrote:
> > From: Tien Fong Chee <tien.fong.chee at intel.com>
> >
> > Add FPGA driver support for Arria 10.
> >
> > Signed-off-by: Tien Fong Chee <tien.fong.chee at intel.com>
> > ---
> > arch/arm/mach-socfpga/include/mach/fpga_manager.h | 2 +
> > .../include/mach/fpga_manager_arria10.h | 100 +++++
> > drivers/fpga/Makefile | 1 +
> > drivers/fpga/socfpga_arria10.c | 487
> +++++++++++++++++++++
> > include/configs/socfpga_common.h | 3 +-
> > 5 files changed, 592 insertions(+), 1 deletion(-)
> > create mode 100644 arch/arm/mach-socfpga/include/
> mach/fpga_manager_arria10.h
> > create mode 100644 drivers/fpga/socfpga_arria10.c
> >
> > diff --git a/arch/arm/mach-socfpga/include/mach/fpga_manager.h
> b/arch/arm/mach-socfpga/include/mach/fpga_manager.h
> > index b046c2c..a21c716 100644
> > --- a/arch/arm/mach-socfpga/include/mach/fpga_manager.h
> > +++ b/arch/arm/mach-socfpga/include/mach/fpga_manager.h
> > @@ -12,6 +12,8 @@
> >
> > #if defined(CONFIG_TARGET_SOCFPGA_GEN5)
> > #include <asm/arch/fpga_manager_gen5.h>
> > +#elif defined(CONFIG_TARGET_SOCFPGA_ARRIA10)
> > +#include <asm/arch/fpga_manager_arria10.h>
> > #endif
> >
> > /* FPGA CD Ratio Value */
> > diff --git a/arch/arm/mach-socfpga/include/mach/fpga_manager_arria10.h
> b/arch/arm/mach-socfpga/include/mach/fpga_manager_arria10.h
> > new file mode 100644
> > index 0000000..18d9580
> > --- /dev/null
> > +++ b/arch/arm/mach-socfpga/include/mach/fpga_manager_arria10.h
> > @@ -0,0 +1,100 @@
> > +/*
> > + * Copyright (C) 2017 Intel Corporation <www.intel.com>
> > + * All rights reserved.
> > + *
> > + * SPDX-License-Identifier: GPL-2.0
> > + */
> > +
> > +#ifndef _FPGA_MANAGER_ARRIA10_H_
> > +#define _FPGA_MANAGER_ARRIA10_H_
> > +
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_CRC_ERROR_SET_MSK
> BIT(0)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_EARLY_USERMODE_SET_MSK BIT(1)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_USERMODE_SET_MSK
> BIT(2)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_INITDONE_OE_SET_MSK BIT(3)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_NSTATUS_PIN_SET_MSK
> BIT(4)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_NSTATUS_OE_SET_MSK
> BIT(5)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_CONDONE_PIN_SET_MSK
> BIT(6)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_CONDONE_OE_SET_MSK
> BIT(7)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_CVP_CONF_DONE_SET_MSK BIT(8)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_PR_READY_SET_MSK BIT(9)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_PR_DONE_SET_MSK BIT(10)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_PR_ERROR_SET_MSK BIT(11)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_NCONFIG_PIN_SET_MSK
> BIT(12)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_NCEO_OE_SET_MSK BIT(13)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_MSEL0_SET_MSK
> BIT(16)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_MSEL1_SET_MSK
> BIT(17)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_MSEL2_SET_MSK
> BIT(18)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_MSEL_SET_MSD (\
> > + ALT_FPGAMGR_IMGCFG_STAT_F2S_MSEL0_SET_MSK |\
> > + ALT_FPGAMGR_IMGCFG_STAT_F2S_MSEL1_SET_MSK |\
> > + ALT_FPGAMGR_IMGCFG_STAT_F2S_MSEL2_SET_MSK)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_IMGCFG_FIFOEMPTY_SET_MSK BIT(24)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_IMGCFG_FIFOFULL_SET_MSK BIT(25)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_JTAGM_SET_MSK BIT(28)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_EMR_SET_MSK
> BIT(29)
> > +#define ALT_FPGAMGR_IMGCFG_STAT_F2S_MSEL0_LSB 16
> > +
> > +#define ALT_FPGAMGR_IMGCFG_CTL_00_S2F_NENABLE_NCONFIG_SET_MSK
> BIT(0)
> > +#define ALT_FPGAMGR_IMGCFG_CTL_00_S2F_NENABLE_NSTATUS_SET_MSK
> BIT(1)
> > +#define ALT_FPGAMGR_IMGCFG_CTL_00_S2F_NENABLE_CONDONE_SET_MSK
> BIT(2)
> > +#define ALT_FPGAMGR_IMGCFG_CTL_00_S2F_NCONFIG_SET_MSK
> BIT(8)
> > +#define ALT_FPGAMGR_IMGCFG_CTL_00_S2F_NSTATUS_OE_SET_MSK BIT(16)
> > +#define ALT_FPGAMGR_IMGCFG_CTL_00_S2F_CONDONE_OE_SET_MSK BIT(24)
> > +
> > +#define ALT_FPGAMGR_IMGCFG_CTL_01_S2F_NENABLE_CONFIG_SET_MSK BIT(0)
> > +#define ALT_FPGAMGR_IMGCFG_CTL_01_S2F_PR_REQUEST_SET_MSK BIT(16)
> > +#define ALT_FPGAMGR_IMGCFG_CTL_01_S2F_NCE_SET_MSK BIT(24)
> > +
> > +#define ALT_FPGAMGR_IMGCFG_CTL_02_EN_CFG_CTRL_SET_MSK BIT(0)
> > +#define ALT_FPGAMGR_IMGCFG_CTL_02_EN_CFG_DATA_SET_MSK BIT(8)
> > +#define ALT_FPGAMGR_IMGCFG_CTL_02_CDRATIO_SET_MSK
> 0x00030000
> > +#define ALT_FPGAMGR_IMGCFG_CTL_02_CFGWIDTH_SET_MSK BIT(24)
> > +#define ALT_FPGAMGR_IMGCFG_CTL_02_CDRATIO_LSB 16
> > +
> > +#ifndef __ASSEMBLY__
> > +
> > +struct socfpga_fpga_manager {
> > + u32 _pad_0x0_0x7[2];
> > + u32 dclkcnt;
> > + u32 dclkstat;
> > + u32 gpo;
> > + u32 gpi;
> > + u32 misci;
> > + u32 _pad_0x1c_0x2f[5];
> > + u32 emr_data0;
> > + u32 emr_data1;
> > + u32 emr_data2;
> > + u32 emr_data3;
> > + u32 emr_data4;
> > + u32 emr_data5;
> > + u32 emr_valid;
> > + u32 emr_en;
> > + u32 jtag_config;
> > + u32 jtag_status;
> > + u32 jtag_kick;
> > + u32 _pad_0x5c_0x5f;
> > + u32 jtag_data_w;
> > + u32 jtag_data_r;
> > + u32 _pad_0x68_0x6f[2];
> > + u32 imgcfg_ctrl_00;
> > + u32 imgcfg_ctrl_01;
> > + u32 imgcfg_ctrl_02;
> > + u32 _pad_0x7c_0x7f;
> > + u32 imgcfg_stat;
> > + u32 intr_masked_status;
> > + u32 intr_mask;
> > + u32 intr_polarity;
> > + u32 dma_config;
> > + u32 imgcfg_fifo_status;
> > +};
> > +
> > +/* Functions */
> > +int fpgamgr_program_init(u32 * rbf_data, size_t rbf_size);
> > +int fpgamgr_program_fini(void);
> > +int is_fpgamgr_user_mode(void);
> > +int fpgamgr_wait_early_user_mode(void);
> > +
> > +#endif /* __ASSEMBLY__ */
> > +
> > +#endif /* _FPGA_MANAGER_ARRIA10_H_ */
> > diff --git a/drivers/fpga/Makefile b/drivers/fpga/Makefile
> > index b65e5ba..08c9ff8 100644
> > --- a/drivers/fpga/Makefile
> > +++ b/drivers/fpga/Makefile
> > @@ -21,4 +21,5 @@ obj-$(CONFIG_FPGA_STRATIX_II) += stratixII.o
> > obj-$(CONFIG_FPGA_STRATIX_V) += stratixv.o
> > obj-$(CONFIG_FPGA_SOCFPGA) += socfpga.o
> > obj-$(CONFIG_TARGET_SOCFPGA_GEN5) += socfpga_gen5.o
> > +obj-$(CONFIG_TARGET_SOCFPGA_ARRIA10) += socfpga_arria10.o
> > endif
> > diff --git a/drivers/fpga/socfpga_arria10.c b/drivers/fpga/socfpga_
> arria10.c
> > new file mode 100644
> > index 0000000..262e962
> > --- /dev/null
> > +++ b/drivers/fpga/socfpga_arria10.c
> > @@ -0,0 +1,487 @@
> > +/*
> > + * Copyright (C) 2017 Intel Corporation <www.intel.com>
> > + *
> > + * SPDX-License-Identifier: GPL-2.0
> > + */
> > +
> > +#include <asm/io.h>
> > +#include <asm/arch/fpga_manager.h>
> > +#include <asm/arch/reset_manager.h>
> > +#include <asm/arch/system_manager.h>
> > +#include <asm/arch/sdram.h>
> > +#include <asm/arch/misc.h>
> > +#include <altera.h>
> > +#include <common.h>
> > +#include <errno.h>
> > +#include <wait_bit.h>
> > +#include <watchdog.h>
> > +
> > +#define CFGWDTH_32 1
> > +#define MIN_BITSTREAM_SIZECHECK 230
> > +#define ENCRYPTION_OFFSET 69
> > +#define COMPRESSION_OFFSET 229
> > +#define FPGA_TIMEOUT_MSEC 1000 /* timeout in ms */
> > +#define FPGA_TIMEOUT_CNT 0x1000000
> > +
> > +DECLARE_GLOBAL_DATA_PTR;
> > +
> > +static const struct socfpga_fpga_manager *fpga_manager_base =
> > + (void *)SOCFPGA_FPGAMGRREGS_ADDRESS;
> > +
> > +static const struct socfpga_system_manager *system_manager_base =
> > + (void *)SOCFPGA_SYSMGR_ADDRESS;
> > +
> > +static void fpgamgr_set_cd_ratio(unsigned long ratio);
> > +
> > +static uint32_t fpgamgr_get_msel(void)
> > +{
> > + u32 reg;
> > +
> > + reg = readl(&fpga_manager_base->imgcfg_stat);
> > + reg = (reg & ALT_FPGAMGR_IMGCFG_STAT_F2S_MSEL_SET_MSD) >>
> > + ALT_FPGAMGR_IMGCFG_STAT_F2S_MSEL0_LSB;
> > +
> > + return reg;
> > +}
> > +
> > +static void fpgamgr_set_cfgwdth(int width)
> > +{
> > + if (width)
> > + setbits_le32(&fpga_manager_base->imgcfg_ctrl_02,
> > + ALT_FPGAMGR_IMGCFG_CTL_02_CFGWIDTH_SET_MSK);
> > + else
> > + clrbits_le32(&fpga_manager_base->imgcfg_ctrl_02,
> > + ALT_FPGAMGR_IMGCFG_CTL_02_CFGWIDTH_SET_MSK);
> > +}
> > +
> > +/* Check whether FPGA Init_Done signal is high */
> > +int is_fpgamgr_initdone_high(void)
>
> static
>
> Okay
> > +{
> > + return (readl(&fpga_manager_base->imgcfg_stat) &
> > + ALT_FPGAMGR_IMGCFG_STAT_F2S_INITDONE_OE_SET_MSK) != 0;
> > +}
> > +
> > +int is_fpgamgr_user_mode(void)
>
> static
>
> This function will be exposed to other file in later patch.
> +{
> > + return (readl(&fpga_manager_base->imgcfg_stat) &
> > + ALT_FPGAMGR_IMGCFG_STAT_F2S_USERMODE_SET_MSK) != 0;
> > +}
> > +
> > +static int wait_for_user_mode(void)
> > +{
> > + return wait_for_bit(__func__,
> > + &fpga_manager_base->imgcfg_stat,
> > + ALT_FPGAMGR_IMGCFG_STAT_F2S_USERMODE_SET_MSK,
> > + 1, FPGA_TIMEOUT_MSEC, false);
> > +}
> > +
> > +static int is_fpgamgr_early_user_mode(void)
> > +{
> > + return (readl(&fpga_manager_base->imgcfg_stat) &
> > + ALT_FPGAMGR_IMGCFG_STAT_F2S_EARLY_USERMODE_SET_MSK) != 0;
> > +}
> > +
> > +int fpgamgr_wait_early_user_mode(void)
>
> static ?
>
> This function will be exposed to other file in later patch.
> > +{
> > + u32 sync_data = 0xffffffff;
> > + u32 i = 0;
> > + unsigned start = get_timer(0);
> > + unsigned long cd_ratio;
> > +
> > + /* Getting existing CDRATIO */
> > + cd_ratio = (readl(&fpga_manager_base->imgcfg_ctrl_02) &
> > + ALT_FPGAMGR_IMGCFG_CTL_02_CDRATIO_SET_MSK) >>
> > + ALT_FPGAMGR_IMGCFG_CTL_02_CDRATIO_LSB;
> > +
> > + /* Using CDRATIO_X1 for better compatibility */
> > + fpgamgr_set_cd_ratio(CDRATIO_x1);
> > +
> > + while (!(is_fpgamgr_early_user_mode())) {
> > + if (get_timer(start) > FPGA_TIMEOUT_MSEC)
> > + return -ETIMEDOUT;
> > + fpgamgr_program_write((const long unsigned int
> *)&sync_data,
> > + sizeof(sync_data));
> > + udelay(FPGA_TIMEOUT_MSEC);
> > + i++;
> > + }
> > +
> > + debug("Additional %i sync word needed\n", i);
> > +
> > + /* restoring original CDRATIO */
> > + fpgamgr_set_cd_ratio(cd_ratio);
> > +
> > + return 0;
> > +}
> > +
> > +/* Read f2s_nconfig_pin and f2s_nstatus_pin; loop until de-asserted */
> > +static int wait_for_nconfig_pin_and_nstatus_pin(void)
> > +{
> > + unsigned long mask = ALT_FPGAMGR_IMGCFG_STAT_F2S_NCONFIG_PIN_SET_MSK
> |
> > + ALT_FPGAMGR_IMGCFG_STAT_F2S_
> NSTATUS_PIN_SET_MSK;
> > +
> > + /* Poll until f2s_nconfig_pin and f2s_nstatus_pin; loop until
> de-asserted,
> > + * timeout at 1000ms
> > + */
> > + return wait_for_bit(__func__,
> > + &fpga_manager_base->imgcfg_stat,
> > + mask,
> > + false, FPGA_TIMEOUT_MSEC, false);
> > +}
> > +
> > +static int wait_for_f2s_nstatus_pin(unsigned long value)
> > +{
> > + /* Poll until f2s to specific value, timeout at 1000ms */
> > + return wait_for_bit(__func__,
> > + &fpga_manager_base->imgcfg_stat,
> > + ALT_FPGAMGR_IMGCFG_STAT_F2S_
> NSTATUS_PIN_SET_MSK,
> > + value, FPGA_TIMEOUT_MSEC, false);
> > +}
> > +
> > +/* set CD ratio */
> > +static void fpgamgr_set_cd_ratio(unsigned long ratio)
> > +{
> > + clrbits_le32(&fpga_manager_base->imgcfg_ctrl_02,
> > + ALT_FPGAMGR_IMGCFG_CTL_02_CDRATIO_SET_MSK);
> > +
> > + setbits_le32(&fpga_manager_base->imgcfg_ctrl_02,
> > + (ratio << ALT_FPGAMGR_IMGCFG_CTL_02_CDRATIO_LSB) &
> > + ALT_FPGAMGR_IMGCFG_CTL_02_CDRATIO_SET_MSK);
> > +}
> > +
> > +/* get the MSEL value, verify we are set for FPP configuration mode */
> > +static int fpgamgr_verify_msel(void)
> > +{
> > + u32 msel = fpgamgr_get_msel();
> > +
> > + if ((msel != 0) && (msel != 1)) {
> > + printf("Fail: read msel=%d\n", msel);
> > + return -EPERM;
> > + }
> > +
> > + return 0;
> > +}
> > +
> > +/*
> > + * Write cdratio and cdwidth based on whether the bitstream is
> compressed
> > + * and/or encoded
> > + */
> > +static int fpgamgr_set_cdratio_cdwidth(unsigned int cfg_width, u32
> *rbf_data,
> > + size_t rbf_size)
> > +{
> > + unsigned int cd_ratio;
> > + bool encrypt, compress;
> > +
> > + /*
> > + * According to the bitstream specification,
> > + * both encryption and compression status are
> > + * in location before offset 230 of the buffer.
> > + */
> > + if (rbf_size < MIN_BITSTREAM_SIZECHECK)
> > + return -EINVAL;
> > +
> > + encrypt = (rbf_data[ENCRYPTION_OFFSET] >> 2) & 3;
> > + encrypt = encrypt != 0;
> > +
> > + compress = (rbf_data[COMPRESSION_OFFSET] >> 1) & 1;
> > + compress = !compress;
> > +
> > + debug("header word %d = %08x\n", 69, rbf_data[69]);
> > + debug("header word %d = %08x\n", 229, rbf_data[229]);
> > + debug("read from rbf header: encrypt=%d compress=%d\n", encrypt,
> compress);
> > +
> > + /*
> > + * from the register map description of cdratio in imgcfg_ctrl_02:
> > + * Normal Configuration : 32bit Passive Parallel
> > + * Partial Reconfiguration : 16bit Passive Parallel
> > + */
> > +
> > + /*
> > + * cd ratio is dependent on cfg width and whether the bitstream
> > + * is encrypted and/or compressed.
> > + *
> > + * | width | encr. | compr. | cd ratio |
> > + * | 16 | 0 | 0 | 1 |
> > + * | 16 | 0 | 1 | 4 |
> > + * | 16 | 1 | 0 | 2 |
> > + * | 16 | 1 | 1 | 4 |
> > + * | 32 | 0 | 0 | 1 |
> > + * | 32 | 0 | 1 | 8 |
> > + * | 32 | 1 | 0 | 4 |
> > + * | 32 | 1 | 1 | 8 |
> > + */
> > + if (!compress && !encrypt) {
> > + cd_ratio = CDRATIO_x1;
> > + } else {
> > + if (compress)
> > + cd_ratio = CDRATIO_x4;
> > + else
> > + cd_ratio = CDRATIO_x2;
> > +
> > + /* if 32 bit, double the cd ratio (so register
> > + field setting is incremented) */
> > + if (cfg_width == CFGWDTH_32)
> > + cd_ratio += 1;
> > + }
> > +
> > + fpgamgr_set_cfgwdth(cfg_width);
> > + fpgamgr_set_cd_ratio(cd_ratio);
> > +
> > + return 0;
> > +}
> > +
> > +static int fpgamgr_reset(void)
> > +{
> > + unsigned long reg;
> > +
> > + /* S2F_NCONFIG = 0 */
> > + clrbits_le32(&fpga_manager_base->imgcfg_ctrl_00,
> > + ALT_FPGAMGR_IMGCFG_CTL_00_S2F_NCONFIG_SET_MSK);
> > +
> > + /* Wait for f2s_nstatus == 0 */
> > + if (wait_for_f2s_nstatus_pin(0))
> > + return -ETIME;
> > +
> > + /* S2F_NCONFIG = 1 */
> > + setbits_le32(&fpga_manager_base->imgcfg_ctrl_00,
> > + ALT_FPGAMGR_IMGCFG_CTL_00_S2F_NCONFIG_SET_MSK);
> > +
> > + /* Wait for f2s_nstatus == 1 */
> > + if (wait_for_f2s_nstatus_pin(1))
> > + return -ETIME;
> > +
> > + /* read and confirm f2s_condone_pin = 0 and f2s_condone_oe = 1 */
> > + reg = readl(&fpga_manager_base->imgcfg_stat);
> > + if ((reg & ALT_FPGAMGR_IMGCFG_STAT_F2S_CONDONE_PIN_SET_MSK) != 0)
> > + return -EPERM;
> > +
> > + if ((reg & ALT_FPGAMGR_IMGCFG_STAT_F2S_CONDONE_OE_SET_MSK) == 0)
> > + return -EPERM;
> > +
> > + return 0;
> > +}
> > +
> > +/* Start the FPGA programming by initialize the FPGA Manager */
> > +int fpgamgr_program_init(u32 * rbf_data, size_t rbf_size)
> > +{
> > + int ret;
> > +
> > + /* Step 1 */
> > + if (fpgamgr_verify_msel())
> > + return -EPERM;
> > +
> > + /* Step 2 */
> > + if (fpgamgr_set_cdratio_cdwidth(CFGWDTH_32, rbf_data, rbf_size))
> > + return -EPERM;
> > +
> > + /*
> > + * Step 3:
> > + * Make sure no other external devices are trying to interfere with
> > + * programming:
> > + */
> > + if (wait_for_nconfig_pin_and_nstatus_pin())
> > + return -ETIME;
> > +
> > + /*
> > + * Step 4:
> > + * Deassert the signal drives from HPS
> > + *
> > + * S2F_NCE = 1
> > + * S2F_PR_REQUEST = 0
> > + * EN_CFG_CTRL = 0
> > + * EN_CFG_DATA = 0
> > + * S2F_NCONFIG = 1
> > + * S2F_NSTATUS_OE = 0
> > + * S2F_CONDONE_OE = 0
> > + */
> > + setbits_le32(&fpga_manager_base->imgcfg_ctrl_01,
> > + ALT_FPGAMGR_IMGCFG_CTL_01_S2F_NCE_SET_MSK);
> > +
> > + clrbits_le32(&fpga_manager_base->imgcfg_ctrl_01,
> > + ALT_FPGAMGR_IMGCFG_CTL_01_S2F_PR_REQUEST_SET_MSK);
> > +
> > + clrbits_le32(&fpga_manager_base->imgcfg_ctrl_02,
> > + ALT_FPGAMGR_IMGCFG_CTL_02_EN_CFG_DATA_SET_MSK |
> > + ALT_FPGAMGR_IMGCFG_CTL_02_EN_CFG_CTRL_SET_MSK);
> > +
> > + setbits_le32(&fpga_manager_base->imgcfg_ctrl_00,
> > + ALT_FPGAMGR_IMGCFG_CTL_00_S2F_NCONFIG_SET_MSK);
> > +
> > + clrbits_le32(&fpga_manager_base->imgcfg_ctrl_00,
> > + ALT_FPGAMGR_IMGCFG_CTL_00_S2F_NSTATUS_OE_SET_MSK |
> > + ALT_FPGAMGR_IMGCFG_CTL_00_S2F_CONDONE_OE_SET_MSK);
> > +
> > + /*
> > + * Step 5:
> > + * Enable overrides
> > + * S2F_NENABLE_CONFIG = 0
> > + * S2F_NENABLE_NCONFIG = 0
> > + */
> > + clrbits_le32(&fpga_manager_base->imgcfg_ctrl_01,
> > + ALT_FPGAMGR_IMGCFG_CTL_01_S2F_NENABLE_CONFIG_SET_MSK);
> > + clrbits_le32(&fpga_manager_base->imgcfg_ctrl_00,
> > + ALT_FPGAMGR_IMGCFG_CTL_00_S2F_NENABLE_NCONFIG_SET_MSK);
> > +
> > + /*
> > + * Disable driving signals that HPS doesn't need to drive.
> > + * S2F_NENABLE_NSTATUS = 1
> > + * S2F_NENABLE_CONDONE = 1
> > + */
> > + setbits_le32(&fpga_manager_base->imgcfg_ctrl_00,
> > + ALT_FPGAMGR_IMGCFG_CTL_00_S2F_NENABLE_NSTATUS_SET_MSK |
> > + ALT_FPGAMGR_IMGCFG_CTL_00_S2F_NENABLE_CONDONE_SET_MSK);
> > +
> > + /*
> > + * Step 6:
> > + * Drive chip select S2F_NCE = 0
> > + */
> > + clrbits_le32(&fpga_manager_base->imgcfg_ctrl_01,
> > + ALT_FPGAMGR_IMGCFG_CTL_01_S2F_NCE_SET_MSK);
> > +
> > + /* Step 7 */
> > + if (wait_for_nconfig_pin_and_nstatus_pin())
> > + return -ETIME;
> > +
> > + /* Step 8 */
> > + ret = fpgamgr_reset();
> > +
> > + if (ret)
> > + return ret;
> > +
> > + /*
> > + * Step 9:
> > + * EN_CFG_CTRL and EN_CFG_DATA = 1
> > + */
> > + setbits_le32(&fpga_manager_base->imgcfg_ctrl_02,
> > + ALT_FPGAMGR_IMGCFG_CTL_02_EN_CFG_DATA_SET_MSK |
> > + ALT_FPGAMGR_IMGCFG_CTL_02_EN_CFG_CTRL_SET_MSK);
> > +
> > + return 0;
> > +}
> > +
> > +/* Ensure the FPGA entering config done */
> > +static int fpgamgr_program_poll_cd(void)
> > +{
> > + unsigned long reg, i;
> > +
> > + for (i = 0; i < FPGA_TIMEOUT_CNT; i++) {
> > + reg = readl(&fpga_manager_base->imgcfg_stat);
> > + if (reg & ALT_FPGAMGR_IMGCFG_STAT_F2S_CONDONE_PIN_SET_MSK)
> > + return 0;
> > +
> > + if ((reg & ALT_FPGAMGR_IMGCFG_STAT_F2S_NSTATUS_PIN_SET_MSK)
> == 0) {
> > + printf("nstatus == 0 while waiting for condone\n");
> > + return -EPERM;
> > + }
> > + }
> > +
> > + if (i == FPGA_TIMEOUT_CNT)
> > + return -ETIME;
> > +
> > + return 0;
> > +}
> > +
> > +/* Ensure the FPGA entering user mode */
> > +static int fpgamgr_program_poll_usermode(void)
> > +{
> > + unsigned long reg;
> > + int ret = 0;
> > +
> > + if (fpgamgr_dclkcnt_set(0xf))
> > + return -ETIME;
> > +
> > + ret = wait_for_user_mode();
> > +
> > + if (ret < 0) {
> > + printf("%s: Failed to enter user mode with ", __func__);
> > + printf("error code %d\n", ret);
> > + return ret;
> > + }
> > +
> > + /*
> > + * Step 14:
> > + * Stop DATA path and Dclk
> > + * EN_CFG_CTRL and EN_CFG_DATA = 0
> > + */
> > + clrbits_le32(&fpga_manager_base->imgcfg_ctrl_02,
> > + ALT_FPGAMGR_IMGCFG_CTL_02_EN_CFG_DATA_SET_MSK |
> > + ALT_FPGAMGR_IMGCFG_CTL_02_EN_CFG_CTRL_SET_MSK);
> > +
> > + /*
> > + * Step 15:
> > + * Disable overrides
> > + * S2F_NENABLE_CONFIG = 1
> > + * S2F_NENABLE_NCONFIG = 1
> > + */
> > + setbits_le32(&fpga_manager_base->imgcfg_ctrl_01,
> > + ALT_FPGAMGR_IMGCFG_CTL_01_S2F_NENABLE_CONFIG_SET_MSK);
> > + setbits_le32(&fpga_manager_base->imgcfg_ctrl_00,
> > + ALT_FPGAMGR_IMGCFG_CTL_00_S2F_NENABLE_NCONFIG_SET_MSK);
> > +
> > + /* Disable chip select S2F_NCE = 1 */
> > + setbits_le32(&fpga_manager_base->imgcfg_ctrl_01,
> > + ALT_FPGAMGR_IMGCFG_CTL_01_S2F_NCE_SET_MSK);
> > +
> > + /*
> > + * Step 16:
> > + * Final check
> > + */
> > + reg = readl(&fpga_manager_base->imgcfg_stat);
> > + if (((reg & ALT_FPGAMGR_IMGCFG_STAT_F2S_USERMODE_SET_MSK) !=
> > + ALT_FPGAMGR_IMGCFG_STAT_F2S_USERMODE_SET_MSK) ||
> > + ((reg & ALT_FPGAMGR_IMGCFG_STAT_F2S_CONDONE_PIN_SET_MSK) !=
> > + ALT_FPGAMGR_IMGCFG_STAT_F2S_CONDONE_PIN_SET_MSK) ||
> > + ((reg & ALT_FPGAMGR_IMGCFG_STAT_F2S_NSTATUS_PIN_SET_MSK) !=
> > + ALT_FPGAMGR_IMGCFG_STAT_F2S_NSTATUS_PIN_SET_MSK))
> > + return -EPERM;
> > +
> > + return 0;
> > +}
> > +
> > +int fpgamgr_program_fini(void)
>
> static and how about fpgamgr_program_finish()?
>
> This function will be exposed to other file in later patch. I can change
to finish.
> > +{
> > + /* Ensure the FPGA entering config done */
> > + int status = fpgamgr_program_poll_cd();
> > +
> > + if (status) {
> > + printf("FPGA: Poll CD failed with error code %d\n",
> status);
> > + return -EPERM;
> > + }
> > + WATCHDOG_RESET();
> > +
> > + /* Ensure the FPGA entering user mode */
> > + status = fpgamgr_program_poll_usermode();
> > + if (status) {
> > + printf("FPGA: Poll usermode failed with error code %d\n",
> > + status);
> > + return -EPERM;
> > + }
> > +
> > + printf("Full Configuration Succeeded.\n");
> > +
> > + return 0;
> > +}
> > +
> > +/*
> > + * FPGA Manager to program the FPGA. This is the interface used by FPGA
> driver.
> > + * Return 0 for sucess, non-zero for error.
> > + */
> > +int socfpga_load(Altera_desc *desc, const void *rbf_data, size_t
> rbf_size)
> > +{
> > + unsigned long status;
> > +
> > + /* disable all signals from hps peripheral controller to fpga */
> > + writel(0, &system_manager_base->fpgaintf_en_global);
> > +
> > + /* disable all axi bridge (hps2fpga, lwhps2fpga & fpga2hps) */
> > + socfpga_bridges_reset();
> > +
> > + /* Initialize the FPGA Manager */
> > + status = fpgamgr_program_init((u32 *)rbf_data, rbf_size);
> > + if (status)
> > + return status;
> > +
> > + /* Write the RBF data to FPGA Manager */
> > + fpgamgr_program_write(rbf_data, rbf_size);
> > +
> > + return fpgamgr_program_fini();
> > +}
> > diff --git a/include/configs/socfpga_common.h b/include/configs/socfpga_
> common.h
> > index da7e4ad..992097d 100644
> > --- a/include/configs/socfpga_common.h
> > +++ b/include/configs/socfpga_common.h
> > @@ -105,7 +105,8 @@
> > /*
> > * FPGA Driver
> > */
> > -#ifdef CONFIG_TARGET_SOCFPGA_GEN5
> > +#if defined(CONFIG_TARGET_SOCFPGA_GEN5) || \
> > + defined(CONFIG_TARGET_SOCFPGA_ARRIA10)
>
> I don't think there's a need for the above wrappers at all.
>
> Okay
> Dinh
>
More information about the U-Boot
mailing list