+
+#define __do_spm_Ex(arguments...) __do_spm_GeneralEx(HAVE_SPMINTEREFACE_MAGICVALUE, ##arguments)
+
+
+#if HAVE_SPMINTEREFACE_MAGICVALUE
+#define __do_spm_GeneralEx __do_spm_ExASMEx_magic
+#else
+#define __do_spm_GeneralEx __do_spm_ExASMEx_
+#endif
+
+
+#if (defined(EIND) && ((FLASHEND)>131071))
+ /*
+ * Huge flash version using eicall (and EIND)
+ * MV defines the magic value to be send to bootloader_do_spm
+ */
+ #define __do_spm_ExASMEx_(MV, flash_wordaddress, spmcrval, dataword, ___bootloader__do_spm__ptr) \
+ ({ \
+ asm volatile ( \
+ "push r0\n\t" \
+ "push r1\n\t" \
+ \
+ "mov r13, %B[flashaddress]\n\t" \
+ "mov r12, %A[flashaddress]\n\t" \
+ "mov r11, %C[flashaddress]\n\t" \
+ \
+ /* prepare the EIND for following eicall */ \
+ "in r18, %[eind]\n\t" \
+ "push r18\n\t" \
+ "ldi r18, %[spmfuncaddrEIND]\n\t" \
+ "out %[eind], r18\n\t" \
+ \
+ /* also load the spmcrval */ \
+ "mov r18, %[spmcrval]\n\t" \
+ \
+ \
+ "mov r1, %B[data]\n\t" \
+ "mov r0, %A[data]\n\t" \
+ \
+ /* finally call the bootloader-function */ \
+ "eicall\n\t" \
+ "pop r1\n\t" \
+ "out %[eind], r1\n\t" \
+ \
+ /* \
+ * bootloader__do_spm should change spmcrval (r18) to \
+ * "((1<<RWWSRE) | (1<<SPMEN))" in case of success \
+ */ \
+ "cpi r18, %[spmret]\n\t" \
+ /* loop infitinte if not so, most likely we called an bootloader__do_spm \
+ * with wrong magic! To avoid calls to wrong initialized pages, better crash here... \
+ */ \
+ "loop%=: \n\t" \
+ "brne loop%= \n\t" \
+ \
+ "pop r1\n\t" \
+ "pop r0\n\t" \
+ \
+ : \
+ : [flashaddress] "r" (flash_wordaddress), \
+ [spmfunctionaddress] "z" ((uint16_t)(___bootloader__do_spm__ptr)), \
+ [spmfuncaddrEIND] "M" ((uint8_t)(___bootloader__do_spm__ptr>>16)), \
+ [eind] "I" (_SFR_IO_ADDR(EIND)), \
+ [spmcrval] "r" (spmcrval), \
+ [data] "r" (dataword), \
+ [spmret] "M" ((1<<RWWSRE) | (1<<SPMEN)) \
+ : "r0","r1","r11","r12","r13","r18" \
+ ); \
+ })
+
+ #define __do_spm_ExASMEx_magic(MV, flash_wordaddress, spmcrval, dataword, ___bootloader__do_spm__ptr) \
+ ({ \
+ asm volatile ( \
+ "push r0\n\t" \
+ "push r1\n\t" \
+ \
+ "ldi r23, %[magicD] \n\t" \
+ "ldi r22, %[magicC] \n\t" \
+ "ldi r21, %[magicB] \n\t" \
+ "ldi r20, %[magicA] \n\t" \
+ \
+ "mov r13, %B[flashaddress]\n\t" \
+ "mov r12, %A[flashaddress]\n\t" \
+ "mov r11, %C[flashaddress]\n\t" \
+ \
+ /* prepare the EIND for following eicall */ \
+ "in r18, %[eind]\n\t" \
+ "push r18\n\t" \
+ "ldi r18, %[spmfuncaddrEIND]\n\t" \
+ "out %[eind], r18\n\t" \
+ \
+ /* also load the spmcrval */ \
+ "mov r18, %[spmcrval]\n\t" \
+ \
+ \
+ "mov r1, %B[data]\n\t" \
+ "mov r0, %A[data]\n\t" \
+ \
+ /* finally call the bootloader-function */ \
+ "eicall\n\t" \
+ "pop r1\n\t" \
+ "out %[eind], r1\n\t" \
+ \
+ /* \
+ * bootloader__do_spm should change spmcrval (r18) to \
+ * "((1<<RWWSRE) | (1<<SPMEN))" in case of success \
+ */ \
+ "cpi r18, %[spmret]\n\t" \
+ /* loop infitinte if not so, most likely we called an bootloader__do_spm \
+ * with wrong magic! To avoid calls to wrong initialized pages, better crash here... \
+ */ \
+ "loop%=: \n\t" \
+ "brne loop%= \n\t" \
+ \
+ "pop r1\n\t" \
+ "pop r0\n\t" \
+ \
+ : \
+ : [flashaddress] "r" (flash_wordaddress), \
+ [spmfunctionaddress] "z" ((uint16_t)(___bootloader__do_spm__ptr)), \
+ [spmfuncaddrEIND] "M" ((uint8_t)(___bootloader__do_spm__ptr>>16)), \
+ [eind] "I" (_SFR_IO_ADDR(EIND)), \
+ [spmcrval] "r" (spmcrval), \
+ [data] "r" (dataword), \
+ [spmret] "M" ((1<<RWWSRE) | (1<<SPMEN)), \
+ [magicD] "M" (((MV)>>24)&0xff), \
+ [magicC] "M" (((MV)>>16)&0xff), \
+ [magicB] "M" (((MV)>> 8)&0xff), \
+ [magicA] "M" (((MV)>> 0)&0xff) \
+ : "r0","r1","r11","r12","r13","r18","r20","r21","r22","r23" \
+ ); \
+ })
+
+
+#else
+ /*
+ * Normal version for devices with <=128KiB flash (using icall)
+ */
+ #if ((FLASHEND)>131071)
+ #error "Using inappropriate code for device with more than 128kib flash"
+ #endif
+
+ #define __do_spm_ExASMEx_(MV, flash_wordaddress, spmcrval, dataword, ___bootloader__do_spm__ptr) \
+ ({ \
+ asm volatile ( \
+ "push r0\n\t" \
+ "push r1\n\t" \
+ \
+ "mov r13, %B[flashaddress]\n\t" \
+ "mov r12, %A[flashaddress]\n\t" \
+ "mov r11, %C[flashaddress]\n\t" \
+ \
+ /* also load the spmcrval */ \
+ "mov r18, %[spmcrval]\n\t" \
+ \
+ \
+ "mov r1, %B[data]\n\t" \
+ "mov r0, %A[data]\n\t" \
+ \
+ /* finally call the bootloader-function */ \
+ "icall\n\t" \
+ \
+ /* \
+ * bootloader__do_spm should change spmcrval (r18) to \
+ * "((1<<RWWSRE) | (1<<SPMEN))" in case of success \
+ */ \
+ "cpi r18, %[spmret]\n\t" \
+ /* loop infitinte if not so, most likely we called an bootloader__do_spm \
+ * with wrong magic! To avoid calls to wrong initialized pages, better crash here... \
+ */ \
+ "loop%=: \n\t" \
+ "brne loop%= \n\t" \
+ \
+ "pop r1\n\t" \
+ "pop r0\n\t" \
+ \
+ : \
+ : [flashaddress] "r" (flash_wordaddress), \
+ [spmfunctionaddress] "z" ((uint16_t)(___bootloader__do_spm__ptr)), \
+ [spmcrval] "r" (spmcrval), \
+ [data] "r" (dataword), \
+ [spmret] "M" ((1<<RWWSRE) | (1<<SPMEN)) \
+ : "r0","r1","r11","r12","r13","r18" \
+ ); \
+ })
+
+ #define __do_spm_ExASMEx_magic(MV, flash_wordaddress, spmcrval, dataword, ___bootloader__do_spm__ptr) \
+ ({ \
+ asm volatile ( \
+ "push r0\n\t" \
+ "push r1\n\t" \
+ \
+ "ldi r23, %[magicD] \n\t" \
+ "ldi r22, %[magicC] \n\t" \
+ "ldi r21, %[magicB] \n\t" \
+ "ldi r20, %[magicA] \n\t" \
+ \
+ "mov r13, %B[flashaddress]\n\t" \
+ "mov r12, %A[flashaddress]\n\t" \
+ "mov r11, %C[flashaddress]\n\t" \
+ \
+ /* also load the spmcrval */ \
+ "mov r18, %[spmcrval]\n\t" \
+ \
+ \
+ "mov r1, %B[data]\n\t" \
+ "mov r0, %A[data]\n\t" \
+ \
+ /* finally call the bootloader-function */ \
+ "icall\n\t" \
+ \
+ /* \
+ * bootloader__do_spm should change spmcrval (r18) to \
+ * "((1<<RWWSRE) | (1<<SPMEN))" in case of success \
+ */ \
+ "cpi r18, %[spmret]\n\t" \
+ /* loop infitinte if not so, most likely we called an bootloader__do_spm \
+ * with wrong magic! To avoid calls to wrong initialized pages, better crash here... \
+ */ \
+ "loop%=: \n\t" \
+ "brne loop%= \n\t" \
+ \
+ "pop r1\n\t" \
+ "pop r0\n\t" \
+ \
+ : \
+ : [flashaddress] "r" (flash_wordaddress), \
+ [spmfunctionaddress] "z" ((uint16_t)(___bootloader__do_spm__ptr)), \
+ [spmcrval] "r" (spmcrval), \
+ [data] "r" (dataword), \
+ [spmret] "M" ((1<<RWWSRE) | (1<<SPMEN)), \
+ [magicD] "M" (((MV)>>24)&0xff), \
+ [magicC] "M" (((MV)>>16)&0xff), \
+ [magicB] "M" (((MV)>> 8)&0xff), \
+ [magicA] "M" (((MV)>> 0)&0xff) \
+ : "r0","r1","r11","r12","r13","r18","r20","r21","r22","r23" \
+ ); \
+ })
+#endif
+
+#if (!(defined(BOOTLOADER_ADDRESS))) || (defined(NEW_BOOTLOADER_ADDRESS))
+void do_spm(const uint32_t flash_byteaddress, const uint8_t spmcrval, const uint16_t dataword) {
+ __do_spm_Ex(flash_byteaddress, spmcrval, dataword, funcaddr___bootloader__do_spm >> 1);
+}
+#endif
+
+#if HAVE_SPMINTEREFACE_NORETMAGIC
+ #define bootloader__do_spm_magic_exitstrategy(a) (0xf7f9)
+#else
+ #define bootloader__do_spm_magic_exitstrategy(a) (a)
+#endif
+
+#if (HAVE_SPMINTEREFACE) && (defined(BOOTLOADER_ADDRESS)) && (!(defined(NEW_BOOTLOADER_ADDRESS)))
+
+/*
+ * insert architecture dependend "bootloader_do_spm"-code
+ */
+#if defined (__AVR_ATmega8535__) || defined (__AVR_ATmega8__) || defined (__AVR_ATmega8A__) || defined (__AVR_ATmega8HVA__) || defined (__AVR_ATmega16__) || defined (__AVR_ATmega162__) || defined (__AVR_ATmega32__)
+
+#if defined (__AVR_ATmega8535__) || defined (__AVR_ATmega8__) || defined (__AVR_ATmega8A__) || defined (__AVR_ATmega8HVA__)
+ #if (BOOTLOADER_ADDRESS != 0x1800)
+ #error BOOTLOADER_ADDRESS!=0x1800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#elif defined (__AVR_ATmega16__) || defined (__AVR_ATmega162__)
+ #if (BOOTLOADER_ADDRESS != 0x3800)
+ #error BOOTLOADER_ADDRESS!=0x3800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#elif defined (__AVR_ATmega32__)
+ #if (BOOTLOADER_ADDRESS != 0x7000)
+ #error BOOTLOADER_ADDRESS!=0x7000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#else
+ #error undefined device selection - this should not happen!
+#endif
+
+//assume SPMCR==0x37, SPMEN==0x0, RWWSRE=0x4, RWWSB=0x6
+#if HAVE_SPMINTEREFACE_MAGICVALUE
+const uint16_t bootloader__do_spm[23] BOOTLIBLINK = {
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 28) & 0xf))<<8) | (0x70 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 24) & 0xf))), // r23
+ bootloader__do_spm_magic_exitstrategy(0xf4a1), // brne +20
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 20) & 0xf))<<8) | (0x60 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 16) & 0xf))), // r22
+ bootloader__do_spm_magic_exitstrategy(0xf491), // brne +18
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 12) & 0xf))<<8) | (0x50 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 8) & 0xf))), // r21
+ bootloader__do_spm_magic_exitstrategy(0xf481), // brne +16
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 4) & 0xf))<<8) | (0x40 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 0) & 0xf))), // r20
+ bootloader__do_spm_magic_exitstrategy(0xf471), // brne +14
+#else
+const uint16_t bootloader__do_spm[15] BOOTLIBLINK = {
+#endif
+ 0x2dec, 0x2dfd, 0xb6b7, 0xfcb0, 0xcffd, 0xbf27, 0x95e8, 0xb6b7,
+ 0xfcb0, 0xcffd, 0xe121, 0xb6b7, 0xfcb6, 0xcff4, 0x9508
+};
+
+/*
+00001826 <bootloader__do_spm>:
+ 1828: ec 2d mov r30, r12
+ 182a: fd 2d mov r31, r13
+
+0000182c <waitA>:
+ 182c: b7 b6 in r11, 0x37 ; 55
+ 182e: b0 fc sbrc r11, 0
+ 1830: fd cf rjmp .-6 ; 0x182c <waitA>
+ 1832: 27 bf out 0x37, r18 ; 55
+ 1834: e8 95 spm
+
+00001836 <waitB>:
+ 1836: b7 b6 in r11, 0x37 ; 55
+ 1838: b0 fc sbrc r11, 0
+ 183a: fd cf rjmp .-6 ; 0x1836 <waitB>
+ 183c: 21 e1 ldi r18, 0x11 ; 17
+ 183e: b7 b6 in r11, 0x37 ; 55
+ 1840: b6 fc sbrc r11, 6
+ 1842: f4 cf rjmp .-24 ; 0x182c <waitA>
+ 1844: 08 95 ret
+*/
+
+
+
+
+
+#elif defined (__AVR_ATmega48__) || defined (__AVR_ATmega48P__) || defined (__AVR_ATmega88__) || defined (__AVR_ATmega88P__) || defined (__AVR_ATmega168__) || defined (__AVR_ATmega168P__)
+
+#if defined (__AVR_ATmega88__) || defined (__AVR_ATmega88P__)
+ #if (BOOTLOADER_ADDRESS != 0x1800)
+ #error BOOTLOADER_ADDRESS!=0x1800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#elif defined (__AVR_ATmega168__) || defined (__AVR_ATmega168P__)
+ #if (BOOTLOADER_ADDRESS != 0x3800)
+ #error BOOTLOADER_ADDRESS!=0x3800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#else
+ #error undefined device selection - this should not happen!
+#endif
+
+//assume SPMCR:=SPMCSR==0x37, SPMEN:=SELFPRGEN==0x0, RWWSRE=0x4, RWWSB=0x6
+#if HAVE_SPMINTEREFACE_MAGICVALUE
+const uint16_t bootloader__do_spm[23] BOOTLIBLINK = {
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 28) & 0xf))<<8) | (0x70 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 24) & 0xf))), // r23
+ bootloader__do_spm_magic_exitstrategy(0xf4a1), // brne +20
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 20) & 0xf))<<8) | (0x60 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 16) & 0xf))), // r22
+ bootloader__do_spm_magic_exitstrategy(0xf491), // brne +18
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 12) & 0xf))<<8) | (0x50 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 8) & 0xf))), // r21
+ bootloader__do_spm_magic_exitstrategy(0xf481), // brne +16
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 4) & 0xf))<<8) | (0x40 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 0) & 0xf))), // r20
+ bootloader__do_spm_magic_exitstrategy(0xf471), // brne +14
+#else
+const uint16_t bootloader__do_spm[15] BOOTLIBLINK = {
+#endif
+ 0x2dec, 0x2dfd, 0xb6b7, 0xfcb0, 0xcffd, 0xbf27, 0x95e8, 0xb6b7,
+ 0xfcb0, 0xcffd, 0xe121, 0xb6b7, 0xfcb6, 0xcff4, 0x9508
+};
+/*
+00001826 <bootloader__do_spm>:
+ 1828: ec 2d mov r30, r12
+ 182a: fd 2d mov r31, r13
+
+0000182c <waitA>:
+ 182c: b7 b6 in r11, 0x37 ; 55
+ 182e: b0 fc sbrc r11, 0
+ 1830: fd cf rjmp .-6 ; 0x182c <waitA>
+ 1832: 27 bf out 0x37, r18 ; 55
+ 1834: e8 95 spm
+
+00001836 <waitB>:
+ 1836: b7 b6 in r11, 0x37 ; 55
+ 1838: b0 fc sbrc r11, 0
+ 183a: fd cf rjmp .-6 ; 0x1836 <waitB>
+ 183c: 21 e1 ldi r18, 0x11 ; 17
+ 183e: b7 b6 in r11, 0x37 ; 55
+ 1840: b6 fc sbrc r11, 6
+ 1842: f4 cf rjmp .-24 ; 0x182c <waitA>
+ 1844: 08 95 ret
+*/
+
+
+
+
+
+#elif defined (__AVR_ATmega48A__) || defined (__AVR_ATmega48PA__) || defined (__AVR_ATmega88A__) || defined (__AVR_ATmega88PA__) || defined (__AVR_ATmega168A__) || defined (__AVR_ATmega168PA__) || defined (__AVR_ATmega328__) || defined (__AVR_ATmega328P__)
+
+#if defined (__AVR_ATmega88A__) || defined (__AVR_ATmega88PA__)
+ #if (BOOTLOADER_ADDRESS != 0x1800)
+ #error BOOTLOADER_ADDRESS!=0x1800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#elif defined (__AVR_ATmega168A__) || defined (__AVR_ATmega168PA__)
+ #if (BOOTLOADER_ADDRESS != 0x3800)
+ #error BOOTLOADER_ADDRESS!=0x3800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#elif defined (__AVR_ATmega328__) || defined (__AVR_ATmega328P__)
+ #if (BOOTLOADER_ADDRESS != 0x7000)
+ #error BOOTLOADER_ADDRESS!=0x7000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#else
+ #error undefined device selection - this should not happen!
+#endif
+
+//assume SPMCR:=SPMCSR==0x37, SPMEN:=SELFPRGEN==0x0, RWWSRE=0x4, RWWSB=0x6
+#if HAVE_SPMINTEREFACE_MAGICVALUE
+const uint16_t bootloader__do_spm[23] BOOTLIBLINK = {
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 28) & 0xf))<<8) | (0x70 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 24) & 0xf))), // r23
+ bootloader__do_spm_magic_exitstrategy(0xf4a1), // brne +20
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 20) & 0xf))<<8) | (0x60 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 16) & 0xf))), // r22
+ bootloader__do_spm_magic_exitstrategy(0xf491), // brne +18
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 12) & 0xf))<<8) | (0x50 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 8) & 0xf))), // r21
+ bootloader__do_spm_magic_exitstrategy(0xf481), // brne +16
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 4) & 0xf))<<8) | (0x40 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 0) & 0xf))), // r20
+ bootloader__do_spm_magic_exitstrategy(0xf471), // brne +14
+#else
+const uint16_t bootloader__do_spm[15] BOOTLIBLINK = {
+#endif
+ 0x2dec, 0x2dfd, 0xb6b7, 0xfcb0, 0xcffd, 0xbf27, 0x95e8, 0xb6b7,
+ 0xfcb0, 0xcffd, 0xe121, 0xb6b7, 0xfcb6, 0xcff4, 0x9508
+};
+/*
+00001826 <bootloader__do_spm>:
+ 1828: ec 2d mov r30, r12
+ 182a: fd 2d mov r31, r13
+
+0000182c <waitA>:
+ 182c: b7 b6 in r11, 0x37 ; 55
+ 182e: b0 fc sbrc r11, 0
+ 1830: fd cf rjmp .-6 ; 0x182c <waitA>
+ 1832: 27 bf out 0x37, r18 ; 55
+ 1834: e8 95 spm
+
+00001836 <waitB>:
+ 1836: b7 b6 in r11, 0x37 ; 55
+ 1838: b0 fc sbrc r11, 0
+ 183a: fd cf rjmp .-6 ; 0x1836 <waitB>
+ 183c: 21 e1 ldi r18, 0x11 ; 17
+ 183e: b7 b6 in r11, 0x37 ; 55
+ 1840: b6 fc sbrc r11, 6
+ 1842: f4 cf rjmp .-24 ; 0x182c <waitA>
+ 1844: 08 95 ret
+*/
+
+
+
+
+
+#elif defined (__AVR_ATmega128__)
+
+#if defined (__AVR_ATmega128__)
+ #if (BOOTLOADER_ADDRESS != 0x1E000)
+ #error BOOTLOADER_ADDRESS!=0x1E000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#else
+ #error undefined device selection - this should not happen!
+#endif
+
+//assume SPMCR:=SPMCSR==0x68, SPMEN==0x0, RWWSRE=0x4, RWWSB=0x6 and rampZ=0x3b
+#if HAVE_SPMINTEREFACE_MAGICVALUE
+const uint16_t bootloader__do_spm[28] BOOTLIBLINK = {
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 28) & 0xf))<<8) | (0x70 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 24) & 0xf))), // r23
+ bootloader__do_spm_magic_exitstrategy(0xf4c9), // brne +21+4
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 20) & 0xf))<<8) | (0x60 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 16) & 0xf))), // r22
+ bootloader__do_spm_magic_exitstrategy(0xf4b9), // brne +19+4
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 12) & 0xf))<<8) | (0x50 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 8) & 0xf))), // r21
+ bootloader__do_spm_magic_exitstrategy(0xf4a9), // brne +17+4
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 4) & 0xf))<<8) | (0x40 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 0) & 0xf))), // r20
+ bootloader__do_spm_magic_exitstrategy(0xf499), // brne +15+4
+#else
+const uint16_t bootloader__do_spm[20] BOOTLIBLINK = {
+#endif
+ 0xbebb, 0x2dec, 0x2dfd, 0x90b0, 0x0068, 0xfcb0, 0xcffc, 0x9320, 0x0068,
+ 0x95e8, 0x90b0, 0x0068, 0xfcb0, 0xcffc, 0xe121, 0x90b0, 0x0068, 0xfcb6,
+ 0xcff0, 0x9508
+};
+/*
+0001e08c <bootloader__do_spm>:
+ 1e08c: bb be out 0x3b, r11 ; 59
+ 1e08e: ec 2d mov r30, r12
+ 1e090: fd 2d mov r31, r13
+
+0001e092 <waitA>:
+ 1e092: b0 90 68 00 lds r11, 0x0068
+ 1e096: b0 fc sbrc r11, 0
+ 1e098: fc cf rjmp .-8 ; 0x1e092 <waitA>
+ 1e09a: 20 93 68 00 sts 0x0068, r18
+ 1e09e: e8 95 spm
+
+0001e0a0 <waitB>:
+ 1e0a0: b0 90 68 00 lds r11, 0x0068
+ 1e0a4: b0 fc sbrc r11, 0
+ 1e0a6: fc cf rjmp .-8 ; 0x1e0a0 <waitB>
+ 1e0a8: 21 e1 ldi r18, 0x11 ; 17
+ 1e0aa: b0 90 68 00 lds r11, 0x0068
+ 1e0ae: b6 fc sbrc r11, 6
+ 1e0b0: f0 cf rjmp .-32 ; 0x1e092 <waitA>
+ 1e0b2: 08 95 ret
+*/
+
+
+
+
+
+#elif defined (__AVR_ATmega164A__) || defined (__AVR_ATmega164P__) || defined (__AVR_ATmega164PA__) || defined (__AVR_ATmega324A__) || defined (__AVR_ATmega324P__) || defined (__AVR_ATmega324PA__) || defined (__AVR_ATmega640__) || defined (__AVR_ATmega644__) || defined (__AVR_ATmega644A__) || defined (__AVR_ATmega644P__) || defined (__AVR_ATmega644PA__) || defined (__AVR_ATmega1280__) || defined (__AVR_ATmega1281__) || defined (__AVR_ATmega1284__) || defined (__AVR_ATmega1284P__) || defined (__AVR_ATmega2560__) || defined (__AVR_ATmega2561__)
+
+#if defined (__AVR_ATmega164A__) || defined (__AVR_ATmega164P__) || defined (__AVR_ATmega164PA__)
+ #if (BOOTLOADER_ADDRESS != 0x3800)
+ #error BOOTLOADER_ADDRESS!=0x3800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#elif defined (__AVR_ATmega324A__) || defined (__AVR_ATmega324P__) || defined (__AVR_ATmega324PA__)
+ #if (BOOTLOADER_ADDRESS != 0x7000)
+ #error BOOTLOADER_ADDRESS!=0x7000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#elif defined (__AVR_ATmega640__)
+ #if (BOOTLOADER_ADDRESS != 0xE000)
+ #error BOOTLOADER_ADDRESS!=0xE000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#elif defined (__AVR_ATmega644__) || defined (__AVR_ATmega644A__) || defined (__AVR_ATmega644P__) || defined (__AVR_ATmega644PA__)
+ #if (BOOTLOADER_ADDRESS != 0xE000)
+ #error BOOTLOADER_ADDRESS!=0xE000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#elif defined (__AVR_ATmega1280__)
+ #if (BOOTLOADER_ADDRESS != 0x1E000)
+ #error BOOTLOADER_ADDRESS!=0x1E000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#elif defined (__AVR_ATmega1281__)
+ #if (BOOTLOADER_ADDRESS != 0x1E000)
+ #error BOOTLOADER_ADDRESS!=0x1E000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#elif defined (__AVR_ATmega1284__) || defined (__AVR_ATmega1284P__)
+ #if (BOOTLOADER_ADDRESS != 0x1E000)
+ #error BOOTLOADER_ADDRESS!=0x1E000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#elif defined (__AVR_ATmega2560__)
+ #if (BOOTLOADER_ADDRESS != 0x3E000)
+ #error BOOTLOADER_ADDRESS!=0x3E000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#elif defined (__AVR_ATmega2561__)
+ #if (BOOTLOADER_ADDRESS != 0x3E000)
+ #error BOOTLOADER_ADDRESS!=0x3E000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
+ #endif
+#else
+ #error undefined device selection - this should not happen!
+#endif
+
+//assume SPMCR:=SPCSR==0x37, SPMEN==0x0, RWWSRE=0x4, RWWSB=0x6 and rampZ=0x3b
+#if HAVE_SPMINTEREFACE_MAGICVALUE
+const uint16_t bootloader__do_spm[24] BOOTLIBLINK = {
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 28) & 0xf))<<8) | (0x70 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 24) & 0xf))), // r23
+ bootloader__do_spm_magic_exitstrategy(0xf4a9), // brne +21
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 20) & 0xf))<<8) | (0x60 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 16) & 0xf))), // r22
+ bootloader__do_spm_magic_exitstrategy(0xf499), // brne +19
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 12) & 0xf))<<8) | (0x50 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 8) & 0xf))), // r21
+ bootloader__do_spm_magic_exitstrategy(0xf489), // brne +17
+ (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 4) & 0xf))<<8) | (0x40 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 0) & 0xf))), // r20
+ bootloader__do_spm_magic_exitstrategy(0xf479), // brne +15
+#else
+const uint16_t bootloader__do_spm[16] BOOTLIBLINK = {
+#endif
+ 0xbebb,
+ 0x2dec, 0x2dfd, 0xb6b7, 0xfcb0, 0xcffd, 0xbf27, 0x95e8, 0xb6b7,
+ 0xfcb0, 0xcffd, 0xe121, 0xb6b7, 0xfcb6, 0xcff4, 0x9508
+};
+/*
+00001826 <bootloader__do_spm>:
+ 1826: bb be out 0x3b,r11 ; rampZ=r11; (rampZ is at IO 0x3b)
+ 1828: ec 2d mov r30, r12
+ 182a: fd 2d mov r31, r13
+
+0000182c <waitA>:
+ 182c: b7 b6 in r11, 0x37 ; 55
+ 182e: b0 fc sbrc r11, 0
+ 1830: fd cf rjmp .-6 ; 0x182c <waitA>
+ 1832: 27 bf out 0x37, r18 ; 55
+ 1834: e8 95 spm
+
+00001836 <waitB>:
+ 1836: b7 b6 in r11, 0x37 ; 55
+ 1838: b0 fc sbrc r11, 0
+ 183a: fd cf rjmp .-6 ; 0x1836 <waitB>
+ 183c: 21 e1 ldi r18, 0x11 ; 17
+ 183e: b7 b6 in r11, 0x37 ; 55
+ 1840: b6 fc sbrc r11, 6
+ 1842: f4 cf rjmp .-24 ; 0x182c <waitA>
+ 1844: 08 95 ret
+*/
+
+
+
+
+