pid steering
This commit is contained in:
parent
a0ab0e15d0
commit
e6d26d4aa8
|
|
@ -101,8 +101,8 @@ for chunk in stream.iter_content(chunk_size=1024):
|
||||||
v = 0.25
|
v = 0.25
|
||||||
|
|
||||||
p = -x
|
p = -x
|
||||||
d = (x - xp) * 1000 / dtms
|
d = (x - xp) * 1000 / -dtms
|
||||||
i = mri * ip + x * dtms / 10000
|
i = mri * ip + x * dtms / -10000
|
||||||
|
|
||||||
k = wp * p + wi * i + wd * d
|
k = wp * p + wi * i + wd * d
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue