Scores trajectories based on how far along the global path they end up. TODO Scores trajectories based on the distance to the global path, only taking the parts into account that are still ahead of the robot.