Seg fault removed from planner. Truncate function for target inside the map needs to be repaired. launch file added for debugger.