Use EntityMovement speed and tile distance to compute path duration.
Set exactly the final position.
Fix PathFindingMap cost function and heuristic.