Add baxter box movement with moveit

Please merge after #86