aboutsummaryrefslogtreecommitdiff
diff options
context:
space:
mode:
authoroharboe <oharboe@b42882b7-edfa-0310-969c-e2dbd0fdcd60>2009-01-07 07:08:02 +0000
committeroharboe <oharboe@b42882b7-edfa-0310-969c-e2dbd0fdcd60>2009-01-07 07:08:02 +0000
commit78d990e67891ec11850244ec30a526f264dbe26e (patch)
treea4c076249a3ae80ead01f841f50523f608cf21dc
parent6935e703c0f9b36eb29deef46f201c89bccfe46a (diff)
Dick Hollenbeck <dick@softplc.com> SVF to XSVF converter and the XSVF dumper
git-svn-id: svn://svn.berlios.de/openocd/trunk@1303 b42882b7-edfa-0310-969c-e2dbd0fdcd60
-rw-r--r--tools/xsvf_tools/svf2xsvf.py693
-rw-r--r--tools/xsvf_tools/xsvfdump.py255
2 files changed, 948 insertions, 0 deletions
diff --git a/tools/xsvf_tools/svf2xsvf.py b/tools/xsvf_tools/svf2xsvf.py
new file mode 100644
index 00000000..aeff587a
--- /dev/null
+++ b/tools/xsvf_tools/svf2xsvf.py
@@ -0,0 +1,693 @@
+#!/usr/bin/python3.0
+
+# Copyright 2008, SoftPLC Corporation http://softplc.com
+# Dick Hollenbeck dick@softplc.com
+
+
+# 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, you may find one here:
+# http://www.gnu.org/licenses/old-licenses/gpl-2.0.html
+# or you may search the http://www.gnu.org website for the version 2 license,
+# or you may write to the Free Software Foundation, Inc.,
+# 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA
+
+
+# A python program to convert an SVF file to an XSVF file. There is an
+# option to include comments containing the source file line number from the origin
+# SVF file before each outputted XSVF statement.
+#
+# We deviate from the XSVF spec in that we introduce a new command called
+# XWAITSTATE which directly flows from the SVF RUNTEST command. Unfortunately
+# XRUNSTATE was ill conceived and is not used here. We also add support for the
+# three Lattice extensions to SVF: LCOUNT, LDELAY, and LSDR. The xsvf file
+# generated from this program is suitable for use with the xsvf player in
+# OpenOCD with my modifications to xsvf.c.
+#
+# This program is written for python 3.0, and it is not easy to change this
+# back to 2.x. You may find it easier to use python 3.x even if that means
+# building it.
+
+
+import re
+import sys
+import struct
+
+
+# There are both ---<Lexer>--- and ---<Parser>--- sections to this program
+
+
+if len( sys.argv ) < 3:
+ print("usage %s <svf_filename> <xsvf_filename>" % sys.argv[0])
+ exit(1)
+
+
+inputFilename = sys.argv[1]
+outputFilename = sys.argv[2]
+
+doCOMMENTs = True # Save XCOMMENTs in the output xsvf file
+#doCOMMENTs = False # Save XCOMMENTs in the output xsvf file
+
+xrepeat = 0 # argument to XREPEAT, gives retry count for masked compares
+
+
+#-----< Lexer >---------------------------------------------------------------
+
+StateBin = (RESET,IDLE,
+ DRSELECT,DRCAPTURE,DRSHIFT,DREXIT1,DRPAUSE,DREXIT2,DRUPDATE,
+ IRSELECT,IRCAPTURE,IRSHIFT,IREXIT1,IRPAUSE,IREXIT2,IRUPDATE) = range(16)
+
+# Any integer index into this tuple will be equal to its corresponding StateBin value
+StateTxt = ("RESET","IDLE",
+ "DRSELECT","DRCAPTURE","DRSHIFT","DREXIT1","DRPAUSE","DREXIT2","DRUPDATE",
+ "IRSELECT","IRCAPTURE","IRSHIFT","IREXIT1","IRPAUSE","IREXIT2","IRUPDATE")
+
+
+(XCOMPLETE,XTDOMASK,XSIR,XSDR,XRUNTEST,hole0,hole1,XREPEAT,XSDRSIZE,XSDRTDO,
+ XSETSDRMASKS,XSDRINC,XSDRB,XSDRC,XSDRE,XSDRTDOB,XSDRTDOC,
+ XSDRTDOE,XSTATE,XENDIR,XENDDR,XSIR2,XCOMMENT,XWAIT,XWAITSTATE,LCOUNT,LDELAY,LSDR) = range(28)
+
+#Note: LCOUNT, LDELAY, and LSDR are Lattice extensions to SVF and provide a way to loop back
+# and check a completion status, essentially waiting on a part until it signals that it is done.
+# For example below: loop 25 times, each time through the loop do a LDELAY (same as a true RUNTEST)
+# and exit loop when LSDR compares match.
+"""
+LCOUNT 25;
+! Step to DRPAUSE give 5 clocks and wait for 1.00e+000 SEC.
+LDELAY DRPAUSE 5 TCK 1.00E-003 SEC;
+! Test for the completed status. Match means pass.
+! Loop back to LDELAY line if not match and loop count less than 25.
+LSDR 1 TDI (0)
+ TDO (1);
+"""
+
+LineNumber = 1
+
+def s_ident(scanner, token): return ("ident", token.upper(), LineNumber)
+
+def s_hex(scanner, token):
+ global LineNumber
+ LineNumber = LineNumber + token.count('\n')
+ token = ''.join(token.split())
+ return ("hex", token[1:-1], LineNumber)
+
+def s_int(scanner, token): return ("int", int(token), LineNumber)
+def s_float(scanner, token): return ("float", float(token), LineNumber)
+#def s_comment(scanner, token): return ("comment", token, LineNumber)
+def s_semicolon(scanner, token): return ("semi", token, LineNumber)
+
+def s_nl(scanner,token):
+ global LineNumber
+ LineNumber = LineNumber + 1
+ #print( 'LineNumber=', LineNumber, file=sys.stderr )
+ return None
+
+#2.00E-002
+
+scanner = re.Scanner([
+ (r"[a-zA-Z]\w*", s_ident),
+# (r"[-+]?[0-9]+[.]?[0-9]*([eE][-+]?[0-9]+)?", s_float),
+ (r"[-+]?[0-9]+(([.][0-9eE+-]*)|([eE]+[-+]?[0-9]+))", s_float),
+ (r"\d+", s_int),
+ (r"\(([0-9a-fA-F]|\s)*\)", s_hex),
+ (r"(!|//).*$", None),
+ (r";", s_semicolon),
+ (r"\n",s_nl),
+ (r"\s*", None),
+ ],
+ re.MULTILINE
+ )
+
+# read all svf file input into string "input"
+input = open( sys.argv[1] ).read()
+
+# Lexer:
+# create a list of tuples containing (tokenType, tokenValue, LineNumber)
+tokens = scanner.scan( input )[0]
+
+input = None # allow gc to reclaim memory holding file
+
+#for tokenType, tokenValue, ln in tokens: print( "line %d: %s" % (ln, tokenType), tokenValue )
+
+
+#-----<parser>-----------------------------------------------------------------
+
+tokVal = tokType = tokLn = None
+
+tup = iter( tokens )
+
+def nextTok():
+ """
+ Function to read the next token from tup into tokType, tokVal, tokLn (linenumber)
+ which are globals.
+ """
+ global tokType, tokVal, tokLn, tup
+ tokType, tokVal, tokLn = tup.__next__()
+
+
+class ParseError(Exception):
+ """A class to hold a parsing error message"""
+ def __init__(self, linenumber, token, message):
+ self.linenumber = linenumber
+ self.token = token
+ self.message = message
+ def __str__(self):
+ global inputFilename
+ return "Error in file \'%s\' at line %d near token %s\n %s" % (
+ inputFilename, self.linenumber, repr(self.token), self.message)
+
+
+class MASKSET(object):
+ """
+ Class MASKSET holds a set of bit vectors, all of which are related, will all
+ have the same length, and are associated with one of the seven shiftOps:
+ HIR, HDR, TIR, TDR, SIR, SDR, LSDR. One of these holds a mask, smask, tdi, tdo, and a
+ size.
+ """
+ def __init__(self, name):
+ self.empty()
+ self.name = name
+
+ def empty(self):
+ self.mask = bytearray()
+ self.smask = bytearray()
+ self.tdi = bytearray()
+ self.tdo = bytearray()
+ self.size = 0
+
+ def syncLengths( self, sawTDI, sawTDO, sawMASK, sawSMASK, newSize ):
+ """
+ Set all the lengths equal in the event some of the masks were
+ not seen as part of the last change set.
+ """
+ if self.size == newSize:
+ return
+
+ if newSize == 0:
+ self.empty()
+ return
+
+ # If an SIR was given without a MASK(), then use a mask of all zeros.
+ # this is not consistent with the SVF spec, but it makes sense because
+ # it would be odd to be testing an instruction register read out of a
+ # tap without giving a mask for it. Also, lattice seems to agree and is
+ # generating SVF files that comply with this philosophy.
+ if self.name == 'SIR' and not sawMASK:
+ self.mask = bytearray( newSize )
+
+ if newSize != len(self.mask):
+ self.mask = bytearray( newSize )
+ if self.name == 'SDR': # leave mask for HIR,HDR,TIR,TDR,SIR zeros
+ for i in range( newSize ):
+ self.mask[i] = 1
+
+ if newSize != len(self.tdo):
+ self.tdo = bytearray( newSize )
+
+ if newSize != len(self.tdi):
+ self.tdi = bytearray( newSize )
+
+ if newSize != len(self.smask):
+ self.smask = bytearray( newSize )
+
+ self.size = newSize
+#-----</MASKSET>-----
+
+
+def makeBitArray( hexString, bitCount ):
+ """
+ Converts a packed sequence of hex ascii characters into a bytearray where
+ each element in the array holds exactly one bit. Only "bitCount" bits are
+ scanned and these must be the least significant bits in the hex number. That
+ is, it is legal to have some unused bits in the must significant hex nibble
+ of the input "hexString". The string is scanned starting from the backend,
+ then just before returning we reverse the array. This way the append()
+ method can be used, which I assume is faster than an insert.
+ """
+ global tokLn
+ a = bytearray()
+ length = bitCount
+ hexString = list(hexString)
+ hexString.reverse()
+ #print(hexString)
+ for c in hexString:
+ if length <= 0:
+ break;
+ c = int(c, 16)
+ for mask in [1,2,4,8]:
+ if length <= 0:
+ break;
+ length = length - 1
+ a.append( (c & mask) != 0 )
+ if length > 0:
+ raise ParseError( tokLn, hexString, "Insufficient hex characters for given length of %d" % bitCount )
+ a.reverse()
+ #print(a)
+ return a
+
+
+def makeXSVFbytes( bitarray ):
+ """
+ Make a bytearray which is contains the XSVF bits which will be written
+ directly to disk. The number of bytes needed is calculated from the size
+ of the argument bitarray.
+ """
+ bitCount = len(bitarray)
+ byteCount = (bitCount+7)//8
+ ba = bytearray( byteCount )
+ firstBit = (bitCount % 8) - 1
+ if firstBit == -1:
+ firstBit = 7
+ bitNdx = 0
+ for byteNdx in range(byteCount):
+ mask = 1<<firstBit
+ byte = 0
+ while mask:
+ if bitarray[bitNdx]:
+ byte |= mask;
+ mask = mask >> 1
+ bitNdx = bitNdx + 1
+ ba[byteNdx] = byte
+ firstBit = 7
+ return ba
+
+
+def writeComment( outputFile, shiftOp_linenum, shiftOp ):
+ """
+ Write an XCOMMENT record to outputFile
+ """
+ comment = "%s @%d\0" % (shiftOp, shiftOp_linenum) # \0 is terminating nul
+ ba = bytearray(1)
+ ba[0] = XCOMMENT
+ ba += comment.encode()
+ outputFile.write( ba )
+
+
+def combineBitVectors( trailer, meat, header ):
+ """
+ Combine the 3 bit vectors comprizing a transmission. Since the least
+ significant bits are sent first, the header is put onto the list last so
+ they are sent first from that least significant position.
+ """
+ ret = bytearray()
+ ret.extend( trailer )
+ ret.extend( meat )
+ ret.extend( header )
+ return ret
+
+
+def writeRUNTEST( outputFile, run_state, end_state, run_count, min_time, tokenTxt ):
+ """
+ Write the output for the SVF RUNTEST command.
+ run_count - the number of clocks
+ min_time - the number of seconds
+ tokenTxt - either RUNTEST or LDELAY
+ """
+ # convert from secs to usecs
+ min_time = int( min_time * 1000000)
+
+ # the SVF RUNTEST command does NOT map to the XSVF XRUNTEST command. Check the SVF spec, then
+ # read the XSVF command. They are not the same. Use an XSVF XWAITSTATE to
+ # implement the required behavior of the SVF RUNTEST command.
+ if doCOMMENTs:
+ writeComment( output, tokLn, tokenTxt )
+
+ if tokenTxt == 'RUNTEST':
+ obuf = bytearray(11)
+ obuf[0] = XWAITSTATE
+ obuf[1] = run_state
+ obuf[2] = end_state
+ struct.pack_into(">i", obuf, 3, run_count ) # big endian 4 byte int to obuf
+ struct.pack_into(">i", obuf, 7, min_time ) # big endian 4 byte int to obuf
+ outputFile.write( obuf )
+ else: # == 'LDELAY'
+ obuf = bytearray(10)
+ obuf[0] = LDELAY
+ obuf[1] = run_state
+ # LDELAY has no end_state
+ struct.pack_into(">i", obuf, 2, run_count ) # big endian 4 byte int to obuf
+ struct.pack_into(">i", obuf, 6, min_time ) # big endian 4 byte int to obuf
+ outputFile.write( obuf )
+
+
+output = open( outputFilename, mode='wb' )
+
+hir = MASKSET('HIR')
+hdr = MASKSET('HDR')
+tir = MASKSET('TIR')
+tdr = MASKSET('TDR')
+sir = MASKSET('SIR')
+sdr = MASKSET('SDR')
+
+
+expecting_eof = True
+
+
+# one of the commands that take the shiftParts after the length, the parse
+# template for all of these commands is identical
+shiftOps = ('SDR', 'SIR', 'LSDR', 'HDR', 'HIR', 'TDR', 'TIR')
+
+# the order must correspond to shiftOps, this holds the MASKSETS. 'LSDR' shares sdr with 'SDR'
+shiftSets = (sdr, sir, sdr, hdr, hir, tdr, tir )
+
+# what to expect as parameters to a shiftOp, i.e. after a SDR length or SIR length
+shiftParts = ('TDI', 'TDO', 'MASK', 'SMASK')
+
+# the set of legal states which can trail the RUNTEST command
+run_state_allowed = ('IRPAUSE', 'DRPAUSE', 'RESET', 'IDLE')
+
+enddr_state_allowed = ('DRPAUSE', 'IDLE', 'RESET')
+endir_state_allowed = ('IRPAUSE', 'IDLE', 'RESET')
+
+enddr_state = IDLE
+endir_state = IDLE
+
+frequency = 1.00e+006 # HZ;
+
+# change detection for xsdrsize and xtdomask
+xsdrsize = -1 # the last one sent, send only on change
+xtdomask = bytearray() # the last one sent, send only on change
+
+
+# we use a number of single byte writes for the XSVF command below
+cmdbuf = bytearray(1)
+
+
+# Save the XREPEAT setting into the file as first thing.
+obuf = bytearray(2)
+obuf[0] = XREPEAT
+obuf[1] = xrepeat
+output.write( obuf )
+
+
+try:
+ while 1:
+ expecting_eof = True
+ nextTok()
+ expecting_eof = False
+ # print( tokType, tokVal, tokLn )
+
+ if tokVal in shiftOps:
+ shiftOp_linenum = tokLn
+ shiftOp = tokVal
+
+ set = shiftSets[shiftOps.index(shiftOp)]
+
+ # set flags false, if we see one later, set that one true later
+ sawTDI = sawTDO = sawMASK = sawSMASK = False
+
+ nextTok()
+ if tokType != 'int':
+ raise ParseError( tokLn, tokVal, "Expecting 'int' giving %s length, got '%s'" % (shiftOp, tokType) )
+ length = tokVal
+
+ nextTok()
+
+ while tokVal != ';':
+ if tokVal not in shiftParts:
+ raise ParseError( tokLn, tokVal, "Expecting TDI, TDO, MASK, SMASK, or ';'")
+ shiftPart = tokVal
+
+ nextTok()
+
+ if tokType != 'hex':
+ raise ParseError( tokLn, tokVal, "Expecting hex bits" )
+ bits = makeBitArray( tokVal, length )
+
+ if shiftPart == 'TDI':
+ sawTDI = True
+ set.tdi = bits
+
+ elif shiftPart == 'TDO':
+ sawTDO = True
+ set.tdo = bits
+
+ elif shiftPart == 'MASK':
+ sawMASK = True
+ set.mask = bits
+
+ elif shiftPart == 'SMASK':
+ sawSMASK = True
+ set.smask = bits
+
+ nextTok()
+
+ set.syncLengths( sawTDI, sawTDO, sawMASK, sawSMASK, length )
+
+ # process all the gathered parameters and generate outputs here
+ if shiftOp == 'SIR':
+ if doCOMMENTs:
+ writeComment( output, shiftOp_linenum, 'SIR' )
+
+ tdi = combineBitVectors( tir.tdi, sir.tdi, hir.tdi )
+ if len(tdi) > 255:
+ obuf = bytearray(3)
+ obuf[0] = XSIR2
+ struct.pack_into( ">h", obuf, 1, len(tdi) )
+ else:
+ obuf = bytearray(2)
+ obuf[0] = XSIR
+ obuf[1] = len(tdi)
+ output.write( obuf )
+ obuf = makeXSVFbytes( tdi )
+ output.write( obuf )
+
+ elif shiftOp == 'SDR':
+ if doCOMMENTs:
+ writeComment( output, shiftOp_linenum, shiftOp )
+
+ if not sawTDO:
+ # pass a zero filled bit vector for the sdr.mask
+ mask = combineBitVectors( tdr.mask, bytearray(sdr.size), hdr.mask )
+ tdi = combineBitVectors( tdr.tdi, sdr.tdi, hdr.tdi )
+
+ if xsdrsize != len(tdi):
+ xsdrsize = len(tdi)
+ cmdbuf[0] = XSDRSIZE
+ output.write( cmdbuf )
+ obuf = bytearray(4)
+ struct.pack_into( ">i", obuf, 0, xsdrsize ) # big endian 4 byte int to obuf
+ output.write( obuf )
+
+ if xtdomask != mask:
+ xtdomask = mask
+ cmdbuf[0] = XTDOMASK
+ output.write( cmdbuf )
+ obuf = makeXSVFbytes( mask )
+ output.write( obuf )
+
+ cmdbuf[0] = XSDR
+ output.write( cmdbuf )
+ obuf = makeXSVFbytes( tdi )
+ output.write( obuf )
+
+ else:
+ mask = combineBitVectors( tdr.mask, sdr.mask, hdr.mask )
+ tdi = combineBitVectors( tdr.tdi, sdr.tdi, hdr.tdi )
+ tdo = combineBitVectors( tdr.tdo, sdr.tdo, hdr.tdo )
+
+ if xsdrsize != len(tdi):
+ xsdrsize = len(tdi)
+ cmdbuf[0] = XSDRSIZE
+ output.write( cmdbuf )
+ obuf = bytearray(4)
+ struct.pack_into(">i", obuf, 0, xsdrsize ) # big endian 4 byte int to obuf
+ output.write( obuf )
+
+ if xtdomask != mask:
+ xtdomask = mask
+ cmdbuf[0] = XTDOMASK
+ output.write( cmdbuf )
+ obuf = makeXSVFbytes( mask )
+ output.write( obuf )
+
+ cmdbuf[0] = XSDRTDO
+ output.write( cmdbuf )
+ obuf = makeXSVFbytes( tdi )
+ output.write( obuf )
+ obuf = makeXSVFbytes( tdo )
+ output.write( obuf )
+ #print( "len(tdo)=", len(tdo), "len(tdr.tdo)=", len(tdr.tdo), "len(sdr.tdo)=", len(sdr.tdo), "len(hdr.tdo)=", len(hdr.tdo) )
+
+ elif shiftOp == 'LSDR':
+ if doCOMMENTs:
+ writeComment( output, shiftOp_linenum, shiftOp )
+
+ mask = combineBitVectors( tdr.mask, sdr.mask, hdr.mask )
+ tdi = combineBitVectors( tdr.tdi, sdr.tdi, hdr.tdi )
+ tdo = combineBitVectors( tdr.tdo, sdr.tdo, hdr.tdo )
+
+ if xsdrsize != len(tdi):
+ xsdrsize = len(tdi)
+ cmdbuf[0] = XSDRSIZE
+ output.write( cmdbuf )
+ obuf = bytearray(4)
+ struct.pack_into(">i", obuf, 0, xsdrsize ) # big endian 4 byte int to obuf
+ output.write( obuf )
+
+ if xtdomask != mask:
+ xtdomask = mask
+ cmdbuf[0] = XTDOMASK
+ output.write( cmdbuf )
+ obuf = makeXSVFbytes( mask )
+ output.write( obuf )
+
+ cmdbuf[0] = LSDR
+ output.write( cmdbuf )
+ obuf = makeXSVFbytes( tdi )
+ output.write( obuf )
+ obuf = makeXSVFbytes( tdo )
+ output.write( obuf )
+ #print( "len(tdo)=", len(tdo), "len(tdr.tdo)=", len(tdr.tdo), "len(sdr.tdo)=", len(sdr.tdo), "len(hdr.tdo)=", len(hdr.tdo) )
+
+ elif tokVal == 'RUNTEST' or tokVal == 'LDELAY':
+ # e.g. from lattice tools:
+ # "RUNTEST IDLE 5 TCK 1.00E-003 SEC;"
+ saveTok = tokVal
+ nextTok()
+ min_time = 0
+ run_count = 0
+ max_time = 600 # ten minutes
+ if tokVal in run_state_allowed:
+ run_state = StateTxt.index(tokVal)
+ end_state = run_state # bottom of page 17 of SVF spec
+ nextTok()
+ if tokType != 'int' and tokType != 'float':
+ raise ParseError( tokLn, tokVal, "Expecting 'int' or 'float' after RUNTEST [run_state]")
+ timeval = tokVal;
+ nextTok()
+ if tokVal != 'TCK' and tokVal != 'SEC' and tokVal != 'SCK':
+ raise ParseError( tokLn, tokVal, "Expecting 'TCK' or 'SEC' or 'SCK' after RUNTEST [run_state] (run_count|min_time)")
+ if tokVal == 'TCK' or tokVal == 'SCK':
+ run_count = int( timeval )
+ else:
+ min_time = timeval
+ nextTok()
+ if tokType == 'int' or tokType == 'float':
+ min_time = tokVal
+ nextTok()
+ if tokVal != 'SEC':
+ raise ParseError( tokLn, tokVal, "Expecting 'SEC' after RUNTEST [run_state] run_count min_time")
+ nextTok()
+ if tokVal == 'MAXIMUM':
+ nextTok()
+ if tokType != 'int' and tokType != 'float':
+ raise ParseError( tokLn, tokVal, "Expecting 'max_time' after RUNTEST [run_state] min_time SEC MAXIMUM")
+ max_time = tokVal
+ nextTok()
+ if tokVal != 'SEC':
+ raise ParseError( tokLn, tokVal, "Expecting 'max_time' after RUNTEST [run_state] min_time SEC MAXIMUM max_time")
+ nextTok()
+ if tokVal == 'ENDSTATE':
+ nextTok()
+ if tokVal not in run_state_allowed:
+ raise ParseError( tokLn, tokVal, "Expecting 'run_state' after RUNTEST .... ENDSTATE")
+ end_state = StateTxt.index(tokVal)
+ nextTok()
+ if tokVal != ';':
+ raise ParseError( tokLn, tokVal, "Expecting ';' after RUNTEST ....")
+ # print( "run_count=", run_count, "min_time=", min_time,
+ # "max_time=", max_time, "run_state=", State[run_state], "end_state=", State[end_state] )
+ writeRUNTEST( output, run_state, end_state, run_count, min_time, saveTok )
+
+ elif tokVal == 'LCOUNT':
+ nextTok()
+ if tokType != 'int':
+ raise ParseError( tokLn, tokVal, "Expecting integer 'count' after LCOUNT")
+ loopCount = tokVal
+ nextTok()
+ if tokVal != ';':
+ raise ParseError( tokLn, tokVal, "Expecting ';' after LCOUNT count")
+ if doCOMMENTs:
+ writeComment( output, tokLn, 'LCOUNT' )
+ obuf = bytearray(5)
+ obuf[0] = LCOUNT
+ struct.pack_into(">i", obuf, 1, loopCount ) # big endian 4 byte int to obuf
+ output.write( obuf )
+
+ elif tokVal == 'ENDDR':
+ nextTok()
+ if tokVal not in enddr_state_allowed:
+ raise ParseError( tokLn, tokVal, "Expecting 'stable_state' after ENDDR. (one of: DRPAUSE, IDLE, RESET)")
+ enddr_state = StateTxt.index(tokVal)
+ nextTok()
+ if tokVal != ';':
+ raise ParseError( tokLn, tokVal, "Expecting ';' after ENDDR stable_state")
+ if doCOMMENTs:
+ writeComment( output, tokLn, 'ENDDR' )
+ obuf = bytearray(2)
+ obuf[0] = XENDDR
+ obuf[1] = enddr_state
+ output.write( obuf )
+
+ elif tokVal == 'ENDIR':
+ nextTok()
+ if tokVal not in endir_state_allowed:
+ raise ParseError( tokLn, tokVal, "Expecting 'stable_state' after ENDIR. (one of: IRPAUSE, IDLE, RESET)")
+ endir_state = StateTxt.index(tokVal)
+ nextTok()
+ if tokVal != ';':
+ raise ParseError( tokLn, tokVal, "Expecting ';' after ENDIR stable_state")
+ if doCOMMENTs:
+ writeComment( output, tokLn, 'ENDIR' )
+ obuf = bytearray(2)
+ obuf[0] = XENDIR
+ obuf[1] = endir_state
+ output.write( obuf )
+
+ elif tokVal == 'STATE':
+ nextTok()
+ ln = tokLn
+ while tokVal != ';':
+ if tokVal not in StateTxt:
+ raise ParseError( tokLn, tokVal, "Expecting 'stable_state' after STATE")
+ stable_state = StateTxt.index( tokVal )
+
+ if doCOMMENTs and ln != -1:
+ writeComment( output, ln, 'STATE' )
+ ln = -1 # save comment only once
+
+ obuf = bytearray(2)
+ obuf[0] = XSTATE
+ obuf[1] = stable_state
+ output.write( obuf )
+ nextTok()
+
+ elif tokVal == 'FREQUENCY':
+ nextTok()
+ if tokVal != ';':
+ if tokType != 'int' and tokType != 'float':
+ raise ParseError( tokLn, tokVal, "Expecting 'cycles HZ' after FREQUENCY")
+ frequency = tokVal
+ nextTok()
+ if tokVal != 'HZ':
+ raise ParseError( tokLn, tokVal, "Expecting 'HZ' after FREQUENCY cycles")
+ nextTok()
+ if tokVal != ';':
+ raise ParseError( tokLn, tokVal, "Expecting ';' after FREQUENCY cycles HZ")
+
+ else:
+ raise ParseError( tokLn, tokVal, "Unknown token '%s'" % tokVal)
+
+except StopIteration:
+ if not expecting_eof:
+ print( "Unexpected End of File at line ", tokLn )
+
+except ParseError as pe:
+ print( "\n", pe )
+
+finally:
+ # print( "closing file" )
+ cmdbuf[0] = XCOMPLETE
+ output.write( cmdbuf )
+ output.close()
+
diff --git a/tools/xsvf_tools/xsvfdump.py b/tools/xsvf_tools/xsvfdump.py
new file mode 100644
index 00000000..df5db165
--- /dev/null
+++ b/tools/xsvf_tools/xsvfdump.py
@@ -0,0 +1,255 @@
+#!/usr/bin/python3.0
+
+# Copyright 2008, SoftPLC Corporation http://softplc.com
+# Dick Hollenbeck dick@softplc.com
+
+# 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, you may find one here:
+# http://www.gnu.org/licenses/old-licenses/gpl-2.0.html
+# or you may search the http://www.gnu.org website for the version 2 license,
+# or you may write to the Free Software Foundation, Inc.,
+# 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA
+
+# Dump an Xilinx XSVF file to stdout
+
+# This program is written for python 3.0, and it is not easy to change this
+# back to 2.x. You may find it easier to use python 3.x even if that means
+# building it.
+
+
+import sys
+import struct
+
+
+LABEL = "A script to dump an XSVF file to stdout"
+
+
+Xsdrsize = 0
+
+
+(XCOMPLETE,XTDOMASK,XSIR,XSDR,XRUNTEST,hole0,hole1,XREPEAT,XSDRSIZE,XSDRTDO,
+ XSETSDRMASKS,XSDRINC,XSDRB,XSDRC,XSDRE,XSDRTDOB,XSDRTDOC,
+ XSDRTDOE,XSTATE,XENDIR,XENDDR,XSIR2,XCOMMENT,XWAIT,XWAITSTATE,LCOUNT,LDELAY,LSDR) = range(28)
+
+
+(RESET,IDLE,
+ DRSELECT,DRCAPTURE,DRSHIFT,DREXIT1,DRPAUSE,DREXIT2,DRUPDATE,
+ IRSELECT,IRCAPTURE,IRSHIFT,IREXIT1,IRPAUSE,IREXIT2,IRUPDATE) = range(16)
+
+
+State = ("RESET","IDLE",
+ "DRSELECT","DRCAPTURE","DRSHIFT","DREXIT1","DRPAUSE","DREXIT2","DRUPDATE",
+ "IRSELECT","IRCAPTURE","IRSHIFT","IREXIT1","IRPAUSE","IREXIT2","IRUPDATE")
+
+Setsdrmasks = 0
+SetsdrmasksOnesCount = 0
+
+def ReadSDRMASKS( f, len ):
+ global Setsdrmasks, SetsdrmasksOnesCount
+ byteCount = (len+7)//8
+ Setsdrmasks = f.read( byteCount )
+ ls = []
+ SetsdrmasksOnesCount = 0
+ for b in Setsdrmasks:
+ ls.append( "%x" % ((b & 0xf0) >> 4) )
+ ls.append( "%x" % ( b & 0x0f ) )
+ for i in range(8):
+ if b & (1<<i):
+ SetsdrmasksOnesCount = SetsdrmasksOnesCount +1
+ return ''.join(ls)
+
+
+def bytes2hexString( f, len ):
+ byteCount = (len+7)//8
+ bytebuf = f.read( byteCount )
+ ls = []
+ for b in bytebuf:
+ ls.append( "%x" % ((b & 0xf0) >> 4) )
+ ls.append( "%x" % ( b & 0x0f ) )
+ return ''.join(ls)
+
+
+def ReadByte( f ):
+ """Read a byte from a file and return it as an int in least significant 8 bits"""
+ b = f.read(1)
+ if b:
+ return 0xff & b[0];
+ else:
+ return -1
+
+
+def ShowState( state ):
+ """return the given state int as a state string"""
+ #return "0x%02x" % state # comment this out to get textual state form
+ global State
+ if 0 <= state <= IRUPDATE:
+ return State[state]
+ else:
+ return "Unknown state 0x%02x" % state
+
+
+def ShowOpcode( op, f ):
+ """return the given byte as an opcode string"""
+ global Xsdrsize
+ if op == XCOMPLETE:
+ print("XCOMPLETE")
+
+ elif op == XTDOMASK:
+ buf = bytes2hexString( f, Xsdrsize )
+ print("XTDOMASK 0x%s" % buf)
+
+ elif op == XSIR:
+ len = ReadByte( f )
+ buf = bytes2hexString( f, len )
+ print("XSIR 0x%02X 0x%s" % (len, buf))
+
+ elif op == XSDR:
+ tdi = bytes2hexString( f, Xsdrsize )
+ print("XSDR 0x%s" % tdi)
+
+ elif op == XRUNTEST:
+ len = struct.unpack( '>i', f.read(4) )[0]
+ print("XRUNTEST 0x%08X" % len)
+
+ elif op == XREPEAT:
+ len = ReadByte( f )
+ print("XREPEAT 0x%02X" % len)
+
+ elif op == XSDRSIZE:
+ Xsdrsize = struct.unpack( '>i', f.read(4) )[0]
+ #print("XSDRSIZE 0x%08X" % Xsdrsize, file=sys.stderr )
+ print("XSDRSIZE 0x%08X %d" % (Xsdrsize, Xsdrsize) )
+
+ elif op == XSDRTDO:
+ tdi = bytes2hexString( f, Xsdrsize )
+ tdo = bytes2hexString( f, Xsdrsize )
+ print("XSDRTDO 0x%s 0x%s" % (tdi, tdo) )
+
+ elif op == XSETSDRMASKS:
+ addrmask = bytes2hexString( f, Xsdrsize )
+ datamask = ReadSDRMASKS( f, Xsdrsize )
+ print("XSETSDRMASKS 0x%s 0x%s" % (addrmask, datamask) )
+
+ elif op == XSDRINC:
+ startaddr = bytes2hexString( f, Xsdrsize )
+ len = ReadByte(f)
+ print("XSDRINC 0x%s 0x%02X" % (startaddr, len), end='' )
+ for numTimes in range(len):
+ data = bytes2hexString( f, SetsdrmasksOnesCount)
+ print(" 0x%s" % data )
+ print() # newline
+
+ elif op == XSDRB:
+ tdi = bytes2hexString( f, Xsdrsize )
+ print("XSDRB 0x%s" % tdi )
+
+ elif op == XSDRC:
+ tdi = bytes2hexString( f, Xsdrsize )
+ print("XSDRC 0x%s" % tdi )
+
+ elif op == XSDRE:
+ tdi = bytes2hexString( f, Xsdrsize )
+ print("XSDRE 0x%s" % tdi )
+
+ elif op == XSDRTDOB:
+ tdo = bytes2hexString( f, Xsdrsize )
+ print("XSDRTDOB 0x%s" % tdo )
+
+ elif op == XSDRTDOC:
+ tdi = bytes2hexString( f, Xsdrsize )
+ tdo = bytes2hexString( f, Xsdrsize )
+ print("XSDRTDOC 0x%s 0x%s" % (tdi, tdo) )
+
+ elif op == XSDRTDOE:
+ tdi = bytes2hexString( f, Xsdrsize )
+ tdo = bytes2hexString( f, Xsdrsize )
+ print("XSDRTDOE 0x%s 0x%s" % (tdi, tdo) )
+
+ elif op == XSTATE:
+ b = ReadByte(f)
+ print("XSTATE %s" % ShowState(b))
+
+ elif op == XENDIR:
+ b = ReadByte( f )
+ print("XENDIR %s" % ShowState(b))
+
+ elif op == XENDDR:
+ b = ReadByte( f )
+ print("XENDDR %s" % ShowState(b))
+
+ elif op == XSIR2:
+ len = struct.unpack( '>H', f.read(2) )[0]
+ buf = bytes2hexString( f, len )
+ print("XSIR2 0x%04X 0x%s" % (len, buf))
+
+ elif op == XCOMMENT:
+ cmt = []
+ while 1:
+ b = ReadByte(f)
+ if b == 0: # terminating nul
+ break;
+ cmt.append( chr(b) )
+ print("XCOMMENT \"%s\"" % ''.join(cmt) )
+
+ elif op == XWAIT:
+ run_state = ReadByte(f)
+ end_state = ReadByte(f)
+ useconds = struct.unpack( '>i', f.read(4) )[0]
+ print("XWAIT %s %s" % (ShowState(run_state), ShowState(end_state)), useconds)
+
+ elif op == XWAITSTATE:
+ run_state = ReadByte(f)
+ end_state = ReadByte(f)
+ clocks = struct.unpack( '>i', f.read(4) )[0]
+ useconds = struct.unpack( '>i', f.read(4) )[0]
+ print("XWAITSTATE %s %s CLOCKS=%d USECS=%d" % (ShowState(run_state), ShowState(end_state), clocks, useconds) )
+
+ elif op == LCOUNT:
+ loop_count = struct.unpack( '>i', f.read(4) )[0]
+ print("LCOUNT", loop_count )
+
+ elif op == LDELAY:
+ run_state = ReadByte(f)
+ clocks = struct.unpack( '>i', f.read(4) )[0]
+ useconds = struct.unpack( '>i', f.read(4) )[0]
+ print("LDELAY %s CLOCKS=%d USECS=%d" % (ShowState(run_state), clocks, useconds) )
+
+ elif op == LSDR:
+ tdi = bytes2hexString( f, Xsdrsize )
+ tdo = bytes2hexString( f, Xsdrsize )
+ print("LSDR 0x%s 0x%s" % (tdi, tdo) )
+
+ else:
+ print("UNKNOWN op 0x%02X %d" % (op, op))
+ exit(1)
+
+
+def main():
+
+ if len( sys.argv ) < 2:
+ print("usage %s <xsvf_filename>" % sys.argv[0])
+ exit(1)
+
+ f = open( sys.argv[1], 'rb' )
+
+ opcode = ReadByte( f )
+ while opcode != -1:
+ # print the position within the file, then the command
+ print( "%d: " % f.tell(), end='' )
+ ShowOpcode( opcode, f )
+ opcode = ReadByte(f)
+
+
+if __name__ == "__main__":
+ main()
+