Stap 11: Uploaden van de schets
int Enable1 = 10;
int Enable2 = 11;
int M1 = 2;
int M2 = 3;
int M3 = 4;
int M4 = 5;
int Switch = 6;
VOID Setup
{
pinMode (Enable1, uitvoer);
pinMode (Enable2, uitvoer);
pinMode (M1, uitvoer);
pinMode (M2, uitvoer);
pinMode (M3, uitvoer);
pinMode (M4, uitvoer);
digitalWrite (Enable1, hoge);
digitalWrite (Enable2, hoge);
}
void loop
{
if(digitalRead(switch) == HIGH)
{
Backwards();
delay(500);
Turn();
delay(500);
}
anders
{
vooruit();
}
}
VOID backwards()
{
digitalWrite (M1, laag);
digitalWrite (M2, hoge);
digitalWrite (M3, laag);
digitalWrite (M4, hoge);
}
VOID vooruit()
{
digitalWrite (M1, hoge);
digitalWrite (M2, laag);
digitalWrite (M3, hoge);
digitalWrite (M4, laag);
}
VOID turn()
{
digitalWrite (M1, hoge);
digitalWrite (M2, laag);
digitalWrite (M3, laag);
digitalWrite (M4, hoge);
}