pid: fix derivative calculation

Reviewed-on: M-Labs/thermostat#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 =>
0.0,
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);