UnitTester and Debugger classes for local_planner and controller done.