public void CopyFrom(Skeleton skeleton, Transform kinect, uint timestamp)
{
const float mm2m = 0.001f; // When using 0.001, we get a dwarf. Do they mean cm?
for (int i = 0; i < 32; i++)
{
var joint = skeleton.GetJoint(i);
var bone = new BoneState();
bone.position = kinect.TransformPoint(NumericsUtil.Convert(joint.Position) * mm2m);
bone.rotation = kinect.rotation * NumericsUtil.Convert(joint.Quaternion);
bone.confidenceLevel = joint.ConfidenceLevel;
bones[i] = bone;
}
this.timestamp = timestamp;
}
