Back to moving arms, planning done with objects in the scene. Interpolating trajectories.
Fixing things that were fixed before, start committing more.
Fixing the old way of doing this. Using arm.set_joint_positions instead of joint trajectory action server
Ready to push, back to the old method.