Replaced core/pathQueue with std::queue