private void OnDrawGizmos()
 {
     if (Samples.Count > 0)
     {
         var positionAvg = MathUtility.Average(Samples.Select(t => t.Item1));
         var rotationAvg = MathUtility.Average(Samples.Select(t => t.Item2));
         Gizmos.DrawCube(positionAvg, Vector3.one * 0.01f);
         GizmosExtension.DrawRotation(positionAvg, rotationAvg, 0.1f);
     }
 }
        private void OnDrawGizmos()
        {
            if (Application.isPlaying)
            {
                Gizmos.color = Color.blue;
                Gizmos.DrawWireCube(Point1.transform.position, Vector3.one * 0.01f);
                GizmosExtension.DrawRotation(Point1.transform.position, Point1.transform.rotation, 0.1f);

                Gizmos.color = Color.green;
                Gizmos.DrawWireCube(Point2.transform.position, Vector3.one * 0.01f);
                GizmosExtension.DrawRotation(Point2.transform.position, Point2.transform.rotation, 0.1f);
            }
        }