pid: fix derivative calculation

Reviewed-on: #40
Co-Authored-By: topquark12 <aw@m-labs.hk>
Co-Committed-By: topquark12 <aw@m-labs.hk>
This commit is contained in:
topquark12 2020-12-29 17:09:03 +08:00 committed by sb10q
parent 8c9e12587f
commit e94601f54f

View File

@ -85,7 +85,7 @@ impl Controller {
None => None =>
0.0, 0.0,
Some(last_input) => Some(last_input) =>
f64::from(self.parameters.kd) * (input - last_input) / time_delta, f64::from(self.parameters.kd) * (last_input - input) / time_delta,
}; };
self.last_input = Some(input); self.last_input = Some(input);