Stap 3: Code
De Arduino board verbinden met uw computer/laptop. Vervolgens opent u de Arduino IDE en voeg de volgende code in een nieuw bestand van de schets:
Voegt Servo bibliotheek
#include
Hiermee definieert u Tirg en Echo pinnen van de Sensor en welke macht pin ze zullen gehecht const int trigPin = 10; Const int echoPin = 11;
Variabelen voor de duur en de afstand lange duur; int afstand;
Servo myServo; Code aan controle de servo motor void setup {pinMode (trigPin, OUTPUT); / / wordt de trigPin ingesteld als een Output-pinMode (echoPin, INPUT); / / Sets van de echoPin als een Input-Serial.begin(9600); myServo.attach(12); / / bepaalt op welke macht pin de servomotor vastzit}
void loop {/ / draait de servomotor van 15 tot 165 graden voor (int ik = 15; Ik < = 165; i ++) {myServo.write(i); delay(30); afstand = calculateDistance(); / / roept een functie voor het berekenen van de afstand gemeten door de ultrasone sensor voor elke graad Serial.print(i); / / stuurt de huidige mate in de seriële poort Serial.print(","); / / stuurt toevoeging teken rechts naast de vorige waarde nodig verderop in de verwerking van IDE voor indexing Serial.print(distance); / / stuurt de waarde afstand in de seriële poort Serial.print("."); / / stuurt toevoeging teken rechts naast de vorige waarde nodig verderop in de verwerking van IDE voor indexering} / / herhaalt de voorgaande regels bij roterende terug van 165 tot 15 graden voor (int i = 165; ik > 15; ik--) {myServo.write(i); delay(30); afstand = calculateDistance(); Serial.Print(i); Serial.Print(","); Serial.Print(distance); Serial.Print("."); } }
Functie voor het berekenen van de afstand gemeten door de sensor int calculateDistance() {digitalWrite (trigPin, laag); delayMicroseconds(2); / / Hiermee stelt u de trigPin op hoog staat voor 10 micro seconden digitalWrite (trigPin, hoog), delayMicroseconds(10), digitalWrite (trigPin, laag); duur = pulseIn (echoPin, hoge); / / geeft als resultaat de geluidsgolf reistijd in microseconden door het lezen van de echoPin afstand = duur * 0,034 / 2; terugkeer afstand;}
Upload deze code naar je Arduino. De servomotor moet nu worden bewegen.