Debugging statements in RRT*.