pid steering
This commit is contained in:
parent
c8797cb5bc
commit
b695190099
|
|
@ -105,7 +105,7 @@ for chunk in stream.iter_content(chunk_size=1024):
|
|||
|
||||
k = wp * p + wi * i + wd * d
|
||||
|
||||
speedL = max(-99, -v * min(100 + k, 99))
|
||||
speedL = -1 * max(-99, v * min(100 + k, 99))
|
||||
speedR = max(-99, v * min(100 - k, 99))
|
||||
print(p, d, i, speedL, speedR)
|
||||
motorL.start(int(speedL))
|
||||
|
|
|
|||
Loading…
Reference in a new issue