Eugene Konev
18 years ago
parent
418ae3a045
commit
3dbd8ff32f
@ -0,0 +1,523 @@ |
||||
#include <stdio.h> |
||||
#include <ctype.h> |
||||
|
||||
//Rev 0.1 Original
|
||||
// 8 Jan 2001 MJH Added code to write data to Binary file
|
||||
// note: outputfile is name.bin, where name is first part
|
||||
// of input file. ie tmp.rec -> tmp.bin
|
||||
//
|
||||
// srec2bin <input SREC file> <Output Binary File> <If Present, Big Endian>
|
||||
//
|
||||
// TAG
|
||||
// bit32u TAG_BIG = 0xDEADBE42;
|
||||
// bit32u TAG_LITTLE = 0xFEEDFA42;
|
||||
//
|
||||
// File Structure
|
||||
//
|
||||
// TAG : 32 Bits
|
||||
// [DATA RECORDS]
|
||||
//
|
||||
// Data Records Structure
|
||||
//
|
||||
// LENGTH : 32 Bits <- Length of DATA, excludes ADDRESS and CHECKSUM
|
||||
// ADDRESS : 32 Bits
|
||||
// DATA : 8 Bits * LENGTH
|
||||
// CHECKSUM: 32 Bits <- 0 - (Sum of Length --> End of Data)
|
||||
//
|
||||
// Note : If Length == 0, Address will be Program Start
|
||||
//
|
||||
//
|
||||
//
|
||||
//
|
||||
//
|
||||
|
||||
#define MajRevNum 0 |
||||
#define MinRevNum 2 |
||||
|
||||
|
||||
#define EndianSwitch(x) ((x >> 24) | (x << 24) | ((x << 8) & (0x00FF0000)) | ((x >> 8) & (0x0000FF00)) ) |
||||
|
||||
typedef unsigned char bit8u; |
||||
typedef unsigned int bit32u; |
||||
typedef int bit32; |
||||
|
||||
#define FALSE 0 |
||||
#define TRUE (!FALSE) |
||||
|
||||
|
||||
bit32u CheckSum; |
||||
int RecStart; |
||||
int debug; |
||||
int verbose; |
||||
|
||||
FILE *OpenOutputFile( char *Name ); |
||||
FILE *fOut; |
||||
bit32u RecLength=0; |
||||
|
||||
bit32u AddressCurrent; |
||||
|
||||
bit32u gh(char *cp,int nibs); |
||||
|
||||
int BigEndian; |
||||
|
||||
int inputline; |
||||
|
||||
// char buf[16*1024];
|
||||
|
||||
char buffer[2048]; |
||||
char *cur_ptr; |
||||
int cur_line=0; |
||||
int cur_len=0; |
||||
|
||||
int s1s2s3_total=0; |
||||
|
||||
bit32u PBVal; |
||||
int PBValid; |
||||
bit32u PBAdr; |
||||
|
||||
|
||||
void dumpfTell(char *s, bit32u Value) |
||||
{ |
||||
int Length; |
||||
Length = (int) RecLength; |
||||
if (debug) |
||||
printf("[%s ] ftell()[0x%08lX] Length[0x%4X] Length[%4d] Value[0x%08x]\n", |
||||
s, ftell(fOut), Length, Length, Value); |
||||
} |
||||
|
||||
void DispHex(bit32u Hex) |
||||
{ |
||||
// printf("%X", Hex);
|
||||
} |
||||
|
||||
void WaitDisplay(void) |
||||
{ |
||||
static int Count=0; |
||||
static int Index=0; |
||||
char iline[]={"-\\|/"}; |
||||
|
||||
Count++; |
||||
if ((Count % 32)==0) |
||||
{ |
||||
if (verbose) |
||||
printf("%c%c",iline[Index++],8); |
||||
Index &= 3; |
||||
} |
||||
} |
||||
|
||||
|
||||
void binOut32 ( bit32u Data ) |
||||
{ |
||||
// On UNIX machine all 32bit writes need ENDIAN switched
|
||||
// Data = EndianSwitch(Data);
|
||||
// fwrite( &Data, sizeof(bit32u), 1, fOut);
|
||||
|
||||
char sdat[4]; |
||||
int i; |
||||
|
||||
for(i=0;i<4;i++) |
||||
sdat[i]=(char)(Data>>(i*8)); |
||||
fwrite( sdat, 1, 4, fOut); |
||||
dumpfTell("Out32" , Data); |
||||
} |
||||
|
||||
// Only update RecLength on Byte Writes
|
||||
// All 32 bit writes will be for Length etc
|
||||
|
||||
void binOut8 ( bit8u Data ) |
||||
{ |
||||
int n; |
||||
dumpfTell("B4Data" , (bit32u) (Data & 0xFF) ); |
||||
n = fwrite( &Data, sizeof(bit8u), 1, fOut); |
||||
if (n != 1) |
||||
printf("Error in writing %X for Address 0x%8X\n", Data, AddressCurrent); |
||||
RecLength += 1; |
||||
} |
||||
|
||||
// Currently ONLY used for outputting Program Start
|
||||
|
||||
void binRecStart(bit32u Address) |
||||
{ |
||||
RecLength = 0; |
||||
CheckSum = Address; |
||||
RecStart = TRUE; |
||||
|
||||
if (debug) |
||||
printf("[RecStart] CheckSum[0x%08X] Length[%4d] Address[0x%08X]\n", |
||||
CheckSum, RecLength, Address); |
||||
|
||||
|
||||
dumpfTell("RecLength", RecLength); |
||||
binOut32( RecLength ); |
||||
dumpfTell("Address", Address); |
||||
binOut32( Address ); |
||||
} |
||||
|
||||
void binRecEnd(void) |
||||
{ |
||||
long RecEnd; |
||||
|
||||
if (!RecStart) // if no record started, do not end it
|
||||
{ |
||||
return; |
||||
} |
||||
|
||||
RecStart = FALSE; |
||||
|
||||
|
||||
RecEnd = ftell(fOut); // Save Current position
|
||||
|
||||
if (debug) |
||||
printf("[RecEnd ] CheckSum[0x%08X] Length[%4d] Length[0x%X] RecEnd[0x%08lX]\n", |
||||
CheckSum, RecLength, RecLength, RecEnd); |
||||
|
||||
fseek( fOut, -((long) RecLength), SEEK_CUR); // move back Start Of Data
|
||||
|
||||
dumpfTell("Data ", -1); |
||||
|
||||
fseek( fOut, -4, SEEK_CUR); // move back Start Of Address
|
||||
|
||||
dumpfTell("Address ", -1); |
||||
|
||||
fseek( fOut, -4, SEEK_CUR); // move back Start Of Length
|
||||
|
||||
dumpfTell("Length ", -1); |
||||
|
||||
binOut32( RecLength ); |
||||
|
||||
fseek( fOut, RecEnd, SEEK_SET); // move to end of Record
|
||||
|
||||
CheckSum += RecLength; |
||||
|
||||
CheckSum = ~CheckSum + 1; // Two's complement
|
||||
|
||||
binOut32( CheckSum ); |
||||
|
||||
if (verbose) |
||||
printf("[Created Record of %d Bytes with CheckSum [0x%8X]\n", RecLength, CheckSum); |
||||
} |
||||
|
||||
void binRecOutProgramStart(bit32u Address) |
||||
{ |
||||
if (Address != (AddressCurrent+1)) |
||||
{ |
||||
binRecEnd(); |
||||
binRecStart(Address); |
||||
} |
||||
AddressCurrent = Address; |
||||
} |
||||
void binRecOutByte(bit32u Address, bit8u Data) |
||||
{ |
||||
// If Address is one after Current Address, output Byte
|
||||
// If not, close out last record, update Length, write checksum
|
||||
// Then Start New Record, updating Current Address
|
||||
|
||||
if (Address != (AddressCurrent+1)) |
||||
{ |
||||
binRecEnd(); |
||||
binRecStart(Address); |
||||
} |
||||
AddressCurrent = Address; |
||||
CheckSum += Data; |
||||
binOut8( Data ); |
||||
} |
||||
|
||||
//=============================================================================
|
||||
// SUPPORT FUNCTIONS
|
||||
//=============================================================================
|
||||
int readline(FILE *fil,char *buf,int len) |
||||
{ |
||||
int rlen; |
||||
|
||||
rlen=0; |
||||
if (len==0) return(0); |
||||
while(1) |
||||
{ |
||||
if (cur_len==0) |
||||
{ |
||||
cur_len=fread(buffer, 1, sizeof(buffer), fil); |
||||
if (cur_len==0) |
||||
{ |
||||
if (rlen) |
||||
{ |
||||
*buf=0; |
||||
return(rlen); |
||||
} |
||||
return(-1); |
||||
} |
||||
cur_ptr=buffer; |
||||
} |
||||
if (cur_len) |
||||
{ |
||||
if (*cur_ptr=='\n') |
||||
{ |
||||
*buf=0; |
||||
cur_ptr++; |
||||
cur_len--; |
||||
return(rlen); |
||||
} |
||||
else |
||||
{ |
||||
if ((len>1)&&(*cur_ptr!='\r')) |
||||
{ |
||||
*buf++=*cur_ptr++; |
||||
len--; |
||||
} |
||||
else |
||||
cur_ptr++; |
||||
|
||||
rlen++; |
||||
cur_len--; |
||||
} |
||||
} |
||||
else |
||||
{ |
||||
*buf=0; |
||||
cur_ptr++; |
||||
cur_len--; |
||||
return(rlen); |
||||
} |
||||
} |
||||
} |
||||
|
||||
|
||||
int SRLerrorout(char *c1,char *c2) |
||||
{ |
||||
printf("\nERROR: %s - '%s'.",c1,c2); |
||||
return(FALSE); |
||||
} |
||||
|
||||
|
||||
int checksum(char *cp,int count) |
||||
{ |
||||
char *scp; |
||||
int cksum; |
||||
int dum; |
||||
|
||||
scp=cp; |
||||
while(*scp) |
||||
{ |
||||
if (!isxdigit(*scp++)) |
||||
return(SRLerrorout("Invalid hex digits",cp)); |
||||
} |
||||
scp=cp; |
||||
|
||||
cksum=count; |
||||
|
||||
while(count) |
||||
{ |
||||
cksum += gh(scp,2); |
||||
if (count == 2) |
||||
dum = ~cksum; |
||||
scp += 2; |
||||
count--; |
||||
} |
||||
cksum&=0x0ff;
|
||||
// printf("\nCk:%02x",cksum);
|
||||
return(cksum==0x0ff); |
||||
} |
||||
|
||||
bit32u gh(char *cp,int nibs) |
||||
{ |
||||
int i; |
||||
bit32u j; |
||||
|
||||
j=0; |
||||
|
||||
for(i=0;i<nibs;i++) |
||||
{ |
||||
j<<=4; |
||||
if ((*cp>='a')&&(*cp<='z')) *cp &= 0x5f; |
||||
if ((*cp>='0')&&(*cp<='9'))
|
||||
j += (*cp-0x30); |
||||
else |
||||
if ((*cp>='A')&&(*cp<='F')) |
||||
j += (*cp-0x37); |
||||
else |
||||
SRLerrorout("Bad Hex char", cp); |
||||
cp++; |
||||
} |
||||
return(j); |
||||
} |
||||
|
||||
|
||||
//=============================================================================
|
||||
// PROCESS SREC LINE
|
||||
//=============================================================================
|
||||
|
||||
int srecLine(char *pSrecLine) |
||||
{ |
||||
char *scp,ch; |
||||
int itmp,count,dat; |
||||
bit32u adr; |
||||
static bit32u RecordCounter=0; |
||||
|
||||
cur_line++; |
||||
scp=pSrecLine; |
||||
|
||||
if (*pSrecLine!='S') |
||||
return(SRLerrorout("Not an Srecord file",scp)); |
||||
pSrecLine++; |
||||
if (strlen(pSrecLine)<4) |
||||
return(SRLerrorout("Srecord too short",scp)); |
||||
|
||||
ch=*pSrecLine++; |
||||
|
||||
count=gh(pSrecLine,2); |
||||
|
||||
pSrecLine += 2; |
||||
|
||||
// if(debug)
|
||||
// printf("count %d, strlen(pSrecLine) = %d, pSrecLine =[%s]\n", count, strlen(pSrecLine), pSrecLine);
|
||||
RecordCounter++; |
||||
DispHex(RecordCounter); |
||||
|
||||
if ((count*2) != strlen(pSrecLine)) return(SRLerrorout("Count field larger than record",scp)); |
||||
|
||||
if (!checksum(pSrecLine, count)) return(SRLerrorout("Bad Checksum",scp)); |
||||
|
||||
switch(ch) |
||||
{ |
||||
case '0': if (count<3) return(SRLerrorout("Invalid Srecord count field",scp)); |
||||
itmp=gh(pSrecLine,4); pSrecLine+=4; count-=2; |
||||
if (itmp) return(SRLerrorout("Srecord 1 address not zero",scp)); |
||||
break; |
||||
case '1': if (count<3) return(SRLerrorout("Invalid Srecord count field",scp)); |
||||
return(SRLerrorout("Srecord Not valid for MIPS",scp)); |
||||
break; |
||||
case '2': if (count<4) return(SRLerrorout("Invalid Srecord count field",scp)); |
||||
return(SRLerrorout("Srecord Not valid for MIPS",scp)); |
||||
break; |
||||
case '3': if (count<5) return(SRLerrorout("Invalid Srecord count field",scp)); |
||||
adr=gh(pSrecLine,8); pSrecLine+=8; count-=4; |
||||
count--; |
||||
while(count) |
||||
{ |
||||
dat=gh(pSrecLine,2); pSrecLine+=2; count--; |
||||
binRecOutByte(adr, (char) (dat & 0xFF)); |
||||
adr++; |
||||
} |
||||
s1s2s3_total++; |
||||
break; |
||||
case '4': return(SRLerrorout("Invalid Srecord type",scp)); |
||||
break; |
||||
case '5': if (count<3) return(SRLerrorout("Invalid Srecord count field",scp)); |
||||
itmp=gh(pSrecLine,4); pSrecLine+=4; count-=2; |
||||
if (itmp|=s1s2s3_total) return(SRLerrorout("Incorrect number of S3 Record processed",scp)); |
||||
break; |
||||
case '6': return(SRLerrorout("Invalid Srecord type",scp)); |
||||
break; |
||||
case '7': // PROGRAM START
|
||||
if (count<5) return(SRLerrorout("Invalid Srecord count field",scp)); |
||||
adr=gh(pSrecLine,8); pSrecLine+=8; count-=4; |
||||
if (count!=1) return(SRLerrorout("Invalid Srecord count field",scp)); |
||||
binRecOutProgramStart(adr); |
||||
break; |
||||
case '8': if (count<4) return(SRLerrorout("Invalid Srecord count field",scp)); |
||||
return(SRLerrorout("Srecord Not valid for MIPS",scp)); |
||||
break; |
||||
case '9': if (count<3) return(SRLerrorout("Invalid Srecord count field",scp)); |
||||
return(SRLerrorout("Srecord Not valid for MIPS",scp)); |
||||
break; |
||||
default: |
||||
break; |
||||
} |
||||
return(TRUE); |
||||
} |
||||
|
||||
|
||||
//=============================================================================
|
||||
// MAIN LOGIC, READS IN LINE AND OUTPUTS BINARY
|
||||
//=============================================================================
|
||||
|
||||
int srec2bin(int argc,char *argv[],int verbose) |
||||
{ |
||||
int i,rlen,sts; |
||||
FILE *fp; |
||||
char ac; |
||||
char buff[256]; |
||||
bit32u TAG_BIG = 0xDEADBE42; |
||||
bit32u TAG_LITTLE = 0xFEEDFA42; |
||||
|
||||
bit32u Tag; |
||||
|
||||
|
||||
if(argc < 3) |
||||
{ |
||||
printf("\nError: <srec2bin <srec input file> <bin output file>\n\n"); |
||||
return(0); |
||||
} |
||||
|
||||
if (argc > 3) BigEndian=TRUE; else BigEndian=FALSE; |
||||
|
||||
if (BigEndian) |
||||
Tag = TAG_BIG; |
||||
else |
||||
Tag = TAG_LITTLE; |
||||
|
||||
if (verbose) |
||||
printf("\nEndian: %s, Tag is 0x%8X\n",(BigEndian)?"BIG":"LITTLE", Tag); |
||||
|
||||
fp = fopen(argv[1],"rt"); |
||||
|
||||
if (fp==NULL) |
||||
{ |
||||
printf("\nError: Opening input file, %s.", argv[1]); |
||||
return(0); |
||||
} |
||||
|
||||
fOut = fopen( argv[2], "wb"); |
||||
|
||||
if (fOut==NULL) |
||||
{ |
||||
printf("\nError: Opening Output file, %s.", argv[2]); |
||||
if(fp) fclose(fp); |
||||
return(0); |
||||
} |
||||
|
||||
RecStart = FALSE; |
||||
|
||||
AddressCurrent = 0xFFFFFFFFL; |
||||
|
||||
// Setup Tag
|
||||
|
||||
dumpfTell("Tag", Tag); |
||||
|
||||
binOut32(Tag); |
||||
|
||||
|
||||
inputline=0; |
||||
sts=TRUE; |
||||
|
||||
rlen = readline(fp,buff,sizeof buff); |
||||
|
||||
while( (sts) && (rlen != -1)) |
||||
{ |
||||
if (strlen(buff)) |
||||
{ |
||||
sts &= srecLine(buff); |
||||
WaitDisplay(); |
||||
} |
||||
rlen = readline(fp,buff,sizeof buff); |
||||
} |
||||
|
||||
|
||||
// printf("PC: 0x%08X, Length 0x%08X, Tag 0x%08X\n", ProgramStart, RecLength, TAG_LITTLE);
|
||||
|
||||
binRecEnd(); |
||||
|
||||
if(fp) fclose(fp); |
||||
if(fOut) fclose(fOut); |
||||
|
||||
return(1); |
||||
} |
||||
|
||||
main(int argc, char *argv[]) |
||||
{ |
||||
debug = TRUE; |
||||
debug = FALSE; |
||||
verbose = FALSE; |
||||
srec2bin(argc,argv,verbose); |
||||
return 0; |
||||
} |
||||
|
||||
Loading…
Reference in new issue