[Engine/Utils] Added AStar implementation.