Added scripts to publish desired trajectory