Baxter trajectory execution code