/* Name: spminterface.h
 * Project: USBaspLoader
 * Author: Stephan Baerwolf
 * Creation Date: 2012-08-01
 * Copyright: (c) 2013 by Stephan Baerwolf
 * License: GNU GPL v2 (see License.txt)
 * Version: 0.96.1
 */

#ifndef SPMINTERFACE_H_f70ba6adf7624275947e859bdbff0599
#define SPMINTERFACE_H_f70ba6adf7624275947e859bdbff0599

/*
 * spminterface.h offers a lightweight interface by inserting
 * an small machine-subroutine into the bootsection. (right 
 * after the interrupt-vector-table)
 * This subroutine can be called by normal code in order to 
 * enable it to program the flash (and depending on BLB11-lockbit
 * also the bootsection itself). Since SPM-calls from RWW-sections
 * will fail to work. The routine will be called "bootloader__do_spm".
 * Its principle assembler-code is depicted below (real code is a
 * little machinedependend).
 * Interfaces will be the 8-bit registers r10..r13, for details 
 * also see below. As also the pageaddress-registes (Z and rampZ)
 * are interfaced via different registers, it is possible to call
 * this routine via indirect call (icall).
 * Traditionally it is also possible to rcall, therefore you can
 * define "bootloader__do_spm" for your normal code via defsym at 
 * linking time.
 * Example for an atmega8: "-Wl,--defsym=transfer_point=0x1826"
 * (since BOOTLOADER_ADDRESS is 0x1800 and there are 
 * 2x19 = 38 = 0x26 byte for interrupts)
 * 

bootloader__do_spm:
;disable interrupts (if enabled) before calling!
;you may also want to disable wdt, since this routine may busy-loop
;==================================================================
;-->INPUT:
;#if HAVE_SPMINTEREFACE_MAGICVALUE
;magicvalue in                                    r23:r22:r21:r20
;#endif
;spmcr (spmcrval determines SPM action) will be register:	r18
;MCU dependend RA(MPZ should be transfered within register:	r11
;lo8(Z) should be transfered within register:			r12
;hi8(Z) should be transfered within register:			r13
;( as definition of SPM low8bit of dataword are stored within	r0 )
;( as definition of SPM hi8bit  of dataword are stored within	r1 )

;<-->USED/CHANGED:
;temp0 will be register:					r11
;temp1 will be register:					r12
;temp2 will be register:					r13
;spmcrval (r18) may also be changed due to rww reenable-phase	r18
;Z (r31:r30) wil be changed during operation

;<--OUT:
;==================================================================
; TODO: waitA and waitB could be merged to subroutine saving 2 opc
;==================================================================
;<magicvalue specific code (not depicted here)>
;load pageaddress (Z) from (r11:)r13:12 since it may was used for icall
mov	rampZ,	r11
mov	r30,	r12
mov	r31,	r13

waitA:			;check for pending SPM complete
in	temp0, SPMCR
sbrc	temp0, SPMEN
rjmp	waitA

out	SPMCR, spmcrval	;SPM timed sequence
spm

waitB:			;check for previous SPM complete
in	temp0, SPMCR
sbrc	temp0, SPMEN
rjmp	waitB

;avoid crash of userapplication
ldi	spmcrval, ((1<<RWWSRE) | (1<<SPMEN)) 
in	temp0,	  SPMCR
sbrc	temp0,	  RWWSB
rjmp	waitA

ret

*
*/ 

#include <avr/io.h>
#include "bootloaderconfig.h"



/*
 * This MACRO commands the linker to place correspondig
 * data on the top of the firmware. (Right after the 
 * interrupt-vector-table)
 * This is necessary to always locate the
 * "bootloader__do_spm" for example at 0x1826, even if
 * there are existing PROGMEM within the firmware...
 */
#define BOOTLIBLINK __attribute__ ((section (".vectors") ))


#ifndef funcaddr___bootloader__do_spm
  #if (defined(BOOTLOADER_ADDRESS)) && (!(defined(NEW_BOOTLOADER_ADDRESS)))
    #if HAVE_SPMINTEREFACE
      #define  funcaddr___bootloader__do_spm (&bootloader__do_spm)
    #endif  
  #else
    #if defined (__AVR_ATmega8__) || defined (__AVR_ATmega8A__) || defined (__AVR_ATmega8HVA__)
      #define  funcaddr___bootloader__do_spm 0x1826
    #elif defined (__AVR_ATmega16__)
      #define  funcaddr___bootloader__do_spm 0x3854
    #elif defined (__AVR_ATmega32__)
      #define  funcaddr___bootloader__do_spm 0x7054
    #elif defined (__AVR_ATmega88__) || defined (__AVR_ATmega88P__) || defined (__AVR_ATmega88A__) || defined (__AVR_ATmega88PA__)  
      #define  funcaddr___bootloader__do_spm 0x1834
    #elif defined (__AVR_ATmega164A__) || defined (__AVR_ATmega164P__) || defined (__AVR_ATmega164PA__)  
      #define  funcaddr___bootloader__do_spm 0x387c
    #elif defined (__AVR_ATmega168__) || defined (__AVR_ATmega168P__) || defined (__AVR_ATmega168A__) || defined (__AVR_ATmega168PA__)  
      #define  funcaddr___bootloader__do_spm 0x3868
    #elif defined (__AVR_ATmega324A__) || defined (__AVR_ATmega324P__) || defined (__AVR_ATmega324PA__)
      #define  funcaddr___bootloader__do_spm 0x707c
    #elif defined (__AVR_ATmega328__) || defined (__AVR_ATmega328P__)
      #define  funcaddr___bootloader__do_spm 0x7068
    #elif defined (__AVR_ATmega640__)
      #define  funcaddr___bootloader__do_spm 0xe0e4
    #elif defined (__AVR_ATmega644__) || defined (__AVR_ATmega644A__) || defined (__AVR_ATmega644P__) || defined (__AVR_ATmega644PA__)
      #define  funcaddr___bootloader__do_spm 0xe07c
    #elif defined (__AVR_ATmega128__)
      #define  funcaddr___bootloader__do_spm 0x1e08c
    #elif defined (__AVR_ATmega1280__)
      #define  funcaddr___bootloader__do_spm 0x1e0e4
    #elif defined (__AVR_ATmega1281__)
      #define  funcaddr___bootloader__do_spm 0x1e0cc
    #elif defined (__AVR_ATmega1284__) || defined (__AVR_ATmega1284P__)
      #define  funcaddr___bootloader__do_spm 0x1e08c
    #elif defined (__AVR_ATmega2560__)
      #define  funcaddr___bootloader__do_spm 0x3e0e4
    #elif defined (__AVR_ATmega2561__)
      #define  funcaddr___bootloader__do_spm 0x3e0cc
    #else
      #error "unknown MCU - where is bootloader__do_spm located?"
    #endif

    #if defined(_VECTORS_SIZE)
      #if (funcaddr___bootloader__do_spm != (BOOTLOADER_ADDRESS+_VECTORS_SIZE))
	#error "bootloader__do_spm is not located after interrupts - sth. is very wrong here!" 
      #endif
    #endif  

  #endif
#endif


#ifndef SPMEN
#define SPMEN SELFPRGEN
#endif

/*
 * Call the "bootloader__do_spm"-function, located within the BLS via comfortable C-interface
 * During operation code will block - disable or reset watchdog before call.
 * 
 * ATTANTION:	Since the underlying "bootloader__do_spm" will automatically reenable the
 * 		rww-section, only one way to program the flash will work.
 * 		(First erase the page, then fill temp. buffer, finally program...)
 * 		Since unblocking rww-section erases the temp. pagebuffer (which happens
 * 		after a page-erase), first programming this buffer does not help !!
 * 
 * REMEMBER: interrupts have to be disabled! (otherwise code may crash non-deterministic)
 * 
 */
#if HAVE_SPMINTEREFACE_MAGICVALUE
#define __do_spm_Ex	__do_spm_Ex_magic
#else
#define __do_spm_Ex	__do_spm_Ex_
#endif

#if (defined(EIND) && ((FLASHEND)>131071))
  /*
  * Huge flash version using eicall (and EIND)
  */
  #define __do_spm_Ex_(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_Ex_magic(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" ((HAVE_SPMINTEREFACE_MAGICVALUE>>24)&0xff),					\
	[magicC] "M" ((HAVE_SPMINTEREFACE_MAGICVALUE>>16)&0xff),					\
	[magicB] "M" ((HAVE_SPMINTEREFACE_MAGICVALUE>> 8)&0xff),					\
	[magicA] "M" ((HAVE_SPMINTEREFACE_MAGICVALUE>> 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_Ex_(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_Ex_magic(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" ((HAVE_SPMINTEREFACE_MAGICVALUE>>24)&0xff),					\
	[magicC] "M" ((HAVE_SPMINTEREFACE_MAGICVALUE>>16)&0xff),					\
	[magicB] "M" ((HAVE_SPMINTEREFACE_MAGICVALUE>> 8)&0xff),					\
	[magicA] "M" ((HAVE_SPMINTEREFACE_MAGICVALUE>> 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
 * 
 * try to make this array as big as possible
 * (so bootloader always uses 2kbytes flash)
 */
#if defined (__AVR_ATmega8__) || defined (__AVR_ATmega8A__) || defined (__AVR_ATmega8HVA__) || defined (__AVR_ATmega16__) || defined (__AVR_ATmega32__)

#if 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__)
  #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
*/





#else
  #error "bootloader__do_spm has to be adapted, since there is no architecture code, yet"
#endif  


#endif

#endif