HAL_ChibiOS: implement was_watchdog_armed()

This commit is contained in:
Andrew Tridgell 2019-04-20 14:01:25 +10:00
parent 63e636fd5a
commit f5e170c76b
5 changed files with 76 additions and 28 deletions

View File

@ -21,6 +21,7 @@
#include <chheap.h> #include <chheap.h>
#include "RCOutput.h" #include "RCOutput.h"
#include "hwdef/common/stm32_util.h" #include "hwdef/common/stm32_util.h"
#include "hwdef/common/watchdog.h"
#include "hwdef/common/flash.h" #include "hwdef/common/flash.h"
#include <AP_ROMFS/AP_ROMFS.h> #include <AP_ROMFS/AP_ROMFS.h>
#include "sdcard.h" #include "sdcard.h"
@ -261,3 +262,30 @@ bool Util::fs_init(void)
return sdcard_retry(); return sdcard_retry();
} }
#endif #endif
// return true if the reason for the reboot was a watchdog reset
bool Util::was_watchdog_reset() const
{
return stm32_was_watchdog_reset();
}
// return true if safety was off and this was a watchdog reset
bool Util::was_watchdog_safety_off() const
{
return stm32_was_watchdog_reset() && stm32_get_boot_backup_safety_state() == false;
}
// return true if vehicle was armed and this was a watchdog reset
bool Util::was_watchdog_armed() const
{
return stm32_was_watchdog_reset() && stm32_get_boot_backup_armed() == true;
}
/*
change armed state
*/
void Util::set_soft_armed(const bool b)
{
AP_HAL::Util::set_soft_armed(b);
stm32_set_backup_armed(b);
}

View File

@ -21,7 +21,6 @@
#include "Semaphores.h" #include "Semaphores.h"
#include "AP_HAL_ChibiOS.h" #include "AP_HAL_ChibiOS.h"
#include <ch.h> #include <ch.h>
#include "hwdef/common/watchdog.h"
class ChibiOS::Util : public AP_HAL::Util { class ChibiOS::Util : public AP_HAL::Util {
public: public:
@ -62,13 +61,14 @@ public:
#endif #endif
// return true if the reason for the reboot was a watchdog reset // return true if the reason for the reboot was a watchdog reset
bool was_watchdog_reset() const override { return stm32_was_watchdog_reset(); } bool was_watchdog_reset() const override;
// return true if safety was off and this was a watchdog reset // return true if safety was off and this was a watchdog reset
bool was_watchdog_safety_off() const override { bool was_watchdog_safety_off() const override;
return stm32_was_watchdog_reset() && stm32_get_boot_backup_safety_state() == false;
} // return true if vehicle was armed and this was a watchdog reset
bool was_watchdog_armed() const override;
private: private:
#ifdef HAL_PWM_ALARM #ifdef HAL_PWM_ALARM
struct ToneAlarmPwmGroup { struct ToneAlarmPwmGroup {
@ -103,4 +103,5 @@ private:
uint64_t get_hw_rtc() const override; uint64_t get_hw_rtc() const override;
bool flash_bootloader() override; bool flash_bootloader() override;
void set_soft_armed(const bool b) override;
}; };

View File

@ -273,8 +273,6 @@ void set_rtc_backup1(uint32_t v)
RTC->BKP1R = v; RTC->BKP1R = v;
} }
#endif //NO_FASTBOOT
/* /*
enable peripheral power if needed This is done late to prevent enable peripheral power if needed This is done late to prevent
problems with CTS causing SiK radios to stay in the bootloader. A problems with CTS causing SiK radios to stay in the bootloader. A

View File

@ -54,7 +54,7 @@ typedef struct
static bool was_watchdog_reset; static bool was_watchdog_reset;
static bool watchdog_enabled; static bool watchdog_enabled;
static bool boot_safety_state; static uint32_t boot_backup1_state;
/* /*
setup the watchdog setup the watchdog
@ -87,7 +87,7 @@ void stm32_watchdog_save_reason(void)
{ {
if (WDG_RESET_STATUS & WDG_RESET_IS_IWDG) { if (WDG_RESET_STATUS & WDG_RESET_IS_IWDG) {
was_watchdog_reset = true; was_watchdog_reset = true;
boot_safety_state = stm32_get_backup_safety_state(); boot_backup1_state = get_rtc_backup1();
} }
} }
@ -97,6 +97,7 @@ void stm32_watchdog_save_reason(void)
void stm32_watchdog_clear_reason(void) void stm32_watchdog_clear_reason(void)
{ {
WDG_RESET_STATUS = WDG_RESET_CLEAR; WDG_RESET_STATUS = WDG_RESET_CLEAR;
set_rtc_backup1(0);
} }
/* /*
@ -107,6 +108,9 @@ bool stm32_was_watchdog_reset(void)
return was_watchdog_reset; return was_watchdog_reset;
} }
#define WDG_SAFETY_BIT 0x01
#define WDG_ARMED_BIT 0x02
/* /*
set the safety state in backup register set the safety state in backup register
@ -116,26 +120,39 @@ bool stm32_was_watchdog_reset(void)
void stm32_set_backup_safety_state(bool safety_on) void stm32_set_backup_safety_state(bool safety_on)
{ {
uint32_t v = get_rtc_backup1(); uint32_t v = get_rtc_backup1();
uint32_t v2 = safety_on?(v|1):(v&~1); uint32_t v2 = safety_on?(v | WDG_SAFETY_BIT):(v & ~WDG_SAFETY_BIT);
if (v != v2) { if (v != v2) {
set_rtc_backup1(v2); set_rtc_backup1(v2);
} }
} }
/*
get the safety state in backup register
return true if safety is marked as safety on
*/
bool stm32_get_backup_safety_state(void)
{
uint32_t v = get_rtc_backup1();
return (v&1) != 0;
}
/* /*
get the safety state in backup register from initial boot get the safety state in backup register from initial boot
*/ */
bool stm32_get_boot_backup_safety_state(void) bool stm32_get_boot_backup_safety_state(void)
{ {
return boot_safety_state; return (boot_backup1_state & WDG_SAFETY_BIT) != 0;
}
/*
set the armed state in backup register
This is stored so that the armed state can be restored after a
watchdog reset
*/
void stm32_set_backup_armed(bool armed)
{
uint32_t v = get_rtc_backup1();
uint32_t v2 = armed?(v | WDG_ARMED_BIT): (v & ~WDG_ARMED_BIT);
if (v != v2) {
set_rtc_backup1(v2);
}
}
/*
get the armed state in backup register from initial boot
*/
bool stm32_get_boot_backup_armed(void)
{
return (boot_backup1_state & WDG_ARMED_BIT) != 0;
} }

View File

@ -34,16 +34,20 @@ void stm32_watchdog_clear_reason(void);
*/ */
void stm32_set_backup_safety_state(bool safety_on); void stm32_set_backup_safety_state(bool safety_on);
/*
get the safety state in backup register
return true if safety is marked as safety on
*/
bool stm32_get_backup_safety_state(void);
/* /*
get the safety state in backup register from initial boot get the safety state in backup register from initial boot
*/ */
bool stm32_get_boot_backup_safety_state(void); bool stm32_get_boot_backup_safety_state(void);
/*
set the armed state in backup register
*/
void stm32_set_backup_armed(bool armed);
/*
get the armed state in backup register from initial boot
*/
bool stm32_get_boot_backup_armed(void);
#ifdef __cplusplus #ifdef __cplusplus
} }