adding PIDControllerX2