Added a wait-for-transform before transforming pose into arm coordinates

A TF CACHE ERROR comes up regularly when not waiting for the correct TF transform here.