public void Init(SkinnedMeshRenderer mesh)
{
this.mesh = mesh;
this.name = GenerateName(this.mesh);
// reset anything associated with the old model
this.MappedList.Clear();
this.meshSkeleton = null;
this.kinectSkeleton = null;
}
public void Update()
{
// Get the closest body
Kinect.Body body = this.BodySourceManager.FindClosestBody();
if (null == body)
{
return;
}
Vector3 position = KinectSkeleton.ConvertJointPositionToUnityVector3(body, Kinect.JointType.SpineBase);
Quaternion rotation = KinectSkeleton.ConvertJointQuaternionToUnityQuaterion(body, Kinect.JointType.SpineBase);
this.transform.position = position;
this.transform.rotation = rotation;
// update the skeleton with the new body joint/orientation information
UpdateSkeletons(body);
}
void Update()
{
if (_reader != null)
{
bool hasBodyData = false;
using (var frame = _reader.AcquireLatestFrame())
{
if (frame != null)
{
hasBodyData = true;
if (_bodies == null)
{
_bodies = new Kinect.Body[_sensor.BodyFrameSource.BodyCount];
}
frame.GetAndRefreshBodyData(_bodies);
UnityEngine.Vector4 floorPlane = new UnityEngine.Vector4(frame.FloorClipPlane.X,
frame.FloorClipPlane.Y,
frame.FloorClipPlane.Z,
frame.FloorClipPlane.W);
// update plane
Helpers.FloorClipPlane = floorPlane;
}
}
// correct for floorPlane
if (hasBodyData)
{
// get a local copy
UnityEngine.Vector4 floorClipPlane = Helpers.FloorClipPlane;
// y - up
Vector3 up = floorClipPlane;
// z - forward
Vector3 forward = new Vector3(0.0f, 0.0f, 1.0f);
// x - right
Vector3 right = Vector3.Cross(up, forward);
right.Normalize();
// update matrix
Matrix4x4 correctionMatrix = Matrix4x4.identity;
correctionMatrix.SetColumn(0, right);
correctionMatrix.m00 = right.x;
correctionMatrix.m01 = right.y;
correctionMatrix.m02 = right.z;
correctionMatrix.SetColumn(1, up);
correctionMatrix.m10 = up.x;
correctionMatrix.m11 = up.y;
correctionMatrix.m12 = up.z;
correctionMatrix.SetColumn(2, forward);
correctionMatrix.m20 = forward.x;
correctionMatrix.m21 = forward.y;
correctionMatrix.m23 = forward.z;
// may need to be transposed
correctionMatrix.m13 = floorClipPlane.w;
//correctionMatrix.m33 = floorClipPlane.w;
}
if (Bodies == null || Bodies.Length == 0)
{
return;
}
List <ulong> uList = new List <ulong>();
foreach (KeyValuePair <ulong, GameObject> entry in bodies)
{
uList.Add(entry.Key);
}
foreach (Kinect.Body b in Bodies)
{
if (b.IsTracked)
{
uList.Remove(b.TrackingId);
GameObject bObj = null;
if (bodies.ContainsKey(b.TrackingId))
{
bObj = bodies[b.TrackingId];
KinectVisualizer vis = bObj.GetComponent <KinectVisualizer>();
vis.DrawBoneModel = true;
}
else
{
bObj = Instantiate(pref);
KinectVisualizer vis = bObj.GetComponent <KinectVisualizer>();
GameObject shirtObj = Instantiate(shirt);
shirtObj.transform.parent = bObj.transform;
vis.shirt = shirtObj;
bObj.name = b.TrackingId.ToString();
bodies.Add(b.TrackingId, bObj);
}
bObj.SetActive(true);
KinectSkeleton skel = bObj.GetComponent <KinectSkeleton>();
skel.UpdateJoints(b);
}
else
{
GameObject bod = GameObject.Find(b.TrackingId.ToString());
Destroy(bod);
GameObject sket = GameObject.Find(b.TrackingId.ToString() + "_Skeleton");
Destroy(sket);
}
}
foreach (ulong u in uList)
{
GameObject bObj = bodies[u];
GameObject skelObj = GameObject.Find(bObj.name + "_Skeleton");
Destroy(bObj);
Destroy(skelObj);
bodies.Remove(u);
}
}
}