Added local planner tester and modified the subscriber of local planner.