cleaning code
fixing missuse of PIDControllerX class