#include Servo myservo; Servo myservo2; int val; int val2; int Index; void setup() { myservo.attach(9); myservo2.attach(3); pinMode(6, OUTPUT); //Enable pinMode(5, OUTPUT); //Step pinMode(4, OUTPUT); //Direction Serial.begin(9600); digitalWrite(6,LOW); //enable } void loop() { val = analogRead(A2); val = map(val, 0, 1023, 0, 180); myservo.write(val); val2 = analogRead(A4); val2 = map(val2, 0, 1023, 80, 100); myservo2.write(val2); if (analogRead(A0)<70){ digitalWrite(4,HIGH); digitalWrite(6,LOW);} if (analogRead(A0)>300){ digitalWrite(4,LOW); digitalWrite(6,LOW);} if ( (analogRead(A0)>70) && (analogRead(A0)<300)){ digitalWrite(6,HIGH); //disable } for(Index = 0; Index < 5; Index++) { digitalWrite(5,HIGH); delayMicroseconds(500); digitalWrite(5,LOW); delayMicroseconds(500); } delay(100); }