--- embedtools/src/athctl.c	2010/10/25 14:46:30	1.1.2.4
+++ embedtools/src/athctl.c	2010/11/03 14:34:58	1.1.2.10
@@ -3,7 +3,7 @@
  *  by Michael Pounov <misho@aitbg.com>
  *
  * $Author: misho $
- * $Id: athctl.c,v 1.1.2.4 2010/10/25 14:46:30 misho Exp $
+ * $Id: athctl.c,v 1.1.2.10 2010/11/03 14:34:58 misho Exp $
  *
  *************************************************************************/
 #include "global.h"
@@ -170,12 +170,13 @@ devClose(void *basemem)
 		munmap(basemem, ATH_PCI_MEM_SIZE);
 }
 
-static inline short
+static inline int
 readWord(u_char *mem, u_long offset)
 {
 	register int timeout = ATH_ACCESS_TIMEOUT;
 	u_long stat;
 
+	VERB(2) printf("Reading EEPROM memory %p+%lx ...\n", mem, offset);
 	ATH_OUT(mem, AR5211_EEPROM_CONF, 0);
 	usleep(ATH_ACCESS_WAIT);
  	/* enable eeprom access */
@@ -198,21 +199,22 @@ readWord(u_char *mem, u_long offset)
 			}
 
 			stat = ATH_IN(mem, AR5211_EEPROM_DATA);
-			return stat & 0x0000ffff;
+			return (stat & 0x0000ffff) << 16;
 		}
 	}
 
 	printf("Error:: EEPROM read timeout!\n");
-	return 0;
+	return -1;
 }
 
-static inline short
+static inline int
 writeWord(u_char *mem, u_long offset, u_short newval)
 {
 	register int i = ATH_WRITE_RETRY, timeout;
 	u_long pcicfg, stat;
 	u_short chk;
 
+	VERB(2) printf("Writing EEPROM memory %p+%lx ...\n", mem, offset);
  	/* enable pci write access */
 	pcicfg = ATH_IN(mem, AR5K_PCICFG);
 	ATH_OUT(mem, AR5K_PCICFG, (pcicfg & ~AR5K_PCICFG_SPWR_DN));
@@ -254,27 +256,118 @@ writeWord(u_char *mem, u_long offset, u_short newval)
 		if (chk == (u_short) -1)
 			return -1;
 		if (chk == newval)
-			return 1;
+			return chk << 16;
+		else
+			VERB(1) printf("Write & Read don`t match 0x%04X != 0x%04X\n", newval, chk);
 		if (i)
 			printf("Warning:: Retrying EEPROM write ...\n");
 	} while (--i);
 
 	printf("Error:: EEPROM write timeout!\n");
-	return 0;
+	return -1;
 }
 
-/*
 static int
-readEEPROM()
+dumpFile(const char *csName, u_char *mem)
 {
 	register u_long i;
+	u_short d1, d2;
+	u_short eeprom[ATH_EEPROM_SIZE] = { 0 };
+	int f, data;
 
-	printf("Reading EEPROM ...\n");
+	VERB(2) printf("Reading EEPROM memory %p ::\n", mem);
 	for (i = 0; i < ATH_EEPROM_SIZE / 2; i++) {
+		if (!(i % 0x40)) {
+			if (i)
+				printf("]\n");
+			printf("0x%04lX [", i * 2);
+		}
+
+		if ((data = readWord(mem, i)) == -1)
+			return -1;
+		else {
+			d1 = ((u_short) data >> 16) / 0x100;
+			d2 = ((u_short) data >> 16) % 0x100;
+		}
+
+		eeprom[i * 2] = d2;
+		eeprom[i * 2 + 1] = d1;
+
+		printf(".");
+		usleep(ATH_ACCESS_WAITDOWN);
 	}
+	printf("]\n");
+
+	VERB(2) printf("Saving EEPROM to file %s ... ", csName);
+	f = open(csName, O_WRONLY | O_CREAT | O_TRUNC, 0644);
+	if (f == -1) {
+		printf("Failed!\nError:: in create file %s #%d - %s\n", csName, 
+				errno, strerror(errno));
+		return 0;
+	}
+	if (write(f, eeprom, ATH_EEPROM_SIZE) == -1) {
+		printf("Failed!\nError:: in write to file %s #%d - %s\n", csName, 
+				errno, strerror(errno));
+		close(f);
+		return 0;
+	}
+	close(f);
+	printf("OK!\n");
+	return 1;
 }
-*/
 
+static int
+flashFile(const char *csName, u_char *mem)
+{
+	register u_long i;
+	u_short d1;
+	u_short eeprom[ATH_EEPROM_SIZE] = { 0 };
+	int f, data;
+
+	VERB(2) printf("Reading EEPROM from file %s ... ", csName);
+	f = open(csName, O_RDONLY);
+	if (f == -1) {
+		printf("Failed!\nError:: in open file %s #%d - %s\n", csName, 
+				errno, strerror(errno));
+		return 0;
+	}
+	if (read(f, eeprom, ATH_EEPROM_SIZE) != ATH_EEPROM_SIZE) {
+		printf("Failed!\nError:: failed load image from file %s\n", csName);
+		close(f);
+		return 0;
+	}
+	close(f);
+	printf("OK!\n");
+
+	VERB(2) printf("Writing EEPROM memory %p ::\n", mem);
+	for (i = 0; i < ATH_EEPROM_SIZE / 2; i++) {
+		if (!(i % 0x40)) {
+			if (i)
+				printf("]\n");
+			printf("0x%04lX [", i * 2);
+		}
+
+		if ((data = readWord(mem, i)) == -1)
+			return -1;
+		else
+			d1 = eeprom[i * 2 + 1] * 0x100 + eeprom[i * 2];
+
+		if ((data >> 16) == d1)
+			printf(".");
+		else {
+			printf("x");
+
+			if (writeWord(mem, i, d1) < 1)
+				return -1;
+		}
+
+		usleep(ATH_ACCESS_WAITDOWN);
+	}
+	printf("]\n");
+
+	return 0;
+}
+
 // ----------------------------------------------------
 
 int
@@ -371,16 +464,37 @@ main(int argc, char **argv)
 	if (mode & 4) {
 		if (!(basemem = devOpen(baseaddr)))
 			return 2;
-		if ((ret = readWord(basemem, offset)) < 1) {
+		if ((ret = readWord(basemem, offset)) == -1) {
 			devClose(basemem);
 			return 3;
-		}
+		} else
+			printf("EEPROM readed value 0x%04X\n", (u_short) ret >> 16);
 		devClose(basemem);
 	}
 	if (mode & 8) {
 		if (!(basemem = devOpen(baseaddr)))
 			return 2;
-		if ((ret = writeWord(basemem, offset, newval)) < 1) {
+		if ((ret = writeWord(basemem, offset, newval)) == -1) {
+			devClose(basemem);
+			return 3;
+		} else
+			printf("EEPROM writed value 0x%04X\n", (u_short) ret);
+		devClose(basemem);
+	}
+
+	if (mode & 0x10) {
+		if (!(basemem = devOpen(baseaddr)))
+			return 2;
+		if ((ret = dumpFile(szName, basemem)) < 1) {
+			devClose(basemem);
+			return 3;
+		}
+		devClose(basemem);
+	}
+	if (mode & 0x20) {
+		if (!(basemem = devOpen(baseaddr)))
+			return 2;
+		if ((ret = flashFile(szName, basemem)) < 1) {
 			devClose(basemem);
 			return 3;
 		}