Added obstacle check to planner. Done sanity checks.
Merge branch 'master' of http://github.com/jitrc/eklavya-ros-pkg