BUG: fix way accessing flash-memory, esp. on devices >64k

[pub/USBaspLoader.git] / firmware / main.c

diff --git a/firmware/main.c b/firmware/main.c
index 0f49474..53d1ae0 100644 (file)
--- a/firmware/main.c
+++ b/firmware/main.c
@@ -378,7 +378,11 @@ uchar   i;
         if(currentRequest >= USBASP_FUNC_READEEPROM){
             *data = eeprom_read_byte((void *)currentAddress.w[0]);
         }else{
-            *data = pgm_read_byte((void *)CURRENT_ADDRESS);
+#if ((FLASHEND) > 65535)
+            *data = pgm_read_byte_far(CURRENT_ADDRESS);
+#else
+            *data = pgm_read_byte(CURRENT_ADDRESS);
+#endif
         }
         data++;
         CURRENT_ADDRESS++;