From: hackbard <hackbard@staubsauger.localdomain>
Date: Sat, 1 Sep 2007 20:03:17 +0000 (+0200)
Subject: lpcload, added support for writing data to flash (untested!)
X-Git-Url: https://hackdaworld.org/cgi-bin/gitweb.cgi?a=commitdiff_plain;h=0f5679e8fd5b03c53a332a94f85008b0494fbd2e;p=my-code%2Farm.git

lpcload, added support for writing data to flash (untested!)
---

diff --git a/betty/lpcload.c b/betty/lpcload.c
index 1cbeb07..4f62a59 100644
--- a/betty/lpcload.c
+++ b/betty/lpcload.c
@@ -21,6 +21,7 @@
 #define BANK0			(1<<2)
 #define BANK2			(1<<3)
 #define BL			(1<<4)
+#define FLASHFW			(1<<5)
 
 #define BANK0_ADDR		0x80000000
 #define BANK2_ADDR		0x82000000
@@ -29,6 +30,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 +57,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 +74,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 +82,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 +96,7 @@ 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("  -v\n");
 
 }
@@ -176,8 +185,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 +509,97 @@ 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;
+	printf("  sending cmd: ");
+	while(size) {
+		ret=write(sfd,send+cnt,size);
+		if(ret<0) {
+			perror("dump file: send cmd ");
+			return ret;
+		}
+		for(i=cnt;i<cnt+ret;i++)
+			printf("%02x ",send[i]);
+		size-=ret;
+		cnt+=ret;
+	}
+	printf("\n");
+
+	return 0;
+}
+
+int write_to_flash(t_lpc *lpc,char *buf,u32 addr,int len) {
+
+	int cnt,size,ret;
+
+	/* send cmd */
+	send_cmd(lpc->sfd,addr,len,CMD_WRITE);
+
+	/* transfer data */
+	while(len) {
+		size=2;
+		while(size) {
+			ret=write(lpc->sfd,buf+cnt,2);
+			if(ret<0) {
+				perror("transmit flash content");
+				return ret;
+			}
+			size-=ret;
+		}
+		cnt+=2;
+	}
+
+	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;
 
 	/* 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 +609,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 +641,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,buf,addr,len);
 				break;
 			case 0x04:
 				lpc->roff=((buf[0]<<24)|(buf[1]<<16));
@@ -555,7 +657,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 +687,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 +778,10 @@ int main(int argc,char **argv) {
 					usage();
 					return -1;
 				}
-				
+			case 'w':
+				strncpy(lpc.ffwfile,argv[++i],127);
+				lpc.info|=FLASHFW;
+				break;
 			default:
 				usage();
 				return -1;
@@ -733,7 +814,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 +839,13 @@ 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) {
+		send_cmd(lpc.sfd,0,0,CMD_CHIP_ERASE);
+		lpc.roff=BANK0_ADDR;
+		firmware_to_mem(&lpc,FLASH);
+	}
+
 end:
 	if(lpc.sfd)
 		close(lpc.sfd);
@@ -769,6 +857,8 @@ end:
 		close(lpc.b2fd);
 	if(lpc.blfd)
 		close(lpc.blfd);
+	if(lpc.ffwfd)
+		close(lpc.ffwfd);
 
 	return 0;
 }