Update rrt_example_pr2.py