pid steering

This commit is contained in:
tymek 2025-07-31 18:38:48 +02:00
parent c2929ab72b
commit dca54f7f03

View file

@ -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