Derivative calculation was wrong all along #40

Merged
sb10q merged 1 commits from pid_hotfix into master 2020-12-29 17:09:04 +08:00
1 changed files with 1 additions and 1 deletions

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);