123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310 |
- /*
- 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;
- }
|