mirror of
git://projects.qi-hardware.com/nn-usb-fpga.git
synced 2025-01-09 14:10:15 +02:00
107 lines
3.0 KiB
C++
107 lines
3.0 KiB
C++
|
/* JTAG routines
|
||
|
|
|
||
|
|
Copyright (C) 2004 Andrew Rogers
|
||
|
|
|
||
|
|
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 */
|
||
|
|
|
||
|
|
#include "jtag.h"
|
||
|
|
|
||
|
|
Jtag::Jtag(IOBase *iob)
|
||
|
|
{
|
||
|
|
io=iob;
|
||
|
|
postDRState=IOBase::RUN_TEST_IDLE;
|
||
|
|
postIRState=IOBase::RUN_TEST_IDLE;
|
||
|
|
deviceIndex=-1;
|
||
|
|
shiftDRincomplete=false;
|
||
|
|
}
|
||
|
|
|
||
|
|
int Jtag::getChain()
|
||
|
|
{
|
||
|
|
io->tapTestLogicReset();
|
||
|
|
io->setTapState(IOBase::SHIFT_DR);
|
||
|
|
byte idx[4];
|
||
|
|
byte zero[4];
|
||
|
|
numDevices=0;
|
||
|
|
for(int i=0; i<4; i++)zero[i]=0;
|
||
|
|
do{
|
||
|
|
io->shiftTDITDO(zero,idx,32,false);
|
||
|
|
unsigned long id=byteArrayToLong(idx);
|
||
|
|
if(id!=0){
|
||
|
|
numDevices++;
|
||
|
|
chainParam_t dev;
|
||
|
|
dev.idcode=id;
|
||
|
|
printf("Device with ID=%x found\n", id);
|
||
|
|
devices.insert(devices.begin(),dev);
|
||
|
|
}
|
||
|
|
else break;
|
||
|
|
}while(numDevices<MAXNUMDEVICES);
|
||
|
|
io->setTapState(IOBase::TEST_LOGIC_RESET);
|
||
|
|
return numDevices;
|
||
|
|
}
|
||
|
|
|
||
|
|
int Jtag::selectDevice(int dev)
|
||
|
|
{
|
||
|
|
if(dev>=numDevices)deviceIndex=-1;
|
||
|
|
else deviceIndex=dev;
|
||
|
|
return deviceIndex;
|
||
|
|
}
|
||
|
|
|
||
|
|
int Jtag::setDeviceIRLength(int dev, int len)
|
||
|
|
{
|
||
|
|
if(dev>=numDevices||dev<0)return -1;
|
||
|
|
devices[dev].irlen=len;
|
||
|
|
return dev;
|
||
|
|
}
|
||
|
|
|
||
|
|
void Jtag::shiftDR(const byte *tdi, byte *tdo, int length, int align, bool exit)
|
||
|
|
{
|
||
|
|
if(deviceIndex<0)return;
|
||
|
|
int post=deviceIndex;
|
||
|
|
if(!shiftDRincomplete){
|
||
|
|
io->setTapState(IOBase::SHIFT_DR);
|
||
|
|
int pre=numDevices-deviceIndex-1;
|
||
|
|
if(align){
|
||
|
|
pre=-post;
|
||
|
|
while(pre<=0)pre+=align;
|
||
|
|
}
|
||
|
|
io->shift(false,pre,false);
|
||
|
|
}
|
||
|
|
if(tdi!=0&&tdo!=0)io->shiftTDITDO(tdi,tdo,length,post==0&&exit);
|
||
|
|
else if(tdi!=0&&tdo==0)io->shiftTDI(tdi,length,post==0&&exit);
|
||
|
|
else if(tdi==0&&tdo!=0)io->shiftTDO(tdo,length,post==0&&exit);
|
||
|
|
else io->shift(false,length,post==0&&exit);
|
||
|
|
if(exit){
|
||
|
|
io->shift(false,post);
|
||
|
|
io->setTapState(postDRState);
|
||
|
|
shiftDRincomplete=false;
|
||
|
|
}
|
||
|
|
else shiftDRincomplete=true;
|
||
|
|
}
|
||
|
|
|
||
|
|
void Jtag::shiftIR(const byte *tdi, byte *tdo)
|
||
|
|
{
|
||
|
|
if(deviceIndex<0)return;
|
||
|
|
io->setTapState(IOBase::SHIFT_IR);
|
||
|
|
int pre=0;
|
||
|
|
for(int dev=deviceIndex+1; dev<numDevices; dev++)pre+=devices[dev].irlen; // Calculate number of pre BYPASS bits.
|
||
|
|
int post=0;
|
||
|
|
for(int dev=0; dev<deviceIndex; dev++)post+=devices[dev].irlen; // Calculate number of post BYPASS bits.
|
||
|
|
io->shift(true,pre,false);
|
||
|
|
if(tdo!=0)io->shiftTDITDO(tdi,tdo,devices[deviceIndex].irlen,post==0);
|
||
|
|
else if(tdo==0)io->shiftTDI(tdi,devices[deviceIndex].irlen,post==0);
|
||
|
|
io->shift(true,post);
|
||
|
|
io->setTapState(postIRState);
|
||
|
|
}
|