#include <Stepper.h>

Stepper steppersLinks (200, 6, 7, 8, 9);
Stepper steppersRechts (200, 5, 4, 3, 2);  /* volgorde poortaansluitingen veranderd
  Dit was (2,3,4,5) ,dit geeft een andere draairichting toz van steppersLinks. */

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() {
  // put your main code here, to run repeatedly:
  waardeVerticaal = analogRead(PIN_VERT);
  //Serial.println(waardeVerticaal);      // 0(achteruit) - 512 - 1023(vooruit)
  waardeHorizontaal = analogRead(PIN_HORZ);
  //Serial.println( waardeHorizontaal);      // 0(rechts) - 512 - 1023(links)

  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
  }
}