Kommen wir jetzt zum Code für den Arduino:

ich programmiere den Arduino vorzugsweise in C++, dafür gibt es ein ausgezeichnetes Plugin für Eclipse unter Baeyebs Arduino Nightly


hier erstmal die beiden Dateien:

die Radar.cpp



die Radar.h



Um den Servo laufen lassen zu können brauchen wir noch den Header File für den Servo. Den binden wir in Eclipse folgender Maßen ein:

Man wählt im Menü den Menüpunkt Arduino aus, dann klickt man auf Add a Library to the selected Project. Damit öffnet sich ein Fenster, in dem man die verfügbaren Libraries für den Arduino
sieht. Hier wählt man Servo aus und klickt auf Finish. Damit ist das Projekt vorbereitet zum compilieren.

nun zum Code:

in den Zeilen 4 - 6 machen wir die Pins der beiden Bauelemente bekannt. Wie bereits im Planning der Platine besprochen liegt auf 6 der Echo des Sonic Sensors, auf 7 der Trigger und auf 9 der Datenpin des Servo.

in der Funktion setup initialisieren wir, wie gewohnt, die Bauelemente und setzen die Übertragungsrate der seriellen Schnittstelle.

loop ruft lediglich die scan Funktion auf, in der wir eine Range von bis in Grad angeben.

scan bekommt als parameter die Grad von und die Grad bis, innerhalb derer der Servo sich bewegen soll. Diese Range wird durchlaufen und dem Stepper die Position Schrittweise übergeben. Innerhalb der Schleife wird

• wie bereits erwähnt der Servo auf seine aktuelle Position gesetzt
• über den Ultraschall Sensor (HR-SC40) für die aktuelle Position des Servo die Entfernung bis zum nächsten Hindernis berechnet
• die berechneten Daten ausgegeben

calculateDistance läßt den Ultraschall Sensor die aktuelle Distanz erfragen

calculateAverageDistance läßt den Ultraschall Sensor ebenfalls die Distanz erfragen, hier wird aber an Hand der Klassenvariable iAverageCount mehrmals beim Ultraschall Sensor angefragt und aus den Werten ein Durchschnittswert gebildet, da mir die einfache Anfrage ein großes Stück zu ungenau war.

readEchoFromSonic läßt den Sensor eine Distanzmessung durchführen. Dafür wird der Ultraschall Sensor erst resettet (LOW Signal an den Trigger PIN), 2 Microsekunden später wird ein Schallsignal über den Sensor gesendet, was 10 Microsekunden dauert (HIGH Signal an den Trigger PIN), abschließend wird nach 10 Millisekunden der Trigger PIN wieder mit LOW befeuert, was ihn verstummen läßt.

Die Dauer zwischen dem Absenden und dem Empfang des Signals erhält man über den Echo PIN des Ultraschall Sensors mit pulseIn(PIN, HIGH)

communicateCurrentData dient lediglich der Ausgabe der errechneten Daten und der aktuellen Position des Servo über die Serielle Schnittstelle.

convertMicrosecondsToInches berechnet die erhaltene Dauer bis zur Rückantwort des Echo Signales in Inches um, da 2.5 Inch 1cm sind und der Schall in 1 Microsekunde 29 cm zurück legt, errechnen wir aus der erhaltenenen Dauer des Echos / 74 die Strecke in Inches, da das Echo hin und zurück diese Dauer benötigte, teilen wir das Ergebnis durch 2 und haben somit das Ergebnis einer einfachen Strecke zwischen dem Sensor und dem Hindernis.

convertMicrosecondsToCm berechnet die erhaltene Dauer bis zur Rückantwort des Echo Signals in cm, analog zu convertMicrosecondsToInches, nur das hier die erhaltene Dauer durch 29 gerechnet wird. Die Erklärung sollte aus der Erklärung für das konvertieren in Inches schlüssig sein.