Fixed pid_control function declaration at top of ControlManager