Added virtual destructors and tuned closed loop. Fixed Kick.
changed closed loop control and Obstacle avoid move