const int mundur = 5;
const int maju = 4;
int direction = 2;
int step = 3;
int time = 20000;
void setup()
{
Serial.begin(9600);
pinMode(mundur, INPUT_PULLUP);
pinMode(maju, INPUT_PULLUP);
pinMode(direction, OUTPUT);
pinMode(step, OUTPUT);
digitalWrite(direction, LOW);
digitalWrite(step, LOW);
}
void loop()
{
int berlawananjarum = digitalRead(mundur);
int searahjarum = digitalRead(maju);
if(berlawananjarum == LOW)
{
delay(250);
if(berlawananjarum == LOW)
{
digitalWrite(direction, LOW);
do
{
digitalWrite(step, HIGH);
delayMicroseconds(time);
digitalWrite(step, LOW);
delayMicroseconds(time);
berlawananjarum = digitalRead(mundur);
}
while(berlawananjarum != HIGH);
}
}
if(searahjarum == LOW)
{
delay(250);
if(searahjarum == LOW)
{
digitalWrite(direction, HIGH);
do
{
digitalWrite(step, HIGH);
delayMicroseconds(time);
digitalWrite(step, LOW);
delayMicroseconds(time);
searahjarum = digitalRead(maju);
}
while(searahjarum != HIGH);
}
}
}