Fixed bug

optiklab · Jul 15, 2023 · ec67b5b · ec67b5b
1 parent 9468196
commit ec67b5b
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/aStarQueue.h b/aStarQueue.h
@@ -68,14 +68,14 @@ class aStarQueue : public pathFindingBase
 
 			if (minimum > newDistance + euristic)
 			{
-				minimum = newDistance;
+				minimum = newDistance + euristic;
 				minimumNode = to;
 			}
 		}
 
 		if (minimumNode != -1)
 		{
-			remove(_queue.begin(), _queue.end(), minimumNode);
+			_queue.erase(remove(_queue.begin(), _queue.end(), minimumNode), _queue.end());
 		}
 
 		return minimumNode;