Forigo / Mbed 2 deprecated FORIGO_Modula_V7_3_VdcStep_maggio2020

Messa in campo 4 file - 26/06/2020 Francia

Dependencies:   mbed X_NUCLEO_IHM03A1_for

Fork of FORIGO_Modula_V7_3_VdcStep_maggio2020 by Francesco Pistone

watchdog.cpp@45:162116db828a, 2020-07-20 (annotated)

Committer:
nerit
Date:
Mon Jul 20 09:06:29 2020 +0000
Revision:
45:162116db828a
Parent:
3:a469bbd294b5 
versione di prova per verifica accelerazione tamburo

Who changed what in which revision?

UserRevisionLine numberNew contents of line
nerit 3:a469bbd294b5 1 /// @file Watchdog.cpp provides the interface to the Watchdog module
nerit 3:a469bbd294b5 2 ///
nerit 3:a469bbd294b5 3 /// This provides basic Watchdog service for the mbed. You can configure
nerit 3:a469bbd294b5 4 /// various timeout intervals that meet your system needs. Additionally,
nerit 3:a469bbd294b5 5 /// it is possible to identify if the Watchdog was the cause of any
nerit 3:a469bbd294b5 6 /// system restart.
nerit 3:a469bbd294b5 7 ///
nerit 3:a469bbd294b5 8 /// Adapted from Simon's Watchdog code from http://mbed.org/forum/mbed/topic/508/
nerit 3:a469bbd294b5 9 ///
nerit 3:a469bbd294b5 10 /// @note Copyright © 2011 by Smartware Computing, all rights reserved.
nerit 3:a469bbd294b5 11 /// This software may be used to derive new software, as long as
nerit 3:a469bbd294b5 12 /// this copyright statement remains in the source file.
nerit 3:a469bbd294b5 13 /// @author David Smart
nerit 3:a469bbd294b5 14 ///
nerit 3:a469bbd294b5 15 /// @note Copyright © 2015 by NBRemond, all rights reserved.
nerit 3:a469bbd294b5 16 /// This software may be used to derive new software, as long as
nerit 3:a469bbd294b5 17 /// this copyright statement remains in the source file.
nerit 3:a469bbd294b5 18 ///
nerit 3:a469bbd294b5 19 /// Added support for STM32 Nucleo platforms
nerit 3:a469bbd294b5 20 ///
nerit 3:a469bbd294b5 21 /// @author Bernaérd Remond
nerit 3:a469bbd294b5 22 ///
nerit 3:a469bbd294b5 23
nerit 3:a469bbd294b5 24 //#define LPC
nerit 3:a469bbd294b5 25 #define ST_NUCLEO
nerit 3:a469bbd294b5 26
nerit 3:a469bbd294b5 27
nerit 3:a469bbd294b5 28 #include "mbed.h"
nerit 3:a469bbd294b5 29 #include "watchdog.h"
nerit 3:a469bbd294b5 30
nerit 3:a469bbd294b5 31
nerit 3:a469bbd294b5 32 /// Watchdog gets instantiated at the module level
nerit 3:a469bbd294b5 33 Watchdog::Watchdog() {
nerit 3:a469bbd294b5 34 #ifdef LPC
nerit 3:a469bbd294b5 35 wdreset = (LPC_WDT->WDMOD >> 2) & 1; // capture the cause of the previous reset
nerit 3:a469bbd294b5 36 #endif
nerit 3:a469bbd294b5 37 #ifdef ST_NUCLEO
nerit 3:a469bbd294b5 38 // capture the cause of the previous reset
nerit 3:a469bbd294b5 39 /* Check if the system has resumed from IWDG reset */
nerit 3:a469bbd294b5 40 /*
nerit 3:a469bbd294b5 41 if (__HAL_RCC_GET_FLAG(RCC_FLAG_IWDGRST)) {
nerit 3:a469bbd294b5 42 wdreset = true;
nerit 3:a469bbd294b5 43 }
nerit 3:a469bbd294b5 44 else {
nerit 3:a469bbd294b5 45 wdreset = false;
nerit 3:a469bbd294b5 46 }
nerit 3:a469bbd294b5 47 */
nerit 3:a469bbd294b5 48 wdreset = false;
nerit 3:a469bbd294b5 49 #endif
nerit 3:a469bbd294b5 50
nerit 3:a469bbd294b5 51 }
nerit 3:a469bbd294b5 52
nerit 3:a469bbd294b5 53 /// Load timeout value in watchdog timer and enable
nerit 3:a469bbd294b5 54 void Watchdog::Configure(float timeout) {
nerit 3:a469bbd294b5 55 #ifdef LPC
nerit 3:a469bbd294b5 56 LPC_WDT->WDCLKSEL = 0x1; // Set CLK src to PCLK
nerit 3:a469bbd294b5 57 uint32_t clk = SystemCoreClock / 16; // WD has a fixed /4 prescaler, PCLK default is /4
nerit 3:a469bbd294b5 58 LPC_WDT->WDTC = (uint32_t)(timeout * (float)clk);
nerit 3:a469bbd294b5 59 LPC_WDT->WDMOD = 0x3; // Enabled and Reset
nerit 3:a469bbd294b5 60 #endif
nerit 3:a469bbd294b5 61 #ifdef ST_NUCLEO
nerit 3:a469bbd294b5 62 // see http://embedded-lab.com/blog/?p=9662
nerit 3:a469bbd294b5 63 #define LsiFreq (45000)
nerit 3:a469bbd294b5 64
nerit 3:a469bbd294b5 65 uint16_t PrescalerCode;
nerit 3:a469bbd294b5 66 uint16_t Prescaler;
nerit 3:a469bbd294b5 67 uint16_t ReloadValue;
nerit 3:a469bbd294b5 68 float Calculated_timeout;
nerit 3:a469bbd294b5 69
nerit 3:a469bbd294b5 70 if ((timeout * (LsiFreq/4)) < 0x7FF) {
nerit 3:a469bbd294b5 71 PrescalerCode = IWDG_PRESCALER_4;
nerit 3:a469bbd294b5 72 Prescaler = 4;
nerit 3:a469bbd294b5 73 }
nerit 3:a469bbd294b5 74 else if ((timeout * (LsiFreq/8)) < 0xFF0) {
nerit 3:a469bbd294b5 75 PrescalerCode = IWDG_PRESCALER_8;
nerit 3:a469bbd294b5 76 Prescaler = 8;
nerit 3:a469bbd294b5 77 }
nerit 3:a469bbd294b5 78 else if ((timeout * (LsiFreq/16)) < 0xFF0) {
nerit 3:a469bbd294b5 79 PrescalerCode = IWDG_PRESCALER_16;
nerit 3:a469bbd294b5 80 Prescaler = 16;
nerit 3:a469bbd294b5 81 }
nerit 3:a469bbd294b5 82 else if ((timeout * (LsiFreq/32)) < 0xFF0) {
nerit 3:a469bbd294b5 83 PrescalerCode = IWDG_PRESCALER_32;
nerit 3:a469bbd294b5 84 Prescaler = 32;
nerit 3:a469bbd294b5 85 }
nerit 3:a469bbd294b5 86 else if ((timeout * (LsiFreq/64)) < 0xFF0) {
nerit 3:a469bbd294b5 87 PrescalerCode = IWDG_PRESCALER_64;
nerit 3:a469bbd294b5 88 Prescaler = 64;
nerit 3:a469bbd294b5 89 }
nerit 3:a469bbd294b5 90 else if ((timeout * (LsiFreq/128)) < 0xFF0) {
nerit 3:a469bbd294b5 91 PrescalerCode = IWDG_PRESCALER_128;
nerit 3:a469bbd294b5 92 Prescaler = 128;
nerit 3:a469bbd294b5 93 }
nerit 3:a469bbd294b5 94 else {
nerit 3:a469bbd294b5 95 PrescalerCode = IWDG_PRESCALER_256;
nerit 3:a469bbd294b5 96 Prescaler = 256;
nerit 3:a469bbd294b5 97 }
nerit 3:a469bbd294b5 98
nerit 3:a469bbd294b5 99 // specifies the IWDG Reload value. This parameter must be a number between 0 and 0x0FFF.
nerit 3:a469bbd294b5 100 ReloadValue = (uint32_t)(timeout * (LsiFreq/Prescaler));
nerit 3:a469bbd294b5 101
nerit 3:a469bbd294b5 102 Calculated_timeout = ((float)(Prescaler * ReloadValue)) / LsiFreq;
nerit 3:a469bbd294b5 103 //printf("WATCHDOG set with prescaler:%d reload value: 0x%X - timeout:%f\n",Prescaler, ReloadValue, Calculated_timeout);
nerit 3:a469bbd294b5 104
nerit 3:a469bbd294b5 105 IWDG->KR = 0x5555; //Disable write protection of IWDG registers
nerit 3:a469bbd294b5 106 IWDG->PR = PrescalerCode; //Set PR value
nerit 3:a469bbd294b5 107 IWDG->RLR = ReloadValue; //Set RLR value
nerit 3:a469bbd294b5 108 IWDG->KR = 0xAAAA; //Reload IWDG
nerit 3:a469bbd294b5 109 IWDG->KR = 0xCCCC; //Start IWDG - See more at: http://embedded-lab.com/blog/?p=9662#sthash.6VNxVSn0.dpuf
nerit 3:a469bbd294b5 110 #endif
nerit 3:a469bbd294b5 111
nerit 3:a469bbd294b5 112 Service();
nerit 3:a469bbd294b5 113 }
nerit 3:a469bbd294b5 114
nerit 3:a469bbd294b5 115 /// "Service", "kick" or "feed" the dog - reset the watchdog timer
nerit 3:a469bbd294b5 116 /// by writing this required bit pattern
nerit 3:a469bbd294b5 117 void Watchdog::Service() {
nerit 3:a469bbd294b5 118 #ifdef LPC
nerit 3:a469bbd294b5 119 LPC_WDT->WDFEED = 0xAA;
nerit 3:a469bbd294b5 120 LPC_WDT->WDFEED = 0x55;
nerit 3:a469bbd294b5 121 #endif
nerit 3:a469bbd294b5 122 #ifdef ST_NUCLEO
nerit 3:a469bbd294b5 123 IWDG->KR = 0xAAAA; //Reload IWDG - See more at: http://embedded-lab.com/blog/?p=9662#sthash.6VNxVSn0.dpuf
nerit 3:a469bbd294b5 124 #endif
nerit 3:a469bbd294b5 125 }
nerit 3:a469bbd294b5 126
nerit 3:a469bbd294b5 127 /// get the flag to indicate if the watchdog causes the reset
nerit 3:a469bbd294b5 128 bool Watchdog::WatchdogCausedReset() {
nerit 3:a469bbd294b5 129 return wdreset;
nerit 3:a469bbd294b5 130 }
nerit 3:a469bbd294b5 131