bullshit commit, sync for travel (to zn00H!) :)
[my-code/arm.git] / betty / lpcload.c
index 19d5a5b..38d5386 100644 (file)
@@ -4,7 +4,7 @@
  * author: hackbard@hackdaworld.org, rolf.anders@physik.uni-augsburg.de
  *
  * build: make
- * usage: sudo ./lpcload -d /dev/ttyS0 -f firmware.hex [-v]
+ * usage: sudo ./lpcload -d /dev/ttyS0 -f firmware.hex -D0 fw0.bin [-v]
  */
 
 #include <stdio.h>
@@ -21,6 +21,8 @@
 #define BANK0                  (1<<2)
 #define BANK2                  (1<<3)
 #define BL                     (1<<4)
+#define FLASHFW                        (1<<5)
+#define BINARY                 (1<<6)
 
 #define BANK0_ADDR             0x80000000
 #define BANK2_ADDR             0x82000000
@@ -29,6 +31,8 @@
 #define BL_SIZE                        0x00002000
 
 #define CMD_READ               'R'             // stay compatible to fwflash!
+#define CMD_WRITE              'W'
+#define CMD_CHIP_ERASE         'E'
 
 #define TXRX_TYPE_SYNC         0x00
 #define TXRX_TYPE_CKSM         0x00
@@ -54,6 +58,9 @@
 #define INVALID_BAUD_RATE      "17\r\n"
 #define INVALID_STOP_BIT       "18\r\n"
 
+#define RAM                    0x01
+#define FLASH                  0x02
+
 #define CRYSTFREQ              "10000"
 #define RAMOFFSET              0x40000200
 
@@ -68,7 +75,7 @@ typedef struct s_lpc {
        char sdev[128];         /* seriel device */
        int fwfd;               /* fimrware fd */
        char fwfile[128];       /* firmware file */
-       u8 info;                /* info/mode */
+       u32 info;               /* info/mode */
        char freq[8];           /* frequency */
        char bank0[127];        /* flash dump bank0 */
        int b0fd;               /* dumpfile fd bank0 */
@@ -76,6 +83,8 @@ typedef struct s_lpc {
        int b2fd;               /* dumpfile fd bank0 */
        char bl[127];           /* flash dump bootloader */
        int blfd;               /* dumpfile fd bootloader */
+       char ffwfile[127];      /* file with firmware to be flashed */
+       int ffwfd;              /* fd of the above */
        u32 roff;               /* ram offset of uc */
        u32 jaddr;              /* addr for the jump */
 } t_lpc;
@@ -88,6 +97,8 @@ void usage(void) {
        printf("  -c  <crystal freq>\n");
        printf("  -Dx <filename>\n");
        printf("      x=0: bank0, x=2: bank2, x=b: bootloader\n");
+       printf("  -w <firmware which goes to flash>\n");
+       printf("  -b (if firmware for flash is a binary)\n");
        printf("  -v\n");
 
 }
@@ -165,6 +176,11 @@ int reconfig_serial_device(t_lpc *lpc) {
        cfsetispeed(&term,B115200);
        cfsetospeed(&term,B115200);
 
+       // timeouts
+       
+       term.c_cc[VMIN]=0;
+       term.c_cc[VTIME]=100;   // 10 seconds timeout
+
        ret=tcsetattr(lpc->sfd,TCSANOW,&term);
 
        return ret;
@@ -176,8 +192,18 @@ int open_firmware(t_lpc *lpc) {
 
        lpc->fwfd=open(lpc->fwfile,O_RDONLY);
 
-       if(lpc->fwfd<0)
+       if(lpc->fwfd<0) {
                perror("fw open");
+               return lpc->fwfd;
+       }
+
+       if(lpc->info&FLASHFW) {
+               lpc->ffwfd=open(lpc->ffwfile,O_RDONLY);
+               if(lpc->ffwfd<0) {
+                       perror("ffw open");
+                       return lpc->ffwfd;
+               }
+       }
 
        return lpc->fwfd;
 }
@@ -490,17 +516,144 @@ int write_to_ram(t_lpc *lpc,char *buf,u32 addr,int len) {
        return 0;
 }
 
-int firmware_to_ram(t_lpc *lpc) {
+int send_cmd(int sfd,u32 addr,u32 len,u8 cmd) {
+
+       int ret,i,cnt,size;
+       int as,ls;
+       u8 send[9];
+
+       switch(cmd) {
+               case CMD_READ:
+               case CMD_WRITE:
+                       as=4;
+                       ls=4;
+                       break;
+               case CMD_CHIP_ERASE:
+                       as=0;
+                       ls=1;
+                       break;
+               default:
+                       printf("send cmd: cmd '%02x' not supported\n",cmd);
+                       return -1;
+       }
+
+       size=1+as+ls;
+       send[0]=cmd;
+
+       for(i=0;i<as;i++)
+               send[1+i]=(addr>>((as-1-i)*8))&0xff;
+       for(i=0;i<ls;i++)
+               send[1+i+as]=(len>>((ls-1-i)*8))&0xff;
+
+       cnt=0;
+       while(size) {
+               ret=write(sfd,send+cnt,size);
+               if(ret<0) {
+                       perror("dump file: send cmd ");
+                       return ret;
+               }
+               size-=ret;
+               cnt+=ret;
+       }
+
+       /* flush  */
+       tcflush(sfd,TCIOFLUSH);
+
+       return 0;
+}
+
+int write_to_flash(t_lpc *lpc,u8 *buf,u32 addr,int len) {
+
+       int cnt,ret;
+       u8 cksml,cksmr;
+       int i;
+
+       /* prepare addr */
+       addr+=lpc->roff;
+
+       /* send cmd */
+       send_cmd(lpc->sfd,addr,len,CMD_WRITE);
+
+       /* transfer data */
+       cnt=0;
+       cksml=0;
+       while(len) {
+               ret=write(lpc->sfd,buf+cnt,len);
+               if(ret<0) {
+                       perror("transmit flash content (w)");
+                       return ret;
+               }
+               for(i=cnt;i<cnt+ret;i++)
+                       cksml+=buf[i];
+               len-=ret;
+               cnt+=ret;
+       }
+
+
+       /* check ack */
+       while(1) {
+               ret=read(lpc->sfd,&cksmr,1);
+               if(ret<0) {
+                       perror("write to flash: read cksm");
+                       return ret;
+               }
+               if(ret==1) break;
+       }
+       if(cksml!=cksmr) {
+               printf("FATAL: wrong checksum or failure in flash write!\n");
+               if(cksml+1==cksmr)
+                       printf(" -> most probably due to flash write!\n");
+               else
+                       printf(" -> most probably failure in transfer!\n");
+               printf(" addr:0x%08x l:%02x r:%02x\n",addr,cksml,cksmr);
+       }
+
+       return 0;
+}
+
+int firmware_to_mem(t_lpc *lpc,u8 memtype) {
 
        char buf[BUFSIZE];
        u32 addr,len,type;
        int ret,temp;
+       int fd;
+
+       /* prepare for memory type */
+       if(memtype==RAM)
+               fd=lpc->fwfd;
+       else if(memtype==FLASH)
+               fd=lpc->ffwfd;
+       else
+               return -1;
+
+       /* another evil hack to support binary format */
+       if((lpc->info&BINARY)&&(memtype==FLASH)) {
+               addr=0;
+               ret=1;
+               while(ret) {
+                       ret=read(fd,buf,16);
+                       if(ret!=16) {
+                               printf("D'OH ...\n");
+                               return -1;
+                       }
+                       buf[16]='s'; // skip
+                       for(temp=0;temp<16;temp++)
+                               if((u8)buf[temp]!=0xff)
+                                       buf[16]='w'; // write
+                       printf("addr:%08x\r",addr+lpc->roff);
+                       fflush(stdout);
+                       if(buf[16]=='w') 
+                               write_to_flash(lpc,(u8 *)buf,addr,16);
+                       addr+=16;
+               }
+               return 0;
+       }
 
        /* read a line */
        ret=1;
        while(ret) {
                /* sync line */
-               ret=read(lpc->fwfd,buf,1);
+               ret=read(fd,buf,1);
                switch(buf[0]) {
                        case '\r':
                                continue;
@@ -510,25 +663,25 @@ int firmware_to_ram(t_lpc *lpc) {
                                /* start code */
                                break;
                        default:
-                               printf("fw to ram: no ihex format\n");
+                               printf("fw to mem: no ihex format\n");
                                return -1;
                }
                /* read len */
-               ret=read(lpc->fwfd,buf,2);
+               ret=read(fd,buf,2);
                sscanf(buf,"%02x",&len);
                /* read addr */
-               ret=read(lpc->fwfd,buf,4);
+               ret=read(fd,buf,4);
                sscanf(buf,"%04x",&addr);
                /* read type */
-               ret=read(lpc->fwfd,buf,2);
+               ret=read(fd,buf,2);
                sscanf(buf,"%02x",&type);
                /* successfull return if type is end of file */
                if(type==0x01)
                        return 0;
                /* read data (and cksum) */
-               ret=read(lpc->fwfd,buf,2*(len+1));
+               ret=read(fd,buf,2*(len+1));
                if(ret!=(2*(len+1))) {
-                       printf("fw to ram: data missing\n");
+                       printf("fw to mem: data missing\n");
                                return -1;
                }
                for(ret=0;ret<len;ret++) {
@@ -542,10 +695,13 @@ int firmware_to_ram(t_lpc *lpc) {
                        //      break;
                        case 0x00:
                                if(len%4) {
-                                       printf("fw to ram: invalid len\n");
+                                       printf("fw to mem: invalid len\n");
                                        return -1;
                                }
-                               write_to_ram(lpc,buf,addr,len);
+                               if(memtype==RAM)
+                                       write_to_ram(lpc,buf,addr,len);
+                               else
+                                       write_to_flash(lpc,(u8 *)buf,addr,len);
                                break;
                        case 0x04:
                                lpc->roff=((buf[0]<<24)|(buf[1]<<16));
@@ -555,7 +711,7 @@ int firmware_to_ram(t_lpc *lpc) {
                                lpc->jaddr|=((buf[2]<<8)|buf[3]);
                                break;
                        default:
-                               printf("fw to ram: unknown type %02x\n",type);
+                               printf("fw to mem: unknown type %02x\n",type);
                                return -1;
                }
        }
@@ -585,36 +741,12 @@ int dump_files(int sfd,int dfd,u32 addr,u32 len) {
        int ret;
        int size;
        int cnt;
-       int i;
        u8 buf[16];
 
        printf("dumping content (addr=0x%08x, len=0x%08x) ...\n",addr,len);
 
-       /* send cmd */
-       size=1+4+4;
-       cnt=0;
-       buf[0]=CMD_READ;
-       buf[1]=(addr>>24)&0xff;
-       buf[2]=(addr>>16)&0xff;
-       buf[3]=(addr>>8)&0xff;
-       buf[4]=addr&0xff;
-       buf[5]=(len>>24)&0xff;
-       buf[6]=(len>>16)&0xff;
-       buf[7]=(len>>8)&0xff;
-       buf[8]=len&0xff;
-       printf("  sending cmd: ");
-       while(size) {
-               ret=write(sfd,buf+cnt,size);
-               for(i=cnt;i<cnt+ret;i++)
-                       printf("%02x ",buf[i]);
-               if(ret<0) {
-                       perror("dump file: send cmd ");
-                       return ret;
-               }
-               size-=ret;
-               cnt+=ret;
-       }
-       printf("\n");
+       /* send the cmd */
+       send_cmd(sfd,addr,len,CMD_READ);
 
        /* receive data and dump it to file */
        ret=1;
@@ -700,7 +832,13 @@ int main(int argc,char **argv) {
                                        usage();
                                        return -1;
                                }
-                               
+                       case 'w':
+                               strncpy(lpc.ffwfile,argv[++i],127);
+                               lpc.info|=FLASHFW;
+                               break;
+                       case 'b':
+                               lpc.info|=BINARY;
+                               break;
                        default:
                                usage();
                                return -1;
@@ -733,7 +871,7 @@ int main(int argc,char **argv) {
 
        /* parse intel hex file and write to ram */
        printf("write firmware to ram ...\n");
-       firmware_to_ram(&lpc);
+       firmware_to_mem(&lpc,RAM);
 
        /* unlock go cmd */
        printf("unlock go command ...\n");
@@ -758,6 +896,18 @@ int main(int argc,char **argv) {
        if(lpc.info&BL)
                dump_files(lpc.sfd,lpc.blfd,BL_ADDR,BL_SIZE);
 
+       /* write a firmware to the lpc flash */
+       if(lpc.info&FLASHFW) {
+               printf("writing firmware to flash ...\n");
+               send_cmd(lpc.sfd,0,'0',CMD_CHIP_ERASE);
+               /* ack */
+               ret=0;
+               while(!ret)
+                       read(lpc.sfd,&ret,1);
+               lpc.roff=BANK0_ADDR;
+               firmware_to_mem(&lpc,FLASH);
+       }
+
 end:
        if(lpc.sfd)
                close(lpc.sfd);
@@ -769,6 +919,8 @@ end:
                close(lpc.b2fd);
        if(lpc.blfd)
                close(lpc.blfd);
+       if(lpc.ffwfd)
+               close(lpc.ffwfd);
 
        return 0;
 }