Updated the PID control subsystems