adding MathUtils class
adding PIDControllerX class