Stap 3: Code te rijden naar voren wanneer IR Sensor waarde minder dan 100 is
Dit is de fundamentele code die loopt een lus die de Robot maakt rechtdoor naar voren wanneer de infrarood waarde lager is dan 100.int analogPin = 3; Infraroodsensor (juiste lood) aangesloten op analoge pin 3
Infrarood Sensor (middelste Lead) aangesloten op + 5V
Infrarood Sensor (links leiden) aangesloten op grond
int val = 0; variabele de waarde op te slaan lees
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.
Serial.begin(9600); Setup seriële
}
De volgende lus is te maken van de Robot staright gaan wanneer de infrarood waarde lager dan 100 is
void loop
{
Val = analogRead(analogPin); Lees de invoer pin
Serial.println(val); debug waarde
Als (val < 100)
Als de lees waarde < 100 Voer de onderstaande code, die zowel links als rechts Motor zal weer op het maken van de Robot rechtdoor.
{
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
}
}