Added RRT Planner and Shorten Path to Environments.