Atmosphere/fusee/fusee-primary/src/utils.c

78 lines
1.8 KiB
C
Raw Normal View History

#include <stdbool.h>
2018-05-20 14:18:48 +00:00
#include <stdarg.h>
#include "utils.h"
#include "se.h"
#include "fuse.h"
#include "pmc.h"
#include "timers.h"
2018-05-20 14:18:48 +00:00
#include "panic.h"
2018-05-20 21:52:09 +00:00
#include "car.h"
2018-05-20 14:18:48 +00:00
#include "lib/printk.h"
#include "hwinit/btn.h"
2018-05-20 12:11:46 +00:00
__attribute__((noreturn)) void watchdog_reboot(void) {
volatile watchdog_timers_t *wdt = GET_WDT(4);
wdt->PATTERN = WDT_REBOOT_PATTERN;
wdt->COMMAND = 2; /* Disable Counter. */
GET_WDT_REBOOT_CFG_REG(4) = 0xC0000000;
wdt->CONFIG = 0x8019; /* Full System Reset after Fourth Counter expires, using TIMER(9). */
wdt->COMMAND = 1; /* Enable Counter. */
while (true) {
/* Wait for reboot. */
}
2018-05-20 12:11:46 +00:00
}
2018-05-20 12:11:46 +00:00
__attribute__((noreturn)) void pmc_reboot(uint32_t scratch0) {
APBDEV_PMC_SCRATCH0_0 = scratch0;
/* Reset the processor. */
2018-05-20 12:11:46 +00:00
APBDEV_PMC_CONTROL = BIT(4);
while (true) {
/* Wait for reboot. */
}
}
2018-05-20 21:52:09 +00:00
__attribute__((noreturn)) void car_reboot(void) {
/* Reset the processor. */
car_get_regs()->rst_dev_l |= 1<<2;
while (true) {
/* Wait for reboot. */
}
}
__attribute__((noreturn)) void wait_for_button_and_reboot(void) {
2018-05-20 12:11:46 +00:00
uint32_t button;
while (true) {
button = btn_read();
if (button & BTN_POWER) {
2018-05-20 21:52:09 +00:00
car_reboot();
2018-05-20 12:11:46 +00:00
}
}
}
2018-05-20 12:11:46 +00:00
__attribute__ ((noreturn)) void generic_panic(void) {
2018-05-20 14:18:48 +00:00
panic(0xFF000006);
}
__attribute__((noreturn)) void fatal_error(const char *fmt, ...) {
va_list args;
printk("Fatal error: ");
va_start(args, fmt);
vprintk(fmt, args);
va_end(args);
2018-05-20 21:52:09 +00:00
printk("\nPress POWER to reboot\n");
wait_for_button_and_reboot();
}
__attribute__((noinline)) bool overlaps(uint64_t as, uint64_t ae, uint64_t bs, uint64_t be)
{
if(as <= bs && bs <= ae)
return true;
if(bs <= as && as <= be)
return true;
return false;
}