void OpenNIDevice::copySkeleton(const nite::Skeleton& srcSkeleton, dai::Skeleton& dstSkeleton)
{
for (int j=0; j<15; ++j)
{
// Load nite::SkeletonJoint
const nite::SkeletonJoint& niteJoint = srcSkeleton.getJoint((nite::JointType) j);
const nite::Point3f& nitePos = niteJoint.getPosition();
const nite::Quaternion& niteOrientation = niteJoint.getOrientation();
// Copy nite joint pos to my own Joint converting from nite milimeters to meters
SkeletonJoint joint(Point3f(nitePos.x, nitePos.y, nitePos.z), _staticMap[j]);
joint.setOrientation(Quaternion(niteOrientation.w, niteOrientation.x,
niteOrientation.y,
niteOrientation.z));
joint.setPositionConfidence(niteJoint.getPositionConfidence());
joint.setOrientationConfidence(niteJoint.getOrientationConfidence());
dstSkeleton.setJoint(_staticMap[j], joint);
}
dstSkeleton.setDistanceUnits(dai::DISTANCE_MILIMETERS);
}