Working on prep traj
Merge branch 'master' of github.com:cwrus/Baxter_Security