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
|
k = wp * p + wi * i + wd * d
|
||||||
|
|
||||||
motorL.start(-v * min(100 - k, 100))
|
motorL.start(-v * min(100 + k, 100))
|
||||||
motorR.start(v * min(100 - k, 100))
|
motorR.start(v * min(100 + k, 100))
|
||||||
xp = x
|
xp = x
|
||||||
ip += i
|
ip += i
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue