public void DefaultRoundTest() { var third = 100f / 3f; var v = new float3(third, third, third); var output = NumericsUtil.Normalize(v); Assert.AreEqual(output, new float3(33.33f, 33.33f, 33.33f), "Value mismatch!"); }
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; }