XnVector3D Mean(XnVector3D v1, XnVector3D v2)
{
XnVector3D mean;
mean.X = Mean(v1.X, v2.X);
mean.Y = Mean(v1.Y, v2.Y);
mean.Z = Mean(v1.Z, v2.Z);
return(mean);
}
static Vector3 ToVector3(XnVector3D position)
{
return(new Vector3(position.X, position.Y, -position.Z));
}
Vector3 ToWorldPosition(XnVector3D p)
{
return(new Vector3(p.X * ni_world_scale, p.Y * ni_world_scale, -p.Z * ni_world_scale));
}