private void writeEntry()
{
List <List <BVHBone> > bonesListList = new List <List <BVHBone> >();
List <BVHBone> resultList;
while (bvhSkeleton.Bones.Count != 0)
{
if (bvhSkeletonWritten.Bones.Count == 0)
{
resultList = bvhSkeleton.Bones.FindAll(i => i.Root == true);
bonesListList.Add(resultList);
}
else
{
if (bvhSkeletonWritten.Bones.Last().End == false)
{
for (int k = 1; k <= bvhSkeletonWritten.Bones.Count; k++)
{
resultList = bvhSkeletonWritten.Bones[bvhSkeletonWritten.Bones.Count - k].Children;
if (resultList.Count != 0)
{
bonesListList.Add(resultList);
break;
}
}
}
}
BVHBone currentBone = bonesListList.Last().First();
string tabs = calcTabs(currentBone);
if (currentBone.Root == true)
{
file.WriteLine("ROOT " + currentBone.Name);
}
else if (currentBone.End == true)
{
file.WriteLine(tabs + "End Site");
}
else
{
file.WriteLine(tabs + "JOINT " + currentBone.Name);
}
file.WriteLine(tabs + "{");
file.WriteLine(tabs + "\tOFFSET " + currentBone.translOffset[0].ToString().Replace(",", ".") +
" " + currentBone.translOffset[1].ToString().Replace(",", ".") +
" " + currentBone.translOffset[2].ToString().Replace(",", "."));
if (currentBone.End == true)
{
while (bonesListList.Count != 0 && bonesListList.Last().Count == 1)
{
tabs = calcTabs(bonesListList.Last()[0]);
foreach (List <BVHBone> liste in bonesListList)
{
if (liste.Contains(bonesListList.Last()[0]))
{
liste.Remove(bonesListList.Last()[0]);
}
}
bonesListList.Remove(bonesListList.Last());
file.WriteLine(tabs + "}");
}
if (bonesListList.Count != 0)
{
if (bonesListList.Last().Count != 0)
{
bonesListList.Last().Remove(bonesListList.Last()[0]);
}
else
{
bonesListList.Remove(bonesListList.Last());
}
tabs = calcTabs(bonesListList.Last()[0]);
file.WriteLine(tabs + "}");
}
}
else
{
file.WriteLine(tabs + "\t" + writeChannels(currentBone));
}
bvhSkeleton.Bones.Remove(currentBone);
bvhSkeletonWritten.AddBone(currentBone);
}
bvhSkeletonWritten.copyParameters(bvhSkeleton);
}
public static void AddKinectSkeleton(BVHSkeleton Skeleton)
{
//Die Person steht falsch herum im Koordinatensystem der Kinect! Es wird erst beim Abspeichern korrigiert, weshalb die Verarbeitung noch mit umgekehrten Koordinaten erfolgt
// The person is in the wrong direction in the coordinate system of the Kinect! It will only be corrected when saving, so the processing is still with inverted coordinates
BVHBone spineBase = new BVHBone(null, JointType.SpineBase.ToString(), 6, TransAxis.None, true);
BVHBone spineBase2 = new BVHBone(spineBase, "SpineBase2", 3, TransAxis.Y, false);
BVHBone spineMid = new BVHBone(spineBase2, JointType.SpineMid.ToString(), 3, TransAxis.Y, true);
BVHBone spine_Shoulder = new BVHBone(spineMid, JointType.SpineShoulder.ToString(), 3, TransAxis.Y, true);
BVHBone collarLeft = new BVHBone(spine_Shoulder, "CollarLeft", 3, TransAxis.X, false);
BVHBone shoulderLeft = new BVHBone(collarLeft, JointType.ShoulderLeft.ToString(), 3, TransAxis.X, true);
BVHBone elbowLeft = new BVHBone(shoulderLeft, JointType.ElbowLeft.ToString(), 3, TransAxis.X, true);
BVHBone wristLeft = new BVHBone(elbowLeft, JointType.WristLeft.ToString(), 3, TransAxis.X, true);
BVHBone handLeft = new BVHBone(wristLeft, JointType.HandLeft.ToString(), 0, TransAxis.X, true);
BVHBone neck = new BVHBone(spine_Shoulder, "Neck", 3, TransAxis.Y, false);
BVHBone head = new BVHBone(neck, JointType.Head.ToString(), 3, TransAxis.Y, true);
BVHBone headtop = new BVHBone(head, "Headtop", 0, TransAxis.None, false);
BVHBone collarRight = new BVHBone(spine_Shoulder, "CollarRight", 3, TransAxis.nX, false);
BVHBone shoulderRight = new BVHBone(collarRight, JointType.ShoulderRight.ToString(), 3, TransAxis.nX, true);
BVHBone elbowRight = new BVHBone(shoulderRight, JointType.ElbowRight.ToString(), 3, TransAxis.nX, true);
BVHBone wristRight = new BVHBone(elbowRight, JointType.WristRight.ToString(), 3, TransAxis.nX, true);
BVHBone handRight = new BVHBone(wristRight, JointType.HandRight.ToString(), 0, TransAxis.nX, true);
BVHBone hipLeft = new BVHBone(spineBase, JointType.HipLeft.ToString(), 3, TransAxis.X, true);
BVHBone kneeLeft = new BVHBone(hipLeft, JointType.KneeLeft.ToString(), 3, TransAxis.nY, true);
BVHBone ankleLeft = new BVHBone(kneeLeft, JointType.AnkleLeft.ToString(), 3, TransAxis.nY, true);
BVHBone footLeft = new BVHBone(ankleLeft, JointType.FootLeft.ToString(), 0, TransAxis.Z, true);
BVHBone hipRight = new BVHBone(spineBase, JointType.HipRight.ToString(), 3, TransAxis.nX, true);
BVHBone kneeRight = new BVHBone(hipRight, JointType.KneeRight.ToString(), 3, TransAxis.nY, true);
BVHBone ankleRight = new BVHBone(kneeRight, JointType.AnkleRight.ToString(), 3, TransAxis.nY, true);
BVHBone footRight = new BVHBone(ankleRight, JointType.FootRight.ToString(), 0, TransAxis.Z, true);
Skeleton.AddBone(spineBase);
Skeleton.AddBone(spineBase2);
Skeleton.AddBone(spineMid);
Skeleton.AddBone(spine_Shoulder);
Skeleton.AddBone(collarLeft);
Skeleton.AddBone(shoulderLeft);
Skeleton.AddBone(elbowLeft);
Skeleton.AddBone(wristLeft);
Skeleton.AddBone(handLeft);
Skeleton.AddBone(neck);
Skeleton.AddBone(head);
Skeleton.AddBone(headtop);
Skeleton.AddBone(collarRight);
Skeleton.AddBone(shoulderRight);
Skeleton.AddBone(elbowRight);
Skeleton.AddBone(wristRight);
Skeleton.AddBone(handRight);
Skeleton.AddBone(hipLeft);
Skeleton.AddBone(kneeLeft);
Skeleton.AddBone(ankleLeft);
Skeleton.AddBone(footLeft);
Skeleton.AddBone(hipRight);
Skeleton.AddBone(kneeRight);
Skeleton.AddBone(ankleRight);
Skeleton.AddBone(footRight);
Skeleton.FinalizeBVHSkeleton();
}