X-Git-Url: https://git.donarmstrong.com/?a=blobdiff_plain;f=common%2Fbootloader.c;h=cda295b1811e92f90baea342084b37a07139bcc1;hb=b9e265368fde73daff069788dcb58c8230d01b32;hp=43a7e47ce23fb78213348e0f1cca1db5519b56bf;hpb=fe2230cf60efdc5dafb85356e54b8b87cd52c3a3;p=tmk_firmware.git

diff --git a/common/bootloader.c b/common/bootloader.c
index 43a7e47..cda295b 100644
--- a/common/bootloader.c
+++ b/common/bootloader.c
@@ -71,7 +71,8 @@ void bootloader_jump_after_watchdog_reset(void)
         MCUSR &= ~(1<<WDRF);
         wdt_disable();
 
-        ((void (*)(void))BOOTLOADER_START)();
+        // This is compled into 'icall', address should be in word unit, not byte.
+        ((void (*)(void))(BOOTLOADER_START/2))();
     }
 }
 
@@ -141,7 +142,7 @@ void bootloader_jump(void) {
     ADCSRA = 0; TWCR = 0; UCSR0B = 0;
 #endif
 
-    // start Bootloader
-    ((void (*)(void))BOOTLOADER_START)();
+    // This is compled into 'icall', address should be in word unit, not byte.
+    ((void (*)(void))(BOOTLOADER_START/2))();
 }
 #endif