first cut at turnon scripts for EasyTimer v2

[fw/altos] / src / lpc / ao_flash_lpc.c

diff --git a/src/lpc/ao_flash_lpc.c b/src/lpc/ao_flash_lpc.c
index cb1a060668a173ba6e1c4634c26b8ba887924065..541fbb65968ce23898709f3d11935231f055041d 100644 (file)
--- 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