1 /***************************************************************************
2 * Copyright (C) 2007-2009 by Øyvind Harboe *
4 * This program is free software; you can redistribute it and/or modify *
5 * it under the terms of the GNU General Public License as published by *
6 * the Free Software Foundation; either version 2 of the License, or *
7 * (at your option) any later version. *
9 * This program is distributed in the hope that it will be useful, *
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
12 * GNU General Public License for more details. *
14 * You should have received a copy of the GNU General Public License *
15 * along with this program; if not, write to the *
16 * Free Software Foundation, Inc., *
17 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
18 ***************************************************************************/
20 #include <cyg/hal/hal_io.h> // low level i/o
21 #include <cyg/hal/hal_intr.h> // low level i/o
23 //#define VERBOSE(a) a
26 /* used to test manual mode */
27 #define TEST_MANUAL() 0
30 int diag_printf(const char *fmt, ...);
31 #define ZY1000_POKE(a, b) HAL_WRITE_UINT32(a, b); diag_printf("poke 0x%08x,0x%08x\n", a, b)
32 #define ZY1000_PEEK(a, b) HAL_READ_UINT32(a, b); diag_printf("peek 0x%08x = 0x%08x\n", a, b)
34 #define ZY1000_PEEK(a, b) HAL_READ_UINT32(a, b)
36 #ifdef CYGPKG_HAL_NIOS2
37 #define ZY1000_POKE(a, b) \
38 {/* This will flush the bridge FIFO. Overflowed bridge FIFO fails. We must \
39 flush every "often". No precise system has been found, but 4 seems solid. \
40 This code goes away once the FPGA has been fixed. */ \
42 CYG_INTERRUPT_STATE _old_; \
43 HAL_DISABLE_INTERRUPTS(_old_); \
44 HAL_WRITE_UINT32(a, b);\
45 static int overflow_counter = 0; \
46 if (++overflow_counter >= 1) \
49 cyg_uint32 empty; ZY1000_PEEK(ZY1000_JTAG_BASE + 0x10, empty); \
50 overflow_counter = 0; \
52 /* NB! interrupts must be restored *after* read */ \
53 HAL_RESTORE_INTERRUPTS(_old_); \
57 #define ZY1000_POKE(a, b) HAL_WRITE_UINT32(a, b)
63 static __inline__ void waitIdle(void)
68 ZY1000_PEEK(ZY1000_JTAG_BASE + 0x10, empty);
69 } while ((empty & 0x100) == 0);
72 static __inline__ void waitQueue(void)
77 static void sampleShiftRegister(void)
82 ZY1000_PEEK(ZY1000_JTAG_BASE + 0xc, dummy);
86 /* -O3 will inline this for us */
87 static void setCurrentState(enum tap_state state)
92 if (state == TAP_RESET)
94 // The FPGA nor we know the current state of the CPU TAP
95 // controller. This will move it to TAP for sure.
97 // 5 should be enough here, 7 is what OpenOCD uses
101 sampleShiftRegister();
102 ZY1000_POKE(ZY1000_JTAG_BASE + 0x8, (repeat << 8) | (a << 4) | a);
107 * Enter state and cause repeat transitions *out* of that state. So if the endState != state, then
108 * the transition from state to endState counts as a transition out of state.
110 static __inline__ void shiftValueInner(const enum tap_state state, const enum tap_state endState, int repeat, cyg_uint32 value)
116 sampleShiftRegister();
117 ZY1000_POKE(ZY1000_JTAG_BASE + 0xc, value);
120 if ((state == TAP_DRSHIFT) && (endState != TAP_DRSHIFT))
123 setCurrentState(state);
124 for (i = 0; i < repeat; i++)
128 if ((i == repeat-1) && (state != endState))
132 /* shift out value */
134 ZY1000_POKE(ZY1000_JTAG_BASE + 0x28, (((value >> i)&1) << 1) | tms);
137 ZY1000_POKE(ZY1000_JTAG_BASE + 0x28, 0);
139 //ZY1000_POKE(ZY1000_JTAG_BASE + 0x20, TAP_DRSHIFT); // set this state and things break => expected
140 ZY1000_POKE(ZY1000_JTAG_BASE + 0x20, TAP_DRPAUSE); // set this and things will work => expected. Not setting this is not sufficient to make things break.
141 setCurrentState(endState);
144 ZY1000_POKE(ZY1000_JTAG_BASE + 0x8, (repeat << 8) | (a << 4) | b);
148 ZY1000_POKE(ZY1000_JTAG_BASE + 0x8, (repeat << 8) | (a << 4) | b);
151 /* maximum debug version */
152 if ((repeat > 0) && ((state == TAP_DRSHIFT)||(state == TAP_SI)))
155 /* sample shift register for every bit. */
156 for (i = 0; i < repeat-1; i++)
158 sampleShiftRegister();
159 ZY1000_POKE(ZY1000_JTAG_BASE + 0xc, value >> i);
160 ZY1000_POKE(ZY1000_JTAG_BASE + 0x8, (1 << 8) | (a << 4) | a);
162 sampleShiftRegister();
163 ZY1000_POKE(ZY1000_JTAG_BASE + 0xc, value >> (repeat-1));
164 ZY1000_POKE(ZY1000_JTAG_BASE + 0x8, (1 << 8) | (a << 4) | b);
167 sampleShiftRegister();
168 ZY1000_POKE(ZY1000_JTAG_BASE + 0x8, (repeat << 8) | (a << 4) | b);
170 sampleShiftRegister();
176 static __inline__ void interface_jtag_add_dr_out_core(struct jtag_tap *target_tap,
179 const uint32_t *value,
180 enum tap_state end_state)
182 enum tap_state pause_state = TAP_DRSHIFT;
184 struct jtag_tap *tap, *nextTap;
185 for (tap = jtag_tap_next_enabled(NULL); tap!= NULL; tap = nextTap)
187 nextTap = jtag_tap_next_enabled(tap);
190 pause_state = end_state;
192 if (tap == target_tap)
195 for (j = 0; j < (num_fields-1); j++)
197 shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, num_bits[j], value[j]);
199 shiftValueInner(TAP_DRSHIFT, pause_state, num_bits[j], value[j]);
202 /* program the scan field to 1 bit length, and ignore it's value */
203 shiftValueInner(TAP_DRSHIFT, pause_state, 1, 0);
208 static __inline__ void interface_jtag_add_dr_out(struct jtag_tap *target_tap,
211 const uint32_t *value,
212 enum tap_state end_state)
215 int singletap = (jtag_tap_next_enabled(jtag_tap_next_enabled(NULL)) == NULL);
216 if ((singletap) && (num_fields == 3))
218 /* used by embeddedice_write_reg_inner() */
219 shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, num_bits[0], value[0]);
220 shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, num_bits[1], value[1]);
221 shiftValueInner(TAP_DRSHIFT, end_state, num_bits[2], value[2]);
222 } else if ((singletap) && (num_fields == 2))
224 /* used by arm7 code */
225 shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, num_bits[0], value[0]);
226 shiftValueInner(TAP_DRSHIFT, end_state, num_bits[1], value[1]);
229 interface_jtag_add_dr_out_core(target_tap, num_fields, num_bits, value, end_state);
233 #define interface_jtag_add_callback(callback, in) callback(in)
235 #define interface_jtag_add_callback4(callback, in, data1, data2, data3) jtag_set_error(callback(in, data1, data2, data3))