X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Flpc%2Fao_flash_lpc.c;h=541fbb65968ce23898709f3d11935231f055041d;hb=bac27453db0ebfad1c27745200fe6f168d26bd43;hp=cb1a060668a173ba6e1c4634c26b8ba887924065;hpb=1085ec5d57e0ed5d132f2bbdac1a0b6a32c0ab4a;p=fw%2Faltos

diff --git a/src/lpc/ao_flash_lpc.c b/src/lpc/ao_flash_lpc.c
index cb1a0606..541fbb65 100644
--- a/src/lpc/ao_flash_lpc.c
+++ b/src/lpc/ao_flash_lpc.c
@@ -73,10 +73,12 @@ iap(uint32_t *in, uint32_t *out)
 
 static uint32_t	iap_in[5], iap_out[5];
 
+#if IS_FLASH_LOADER
+
 static uint32_t
 ao_lpc_addr_to_sector(uint8_t *addr)
 {
-	uint32_t	off = addr - LPC_FLASH_BASE;
+	uint32_t	off = (uint32_t) (addr - LPC_FLASH_BASE);
 
 	return off >> LPC_FLASH_SECTOR_SHIFT;
 }
@@ -84,7 +86,7 @@ ao_lpc_addr_to_sector(uint8_t *addr)
 static uint8_t
 ao_lpc_addr_is_sector_aligned(uint8_t *addr)
 {
-	uint32_t	off = addr - LPC_FLASH_BASE;
+	uint32_t	off = (uint32_t) (addr - LPC_FLASH_BASE);
 	return		(off & LPC_FLASH_SECTOR_MASK) == 0;
 }
 
@@ -157,3 +159,45 @@ ao_flash_page(uint8_t *page, uint8_t *src)
 	ret = ao_lpc_copy_ram_to_flash(page, src, 256, AO_LPC_SYSCLK / 1000);
 	return ret;
 }
+
+#endif
+
+#if LPC_EEPROM_BYTES
+
+/*
+ * Write to eeprom
+ */
+
+uint8_t
+ao_eeprom_write(ao_pos_t pos, void *v, uint16_t len)
+{
+	iap_in[0] = LPC_IAP_EEPROM_WRITE;
+	iap_in[1] = (uint32_t) pos;
+	iap_in[2] = (uint32_t) v;
+	iap_in[3] = (uint32_t) len;
+	iap_in[4] = AO_LPC_SYSCLK / 1000;
+	iap(iap_in,iap_out);
+	return iap_out[0] == LPC_IAP_CMD_SUCCESS;
+}
+
+/*
+ * Read from eeprom
+ */
+uint8_t
+ao_eeprom_read(ao_pos_t pos, void *v, uint16_t len)
+{
+	iap_in[0] = LPC_IAP_EEPROM_READ;
+	iap_in[1] = (uint32_t) pos;
+	iap_in[2] = (uint32_t) v;
+	iap_in[3] = (uint32_t) len;
+	iap_in[4] = AO_LPC_SYSCLK / 1000;
+	iap(iap_in,iap_out);
+	return iap_out[0] == LPC_IAP_CMD_SUCCESS;
+}
+
+void
+ao_eeprom_init(void)
+{
+	/* Nothing to do here */
+}
+#endif