pid steering
This commit is contained in:
parent
11752074f0
commit
0ea853623a
|
|
@ -106,8 +106,8 @@ for chunk in stream.iter_content(chunk_size=1024):
|
|||
|
||||
k = wp * p + wi * i + wd * d
|
||||
|
||||
motorL.start(-v * min(100 - k, 100))
|
||||
motorR.start(v * min(100 - k, 100))
|
||||
motorL.start(-v * min(100 + k, 100))
|
||||
motorR.start(v * min(100 + k, 100))
|
||||
xp = x
|
||||
ip += i
|
||||
|
||||
|
|
|
|||
Loading…
Reference in a new issue