pub fn pid_compute(setpoint: f64, actual: f64, kp: f64, ki: f64, kd: f64) -> f64
Stateful PID calculation function for Sesh scripts with genuine damping & integral clamping