public static NamedPose ToNamedPose(Rox.Transform tf)
{
var o = new NamedPose();
o.pose = ToPose(tf);
o.frame.name = tf.Child_frame_id ?? "";
o.parent_frame.name = tf.Parent_frame_id ?? "";
return(o);
}
public static Rox.Transform ToTransform(NamedPose tf)
{
return(new Rox.Transform(Q2R(ToVector(tf.pose.orientation)), ToVector(tf.pose.position), tf.parent_frame.name, tf.frame.name));
}
