CC @Timple

Distance to goal integrating path points rather than just L2 distance.

ETA based on some conservative metrics (max speed or min speed, current speed?)