| /* | |
| * (C) Copyright 2007 | |
| * Matthias Fuchs, esd gmbh, matthias.fuchs@esd-electronics.com. | |
| * | |
| * SPDX-License-Identifier: GPL-2.0+ | |
| */ | |
| #include <common.h> | |
| #include <asm/io.h> | |
| #include <spartan2.h> | |
| #include <spartan3.h> | |
| #include <command.h> | |
| #include "fpga.h" | |
| #include "pmc440.h" | |
| DECLARE_GLOBAL_DATA_PTR; | |
| #if defined(CONFIG_FPGA) | |
| #define USE_SP_CODE | |
| #ifdef USE_SP_CODE | |
| Xilinx_Spartan3_Slave_Parallel_fns pmc440_fpga_fns = { | |
| fpga_pre_config_fn, | |
| fpga_pgm_fn, | |
| fpga_init_fn, | |
| NULL, /* err */ | |
| fpga_done_fn, | |
| fpga_clk_fn, | |
| fpga_cs_fn, | |
| fpga_wr_fn, | |
| NULL, /* rdata */ | |
| fpga_wdata_fn, | |
| fpga_busy_fn, | |
| fpga_abort_fn, | |
| fpga_post_config_fn, | |
| }; | |
| #else | |
| Xilinx_Spartan3_Slave_Serial_fns pmc440_fpga_fns = { | |
| fpga_pre_config_fn, | |
| fpga_pgm_fn, | |
| fpga_clk_fn, | |
| fpga_init_fn, | |
| fpga_done_fn, | |
| fpga_wr_fn, | |
| fpga_post_config_fn, | |
| }; | |
| #endif | |
| Xilinx_Spartan2_Slave_Serial_fns ngcc_fpga_fns = { | |
| ngcc_fpga_pre_config_fn, | |
| ngcc_fpga_pgm_fn, | |
| ngcc_fpga_clk_fn, | |
| ngcc_fpga_init_fn, | |
| ngcc_fpga_done_fn, | |
| ngcc_fpga_wr_fn, | |
| ngcc_fpga_post_config_fn | |
| }; | |
| Xilinx_desc fpga[CONFIG_FPGA_COUNT] = { | |
| XILINX_XC3S1200E_DESC( | |
| #ifdef USE_SP_CODE | |
| slave_parallel, | |
| #else | |
| slave_serial, | |
| #endif | |
| (void *)&pmc440_fpga_fns, | |
| 0), | |
| XILINX_XC2S200_DESC( | |
| slave_serial, | |
| (void *)&ngcc_fpga_fns, | |
| 0) | |
| }; | |
| /* | |
| * Set the active-low FPGA reset signal. | |
| */ | |
| void fpga_reset(int assert) | |
| { | |
| debug("%s:%d: RESET ", __FUNCTION__, __LINE__); | |
| if (assert) { | |
| out_be32((void*)GPIO1_OR, in_be32((void*)GPIO1_OR) & ~GPIO1_FPGA_DATA); | |
| debug("asserted\n"); | |
| } else { | |
| out_be32((void*)GPIO1_OR, in_be32((void*)GPIO1_OR) | GPIO1_FPGA_DATA); | |
| debug("deasserted\n"); | |
| } | |
| } | |
| /* | |
| * Initialize the SelectMap interface. We assume that the mode and the | |
| * initial state of all of the port pins have already been set! | |
| */ | |
| void fpga_serialslave_init(void) | |
| { | |
| debug("%s:%d: Initialize serial slave interface\n", __FUNCTION__, | |
| __LINE__); | |
| fpga_pgm_fn(false, false, 0); /* make sure program pin is inactive */ | |
| } | |
| /* | |
| * Set the FPGA's active-low SelectMap program line to the specified level | |
| */ | |
| int fpga_pgm_fn(int assert, int flush, int cookie) | |
| { | |
| debug("%s:%d: FPGA PROGRAM ", | |
| __FUNCTION__, __LINE__); | |
| if (assert) { | |
| out_be32((void*)GPIO1_OR, in_be32((void*)GPIO1_OR) & ~GPIO1_FPGA_PRG); | |
| debug("asserted\n"); | |
| } else { | |
| out_be32((void*)GPIO1_OR, in_be32((void*)GPIO1_OR) | GPIO1_FPGA_PRG); | |
| debug("deasserted\n"); | |
| } | |
| return assert; | |
| } | |
| /* | |
| * Test the state of the active-low FPGA INIT line. Return 1 on INIT | |
| * asserted (low). | |
| */ | |
| int fpga_init_fn(int cookie) | |
| { | |
| if (in_be32((void*)GPIO1_IR) & GPIO1_FPGA_INIT) | |
| return 0; | |
| else | |
| return 1; | |
| } | |
| #ifdef USE_SP_CODE | |
| int fpga_abort_fn(int cookie) | |
| { | |
| return 0; | |
| } | |
| int fpga_cs_fn(int assert_cs, int flush, int cookie) | |
| { | |
| return assert_cs; | |
| } | |
| int fpga_busy_fn(int cookie) | |
| { | |
| return 1; | |
| } | |
| #endif | |
| /* | |
| * Test the state of the active-high FPGA DONE pin | |
| */ | |
| int fpga_done_fn(int cookie) | |
| { | |
| if (in_be32((void*)GPIO1_IR) & GPIO1_FPGA_DONE) | |
| return 1; | |
| else | |
| return 0; | |
| } | |
| /* | |
| * FPGA pre-configuration function. Just make sure that | |
| * FPGA reset is asserted to keep the FPGA from starting up after | |
| * configuration. | |
| */ | |
| int fpga_pre_config_fn(int cookie) | |
| { | |
| debug("%s:%d: FPGA pre-configuration\n", __FUNCTION__, __LINE__); | |
| fpga_reset(true); | |
| /* release init# */ | |
| out_be32((void*)GPIO0_OR, in_be32((void*)GPIO0_OR) | GPIO0_FPGA_FORCEINIT); | |
| /* disable PLD IOs */ | |
| out_be32((void*)GPIO1_OR, in_be32((void*)GPIO1_OR) | GPIO1_IOEN_N); | |
| return 0; | |
| } | |
| /* | |
| * FPGA post configuration function. Blip the FPGA reset line and then see if | |
| * the FPGA appears to be running. | |
| */ | |
| int fpga_post_config_fn(int cookie) | |
| { | |
| pmc440_fpga_t *fpga = (pmc440_fpga_t *)FPGA_BA; | |
| int rc=0; | |
| char *s; | |
| debug("%s:%d: FPGA post configuration\n", __FUNCTION__, __LINE__); | |
| /* enable PLD0..7 pins */ | |
| out_be32((void*)GPIO1_OR, in_be32((void*)GPIO1_OR) & ~GPIO1_IOEN_N); | |
| fpga_reset(true); | |
| udelay (100); | |
| fpga_reset(false); | |
| udelay (100); | |
| FPGA_OUT32(&fpga->status, (gd->board_type << STATUS_HWREV_SHIFT) & STATUS_HWREV_MASK); | |
| /* NGCC/CANDES only: enable ledlink */ | |
| if ((s = getenv("bd_type")) && | |
| ((!strcmp(s, "ngcc")) || (!strcmp(s, "candes")))) | |
| FPGA_SETBITS(&fpga->ctrla, 0x29f8c000); | |
| return rc; | |
| } | |
| int fpga_clk_fn(int assert_clk, int flush, int cookie) | |
| { | |
| if (assert_clk) | |
| out_be32((void*)GPIO1_OR, in_be32((void*)GPIO1_OR) | GPIO1_FPGA_CLK); | |
| else | |
| out_be32((void*)GPIO1_OR, in_be32((void*)GPIO1_OR) & ~GPIO1_FPGA_CLK); | |
| return assert_clk; | |
| } | |
| int fpga_wr_fn(int assert_write, int flush, int cookie) | |
| { | |
| if (assert_write) | |
| out_be32((void*)GPIO1_OR, in_be32((void*)GPIO1_OR) | GPIO1_FPGA_DATA); | |
| else | |
| out_be32((void*)GPIO1_OR, in_be32((void*)GPIO1_OR) & ~GPIO1_FPGA_DATA); | |
| return assert_write; | |
| } | |
| #ifdef USE_SP_CODE | |
| int fpga_wdata_fn(uchar data, int flush, int cookie) | |
| { | |
| uchar val = data; | |
| ulong or = in_be32((void*)GPIO1_OR); | |
| int i = 7; | |
| do { | |
| /* Write data */ | |
| if (val & 0x80) | |
| or = (or & ~GPIO1_FPGA_CLK) | GPIO1_FPGA_DATA; | |
| else | |
| or = or & ~(GPIO1_FPGA_CLK | GPIO1_FPGA_DATA); | |
| out_be32((void*)GPIO1_OR, or); | |
| /* Assert the clock */ | |
| or |= GPIO1_FPGA_CLK; | |
| out_be32((void*)GPIO1_OR, or); | |
| val <<= 1; | |
| i --; | |
| } while (i > 0); | |
| /* Write last data bit (the 8th clock comes from the sp_load() code */ | |
| if (val & 0x80) | |
| or = (or & ~GPIO1_FPGA_CLK) | GPIO1_FPGA_DATA; | |
| else | |
| or = or & ~(GPIO1_FPGA_CLK | GPIO1_FPGA_DATA); | |
| out_be32((void*)GPIO1_OR, or); | |
| return 0; | |
| } | |
| #endif | |
| #define NGCC_FPGA_PRG CLOCK_EN | |
| #define NGCC_FPGA_DATA RESET_OUT | |
| #define NGCC_FPGA_DONE CLOCK_IN | |
| #define NGCC_FPGA_INIT IRIGB_R_IN | |
| #define NGCC_FPGA_CLK CLOCK_OUT | |
| void ngcc_fpga_serialslave_init(void) | |
| { | |
| debug("%s:%d: Initialize serial slave interface\n", | |
| __FUNCTION__, __LINE__); | |
| /* make sure program pin is inactive */ | |
| ngcc_fpga_pgm_fn(false, false, 0); | |
| } | |
| /* | |
| * Set the active-low FPGA reset signal. | |
| */ | |
| void ngcc_fpga_reset(int assert) | |
| { | |
| debug("%s:%d: RESET ", __FUNCTION__, __LINE__); | |
| if (assert) { | |
| FPGA_CLRBITS(NGCC_CTRL_BASE, NGCC_CTRL_FPGARST_N); | |
| debug("asserted\n"); | |
| } else { | |
| FPGA_SETBITS(NGCC_CTRL_BASE, NGCC_CTRL_FPGARST_N); | |
| debug("deasserted\n"); | |
| } | |
| } | |
| /* | |
| * Set the FPGA's active-low SelectMap program line to the specified level | |
| */ | |
| int ngcc_fpga_pgm_fn(int assert, int flush, int cookie) | |
| { | |
| pmc440_fpga_t *fpga = (pmc440_fpga_t *)FPGA_BA; | |
| debug("%s:%d: FPGA PROGRAM ", __FUNCTION__, __LINE__); | |
| if (assert) { | |
| FPGA_CLRBITS(&fpga->ctrla, NGCC_FPGA_PRG); | |
| debug("asserted\n"); | |
| } else { | |
| FPGA_SETBITS(&fpga->ctrla, NGCC_FPGA_PRG); | |
| debug("deasserted\n"); | |
| } | |
| return assert; | |
| } | |
| /* | |
| * Test the state of the active-low FPGA INIT line. Return 1 on INIT | |
| * asserted (low). | |
| */ | |
| int ngcc_fpga_init_fn(int cookie) | |
| { | |
| pmc440_fpga_t *fpga = (pmc440_fpga_t *)FPGA_BA; | |
| debug("%s:%d: INIT check... ", __FUNCTION__, __LINE__); | |
| if (FPGA_IN32(&fpga->status) & NGCC_FPGA_INIT) { | |
| debug("high\n"); | |
| return 0; | |
| } else { | |
| debug("low\n"); | |
| return 1; | |
| } | |
| } | |
| /* | |
| * Test the state of the active-high FPGA DONE pin | |
| */ | |
| int ngcc_fpga_done_fn(int cookie) | |
| { | |
| pmc440_fpga_t *fpga = (pmc440_fpga_t *)FPGA_BA; | |
| debug("%s:%d: DONE check... ", __FUNCTION__, __LINE__); | |
| if (FPGA_IN32(&fpga->status) & NGCC_FPGA_DONE) { | |
| debug("DONE high\n"); | |
| return 1; | |
| } else { | |
| debug("low\n"); | |
| return 0; | |
| } | |
| } | |
| /* | |
| * FPGA pre-configuration function. | |
| */ | |
| int ngcc_fpga_pre_config_fn(int cookie) | |
| { | |
| pmc440_fpga_t *fpga = (pmc440_fpga_t *)FPGA_BA; | |
| debug("%s:%d: FPGA pre-configuration\n", __FUNCTION__, __LINE__); | |
| ngcc_fpga_reset(true); | |
| FPGA_CLRBITS(&fpga->ctrla, 0xfffffe00); | |
| ngcc_fpga_reset(true); | |
| return 0; | |
| } | |
| /* | |
| * FPGA post configuration function. Blip the FPGA reset line and then see if | |
| * the FPGA appears to be running. | |
| */ | |
| int ngcc_fpga_post_config_fn(int cookie) | |
| { | |
| pmc440_fpga_t *fpga = (pmc440_fpga_t *)FPGA_BA; | |
| debug("%s:%d: NGCC FPGA post configuration\n", __FUNCTION__, __LINE__); | |
| udelay (100); | |
| ngcc_fpga_reset(false); | |
| FPGA_SETBITS(&fpga->ctrla, 0x29f8c000); | |
| return 0; | |
| } | |
| int ngcc_fpga_clk_fn(int assert_clk, int flush, int cookie) | |
| { | |
| pmc440_fpga_t *fpga = (pmc440_fpga_t *)FPGA_BA; | |
| if (assert_clk) | |
| FPGA_SETBITS(&fpga->ctrla, NGCC_FPGA_CLK); | |
| else | |
| FPGA_CLRBITS(&fpga->ctrla, NGCC_FPGA_CLK); | |
| return assert_clk; | |
| } | |
| int ngcc_fpga_wr_fn(int assert_write, int flush, int cookie) | |
| { | |
| pmc440_fpga_t *fpga = (pmc440_fpga_t *)FPGA_BA; | |
| if (assert_write) | |
| FPGA_SETBITS(&fpga->ctrla, NGCC_FPGA_DATA); | |
| else | |
| FPGA_CLRBITS(&fpga->ctrla, NGCC_FPGA_DATA); | |
| return assert_write; | |
| } | |
| /* | |
| * Initialize the fpga. Return 1 on success, 0 on failure. | |
| */ | |
| int pmc440_init_fpga(void) | |
| { | |
| char *s; | |
| debug("%s:%d: Initialize FPGA interface\n", | |
| __FUNCTION__, __LINE__); | |
| fpga_init(); | |
| fpga_serialslave_init (); | |
| debug("%s:%d: Adding fpga 0\n", __FUNCTION__, __LINE__); | |
| fpga_add (fpga_xilinx, &fpga[0]); | |
| /* NGCC only */ | |
| if ((s = getenv("bd_type")) && !strcmp(s, "ngcc")) { | |
| ngcc_fpga_serialslave_init (); | |
| debug("%s:%d: Adding fpga 1\n", __FUNCTION__, __LINE__); | |
| fpga_add (fpga_xilinx, &fpga[1]); | |
| } | |
| return 0; | |
| } | |
| #endif /* CONFIG_FPGA */ |