linuswck/thermostat
1
0
Fork 0
forked from M-Labs/thermostat
Code Pull Requests 1 Activity

pid: move ki coefficient inside integration

Browse Source
This commit is contained in:
Astro 2020-10-11 01:56:22 +02:00
parent f12214a4df
commit 83a266852a
1 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
src/pid.rs
View File

@ -53,19 +53,19 @@ impl Controller {
let p = f64::from(self.parameters.kp) * error;
// integral
self.integral += error;
self.integral += f64::from(self.parameters.ki) * error;
if self.integral < self.parameters.integral_min.into() {
self.integral = self.parameters.integral_min.into();
}
if self.integral > self.parameters.integral_max.into() {
self.integral = self.parameters.integral_max.into();
}
let i = f64::from(self.parameters.ki) * f64::from(self.integral);
let i = self.integral;
// derivative
let d = match self.last_input {
None => 0.0,
Some(last_input) => f64::from(self.parameters.kd) * (last_input - input)
Some(last_input) => f64::from(self.parameters.kd) * (last_input - input),
};
self.last_input = Some(input);