#include <Stepper.h>

Stepper steppersLinks (200, 6, 7, 8, 9);
Stepper steppersRechts (200, 2, 3, 4, 5);  // volgorde poortaansluitingen veranderd

int waardeVerticaal;
int waardeHorizontaal;

#define PIN_VERT A1
#define PIN_HORZ A0
#define HighSpeed 2  // steps
#define LowSpeed 1   // steps

void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  pinMode(PIN_VERT, INPUT);
  pinMode(PIN_HORZ, INPUT);
  steppersLinks.setSpeed(100);
  steppersRechts.setSpeed(100);
}

void loop() {
  waardeVerticaal = analogRead(PIN_VERT);
  waardeHorizontaal = analogRead(PIN_HORZ);

  if (waardeVerticaal == 1023 && waardeHorizontaal == 512) {
    steppersLinks.step(-HighSpeed);
    steppersRechts.step(-HighSpeed); // vooruit
  }
  if (waardeVerticaal == 0 && waardeHorizontaal == 512) {
    steppersLinks.step(HighSpeed);
    steppersRechts.step(HighSpeed);// Achteruit
  }
  if (waardeVerticaal == 512 && waardeHorizontaal == 0) {
    steppersLinks.step(LowSpeed);
    steppersRechts.step(-LowSpeed); // Rechts
  }
  if (waardeVerticaal == 512 && waardeHorizontaal == 1023) {
    steppersLinks.step(-LowSpeed);
    steppersRechts.step(LowSpeed);  // Links
  }
  if (waardeVerticaal == 1023 && waardeHorizontaal == 0) {
    steppersLinks.step(HighSpeed);
    steppersRechts.step(LowSpeed);// Rechts-vooruit
  }
  if (waardeVerticaal == 1023 && waardeHorizontaal == 1023) {
    steppersLinks.step(LowSpeed);
    steppersRechts.step(HighSpeed); // Links-vooruit
  }
  if (waardeVerticaal == 0 && waardeHorizontaal == 0) {
    steppersLinks.step(-HighSpeed);
    steppersRechts.step(-LowSpeed); // Links-achteruit
  }
  if (waardeVerticaal == 0 && waardeHorizontaal == 1023) {
    steppersLinks.step(-LowSpeed);
    steppersRechts.step(-HighSpeed); // Rechts-achteruit
  }
}