public static void Draw <C>(PoseArrayMsg message, Drawing3d drawing, float size = 0.1f, bool drawUnityAxes = false) where C : ICoordinateSpace, new()
{
foreach (PoseMsg pose in message.poses)
{
PoseDefaultVisualizer.Draw <C>(pose, drawing, size, drawUnityAxes);
}
}
public override void Draw(Drawing3d drawing, PoseStampedMsg message, MessageMetadata meta)
{
drawing.SetTFTrackingSettings(m_TFTrackingSettings, message.header);
PoseDefaultVisualizer.Draw <FLU>(message.pose, drawing, m_Size, m_DrawUnityAxes);
}
public static void Draw <C>(OdometryMsg message, Drawing3d drawing, Color color, float lengthScale = 1, float sphereRadius = 1, float thickness = 0.01f) where C : ICoordinateSpace, new()
{
PoseDefaultVisualizer.Draw <C>(message.pose.pose, drawing);
TwistDefaultVisualizer.Draw <C>(message.twist.twist, drawing, color, message.pose.pose.position.From <C>(), lengthScale, sphereRadius, thickness);
}
public override void Draw(Drawing3d drawing, PoseWithCovarianceMsg message, MessageMetadata meta)
{
PoseDefaultVisualizer.Draw <FLU>(message.pose, drawing, m_Size, m_DrawUnityAxes);
}
