common/bootloader.c

   1 #include <stdint.h>
   2 #include <stdbool.h>
   3 #include <avr/io.h>
   4 #include <avr/interrupt.h>
   5 #include <avr/wdt.h>
   6 #include <util/delay.h>
   7 #include "bootloader.h"
   8
   9 #ifdef PROTOCOL_LUFA
  10 #include <LUFA/Drivers/USB/USB.h>
  11 #endif
  12
  13
  14 /* Boot Section Size in *BYTEs*
  15  *   Teensy   halfKay    512
  16  *   Teensy++ halfKay    1024
  17  *   Atmel DFU loader    4096
  18  *   LUFA bootloader     4096
  19  *   USBaspLoader        2048
  20  */
  21 #ifndef BOOTLOADER_SIZE
  22 #warning To use bootloader_jump() you need to define BOOTLOADER_SIZE in config.h.
  23 #define BOOTLOADER_SIZE     4096
  24 #endif
  25
  26 #define FLASH_SIZE          (FLASHEND + 1L)
  27 #define BOOTLOADER_START    (FLASH_SIZE - BOOTLOADER_SIZE)
  28
  29
  30 /*
  31  * Entering the Bootloader via Software
  32  * http://www.fourwalledcubicle.com/files/LUFA/Doc/120730/html/_page__software_bootloader_start.html
  33  */
  34 #define BOOTLOADER_RESET_KEY 0xB007B007
  35 uint32_t reset_key  __attribute__ ((section (".noinit")));
  36
  37 /* initialize MCU status by watchdog reset */
  38 void bootloader_jump(void) {
  39 #ifdef PROTOCOL_LUFA
  40     USB_Disable();
  41     cli();
  42     _delay_ms(2000);
  43 #endif
  44
  45 #ifdef PROTOCOL_PJRC
  46     cli();
  47     UDCON = 1;
  48     USBCON = (1<<FRZCLK);
  49     UCSR1B = 0;
  50     _delay_ms(5);
  51 #endif
  52
  53     // watchdog reset
  54     reset_key = BOOTLOADER_RESET_KEY;
  55     wdt_enable(WDTO_250MS);
  56     for (;;);
  57 }
  58
  59
  60 /* this runs before main() */
  61 void bootloader_jump_after_watchdog_reset(void) __attribute__ ((used, naked, section (".init3")));
  62 void bootloader_jump_after_watchdog_reset(void)
  63 {
  64     if ((MCUSR & (1<<WDRF)) && reset_key == BOOTLOADER_RESET_KEY) {
  65         reset_key = 0;
  66
  67         // My custom USBasploader requires this to come up.
  68         MCUSR = 0;
  69
  70         // Seems like Teensy halfkay loader requires clearing WDRF and disabling watchdog.
  71         MCUSR &= ~(1<<WDRF);
  72         wdt_disable();
  73
  74         // This is compled into 'icall', address should be in word unit, not byte.
  75         ((void (*)(void))(BOOTLOADER_START/2))();
  76     }
  77 }
  78
  79
  80 #if 0
  81 /* Jumping To The Bootloader
  82  * http://www.pjrc.com/teensy/jump_to_bootloader.html
  83  *
  84  * This method doen't work when using LUFA. idk why.
  85  * - needs to initialize more regisers or interrupt setting?
  86  */
  87 void bootloader_jump(void) {
  88 #ifdef PROTOCOL_LUFA
  89     USB_Disable();
  90     cli();
  91     _delay_ms(2000);
  92 #endif
  93
  94 #ifdef PROTOCOL_PJRC
  95     cli();
  96     UDCON = 1;
  97     USBCON = (1<<FRZCLK);
  98     UCSR1B = 0;
  99     _delay_ms(5);
 100 #endif
 101
 102     /*
 103      * Initialize
 104      */
 105 #if defined(__AVR_AT90USB162__)
 106     EIMSK = 0; PCICR = 0; SPCR = 0; ACSR = 0; EECR = 0;
 107     TIMSK0 = 0; TIMSK1 = 0; UCSR1B = 0;
 108     DDRB = 0; DDRC = 0; DDRD = 0;
 109     PORTB = 0; PORTC = 0; PORTD = 0;
 110 #elif defined(__AVR_ATmega32U4__)
 111     EIMSK = 0; PCICR = 0; SPCR = 0; ACSR = 0; EECR = 0; ADCSRA = 0;
 112     TIMSK0 = 0; TIMSK1 = 0; TIMSK3 = 0; TIMSK4 = 0; UCSR1B = 0; TWCR = 0;
 113     DDRB = 0; DDRC = 0; DDRD = 0; DDRE = 0; DDRF = 0; TWCR = 0;
 114     PORTB = 0; PORTC = 0; PORTD = 0; PORTE = 0; PORTF = 0;
 115 #elif defined(__AVR_AT90USB646__)
 116     EIMSK = 0; PCICR = 0; SPCR = 0; ACSR = 0; EECR = 0; ADCSRA = 0;
 117     TIMSK0 = 0; TIMSK1 = 0; TIMSK2 = 0; TIMSK3 = 0; UCSR1B = 0; TWCR = 0;
 118     DDRA = 0; DDRB = 0; DDRC = 0; DDRD = 0; DDRE = 0; DDRF = 0;
 119     PORTA = 0; PORTB = 0; PORTC = 0; PORTD = 0; PORTE = 0; PORTF = 0;
 120 #elif defined(__AVR_AT90USB1286__)
 121     EIMSK = 0; PCICR = 0; SPCR = 0; ACSR = 0; EECR = 0; ADCSRA = 0;
 122     TIMSK0 = 0; TIMSK1 = 0; TIMSK2 = 0; TIMSK3 = 0; UCSR1B = 0; TWCR = 0;
 123     DDRA = 0; DDRB = 0; DDRC = 0; DDRD = 0; DDRE = 0; DDRF = 0;
 124     PORTA = 0; PORTB = 0; PORTC = 0; PORTD = 0; PORTE = 0; PORTF = 0;
 125 #endif
 126
 127     /*
 128      * USBaspLoader
 129      */
 130 #if defined(__AVR_ATmega168__) || defined(__AVR_ATmega168P__) || defined(__AVR_ATmega328P__)
 131     // This makes custom USBasploader come up.
 132     MCUSR = 0;
 133
 134     // initialize ports
 135     PORTB = 0; PORTC= 0; PORTD = 0;
 136     DDRB = 0; DDRC= 0; DDRD = 0;
 137
 138     // disable interrupts
 139     EIMSK = 0; EECR = 0; SPCR = 0;
 140     ACSR = 0; SPMCSR = 0; WDTCSR = 0; PCICR = 0;
 141     TIMSK0 = 0; TIMSK1 = 0; TIMSK2 = 0;
 142     ADCSRA = 0; TWCR = 0; UCSR0B = 0;
 143 #endif
 144
 145     // This is compled into 'icall', address should be in word unit, not byte.
 146     ((void (*)(void))(BOOTLOADER_START/2))();
 147 }
 148 #endif