X-Git-Url: https://hackdaworld.org/gitweb/?p=my-code%2Farm.git;a=blobdiff_plain;f=betty%2Flpcload.c;h=748a0963c06a1a2781412822b4dbc5e7ec14fab4;hp=4f62a59253febac2fd3f716dce996f3b69eb2f16;hb=eca427bb7d2ac0dbd337a3797fcea63991c51b38;hpb=2cbc6d2f18a38237fcd1df2ef67ba315af080f03

diff --git a/betty/lpcload.c b/betty/lpcload.c
index 4f62a59..748a096 100644
--- a/betty/lpcload.c
+++ b/betty/lpcload.c
@@ -539,31 +539,30 @@ int send_cmd(int sfd,u32 addr,u32 len,u8 cmd) {
 		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 write_to_flash(t_lpc *lpc,u8 *buf,u32 addr,int len) {
 
 	int cnt,size,ret;
+	u8 cksm;
 
 	/* send cmd */
-	send_cmd(lpc->sfd,addr,len,CMD_WRITE);
+	send_cmd(lpc->sfd,addr+lpc->roff,len,CMD_WRITE);
 
 	/* transfer data */
+	cnt=0;
+	cksm=0;
 	while(len) {
 		size=2;
 		while(size) {
@@ -574,7 +573,21 @@ int write_to_flash(t_lpc *lpc,char *buf,u32 addr,int len) {
 			}
 			size-=ret;
 		}
+		cksm+=buf[cnt];
+		cksm+=buf[cnt+1];
 		cnt+=2;
+		len-=2;
+	}
+
+	/* check ack */
+	ret=read(lpc->sfd,buf,1);
+	if(ret<0) {
+		perror("write to flash: ack rx");
+		return ret;
+	}
+	if(buf[0]!=cksm) {
+		printf("FATAL: write to ram: wrong checksum!\n");
+		return -1;
 	}
 
 	return 0;
@@ -647,7 +660,7 @@ int firmware_to_mem(t_lpc *lpc,u8 memtype) {
 				if(memtype==RAM)
 					write_to_ram(lpc,buf,addr,len);
 				else
-					write_to_flash(lpc,buf,addr,len);
+					write_to_flash(lpc,(u8 *)buf,addr,len);
 				break;
 			case 0x04:
 				lpc->roff=((buf[0]<<24)|(buf[1]<<16));
@@ -841,7 +854,8 @@ int main(int argc,char **argv) {
 
 	/* write a firmware to the lpc flash */
 	if(lpc.info&FLASHFW) {
-		send_cmd(lpc.sfd,0,0,CMD_CHIP_ERASE);
+		printf("writing firmware to flash ...\n");
+		send_cmd(lpc.sfd,0,'0',CMD_CHIP_ERASE);
 		lpc.roff=BANK0_ADDR;
 		firmware_to_mem(&lpc,FLASH);
 	}