Add start point
Randomize start and goal points