mirror of
git://projects.qi-hardware.com/nn-usb-fpga.git
synced 2025-01-08 15:30:15 +02:00
a7c692d3f0
Adding FPGA sram hdl code and user space code Fixing some errors: LCD's pinout connector is swapped FPGA TDI SIGNAL must be routed to another pin (C14), right now is DQMH Remove R11 Check JZ4725 symbol's component (PORTD is wrong) Adding PB2 and PB3 wiring ADC's vref to external connector Adding power LED Adding CPU Led
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);
|
|
}
|