pid steering

This commit is contained in:
tymek 2025-08-01 18:16:21 +02:00
parent a56abda2cd
commit 1633e56a5e

View file

@ -105,8 +105,8 @@ for chunk in stream.iter_content(chunk_size=1024):
k = wp * p + wi * i + wd * d k = wp * p + wi * i + wd * d
speedL = max(0, -v * min(100 + k, 100)) speedL = max(-100, -v * min(100 + k, 100))
speedR = max(0, v * min(100 - k, 100)) speedR = max(-100, v * min(100 - k, 100))
motorL.start(speedL) motorL.start(speedL)
motorR.start(speedR) motorR.start(speedR)
xp = x xp = x