pid steering

This commit is contained in:
tymek 2025-08-01 17:54:40 +02:00
parent a0ab0e15d0
commit e6d26d4aa8

View file

@ -101,8 +101,8 @@ for chunk in stream.iter_content(chunk_size=1024):
v = 0.25
p = -x
d = (x - xp) * 1000 / dtms
i = mri * ip + x * dtms / 10000
d = (x - xp) * 1000 / -dtms
i = mri * ip + x * dtms / -10000
k = wp * p + wi * i + wd * d