Stap 7: obstakel te vermijden
Tot slot is het werkelijke gebouw deel afgewerkt (zodra u uw sensor koppelen). Zorg ervoor dat uw sensor wordt gehouden door de zijn draden verschillende cm afstand van het chassis van de robot. Toen een object voor de QRD, kreeg de waarde van de analoge pin kleiner. Dit werkt goed voor onze doeleinden, want we kunnen dit heel gemakkelijk te gebruiken in de software. kopie plak de volgende code aan uw IDE, compileren en uploaden.
Deze code is voor een hindernis vermijden robot met één QRD-1114 reflectived sensor.
voel je vrij om de wijzigingen te verbeteren of het oplossen van problemen.
Const int Lf = 9; //forwards aan linkerkant
Const int Lb = 10; //backwards aan linkerkant
Const int Rf = 11; //forwards aan rechterkant
Const int Rb = 12; achteruit aan rechterkant
int val = 0; gegevens van de sensor opslaan
VOID Setup {}
pinMode (Lf, uitvoer); linker motor output
pinMode (Lb, uitvoer); linker motor output
pinMode (Rf, uitvoer); rechts motor output
pinMode (Rb, uitvoer); rechts motor output
analoge pinnen automatisch ingesteld als input
}
void loop {}
Val = analogRead(0); lezen van sensor
Als (val < 100) {}
digitalWrite (Lf, laag); / / stop gaan vooruit
digitalWrite (Rf, laag); //stop gaan vooruit
digitalWrite (Lb, hoge); / / terug weg fromn object
digitalWrite (Rb, hoge); //back uit de buurt van object
delay(2500);
digitalWrite (Rb, laag); //turn uit de buurt van object
delay(2500);
digitalWrite (Lb, laag); / / stoppen met bewegen
} else {}
digitalWrite (Lf, hoge);
digitalWrite (Rf, hoge); Ga naar voren als geen object
}
}