mirror of
git://projects.qi-hardware.com/nn-usb-fpga.git
synced 2025-01-09 08:00:15 +02:00
120 lines
2.7 KiB
C++
120 lines
2.7 KiB
C++
|
/* JTAG debugging code
|
||
|
|
|
||
|
|
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 <asm/arch/pxa-regs.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
|
||
|
|
|
||
|
|
#include "iobase.h"
|
||
|
|
#include "at91XCProgramer.h"
|
||
|
|
#include "iodebug.h"
|
||
|
|
|
||
|
|
#define MEMDEV "/dev/mem"
|
||
|
|
#define CPLD_PHY_BASE PXA_CS2_PHYS
|
||
|
|
|
||
|
|
using namespace std;
|
||
|
|
|
||
|
|
void testPP();
|
||
|
|
void testDebug();
|
||
|
|
void printBit(unsigned char *data, int bit);
|
||
|
|
void getSwitches(IOBase *io);
|
||
|
|
void getID(IOBase *io);
|
||
|
|
|
||
|
|
int main(int argc, char**args)
|
||
|
|
{
|
||
|
|
testPP();
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
void testDebug()
|
||
|
|
{
|
||
|
|
IOBase *io;
|
||
|
|
io=new IODebug();
|
||
|
|
unsigned char tdi[]={0x3a,0xa3};
|
||
|
|
unsigned char tdo[10];
|
||
|
|
io->setTapState(IOBase::SHIFT_DR);
|
||
|
|
io->shiftTDITDO(tdi,tdo,16,false);
|
||
|
|
for(int i=0; i<2; i++)printf("TDO %02x\n",tdo[i]);
|
||
|
|
delete io;
|
||
|
|
}
|
||
|
|
|
||
|
|
void testPP()
|
||
|
|
{
|
||
|
|
IOBase *io;
|
||
|
|
io=new JTAGBus(MEMDEV,CPLD_PHY_BASE);
|
||
|
|
unsigned char tdi[]={0,0,0,0,0,0,0,0};
|
||
|
|
unsigned char tdo[100];
|
||
|
|
io->setTapState(IOBase::SHIFT_DR);
|
||
|
|
io->shiftTDITDO(tdi,tdo,64);
|
||
|
|
for(int i=0; i<8; i++)printf("TDO %02x\n",tdo[i]);
|
||
|
|
printf("\n");
|
||
|
|
getSwitches(io);
|
||
|
|
getID(io);
|
||
|
|
delete io;
|
||
|
|
}
|
||
|
|
|
||
|
|
void printBit1(bool val)
|
||
|
|
{
|
||
|
|
if(val)printf("|=| ");
|
||
|
|
else printf("| | ");
|
||
|
|
}
|
||
|
|
|
||
|
|
void getID(IOBase *io)
|
||
|
|
{
|
||
|
|
unsigned char tdo[100];
|
||
|
|
unsigned char tdi[]={0xfe,0x09};
|
||
|
|
io->setTapState(IOBase::SHIFT_IR);
|
||
|
|
io->shiftTDI(tdi,14);
|
||
|
|
io->setTapState(IOBase::RUN_TEST_IDLE);
|
||
|
|
io->setTapState(IOBase::SHIFT_DR);
|
||
|
|
io->shiftTDO(tdo,64);
|
||
|
|
for(int i=0; i<8; i++)printf("TDO %02x\n",tdo[i]);
|
||
|
|
printf("\n");
|
||
|
|
}
|
||
|
|
|
||
|
|
void getSwitches(IOBase *io)
|
||
|
|
{
|
||
|
|
unsigned char tdo[100];
|
||
|
|
unsigned char tdi[]={0xff,0x01};
|
||
|
|
io->setTapState(IOBase::SHIFT_IR);
|
||
|
|
io->shiftTDI(tdi,14);
|
||
|
|
io->setTapState(IOBase::SHIFT_DR);
|
||
|
|
io->shiftTDO(tdo,600);
|
||
|
|
int swi[]={506,509,518,521,539,536,557,569};
|
||
|
|
for(int i=0; i<8; i++){
|
||
|
|
int bit=swi[i];
|
||
|
|
bool val=(tdo[bit/8]>>(bit%8))&1;
|
||
|
|
printBit1(val);
|
||
|
|
}
|
||
|
|
printf("\n");
|
||
|
|
for(int i=0; i<8; i++){
|
||
|
|
int bit=swi[i];
|
||
|
|
bool val=(tdo[bit/8]>>(bit%8))&1;
|
||
|
|
printBit1(!val);
|
||
|
|
}
|
||
|
|
printf("\n\n");
|
||
|
|
}
|
||
|
|
|
||
|
|
void printBit(unsigned char *data, int bit)
|
||
|
|
{
|
||
|
|
printf("bit %d = %d\n",bit,(data[bit/8]>>(bit%8))&1);
|
||
|
|
}
|
||
|
|
|
||
|
|
|