56 geometry_msgs::TransformStamped msgtf;
68 std::vector<geometry_msgs::TransformStamped> msgtfs;
69 for (std::vector<StampedTransform>::const_iterator it = transforms.begin(); it != transforms.end(); ++it)
71 geometry_msgs::TransformStamped msgtf;
73 msgtfs.push_back(msgtf);
static void transformStampedTFToMsg(const StampedTransform &bt, geometry_msgs::TransformStamped &msg)
convert tf::StampedTransform to TransformStamped msg