From 4e79b48e2c7e535ef21178a69788c15b571c72ff Mon Sep 17 00:00:00 2001 From: Franck Jullien Date: Thu, 8 Aug 2013 23:45:47 +0200 Subject: Add new target type: OpenRISC Add support for OpenRISC target. This implementation supports the adv_debug_sys debug unit core. The mohor dbg_if is not supported. Support for mohor TAP core and Altera Virtual JTAG core are also provided. Change-Id: I3b1cfab1bbb28e497c4fca6ed1bd3a4362609b72 Signed-off-by: Franck Jullien Reviewed-on: http://openocd.zylin.com/1547 Tested-by: jenkins Reviewed-by: Andreas Fritiofson --- src/target/openrisc/or1k_tap_vjtag.c | 310 +++++++++++++++++++++++++++++++++++ 1 file changed, 310 insertions(+) create mode 100644 src/target/openrisc/or1k_tap_vjtag.c (limited to 'src/target/openrisc/or1k_tap_vjtag.c') diff --git a/src/target/openrisc/or1k_tap_vjtag.c b/src/target/openrisc/or1k_tap_vjtag.c new file mode 100644 index 00000000..ae729a04 --- /dev/null +++ b/src/target/openrisc/or1k_tap_vjtag.c @@ -0,0 +1,310 @@ +/*************************************************************************** + * Copyright (C) 2013 by Franck Jullien * + * elec4fun@gmail.com * + * * + * This program is free software; you can redistribute it and/or modify * + * it under the terms of the GNU General Public License as published by * + * the Free Software Foundation; either version 2 of the License, or * + * (at your option) any later version. * + * * + * This program is distributed in the hope that it will be useful, * + * but WITHOUT ANY WARRANTY; without even the implied warranty of * + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * + * GNU General Public License for more details. * + * * + * You should have received a copy of the GNU General Public License * + * along with this program; if not, write to the * + * Free Software Foundation, Inc., * + * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. * + ***************************************************************************/ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include "or1k_tap.h" +#include "or1k.h" + +#include + +/* Contains constants relevant to the Altera Virtual JTAG + * device, which are not included in the BSDL. + * As of this writing, these are constant across every + * device which supports virtual JTAG. + */ + +/* These are commands for the FPGA's IR. */ +#define ALTERA_CYCLONE_CMD_USER1 0x0E +#define ALTERA_CYCLONE_CMD_USER0 0x0C + +/* These defines are for the virtual IR (not the FPGA's) + * The virtual TAP was defined in hardware to match the OpenCores native + * TAP in both IR size and DEBUG command. + */ +#define ALT_VJTAG_IR_SIZE 4 +#define ALT_VJTAG_CMD_DEBUG 0x8 + +/* SLD node ID. */ +#define JTAG_TO_AVALON_NODE_ID 0x84 +#define VJTAG_NODE_ID 0x08 +#define SIGNAL_TAP_NODE_ID 0x00 +#define SERIAL_FLASH_LOADER_NODE_ID 0x04 + +#define VER(x) ((x >> 27) & 0x1f) +#define NB_NODES(x) ((x >> 19) & 0xff) +#define ID(x) ((x >> 19) & 0xff) +#define MANUF(x) ((x >> 8) & 0x7ff) +#define M_WIDTH(x) ((x >> 0) & 0xff) +#define INST_ID(x) ((x >> 0) & 0xff) + +/* tap instructions - Mohor JTAG TAP */ +#define OR1K_TAP_INST_IDCODE 0x2 +#define OR1K_TAP_INST_DEBUG 0x8 + +static char *id_to_string(unsigned char id) +{ + switch (id) { + case VJTAG_NODE_ID: + return "Virtual JTAG"; + case JTAG_TO_AVALON_NODE_ID: + return "JTAG to avalon bridge"; + case SIGNAL_TAP_NODE_ID: + return "Signal TAP"; + case SERIAL_FLASH_LOADER_NODE_ID: + return "Serial Flash Loader"; + } + return "unknown"; +} + +static unsigned char guess_addr_width(unsigned char number_of_nodes) +{ + unsigned char width = 0; + + while (number_of_nodes) { + number_of_nodes >>= 1; + width++; + } + + return width; +} + +static int or1k_tap_vjtag_init(struct or1k_jtag *jtag_info) +{ + LOG_DEBUG("Initialising Altera Virtual JTAG TAP"); + + /* Put TAP into state where it can talk to the debug interface + * by shifting in correct value to IR. + */ + + /* Ensure TAP is reset - maybe not necessary*/ + jtag_add_tlr(); + + /* You can use a custom JTAG controller to discover transactions + * necessary to enumerate all Virtual JTAG megafunction instances + * from your design atruntime. All SLD nodes and the virtual JTAG + * registers that they contain are targeted by two Instruction Register + * values, USER0 and USER1. + * + * The USER1 instruction targets the virtual IR of either the sld_hub + * or a SLD node. That is,when the USER1 instruction is issued to + * the device, the subsequent DR scans target a specific virtual + * IR chain based on an address field contained within the DR scan. + * The table below shows how the virtual IR, the DR target of the + * USER1 instruction is interpreted. + * + * The VIR_VALUE in the table below is the virtual IR value for the + * target SLD node. The width of this field is m bits in length, + * where m is the length of the largest VIR for all of the SLD nodes + * in the design. All SLD nodes with VIR lengths of fewer than m + * bits must pad VIR_VALUE with zeros up to a length of m. + * + * -------------------------------+------------------------------- + * m + n - 1 m | m -1 0 + * -------------------------------+------------------------------- + * ADDR [(n – 1)..0] | VIR_VALUE [(m – 1)..0] + * -------------------------------+------------------------------- + * + * The ADDR bits act as address values to signal the active SLD node + * that the virtual IR shift targets. ADDR is n bits in length, where + * n bits must be long enough to encode all SLD nodes within the design, + * as shown below. + * + * n = CEIL(log2(Number of SLD_nodes +1)) + * + * The SLD hub is always 0 in the address map. + * + * Discovery and enumeration of the SLD instances within a design + * requires interrogation of the sld_hub to determine the dimensions + * of the USER1 DR (m and n) and associating each SLD instance, specifically + * the Virtual JTAG megafunction instances, with an address value + * contained within the ADDR bits of the USER1 DR. + * + * The SLD hub contains the HUB IP Configuration Register and SLD_NODE_INFO + * register for each SLD node in the design. The HUB IP configuration register provides + * information needed to determine the dimensions of the USER1 DR chain. The + * SLD_NODE_INFO register is used to determine the address mapping for Virtual + * JTAG instance in your design. This register set is shifted out by issuing the + * HUB_INFO instruction. Both the ADDR bits for the SLD hub and the HUB_INFO + * instruction is 0 × 0. + * Because m and n are unknown at this point, the DR register + * (ADDR bits + VIR_VALUE) must be filled with zeros. Shifting a sequence of 64 zeroes + * into the USER1 DR is sufficient to cover the most conservative case for m and n. + */ + + uint8_t t[4]; + struct scan_field field; + struct jtag_tap *tap = jtag_info->tap; + + /* Select VIR */ + buf_set_u32(t, 0, tap->ir_length, ALTERA_CYCLONE_CMD_USER1); + field.num_bits = tap->ir_length; + field.out_value = t; + field.in_value = NULL; + jtag_add_ir_scan(tap, &field, TAP_IDLE); + + /* Select the SLD Hub */ + field.num_bits = 64; + field.out_value = NULL; + field.in_value = NULL; + jtag_add_dr_scan(tap, 1, &field, TAP_IDLE); + + /* HUB IP Configuration Register + * + * When the USER1 and HUB_INFO instruction sequence is issued, the + * USER0 instruction must be applied to enable the target register + * of the HUB_INFO instruction. The HUB IP configuration register + * is shifted out using eight four-bit nibble scans of the DR register. + * Each four-bit scan must pass through the UPDATE_DR state before + * the next four-bit scan. The 8 scans are assembled into a 32-bit + * value with the definitions shown in the table below. + * + * -------------------------------------------------------------------------------- + * NIBBLE7 | NIBBLE6 | NIBBLE5 | NIBBLE4 | NIBBLE3 | NIBBLE2 | NIBBLE1 | NIBBLE0 + * ----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----- + * | | | | | | | | | | | | | | | + * ----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----- + * HUB IP version| N | ALTERA_MFG_ID (0x06E) | SUM (m, n) + * --------------+-------------------+------------------------+-------------------- + */ + + /* Select VDR */ + buf_set_u32(t, 0, tap->ir_length, ALTERA_CYCLONE_CMD_USER0); + field.num_bits = tap->ir_length; + field.out_value = t; + field.in_value = NULL; + jtag_add_ir_scan(tap, &field, TAP_IDLE); + + int retval = jtag_execute_queue(); + if (retval != ERROR_OK) + return retval; + + uint8_t nibble; + uint32_t hub_info = 0; + + for (int i = 0; i < 8; i++) { + field.num_bits = 4; + field.out_value = NULL; + field.in_value = &nibble; + jtag_add_dr_scan(tap, 1, &field, TAP_IDLE); + retval = jtag_execute_queue(); + if (retval != ERROR_OK) + return retval; + hub_info = ((hub_info >> 4) | ((nibble & 0xf) << 28)); + } + + int nb_nodes = NB_NODES(hub_info); + int m_width = M_WIDTH(hub_info); + + LOG_DEBUG("SLD HUB Configuration register"); + LOG_DEBUG("------------------------------"); + LOG_DEBUG("m_width = %d", m_width); + LOG_DEBUG("manufacturer_id = 0x%02x", MANUF(hub_info)); + LOG_DEBUG("nb_of_node = %d", nb_nodes); + LOG_DEBUG("version = %d", VER(hub_info)); + LOG_DEBUG("VIR length = %d", guess_addr_width(nb_nodes) + m_width); + + /* Because the number of SLD nodes is now known, the Nodes on the hub can be + * enumerated by repeating the 8 four-bit nibble scans, once for each Node, + * to yield the SLD_NODE_INFO register of each Node. The DR nibble shifts + * are a continuation of the HUB_INFO DR shift used to shift out the Hub IP + * Configuration register. + * + * The order of the Nodes as they are shifted out determines the ADDR + * values for the Nodes, beginning with, for the first Node SLD_NODE_INFO + * shifted out, up to and including, for the last node on the hub. The + * tables below show the SLD_NODE_INFO register and a their functional descriptions. + * + * --------------+-----------+---------------+---------------- + * 31 27 | 26 19 | 18 8 | 7 0 + * --------------+-----------+---------------+---------------- + * Node Version | NODE ID | NODE MFG_ID | NODE INST ID + * + */ + + int vjtag_node_address = -1; + int node_index; + uint32_t node_info = 0; + for (node_index = 0; node_index < nb_nodes; node_index++) { + + for (int i = 0; i < 8; i++) { + field.num_bits = 4; + field.out_value = NULL; + field.in_value = &nibble; + jtag_add_dr_scan(tap, 1, &field, TAP_IDLE); + retval = jtag_execute_queue(); + if (retval != ERROR_OK) + return retval; + node_info = ((node_info >> 4) | ((nibble & 0xf) << 28)); + } + + LOG_DEBUG("Node info register"); + LOG_DEBUG("--------------------"); + LOG_DEBUG("instance_id = %d", ID(node_info)); + LOG_DEBUG("manufacturer_id = 0x%02x", MANUF(node_info)); + LOG_DEBUG("node_id = %d (%s)", ID(node_info), + id_to_string(ID(node_info))); + LOG_DEBUG("version = %d", VER(node_info)); + + if (ID(node_info) == VJTAG_NODE_ID) + vjtag_node_address = node_index + 1; + } + + if (vjtag_node_address < 0) { + LOG_ERROR("No VJTAG TAP instance found !"); + return ERROR_FAIL; + } + + /* Select VIR */ + t[0] = ALTERA_CYCLONE_CMD_USER1; + field.num_bits = tap->ir_length; + field.out_value = t; + field.in_value = NULL; + jtag_add_ir_scan(tap, &field, TAP_IDLE); + + /* Send the DEBUG command to the VJTAG IR */ + buf_set_u32(t, 0, field.num_bits, (vjtag_node_address << m_width) | ALT_VJTAG_CMD_DEBUG); + field.num_bits = guess_addr_width(nb_nodes) + m_width; + field.out_value = t; + field.in_value = NULL; + jtag_add_dr_scan(tap, 1, &field, TAP_IDLE); + + /* Select the VJTAG DR */ + t[0] = ALTERA_CYCLONE_CMD_USER0; + field.num_bits = tap->ir_length; + field.out_value = t; + field.in_value = NULL; + jtag_add_ir_scan(tap, &field, TAP_IDLE); + + return jtag_execute_queue(); +} + +static struct or1k_tap_ip vjtag_tap = { + .name = "vjtag", + .init = or1k_tap_vjtag_init, +}; + +int or1k_tap_vjtag_register(void) +{ + list_add_tail(&vjtag_tap.list, &tap_list); + return 0; +} -- cgit v1.2.3-18-g5258