debug.cpp

/* 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 

Changes:
Dmitry Teytelman [dimtey@gmail.com] 14 Jun 2006 [applied 13 Aug 2006]:
    Modified to support the changes in IOParport class.
*/



#include <stdio.h>

#include "iobase.h"
#include "ioparport.h"
#include "iodebug.h"

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()
{
  IODebug  io;

  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++)fprintf(stderr, "TDO %02x\n",tdo[i]);
}

void testPP()
{
  IOParport  io(0);

  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++)fprintf(stderr, "TDO %02x\n",tdo[i]);
  fprintf(stderr, "\n");
  getSwitches(&io);
  getID(&io);
}

void printBit1(bool val)
{
  if(val)fprintf(stderr, "|=| ");
  else fprintf(stderr, "| | ");
}

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++)fprintf(stderr, "TDO %02x\n",tdo[i]);
  fprintf(stderr, "\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);
  }
  fprintf(stderr, "\n");
  for(int i=0; i<8; i++){
    int bit=swi[i];
    bool val=(tdo[bit/8]>>(bit%8))&1;
    printBit1(!val);
  }
  fprintf(stderr, "\n\n");
}

void printBit(unsigned char *data, int bit)
{
  fprintf(stderr, "bit %d = %d\n",bit,(data[bit/8]>>(bit%8))&1);
}