Added changes to test changing trajectories and use system_full_launch