wxGameyuexiu/Assets/Imagine/WorldTracker/Scripts/WorldTracker_3DOF.cs

using System.Collections;
using System.Collections.Generic;
using UnityEngine;
using UnityEngine.Events;
using System.Runtime.InteropServices;
using System.Globalization;


namespace Imagine.WebAR
{
    [System.Serializable]
    public class Settings3DOF
    {
        public float armLength = 0.4f;
        public bool useExtraSmoothing = false;
        [Range(1,50)] public float smoothenFactor = 10;

        [Space][Range(.0001f, 0.1f)] public float angleSmoothFactor = 0.001f;
        [Range(0f, 0.05f)] public float angleDriftThreshold = 0.025f;
    }

    public partial class WorldTracker
    {
        private Vector3 targetPos3DOF;
        private Quaternion targetRot3DOF;

        void Awake_3DOF()
        {
            
        }

        void Start_3DOF()
        {            
            
            // Input.multiTouchEnabled = true;

            var json = "{";
            json += "\"MODE\":\"3DOF\",";
            json += "\"CAM_START_HEIGHT\":" + cameraStartHeight.ToStringInvariantCulture() + ",";
            json += "\"ARM_LENGTH\":" + s3dof.armLength.ToStringInvariantCulture() + ",";
            json += "\"ANGLE_SMOOTH_FACTOR\":" + s3dof.angleSmoothFactor.ToStringInvariantCulture() + ",";
            json += "\"ANGLE_DRIFT_THRESHOLD\":" + s3dof.angleDriftThreshold.ToStringInvariantCulture() + ",";
            json += "\"USE_COMPASS\":" + (useCompass?"true":"false");
            

            json += "}";
#if !UNITY_EDITOR && UNITY_WEBGL
            SetWebGLwTrackerSettings(json);
#endif        

            // if(!usePlacementIndicator){
            //     //we need to correct rotation when object is autoplaced
            //     //otherwise, object can end up behind the user
            //     StartCoroutine(WaitAndInvoke(0.25f,()=>{
            //         Debug.Log("Correcting rotation...");
            //         var camForward = trackerCamera.transform.forward;
            //         camForward.y = 0;
            //         var lookRotation = Quaternion.LookRotation(camForward);
            //         mainObject.transform.rotation = lookRotation;
            //     }));
            // }
        }

        public void Update_3DOF()
        {
            if(s3dof.useExtraSmoothing){
                trackerCamera.transform.position = Vector3.Lerp(trackerCamera.transform.position, targetPos3DOF, Time.deltaTime * s3dof.smoothenFactor);
                trackerCamera.transform.rotation = Quaternion.Slerp(trackerCamera.transform.rotation, targetRot3DOF, Time.deltaTime * s3dof.smoothenFactor);
                //Debug.Log("Update Orbit Mode: " + targetPos3DOF + " " + targetRot3DOF);
            }   
        }


        void UpdateCameraTransform_3DOF(string data)
        {
            var vals = data.Split(new string[] { "," }, System.StringSplitOptions.RemoveEmptyEntries);

            trackerCamRot.w = float.Parse(vals[0], CultureInfo.InvariantCulture);
            trackerCamRot.x = float.Parse(vals[1], CultureInfo.InvariantCulture);
            trackerCamRot.y = float.Parse(vals[2], CultureInfo.InvariantCulture);
            trackerCamRot.z = float.Parse(vals[3], CultureInfo.InvariantCulture);

            trackerCamPos.x = float.Parse(vals[4], CultureInfo.InvariantCulture);
            trackerCamPos.y = float.Parse(vals[5], CultureInfo.InvariantCulture);
            trackerCamPos.z = float.Parse(vals[6], CultureInfo.InvariantCulture);


            if(!s3dof.useExtraSmoothing){
                trackerCamera.transform.position = trackerCamPos;
                trackerCamera.transform.rotation = trackerCamRot;
            }    
            else{
                targetPos3DOF = trackerCamPos;
                targetRot3DOF = trackerCamRot;
            }
            
        }

        void Place_3DOF(Vector3 pos){
            mainObject.transform.position = pos;
        }

        void Reset_3DOF()
        {
#if !UNITY_EDITOR && UNITY_WEBGL
            WebGLResetOrigin();
#endif
        }
    }
}