adding capOutput function to PIDControllerX