Updates in planner. collision check corrected to use true state not belief.
Connection strategy has 10% more radius when doing rollout to prevent getting stuck