Arduino Trimmrad zur Einstellung der Flugzeug-Trimmung (Teil 3)

/*
 * Arduino HID Trim Wheel
 *
 * Author	Jan Wischniowski
 * URL		https://www.metanox.de/
 * Version	0.7.0
 * License	GNU GENERAL PUBLIC LICENSE Version 3
*/
 
// Beim Drehen des Rotary Encoders werden zwischen jedem Einrasten zwei Zustände durchlaufen.
//
// Stufe 1: Drehung im Uhrzeigersinn (rechts)
// rotary_1_clock: 0 -> 1
// rotary_1_data:  1 -> 0
//
// Stufe 2: Drehung gegen Uhrzeigersinn (links)
// rotary_1_clock: 0 -> 1
// rotary_1_data:  0 -> 1
 
#include "HID-Project.h"
 
#define CLOCKWISE true
#define COUNTERCLOCKWISE false
 
// Arduino
const int arduino_led_1		= LED_BUILTIN;
 
// LED 1
const int led_1_blue		= 0;
const int led_1_green		= 1;
const int led_1_red			= 2;
 
// LED 2
const int led_2_blue		= 3;
const int led_2_green		= 4;
const int led_2_red			= 5;
 
// Rotary 1
const int rotary_1_switch	= 6; // Pin 6 to SW (switch pin) on rotary encoder.
const int rotary_1_data		= 7; // Pin 7 to DT (data) on rotary encoder.
const int rotary_1_clock	= 8; // Pin 8 to CLK (clock) on rotary encoder.
int rotary_1_position		= 0;
int rotary_1_x_axis			= 0;
int rotary_1_clock_old;
int rotary_1_clock_new;
boolean rotary_1_direction;
boolean rotary_1_switch_old	= true;
boolean rotary_1_switch_new	= true;
 
// Rotary 2
const int rotary_2_switch	= 9; // Pin 9 to SW (switch pin) on rotary encoder.
const int rotary_2_data		= 10; // Pin 10 to DT (data) on rotary encoder.
const int rotary_2_clock	= 11; // Pin 11 to CLK (clock) on rotary encoder.
int rotary_2_position		= 0;
int rotary_2_y_axis			= 0;
int rotary_2_clock_old;
int rotary_2_clock_new;
boolean rotary_2_direction;
boolean rotary_2_switch_old	= true;
boolean rotary_2_switch_new	= true;
 
void setup()
{
	pinMode(arduino_led_1, OUTPUT);
 
	pinMode(led_1_red, OUTPUT);
	pinMode(led_1_green, OUTPUT);
	pinMode(led_1_blue, OUTPUT);
 
	pinMode(led_2_red, OUTPUT);
	pinMode(led_2_green, OUTPUT);
	pinMode(led_2_blue, OUTPUT);
 
	pinMode(rotary_1_switch, INPUT_PULLUP);
	pinMode(rotary_1_clock, INPUT);
	pinMode(rotary_1_data, INPUT);
 
	pinMode(rotary_2_switch, INPUT_PULLUP);
	pinMode(rotary_2_clock, INPUT);
	pinMode(rotary_2_data, INPUT);
 
	rotary_1_clock_old	= digitalRead(rotary_1_clock);
	rotary_2_clock_old	= digitalRead(rotary_2_clock);
 
	// Sends a clean report to the host. This is important on any Arduino type.
	Gamepad.begin();
 
	// Serial output is used for debugging.
	Serial.begin(9600);
}
 
void loop()
{
	rotary_1();
	rotary_2();
}
 
void rotary_1()
{
	rotary_1_switch_new = digitalRead(rotary_1_switch);
 
	if (rotary_1_switch_new != rotary_1_switch_old)
	{
		if (!rotary_1_switch_new)
		{
			digitalWrite(arduino_led_1, HIGH);
 
			// Button 1 gedrückt. X-Achse auf 0 zurücksetzen.
			Gamepad.press(1);
			rotary_1_x_axis = 0;
			Gamepad.write();
 
			Serial.println ("Rotary 1 Button: Pressed");
 
			digitalWrite(led_1_red, LOW);
			digitalWrite(led_1_green, LOW);
			digitalWrite(led_1_blue, HIGH);
		}
		else
		{
			digitalWrite(arduino_led_1, LOW);
 
			Gamepad.release(1);
 
			Gamepad.write();
 
			Serial.println ("Rotary 1 Button: Released");
 
			digitalWrite(led_1_red, LOW);
			digitalWrite(led_1_green, LOW);
			digitalWrite(led_1_blue, LOW);
		}
	}
 
	rotary_1_switch_old = rotary_1_switch_new;
 
	rotary_1_clock_new = digitalRead(rotary_1_clock);
 
	// Bei jeder Drehung in eine beliebige Richtung soll bei Stufe 2 eine Aktion ausgeführt werden. Stufe 1 wird übersprungen. Andernfalls würden bei jeder Drehung zwei Aktionen ausgeführt werden.
	if ((rotary_1_clock_new != rotary_1_clock_old) && (true == rotary_1_clock_new))
	//if ((rotary_1_clock_new != rotary_1_clock_old))
	{
		//Serial.print("VAR rotary_1_clock: ");
		//Serial.println(digitalRead(rotary_1_clock));
 
		//Serial.print("VAR rotary_1_data: ");
		//Serial.println(digitalRead(rotary_1_data));
 
		if (digitalRead(rotary_1_data) != rotary_1_clock_new)
		{ // Clockwise
			rotary_1_position++;
			rotary_1_direction = CLOCKWISE;
		}
		else
		{ //Counterclockwise
			rotary_1_position--;
			rotary_1_direction = COUNTERCLOCKWISE;
		}
 
		if (CLOCKWISE == rotary_1_direction)
		{
			Serial.println ("Rotary 1 Rotation: Clockwise");
 
			rotary_1_x_axis -= 500;
 
			if (-32767>rotary_1_x_axis)
			{
				rotary_1_x_axis = -32767;
			}
		}
		else
		{
			Serial.println("Rotary 1 Rotation: Counterclockwise");
 
			rotary_1_x_axis += 500;
 
			if (32768<rotary_1_x_axis)
			{
				rotary_1_x_axis = 32768;
			}
		}
 
		if (0>rotary_1_x_axis)
		{
			digitalWrite(led_1_red, HIGH);
			digitalWrite(led_1_green, LOW);
		}
		else if (0<rotary_1_x_axis)
		{
			digitalWrite(led_1_red, LOW);
			digitalWrite(led_1_green, HIGH);
		}
		else
		{
			digitalWrite(led_1_red, LOW);
			digitalWrite(led_1_green, LOW);
		}
 
		Serial.print("VAR rotary_1_position: ");
		Serial.println(rotary_1_position);
 
		Serial.print("VAR rotary_1_x_axis: ");
		Serial.println(rotary_1_x_axis);
	}
 
	rotary_1_clock_old = rotary_1_clock_new;
 
	Gamepad.rxAxis(rotary_1_x_axis);
	Gamepad.write();
}
 
void rotary_2()
{
	rotary_2_switch_new = digitalRead(rotary_2_switch);
 
	if (rotary_2_switch_new != rotary_2_switch_old)
	{
		if (!rotary_2_switch_new)
		{
			digitalWrite(arduino_led_1, HIGH);
 
			// Button 2 gedrückt. Y-Achse auf 0 zurücksetzen.
			Gamepad.press(2);
			rotary_2_y_axis = 0;
			Gamepad.write();
 
			Serial.println ("Rotary 2 Button: Pressed");
 
			digitalWrite(led_2_red, LOW);
			digitalWrite(led_2_green, LOW);
			digitalWrite(led_2_blue, HIGH);
		}
		else
		{
			digitalWrite(arduino_led_1, LOW);
 
			Gamepad.release(2);
 
			Gamepad.write();
 
			Serial.println ("Rotary 2 Button: Released");
 
			digitalWrite(led_2_red, LOW);
			digitalWrite(led_2_green, LOW);
			digitalWrite(led_2_blue, LOW);
		}
	}
 
	rotary_2_switch_old = rotary_2_switch_new;
 
	rotary_2_clock_new = digitalRead(rotary_2_clock);
 
	// Bei jeder Drehung in eine beliebige Richtung soll bei Stufe 2 eine Aktion ausgeführt werden. Stufe 1 wird übersprungen. Andernfalls würden bei jeder Drehung zwei Aktionen ausgeführt werden.
	if ((rotary_2_clock_new != rotary_2_clock_old) && (true == rotary_2_clock_new))
	//if ((rotary_2_clock_new != rotary_2_clock_old))
	{
		//Serial.print("VAR rotary_2_clock: ");
		//Serial.println(digitalRead(rotary_2_clock));
 
		//Serial.print("VAR rotary_2_data: ");
		//Serial.println(digitalRead(rotary_2_data));
 
		if (digitalRead(rotary_2_data) != rotary_2_clock_new)
		{ // Clockwise
			rotary_2_position++;
			rotary_2_direction = CLOCKWISE;
		}
		else
		{ //Counterclockwise
			rotary_2_position--;
			rotary_2_direction = COUNTERCLOCKWISE;
		}
 
		if (CLOCKWISE == rotary_2_direction)
		{
			Serial.println("Rotary 2 Rotation: Counterclockwise");
 
			rotary_2_y_axis += 500;
 
			if (32768<rotary_2_y_axis)
			{
				rotary_2_y_axis = 32768;
			}
		}
		else 
		{
			Serial.println ("Rotary 2 Rotation: Clockwise");
 
			rotary_2_y_axis -= 500;
 
			if (-32767>rotary_2_y_axis)
			{
				rotary_2_y_axis = -32767;
			}
		}
 
		if (0>rotary_2_y_axis)
		{
			digitalWrite(led_2_red, HIGH);
			digitalWrite(led_2_green, LOW);
		}
		else if (0<rotary_2_y_axis)
		{
			digitalWrite(led_2_red, LOW);
			digitalWrite(led_2_green, HIGH);
		}
		else
		{
			digitalWrite(led_2_red, LOW);
			digitalWrite(led_2_green, LOW);
		}
 
		Serial.print("VAR rotary_2_position: ");
		Serial.println(rotary_2_position);
 
		Serial.print("VAR rotary_2_y_axis: ");
		Serial.println(rotary_2_y_axis);
	}
 
	rotary_2_clock_old = rotary_2_clock_new;
 
	Gamepad.ryAxis(rotary_2_y_axis);
	Gamepad.write();
}