pid steering
This commit is contained in:
parent
1633e56a5e
commit
d931a8d090
|
|
@ -105,8 +105,8 @@ for chunk in stream.iter_content(chunk_size=1024):
|
|||
|
||||
k = wp * p + wi * i + wd * d
|
||||
|
||||
speedL = max(-100, -v * min(100 + k, 100))
|
||||
speedR = max(-100, v * min(100 - k, 100))
|
||||
speedL = max(-99, -v * min(100 + k, 99))
|
||||
speedR = max(-99, v * min(100 - k, 99))
|
||||
motorL.start(speedL)
|
||||
motorR.start(speedR)
|
||||
xp = x
|
||||
|
|
|
|||
Loading…
Reference in a new issue