JVSy.ino

#include "JVSy.h"
#include "JVS.h"
#include "Constants.h"

HardwareSerial Uart = HardwareSerial();
JVS j = JVS(Uart);
unsigned long lastTime = 0;

void setup()
{   
	Serial.begin(115200);
	Uart.begin(115200, DE_PIN);
	Joystick.useManualSend(true);
  Joystick2.useManualSend(true);
	delay(START_DELAY);
	Serial.println("Start");
  pinMode(11, OUTPUT);
  digitalWrite(11, HIGH);
	while (!j.initialized){
		j.reset();
		int i = 1;
		//while (analogRead(SENSE_PIN) > 20){
			j.init(i++);
		//}
   // L'IO board de la Noir Cab ne semble pas modifier son sense après l'initialisation
		// USE THIS TO REBOOT, IF NEEDED
		// _restart_Teensyduino_();
	}
    lastTime = millis();
}

void loop()
{
    unsigned long time = millis();
    if(time - lastTime >= 20)
    {
        lastTime = time;
        j.switches(1);
    }
}