private VuforiaManagerImpl.TrackableResultData GetTrackableResultData(VuforiaManager.TrackableIdPair trackableId, bool includeVuMarks)
{
VuforiaManagerImpl.TrackableResultData[] array = this.mTrackableResultDataArray;
for (int i = 0; i < array.Length; i++)
{
VuforiaManagerImpl.TrackableResultData trackableResultData = array[i];
if (trackableResultData.id == trackableId.TrackableId)
{
return(trackableResultData);
}
}
VuforiaManagerImpl.TrackableResultData result;
result.id = -1;
result.pose = default(VuforiaManagerImpl.PoseData);
result.statusInteger = 1;
result.timeStamp = 0.0;
if (includeVuMarks)
{
VuforiaManagerImpl.VuMarkTargetResultData[] array2 = this.mVuMarkResultDataArray;
for (int i = 0; i < array2.Length; i++)
{
VuforiaManagerImpl.VuMarkTargetResultData vuMarkTargetResultData = array2[i];
if (vuMarkTargetResultData.resultID == trackableId.ResultId)
{
result.id = vuMarkTargetResultData.resultID;
result.statusInteger = vuMarkTargetResultData.statusInteger;
result.pose = vuMarkTargetResultData.pose;
result.timeStamp = vuMarkTargetResultData.timeStamp;
break;
}
}
}
return(result);
}
private void UpdateTrackableFoundQueue()
{
VuforiaManagerImpl.TrackableResultData[] array = this.mTrackableResultDataArray;
for (int i = 0; i < array.Length; i++)
{
VuforiaManagerImpl.TrackableResultData trackableResultData = array[i];
this.UpdateTrackableFoundQueue(trackableResultData.status, VuforiaManager.TrackableIdPair.FromTrackableId(trackableResultData.id));
}
VuforiaManagerImpl.VuMarkTargetResultData[] array2 = this.mVuMarkResultDataArray;
for (int i = 0; i < array2.Length; i++)
{
VuforiaManagerImpl.VuMarkTargetResultData vuMarkTargetResultData = array2[i];
this.UpdateTrackableFoundQueue(vuMarkTargetResultData.status, VuforiaManager.TrackableIdPair.FromResultId(vuMarkTargetResultData.resultID));
}
using (List <VuforiaManager.TrackableIdPair> .Enumerator enumerator = new List <VuforiaManager.TrackableIdPair>(this.mTrackableFoundQueue).GetEnumerator())
{
while (enumerator.MoveNext())
{
VuforiaManager.TrackableIdPair id = enumerator.Current;
if (Array.Exists <VuforiaManagerImpl.TrackableResultData>(this.mTrackableResultDataArray, (VuforiaManagerImpl.TrackableResultData tr) => tr.id == id.TrackableId))
{
break;
}
if (Array.Exists <VuforiaManagerImpl.VuMarkTargetResultData>(this.mVuMarkResultDataArray, (VuforiaManagerImpl.VuMarkTargetResultData tr) => tr.resultID == id.ResultId))
{
break;
}
this.mTrackableFoundQueue.Remove(id);
}
}
}
public void UpdateCamera(Transform cameraTransform, VuforiaManagerImpl.TrackableResultData[] trackableResultDataArray, int deviceTrackableID)
{
if (deviceTrackableID >= 0)
{
int i = 0;
while (i < trackableResultDataArray.Length)
{
VuforiaManagerImpl.TrackableResultData trackableResultData = trackableResultDataArray[i];
if (trackableResultData.id == deviceTrackableID)
{
if (trackableResultData.status != TrackableBehaviour.Status.DETECTED && trackableResultData.status != TrackableBehaviour.Status.TRACKED && trackableResultData.status != TrackableBehaviour.Status.EXTENDED_TRACKED)
{
break;
}
if (this.mBeforeDevicePoseUpdated != null)
{
this.mBeforeDevicePoseUpdated.InvokeWithExceptionHandling();
}
this.PositionCamera(this.mDeviceTrackerPositonOffset, this.mDeviceTrackerRotationOffset, cameraTransform, trackableResultData.pose);
if (this.mAfterDevicePoseUpdated != null)
{
this.mAfterDevicePoseUpdated.InvokeWithExceptionHandling();
return;
}
break;
}
else
{
i++;
}
}
}
}
private void UnmarshalTrackables(VuforiaManagerImpl.FrameState frameState)
{
for (int i = 0; i < frameState.numTrackableResults; i++)
{
VuforiaManagerImpl.TrackableResultData trackableResultData = (VuforiaManagerImpl.TrackableResultData)Marshal.PtrToStructure(new IntPtr(frameState.trackableDataArray.ToInt64() + (long)(i * Marshal.SizeOf(typeof(VuforiaManagerImpl.TrackableResultData)))), typeof(VuforiaManagerImpl.TrackableResultData));
this.mTrackableResultDataArray[i] = trackableResultData;
}
for (int j = 0; j < frameState.numPropTrackableResults; j++)
{
VuforiaManagerImpl.TrackableResultData trackableResultData2 = (VuforiaManagerImpl.TrackableResultData)Marshal.PtrToStructure(new IntPtr(frameState.propTrackableDataArray.ToInt64() + (long)(j * Marshal.SizeOf(typeof(VuforiaManagerImpl.TrackableResultData)))), typeof(VuforiaManagerImpl.TrackableResultData));
this.mTrackableResultDataArray[frameState.numTrackableResults + j] = trackableResultData2;
}
}
internal void UpdateTrackablePoses(Transform arCameraTransform, VuforiaManagerImpl.TrackableResultData[] trackableResultDataArray, VuforiaManagerImpl.VuMarkTargetResultData[] vuMarkResultDataArray, VuforiaManager.TrackableIdPair originTrackableID, int frameIndex)
{
Dictionary <int, TrackableBehaviour.Status> dictionary = new Dictionary <int, TrackableBehaviour.Status>();
for (int i = 0; i < trackableResultDataArray.Length; i++)
{
VuforiaManagerImpl.TrackableResultData trackableResultData = trackableResultDataArray[i];
dictionary.Add(trackableResultData.id, trackableResultData.status);
TrackableBehaviour trackableBehaviour;
if (this.mTrackableBehaviours.TryGetValue(trackableResultData.id, out trackableBehaviour) && trackableResultData.id != originTrackableID.TrackableId && VuforiaManagerImpl.IsDetectedOrTracked(trackableResultData.status) && trackableBehaviour.enabled)
{
StateManagerImpl.PositionTrackable(trackableBehaviour, arCameraTransform, trackableResultData.pose, trackableResultData.timeStamp);
}
}
Dictionary <int, TrackableBehaviour.Status> dictionary2 = new Dictionary <int, TrackableBehaviour.Status>();
for (int i = 0; i < vuMarkResultDataArray.Length; i++)
{
VuforiaManagerImpl.VuMarkTargetResultData vuMarkTargetResultData = vuMarkResultDataArray[i];
dictionary2.Add(vuMarkTargetResultData.resultID, vuMarkTargetResultData.status);
}
this.mVuMarkManager.UpdateVuMarkPoses(arCameraTransform, vuMarkResultDataArray, originTrackableID.ResultId);
this.mActiveTrackableBehaviours.Clear();
TrackableBehaviour[] array = this.GetTrackableBehaviours().ToArray <TrackableBehaviour>();
for (int i = 0; i < array.Length; i++)
{
TrackableBehaviour trackableBehaviour2 = array[i];
if (trackableBehaviour2.enabled)
{
TrackableBehaviour.Status vuforiaStatus;
if (dictionary.TryGetValue(trackableBehaviour2.Trackable.ID, out vuforiaStatus) || (trackableBehaviour2 is VuMarkAbstractBehaviour && dictionary2.TryGetValue(((VuMarkAbstractBehaviour)trackableBehaviour2).VuMarkResultId, out vuforiaStatus)))
{
this.mExtendedTrackingManager.ApplyTrackingState(trackableBehaviour2, vuforiaStatus, arCameraTransform);
trackableBehaviour2.OnFrameIndexUpdate(frameIndex);
}
else
{
this.mExtendedTrackingManager.ApplyTrackingState(trackableBehaviour2, TrackableBehaviour.Status.NOT_FOUND, arCameraTransform);
}
if (VuforiaManagerImpl.IsDetectedOrTracked(trackableBehaviour2.CurrentStatus))
{
this.mActiveTrackableBehaviours.Add(trackableBehaviour2);
}
}
}
}
private void UpdateTrackers(VuforiaManagerImpl.FrameState frameState)
{
this.UnmarshalTrackables(frameState);
this.UnmarshalWordTrackables(frameState);
this.UnmarshalVuMarkTrackables(frameState);
this.UpdateTrackableFoundQueue();
StateManagerImpl stateManagerImpl = (StateManagerImpl)TrackerManager.Instance.GetStateManager();
this.UpdateSmartTerrain(frameState, stateManagerImpl);
this.UpdateExtendedTrackedVuMarks();
stateManagerImpl.UpdateVuMarks(this.mVuMarkDataArray, this.mVuMarkResultDataArray);
VuforiaManager.TrackableIdPair trackableIdPair = new VuforiaManager.TrackableIdPair
{
ResultId = -1,
TrackableId = -1
};
int num = -1;
if (this.mWorldCenterMode == VuforiaARController.WorldCenterMode.SPECIFIC_TARGET)
{
if (this.mVuMarkWorldCenter != null && this.mVuMarkWorldCenter.VuMarkTemplate != null)
{
this.mWorldCenter = this.GetVuMarkWorldCenter(this.mVuMarkWorldCenter.VuMarkTemplate.ID);
}
if (this.mWorldCenter != null && this.mWorldCenter.Trackable != null)
{
if (this.mWorldCenter is VuMarkAbstractBehaviour)
{
trackableIdPair.ResultId = ((VuMarkAbstractBehaviour)this.mWorldCenter).VuMarkResultId;
}
else
{
trackableIdPair.TrackableId = this.mWorldCenter.Trackable.ID;
}
}
}
else if (this.mWorldCenterMode == VuforiaARController.WorldCenterMode.FIRST_TARGET)
{
stateManagerImpl.RemoveDisabledTrackablesFromQueue(ref this.mTrackableFoundQueue);
if (this.mTrackableFoundQueue.Count > 0)
{
trackableIdPair = this.mTrackableFoundQueue.First.Value;
}
}
else if (this.mWorldCenterMode == VuforiaARController.WorldCenterMode.DEVICE_TRACKING)
{
num = frameState.deviceTrackableId;
}
DeviceTrackingManager deviceTrackingManager = stateManagerImpl.GetDeviceTrackingManager();
if (num != -1)
{
deviceTrackingManager.UpdateCamera(this.mCentralAnchorPoint, this.mTrackableResultDataArray, num);
}
else
{
RotationalPlayModeDeviceTrackerImpl rotationalPlayModeDeviceTrackerImpl = TrackerManager.Instance.GetTracker <DeviceTracker>() as RotationalPlayModeDeviceTrackerImpl;
if (rotationalPlayModeDeviceTrackerImpl != null && rotationalPlayModeDeviceTrackerImpl.IsActive)
{
VuforiaManagerImpl.TrackableResultData trackable = rotationalPlayModeDeviceTrackerImpl.GetTrackable();
deviceTrackingManager.UpdateCamera(this.mCentralAnchorPoint, new VuforiaManagerImpl.TrackableResultData[]
{
trackable
}, trackable.id);
}
else if (trackableIdPair.TrackableId >= 0 || trackableIdPair.ResultId >= 0)
{
VuforiaManagerImpl.TrackableResultData trackableResultData = this.GetTrackableResultData(trackableIdPair, true);
if (VuforiaManagerImpl.IsDetectedOrTracked(trackableResultData.status))
{
stateManagerImpl.UpdateCameraPoseWRTTrackable(this.mCentralAnchorPoint, this.mParentAnchorPoint, trackableIdPair, trackableResultData.pose);
}
}
}
if (this.mARCameraTransform != this.mCentralAnchorPoint)
{
this.mARCameraTransform.position = this.mCentralAnchorPoint.position;
this.mARCameraTransform.rotation = this.mCentralAnchorPoint.rotation;
}
stateManagerImpl.UpdateTrackablePoses(this.mARCameraTransform, this.mTrackableResultDataArray, this.mVuMarkResultDataArray, trackableIdPair, frameState.frameIndex);
stateManagerImpl.UpdateWords(this.mARCameraTransform, this.mWordDataArray, this.mWordResultDataArray);
stateManagerImpl.UpdateVirtualButtons(frameState.numVirtualButtonResults, frameState.vbDataArray);
}