Pedestrian routing second run stability fix

This commit is contained in:
Lev Dragunov 2015-04-06 18:37:33 +03:00 committed by Alex Zolotarev
parent 2765db6aec
commit d63073f7fd

View file

@ -13,6 +13,8 @@ static double const MAX_SPEED = 36.11111111111; // m/s
void AStarRouter::SetFinalRoadPos(vector<RoadPos> const & finalPos)
{
ASSERT_GREATER(finalPos.size(), 0, ());
m_entries.clear();
PossiblePathQueueT().swap(m_queue);
for (size_t i = 0; i < finalPos.size(); ++i)
{
pair<ShortPathSetT::iterator, bool> t = m_entries.insert(ShortestPath(finalPos[i]));