TactiloControllerPanda/TactiloControllerPanda.ino

///-------------------------------------------------------------------------------------------------
/// 
/// \file TactiloControllerPanda.ino
/// \brief Controlls the Tactilos on the Leonardos GPIOs, based on the messages from OpenVibes TactiloController Box Algorithm
///	       Hochladen mit der Arduino IDE
/// \author Tobias Baumann (TH-Nürnberg).
/// \version 1.0.
/// \date Mon Mar 7 14:02:56 2022.
/// 
///-------------------------------------------------------------------------------------------------

//define used GPIO pins
#define TAC1 7
#define TAC2 8
#define TAC3 9
#define TAC4 10
#define TAC5 11
#define TAC6 12

#define LED  13


void setup() 
{
	//init serial
	Serial.begin(115200);
  
	//init GPIOs
	Serial.println("...init GPIOs");
	set_PinMode();
	set_AllLow();
}

void loop() 
{
	char SerialData;

	if(Serial.available() > 0)
	{
		SerialData = Serial.read();
	}

	processSerialData(SerialData);
}

void set_PinMode()
{
	//set all pins to OUTPUT
	pinMode(TAC1, OUTPUT);
	pinMode(TAC2, OUTPUT);
	pinMode(TAC3, OUTPUT);
	pinMode(TAC4, OUTPUT);
	pinMode(TAC5, OUTPUT);
	pinMode(TAC6, OUTPUT);

	pinMode(LED, OUTPUT);
}

void set_AllLow()
{
	//set all pins to LOW
	digitalWrite(TAC1, LOW);
	digitalWrite(TAC2, LOW);
	digitalWrite(TAC3, LOW);
	digitalWrite(TAC4, LOW);
	digitalWrite(TAC5, LOW);
	digitalWrite(TAC6, LOW);

	digitalWrite(LED, LOW);
}

void processSerialData(char SerialData)
{
	switch(SerialData)
	{
		case '0':
			if(digitalRead(LED) == LOW)
			{
				digitalWrite(LED, HIGH);
				Serial.println("...Start Tactile Session");
			}
			else
			{
				set_AllLow();
				Serial.println("...End Tactile Session");
			}
			break;

		case '1':
			digitalWrite(TAC1, !digitalRead(TAC1));
			Serial.print("Tactilo 1: ");
			Serial.println(digitalRead(TAC1));
			break;

		case '2':
			digitalWrite(TAC2, !digitalRead(TAC2));
			Serial.print("Tactilo 2: ");
			Serial.println(digitalRead(TAC2));
			break;

		case '3':
			digitalWrite(TAC3, !digitalRead(TAC3));
			Serial.print("Tactilo 3: ");
			Serial.println(digitalRead(TAC3));
			break;

		case '4':
			digitalWrite(TAC4, !digitalRead(TAC4));
			Serial.print("Tactilo 4: ");
			Serial.println(digitalRead(TAC4));
			break;

		case '5':
			digitalWrite(TAC5, !digitalRead(TAC5));
			Serial.print("Tactilo 5: ");
			Serial.println(digitalRead(TAC5));
			break;

		case '6':
			digitalWrite(TAC6, !digitalRead(TAC6));
			Serial.print("Tactilo 6: ");
			Serial.println(digitalRead(TAC6));
			break;

		default:
			break;
	}
}