public override void receiveMatrix3x4(SimpleMatrix3x4 newMatrix)
{
lock (thisLock)
{
m_matrix = UbiMeasurementUtils.ubitrackToUnity(newMatrix);
}
}
public override void receiveMatrix3x4(SimpleMatrix3x4 newMatrix)
{
lock (thisLock)
{
m_matrix = UbiMeasurementUtils.ubitrackToUnity(newMatrix);
}
}
public static void ubitrack3x4MatrixToFloatArray(SimpleMatrix3x4 ubiMatrix, ref float[] matrix)
{
matrix[0] = (float)ubiMatrix.e11;
matrix[1] = (float)ubiMatrix.e12;
matrix[2] = (float)ubiMatrix.e13;
matrix[3] = (float)ubiMatrix.e14;
matrix[4] = (float)ubiMatrix.e21;
matrix[5] = (float)ubiMatrix.e22;
matrix[6] = (float)ubiMatrix.e23;
matrix[7] = (float)ubiMatrix.e24;
matrix[8] = (float)ubiMatrix.e31;
matrix[9] = (float)ubiMatrix.e32;
matrix[10] = (float)ubiMatrix.e33;
matrix[11] = (float)ubiMatrix.e34;
}
internal static Measurement <float[]> ubitrackToUnity(SimpleMatrix3x4 newMatrix)
{
float[] data = new float[12];
ubitrack3x4MatrixToFloatArray(newMatrix, ref data);
return(new Measurement <float[]>(data, newMatrix.timestamp));
}
internal static Measurement<float[]> ubitrackToUnity(SimpleMatrix3x4 newMatrix)
{
float[] data = new float[12];
ubitrack3x4MatrixToFloatArray(newMatrix, ref data);
return new Measurement<float[]>(data, newMatrix.timestamp);
}
public static void ubitrack3x4MatrixToFloatArray(SimpleMatrix3x4 ubiMatrix, ref float[] matrix)
{
matrix[0] = (float)ubiMatrix.e11;
matrix[1] = (float)ubiMatrix.e12;
matrix[2] = (float)ubiMatrix.e13;
matrix[3] = (float)ubiMatrix.e14;
matrix[4] = (float)ubiMatrix.e21;
matrix[5] = (float)ubiMatrix.e22;
matrix[6] = (float)ubiMatrix.e23;
matrix[7] = (float)ubiMatrix.e24;
matrix[8] = (float)ubiMatrix.e31;
matrix[9] = (float)ubiMatrix.e32;
matrix[10] = (float)ubiMatrix.e33;
matrix[11] = (float)ubiMatrix.e34;
}
