Made changes to trajectory_visualization to view both robot trajectories. Added the "orientation" parameter to robot node in system_full.launch