Ultraschall Sensor

Nachdem es ca 2-3 Wochen gedauert hat bis mein Ultraschall-Sensor HC-SR04 aus China geliefert wurde, konnte ich diesen heute zum ersten mal testen.
Der Ultraschall-Sensor soll mir den Abstand zu einem Hindernis ,,berechnen“.

So habe ich den HC-SR04 angeschlossen:
VCC vom Sensor geht an meinen 5v Anschluss vom PiFace. Ihr könnt das auch mit 3 V direkt am Pi machen allerdings ist dann die Reichweite des Sensors geringer

GND ist mit GND vom PiFace verbunden.

Trig ist mit dem OutPutPin 4 verbunde.

Echo ist mit dem InPutPin 3 verbunden.

Mein derzeitiger Quellcode sieht folgendermaßen aus:

#!/usr/bin/python3

import pifacedigitalio
import time

pifacedigital = pifacedigitalio.PiFaceDigital()

while True:
    #Hier werden die Impulse gesendet.
    pifacedigital.output_pins[4].turn_on()
    time.sleep(0.00001)
    pifacedigital.output_pins[4].turn_off()
    StartTime = time.time()
    #Hier werden die Echo Impulse gemessen.
    while pifacedigital.input_pins[3].value == 0:
        pass
    StopTime = time.time()
    Elapsed = StopTime - StartTime
    #Hier wird die Entfernung in cm Berechnet.
    DistanceCm = Elapsed * 34000 / 2
    #Hier wird der erechnete Wert auf 2 Kommastellen gerundet
    DistanceCm = round(DistanceCm,2)
    print ("Die Entfernung betraegt: ", DistanceCm, " cm")
    time.sleep(3)

Die Genauigkeit des Sensors lässt allerdings noch ein bisschen zu wünschen übrig. Ich muss wohl noch ein bisschen an meiner Berechnung feilen bis es wirklich richtig funktioniert und am Roboter zum Einsatz kommen kann.

Die Frontansicht vom Roboter