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