Subroutines

void setup()

{

}

void loop()

{

Forward(2000);

Back(250);

}

void Forward(int Dist)

{

// Turn on servos

delay(Dist);

return;

}

void Back(int Dist)

{

// Turn on servos

delay(Dist);

return;

}