mirror of https://github.com/rusefi/openocd.git
Set svn:eol-style native on ZY1000 minidriver header file.
git-svn-id: svn://svn.berlios.de/openocd/trunk@2261 b42882b7-edfa-0310-969c-e2dbd0fdcd60
This commit is contained in:
parent
2d0afa36a8
commit
e2cacd4368
|
@ -1,210 +1,210 @@
|
||||||
/***************************************************************************
|
/***************************************************************************
|
||||||
* Copyright (C) 2007-2008 by Øyvind Harboe *
|
* Copyright (C) 2007-2008 by Øyvind Harboe *
|
||||||
* *
|
* *
|
||||||
* This program is free software; you can redistribute it and/or modify *
|
* 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 *
|
* it under the terms of the GNU General Public License as published by *
|
||||||
* the Free Software Foundation; either version 2 of the License, or *
|
* the Free Software Foundation; either version 2 of the License, or *
|
||||||
* (at your option) any later version. *
|
* (at your option) any later version. *
|
||||||
* *
|
* *
|
||||||
* This program is distributed in the hope that it will be useful, *
|
* This program is distributed in the hope that it will be useful, *
|
||||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
|
||||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
|
||||||
* GNU General Public License for more details. *
|
* GNU General Public License for more details. *
|
||||||
* *
|
* *
|
||||||
* You should have received a copy of the GNU General Public License *
|
* You should have received a copy of the GNU General Public License *
|
||||||
* along with this program; if not, write to the *
|
* along with this program; if not, write to the *
|
||||||
* Free Software Foundation, Inc., *
|
* Free Software Foundation, Inc., *
|
||||||
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
|
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
|
||||||
***************************************************************************/
|
***************************************************************************/
|
||||||
|
|
||||||
#include <cyg/hal/hal_io.h> // low level i/o
|
#include <cyg/hal/hal_io.h> // low level i/o
|
||||||
|
|
||||||
//#define VERBOSE(a) a
|
//#define VERBOSE(a) a
|
||||||
#define VERBOSE(a)
|
#define VERBOSE(a)
|
||||||
|
|
||||||
/* used to test manual mode */
|
/* used to test manual mode */
|
||||||
#define TEST_MANUAL() 0
|
#define TEST_MANUAL() 0
|
||||||
|
|
||||||
#if 0
|
#if 0
|
||||||
int diag_printf( const char *fmt, ... );
|
int diag_printf( const char *fmt, ... );
|
||||||
#define ZY1000_POKE(a, b) HAL_WRITE_UINT32(a, b); diag_printf("poke 0x%08x,0x%08x\n", a, b)
|
#define ZY1000_POKE(a, b) HAL_WRITE_UINT32(a, b); diag_printf("poke 0x%08x,0x%08x\n", a, b)
|
||||||
#define ZY1000_PEEK(a, b) HAL_READ_UINT32(a, b); diag_printf("peek 0x%08x=0x%08x\n", a, b)
|
#define ZY1000_PEEK(a, b) HAL_READ_UINT32(a, b); diag_printf("peek 0x%08x=0x%08x\n", a, b)
|
||||||
#else
|
#else
|
||||||
#define ZY1000_POKE(a, b) HAL_WRITE_UINT32(a, b)
|
#define ZY1000_POKE(a, b) HAL_WRITE_UINT32(a, b)
|
||||||
#define ZY1000_PEEK(a, b) HAL_READ_UINT32(a, b)
|
#define ZY1000_PEEK(a, b) HAL_READ_UINT32(a, b)
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
// FIFO empty?
|
// FIFO empty?
|
||||||
static __inline__ void waitIdle(void)
|
static __inline__ void waitIdle(void)
|
||||||
{
|
{
|
||||||
cyg_uint32 empty;
|
cyg_uint32 empty;
|
||||||
do
|
do
|
||||||
{
|
{
|
||||||
ZY1000_PEEK(ZY1000_JTAG_BASE+0x10, empty);
|
ZY1000_PEEK(ZY1000_JTAG_BASE+0x10, empty);
|
||||||
} while ((empty & 0x100)==0);
|
} while ((empty & 0x100)==0);
|
||||||
}
|
}
|
||||||
|
|
||||||
static __inline__ void waitQueue(void)
|
static __inline__ void waitQueue(void)
|
||||||
{
|
{
|
||||||
// waitIdle();
|
// waitIdle();
|
||||||
}
|
}
|
||||||
|
|
||||||
static void sampleShiftRegister(void)
|
static void sampleShiftRegister(void)
|
||||||
{
|
{
|
||||||
#if 0
|
#if 0
|
||||||
cyg_uint32 dummy;
|
cyg_uint32 dummy;
|
||||||
waitIdle();
|
waitIdle();
|
||||||
ZY1000_PEEK(ZY1000_JTAG_BASE+0xc, dummy);
|
ZY1000_PEEK(ZY1000_JTAG_BASE+0xc, dummy);
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
/* -O3 will inline this for us */
|
/* -O3 will inline this for us */
|
||||||
static void setCurrentState(enum tap_state state)
|
static void setCurrentState(enum tap_state state)
|
||||||
{
|
{
|
||||||
cyg_uint32 a;
|
cyg_uint32 a;
|
||||||
a=state;
|
a=state;
|
||||||
int repeat=0;
|
int repeat=0;
|
||||||
if (state==TAP_RESET)
|
if (state==TAP_RESET)
|
||||||
{
|
{
|
||||||
// The FPGA nor we know the current state of the CPU TAP
|
// The FPGA nor we know the current state of the CPU TAP
|
||||||
// controller. This will move it to TAP for sure.
|
// controller. This will move it to TAP for sure.
|
||||||
//
|
//
|
||||||
// 5 should be enough here, 7 is what OpenOCD uses
|
// 5 should be enough here, 7 is what OpenOCD uses
|
||||||
repeat=7;
|
repeat=7;
|
||||||
}
|
}
|
||||||
waitQueue();
|
waitQueue();
|
||||||
sampleShiftRegister();
|
sampleShiftRegister();
|
||||||
ZY1000_POKE(ZY1000_JTAG_BASE+0x8, (repeat<<8)|(a<<4)|a);
|
ZY1000_POKE(ZY1000_JTAG_BASE+0x8, (repeat<<8)|(a<<4)|a);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Enter state and cause repeat transitions *out* of that state. So if the endState!=state, then
|
* Enter state and cause repeat transitions *out* of that state. So if the endState!=state, then
|
||||||
* the transition from state to endState counts as a transition out of state.
|
* the transition from state to endState counts as a transition out of state.
|
||||||
*/
|
*/
|
||||||
static __inline__ void shiftValueInner(const enum tap_state state, const enum tap_state endState, int repeat, cyg_uint32 value)
|
static __inline__ void shiftValueInner(const enum tap_state state, const enum tap_state endState, int repeat, cyg_uint32 value)
|
||||||
{
|
{
|
||||||
cyg_uint32 a,b;
|
cyg_uint32 a,b;
|
||||||
a=state;
|
a=state;
|
||||||
b=endState;
|
b=endState;
|
||||||
waitQueue();
|
waitQueue();
|
||||||
sampleShiftRegister();
|
sampleShiftRegister();
|
||||||
ZY1000_POKE(ZY1000_JTAG_BASE+0xc, value);
|
ZY1000_POKE(ZY1000_JTAG_BASE+0xc, value);
|
||||||
#if 1
|
#if 1
|
||||||
#if TEST_MANUAL()
|
#if TEST_MANUAL()
|
||||||
if ((state==TAP_DRSHIFT)&&(endState!=TAP_DRSHIFT))
|
if ((state==TAP_DRSHIFT)&&(endState!=TAP_DRSHIFT))
|
||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
setCurrentState(state);
|
setCurrentState(state);
|
||||||
for (i=0; i<repeat; i++)
|
for (i=0; i<repeat; i++)
|
||||||
{
|
{
|
||||||
int tms;
|
int tms;
|
||||||
tms=0;
|
tms=0;
|
||||||
if ((i==repeat-1)&&(state!=endState))
|
if ((i==repeat-1)&&(state!=endState))
|
||||||
{
|
{
|
||||||
tms=1;
|
tms=1;
|
||||||
}
|
}
|
||||||
/* shift out value */
|
/* shift out value */
|
||||||
waitIdle();
|
waitIdle();
|
||||||
ZY1000_POKE(ZY1000_JTAG_BASE+0x28, (((value>>i)&1)<<1)|tms);
|
ZY1000_POKE(ZY1000_JTAG_BASE+0x28, (((value>>i)&1)<<1)|tms);
|
||||||
}
|
}
|
||||||
waitIdle();
|
waitIdle();
|
||||||
ZY1000_POKE(ZY1000_JTAG_BASE+0x28, 0);
|
ZY1000_POKE(ZY1000_JTAG_BASE+0x28, 0);
|
||||||
waitIdle();
|
waitIdle();
|
||||||
//ZY1000_POKE(ZY1000_JTAG_BASE+0x20, TAP_DRSHIFT); // set this state and things break => expected
|
//ZY1000_POKE(ZY1000_JTAG_BASE+0x20, TAP_DRSHIFT); // set this state and things break => expected
|
||||||
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.
|
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.
|
||||||
setCurrentState(endState);
|
setCurrentState(endState);
|
||||||
} else
|
} else
|
||||||
{
|
{
|
||||||
ZY1000_POKE(ZY1000_JTAG_BASE+0x8, (repeat<<8)|(a<<4)|b);
|
ZY1000_POKE(ZY1000_JTAG_BASE+0x8, (repeat<<8)|(a<<4)|b);
|
||||||
}
|
}
|
||||||
#else
|
#else
|
||||||
/* fast version */
|
/* fast version */
|
||||||
ZY1000_POKE(ZY1000_JTAG_BASE+0x8, (repeat<<8)|(a<<4)|b);
|
ZY1000_POKE(ZY1000_JTAG_BASE+0x8, (repeat<<8)|(a<<4)|b);
|
||||||
#endif
|
#endif
|
||||||
#else
|
#else
|
||||||
/* maximum debug version */
|
/* maximum debug version */
|
||||||
if ((repeat>0)&&((state==TAP_DRSHIFT)||(state==TAP_SI)))
|
if ((repeat>0)&&((state==TAP_DRSHIFT)||(state==TAP_SI)))
|
||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
/* sample shift register for every bit. */
|
/* sample shift register for every bit. */
|
||||||
for (i=0; i<repeat-1; i++)
|
for (i=0; i<repeat-1; i++)
|
||||||
{
|
{
|
||||||
sampleShiftRegister();
|
sampleShiftRegister();
|
||||||
ZY1000_POKE(ZY1000_JTAG_BASE+0xc, value>>i);
|
ZY1000_POKE(ZY1000_JTAG_BASE+0xc, value>>i);
|
||||||
ZY1000_POKE(ZY1000_JTAG_BASE+0x8, (1<<8)|(a<<4)|a);
|
ZY1000_POKE(ZY1000_JTAG_BASE+0x8, (1<<8)|(a<<4)|a);
|
||||||
}
|
}
|
||||||
sampleShiftRegister();
|
sampleShiftRegister();
|
||||||
ZY1000_POKE(ZY1000_JTAG_BASE+0xc, value>>(repeat-1));
|
ZY1000_POKE(ZY1000_JTAG_BASE+0xc, value>>(repeat-1));
|
||||||
ZY1000_POKE(ZY1000_JTAG_BASE+0x8, (1<<8)|(a<<4)|b);
|
ZY1000_POKE(ZY1000_JTAG_BASE+0x8, (1<<8)|(a<<4)|b);
|
||||||
} else
|
} else
|
||||||
{
|
{
|
||||||
sampleShiftRegister();
|
sampleShiftRegister();
|
||||||
ZY1000_POKE(ZY1000_JTAG_BASE+0x8, (repeat<<8)|(a<<4)|b);
|
ZY1000_POKE(ZY1000_JTAG_BASE+0x8, (repeat<<8)|(a<<4)|b);
|
||||||
}
|
}
|
||||||
sampleShiftRegister();
|
sampleShiftRegister();
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
static __inline__ void interface_jtag_add_dr_out_core(jtag_tap_t *target_tap,
|
static __inline__ void interface_jtag_add_dr_out_core(jtag_tap_t *target_tap,
|
||||||
int num_fields,
|
int num_fields,
|
||||||
const int *num_bits,
|
const int *num_bits,
|
||||||
const u32 *value,
|
const u32 *value,
|
||||||
enum tap_state end_state)
|
enum tap_state end_state)
|
||||||
{
|
{
|
||||||
enum tap_state pause_state = TAP_DRSHIFT;
|
enum tap_state pause_state = TAP_DRSHIFT;
|
||||||
|
|
||||||
jtag_tap_t *tap, *nextTap;
|
jtag_tap_t *tap, *nextTap;
|
||||||
for(tap = jtag_tap_next_enabled(NULL); tap!= NULL; tap=nextTap)
|
for(tap = jtag_tap_next_enabled(NULL); tap!= NULL; tap=nextTap)
|
||||||
{
|
{
|
||||||
nextTap=jtag_tap_next_enabled(tap);
|
nextTap=jtag_tap_next_enabled(tap);
|
||||||
if (nextTap==NULL)
|
if (nextTap==NULL)
|
||||||
{
|
{
|
||||||
pause_state = end_state;
|
pause_state = end_state;
|
||||||
}
|
}
|
||||||
if (tap == target_tap)
|
if (tap == target_tap)
|
||||||
{
|
{
|
||||||
int j;
|
int j;
|
||||||
for (j=0; j<(num_fields-1); j++)
|
for (j=0; j<(num_fields-1); j++)
|
||||||
{
|
{
|
||||||
shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, num_bits[j], value[j]);
|
shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, num_bits[j], value[j]);
|
||||||
}
|
}
|
||||||
shiftValueInner(TAP_DRSHIFT, pause_state, num_bits[j], value[j]);
|
shiftValueInner(TAP_DRSHIFT, pause_state, num_bits[j], value[j]);
|
||||||
} else
|
} else
|
||||||
{
|
{
|
||||||
/* program the scan field to 1 bit length, and ignore it's value */
|
/* program the scan field to 1 bit length, and ignore it's value */
|
||||||
shiftValueInner(TAP_DRSHIFT, pause_state, 1, 0);
|
shiftValueInner(TAP_DRSHIFT, pause_state, 1, 0);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static __inline__ void interface_jtag_add_dr_out(jtag_tap_t *target_tap,
|
static __inline__ void interface_jtag_add_dr_out(jtag_tap_t *target_tap,
|
||||||
int num_fields,
|
int num_fields,
|
||||||
const int *num_bits,
|
const int *num_bits,
|
||||||
const u32 *value,
|
const u32 *value,
|
||||||
enum tap_state end_state)
|
enum tap_state end_state)
|
||||||
{
|
{
|
||||||
|
|
||||||
int singletap=(jtag_tap_next_enabled(jtag_tap_next_enabled(NULL))==NULL);
|
int singletap=(jtag_tap_next_enabled(jtag_tap_next_enabled(NULL))==NULL);
|
||||||
if ((singletap)&&(num_fields==3))
|
if ((singletap)&&(num_fields==3))
|
||||||
{
|
{
|
||||||
/* used by embeddedice_write_reg_inner() */
|
/* used by embeddedice_write_reg_inner() */
|
||||||
shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, num_bits[0], value[0]);
|
shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, num_bits[0], value[0]);
|
||||||
shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, num_bits[1], value[1]);
|
shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, num_bits[1], value[1]);
|
||||||
shiftValueInner(TAP_DRSHIFT, end_state, num_bits[2], value[2]);
|
shiftValueInner(TAP_DRSHIFT, end_state, num_bits[2], value[2]);
|
||||||
} else if ((singletap)&&(num_fields==2))
|
} else if ((singletap)&&(num_fields==2))
|
||||||
{
|
{
|
||||||
/* used by arm7 code */
|
/* used by arm7 code */
|
||||||
shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, num_bits[0], value[0]);
|
shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, num_bits[0], value[0]);
|
||||||
shiftValueInner(TAP_DRSHIFT, end_state, num_bits[1], value[1]);
|
shiftValueInner(TAP_DRSHIFT, end_state, num_bits[1], value[1]);
|
||||||
} else
|
} else
|
||||||
{
|
{
|
||||||
interface_jtag_add_dr_out_core(target_tap, num_fields, num_bits, value, end_state);
|
interface_jtag_add_dr_out_core(target_tap, num_fields, num_bits, value, end_state);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
#define interface_jtag_add_callback(callback, in) callback(in)
|
#define interface_jtag_add_callback(callback, in) callback(in)
|
||||||
|
|
||||||
#define interface_jtag_add_callback4(callback, in, data1, data2, data3) jtag_set_error(callback(in, data1, data2, data3))
|
#define interface_jtag_add_callback4(callback, in, data1, data2, data3) jtag_set_error(callback(in, data1, data2, data3))
|
||||||
|
|
Loading…
Reference in New Issue