minor (performance) changes
changed call for convex hull function.
only call the function when a check for obstacle colission is called
added service call for colission detection when navigating to a new waypoint