watchdog.h

Go to the documentation of this file.

 
#ifndef WATCHDOG_H_
#define WATCHDOG_H_
 
#include <Arduino.h>
#if defined(__AVR__)
#include <avr/wdt.h>
#endif
#include "globals.h"
#include "easycomm.h"
#include "rotator_pins.h"
 
/**************************************************************************/
/**************************************************************************/
class wdt_timer{
public:
 
    /**************************************************************************/
    /**************************************************************************/
    void watchdog_init() {
#if defined(__AVR__)
        cli();
        wdt_reset();
#if defined(__AVR_ATmega328P__) || defined(__AVR_ATmega168__)
        WDTCSR |= _BV(WDCE) | _BV(WDE);
        WDTCSR = _BV(WDIE) | _BV(WDE) | _BV(WDP3) | _BV(WDP2) | _BV(WDP1);
#endif
        sei();
#endif
    }
 
    /**************************************************************************/
    /**************************************************************************/
    void watchdog_reset() {
#if defined(__AVR__)
        wdt_reset();
#endif
    }
};
 
/**************************************************************************/
/**************************************************************************/
#if defined(__AVR_ATmega328P__) || defined(__AVR_ATmega168__)
ISR(WDT_vect) {
    // Disable motors
    digitalWrite(MOTOR_EN, LOW);
    // Set error
    rotator.rotator_error = wdt_error;
    rotator.rotator_status = r_error;
    // Enable interrupts for serial communication
    sei();
 
    while (1) {
        // Reset the watchdog timer because the interrupts are enabled
        wdt_reset();
        // Implement a minimal easycomm protocol to get the errors and reset uC
        char buffer[BUFFER_SIZE];
        char incomingByte;
        static uint16_t BufferCnt = 0;
        String str1, str2, str3, str4, str5, str6;
        while (rs485.available() > 0) {
            incomingByte = rs485.read();
            if (incomingByte == '\n' || incomingByte == '\r') {
                buffer[BufferCnt] = 0;
                if (buffer[0] == 'G' && buffer[1] == 'S') {
                    str1 = String("GS");
                    str2 = String(rotator.rotator_status, DEC);
                    str3 = String("\n");
                    rs485.print(str1 + str2 + str3);
                } else if (buffer[0] == 'G' && buffer[1] == 'E') {
                    str1 = String("GE");
                    str2 = String(rotator.rotator_error, DEC);
                    str3 = String("\n");
                    rs485.print(str1 + str2 + str3);
                } else if (buffer[0] == 'R' && buffer[1] == 'B') {
                    while(1);
                }
                BufferCnt = 0;
                rs485.flush();
            } else {
                buffer[BufferCnt] = incomingByte;
                BufferCnt++;
            }
        }
        // Reset the watchdog timer
        wdt_reset();
    }
}
#endif
 
#endif /* WATCHDOG_H_ */