farmbot-arduino-firmware/src/PinGuardPin.cpp

#include "PinGuardPin.h"
#include "ParameterList.h"

PinGuardPin::PinGuardPin() {
	pinNr = 0;
}

// Set the initial settings for what pin to check
void PinGuardPin::loadPinConfig(int pinNrParamNr, int activeStateParamNr, int timeOutParamNr) {

        pinNr       =  ParameterList::getInstance()->getValue(pinNrParamNr);
        activeState = (ParameterList::getInstance()->getValue(activeStateParamNr)== 1);
        timeOut     =  ParameterList::getInstance()->getValue(timeOutParamNr);

	timeOutCount	= 0;
}

// Check each second if the time out is lapsed or the value has changed
void PinGuardPin::processTick() {

	if (pinNr==0) {
		return;
	}

	currentStatePin = digitalRead(pinNr);

	if (currentStatePin != activeState) {
		timeOutCount = 0;
	} else {
		timeOutCount++;
	}

	if (timeOutCount >= timeOut) {
		digitalWrite(pinNr, !activeState);
	}
}