Initial version. Pick and place borrowed from https://github.com/pirobot/rbx2/tree/hydro-devel/rbx2_arm_nav. Thanks to @pirobot!
Temporally removed until I update them to indigo