Added execute trajectory
Minor Changes