Schritt 3: Code
Das Arduino-Board an Ihren Computer/Laptop anschließen. Als nächstes öffnen Sie der Arduino IDE und fügen Sie folgenden Code in eine neue Skizze-Datei:
Fügt Servo-Bibliothek
#include
Definiert Tirg und Echo Pins des Sensors und was macht Pin sie werden const Int TrigPin = 10; const Int EchoPin = 11;
Variablen für die Dauer und die lange Dauer der Entfernung; Int Entfernung;
Servo MyServo; Code zur Controle der Servo motor void setup() {PinMode (TrigPin, OUTPUT); / / setzt die TrigPin als eine Output-PinMode (EchoPin, Eingabe); / / setzt die EchoPin als ein Input-Serial.begin(9600); myServo.attach(12); / / definiert, auf welche Leistung Pin die Servo-Motor angeschlossen ist}
void loop() {/ / dreht die Servo-Motor von 15 bis 165 Grad für (Int ich = 15; ich < = 165; i ++) {myServo.write(i); delay(30); Abstand = calculateDistance(); / / ruft eine Funktion für die Berechnung der Entfernung gemessen an der Ultraschallsensor für jeden Serial.print(i); / / sendet den aktuellen Grad in den seriellen Port Serial.print(","); / / sendet zusätzlich Zeichen direkt neben den vorherigen Wert für Indizierung Serial.print(distance); später in der Verarbeitung von IDE benötigt / / sendet den Abstandswert in den seriellen Port Serial.print("."); / / sendet Zusatz-Zeichen direkt neben den vorherigen Wert später in der Verarbeitung von IDE für die Indizierung erforderlich} / / wiederholt die vorhergehenden Zeilen beim Drehen von 165 bis 15 Grad für (Int ich = 165; ich > 15; ich--) {myServo.write(i); delay(30); Abstand = calculateDistance(); Serial.Print(i); Serial.Print(","); Serial.Print(Distance); Serial.Print("."); } }
Funktion für die Berechnung der Entfernung gemessen an den Sensor Int calculateDistance() {DigitalWrite (TrigPin, LOW); delayMicroseconds(2); / / setzt die TrigPin auf HIGH-Zustand für 10 Mikrosekunden DigitalWrite (TrigPin, HIGH); delayMicroseconds(10); DigitalWrite (TrigPin, LOW) Dauer = PulseIn (EchoPin, HIGH); / / gibt zurück die Schallwelle Fahrzeit in Mikrosekunden durch das Lesen des EchoPin Abstand = Dauer * 0,034 / 2; return zu distanzieren;}
Laden Sie diesen Code auf Ihrem Arduino. Die Servo-Motor sollte jetzt bewegen.