AppExperiments

using Leap.Unity.RuntimeGizmos;
using UnityEngine;

using Drawer = Leap.Unity.RuntimeGizmos.RuntimeGizmoDrawer;

namespace Leap.Unity.Geometry {

  public static class GeometryUtils {

    #region Runtime Gizmos

    private static Drawer s_drawer;

    #region Render Sphere

    /// <summary>
    /// Renders this Sphere in world space.
    /// </summary>
    public static void Render(this Sphere sphere) {
      Drawer drawer;
      if (TryGetDrawer(out drawer)) {
        drawer.DrawWireSphere(sphere.center, sphere.radius);
      }
    }

    public static void Render(this Sphere sphere, Color color) {
      Drawer drawer;
      if (TryGetDrawer(out drawer)) {
        drawer.color = color;
        drawer.DrawWireSphere(sphere.center, sphere.radius);
      }
    }

    #endregion

    #region Render Point

    /// <summary>
    /// Renders the point with world-aligned axis lines one centimeter outward from the
    /// point's position. Optionally pass a scale multliplier for the scale of the
    /// render.
    /// </summary>
    public static void Render(this Point point, Color? color, float scale = 1f) {
      Drawer drawer;
      if (TryGetDrawer(out drawer)) {

        float finalScale = 0.01f * scale;
        var pos = point.position;

        if (color.HasValue) {
          drawer.color = color.GetValueOrDefault();
        }

        if (!color.HasValue) {
          drawer.color = Color.red;
        }
        drawer.DrawLine(pos - Vector3.right * finalScale,
                        pos + Vector3.right * finalScale);

        if (!color.HasValue) {
          drawer.color = Color.green;
        }
        drawer.DrawLine(pos - Vector3.up * finalScale,
                        pos + Vector3.up * finalScale);

        if (!color.HasValue) {
          drawer.color = Color.blue;
        }
        drawer.DrawLine(pos - Vector3.forward * finalScale,
                        pos + Vector3.forward * finalScale);
      }
    }
    /// <summary>
    /// Renders the point with a sphere of one centimeter radius. Optionally pass a
    /// color and scale multiplier.
    /// </summary>
    public static void RenderSphere(this Point point, Color? color, float scale = 1f) {
      Drawer drawer;
      if (TryGetDrawer(out drawer)) {

        float finalScale = 0.01f * scale;
        var pos = point.position;

        if (color.HasValue) {
          drawer.color = color.GetValueOrDefault();
        }

        drawer.DrawWireSphere(pos, finalScale);
      }
    }

    #endregion

    #endregion

    #region Internal

    private static bool TryGetDrawer(out Drawer drawer) {
      return RuntimeGizmoManager.TryGetGizmoDrawer(out drawer);
    }

    #endregion

  }

}