#!/usr/bin/env pybricks-micropython
# imports nach https://fginfo.ksbg.ch/dokuwiki/doku.php?id=lehrkraefte:blc:informatik:glf22:robotik-mit-svcode:programm-struktur
from pybricks.hubs import EV3Brick
from pybricks.ev3devices import Motor, TouchSensor, ColorSensor, InfraredSensor, UltrasonicSensor, GyroSensor
from pybricks.parameters import Port, Stop, Direction, Button, Color
from pybricks.tools import wait, StopWatch, DataLog
from pybricks.robotics import DriveBase
from pybricks.media.ev3dev import SoundFile, ImageFile

from math import pi  # Wert pi importieren

# Create your objects here.
ev3 = EV3Brick()
ev3.speaker.beep()

links = Motor(Port.A)
rechts = Motor(Port.B)

# ----------------
dRad = 5.40  # [cm] Raddurchmesser gemessen
spur = 10.5  # [cm] Radabstand gemessen
# --------------
uRad = dRad * pi  # [cm] Radmufang
grad_pro_cm = 360 / uRad  # [°/cm]
cm_pro_grad = uRad / 360  # [cm/°]
print("dRad={}cm, uRad={}cm, spur={}cm, Wegwinkel={}°/cm, Winkelweg={}cm/°".format(dRad, int(uRad), spur, int(grad_pro_cm), int(cm_pro_grad)))