118 lines
4.4 KiB
C#
118 lines
4.4 KiB
C#
using System;
|
||
using System.Collections;
|
||
using System.Collections.Generic;
|
||
using LitJson;
|
||
#if PICO_OPENXR_SDK
|
||
using Unity.XR.OpenXR.Features.PICOSupport;
|
||
#endif
|
||
using Unity.XR.PXR;
|
||
using UnityEngine;
|
||
using UnityEngine.XR;
|
||
|
||
|
||
namespace Unity.XR.PICO.TOBSupport
|
||
{
|
||
public class MarkerInfoCallback : AndroidJavaProxy
|
||
{
|
||
public Action<List<MarkerInfo>> mCallback;
|
||
private List<MarkerInfo> mlist = new List<MarkerInfo>();
|
||
private TrackingOriginModeFlags TrackingMode;
|
||
private float YOffset;
|
||
|
||
public MarkerInfoCallback(TrackingOriginModeFlags trackingMode, float cameraYOffset,
|
||
Action<List<MarkerInfo>> callback) : base("com.picoxr.tobservice.interfaces.StringCallback")
|
||
{
|
||
TrackingMode = trackingMode;
|
||
YOffset = cameraYOffset;
|
||
mCallback = callback;
|
||
mlist.Clear();
|
||
#if PICO_OPENXR_SDK
|
||
OpenXRExtensions.SetMarkMode();
|
||
#endif
|
||
}
|
||
|
||
public void CallBack(string var1)
|
||
{
|
||
Debug.Log("ToBService MarkerInfo Callback 回调:" + var1);
|
||
List<MarkerInfo> tmp = JsonToMarkerInfos(var1);
|
||
PXR_EnterpriseTools.QueueOnMainThread(() =>
|
||
{
|
||
if (mCallback != null)
|
||
{
|
||
mCallback(tmp);
|
||
}
|
||
});
|
||
}
|
||
|
||
public List<MarkerInfo> JsonToMarkerInfos(string json)
|
||
{
|
||
if (string.IsNullOrEmpty(json))
|
||
{
|
||
return null;
|
||
}
|
||
|
||
List<MarkerInfo> ModelList = new List<MarkerInfo>();
|
||
JsonData jsonData = JsonMapper.ToObject(json);
|
||
IDictionary dictionary = jsonData as IDictionary;
|
||
for (int i = 0; i < dictionary.Count; i++)
|
||
{
|
||
Debug.Log("TOB TestDemo---- MarkerInfo Callback 回调:1");
|
||
|
||
float OriginHeight = 0;
|
||
if (TrackingMode == TrackingOriginModeFlags.Device || TrackingMode == TrackingOriginModeFlags.Floor)
|
||
{
|
||
|
||
#if !PICO_OPENXR_SDK
|
||
OriginHeight = PXR_Plugin.System.UPxr_GetConfigFloat(ConfigType.ToDelaSensorY);
|
||
#else
|
||
float trackingorigin_height = PXR_EnterprisePlugin.oxr_get_trackingorigin_height();
|
||
float locationheight = OpenXRExtensions.GetLocationHeight();
|
||
if (TrackingMode == TrackingOriginModeFlags.Floor)
|
||
{
|
||
YOffset = 0;
|
||
OriginHeight = -trackingorigin_height;
|
||
}
|
||
else
|
||
{
|
||
// OriginHeight = trackingorigin_height + locationheight;
|
||
// OriginHeight = locationheight;
|
||
OriginHeight = -trackingorigin_height;
|
||
}
|
||
#endif
|
||
}
|
||
else
|
||
{
|
||
OriginHeight = 0;
|
||
YOffset = 0;
|
||
}
|
||
|
||
Debug.Log("TOB TestDemo---- MarkerInfo Callback 回调:OriginHeight："+OriginHeight );
|
||
MarkerInfo model = new MarkerInfo();
|
||
model.posX = double.Parse(jsonData[i]["posX"].ToString());
|
||
model.posY = double.Parse(jsonData[i]["posY"].ToString()) + OriginHeight + YOffset;
|
||
model.posZ = -double.Parse(jsonData[i]["posZ"].ToString());
|
||
|
||
model.rotationX = -double.Parse(jsonData[i]["rotationX"].ToString());
|
||
model.rotationY = -double.Parse(jsonData[i]["rotationY"].ToString());
|
||
model.rotationZ = double.Parse(jsonData[i]["rotationZ"].ToString());
|
||
model.rotationW = double.Parse(jsonData[i]["rotationW"].ToString());
|
||
|
||
model.validFlag = int.Parse(jsonData[i]["validFlag"].ToString());
|
||
model.markerType = int.Parse(jsonData[i]["markerType"].ToString());
|
||
model.iMarkerId = int.Parse(jsonData[i]["iMarkerId"].ToString());
|
||
model.dTimestamp = double.Parse(jsonData[i]["dTimestamp"].ToString());
|
||
|
||
IDictionary dictionaryReserve = jsonData[i]["reserve"] as IDictionary;
|
||
model.reserve = new float[dictionaryReserve.Count];
|
||
for (int j = 0; j < dictionaryReserve.Count; j++)
|
||
{
|
||
model.reserve[j] = float.Parse(jsonData[i]["reserve"][j].ToString());
|
||
}
|
||
|
||
ModelList.Add(model);
|
||
}
|
||
|
||
return ModelList;
|
||
}
|
||
}
|
||
} |