parent
22a40b0a88
commit
9a2dd74032
@ -0,0 +1,217 @@ |
||||
/*
|
||||
* (C) Copyright 2003 |
||||
* Stefan Roese, esd gmbh germany, stefan.roese@esd-electronics.com |
||||
* |
||||
* See file CREDITS for list of people who contributed to this |
||||
* project. |
||||
* |
||||
* 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 |
||||
*/ |
||||
|
||||
/*******************************************************/ |
||||
/* file: lenval.c */ |
||||
/* abstract: This file contains routines for using */ |
||||
/* the lenVal data structure. */ |
||||
/*******************************************************/ |
||||
|
||||
#include <common.h> |
||||
#include <asm/processor.h> |
||||
|
||||
#include "lenval.h" |
||||
#include "ports.h" |
||||
|
||||
|
||||
/*****************************************************************************
|
||||
* Function: value |
||||
* Description: Extract the long value from the lenval array. |
||||
* Parameters: plvValue - ptr to lenval. |
||||
* Returns: long - the extracted value. |
||||
*****************************************************************************/ |
||||
long value( lenVal* plvValue ) |
||||
{ |
||||
long lValue; /* result to hold the accumulated result */ |
||||
short sIndex; |
||||
|
||||
lValue = 0; |
||||
for ( sIndex = 0; sIndex < plvValue->len ; ++sIndex ) |
||||
{ |
||||
lValue <<= 8; /* shift the accumulated result */ |
||||
lValue |= plvValue->val[ sIndex]; /* get the last byte first */ |
||||
} |
||||
|
||||
return( lValue ); |
||||
} |
||||
|
||||
/*****************************************************************************
|
||||
* Function: initLenVal |
||||
* Description: Initialize the lenval array with the given value. |
||||
* Assumes lValue is less than 256. |
||||
* Parameters: plv - ptr to lenval. |
||||
* lValue - the value to set. |
||||
* Returns: void. |
||||
*****************************************************************************/ |
||||
void initLenVal( lenVal* plv, |
||||
long lValue ) |
||||
{ |
||||
plv->len = 1; |
||||
plv->val[0] = (unsigned char)lValue; |
||||
} |
||||
|
||||
/*****************************************************************************
|
||||
* Function: EqualLenVal |
||||
* Description: Compare two lenval arrays with an optional mask. |
||||
* Parameters: plvTdoExpected - ptr to lenval #1. |
||||
* plvTdoCaptured - ptr to lenval #2. |
||||
* plvTdoMask - optional ptr to mask (=0 if no mask). |
||||
* Returns: short - 0 = mismatch; 1 = equal. |
||||
*****************************************************************************/ |
||||
short EqualLenVal( lenVal* plvTdoExpected, |
||||
lenVal* plvTdoCaptured, |
||||
lenVal* plvTdoMask ) |
||||
{ |
||||
short sEqual; |
||||
short sIndex; |
||||
unsigned char ucByteVal1; |
||||
unsigned char ucByteVal2; |
||||
unsigned char ucByteMask; |
||||
|
||||
sEqual = 1; |
||||
sIndex = plvTdoExpected->len; |
||||
|
||||
while ( sEqual && sIndex-- ) |
||||
{ |
||||
ucByteVal1 = plvTdoExpected->val[ sIndex ]; |
||||
ucByteVal2 = plvTdoCaptured->val[ sIndex ]; |
||||
if ( plvTdoMask ) |
||||
{ |
||||
ucByteMask = plvTdoMask->val[ sIndex ]; |
||||
ucByteVal1 &= ucByteMask; |
||||
ucByteVal2 &= ucByteMask; |
||||
} |
||||
if ( ucByteVal1 != ucByteVal2 ) |
||||
{ |
||||
sEqual = 0; |
||||
} |
||||
} |
||||
|
||||
return( sEqual ); |
||||
} |
||||
|
||||
|
||||
/*****************************************************************************
|
||||
* Function: RetBit |
||||
* Description: return the (byte, bit) of lv (reading from left to right). |
||||
* Parameters: plv - ptr to lenval. |
||||
* iByte - the byte to get the bit from. |
||||
* iBit - the bit number (0=msb) |
||||
* Returns: short - the bit value. |
||||
*****************************************************************************/ |
||||
short RetBit( lenVal* plv, |
||||
int iByte, |
||||
int iBit ) |
||||
{ |
||||
/* assert( ( iByte >= 0 ) && ( iByte < plv->len ) ); */ |
||||
/* assert( ( iBit >= 0 ) && ( iBit < 8 ) ); */ |
||||
return( (short)( ( plv->val[ iByte ] >> ( 7 - iBit ) ) & 0x1 ) ); |
||||
} |
||||
|
||||
/*****************************************************************************
|
||||
* Function: SetBit |
||||
* Description: set the (byte, bit) of lv equal to val |
||||
* Example: SetBit("00000000",byte, 1) equals "01000000". |
||||
* Parameters: plv - ptr to lenval. |
||||
* iByte - the byte to get the bit from. |
||||
* iBit - the bit number (0=msb). |
||||
* sVal - the bit value to set. |
||||
* Returns: void. |
||||
*****************************************************************************/ |
||||
void SetBit( lenVal* plv, |
||||
int iByte, |
||||
int iBit, |
||||
short sVal ) |
||||
{ |
||||
unsigned char ucByteVal; |
||||
unsigned char ucBitMask; |
||||
|
||||
ucBitMask = (unsigned char)(1 << ( 7 - iBit )); |
||||
ucByteVal = (unsigned char)(plv->val[ iByte ] & (~ucBitMask)); |
||||
|
||||
if ( sVal ) |
||||
{ |
||||
ucByteVal |= ucBitMask; |
||||
} |
||||
plv->val[ iByte ] = ucByteVal; |
||||
} |
||||
|
||||
/*****************************************************************************
|
||||
* Function: AddVal |
||||
* Description: add val1 to val2 and store in resVal; |
||||
* assumes val1 and val2 are of equal length. |
||||
* Parameters: plvResVal - ptr to result. |
||||
* plvVal1 - ptr of addendum. |
||||
* plvVal2 - ptr of addendum. |
||||
* Returns: void. |
||||
*****************************************************************************/ |
||||
void addVal( lenVal* plvResVal, |
||||
lenVal* plvVal1, |
||||
lenVal* plvVal2 ) |
||||
{ |
||||
unsigned char ucCarry; |
||||
unsigned short usSum; |
||||
unsigned short usVal1; |
||||
unsigned short usVal2; |
||||
short sIndex; |
||||
|
||||
plvResVal->len = plvVal1->len; /* set up length of result */ |
||||
|
||||
/* start at least significant bit and add bytes */ |
||||
ucCarry = 0; |
||||
sIndex = plvVal1->len; |
||||
while ( sIndex-- ) |
||||
{ |
||||
usVal1 = plvVal1->val[ sIndex ]; /* i'th byte of val1 */ |
||||
usVal2 = plvVal2->val[ sIndex ]; /* i'th byte of val2 */ |
||||
|
||||
/* add the two bytes plus carry from previous addition */ |
||||
usSum = (unsigned short)( usVal1 + usVal2 + ucCarry ); |
||||
|
||||
/* set up carry for next byte */ |
||||
ucCarry = (unsigned char)( ( usSum > 255 ) ? 1 : 0 ); |
||||
|
||||
/* set the i'th byte of the result */ |
||||
plvResVal->val[ sIndex ] = (unsigned char)usSum; |
||||
} |
||||
} |
||||
|
||||
/*****************************************************************************
|
||||
* Function: readVal |
||||
* Description: read from XSVF numBytes bytes of data into x. |
||||
* Parameters: plv - ptr to lenval in which to put the bytes read. |
||||
* sNumBytes - the number of bytes to read. |
||||
* Returns: void. |
||||
*****************************************************************************/ |
||||
void readVal( lenVal* plv, |
||||
short sNumBytes ) |
||||
{ |
||||
unsigned char* pucVal; |
||||
|
||||
plv->len = sNumBytes; /* set the length of the lenVal */ |
||||
for ( pucVal = plv->val; sNumBytes; --sNumBytes, ++pucVal ) |
||||
{ |
||||
/* read a byte of data into the lenVal */ |
||||
readByte( pucVal ); |
||||
} |
||||
} |
@ -0,0 +1,79 @@ |
||||
/*
|
||||
* (C) Copyright 2003 |
||||
* Stefan Roese, esd gmbh germany, stefan.roese@esd-electronics.com |
||||
* |
||||
* See file CREDITS for list of people who contributed to this |
||||
* project. |
||||
* |
||||
* 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 |
||||
*/ |
||||
|
||||
/*******************************************************/ |
||||
/* file: lenval.h */ |
||||
/* abstract: This file contains a description of the */ |
||||
/* data structure "lenval". */ |
||||
/*******************************************************/ |
||||
|
||||
#ifndef lenval_dot_h |
||||
#define lenval_dot_h |
||||
|
||||
/* the lenVal structure is a byte oriented type used to store an */ |
||||
/* arbitrary length binary value. As an example, the hex value */ |
||||
/* 0x0e3d is represented as a lenVal with len=2 (since 2 bytes */ |
||||
/* and val[0]=0e and val[1]=3d. val[2-MAX_LEN] are undefined */ |
||||
|
||||
/* maximum length (in bytes) of value to read in */ |
||||
/* this needs to be at least 4, and longer than the */ |
||||
/* length of the longest SDR instruction. If there is, */ |
||||
/* only 1 device in the chain, MAX_LEN must be at least */ |
||||
/* ceil(27/8) == 4. For 6 devices in a chain, MAX_LEN */ |
||||
/* must be 5, for 14 devices MAX_LEN must be 6, for 20 */ |
||||
/* devices MAX_LEN must be 7, etc.. */ |
||||
/* You can safely set MAX_LEN to a smaller number if you*/ |
||||
/* know how many devices will be in your chain. */ |
||||
#define MAX_LEN 7000 |
||||
|
||||
|
||||
typedef struct var_len_byte |
||||
{ |
||||
short len; /* number of chars in this value */ |
||||
unsigned char val[MAX_LEN+1]; /* bytes of data */ |
||||
} lenVal; |
||||
|
||||
|
||||
/* return the long representation of a lenVal */ |
||||
extern long value(lenVal *x); |
||||
|
||||
/* set lenVal equal to value */ |
||||
extern void initLenVal(lenVal *x, long value); |
||||
|
||||
/* check if expected equals actual (taking the mask into account) */ |
||||
extern short EqualLenVal(lenVal *expected, lenVal *actual, lenVal *mask); |
||||
|
||||
/* add val1+val2 and put the result in resVal */ |
||||
extern void addVal(lenVal *resVal, lenVal *val1, lenVal *val2); |
||||
|
||||
/* return the (byte, bit) of lv (reading from left to right) */ |
||||
extern short RetBit(lenVal *lv, int byte, int bit); |
||||
|
||||
/* set the (byte, bit) of lv equal to val (e.g. SetBit("00000000",byte, 1)
|
||||
equals "01000000" */ |
||||
extern void SetBit(lenVal *lv, int byte, int bit, short val); |
||||
|
||||
/* read from XSVF numBytes bytes of data into x */ |
||||
extern void readVal(lenVal *x, short numBytes); |
||||
|
||||
#endif |
File diff suppressed because it is too large
Load Diff
@ -0,0 +1,64 @@ |
||||
/*
|
||||
* (C) Copyright 2003 |
||||
* Stefan Roese, esd gmbh germany, stefan.roese@esd-electronics.com |
||||
* |
||||
* See file CREDITS for list of people who contributed to this |
||||
* project. |
||||
* |
||||
* 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 |
||||
*/ |
||||
|
||||
/*****************************************************************************
|
||||
* File: micro.h |
||||
* Description: This header file contains the function prototype to the |
||||
* primary interface function for the XSVF player. |
||||
* Usage: FIRST - PORTS.C |
||||
* Customize the ports.c function implementations to establish |
||||
* the correct protocol for communicating with your JTAG ports |
||||
* (setPort() and readTDOBit()) and tune the waitTime() delay |
||||
* function. Also, establish access to the XSVF data source |
||||
* in the readByte() function. |
||||
* FINALLY - Call xsvfExecute(). |
||||
*****************************************************************************/ |
||||
#ifndef XSVF_MICRO_H |
||||
#define XSVF_MICRO_H |
||||
|
||||
/* Legacy error codes for xsvfExecute from original XSVF player v2.0 */ |
||||
#define XSVF_LEGACY_SUCCESS 1 |
||||
#define XSVF_LEGACY_ERROR 0 |
||||
|
||||
/* 4.04 [NEW] Error codes for xsvfExecute. */ |
||||
/* Must #define XSVF_SUPPORT_ERRORCODES in micro.c to get these codes */ |
||||
#define XSVF_ERROR_NONE 0 |
||||
#define XSVF_ERROR_UNKNOWN 1 |
||||
#define XSVF_ERROR_TDOMISMATCH 2 |
||||
#define XSVF_ERROR_MAXRETRIES 3 /* TDO mismatch after max retries */ |
||||
#define XSVF_ERROR_ILLEGALCMD 4 |
||||
#define XSVF_ERROR_ILLEGALSTATE 5 |
||||
#define XSVF_ERROR_DATAOVERFLOW 6 /* Data > lenVal MAX_LEN buffer size*/ |
||||
/* Insert new errors here */ |
||||
#define XSVF_ERROR_LAST 7 |
||||
|
||||
/*****************************************************************************
|
||||
* Function: xsvfExecute |
||||
* Description: Process, interpret, and apply the XSVF commands. |
||||
* See port.c:readByte for source of XSVF data. |
||||
* Parameters: none. |
||||
* Returns: int - For error codes see above. |
||||
*****************************************************************************/ |
||||
int xsvfExecute(void); |
||||
|
||||
#endif /* XSVF_MICRO_H */ |
@ -0,0 +1,116 @@ |
||||
/*
|
||||
* (C) Copyright 2003 |
||||
* Stefan Roese, esd gmbh germany, stefan.roese@esd-electronics.com |
||||
* |
||||
* See file CREDITS for list of people who contributed to this |
||||
* project. |
||||
* |
||||
* 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 |
||||
*/ |
||||
|
||||
/*******************************************************/ |
||||
/* file: ports.c */ |
||||
/* abstract: This file contains the routines to */ |
||||
/* output values on the JTAG ports, to read */ |
||||
/* the TDO bit, and to read a byte of data */ |
||||
/* from the prom */ |
||||
/* */ |
||||
/*******************************************************/ |
||||
|
||||
#include <common.h> |
||||
#include <asm/processor.h> |
||||
|
||||
#include "ports.h" |
||||
|
||||
static unsigned long output = 0; |
||||
static int filepos = 0; |
||||
static int oldstate = 0; |
||||
static int newstate = 0; |
||||
static int readptr = 0; |
||||
|
||||
extern long filesize; |
||||
extern const unsigned char fpgadata[]; |
||||
|
||||
|
||||
/* if in debugging mode, then just set the variables */ |
||||
void setPort(short p,short val) |
||||
{ |
||||
if (p==TMS) { |
||||
if (val) { |
||||
output |= JTAG_TMS; |
||||
} else { |
||||
output &= ~JTAG_TMS; |
||||
} |
||||
} |
||||
if (p==TDI) { |
||||
if (val) { |
||||
output |= JTAG_TDI; |
||||
} else { |
||||
output &= ~JTAG_TDI; |
||||
} |
||||
} |
||||
if (p==TCK) { |
||||
if (val) { |
||||
output |= JTAG_TCK; |
||||
} else { |
||||
output &= ~JTAG_TCK; |
||||
} |
||||
out32(GPIO0_OR, output); |
||||
} |
||||
} |
||||
|
||||
|
||||
/* toggle tck LH */ |
||||
void pulseClock(void) |
||||
{ |
||||
setPort(TCK,0); /* set the TCK port to low */ |
||||
setPort(TCK,1); /* set the TCK port to high */ |
||||
} |
||||
|
||||
|
||||
/* read in a byte of data from the prom */ |
||||
void readByte(unsigned char *data) |
||||
{ |
||||
/* pretend reading using a file */ |
||||
*data = fpgadata[readptr++]; |
||||
newstate = (100 * filepos++) / filesize; |
||||
if (newstate != oldstate) { |
||||
printf("%4d\r\r\r\r", newstate); |
||||
oldstate = newstate; |
||||
} |
||||
} |
||||
|
||||
/* read the TDO bit from port */ |
||||
unsigned char readTDOBit(void) |
||||
{ |
||||
unsigned long inputs; |
||||
|
||||
inputs = in32(GPIO0_IR); |
||||
if (inputs & JTAG_TDO) |
||||
return 1; |
||||
else |
||||
return 0; |
||||
} |
||||
|
||||
|
||||
/* Wait at least the specified number of microsec. */ |
||||
/* Use a timer if possible; otherwise estimate the number of instructions */ |
||||
/* necessary to be run based on the microcontroller speed. For this example */ |
||||
/* we pulse the TCK port a number of times based on the processor speed. */ |
||||
void waitTime(long microsec) |
||||
{ |
||||
udelay(microsec); /* esd */ |
||||
} |
@ -0,0 +1,62 @@ |
||||
/*
|
||||
* (C) Copyright 2003 |
||||
* Stefan Roese, esd gmbh germany, stefan.roese@esd-electronics.com |
||||
* |
||||
* See file CREDITS for list of people who contributed to this |
||||
* project. |
||||
* |
||||
* 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 |
||||
*/ |
||||
|
||||
/*******************************************************/ |
||||
/* file: ports.h */ |
||||
/* abstract: This file contains extern declarations */ |
||||
/* for providing stimulus to the JTAG ports.*/ |
||||
/*******************************************************/ |
||||
|
||||
#ifndef ports_dot_h |
||||
#define ports_dot_h |
||||
|
||||
/* these constants are used to send the appropriate ports to setPort */ |
||||
/* they should be enumerated types, but some of the microcontroller */ |
||||
/* compilers don't like enumerated types */ |
||||
#define TCK (short) 0 |
||||
#define TMS (short) 1 |
||||
#define TDI (short) 2 |
||||
|
||||
/*
|
||||
* Use CFG_FPGA_xxx defines from board include file. |
||||
*/ |
||||
#define JTAG_TMS CFG_FPGA_PRG /* output */ |
||||
#define JTAG_TCK CFG_FPGA_CLK /* output */ |
||||
#define JTAG_TDI CFG_FPGA_DATA /* output */ |
||||
#define JTAG_TDO CFG_FPGA_DONE /* input */ |
||||
|
||||
/* set the port "p" (TCK, TMS, or TDI) to val (0 or 1) */ |
||||
void setPort(short p, short val); |
||||
|
||||
/* read the TDO bit and store it in val */ |
||||
unsigned char readTDOBit(void); |
||||
|
||||
/* make clock go down->up->down*/ |
||||
void pulseClock(void); |
||||
|
||||
/* read the next byte of data from the xsvf file */ |
||||
void readByte(unsigned char *data); |
||||
|
||||
void waitTime(long microsec); |
||||
|
||||
#endif |
Loading…
Reference in new issue