Diff: ResetSupervisor.cpp

Revision:

1:4e2e6a9dc079

Child:

2:72d1cb8fc13c

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/ResetSupervisor.cpp	Thu Oct 03 19:47:05 2019 +0000
@@ -0,0 +1,115 @@
+/// @file Supervisor.cpp provides the interface to the Supervisor module
+///
+/// This provides basic Supervisor service for the mbed. You can configure
+/// various timeout intervals that meet your system needs. Additionally,
+/// it is possible to identify if the Supervisor was the cause of any 
+/// system restart.
+/// 
+/// Adapted from Simon's watchdog code from http://mbed.org/forum/mbed/topic/508/
+
+
+#include "mbed.h"
+#include "ResetSupervisor.h"
+
+#ifdef FEATURE_COMMON_PAL
+#include "mbed_trace.h"
+#define TRACE_GROUP "WDT"
+#else
+#define tr_debug(format, ...) debug_if(_debug_trace_on, format "\n", ## __VA_ARGS__)
+#define tr_info(format, ...)  debug_if(_debug_trace_on, format "\n", ## __VA_ARGS__)
+#define tr_warn(format, ...)  debug_if(_debug_trace_on, format "\n", ## __VA_ARGS__)
+#define tr_error(format, ...) debug_if(_debug_trace_on, format "\n", ## __VA_ARGS__)
+#endif
+
+/// Supervisor gets instantiated at the module level
+Supervisor::Supervisor() {
+    // capture the cause of the previous reset
+    if(__HAL_RCC_GET_FLAG(RCC_FLAG_BORRST))// BOR reset
+        rstRsn = RCC_FLAG_BORRST;
+    else if(__HAL_RCC_GET_FLAG(RCC_FLAG_OBLRST))//  OBLRST reset
+        rstRsn = RCC_FLAG_OBLRST;
+    else if(__HAL_RCC_GET_FLAG(RCC_FLAG_PINRST))//  Pin reset
+        rstRsn = RCC_FLAG_PINRST;
+    else if(__HAL_RCC_GET_FLAG(RCC_FLAG_FWRST))//  FIREWALL reset
+        rstRsn = RCC_FLAG_FWRST;
+    else if(__HAL_RCC_GET_FLAG(RCC_FLAG_SFTRST))//  Software reset
+        rstRsn = RCC_FLAG_SFTRST;
+    else if(__HAL_RCC_GET_FLAG(RCC_FLAG_IWDGRST))//  Independent Supervisor reset
+        rstRsn = RCC_FLAG_IWDGRST;
+    else if(__HAL_RCC_GET_FLAG(RCC_FLAG_WWDGRST))//  Window Supervisor reset
+        rstRsn = RCC_FLAG_WWDGRST;
+    else if(__HAL_RCC_GET_FLAG(RCC_FLAG_LPWRRST))//  Low Power reset
+         rstRsn = RCC_FLAG_LPWRRST;
+   
+    //Clear source Reset Flag
+    __HAL_RCC_CLEAR_RESET_FLAGS();
+}
+
+/// Load timeout value in watchdog timer and enable
+void Supervisor::Configure(float timeout) {
+       
+    #define LsiFreq (45000)
+    uint16_t PrescalerCode;
+    uint16_t Prescaler;
+    uint16_t ReloadValue;
+    float Calculated_timeout;
+    
+    if ((timeout * (LsiFreq/4)) < 0x7FF) {
+        PrescalerCode = IWDG_PRESCALER_4;
+        Prescaler = 4;
+    }
+    else if ((timeout * (LsiFreq/8)) < 0xFF0) {
+        PrescalerCode = IWDG_PRESCALER_8;
+        Prescaler = 8;
+    }
+    else if ((timeout * (LsiFreq/16)) < 0xFF0) {
+        PrescalerCode = IWDG_PRESCALER_16;
+        Prescaler = 16;
+    }
+    else if ((timeout * (LsiFreq/32)) < 0xFF0) {
+        PrescalerCode = IWDG_PRESCALER_32;
+        Prescaler = 32;
+    }
+    else if ((timeout * (LsiFreq/64)) < 0xFF0) {
+        PrescalerCode = IWDG_PRESCALER_64;
+        Prescaler = 64;
+    }
+    else if ((timeout * (LsiFreq/128)) < 0xFF0) {
+        PrescalerCode = IWDG_PRESCALER_128;
+        Prescaler = 128;
+    }
+    else {
+        PrescalerCode = IWDG_PRESCALER_256;
+        Prescaler = 256;
+    }
+    
+    // specifies the IWDG Reload value. This parameter must be a number between 0 and 0x0FFF.
+    ReloadValue = (uint32_t)(timeout * (LsiFreq/Prescaler));
+    
+    Calculated_timeout = ((float)(Prescaler * ReloadValue)) / LsiFreq;
+    tr_debug("WATCHDOG set with prescaler:%d reload value: 0x%X - timeout:%f\n",Prescaler, ReloadValue, Calculated_timeout);
+    
+    IWDG->KR = 0x5555; //Disable write protection of IWDG registers      
+    IWDG->PR = PrescalerCode;      //Set PR value      
+    IWDG->RLR = ReloadValue;      //Set RLR value      
+    IWDG->KR = 0xAAAA;    //Reload IWDG      
+    IWDG->KR = 0xCCCC;    //Start IWDG - See more at: http://embedded-lab.com/blog/?p=9662#sthash.6VNxVSn0.dpuf       
+ 
+    Update();
+}
+
+/// "Update", "kick" or "feed" the dog - reset the watchdog timer
+/// by writing this required bit pattern
+void Supervisor::Update() { 
+    IWDG->KR = 0xAAAA;         //Reload IWDG - See more at: http://embedded-lab.com/blog/?p=9662#sthash.6VNxVSn0.dpuf
+}
+
+/// get the flag to indicate if the watchdog causes the reset
+bool Supervisor::WatchdogReset() {
+    return rstRsn == RCC_FLAG_WWDGRST;
+}
+
+uint8_t Supervisor::ResetReason(){
+    return rstRsn;
+}
+