13cb6681d99d7b8fa5869d81aadefc5d24685a6c
[pub/USBaspLoader.git] / firmware / spminterface.h
1 /* Name: spminterface.h
2 * Project: USBaspLoader
3 * Author: Stephan Baerwolf
4 * Creation Date: 2012-08-01
5 * Copyright: (c) 2013 by Stephan Baerwolf
6 * License: GNU GPL v2 (see License.txt)
7 * Version: 0.96.3
8 */
9
10 #ifndef SPMINTERFACE_H_f70ba6adf7624275947e859bdbff0599
11 #define SPMINTERFACE_H_f70ba6adf7624275947e859bdbff0599
12
13 /*
14 * spminterface.h offers a lightweight interface by inserting
15 * an small machine-subroutine into the bootsection. (right
16 * after the interrupt-vector-table)
17 * This subroutine can be called by normal code in order to
18 * enable it to program the flash (and depending on BLB11-lockbit
19 * also the bootsection itself). Since SPM-calls from RWW-sections
20 * will fail to work. The routine will be called "bootloader__do_spm".
21 * Its principle assembler-code is depicted below (real code is a
22 * little machinedependend).
23 * Interfaces will be the 8-bit registers r10..r13, for details
24 * also see below. As also the pageaddress-registes (Z and rampZ)
25 * are interfaced via different registers, it is possible to call
26 * this routine via indirect call (icall).
27 * Traditionally it is also possible to rcall, therefore you can
28 * define "bootloader__do_spm" for your normal code via defsym at
29 * linking time.
30 * Example for an atmega8: "-Wl,--defsym=transfer_point=0x1826"
31 * (since BOOTLOADER_ADDRESS is 0x1800 and there are
32 * 2x19 = 38 = 0x26 byte for interrupts)
33 *
34
35 bootloader__do_spm:
36 ;disable interrupts (if enabled) before calling!
37 ;you may also want to disable wdt, since this routine may busy-loop
38 ;==================================================================
39 ;-->INPUT:
40 ;#if HAVE_SPMINTEREFACE_MAGICVALUE
41 ;magicvalue in r23:r22:r21:r20
42 ;#endif
43 ;spmcr (spmcrval determines SPM action) will be register: r18
44 ;MCU dependend RA(MPZ should be transfered within register: r11
45 ;lo8(Z) should be transfered within register: r12
46 ;hi8(Z) should be transfered within register: r13
47 ;( as definition of SPM low8bit of dataword are stored within r0 )
48 ;( as definition of SPM hi8bit of dataword are stored within r1 )
49
50 ;<-->USED/CHANGED:
51 ;temp0 will be register: r11
52 ;temp1 will be register: r12
53 ;temp2 will be register: r13
54 ;spmcrval (r18) may also be changed due to rww reenable-phase r18
55 ;Z (r31:r30) wil be changed during operation
56
57 ;<--OUT:
58 ;==================================================================
59 ; TODO: waitA and waitB could be merged to subroutine saving 2 opc
60 ;==================================================================
61 ;<magicvalue specific code (not depicted here)>
62 ;load pageaddress (Z) from (r11:)r13:12 since it may was used for icall
63 mov rampZ, r11
64 mov r30, r12
65 mov r31, r13
66
67 waitA: ;check for pending SPM complete
68 in temp0, SPMCR
69 sbrc temp0, SPMEN
70 rjmp waitA
71
72 out SPMCR, spmcrval ;SPM timed sequence
73 spm
74
75 waitB: ;check for previous SPM complete
76 in temp0, SPMCR
77 sbrc temp0, SPMEN
78 rjmp waitB
79
80 ;avoid crash of userapplication
81 ldi spmcrval, ((1<<RWWSRE) | (1<<SPMEN))
82 in temp0, SPMCR
83 sbrc temp0, RWWSB
84 rjmp waitA
85
86 ret
87
88 *
89 */
90
91 #include <avr/io.h>
92 #include "bootloaderconfig.h"
93
94
95
96 /*
97 * This MACRO commands the linker to place correspondig
98 * data on the top of the firmware. (Right after the
99 * interrupt-vector-table)
100 * This is necessary to always locate the
101 * "bootloader__do_spm" for example at 0x1826, even if
102 * there are existing PROGMEM within the firmware...
103 */
104 #define BOOTLIBLINK __attribute__ ((section (".vectors") ))
105
106
107 #ifndef funcaddr___bootloader__do_spm
108 #if (defined(BOOTLOADER_ADDRESS)) && (!(defined(NEW_BOOTLOADER_ADDRESS)))
109 #if HAVE_SPMINTEREFACE
110 #define funcaddr___bootloader__do_spm (&bootloader__do_spm)
111 #endif
112 #else
113 #if defined (__AVR_ATmega8__) || defined (__AVR_ATmega8A__) || defined (__AVR_ATmega8HVA__)
114 #define funcaddr___bootloader__do_spm 0x1826
115 #elif defined (__AVR_ATmega16__)
116 #define funcaddr___bootloader__do_spm 0x3854
117 #elif defined (__AVR_ATmega32__)
118 #define funcaddr___bootloader__do_spm 0x7054
119 #elif defined (__AVR_ATmega88__) || defined (__AVR_ATmega88P__) || defined (__AVR_ATmega88A__) || defined (__AVR_ATmega88PA__)
120 #define funcaddr___bootloader__do_spm 0x1834
121 #elif defined (__AVR_ATmega164A__) || defined (__AVR_ATmega164P__) || defined (__AVR_ATmega164PA__)
122 #define funcaddr___bootloader__do_spm 0x387c
123 #elif defined (__AVR_ATmega168__) || defined (__AVR_ATmega168P__) || defined (__AVR_ATmega168A__) || defined (__AVR_ATmega168PA__)
124 #define funcaddr___bootloader__do_spm 0x3868
125 #elif defined (__AVR_ATmega324A__) || defined (__AVR_ATmega324P__) || defined (__AVR_ATmega324PA__)
126 #define funcaddr___bootloader__do_spm 0x707c
127 #elif defined (__AVR_ATmega328__) || defined (__AVR_ATmega328P__)
128 #define funcaddr___bootloader__do_spm 0x7068
129 #elif defined (__AVR_ATmega640__)
130 #define funcaddr___bootloader__do_spm 0xe0e4
131 #elif defined (__AVR_ATmega644__) || defined (__AVR_ATmega644A__) || defined (__AVR_ATmega644P__) || defined (__AVR_ATmega644PA__)
132 #define funcaddr___bootloader__do_spm 0xe07c
133 #elif defined (__AVR_ATmega128__)
134 #define funcaddr___bootloader__do_spm 0x1e08c
135 #elif defined (__AVR_ATmega1280__)
136 #define funcaddr___bootloader__do_spm 0x1e0e4
137 #elif defined (__AVR_ATmega1281__)
138 #define funcaddr___bootloader__do_spm 0x1e0cc
139 #elif defined (__AVR_ATmega1284__) || defined (__AVR_ATmega1284P__)
140 #define funcaddr___bootloader__do_spm 0x1e08c
141 #elif defined (__AVR_ATmega2560__)
142 #define funcaddr___bootloader__do_spm 0x3e0e4
143 #elif defined (__AVR_ATmega2561__)
144 #define funcaddr___bootloader__do_spm 0x3e0cc
145 #else
146 #error "unknown MCU - where is bootloader__do_spm located?"
147 #endif
148
149 #if defined(_VECTORS_SIZE)
150 #if (funcaddr___bootloader__do_spm != (BOOTLOADER_ADDRESS+_VECTORS_SIZE))
151 #error "bootloader__do_spm is not located after interrupts - sth. is very wrong here!"
152 #endif
153 #endif
154
155 #endif
156 #endif
157
158
159 #ifndef SPMEN
160 #define SPMEN SELFPRGEN
161 #endif
162
163 /*
164 * Call the "bootloader__do_spm"-function, located within the BLS via comfortable C-interface
165 * During operation code will block - disable or reset watchdog before call.
166 *
167 * ATTANTION: Since the underlying "bootloader__do_spm" will automatically reenable the
168 * rww-section, only one way to program the flash will work.
169 * (First erase the page, then fill temp. buffer, finally program...)
170 * Since unblocking rww-section erases the temp. pagebuffer (which happens
171 * after a page-erase), first programming this buffer does not help !!
172 *
173 * REMEMBER: interrupts have to be disabled! (otherwise code may crash non-deterministic)
174 *
175 */
176
177 #define __do_spm_Ex(arguments...) __do_spm_GeneralEx(HAVE_SPMINTEREFACE_MAGICVALUE, ##arguments)
178
179
180 #if HAVE_SPMINTEREFACE_MAGICVALUE
181 #define __do_spm_GeneralEx __do_spm_ExASMEx_magic
182 #else
183 #define __do_spm_GeneralEx __do_spm_ExASMEx_
184 #endif
185
186
187 #if (defined(EIND) && ((FLASHEND)>131071))
188 /*
189 * Huge flash version using eicall (and EIND)
190 * MV defines the magic value to be send to bootloader_do_spm
191 */
192 #define __do_spm_ExASMEx_(MV, flash_wordaddress, spmcrval, dataword, ___bootloader__do_spm__ptr) \
193 ({ \
194 asm volatile ( \
195 "push r0\n\t" \
196 "push r1\n\t" \
197 \
198 "mov r13, %B[flashaddress]\n\t" \
199 "mov r12, %A[flashaddress]\n\t" \
200 "mov r11, %C[flashaddress]\n\t" \
201 \
202 /* prepare the EIND for following eicall */ \
203 "in r18, %[eind]\n\t" \
204 "push r18\n\t" \
205 "ldi r18, %[spmfuncaddrEIND]\n\t" \
206 "out %[eind], r18\n\t" \
207 \
208 /* also load the spmcrval */ \
209 "mov r18, %[spmcrval]\n\t" \
210 \
211 \
212 "mov r1, %B[data]\n\t" \
213 "mov r0, %A[data]\n\t" \
214 \
215 /* finally call the bootloader-function */ \
216 "eicall\n\t" \
217 "pop r1\n\t" \
218 "out %[eind], r1\n\t" \
219 \
220 /* \
221 * bootloader__do_spm should change spmcrval (r18) to \
222 * "((1<<RWWSRE) | (1<<SPMEN))" in case of success \
223 */ \
224 "cpi r18, %[spmret]\n\t" \
225 /* loop infitinte if not so, most likely we called an bootloader__do_spm \
226 * with wrong magic! To avoid calls to wrong initialized pages, better crash here... \
227 */ \
228 "loop%=: \n\t" \
229 "brne loop%= \n\t" \
230 \
231 "pop r1\n\t" \
232 "pop r0\n\t" \
233 \
234 : \
235 : [flashaddress] "r" (flash_wordaddress), \
236 [spmfunctionaddress] "z" ((uint16_t)(___bootloader__do_spm__ptr)), \
237 [spmfuncaddrEIND] "M" ((uint8_t)(___bootloader__do_spm__ptr>>16)), \
238 [eind] "I" (_SFR_IO_ADDR(EIND)), \
239 [spmcrval] "r" (spmcrval), \
240 [data] "r" (dataword), \
241 [spmret] "M" ((1<<RWWSRE) | (1<<SPMEN)) \
242 : "r0","r1","r11","r12","r13","r18" \
243 ); \
244 })
245
246 #define __do_spm_ExASMEx_magic(MV, flash_wordaddress, spmcrval, dataword, ___bootloader__do_spm__ptr) \
247 ({ \
248 asm volatile ( \
249 "push r0\n\t" \
250 "push r1\n\t" \
251 \
252 "ldi r23, %[magicD] \n\t" \
253 "ldi r22, %[magicC] \n\t" \
254 "ldi r21, %[magicB] \n\t" \
255 "ldi r20, %[magicA] \n\t" \
256 \
257 "mov r13, %B[flashaddress]\n\t" \
258 "mov r12, %A[flashaddress]\n\t" \
259 "mov r11, %C[flashaddress]\n\t" \
260 \
261 /* prepare the EIND for following eicall */ \
262 "in r18, %[eind]\n\t" \
263 "push r18\n\t" \
264 "ldi r18, %[spmfuncaddrEIND]\n\t" \
265 "out %[eind], r18\n\t" \
266 \
267 /* also load the spmcrval */ \
268 "mov r18, %[spmcrval]\n\t" \
269 \
270 \
271 "mov r1, %B[data]\n\t" \
272 "mov r0, %A[data]\n\t" \
273 \
274 /* finally call the bootloader-function */ \
275 "eicall\n\t" \
276 "pop r1\n\t" \
277 "out %[eind], r1\n\t" \
278 \
279 /* \
280 * bootloader__do_spm should change spmcrval (r18) to \
281 * "((1<<RWWSRE) | (1<<SPMEN))" in case of success \
282 */ \
283 "cpi r18, %[spmret]\n\t" \
284 /* loop infitinte if not so, most likely we called an bootloader__do_spm \
285 * with wrong magic! To avoid calls to wrong initialized pages, better crash here... \
286 */ \
287 "loop%=: \n\t" \
288 "brne loop%= \n\t" \
289 \
290 "pop r1\n\t" \
291 "pop r0\n\t" \
292 \
293 : \
294 : [flashaddress] "r" (flash_wordaddress), \
295 [spmfunctionaddress] "z" ((uint16_t)(___bootloader__do_spm__ptr)), \
296 [spmfuncaddrEIND] "M" ((uint8_t)(___bootloader__do_spm__ptr>>16)), \
297 [eind] "I" (_SFR_IO_ADDR(EIND)), \
298 [spmcrval] "r" (spmcrval), \
299 [data] "r" (dataword), \
300 [spmret] "M" ((1<<RWWSRE) | (1<<SPMEN)), \
301 [magicD] "M" (((MV)>>24)&0xff), \
302 [magicC] "M" (((MV)>>16)&0xff), \
303 [magicB] "M" (((MV)>> 8)&0xff), \
304 [magicA] "M" (((MV)>> 0)&0xff) \
305 : "r0","r1","r11","r12","r13","r18","r20","r21","r22","r23" \
306 ); \
307 })
308
309
310 #else
311 /*
312 * Normal version for devices with <=128KiB flash (using icall)
313 */
314 #if ((FLASHEND)>131071)
315 #error "Using inappropriate code for device with more than 128kib flash"
316 #endif
317
318 #define __do_spm_ExASMEx_(MV, flash_wordaddress, spmcrval, dataword, ___bootloader__do_spm__ptr) \
319 ({ \
320 asm volatile ( \
321 "push r0\n\t" \
322 "push r1\n\t" \
323 \
324 "mov r13, %B[flashaddress]\n\t" \
325 "mov r12, %A[flashaddress]\n\t" \
326 "mov r11, %C[flashaddress]\n\t" \
327 \
328 /* also load the spmcrval */ \
329 "mov r18, %[spmcrval]\n\t" \
330 \
331 \
332 "mov r1, %B[data]\n\t" \
333 "mov r0, %A[data]\n\t" \
334 \
335 /* finally call the bootloader-function */ \
336 "icall\n\t" \
337 \
338 /* \
339 * bootloader__do_spm should change spmcrval (r18) to \
340 * "((1<<RWWSRE) | (1<<SPMEN))" in case of success \
341 */ \
342 "cpi r18, %[spmret]\n\t" \
343 /* loop infitinte if not so, most likely we called an bootloader__do_spm \
344 * with wrong magic! To avoid calls to wrong initialized pages, better crash here... \
345 */ \
346 "loop%=: \n\t" \
347 "brne loop%= \n\t" \
348 \
349 "pop r1\n\t" \
350 "pop r0\n\t" \
351 \
352 : \
353 : [flashaddress] "r" (flash_wordaddress), \
354 [spmfunctionaddress] "z" ((uint16_t)(___bootloader__do_spm__ptr)), \
355 [spmcrval] "r" (spmcrval), \
356 [data] "r" (dataword), \
357 [spmret] "M" ((1<<RWWSRE) | (1<<SPMEN)) \
358 : "r0","r1","r11","r12","r13","r18" \
359 ); \
360 })
361
362 #define __do_spm_ExASMEx_magic(MV, flash_wordaddress, spmcrval, dataword, ___bootloader__do_spm__ptr) \
363 ({ \
364 asm volatile ( \
365 "push r0\n\t" \
366 "push r1\n\t" \
367 \
368 "ldi r23, %[magicD] \n\t" \
369 "ldi r22, %[magicC] \n\t" \
370 "ldi r21, %[magicB] \n\t" \
371 "ldi r20, %[magicA] \n\t" \
372 \
373 "mov r13, %B[flashaddress]\n\t" \
374 "mov r12, %A[flashaddress]\n\t" \
375 "mov r11, %C[flashaddress]\n\t" \
376 \
377 /* also load the spmcrval */ \
378 "mov r18, %[spmcrval]\n\t" \
379 \
380 \
381 "mov r1, %B[data]\n\t" \
382 "mov r0, %A[data]\n\t" \
383 \
384 /* finally call the bootloader-function */ \
385 "icall\n\t" \
386 \
387 /* \
388 * bootloader__do_spm should change spmcrval (r18) to \
389 * "((1<<RWWSRE) | (1<<SPMEN))" in case of success \
390 */ \
391 "cpi r18, %[spmret]\n\t" \
392 /* loop infitinte if not so, most likely we called an bootloader__do_spm \
393 * with wrong magic! To avoid calls to wrong initialized pages, better crash here... \
394 */ \
395 "loop%=: \n\t" \
396 "brne loop%= \n\t" \
397 \
398 "pop r1\n\t" \
399 "pop r0\n\t" \
400 \
401 : \
402 : [flashaddress] "r" (flash_wordaddress), \
403 [spmfunctionaddress] "z" ((uint16_t)(___bootloader__do_spm__ptr)), \
404 [spmcrval] "r" (spmcrval), \
405 [data] "r" (dataword), \
406 [spmret] "M" ((1<<RWWSRE) | (1<<SPMEN)), \
407 [magicD] "M" (((MV)>>24)&0xff), \
408 [magicC] "M" (((MV)>>16)&0xff), \
409 [magicB] "M" (((MV)>> 8)&0xff), \
410 [magicA] "M" (((MV)>> 0)&0xff) \
411 : "r0","r1","r11","r12","r13","r18","r20","r21","r22","r23" \
412 ); \
413 })
414 #endif
415
416 #if (!(defined(BOOTLOADER_ADDRESS))) || (defined(NEW_BOOTLOADER_ADDRESS))
417 void do_spm(const uint32_t flash_byteaddress, const uint8_t spmcrval, const uint16_t dataword) {
418 __do_spm_Ex(flash_byteaddress, spmcrval, dataword, funcaddr___bootloader__do_spm >> 1);
419 }
420 #endif
421
422 #if HAVE_SPMINTEREFACE_NORETMAGIC
423 #define bootloader__do_spm_magic_exitstrategy(a) (0xf7f9)
424 #else
425 #define bootloader__do_spm_magic_exitstrategy(a) (a)
426 #endif
427
428 #if (HAVE_SPMINTEREFACE) && (defined(BOOTLOADER_ADDRESS)) && (!(defined(NEW_BOOTLOADER_ADDRESS)))
429
430 /*
431 * insert architecture dependend "bootloader_do_spm"-code
432 *
433 * try to make this array as big as possible
434 * (so bootloader always uses 2kbytes flash)
435 */
436 #if defined (__AVR_ATmega8__) || defined (__AVR_ATmega8A__) || defined (__AVR_ATmega8HVA__) || defined (__AVR_ATmega16__) || defined (__AVR_ATmega32__)
437
438 #if defined (__AVR_ATmega8__) || defined (__AVR_ATmega8A__) || defined (__AVR_ATmega8HVA__)
439 #if (BOOTLOADER_ADDRESS != 0x1800)
440 #error BOOTLOADER_ADDRESS!=0x1800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
441 #endif
442 #elif defined (__AVR_ATmega16__)
443 #if (BOOTLOADER_ADDRESS != 0x3800)
444 #error BOOTLOADER_ADDRESS!=0x3800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
445 #endif
446 #elif defined (__AVR_ATmega32__)
447 #if (BOOTLOADER_ADDRESS != 0x7000)
448 #error BOOTLOADER_ADDRESS!=0x7000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
449 #endif
450 #else
451 #error undefined device selection - this should not happen!
452 #endif
453
454 //assume SPMCR==0x37, SPMEN==0x0, RWWSRE=0x4, RWWSB=0x6
455 #if HAVE_SPMINTEREFACE_MAGICVALUE
456 const uint16_t bootloader__do_spm[23] BOOTLIBLINK = {
457 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 28) & 0xf))<<8) | (0x70 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 24) & 0xf))), // r23
458 bootloader__do_spm_magic_exitstrategy(0xf4a1), // brne +20
459 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 20) & 0xf))<<8) | (0x60 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 16) & 0xf))), // r22
460 bootloader__do_spm_magic_exitstrategy(0xf491), // brne +18
461 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 12) & 0xf))<<8) | (0x50 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 8) & 0xf))), // r21
462 bootloader__do_spm_magic_exitstrategy(0xf481), // brne +16
463 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 4) & 0xf))<<8) | (0x40 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 0) & 0xf))), // r20
464 bootloader__do_spm_magic_exitstrategy(0xf471), // brne +14
465 #else
466 const uint16_t bootloader__do_spm[15] BOOTLIBLINK = {
467 #endif
468 0x2dec, 0x2dfd, 0xb6b7, 0xfcb0, 0xcffd, 0xbf27, 0x95e8, 0xb6b7,
469 0xfcb0, 0xcffd, 0xe121, 0xb6b7, 0xfcb6, 0xcff4, 0x9508
470 };
471
472 /*
473 00001826 <bootloader__do_spm>:
474 1828: ec 2d mov r30, r12
475 182a: fd 2d mov r31, r13
476
477 0000182c <waitA>:
478 182c: b7 b6 in r11, 0x37 ; 55
479 182e: b0 fc sbrc r11, 0
480 1830: fd cf rjmp .-6 ; 0x182c <waitA>
481 1832: 27 bf out 0x37, r18 ; 55
482 1834: e8 95 spm
483
484 00001836 <waitB>:
485 1836: b7 b6 in r11, 0x37 ; 55
486 1838: b0 fc sbrc r11, 0
487 183a: fd cf rjmp .-6 ; 0x1836 <waitB>
488 183c: 21 e1 ldi r18, 0x11 ; 17
489 183e: b7 b6 in r11, 0x37 ; 55
490 1840: b6 fc sbrc r11, 6
491 1842: f4 cf rjmp .-24 ; 0x182c <waitA>
492 1844: 08 95 ret
493 */
494
495
496
497
498
499 #elif defined (__AVR_ATmega48__) || defined (__AVR_ATmega48P__) || defined (__AVR_ATmega88__) || defined (__AVR_ATmega88P__) || defined (__AVR_ATmega168__) || defined (__AVR_ATmega168P__)
500
501 #if defined (__AVR_ATmega88__) || defined (__AVR_ATmega88P__)
502 #if (BOOTLOADER_ADDRESS != 0x1800)
503 #error BOOTLOADER_ADDRESS!=0x1800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
504 #endif
505 #elif defined (__AVR_ATmega168__) || defined (__AVR_ATmega168P__)
506 #if (BOOTLOADER_ADDRESS != 0x3800)
507 #error BOOTLOADER_ADDRESS!=0x3800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
508 #endif
509 #else
510 #error undefined device selection - this should not happen!
511 #endif
512
513 //assume SPMCR:=SPMCSR==0x37, SPMEN:=SELFPRGEN==0x0, RWWSRE=0x4, RWWSB=0x6
514 #if HAVE_SPMINTEREFACE_MAGICVALUE
515 const uint16_t bootloader__do_spm[23] BOOTLIBLINK = {
516 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 28) & 0xf))<<8) | (0x70 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 24) & 0xf))), // r23
517 bootloader__do_spm_magic_exitstrategy(0xf4a1), // brne +20
518 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 20) & 0xf))<<8) | (0x60 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 16) & 0xf))), // r22
519 bootloader__do_spm_magic_exitstrategy(0xf491), // brne +18
520 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 12) & 0xf))<<8) | (0x50 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 8) & 0xf))), // r21
521 bootloader__do_spm_magic_exitstrategy(0xf481), // brne +16
522 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 4) & 0xf))<<8) | (0x40 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 0) & 0xf))), // r20
523 bootloader__do_spm_magic_exitstrategy(0xf471), // brne +14
524 #else
525 const uint16_t bootloader__do_spm[15] BOOTLIBLINK = {
526 #endif
527 0x2dec, 0x2dfd, 0xb6b7, 0xfcb0, 0xcffd, 0xbf27, 0x95e8, 0xb6b7,
528 0xfcb0, 0xcffd, 0xe121, 0xb6b7, 0xfcb6, 0xcff4, 0x9508
529 };
530 /*
531 00001826 <bootloader__do_spm>:
532 1828: ec 2d mov r30, r12
533 182a: fd 2d mov r31, r13
534
535 0000182c <waitA>:
536 182c: b7 b6 in r11, 0x37 ; 55
537 182e: b0 fc sbrc r11, 0
538 1830: fd cf rjmp .-6 ; 0x182c <waitA>
539 1832: 27 bf out 0x37, r18 ; 55
540 1834: e8 95 spm
541
542 00001836 <waitB>:
543 1836: b7 b6 in r11, 0x37 ; 55
544 1838: b0 fc sbrc r11, 0
545 183a: fd cf rjmp .-6 ; 0x1836 <waitB>
546 183c: 21 e1 ldi r18, 0x11 ; 17
547 183e: b7 b6 in r11, 0x37 ; 55
548 1840: b6 fc sbrc r11, 6
549 1842: f4 cf rjmp .-24 ; 0x182c <waitA>
550 1844: 08 95 ret
551 */
552
553
554
555
556
557 #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__)
558
559 #if defined (__AVR_ATmega88A__) || defined (__AVR_ATmega88PA__)
560 #if (BOOTLOADER_ADDRESS != 0x1800)
561 #error BOOTLOADER_ADDRESS!=0x1800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
562 #endif
563 #elif defined (__AVR_ATmega168A__) || defined (__AVR_ATmega168PA__)
564 #if (BOOTLOADER_ADDRESS != 0x3800)
565 #error BOOTLOADER_ADDRESS!=0x3800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
566 #endif
567 #elif defined (__AVR_ATmega328__) || defined (__AVR_ATmega328P__)
568 #if (BOOTLOADER_ADDRESS != 0x7000)
569 #error BOOTLOADER_ADDRESS!=0x7000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
570 #endif
571 #else
572 #error undefined device selection - this should not happen!
573 #endif
574
575 //assume SPMCR:=SPMCSR==0x37, SPMEN:=SELFPRGEN==0x0, RWWSRE=0x4, RWWSB=0x6
576 #if HAVE_SPMINTEREFACE_MAGICVALUE
577 const uint16_t bootloader__do_spm[23] BOOTLIBLINK = {
578 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 28) & 0xf))<<8) | (0x70 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 24) & 0xf))), // r23
579 bootloader__do_spm_magic_exitstrategy(0xf4a1), // brne +20
580 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 20) & 0xf))<<8) | (0x60 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 16) & 0xf))), // r22
581 bootloader__do_spm_magic_exitstrategy(0xf491), // brne +18
582 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 12) & 0xf))<<8) | (0x50 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 8) & 0xf))), // r21
583 bootloader__do_spm_magic_exitstrategy(0xf481), // brne +16
584 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 4) & 0xf))<<8) | (0x40 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 0) & 0xf))), // r20
585 bootloader__do_spm_magic_exitstrategy(0xf471), // brne +14
586 #else
587 const uint16_t bootloader__do_spm[15] BOOTLIBLINK = {
588 #endif
589 0x2dec, 0x2dfd, 0xb6b7, 0xfcb0, 0xcffd, 0xbf27, 0x95e8, 0xb6b7,
590 0xfcb0, 0xcffd, 0xe121, 0xb6b7, 0xfcb6, 0xcff4, 0x9508
591 };
592 /*
593 00001826 <bootloader__do_spm>:
594 1828: ec 2d mov r30, r12
595 182a: fd 2d mov r31, r13
596
597 0000182c <waitA>:
598 182c: b7 b6 in r11, 0x37 ; 55
599 182e: b0 fc sbrc r11, 0
600 1830: fd cf rjmp .-6 ; 0x182c <waitA>
601 1832: 27 bf out 0x37, r18 ; 55
602 1834: e8 95 spm
603
604 00001836 <waitB>:
605 1836: b7 b6 in r11, 0x37 ; 55
606 1838: b0 fc sbrc r11, 0
607 183a: fd cf rjmp .-6 ; 0x1836 <waitB>
608 183c: 21 e1 ldi r18, 0x11 ; 17
609 183e: b7 b6 in r11, 0x37 ; 55
610 1840: b6 fc sbrc r11, 6
611 1842: f4 cf rjmp .-24 ; 0x182c <waitA>
612 1844: 08 95 ret
613 */
614
615
616
617
618
619 #elif defined (__AVR_ATmega128__)
620
621 #if defined (__AVR_ATmega128__)
622 #if (BOOTLOADER_ADDRESS != 0x1E000)
623 #error BOOTLOADER_ADDRESS!=0x1E000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
624 #endif
625 #else
626 #error undefined device selection - this should not happen!
627 #endif
628
629 //assume SPMCR:=SPMCSR==0x68, SPMEN==0x0, RWWSRE=0x4, RWWSB=0x6 and rampZ=0x3b
630 #if HAVE_SPMINTEREFACE_MAGICVALUE
631 const uint16_t bootloader__do_spm[28] BOOTLIBLINK = {
632 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 28) & 0xf))<<8) | (0x70 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 24) & 0xf))), // r23
633 bootloader__do_spm_magic_exitstrategy(0xf4c9), // brne +21+4
634 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 20) & 0xf))<<8) | (0x60 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 16) & 0xf))), // r22
635 bootloader__do_spm_magic_exitstrategy(0xf4b9), // brne +19+4
636 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 12) & 0xf))<<8) | (0x50 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 8) & 0xf))), // r21
637 bootloader__do_spm_magic_exitstrategy(0xf4a9), // brne +17+4
638 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 4) & 0xf))<<8) | (0x40 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 0) & 0xf))), // r20
639 bootloader__do_spm_magic_exitstrategy(0xf499), // brne +15+4
640 #else
641 const uint16_t bootloader__do_spm[20] BOOTLIBLINK = {
642 #endif
643 0xbebb, 0x2dec, 0x2dfd, 0x90b0, 0x0068, 0xfcb0, 0xcffc, 0x9320, 0x0068,
644 0x95e8, 0x90b0, 0x0068, 0xfcb0, 0xcffc, 0xe121, 0x90b0, 0x0068, 0xfcb6,
645 0xcff0, 0x9508
646 };
647 /*
648 0001e08c <bootloader__do_spm>:
649 1e08c: bb be out 0x3b, r11 ; 59
650 1e08e: ec 2d mov r30, r12
651 1e090: fd 2d mov r31, r13
652
653 0001e092 <waitA>:
654 1e092: b0 90 68 00 lds r11, 0x0068
655 1e096: b0 fc sbrc r11, 0
656 1e098: fc cf rjmp .-8 ; 0x1e092 <waitA>
657 1e09a: 20 93 68 00 sts 0x0068, r18
658 1e09e: e8 95 spm
659
660 0001e0a0 <waitB>:
661 1e0a0: b0 90 68 00 lds r11, 0x0068
662 1e0a4: b0 fc sbrc r11, 0
663 1e0a6: fc cf rjmp .-8 ; 0x1e0a0 <waitB>
664 1e0a8: 21 e1 ldi r18, 0x11 ; 17
665 1e0aa: b0 90 68 00 lds r11, 0x0068
666 1e0ae: b6 fc sbrc r11, 6
667 1e0b0: f0 cf rjmp .-32 ; 0x1e092 <waitA>
668 1e0b2: 08 95 ret
669 */
670
671
672
673
674
675 #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__)
676
677 #if defined (__AVR_ATmega164A__) || defined (__AVR_ATmega164P__) || defined (__AVR_ATmega164PA__)
678 #if (BOOTLOADER_ADDRESS != 0x3800)
679 #error BOOTLOADER_ADDRESS!=0x3800, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
680 #endif
681 #elif defined (__AVR_ATmega324A__) || defined (__AVR_ATmega324P__) || defined (__AVR_ATmega324PA__)
682 #if (BOOTLOADER_ADDRESS != 0x7000)
683 #error BOOTLOADER_ADDRESS!=0x7000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
684 #endif
685 #elif defined (__AVR_ATmega640__)
686 #if (BOOTLOADER_ADDRESS != 0xE000)
687 #error BOOTLOADER_ADDRESS!=0xE000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
688 #endif
689 #elif defined (__AVR_ATmega644__) || defined (__AVR_ATmega644A__) || defined (__AVR_ATmega644P__) || defined (__AVR_ATmega644PA__)
690 #if (BOOTLOADER_ADDRESS != 0xE000)
691 #error BOOTLOADER_ADDRESS!=0xE000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
692 #endif
693 #elif defined (__AVR_ATmega1280__)
694 #if (BOOTLOADER_ADDRESS != 0x1E000)
695 #error BOOTLOADER_ADDRESS!=0x1E000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
696 #endif
697 #elif defined (__AVR_ATmega1281__)
698 #if (BOOTLOADER_ADDRESS != 0x1E000)
699 #error BOOTLOADER_ADDRESS!=0x1E000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
700 #endif
701 #elif defined (__AVR_ATmega1284__) || defined (__AVR_ATmega1284P__)
702 #if (BOOTLOADER_ADDRESS != 0x1E000)
703 #error BOOTLOADER_ADDRESS!=0x1E000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
704 #endif
705 #elif defined (__AVR_ATmega2560__)
706 #if (BOOTLOADER_ADDRESS != 0x3E000)
707 #error BOOTLOADER_ADDRESS!=0x3E000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
708 #endif
709 #elif defined (__AVR_ATmega2561__)
710 #if (BOOTLOADER_ADDRESS != 0x3E000)
711 #error BOOTLOADER_ADDRESS!=0x3E000, on current MCU "funcaddr___bootloader__do_spm" might be currupted - please edit spminterface.h for nonstandard use
712 #endif
713 #else
714 #error undefined device selection - this should not happen!
715 #endif
716
717 //assume SPMCR:=SPCSR==0x37, SPMEN==0x0, RWWSRE=0x4, RWWSB=0x6 and rampZ=0x3b
718 #if HAVE_SPMINTEREFACE_MAGICVALUE
719 const uint16_t bootloader__do_spm[24] BOOTLIBLINK = {
720 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 28) & 0xf))<<8) | (0x70 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 24) & 0xf))), // r23
721 bootloader__do_spm_magic_exitstrategy(0xf4a9), // brne +21
722 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 20) & 0xf))<<8) | (0x60 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 16) & 0xf))), // r22
723 bootloader__do_spm_magic_exitstrategy(0xf499), // brne +19
724 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 12) & 0xf))<<8) | (0x50 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 8) & 0xf))), // r21
725 bootloader__do_spm_magic_exitstrategy(0xf489), // brne +17
726 (((0x30 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 4) & 0xf))<<8) | (0x40 | ((HAVE_SPMINTEREFACE_MAGICVALUE >> 0) & 0xf))), // r20
727 bootloader__do_spm_magic_exitstrategy(0xf479), // brne +15
728 #else
729 const uint16_t bootloader__do_spm[16] BOOTLIBLINK = {
730 #endif
731 0xbebb,
732 0x2dec, 0x2dfd, 0xb6b7, 0xfcb0, 0xcffd, 0xbf27, 0x95e8, 0xb6b7,
733 0xfcb0, 0xcffd, 0xe121, 0xb6b7, 0xfcb6, 0xcff4, 0x9508
734 };
735 /*
736 00001826 <bootloader__do_spm>:
737 1826: bb be out 0x3b,r11 ; rampZ=r11; (rampZ is at IO 0x3b)
738 1828: ec 2d mov r30, r12
739 182a: fd 2d mov r31, r13
740
741 0000182c <waitA>:
742 182c: b7 b6 in r11, 0x37 ; 55
743 182e: b0 fc sbrc r11, 0
744 1830: fd cf rjmp .-6 ; 0x182c <waitA>
745 1832: 27 bf out 0x37, r18 ; 55
746 1834: e8 95 spm
747
748 00001836 <waitB>:
749 1836: b7 b6 in r11, 0x37 ; 55
750 1838: b0 fc sbrc r11, 0
751 183a: fd cf rjmp .-6 ; 0x1836 <waitB>
752 183c: 21 e1 ldi r18, 0x11 ; 17
753 183e: b7 b6 in r11, 0x37 ; 55
754 1840: b6 fc sbrc r11, 6
755 1842: f4 cf rjmp .-24 ; 0x182c <waitA>
756 1844: 08 95 ret
757 */
758
759
760
761
762
763 #else
764 #error "bootloader__do_spm has to be adapted, since there is no architecture code, yet"
765 #endif
766
767
768 #endif
769
770 #endif
771