Add new parameters in NavigatorParameters, and better path debugging for A* pathfinder