예제 #1
0
        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);
 }