#include "Arduino.h"

#include "gamepad/Gamepad.h"

Gamepad gamepad;

void setup() {
	Serial.begin(115200);
	Serial.println("Starting debug work!");
	gamepad.begin();
}

void loop() {
	if (gamepad.isConnected()) {
		// test code to automate sending to test RadioReceiver (or any gamepad impl)
		uint8_t c = 0;
		Serial.println("Press buttons 1 and 32. Move all axes to center. Set DPAD to down right.");
		gamepad.press(c, BUTTON_1);
		gamepad.press(c, BUTTON_32);
		gamepad.setAxes(c, 0, 0, 0, 0, 0, 0, DPAD_DOWN_RIGHT);
		delay(500);
		Serial.println("Release all buttons. Move all axes to center. Set DPAD to center.");
		gamepad.buttons(c, 0);
		gamepad.setAxes(c, 0, 0, 0, 0, 0, 0, DPAD_CENTER);
		delay(500);
	}
}