void UpdateTF(Message message) { TF2TFMessage tfMessage = (TF2TFMessage)message; foreach (GeometryTransformStamped tf in tfMessage.transforms) { if (tf.child_frame_id == "torso_lift_link") { torso_lift_link = tf; } } }
public void UpdateTF(TF2TFMessage tfMessage) { doUpdate = true; message = tfMessage; }