from ev3robot import *

######################
##  Initialisierung ##
######################

# Roboter initialisieren
robot = LegoRobot()

# Raeder hinzufuegen
gear = Gear()
robot.addPart(gear)

###########################################
## B E G I N   D E S   P R O G R A M M S ##
###########################################
v = 40                            # Werte bis ca. 70 sind sinnvoll
t = 2                             # Zeit, während der gemessen wird.
print("v=%d" % v)                 # Anzeige auf dem Computer im Ausgabefenster
gear.setSpeed(v)                  # Geschwindigkeit setzen
gear.forward()                    # Fahren...
Tools.delay(1000)                 # Geschwindigkeit stabilisieren, 1 Sekunde warten
start = gear.getLeftMotorCount()  # Aktuelle Winkel-Position in Grad in die Variable start speichern.
Tools.delay(t*1000)               # t Sekunden warten (während die Räder weiter drehen)
distanz = gear.getLeftMotorCount()-start    # Differenz zur Startposition berechnen (in Grad)
print("Geschwindigkeit in Grad/sec %f" % (distanz/t))
gear.stop()
robot.exit()                  # Programm korrekt beenden