farmbot-arduino-firmware/src/PinControl.cpp

#include "PinControl.h"

static PinControl* instance;

PinControl * PinControl::getInstance() {
        if (!instance) {
                instance = new PinControl();
        };
        return instance;
}
;

PinControl::PinControl() {
}

int PinControl::setMode(int pinNr, int mode) {
	pinMode(pinNr   , mode );
	return 0;
}

int PinControl::writeValue(int pinNr, int value, int mode) {
	if (mode == 0) {
		digitalWrite(pinNr, value);
		return 0;
	}
	if (mode == 1) {
		analogWrite(pinNr, value);
		return 0;
	}
	return 1;
}

int PinControl::readValue(int pinNr, int mode) {

	int value = 0;

	if (mode == 0) {
		if (digitalRead(pinNr) == 1){
			value = 1;
		}
	}
	if (mode == 1) {
		value = analogRead(pinNr);
	}

	if (mode == 0 || mode == 1) {

		Serial.print("R41");
		Serial.print(" ");
		Serial.print("P");
		Serial.print(pinNr);
		Serial.print(" ");
		Serial.print("V");
		Serial.print(value);
		//Serial.print("\r\n");
		CurrentState::getInstance()->printQAndNewLine();

		return 0;
	}
	else {
		return 1;
	}
}

int  PinControl::writePulse(int pinNr, int valueOne, int valueTwo, long time, int mode) {
	writeValue( pinNr, valueOne, mode);
	delay(time);
	writeValue( pinNr, valueTwo, mode);
	return 0;
}