WebSVN – pentevo – /tools/crcbldr/source/crcbldr.c

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <time.h>

typedef unsigned char BYTE;
typedef unsigned short WORD;
typedef unsigned long LONGWORD;

#define HEXLEN 0
#define DATATYPE 1
#define CHECKSUM 2

BYTE checksum;
WORD col, row;
LONGWORD err;
BYTE s[256], s1[256];

//-----------------------------------------------------------------------------

void print_err_rc()
{
printf("Error! (Row %d, Col %d)\n",row,col+1);
err++;
}

//-----------------------------------------------------------------------------

void print_err_r(BYTE cause)
{
BYTE* cause_str[3]={"Number of byte","Unknown datatype","Checksum"};
printf("Error! %s. (Row %d)\n",cause_str[cause],row);
err++;
}

//-----------------------------------------------------------------------------

BYTE getbyte()
{
BYTE b1, b0;

b1=s[col];
if ( ( (b1>=0x30)&&(b1<=0x39) )||( (b1>=0x41)&&(b1<=0x46) ) )
{
b1-=0x30;
if (b1>9) b1-=7;
}
else
{
print_err_rc();
b1=0;
}
col++;

b0=s[col];
if ( ( (b0>=0x30)&&(b0<=0x39) )||( (b0>=0x41)&&(b0<=0x46) ) )
{
b0-=0x30;
if (b0>9) b0-=7;
}
else
{
print_err_rc();
b0=0;
}
col++;

b0|=(b1<<4);
checksum+=b0;
return b0;
}

//-----------------------------------------------------------------------------

int main(int argc,char*argv[])
{
BYTE h[]="0123456789ABCDEF";
BYTE b, m, o, hexlen, datatype;
WORD i, crc;
LONGWORD x0, x1, adr, segadr;
struct tm stm;
BYTE vs[86];
BYTE E2Phead[0x98] = {
0x45,0x32,0x50,0x21,0x4C,0x61,0x6E,0x63,0xC0,0x10,0x30,0x00,0x03,0x00,0x00,0x10,
0x02,0x00,0x00,0x77,0x00,0x00,0x00,0x02,0x00,0x00,0x41,0x54,0x6D,0x65,0x67,0x61,
0x31,0x32,0x38 };
WORD tabcrc[256];
BYTE buff[0x2000];
FILE* f;

o=0;
printf("ZX EVO project: Calc CRC for bootloader\n");
if (argc<3) { printf("usage: crcbldr <HexFileName> [<VersionFileName>]\n"); return 2; }

for (adr=0;adr<0x2000;adr++) buff[adr]=0xff;
if (argc==4)
{
strncpy(s1,argv[3],1);
if (s1[0]=='o') o=0x80;
}

strncpy(s1,argv[2],255);
f=fopen(s1,"rt");
vs[0]=0;
if (f)
{
fgets(vs,13,f);
fclose(f);
}
i=strlen(vs);
if ((i) && (vs[i-1]=='\n')) vs[--i]=0;
if (!i)
{
strcpy(vs, "No info");
o=0;
}

strncpy(s1,argv[1],255);
f=fopen(s1,"rt");
if (!f) { printf("Can't open file %s!\n",s1); return 1; }

err=0;
segadr=0;
row=0;
while (!feof(f))
{
row++;
col=0;
if (fgets(s,255,f) && strlen(s))
{
if (s[col]!=':') print_err_rc();
col++;
checksum=0;
hexlen=getbyte();
x1=getbyte();
x0=getbyte();
adr=segadr|(x1<<8)|x0;
datatype=getbyte();
switch (datatype)
{
// Data record
case 0: while (hexlen>0)
{
b=getbyte();
hexlen--;
if ( (adr>=0x1e000) && (adr<0x20000) ) buff[adr-0x1e000]=b;
adr++;
}
break;
// End of file record
case 1: if (hexlen!=0) print_err_r(HEXLEN);
break;
// Extended segment address record
case 2: x1=getbyte();
x0=getbyte();
segadr=(x1<<12)|(x0<<4);
if (hexlen!=2) print_err_r(HEXLEN);
break;
// Start segment address record
case 3: break;
// Extended linear address record
case 4: x1=getbyte();
x0=getbyte();
segadr=(x1<<24)|(x0<<16);
if (hexlen!=2) print_err_r(HEXLEN);
break;
// Start linear address record
case 5: break;
default: print_err_r(DATATYPE);
while (hexlen!=0) { getbyte(); hexlen--; }
}
getbyte();
if (checksum!=0) print_err_r(CHECKSUM);
}
}
fclose(f);

if (err) { printf("Total %d error(s)!\n",(int)err); return 3; }

for (i=0;i<256;i++)
{
crc=i<<8;
b=8;
do
{
if (crc&0x8000)
crc=(crc<<1)^0x1021;
else
crc<<=1;
b--;
}
while ((b)&&(crc));
tabcrc[i]=crc;
}

strncpy(&buff[0x1ff0], vs, 12);
{
time_t tt;
tt=time(NULL);
memcpy(&stm,localtime(&tt),sizeof(stm));
}
i=(WORD)( (((stm.tm_year-100)&0x3f)<<9) | (((stm.tm_mon+1)&0x0f)<<5) | (stm.tm_mday&0x1f) );
buff[0x1ffd]=(i>>8)&0x7f|o;
buff[0x1ffc]=i&0xff;

crc=0xffff;
for (adr=0;adr<0x1ffe;adr++) crc=tabcrc[(crc>>8)^buff[adr]]^(crc<<8);
buff[0x1ffe]=crc>>8;
buff[0x1fff]=crc&0xff;

// - - - - - - - -

f=fopen("zxevo_bl.hex","wt");
if (!f) { printf("Can't create output file!\n"); return 1; }

fputs(":020000020000FC\n:01000000FF00\n:020000021000EC\n",f);
s[0]=':';
s[1]='1';
s[2]='0';
adr=0;

do
{
checksum=0xf0;
m=3;
b=((adr>>8)&0xff)+0xe0;
checksum-=b;
s[m++]=h[b>>4];
s[m++]=h[b&0x0f];
b=adr&0xff;
checksum-=b;
s[m++]=h[b>>4];
s[m++]=h[b&0x0f];
s[m++]='0';
s[m++]='0';
for (i=0;i<16;i++)
{
b=buff[adr++];
checksum-=b;
s[m++]=h[b>>4];
s[m++]=h[b&0x0f];
}
s[m++]=h[checksum>>4];
s[m++]=h[checksum&0x0f];
s[m++]='\n';
s[m]=0;
fputs(s,f);
}
while (adr<0x2000);

fputs(":00000001FF\n",f);
fclose(f);

printf("Created file zxevo_bl.hex\n");

// - - - - - - - -

for (i=0;i<256;i++)
{
crc=i;
b=8;
do
{
if (crc&0x0001)
crc=(crc>>1)^0xa001;
else
crc>>=1;
b--;
}
while ((b)&&(crc));
tabcrc[i]=crc;
}

i=strlen(vs);
vs[i++]=' ';
b=stm.tm_mday&0x1f;
vs[i++]=h[b/10];
vs[i++]=h[b%10];
vs[i++]='.';
b=stm.tm_mon+1;
vs[i++]=h[b/10];
vs[i++]=h[b%10];
vs[i++]='.';
vs[i++]='2';
vs[i++]='0';
b=stm.tm_year-100;
vs[i++]=h[b/10];
vs[i++]=h[b%10];
vs[i]=0;
if (!o) strcpy(&vs[i]," beta");

strncpy(&E2Phead[0x3a],vs,85);
E2Phead[0x90]=0x02;
E2Phead[0x91]=0x00;

crc=0xd001; // precalculated for empty space before
for (adr=0;adr<0x2000;adr++) crc=tabcrc[(crc&0xff)^buff[adr]]^(crc>>8);
for (adr=0;adr<0x1000;adr++) crc=tabcrc[(~crc)&0xff]^(crc>>8); // postcalculating for empty space after
E2Phead[0x94]=crc&0xff;
E2Phead[0x95]=crc>>8;

crc=0;
for (adr=0;adr<0x96;adr++) crc=tabcrc[(crc&0xff)^E2Phead[adr]]^(crc>>8);
E2Phead[0x96]=crc&0xff;
E2Phead[0x97]=crc>>8;

f=fopen("zxevo_bl.e2p","wb");
if (!f) { printf("Can't create output file!\n"); return 1; }
fwrite(E2Phead,1,0x98,f);
for (adr=0;adr<256;adr++) s1[adr]=0xff;
for (adr=0;adr<0x1e0;adr++) fwrite(s1,1,256,f);
fwrite(buff,1,0x2000,f);
for (adr=0;adr<0x10;adr++) fwrite(s1,1,256,f);
fclose(f);

printf("Created file zxevo_bl.e2p\n");

return 0;
}

Top secrets sources NedoPC pentevo

(root)/tools/crcbldr/source/crcbldr.c – Rev 288