Successfully drawing in obstacles, still can't get pedestrians right.