public override void Draw(Drawing3d drawing, TwistStampedMsg message, MessageMetadata meta)
{
drawing.SetTFTrackingSettings(m_TFTrackingSettings, message.header);
var orig = origin == null ? Vector3.zero : origin.transform.position;
TwistDefaultVisualizer.Draw <FLU>(message.twist, drawing, SelectColor(m_Color, meta), orig, lengthScale, sphereRadius, thickness);
}
public static void Draw <C>(TwistWithCovarianceMsg message, Drawing3d drawing, Color color, Vector3 origin, float lengthScale = 1, float sphereRadius = 1, float thickness = 0.01f) where C : ICoordinateSpace, new()
{
TwistDefaultVisualizer.Draw <FLU>(message.twist, drawing, color, origin, lengthScale, sphereRadius, thickness);
}