From 3193b0ba4ee017a7fc61801341edac52febc18be Mon Sep 17 00:00:00 2001
From: tatiana-kondakova <tatiana.kondakova@gmail.com>
Date: Tue, 21 Nov 2017 18:32:18 +0300
Subject: [PATCH] Fix distance calculation for unidirectional AStar

---
 routing/base/astar_algorithm.hpp | 5 +++--
 1 file changed, 3 insertions(+), 2 deletions(-)

diff --git a/routing/base/astar_algorithm.hpp b/routing/base/astar_algorithm.hpp
index 0926fde12a..2bf7503352 100644
--- a/routing/base/astar_algorithm.hpp
+++ b/routing/base/astar_algorithm.hpp
@@ -358,8 +358,9 @@ typename AStarAlgorithm<TGraph>::Result AStarAlgorithm<TGraph>::FindPath(
   if (resultCode == Result::OK)
   {
     context.ReconstructPath(finalVertex, result.m_path);
-    result.m_distance =
-        context.GetDistance(finalVertex) - graph.HeuristicCostEstimate(startVertex, finalVertex);
+    result.m_distance = context.GetDistance(finalVertex) -
+                        graph.HeuristicCostEstimate(finalVertex, finalVertex) +
+                        graph.HeuristicCostEstimate(startVertex, finalVertex);
   }
 
   return resultCode;