/*
ŠE NE DELA
*/

int stp1=3;
int stp2=7;
int dir1=2;
int dir2=6;

int P1=A4;
int P2=A5;
int POT1;
int POT2;
int Dh;
int Dv;

void setup() 
{
  // put your setup code here, to run once:
Serial.begin(115200);
pinMode(A0, INPUT);
pinMode(A1, INPUT);
pinMode(dir1, OUTPUT);
pinMode(stp1, OUTPUT);
pinMode(dir2, OUTPUT);
pinMode(stp2, OUTPUT);
}

void loop()
{
  // put your setup code here, to run once:
  int horz=analogRead(A1);
  int vert=analogRead(A0);
  Serial.print("HORIZ: ");
  Serial.print(horz);
  Serial.print(", VERT: ");
  Serial.print(vert);


  // DELAY WITH POTENTIOMETER
  P1 = analogRead(POT1);
  P2 = analogRead(POT2);
  Dh = map(P1, 0, 1023, 0, 1500);
  Dv = map(P1, 0, 1023, 0, 1500);

  Serial.print(", DELAY (Dh,Dv): ");
  Serial.print  (Dh);
  Serial.print("; ");
  Serial.println(Dv);

  delay(50);

  if(horz > 600)
  {
  stepper(dir1, stp1, 0);
  }

  if(horz < 300)
  {
  stepper(dir1, stp1, 1);
  }

  if(vert > 600)
  {
  stepper(dir2, stp2, 0);
  }

  if(vert < 300)
  {
  stepper(dir2, stp2, 1);
  }
}

void stepper(int dir, int step, int dirVal)
{ 
  digitalWrite(dir, dirVal);
  digitalWrite(step, HIGH);
  delayMicroseconds(50);
  digitalWrite(step, LOW);
  delayMicroseconds(50);

  delay(Dh);
  delay(Dv);
}