Change Path evaulate to take into account the start speed of the robot.