A small change in local_planner.hpp