294 lines
9.0 KiB
C
294 lines
9.0 KiB
C
|
#include <stdint.h>
|
||
|
|
#include <stdbool.h>
|
||
|
|
#include <avr/io.h>
|
||
|
|
#include <avr/eeprom.h>
|
||
|
|
#include <avr/interrupt.h>
|
||
|
|
#include <avr/wdt.h>
|
||
|
|
#include <util/delay.h>
|
||
|
|
#include "bootloader.h"
|
||
|
|
#include <avr/boot.h>
|
||
|
|
|
||
|
|
#ifdef PROTOCOL_LUFA
|
||
|
|
# include <LUFA/Drivers/USB/USB.h>
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/** \brief Bootloader Size in *bytes*
|
||
|
|
*
|
||
|
|
* AVR Boot section size are defined by setting BOOTSZ fuse in fact. Consult with your MCU datasheet.
|
||
|
|
* Note that 'Word'(2 bytes) size and address are used in datasheet while TMK uses 'Byte'.
|
||
|
|
*
|
||
|
|
* Size of Bootloaders in bytes:
|
||
|
|
* Atmel DFU loader(ATmega32U4) 4096
|
||
|
|
* Atmel DFU loader(AT90USB128) 8192
|
||
|
|
* LUFA bootloader(ATmega32U4) 4096
|
||
|
|
* Arduino Caterina(ATmega32U4) 4096
|
||
|
|
* USBaspLoader(ATmega***) 2048
|
||
|
|
* Teensy halfKay(ATmega32U4) 512
|
||
|
|
* Teensy++ halfKay(AT90USB128) 1024
|
||
|
|
*
|
||
|
|
* AVR Boot section is located at the end of Flash memory like the followings.
|
||
|
|
*
|
||
|
|
* byte Atmel/LUFA(ATMega32u4) byte Atmel(AT90SUB128)
|
||
|
|
* 0x0000 +---------------+ 0x00000 +---------------+
|
||
|
|
* | | | |
|
||
|
|
* | | | |
|
||
|
|
* | Application | | Application |
|
||
|
|
* | | | |
|
||
|
|
* = = = =
|
||
|
|
* | | 32KB-4KB | | 128KB-8KB
|
||
|
|
* 0x7000 +---------------+ 0x1E000 +---------------+
|
||
|
|
* | Bootloader | 4KB | Bootloader | 8KB
|
||
|
|
* 0x7FFF +---------------+ 0x1FFFF +---------------+
|
||
|
|
*
|
||
|
|
*
|
||
|
|
* byte Teensy(ATMega32u4) byte Teensy++(AT90SUB128)
|
||
|
|
* 0x0000 +---------------+ 0x00000 +---------------+
|
||
|
|
* | | | |
|
||
|
|
* | | | |
|
||
|
|
* | Application | | Application |
|
||
|
|
* | | | |
|
||
|
|
* = = = =
|
||
|
|
* | | 32KB-512B | | 128KB-1KB
|
||
|
|
* 0x7E00 +---------------+ 0x1FC00 +---------------+
|
||
|
|
* | Bootloader | 512B | Bootloader | 1KB
|
||
|
|
* 0x7FFF +---------------+ 0x1FFFF +---------------+
|
||
|
|
*/
|
||
|
|
#define FLASH_SIZE (FLASHEND + 1L)
|
||
|
|
|
||
|
|
#if !defined(BOOTLOADER_SIZE)
|
||
|
|
uint16_t bootloader_start;
|
||
|
|
#endif
|
||
|
|
|
||
|
|
// compatibility between ATMega8 and ATMega88
|
||
|
|
#if !defined(MCUCSR)
|
||
|
|
# if defined(MCUSR)
|
||
|
|
# define MCUCSR MCUSR
|
||
|
|
# endif
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/** \brief Entering the Bootloader via Software
|
||
|
|
*
|
||
|
|
* http://www.fourwalledcubicle.com/files/LUFA/Doc/120730/html/_page__software_bootloader_start.html
|
||
|
|
*/
|
||
|
|
#define BOOTLOADER_RESET_KEY 0xB007B007
|
||
|
|
uint32_t reset_key __attribute__((section(".noinit,\"aw\",@nobits;")));
|
||
|
|
|
||
|
|
/** \brief initialize MCU status by watchdog reset
|
||
|
|
*
|
||
|
|
* FIXME: needs doc
|
||
|
|
*/
|
||
|
|
void bootloader_jump(void) {
|
||
|
|
#if !defined(BOOTLOADER_SIZE)
|
||
|
|
uint8_t high_fuse = boot_lock_fuse_bits_get(GET_HIGH_FUSE_BITS);
|
||
|
|
|
||
|
|
if (high_fuse & ~(FUSE_BOOTSZ0 & FUSE_BOOTSZ1)) {
|
||
|
|
bootloader_start = (FLASH_SIZE - 512) >> 1;
|
||
|
|
} else if (high_fuse & ~(FUSE_BOOTSZ1)) {
|
||
|
|
bootloader_start = (FLASH_SIZE - 1024) >> 1;
|
||
|
|
} else if (high_fuse & ~(FUSE_BOOTSZ0)) {
|
||
|
|
bootloader_start = (FLASH_SIZE - 2048) >> 1;
|
||
|
|
} else {
|
||
|
|
bootloader_start = (FLASH_SIZE - 4096) >> 1;
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
// Something like this might work, but it compiled larger than the block above
|
||
|
|
// bootloader_start = FLASH_SIZE - (256 << (~high_fuse & 0b110 >> 1));
|
||
|
|
|
||
|
|
#if defined(BOOTLOADER_HALFKAY)
|
||
|
|
// http://www.pjrc.com/teensy/jump_to_bootloader.html
|
||
|
|
cli();
|
||
|
|
// disable watchdog, if enabled (it's not)
|
||
|
|
// disable all peripherals
|
||
|
|
// a shutdown call might make sense here
|
||
|
|
UDCON = 1;
|
||
|
|
USBCON = (1 << FRZCLK); // disable USB
|
||
|
|
UCSR1B = 0;
|
||
|
|
_delay_ms(5);
|
||
|
|
# if defined(__AVR_AT90USB162__) // Teensy 1.0
|
||
|
|
EIMSK = 0;
|
||
|
|
PCICR = 0;
|
||
|
|
SPCR = 0;
|
||
|
|
ACSR = 0;
|
||
|
|
EECR = 0;
|
||
|
|
TIMSK0 = 0;
|
||
|
|
TIMSK1 = 0;
|
||
|
|
UCSR1B = 0;
|
||
|
|
DDRB = 0;
|
||
|
|
DDRC = 0;
|
||
|
|
DDRD = 0;
|
||
|
|
PORTB = 0;
|
||
|
|
PORTC = 0;
|
||
|
|
PORTD = 0;
|
||
|
|
asm volatile("jmp 0x3E00");
|
||
|
|
# elif defined(__AVR_ATmega32U4__) // Teensy 2.0
|
||
|
|
EIMSK = 0;
|
||
|
|
PCICR = 0;
|
||
|
|
SPCR = 0;
|
||
|
|
ACSR = 0;
|
||
|
|
EECR = 0;
|
||
|
|
ADCSRA = 0;
|
||
|
|
TIMSK0 = 0;
|
||
|
|
TIMSK1 = 0;
|
||
|
|
TIMSK3 = 0;
|
||
|
|
TIMSK4 = 0;
|
||
|
|
UCSR1B = 0;
|
||
|
|
TWCR = 0;
|
||
|
|
DDRB = 0;
|
||
|
|
DDRC = 0;
|
||
|
|
DDRD = 0;
|
||
|
|
DDRE = 0;
|
||
|
|
DDRF = 0;
|
||
|
|
TWCR = 0;
|
||
|
|
PORTB = 0;
|
||
|
|
PORTC = 0;
|
||
|
|
PORTD = 0;
|
||
|
|
PORTE = 0;
|
||
|
|
PORTF = 0;
|
||
|
|
asm volatile("jmp 0x7E00");
|
||
|
|
# elif defined(__AVR_AT90USB646__) // Teensy++ 1.0
|
||
|
|
EIMSK = 0;
|
||
|
|
PCICR = 0;
|
||
|
|
SPCR = 0;
|
||
|
|
ACSR = 0;
|
||
|
|
EECR = 0;
|
||
|
|
ADCSRA = 0;
|
||
|
|
TIMSK0 = 0;
|
||
|
|
TIMSK1 = 0;
|
||
|
|
TIMSK2 = 0;
|
||
|
|
TIMSK3 = 0;
|
||
|
|
UCSR1B = 0;
|
||
|
|
TWCR = 0;
|
||
|
|
DDRA = 0;
|
||
|
|
DDRB = 0;
|
||
|
|
DDRC = 0;
|
||
|
|
DDRD = 0;
|
||
|
|
DDRE = 0;
|
||
|
|
DDRF = 0;
|
||
|
|
PORTA = 0;
|
||
|
|
PORTB = 0;
|
||
|
|
PORTC = 0;
|
||
|
|
PORTD = 0;
|
||
|
|
PORTE = 0;
|
||
|
|
PORTF = 0;
|
||
|
|
asm volatile("jmp 0xFC00");
|
||
|
|
# elif defined(__AVR_AT90USB1286__) // Teensy++ 2.0
|
||
|
|
EIMSK = 0;
|
||
|
|
PCICR = 0;
|
||
|
|
SPCR = 0;
|
||
|
|
ACSR = 0;
|
||
|
|
EECR = 0;
|
||
|
|
ADCSRA = 0;
|
||
|
|
TIMSK0 = 0;
|
||
|
|
TIMSK1 = 0;
|
||
|
|
TIMSK2 = 0;
|
||
|
|
TIMSK3 = 0;
|
||
|
|
UCSR1B = 0;
|
||
|
|
TWCR = 0;
|
||
|
|
DDRA = 0;
|
||
|
|
DDRB = 0;
|
||
|
|
DDRC = 0;
|
||
|
|
DDRD = 0;
|
||
|
|
DDRE = 0;
|
||
|
|
DDRF = 0;
|
||
|
|
PORTA = 0;
|
||
|
|
PORTB = 0;
|
||
|
|
PORTC = 0;
|
||
|
|
PORTD = 0;
|
||
|
|
PORTE = 0;
|
||
|
|
PORTF = 0;
|
||
|
|
asm volatile("jmp 0x1FC00");
|
||
|
|
# endif
|
||
|
|
|
||
|
|
#elif defined(BOOTLOADER_CATERINA)
|
||
|
|
// this block may be optional
|
||
|
|
// TODO: figure it out
|
||
|
|
|
||
|
|
uint16_t *const bootKeyPtr = (uint16_t *)0x0800;
|
||
|
|
|
||
|
|
// Value used by Caterina bootloader use to determine whether to run the
|
||
|
|
// sketch or the bootloader programmer.
|
||
|
|
uint16_t bootKey = 0x7777;
|
||
|
|
|
||
|
|
*bootKeyPtr = bootKey;
|
||
|
|
|
||
|
|
// setup watchdog timeout
|
||
|
|
wdt_enable(WDTO_60MS);
|
||
|
|
|
||
|
|
while (1) {
|
||
|
|
} // wait for watchdog timer to trigger
|
||
|
|
|
||
|
|
#elif defined(BOOTLOADER_USBASP)
|
||
|
|
// Taken with permission of Stephan Baerwolf from https://github.com/tinyusbboard/API/blob/master/apipage.c
|
||
|
|
wdt_enable(WDTO_15MS);
|
||
|
|
wdt_reset();
|
||
|
|
asm volatile("cli \n\t"
|
||
|
|
"ldi r29 , %[ramendhi] \n\t"
|
||
|
|
"ldi r28 , %[ramendlo] \n\t"
|
||
|
|
# if (FLASHEND > 131071)
|
||
|
|
"ldi r18 , %[bootaddrhi] \n\t"
|
||
|
|
"st Y+, r18 \n\t"
|
||
|
|
# endif
|
||
|
|
"ldi r18 , %[bootaddrme] \n\t"
|
||
|
|
"st Y+, r18 \n\t"
|
||
|
|
"ldi r18 , %[bootaddrlo] \n\t"
|
||
|
|
"st Y+, r18 \n\t"
|
||
|
|
"out %[mcucsrio], __zero_reg__ \n\t"
|
||
|
|
"bootloader_startup_loop%=: \n\t"
|
||
|
|
"rjmp bootloader_startup_loop%= \n\t"
|
||
|
|
:
|
||
|
|
: [ mcucsrio ] "I"(_SFR_IO_ADDR(MCUCSR)),
|
||
|
|
# if (FLASHEND > 131071)
|
||
|
|
[ ramendhi ] "M"(((RAMEND - 2) >> 8) & 0xff), [ ramendlo ] "M"(((RAMEND - 2) >> 0) & 0xff), [ bootaddrhi ] "M"((((FLASH_SIZE - BOOTLOADER_SIZE) >> 1) >> 16) & 0xff),
|
||
|
|
# else
|
||
|
|
[ ramendhi ] "M"(((RAMEND - 1) >> 8) & 0xff), [ ramendlo ] "M"(((RAMEND - 1) >> 0) & 0xff),
|
||
|
|
# endif
|
||
|
|
[ bootaddrme ] "M"((((FLASH_SIZE - BOOTLOADER_SIZE) >> 1) >> 8) & 0xff), [ bootaddrlo ] "M"((((FLASH_SIZE - BOOTLOADER_SIZE) >> 1) >> 0) & 0xff));
|
||
|
|
|
||
|
|
#else // Assume remaining boards are DFU, even if the flag isn't set
|
||
|
|
|
||
|
|
# if !(defined(__AVR_ATmega32A__) || defined(__AVR_ATmega328P__)) // no USB - maybe BOOTLOADER_BOOTLOADHID instead though?
|
||
|
|
UDCON = 1;
|
||
|
|
USBCON = (1 << FRZCLK); // disable USB
|
||
|
|
UCSR1B = 0;
|
||
|
|
_delay_ms(5); // 5 seems to work fine
|
||
|
|
# endif
|
||
|
|
|
||
|
|
# ifdef BOOTLOADER_BOOTLOADHID
|
||
|
|
// force bootloadHID to stay in bootloader mode, so that it waits
|
||
|
|
// for a new firmware to be flashed
|
||
|
|
eeprom_write_byte((uint8_t *)1, 0x00);
|
||
|
|
# endif
|
||
|
|
|
||
|
|
// watchdog reset
|
||
|
|
reset_key = BOOTLOADER_RESET_KEY;
|
||
|
|
wdt_enable(WDTO_250MS);
|
||
|
|
for (;;)
|
||
|
|
;
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
/* this runs before main() */
|
||
|
|
void bootloader_jump_after_watchdog_reset(void) __attribute__((used, naked, section(".init3")));
|
||
|
|
void bootloader_jump_after_watchdog_reset(void) {
|
||
|
|
#ifndef BOOTLOADER_HALFKAY
|
||
|
|
if ((MCUCSR & (1 << WDRF)) && reset_key == BOOTLOADER_RESET_KEY) {
|
||
|
|
reset_key = 0;
|
||
|
|
|
||
|
|
// My custom USBasploader requires this to come up.
|
||
|
|
MCUCSR = 0;
|
||
|
|
|
||
|
|
// Seems like Teensy halfkay loader requires clearing WDRF and disabling watchdog.
|
||
|
|
MCUCSR &= ~(1 << WDRF);
|
||
|
|
wdt_disable();
|
||
|
|
|
||
|
|
// This is compled into 'icall', address should be in word unit, not byte.
|
||
|
|
# ifdef BOOTLOADER_SIZE
|
||
|
|
((void (*)(void))((FLASH_SIZE - BOOTLOADER_SIZE) >> 1))();
|
||
|
|
# else
|
||
|
|
asm("ijmp" ::"z"(bootloader_start));
|
||
|
|
# endif
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
}
|