/**********************************************************************************
* Blueprint Reality Inc. CONFIDENTIAL
* 2020 Blueprint Reality Inc.
* All Rights Reserved.
*
* NOTICE:  All information contained herein is, and remains, the property of
* Blueprint Reality Inc. and its suppliers, if any.  The intellectual and
* technical concepts contained herein are proprietary to Blueprint Reality Inc.
* and its suppliers and may be covered by Patents, pending patents, and are
* protected by trade secret or copyright law.
*
* Dissemination of this information or reproduction of this material is strictly
* forbidden unless prior written permission is obtained from Blueprint Reality Inc.
***********************************************************************************/

#if UNITY_STANDALONE_WIN
using BlueprintReality.MixCast.Experience;
using BlueprintReality.MixCast.Shared;
using BlueprintReality.MixCast.Thrift;
using System.Collections;
using System.Collections.Generic;
using UnityEngine;

namespace BlueprintReality.MixCast
{
    public class SdkCustomTrackedObjectMediator
    {
        private List<TrackedObject> customTrackedObjectMetadata = new List<TrackedObject>();
        private List<BlueprintReality.Thrift.Pose> customTrackedObjectPoses = new List<BlueprintReality.Thrift.Pose>();
        private bool metaDataChanged = false;
        //private bool posesChanged = false;

        public void Activate()
        {

        }
        public void Deactivate()
        {
            if (customTrackedObjectMetadata.Count > 0)
            {
                customTrackedObjectMetadata.Clear();
                metaDataChanged = true;
            }
            if( customTrackedObjectPoses.Count > 0 )
            {
                customTrackedObjectPoses.Clear();
                //posesChanged = true;
            }
            
            SendUpdateToService();
        }

        public void Update()
        {
            if (MixCastSdkBehaviour.Instance == null)
                return;

            UpdateObjectList();
            UpdatePoses();

            SendUpdateToService();
        }

        void UpdateObjectList()
        {
            while (customTrackedObjectMetadata.Count < CustomTrackedObjectBehaviour.ActiveCustomTrackedObjects.Count)
            {
                customTrackedObjectMetadata.Add(new TrackedObject()
                {
                    Connected = true,
                    Position = new BlueprintReality.Thrift.Vector3(),
                    Rotation = new BlueprintReality.Thrift.Quaternion(),
                });
                metaDataChanged = true;
            }
            while (customTrackedObjectMetadata.Count > CustomTrackedObjectBehaviour.ActiveCustomTrackedObjects.Count)
            {
                customTrackedObjectMetadata.RemoveAt(customTrackedObjectMetadata.Count - 1);
                metaDataChanged = true;
            }
            for (int i = 0; i < customTrackedObjectMetadata.Count; i++)
            {
                metaDataChanged |= UpdateTrackedObjectMetadata(CustomTrackedObjectBehaviour.ActiveCustomTrackedObjects[i], customTrackedObjectMetadata[i]);
            }
        }
        bool UpdateTrackedObjectMetadata(CustomTrackedObjectBehaviour srcBehaviour, TrackedObject dstObj)
        {
            bool changed = false;

            changed |= dstObj.Identifier != srcBehaviour.objectIdentifier;
            dstObj.Identifier = srcBehaviour.objectIdentifier;

            changed |= dstObj.Name != srcBehaviour.objectName;
            dstObj.Name = srcBehaviour.objectName;

            changed |= dstObj.ObjectType != srcBehaviour.objectType;
            dstObj.ObjectType = srcBehaviour.objectType;

            changed |= dstObj.AssignedRole != srcBehaviour.objectRole;
            dstObj.AssignedRole = srcBehaviour.objectRole;

            changed |= dstObj.HideFromUser != srcBehaviour.hideFromUser;
            dstObj.HideFromUser = srcBehaviour.hideFromUser;

            Vector3 pos = srcBehaviour.GetPosition();
            changed |= Vector3.SqrMagnitude(pos - dstObj.Position.unity) > 0.01f * 0.01f;
            dstObj.Position.unity = pos;

            Quaternion rot = srcBehaviour.GetRotation();
            changed |= Quaternion.Angle(rot, dstObj.Rotation.unity) > 0.01f;
            dstObj.Rotation.unity = rot;

            return changed;
        }
        void UpdatePoses()
        {
            //Can assume that CustomTrackedObjects and customTrackedObjectMetadata are now synced
            while (customTrackedObjectPoses.Count < CustomTrackedObjectBehaviour.ActiveCustomTrackedObjects.Count)
            {
                customTrackedObjectPoses.Add(new BlueprintReality.Thrift.Pose() {
                    Position = new BlueprintReality.Thrift.Vector3(),
                    Rotation = new BlueprintReality.Thrift.Quaternion()
                });
            }
            while (customTrackedObjectPoses.Count > CustomTrackedObjectBehaviour.ActiveCustomTrackedObjects.Count)
                customTrackedObjectPoses.RemoveAt(customTrackedObjectPoses.Count - 1);

            for( int i = 0; i < CustomTrackedObjectBehaviour.ActiveCustomTrackedObjects.Count; i++ )
            {
                //Assigning pose in 2 places for now
                customTrackedObjectPoses[i].Position.unity = customTrackedObjectMetadata[i].Position.unity = CustomTrackedObjectBehaviour.ActiveCustomTrackedObjects[i].GetPosition();
                customTrackedObjectPoses[i].Rotation.unity = customTrackedObjectMetadata[i].Rotation.unity = CustomTrackedObjectBehaviour.ActiveCustomTrackedObjects[i].GetRotation();
                //posesChanged = true;
            }
        }

        void SendUpdateToService()
        {
            if (metaDataChanged)
            {
                MixCastSdkBehaviour.Instance.ClientConnection.TryUpdateExperienceTrackedObjectMetadata(customTrackedObjectMetadata);
            }
            //if( metaDataChanged || posesChanged )
            //{
            //    Thrift.UnityThriftMixCastClient.Get<Thrift.SDK_Service.Client>().TryUpdateExperienceTrackedObjectPoses(customTrackedObjectPoses);
            //}
            metaDataChanged = false;
            //posesChanged = false;
        }
    }
}
#endif
