Compare commits

..

2 commits

Author SHA1 Message Date
80e8811180 Merge pull request 'Anpassung fahre_gerade_aus für negative Strecken' (#14) from treffen-291123 into main
Reviewed-on: #14
2023-11-29 17:01:51 +00:00
Harry Kimpel
2fe0c0a556 Anpassung fahre_gerade_aus für negative Strecken
Signed-off-by: Harry Kimpel <harrykimpel@hotmail.com>
2023-11-29 18:01:27 +01:00

View file

@ -128,8 +128,8 @@ class IQRobot:
versatz = self.bewegungsSensor.get_yaw_angle()
sum_versatz = sum_versatz + versatz
abweichung = (kp * versatz + ki * sum_versatz) / 100
linker_speed = speed * (1 - abweichung)
rechter_speed = speed * (1 + abweichung)
linker_speed = speed * richtung * (1 - abweichung)
rechter_speed = speed * richtung * (1 + abweichung)
self.antrieb.start_tank_at_power(int(linker_speed), int(rechter_speed))
#print("Versatz: " + str(versatz) + " , linker Speed: " + str(linker_speed) + ", rechter Speed: " + str(rechter_speed) + ", strecke: " + str(sum_cm))