X-Git-Url: https://hackdaworld.org/gitweb/?p=my-code%2Farm.git;a=blobdiff_plain;f=betty%2Ffwflash.c;h=e2f78d9895b6a039e1d3360ccfc6b6b23b85f68c;hp=8d837e780cb5e2e5b2ca63ada07df815ab70b55e;hb=f8569c0f53d6b77d5d69d8e31a9d2c25b654265c;hpb=79f5270f51c65d6155462e3d8a9ad967ef312d80

diff --git a/betty/fwflash.c b/betty/fwflash.c
index 8d837e7..e2f78d9 100644
--- a/betty/fwflash.c
+++ b/betty/fwflash.c
@@ -9,16 +9,24 @@
  * include files
  */
 
+#include <stdio.h>
+
 #include "lpc2xxx.h"
 
 /*
  * defines
  */
 
-/* band 0/2 addr */
+/* bank 0/2 addr */
 #define BANK0			0x80000000
 #define BANK2			0x82000000
 
+/* flash cmd addresses */
+#define B0F555	(*((volatile unsigned long *)(BANK0|0x555)))
+#define B0F2AA	(*((volatile unsigned long *)(BANK0|0x2aa)))
+#define B2F555	(*((volatile unsigned long *)(BANK2|0x555)))
+#define B2F2AA	(*((volatile unsigned long *)(BANK2|0x2aa)))
+
 /* commands */
 #define CMD_READ		'R'
 #define CMD_CHIP_ERASE		'E'
@@ -38,10 +46,14 @@ typedef unsigned int u32;
  */
 
 #define TX_BYTE(x)		while(!(UART0_LSR&(1<<5))) continue; \
-				UART0_THR=x;
+				UART0_THR=x
+
+#define TX_NL			TX_BYTE('\n'); TX_BYTE('\r')
 
-#define SEND_OK			TX_BYTE('o'); TX_BYTE('k'); TX_BYTE('\n'); \
-				TX_BYTE('\r');
+#define TX_STRING(x,len)	for(scnt=0;scnt<len;scnt++) { 	\
+					TX_BYTE(x[scnt]);	\
+				}				\
+				TX_NL
 
 /*
  * function prototypes
@@ -52,6 +64,12 @@ void uart0_init(void);
 void uart0_send_string(char *txbuf);
 void uart0_send_char(char send);
 
+/*
+ * global variables
+ */
+
+int scnt;
+
 /*
  * main function
  */
@@ -84,8 +102,7 @@ int main(void) {
 
 	/* external memory init */
 
-	BCFG0=0x1000FBEF;		// no boot[1:0] influence? (thnx colibri)
-					// BCFG2 should be fine as is
+	BCFG0=0x1000FBEF;		// BCFG2 should be fine as is
 
 	/* begin the main loop */
 	while(1) {
@@ -98,7 +115,6 @@ int main(void) {
 		cmd=UART0_RBR;
 
 		if(cmd==CMD_CHIP_ERASE) {
-SEND_OK
 			addrlen=0;
 			datalen=1;
 			break;
@@ -115,19 +131,20 @@ SEND_OK
 
 	addr=0;
 	for(i=0;i<addrlen;i++) {
+		//TX_STRING("got addr",8);
 		while(!(UART0_LSR&(1<<0)))
 			continue;
 		txrx=UART0_RBR;
-		addr|=(txrx<<(i*4));
+		//addr|=(txrx<<((addrlen-i-1)*4));
+		addr=0x80000000;
 	}
-SEND_OK
 
 	for(i=0;i<datalen;i++) {
+		//TX_STRING("got data",8);
 		while(!(UART0_LSR&(1<<0)))
 			continue;
-		buf[i++]=UART0_RBR;
+		buf[i]=UART0_RBR;
 	}
-SEND_OK
 
 	/* process the cmd */
 
@@ -140,29 +157,22 @@ SEND_OK
 			}
 			break;	
 		case CMD_CHIP_ERASE:
-			if(buf[0]=='0')
-				addr=BANK0;
-			else if(buf[0]=='2')
-				addr=BANK2;
-			else
-				break;
-			// cycle 1
-			dptr=(u16 *)(addr|0x555);
-			*dptr=0xaa;
-			// cycle 2
-			dptr=(u16 *)(addr|0x2aa);
-			*dptr=0x55;
-			// cycle 3+4
-			dptr=(u16 *)(addr|0x555);
-			*dptr=0x80;
-			*dptr=0xaa;
-			// cycle 5
-			dptr=(u16 *)(addr|0x2aa);
-			*dptr=0x55;
-			// cycle 6
-			dptr=(u16 *)(addr|0x555);
-			*dptr=0x10;
-SEND_OK
+			if(buf[0]=='0') {
+				B0F555=0xaa;
+				B0F2AA=0x55;
+				B0F555=0x80;
+				B0F555=0xaa;
+				B0F2AA=0x55;
+				B0F555=0x10;
+			}
+			else if(buf[0]=='2') {
+				B2F555=0xaa;
+				B2F2AA=0x55;
+				B2F555=0x80;
+				B2F555=0xaa;
+				B2F2AA=0x55;
+				B2F555=0x10;
+			}
 			break;
 		default:
 			break;