add the new collision monitor

[padhupradheep]

Remove the logic on stopping the robot, while close to the obstacle.. Collision monitor will take care of it..

focus more on planning around..