Fixed drawing in rrt.py