X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/f8d7cde0d035f087f39c8076061bd8ef608e14f4..b2be2bbd665328f4ec3dc14d7d84fdbac4c58e11:/embedded/arch/arm/mach-lpc21xx/libs/iap/iap.c

diff --git a/embedded/arch/arm/mach-lpc21xx/libs/iap/iap.c b/embedded/arch/arm/mach-lpc21xx/libs/iap/iap.c
index 9403f68..cc39097 100644
--- a/embedded/arch/arm/mach-lpc21xx/libs/iap/iap.c
+++ b/embedded/arch/arm/mach-lpc21xx/libs/iap/iap.c
@@ -2,6 +2,8 @@
 #include <cpu_def.h>
 #include <hal_machperiph.h>
 
+#define IAP_PLL_FULL_SPEED      1
+
 #define CMD_SUCCESS 0
 #define BUSY 11
 
@@ -21,7 +23,7 @@ inline int addr2sec(unsigned long addr)
 {
   return addr/0x2000;
 }
-#elif defined INC_LPC214x_H
+#elif defined INC_LPC214x_H || defined INC_LPC2348_H
 inline int addr2sec(unsigned long addr)
 {
   if (addr<0x8000) return (addr>>12);
@@ -74,14 +76,18 @@ int lpcisp_erase(void *addr, int len)
   if (end<start) return 0;
 
   save_and_cli(flags);
+ #ifndef IAP_PLL_FULL_SPEED
   lpc_pll_off();
+ #endif
 
   lpcisp_prepare_sectors(start,end);
   if (CMD_SUCCESS != *result) return 0;
 
   lpcisp_erase_sectors(start,end);
 
+ #ifndef IAP_PLL_FULL_SPEED
   lpc_pll_on();
+ #endif
   restore_flags(flags);
 
   return (CMD_SUCCESS == *result);
@@ -96,7 +102,9 @@ int lpcisp_write(void *addr_des, const void *addr_src, int len)
   end=start;
 
   save_and_cli(flags);
+ #ifndef IAP_PLL_FULL_SPEED
   lpc_pll_off();
+ #endif
 
   lpcisp_prepare_sectors(start,end);
   if (CMD_SUCCESS != *result) return 0;
@@ -109,7 +117,9 @@ int lpcisp_write(void *addr_des, const void *addr_src, int len)
 
   iap_entry(command, result);
 
+ #ifndef IAP_PLL_FULL_SPEED
   lpc_pll_on();
+ #endif
   restore_flags(flags);
 
   return (CMD_SUCCESS == *result);