X-Git-Url: https://git.sur5r.net/?a=blobdiff_plain;f=arch%2Farm%2Fmach-socfpga%2Fscan_manager.c;h=566b33f2b6a0e92d37e5773ba9527f3ae22760f9;hb=4fb01c4435ae98fdce86ec491ddf3c240f8eb174;hp=dd32195d6a436d19773817bd797419b8b896d6de;hpb=62a0c9cff3a8f842bec7d9a52e113ca67371f138;p=u-boot diff --git a/arch/arm/mach-socfpga/scan_manager.c b/arch/arm/mach-socfpga/scan_manager.c index dd32195d6a..566b33f2b6 100644 --- a/arch/arm/mach-socfpga/scan_manager.c +++ b/arch/arm/mach-socfpga/scan_manager.c @@ -9,6 +9,7 @@ #include #include #include +#include /* * Maximum polling loop to wait for IO scan chain engine becomes idle @@ -33,6 +34,8 @@ static const struct socfpga_scan_manager *scan_manager_base = (void *)(SOCFPGA_SCANMGR_ADDRESS); static const struct socfpga_freeze_controller *freeze_controller_base = (void *)(SOCFPGA_SYSMGR_ADDRESS + SYSMGR_FRZCTRL_ADDRESS); +static struct socfpga_system_manager *sys_mgr_base = + (struct socfpga_system_manager *)SOCFPGA_SYSMGR_ADDRESS; /** * scan_chain_engine_is_idle() - Check if the JTAG scan chain is idle @@ -101,16 +104,47 @@ static void scan_mgr_jtag_io(const u32 flags, const u8 iarg, const u32 parg) writel(data & 0xff, &scan_manager_base->fifo_single_byte); } +/** + * scan_mgr_jtag_insn_data() - Send JTAG instruction and data + * @iarg: Instruction argument + * @data: Associated data + * @dlen: Length of data in bits + * + * This function is used when programming the IO chains to submit the + * instruction followed by variable length payload. + */ +static int +scan_mgr_jtag_insn_data(const u8 iarg, const unsigned long *data, + const unsigned int dlen) +{ + int i, j; + + scan_mgr_jtag_io(JTAG_BP_INSN | JTAG_BP_2BYTE, iarg, dlen - 1); + + /* 32 bits or more remain */ + for (i = 0; i < dlen / 32; i++) + scan_mgr_jtag_io(JTAG_BP_4BYTE, 0x0, data[i]); + + if ((dlen % 32) > 24) { /* 31...24 bits remain */ + scan_mgr_jtag_io(JTAG_BP_4BYTE, 0x0, data[i]); + } else if (dlen % 32) { /* 24...1 bit remain */ + for (j = 0; j < dlen % 32; j += 8) + scan_mgr_jtag_io(0, 0x0, data[i] >> j); + } + + return scan_chain_engine_is_idle(SCANMGR_MAX_DELAY); +} + /** * scan_mgr_io_scan_chain_prg() - Program HPS IO Scan Chain * @io_scan_chain_id: IO scan chain ID */ static int scan_mgr_io_scan_chain_prg(const unsigned int io_scan_chain_id) { - u32 residual; u32 io_scan_chain_len_in_bits; const unsigned long *iocsr_scan_chain; - int i, ret, index = 0; + unsigned int rem, idx = 0; + int ret; ret = iocsr_get_config_table(io_scan_chain_id, &iocsr_scan_chain, &io_scan_chain_len_in_bits); @@ -139,78 +173,18 @@ static int scan_mgr_io_scan_chain_prg(const unsigned int io_scan_chain_id) */ setbits_le32(&scan_manager_base->en, 1 << io_scan_chain_id); - /* Program IO scan chain in 128-bit iteration */ - for (i = 0; i < io_scan_chain_len_in_bits / 128; i++) { - /* Write TDI_TDO packet header for 128-bit IO scan chain */ - scan_mgr_jtag_io(JTAG_BP_INSN | JTAG_BP_2BYTE, 0x0, - TDI_TDO_MAX_PAYLOAD); - - /* write 4 successive 32-bit IO scan chain data into WFIFO */ - scan_mgr_jtag_io(JTAG_BP_4BYTE, 0x0, iocsr_scan_chain[index++]); - scan_mgr_jtag_io(JTAG_BP_4BYTE, 0x0, iocsr_scan_chain[index++]); - scan_mgr_jtag_io(JTAG_BP_4BYTE, 0x0, iocsr_scan_chain[index++]); - scan_mgr_jtag_io(JTAG_BP_4BYTE, 0x0, iocsr_scan_chain[index++]); - - /* - * Check if the scan chain engine has completed the - * IO scan chain data shifting - */ - ret = scan_chain_engine_is_idle(SCANMGR_MAX_DELAY); - if (ret) - goto error; - } - - residual = io_scan_chain_len_in_bits % 128; - - /* Final TDI_TDO packet (if chain length is not aligned to 128 bits) */ - if (residual) { - /* - * Program the last part of IO scan chain write TDI_TDO - * packet header (2 bytes) to scan manager. - */ - scan_mgr_jtag_io(JTAG_BP_INSN | JTAG_BP_2BYTE, 0x0, - residual - 1); - - for (i = 0; i < residual / 32; i++) { - /* - * write remaining scan chain data into scan - * manager WFIFO with 4 bytes write - */ - scan_mgr_jtag_io(JTAG_BP_4BYTE, 0x0, - iocsr_scan_chain[index++]); - } - - residual = io_scan_chain_len_in_bits % 32; - if (residual > 24) { - /* - * write the last 4B scan chain data - * into scan manager WFIFO - */ - scan_mgr_jtag_io(JTAG_BP_4BYTE, 0x0, - iocsr_scan_chain[index]); - } else { - /* - * write the remaining 1 - 3 bytes scan chain - * data into scan manager WFIFO byte by byte - * to prevent JTAG engine shifting unused data - * from the FIFO and mistaken the data as a - * valid command (even though unused bits are - * set to 0, but just to prevent hardware - * glitch) - */ - for (i = 0; i < residual; i += 8) { - scan_mgr_jtag_io(0, 0x0, - iocsr_scan_chain[index] >> i); - } - } + /* Program IO scan chain. */ + while (io_scan_chain_len_in_bits) { + if (io_scan_chain_len_in_bits > 128) + rem = 128; + else + rem = io_scan_chain_len_in_bits; - /* - * Check if the scan chain engine has completed the - * IO scan chain data shifting - */ - ret = scan_chain_engine_is_idle(SCANMGR_MAX_DELAY); + ret = scan_mgr_jtag_insn_data(0x0, &iocsr_scan_chain[idx], rem); if (ret) goto error; + io_scan_chain_len_in_bits -= rem; + idx += 4; } /* Disable IO Scan chain when configuration done*/ @@ -234,3 +208,55 @@ int scan_mgr_configure_iocsr(void) status |= scan_mgr_io_scan_chain_prg(3); return status; } + +/** + * scan_mgr_get_fpga_id() - Obtain FPGA JTAG ID + * + * This function obtains JTAG ID from the FPGA TAP controller. + */ +u32 scan_mgr_get_fpga_id(void) +{ + const unsigned long data = 0; + u32 id = 0xffffffff; + int ret; + + /* Enable HPS to talk to JTAG in the FPGA through the System Manager */ + writel(0x1, &sys_mgr_base->scanmgrgrp_ctrl); + + /* Enable port 7 */ + writel(0x80, &scan_manager_base->en); + /* write to CSW to make s2f_ntrst reset */ + writel(0x02, &scan_manager_base->stat); + + /* Add a pause */ + mdelay(1); + + /* write 0x00 to CSW to clear the s2f_ntrst */ + writel(0, &scan_manager_base->stat); + + /* + * Go to Test-Logic-Reset state. + * This sets TAP controller into IDCODE mode. + */ + scan_mgr_jtag_io(JTAG_BP_INSN | JTAG_BP_TMS, 0x1f | (1 << 5), 0x0); + + /* Go to Run-Test/Idle -> DR-Scan -> Capture-DR -> Shift-DR state. */ + scan_mgr_jtag_io(JTAG_BP_INSN | JTAG_BP_TMS, 0x02 | (1 << 4), 0x0); + + /* + * Push 4 bytes of data through TDI->DR->TDO. + * + * Length of TDI data is 32bits (length - 1) and they are only + * zeroes as we care only for TDO data. + */ + ret = scan_mgr_jtag_insn_data(0x4, &data, 32); + /* Read 32 bit from captured JTAG data. */ + if (!ret) + id = readl(&scan_manager_base->fifo_quad_byte); + + /* Disable all port */ + writel(0, &scan_manager_base->en); + writel(0, &sys_mgr_base->scanmgrgrp_ctrl); + + return id; +}