122 lines
2.8 KiB
C++
122 lines
2.8 KiB
C++
/*
|
|
Copyright (c) 2015 Arduino LLC. All right reserved.
|
|
SAMD51 support added by Adafruit - Copyright (c) 2018 Dean Miller for Adafruit Industries
|
|
|
|
This library is free software; you can redistribute it and/or
|
|
modify it under the terms of the GNU Lesser General Public
|
|
License as published by the Free Software Foundation; either
|
|
version 2.1 of the License, or (at your option) any later version.
|
|
|
|
This library is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
|
|
See the GNU Lesser General Public License for more details.
|
|
|
|
You should have received a copy of the GNU Lesser General Public
|
|
License along with this library; if not, write to the Free Software
|
|
Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*/
|
|
|
|
#include <Arduino.h>
|
|
#include "Reset.h"
|
|
|
|
#ifdef __cplusplus
|
|
extern "C" {
|
|
#endif
|
|
|
|
#define NVM_MEMORY ((volatile uint16_t *)0x000000)
|
|
|
|
#if (ARDUINO_SAMD_VARIANT_COMPLIANCE >= 10610)
|
|
|
|
extern const uint32_t __text_start__;
|
|
#define APP_START ((volatile uint32_t)(&__text_start__) + 4)
|
|
|
|
#else
|
|
|
|
#if defined(__SAMD51__)
|
|
#define APP_START 0x00004004
|
|
#else
|
|
#define APP_START 0x00002004
|
|
#endif
|
|
|
|
#endif
|
|
|
|
static inline bool nvmReady(void) {
|
|
#if defined(__SAMD51__)
|
|
return NVMCTRL->STATUS.reg & NVMCTRL_STATUS_READY;
|
|
#else
|
|
return NVMCTRL->INTFLAG.reg & NVMCTRL_INTFLAG_READY;
|
|
#endif
|
|
}
|
|
|
|
__attribute__ ((long_call, section (".ramfunc")))
|
|
static void banzai() {
|
|
// Disable all interrupts
|
|
__disable_irq();
|
|
|
|
#if defined(__SAMD51__)
|
|
//THESE MUST MATCH THE BOOTLOADER
|
|
#define DOUBLE_TAP_MAGIC 0xf01669efUL
|
|
#define BOOT_DOUBLE_TAP_ADDRESS (HSRAM_ADDR + HSRAM_SIZE - 4)
|
|
|
|
unsigned long *a = (unsigned long *)BOOT_DOUBLE_TAP_ADDRESS;
|
|
*a = DOUBLE_TAP_MAGIC;
|
|
//NVMCTRL->ADDR.reg = APP_START;
|
|
//NVMCTRL->CTRLB.reg = NVMCTRL_CTRLB_CMD_EB | NVMCTRL_CTRLB_CMDEX_KEY;
|
|
|
|
// Reset the device
|
|
NVIC_SystemReset() ;
|
|
|
|
while (true);
|
|
#else
|
|
|
|
// Avoid erasing the application if APP_START is < than the minimum bootloader size
|
|
// This could happen if without_bootloader linker script was chosen
|
|
// Minimum bootloader size in SAMD21 family is 512bytes (RM section 22.6.5)
|
|
|
|
if (APP_START < (0x200 + 4)) {
|
|
goto reset;
|
|
}
|
|
|
|
|
|
// Erase application
|
|
while (!nvmReady())
|
|
;
|
|
|
|
NVMCTRL->STATUS.reg |= NVMCTRL_STATUS_MASK;
|
|
NVMCTRL->ADDR.reg = (uintptr_t)&NVM_MEMORY[APP_START / 4];
|
|
NVMCTRL->CTRLA.reg = NVMCTRL_CTRLA_CMD_ER | NVMCTRL_CTRLA_CMDEX_KEY;
|
|
|
|
while (!nvmReady())
|
|
;
|
|
|
|
reset:
|
|
// Reset the device
|
|
NVIC_SystemReset() ;
|
|
|
|
while (true);
|
|
#endif
|
|
|
|
}
|
|
|
|
static int ticks = -1;
|
|
|
|
void initiateReset(int _ticks) {
|
|
ticks = _ticks;
|
|
}
|
|
|
|
void cancelReset() {
|
|
ticks = -1;
|
|
}
|
|
|
|
void tickReset() {
|
|
if (ticks == -1)
|
|
return;
|
|
ticks--;
|
|
if (ticks == 0)
|
|
banzai();
|
|
}
|
|
|
|
#ifdef __cplusplus
|
|
}
|
|
#endif
|