AppExperiments

using Leap.Unity.Attributes;
using Leap.Unity.Layout;
using System.Collections;
using System.Collections.Generic;
using UnityEngine;

namespace Leap.Unity.PhysicalInterfaces {

  public class ThrownUIPoseProvider : MonoBehaviour, IPoseProvider {

    [SerializeField, ImplementsInterface(typeof(IKinematicStateProvider))]
    private MonoBehaviour _handleKinematicStateProvider;
    public IKinematicStateProvider handleKinematicStateProvider {
      get {
        return _handleKinematicStateProvider as IKinematicStateProvider;
      }
    }

    [SerializeField, ImplementsInterface(typeof(IAttachmentProvider))]
    private MonoBehaviour _handleAttachmentPoseProvider;
    public IAttachmentProvider handleAttachmentPoseProvider {
      get {
        return _handleAttachmentPoseProvider as IAttachmentProvider;
      }
    }

    public float optimalHeightFromHead = 0.20f;

    public float optimalDistance = 0.60f;

    public bool flip180 = false;

    [Header("Debug")]
    public bool drawDebug = false;

    public Pose GetPose() {
      var handleKinematicState = handleKinematicStateProvider.GetKinematicState();

      var handlePose = handleKinematicState.pose;

      var handleToAttachedUIPose = handleAttachmentPoseProvider.GetHandleToAttachmentPose();
      
      var layoutPos = PhysicalInterfaceUtils.LayoutThrownUIPosition2(
        Camera.main.transform.ToPose(),
        //handlePose.position,
        handlePose.Then(handleToAttachedUIPose).position,
        handleKinematicState.movement.velocity,
        optimalHeightFromHead: optimalHeightFromHead,
        optimalDistance: optimalDistance
      );

      if (drawDebug) {
        DebugPing.Ping(handlePose, LeapColor.red, 0.2f);
        DebugPing.PingCapsule(handlePose.position, layoutPos, LeapColor.purple, 0.2f);
        DebugPing.Ping(layoutPos, LeapColor.blue, 0.2f);
      }

      var solvedHandlePose = new Pose(layoutPos,
        Utils.FaceTargetWithoutTwist(layoutPos, Camera.main.transform.position,
          flip180)).Then(handleToAttachedUIPose.inverse);

      return solvedHandlePose;
    }

  }

}