mirror of
https://github.com/ipxe/ipxe
synced 2026-02-28 03:11:18 +03:00
Initial revision
This commit is contained in:
Michael Brown
310
contrib/smc9462tx-flash/dp83820_write.c
Normal file
310
contrib/smc9462tx-flash/dp83820_write.c
Normal file
@@ -0,0 +1,310 @@
|
||||
/*
|
||||
DP83820 flash utility written by Dave Ashley for NXTV, Inc.
|
||||
Copyright (C) 2004 by NXTV, Inc.
|
||||
Written 20040219 by Dave Ashley.
|
||||
|
||||
Currently only supports the AT29C512
|
||||
|
||||
This code is released under the terms of the GPL. No warranty.
|
||||
|
||||
|
||||
THEORY:
|
||||
This code uses the /proc/dp83820 file which is created by the
|
||||
dp83820flash.o module. That file allows single byte reads + writes
|
||||
to the bootrom.
|
||||
|
||||
*/
|
||||
|
||||
#include <unistd.h>
|
||||
#include <sys/io.h>
|
||||
#include <stdio.h>
|
||||
#include <unistd.h>
|
||||
#include <sys/mman.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/stat.h>
|
||||
#include <fcntl.h>
|
||||
#include <stdlib.h>
|
||||
#include <signal.h>
|
||||
|
||||
|
||||
// SMC9462TX card has D5 + D6 on the bootrom socket reversed
|
||||
int fixb(int val)
|
||||
{
|
||||
return (val&~0x60) | ((val&0x20)<<1) | ((val&0x40)>>1);
|
||||
}
|
||||
int openit(void)
|
||||
{
|
||||
int fd;
|
||||
fd=open("/proc/dp83820",O_RDWR);
|
||||
if(fd<0)
|
||||
{
|
||||
printf("Failed to open the /proc/dp83820 file to access the flashrom.\n");
|
||||
printf("Make sure you've done:\n");
|
||||
printf(" modprobe dp83820flash\n");
|
||||
exit(-1);
|
||||
}
|
||||
return fd;
|
||||
}
|
||||
void set(int addr, unsigned char val)
|
||||
{
|
||||
unsigned char msg[3];
|
||||
int fd;
|
||||
fd=openit();
|
||||
msg[0]=addr;
|
||||
msg[1]=addr>>8;
|
||||
msg[2]=val;
|
||||
write(fd,msg,3);
|
||||
close(fd);
|
||||
}
|
||||
int get(int addr)
|
||||
{
|
||||
unsigned char msg[2];
|
||||
int fd;
|
||||
fd=openit();
|
||||
msg[0]=addr;
|
||||
msg[1]=addr>>8;
|
||||
write(fd,msg,2);
|
||||
read(fd,msg,1);
|
||||
close(fd);
|
||||
return msg[0];
|
||||
}
|
||||
|
||||
|
||||
int getromsize(unsigned char *id)
|
||||
{
|
||||
if(id[0]==0xbf && id[1]==0xb6) return 0x40000;
|
||||
if(id[0]==0xc2 && id[1]==0xb0) return 0x40000;
|
||||
if(id[0]==0x1f && id[1]==0x3d) return 0x10000;
|
||||
return -1;
|
||||
}
|
||||
|
||||
#define MAXROMSIZE 0x200000
|
||||
unsigned char *buffer;
|
||||
|
||||
int loadfile(char *name)
|
||||
{
|
||||
int filefd;
|
||||
int filesize;
|
||||
filefd=open(name,O_RDONLY);
|
||||
if(filefd<0)
|
||||
{
|
||||
printf("Couldn't open file %s\n",name);
|
||||
return -1;
|
||||
}
|
||||
filesize=read(filefd,buffer,MAXROMSIZE);
|
||||
close(filefd);
|
||||
if(filesize<0)
|
||||
{
|
||||
printf("Error trying to read from file %s\n",name);
|
||||
}
|
||||
return filesize;
|
||||
}
|
||||
|
||||
void readbios(char *name,int len)
|
||||
{
|
||||
int filefd;
|
||||
int filesize=0;
|
||||
unsigned char block[256];
|
||||
int i,j;
|
||||
|
||||
filefd=open(name,O_WRONLY|O_TRUNC|O_CREAT,0644);
|
||||
if(filefd<0)
|
||||
{
|
||||
printf("Couldn't create file %s for writing\n",name);
|
||||
return;
|
||||
}
|
||||
for(i=j=0;i<len;++i)
|
||||
{
|
||||
block[j++]=get(i);
|
||||
if(j<sizeof(block)) continue;
|
||||
filesize+=write(filefd,block,j);
|
||||
j=0;
|
||||
}
|
||||
close(filefd);
|
||||
if(filesize!=len)
|
||||
{
|
||||
printf("Error during write of %s file\n",name);
|
||||
return;
|
||||
}
|
||||
printf("BIOS contents saved to %s, $%x bytes\n",name,len);
|
||||
}
|
||||
|
||||
int verifybios(char *name,int len, int print)
|
||||
{
|
||||
int filelen;
|
||||
int i;
|
||||
int same=0;
|
||||
|
||||
filelen=loadfile(name);
|
||||
for(i=0;i<filelen;++i)
|
||||
if(get(i)!=buffer[i]) break;
|
||||
if(i<filelen)
|
||||
{
|
||||
if(print)
|
||||
printf("BIOS contents does not match file %s, from byte $%x\n",
|
||||
name,i);
|
||||
} else
|
||||
{
|
||||
if(print)
|
||||
printf("BIOS contents match file %s for all of its $%x bytes\n",
|
||||
name,i);
|
||||
same=1;
|
||||
}
|
||||
return same;
|
||||
}
|
||||
|
||||
void writebios(char *name,int len,unsigned char *id)
|
||||
{
|
||||
int i;
|
||||
int p1,p2;
|
||||
int sectorsize=128;
|
||||
|
||||
if(len!=loadfile(name))
|
||||
{
|
||||
printf("File size does not match expected ROM size\n");
|
||||
return;
|
||||
}
|
||||
if(0 && (id[0]!=0xbf || id[1]!=0xb6))
|
||||
{
|
||||
printf("Don't know how to write this kind of flash device\n");
|
||||
return;
|
||||
}
|
||||
|
||||
printf("Erasing device\n");
|
||||
set(0x5555,fixb(0xaa));
|
||||
set(0x2aaa,fixb(0x55));
|
||||
set(0x5555,fixb(0x80));
|
||||
set(0x5555,fixb(0xaa));
|
||||
set(0x2aaa,fixb(0x55));
|
||||
set(0x5555,fixb(0x10));
|
||||
|
||||
for(;;)
|
||||
{
|
||||
printf(".");fflush(stdout);
|
||||
usleep(250000);
|
||||
if(get(0)==get(0) && get(0)==get(0))
|
||||
break;
|
||||
}
|
||||
printf("BIOS erased\n");
|
||||
|
||||
printf("Writing to BIOS\n");
|
||||
p1=-1;
|
||||
for(i=0;i<len;++i)
|
||||
{
|
||||
p2=100*i/(len-1);
|
||||
if(p2!=p1)
|
||||
{
|
||||
printf("\r%d%%",p1=p2);
|
||||
fflush(stdout);
|
||||
}
|
||||
if(i%sectorsize==0)
|
||||
{
|
||||
set(0x5555,fixb(0xaa));
|
||||
set(0x2aaa,fixb(0x55));
|
||||
set(0x5555,fixb(0xa0));
|
||||
}
|
||||
set(i,buffer[i]);
|
||||
if(i%sectorsize==sectorsize-1)
|
||||
while(get(0)!=get(0) || get(0)!=get(0));
|
||||
}
|
||||
printf("\n");
|
||||
}
|
||||
|
||||
void helptext(char *name)
|
||||
{
|
||||
printf("USE: %s <options>\n",name);
|
||||
printf(" -v <filename> = verify bios rom contents with file\n");
|
||||
printf(" -w <filename> = write to bios rom contents from file\n");
|
||||
printf(" -r <filename> = read from bios rom contents to file\n");
|
||||
printf(" -f = force erase/write even if contents already match\n");
|
||||
exit(0);
|
||||
}
|
||||
|
||||
int main(int argc,char **argv)
|
||||
{
|
||||
int i;
|
||||
int vals;
|
||||
unsigned char id[4];
|
||||
char *filename=0;
|
||||
char action=0;
|
||||
int romsize;
|
||||
int force=0;
|
||||
int same;
|
||||
|
||||
vals=0;
|
||||
|
||||
if(argc<2) helptext(argv[0]);
|
||||
for(i=1;i<argc;++i)
|
||||
{
|
||||
if(argv[i][0]!='-')
|
||||
helptext(argv[0]);
|
||||
switch(argv[i][1])
|
||||
{
|
||||
case 'f':
|
||||
force=1;
|
||||
break;
|
||||
case 'v':
|
||||
case 'w':
|
||||
case 'r':
|
||||
action=argv[i][1];
|
||||
if(i+1<argc)
|
||||
filename=argv[++i];
|
||||
else helptext(argv[0]);
|
||||
break;
|
||||
default:
|
||||
helptext(argv[0]);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
buffer=malloc(MAXROMSIZE);
|
||||
if(!buffer)
|
||||
{
|
||||
printf("No memory available!\n");
|
||||
exit(-1);
|
||||
}
|
||||
|
||||
set(0x5555,fixb(0xaa)); // get into flash ID mode
|
||||
set(0x2aaa,fixb(0x55));
|
||||
set(0x5555,fixb(0x90));
|
||||
|
||||
for(i=0;i<4;++i) id[i]=get(i);
|
||||
|
||||
set(0x5555,fixb(0xaa)); // get out of flash ID mode
|
||||
set(0x2aaa,fixb(0x55));
|
||||
set(0x5555,fixb(0xf0));
|
||||
usleep(10000);
|
||||
|
||||
for(i=0;i<4;++i)
|
||||
if(id[i]!=get(i)) break;
|
||||
if(i==4)
|
||||
{
|
||||
printf("Could not read BIOS flashrom ID.\n");
|
||||
goto biosdone;
|
||||
}
|
||||
printf("ID %02x %02x\n",id[0],id[1]);
|
||||
romsize=getromsize(id);
|
||||
if(romsize<0)
|
||||
{
|
||||
printf("Unknown rom type\n");
|
||||
goto biosdone;
|
||||
}
|
||||
printf("romsize=$%x bytes\n",romsize);
|
||||
if(action=='r')
|
||||
readbios(filename,romsize);
|
||||
if(action=='w')
|
||||
{
|
||||
if(!force)
|
||||
same=verifybios(filename,romsize,0);
|
||||
else
|
||||
same=0;
|
||||
if(!same)
|
||||
writebios(filename,romsize,id);
|
||||
}
|
||||
if(action=='v' || action=='w')
|
||||
verifybios(filename,romsize,1);
|
||||
|
||||
biosdone:
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user