OmniNX/Atmosphere
2
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

fusee-primary: fix reboot-to-self for decompressed code

Browse Source
This commit is contained in:
Michael Scire
2020-11-29 18:17:51 -08:00
parent 7ed9bdd374
commit dc52610bd8
3 changed files with 108 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

27
fusee/fusee-primary/fusee-primary-main/src/utils.c
View File

@@ -37,6 +37,8 @@
#undef u8
#undef u32
extern uint8_t __reboot_start__[], __reboot_end__[];
void wait(uint32_t microseconds) {
uint32_t old_time = TIMERUS_CNTR_1US_0;
while (TIMERUS_CNTR_1US_0 - old_time <= microseconds) {
@@ -80,8 +82,31 @@ __attribute__((noreturn)) void reboot_to_self(void) {
write32le((void *)0x4003F000, i, read32le(rebootstub_bin, i));
}
/* Copy our low part into safe IRAM. */
for (size_t i = 0; i < 0x8000; i += sizeof(uint32_t)) {
write32le((void *)0x40030000, i, read32le((void *)0x40008000, i));
}
/* Copy our start page into fatal IRAM. */
for (size_t i = 0; i < 0x1000; i += sizeof(uint32_t)) {
write32le((void *)0x4003D000, i, read32le((void *)0x40010000, i));
}
/* Copy our reboot handler to the rebootstub target. */
for (size_t i = 0; i < (__reboot_end__ - __reboot_start__); i += sizeof(uint32_t)) {
write32le((void *)0x40010000, i, read32le(__reboot_start__, i));
}
/* Trigger warm reboot. */
pmc_reboot(1 << 0);
APBDEV_PMC_SCRATCH0_0 = (1 << 0);
/* Reset the processor. */
APBDEV_PMC_CONTROL = BIT(4);
while (true) {
/* Wait for reboot. */
}
}
__attribute__((noreturn)) void wait_for_button_and_reboot(void) {