Continues obstacle collision check added in main loop
-when nav_state is "moving" continues call checkwaypoint function
-checkwaypointCallback uses checkwaypoint function
-usage of boost::optional<Point> to return if, and where possible colission occurs
-usage of boost::optional<Point> to return recursivebug result if available
-added currentpose servicecall for obstacle colission check