Trackable.cs

/*==============================================================================
Copyright 2017 Maxst, Inc. All Rights Reserved.
==============================================================================*/

using UnityEngine;
using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using System.Runtime.InteropServices;

namespace maxstAR
{
    public class Trackable
    {
        private ulong cPtr;
        private float[] glPoseMatrix = new float[16];
        private byte[] idBytes = new byte[100];
        private byte[] nameBytes = new byte[100];

        internal Trackable(ulong cPtr)
        {
            this.cPtr = cPtr;
        }

        public string GetId()
        {
            Array.Clear(idBytes, 0, idBytes.Length);

            if (Application.platform == RuntimePlatform.IPhonePlayer)
            {
                NativeStaticAPI.Trackable_getId(cPtr, idBytes);
            }
            else
            {
                NativeSharedAPI.Trackable_getId(cPtr, idBytes);
            }

            return Encoding.UTF8.GetString(idBytes).TrimEnd('\0');
        }

        public string GetName()
        {
            Array.Clear(nameBytes, 0, nameBytes.Length);

            if (Application.platform == RuntimePlatform.IPhonePlayer)
            {
                NativeStaticAPI.Trackable_getName(cPtr, nameBytes);
            }
            else
            {
                NativeSharedAPI.Trackable_getName(cPtr, nameBytes);
            }

            return Encoding.UTF8.GetString(nameBytes).TrimEnd('\0');
        }

        public Matrix4x4 GetPose()
        {
            if (Application.platform == RuntimePlatform.IPhonePlayer)
            {
                NativeStaticAPI.Trackable_getPose(cPtr, glPoseMatrix);
            }
            else
            {
                NativeSharedAPI.Trackable_getPose(cPtr, glPoseMatrix);
            }

            if (AbstractARManager.Instance.WorldCenterModeSetting == 
                AbstractARManager.WorldCenterMode.TARGET)
            {
                //Quaternion rotation = Quaternion.Euler(90, 0, 0);
                //Matrix4x4 tempPose = Matrix4x4.identity;
                //Matrix4x4 m = Matrix4x4.TRS(new Vector3(0, 0, 0), rotation, new Vector3(1, 1, 1));
                //tempPose = m * tempPose;
                //rotation = Quaternion.Euler(-90, 0, 0);
                //m = Matrix4x4.TRS(Vector3.zero, rotation, new Vector3(1, 1, 1));
                //tempPose = tempPose * m;
                //return tempPose;
                return Matrix4x4.identity;
            }
            else
            {
                Matrix4x4 tempPose = MatrixUtils.GetUnityPoseMatrix(glPoseMatrix);
                Quaternion rotation = Quaternion.Euler(90, 0, 0);
                Matrix4x4 m = Matrix4x4.TRS(Camera.main.transform.position, rotation, new Vector3(1, 1, 1));

                // First. Change world matrix
                tempPose = m * tempPose;

                rotation = Quaternion.Euler(-90, 0, 0);
                m = Matrix4x4.TRS(Vector3.zero, rotation, new Vector3(1, 1, 1));

                // Second. Change local matrix
                tempPose = tempPose * m;

                return tempPose;
                //return MatrixUtils.GetUnityPoseMatrix(glPoseMatrix);
            }
        }

        // Get target pose for camera transform (When world center mode is TARGET)
        internal Matrix4x4 GetTargetPose()
        {
            if (Application.platform == RuntimePlatform.IPhonePlayer)
            {
                NativeStaticAPI.Trackable_getPose(cPtr, glPoseMatrix);
            }
            else
            {
                NativeSharedAPI.Trackable_getPose(cPtr, glPoseMatrix);
            }

            return MatrixUtils.GetUnityPoseMatrix(glPoseMatrix);
        }

        //public float GetDistance()
        //{
        //  if (Application.platform == RuntimePlatform.IPhonePlayer)
        //  {
        //      return NativeStaticAPI.Trackable_getDistance(index);
        //  }
        //  else
        //  {
        //      return NativeSharedAPI.Trackable_getDistance(index);
        //  }
        //}

        //public float GetWidth()
        //{
        //  if (Application.platform == RuntimePlatform.IPhonePlayer)
        //  {
        //      return NativeStaticAPI.Trackable_getWidth(index);
        //  }
        //  else
        //  {
        //      return NativeSharedAPI.Trackable_getWidth(index);
        //  }
        //}

        //public float GetHeight()
        //{
        //  if (Application.platform == RuntimePlatform.IPhonePlayer)
        //  {
        //      return NativeStaticAPI.Trackable_getHeight(index);
        //  }
        //  else
        //  {
        //      return NativeSharedAPI.Trackable_getHeight(index);
        //  }
        //}
    }
}