Fixed aStar bugs