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