LM A*: Update G map with actual walked distance