Animation 2

        Please click on the picture to get a full screen picture





        Animation 2 show the robot moves around an environment where the robot have to avoid 5 different obstacles. Picture 1 shows the inital point (the blue ball at the right corner) and the goal point (the blue ball at the left corner). Picture 2 shows the 3D RRT formed around the obstacles. Picture 3 shows the filtered path to go from the initial point to the goal point. Picture 4, 5, and 6 show the different view angles of the original RRT when the obstacle were removed.