Stap 12: Code zodat de Robot voorwaarts gaan, rechts, links, Reverse en stoppen alles in een lus
int LeftMotorForward = 10; Pin 10 heeft links Motor aangesloten op de Arduino boards Arduino boards.int LeftMotorReverse = 9; Pin 9 heeft links Motor aangesloten op de Arduino boards Arduino boards.
int RightMotorForward = 12; Pin 12 heeft recht Motor aangesloten op de Arduino boards Arduino boards.
int RightMotorReverse = 13; Pin 13 heeft recht Motor aangesloten op de Arduino boards Arduino boards.
//-----------------------------------------------------------------------------
VOID Setup
{
pinMode (LeftMotorForward, uitvoer); Initialiseer de pin als uitgang.
pinMode (RightMotorForward, uitvoer); Initialiseer de pin als uitgang.
pinMode (LeftMotorReverse, uitvoer); Initialiseer de pin als uitgang.
pinMode (RightMotorReverse, uitvoer); Initialiseer de pin als uitgang.
}
//-----------------------------------------------------------------------------
De volgende lus is om de Robot ga staright te maken
void loop
{
nietig Driveforward();
digitalWrite (RightMotorForward, hoge); Zet de Motor ON recht
digitalWrite (LeftMotorForward, hoge); Zet de linker Motor ON
delay(10000); wacht 10 seconden
digitalWrite(RightMotorForward,LOW); uitschakelen het recht Motor
digitalWrite (LeftMotorForward, laag); Zet de linker Motor uit
delay(10000); wacht 10 seconden
//-----------------------------------------------------------------------------
nietig Rightturn();
digitalWrite (RightMotorForward, laag); uitschakelen het recht Motor
digitalWrite (LeftMotorForward, hoge); Zet de linker Motor ON
delay(10000); wacht 10 seconden
digitalWrite(RightMotorForward,LOW); uitschakelen het recht Motor
digitalWrite (LeftMotorForward, laag); Zet de linker Motor uit
delay(10000); wacht 10 seconden
//-----------------------------------------------------------------------------
nietig Leftturn();
digitalWrite (RightMotorForward, hoge); Zet de Motor ON recht
digitalWrite (LeftMotorForward, laag); Zet de linker Motor uit
delay(10000); wacht 10 seconden
digitalWrite(RightMotorForward,LOW); uitschakelen het recht Motor
digitalWrite (LeftMotorForward, laag); Zet de linker Motor uit
delay(10000); wacht 10 seconden
//-----------------------------------------------------------------------------
VOID Reverse();
digitalWrite (RightMotorReverse, hoge); Zet de Motor ON recht
digitalWrite (LeftMotorReverse, hoge); Zet de linker Motor ON
delay(10000); een 10 seconden wachten
digitalWrite (RightMotorReverse, laag); Zet de Motor ON recht
digitalWrite (LeftMotorReverse, laag); Zet de linker Motor ON
delay(10000); een 10 seconden wachten
//-----------------------------------------------------------------------------
nietig Allstop();
digitalWrite (RightMotorReverse, laag); Zet de Motor ON recht
digitalWrite (LeftMotorReverse, laag); Zet de linker Motor ON
delay(10000); wacht 10 seconden
digitalWrite(RightMotorForward,LOW); uitschakelen het recht Motor
digitalWrite (LeftMotorForward, laag); Zet de linker Motor uit
delay(10000); wacht 10 seconden
//-----------------------------------------------------------------------------
}