Gaussian Sampling added for RRT Planner