Behavior to add box to the planning scene

[msavchen-nasa]

No description provided.

[scastro-nasa]

Would it be easier to just have the behavior accept a PoseStamped and set the header to the CollisionObject message's header? Then you can just couple this with the existing CreatePoseStamped behavior.

Also, unit test?

[msavchen-nasa]

Would it be easier to just have the behavior accept a PoseStamped and set the header to the CollisionObject message's header? Then you can just couple this with the existing CreatePoseStamped behavior.

I was thinking of keeping things more intuitive and straightforward, and having CreatePose behavior makes imetro_behavior more "complete".
But I also didnt think about mapping PoseStamped's header to CollisionObject's header, sorry about that.

Also, unit test?

I always forget about these.
Give me a couple of minutes.

[scastro-nasa]

LGTM, I'll squash the commit so the shared machine doesn't show up as a contributor