rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-01-18 03:52:11 +01:00
Code Issues Releases Activity

Implement a simulated watchdog to catch when the chip would have reboot

Browse Source
This commit is contained in:
James Cotton 2012-03-12 18:05:09 -05:00
parent 28cab678ce
commit 3c0b65fbf8
2 changed files with 30 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
flight/PiOS.osx/inc/pios_wdg.h
View File

@ -37,6 +37,7 @@ bool PIOS_WDG_UpdateFlag(uint16_t flag);
uint16_t PIOS_WDG_GetBootupFlags();
uint16_t PIOS_WDG_GetActiveFlags();
void PIOS_WDG_Clear(void);
bool PIOS_WDG_Check();
#define PIOS_WDG_ACTUATOR 0x0001
#define PIOS_WDG_STABILIZATION 0x0002

29
flight/PiOS.osx/osx/pios_wdg.c
View File

@ -34,6 +34,12 @@
#include "pios.h"
unsigned int wdg_registered_flags;
unsigned int wdg_updated_flags;
unsigned int wdg_cleared_time;
unsigned int wdg_last_update_time;
bool wdg_expired;
/**
* @brief Initialize the watchdog timer for a specified timeout
*
@ -53,6 +59,8 @@
*/
void PIOS_WDG_Init()
{
wdg_registered_flags = 0;
wdg_updated_flags = 0;
}
/**
@ -70,6 +78,7 @@ void PIOS_WDG_Init()
*/
bool PIOS_WDG_RegisterFlag(uint16_t flag_requested)
{
wdg_registered_flags |= flag_requested;
return true;
}
@ -85,6 +94,13 @@ bool PIOS_WDG_RegisterFlag(uint16_t flag_requested)
*/
bool PIOS_WDG_UpdateFlag(uint16_t flag)
{
PIOS_WDG_Check();
wdg_updated_flags |= flag;
if( wdg_updated_flags == wdg_registered_flags) {
wdg_last_update_time = PIOS_DELAY_DiffuS(wdg_cleared_time);
wdg_updated_flags = 0;
wdg_cleared_time = PIOS_DELAY_GetRaw();
}
return true;
}
@ -121,3 +137,16 @@ uint16_t PIOS_WDG_GetActiveFlags()
void PIOS_WDG_Clear(void)
{
}
/**
* @brief This function returns true if the watchdog would
* have expired
*/
bool PIOS_WDG_Check()
{
if(PIOS_DELAY_DiffuS(wdg_cleared_time) > 250000) {
fprintf(stderr, "Watchdog fired!\r\n");
wdg_expired = true;
}
return wdg_expired;
}