mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-10-28 09:03:46 +08:00
firestar5683
c1aeddbfea
Manage device power, parked services and vehicle-specific Panda wake behavior. Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com> Co-authored-by: Daniel Koepping <elkoled@gmail.com> Co-authored-by: firestarsdog <229254897+firestarsdog@users.noreply.github.com>
70 lines
2.2 KiB
C
70 lines
2.2 KiB
C
#pragma once
|
|
|
|
#include "board/drivers/drivers.h"
|
|
|
|
bool bootkick_reset_triggered = false;
|
|
|
|
void bootkick_tick(bool ignition, bool recent_heartbeat, bool wake) {
|
|
static uint8_t waiting_to_boot_countdown = 0;
|
|
static uint8_t boot_reset_countdown = 0;
|
|
static uint8_t bootkick_harness_status_prev = HARNESS_STATUS_NC;
|
|
static bool bootkick_ign_prev = false;
|
|
static bool bootkick_wake_prev = false;
|
|
static BootState boot_state = BOOT_BOOTKICK;
|
|
BootState boot_state_prev = boot_state;
|
|
const bool harness_inserted = (harness.status != bootkick_harness_status_prev) && (harness.status != HARNESS_STATUS_NC);
|
|
|
|
if ((ignition && !bootkick_ign_prev) || harness_inserted || (wake && !bootkick_wake_prev && !ignition)) {
|
|
// bootkick on rising edge of ignition or harness insertion
|
|
boot_state = BOOT_BOOTKICK;
|
|
} else if (recent_heartbeat) {
|
|
// disable bootkick once openpilot is up
|
|
boot_state = BOOT_STANDBY;
|
|
} else {
|
|
|
|
}
|
|
|
|
/*
|
|
Ensure SOM boots in case it goes into QDL mode. Reset behavior:
|
|
* shouldn't trigger on the first boot after power-on
|
|
* only try reset once per bootkick, i.e. don't keep trying until booted
|
|
* only try once per panda boot, since openpilot will reset panda on startup
|
|
* once BOOT_RESET is triggered, it stays until countdown is finished
|
|
*/
|
|
if (!bootkick_reset_triggered && (boot_state == BOOT_BOOTKICK) && (boot_state_prev == BOOT_STANDBY)) {
|
|
waiting_to_boot_countdown = 20U;
|
|
}
|
|
if (waiting_to_boot_countdown > 0U) {
|
|
if (current_board->read_som_gpio() || (boot_state != BOOT_BOOTKICK)) {
|
|
waiting_to_boot_countdown = 0U;
|
|
} else {
|
|
// try a reset
|
|
if (waiting_to_boot_countdown == 1U) {
|
|
boot_reset_countdown = 5U;
|
|
}
|
|
}
|
|
}
|
|
|
|
// handle reset state
|
|
if (boot_reset_countdown > 0U) {
|
|
boot_state = BOOT_RESET;
|
|
bootkick_reset_triggered = true;
|
|
} else {
|
|
if (boot_state == BOOT_RESET) {
|
|
boot_state = BOOT_BOOTKICK;
|
|
}
|
|
}
|
|
|
|
// update state
|
|
bootkick_ign_prev = ignition;
|
|
bootkick_wake_prev = wake;
|
|
bootkick_harness_status_prev = harness.status;
|
|
if (waiting_to_boot_countdown > 0U) {
|
|
waiting_to_boot_countdown--;
|
|
}
|
|
if (boot_reset_countdown > 0U) {
|
|
boot_reset_countdown--;
|
|
}
|
|
current_board->set_bootkick(boot_state);
|
|
}
|