public void Motion(Skeleton skel) { sw.Start(); //Recording the movements begins Console.WriteLine("----{0}----", bvhSkeletonWritten.Bones.Count); for (int k = 0; k < bvhSkeletonWritten.Bones.Count; k++) { if (bvhSkeletonWritten.Bones[k].End == false) { double[] degVec = new double[3]; degVec = KinectSkeletonBVH.getEulerFromBone(bvhSkeletonWritten.Bones[k], skel); int indexOffset = 0; if (bvhSkeletonWritten.Bones[k].Root == true) { indexOffset = 3; } tempMotionVektor[bvhSkeletonWritten.Bones[k].MotionSpace + indexOffset] = degVec[0]; tempMotionVektor[bvhSkeletonWritten.Bones[k].MotionSpace + 1 + indexOffset] = degVec[1]; tempMotionVektor[bvhSkeletonWritten.Bones[k].MotionSpace + 2 + indexOffset] = degVec[2]; } } //Root Bewegung tempMotionVektor[0] = -Math.Round(skel.Position.X * 100, 2); tempMotionVektor[1] = Math.Round(skel.Position.Y * 100, 2) + 120; tempMotionVektor[2] = 300 - Math.Round(skel.Position.Z * 100, 2); writeMotion(tempMotionVektor); file.Flush(); }
// 打开xxx.bvh 写“HIERARCHY” public writeBVH(string fileName) { fileName = fileName + ".bvh"; this.fileName = fileName; KinectSkeletonBVH.AddKinectSkeleton(bvhSkeleton); initializing = true; tempOffsetMatrix = new double[3, bvhSkeleton.Bones.Count]; tempMotionVektor = new double[bvhSkeleton.Channels]; if (File.Exists(fileName)) { File.Delete(fileName); } file = File.CreateText(fileName); file.WriteLine("HIERARCHY"); recording = true; }
public static double[] getBoneVectorOutofJointPosition(BVHBone bvhBone, Skeleton skel) { double[] boneVector = new double[3] { 0, 0, 0 }; double[] boneVectorParent = new double[3] { 0, 0, 0 }; string boneName = bvhBone.Name; JointType Joint; if (bvhBone.Root == true) { boneVector = new double[3] { 0, 0, 0 }; } else { if (bvhBone.IsKinectJoint == true) { Joint = KinectSkeletonBVH.String2JointType(boneName); boneVector[0] = skel.Joints[Joint].Position.X; boneVector[1] = skel.Joints[Joint].Position.Y; boneVector[2] = skel.Joints[Joint].Position.Z; try { Joint = KinectSkeletonBVH.String2JointType(bvhBone.Parent.Name); } catch { Joint = KinectSkeletonBVH.String2JointType(bvhBone.Parent.Parent.Name); } boneVector[0] -= skel.Joints[Joint].Position.X; boneVector[1] -= skel.Joints[Joint].Position.Y; boneVector[2] -= skel.Joints[Joint].Position.Z; } } return(boneVector); }
//eigentliche Schreibarbeit: 实际书写工作 public void Entry(Skeleton skel) { this.intializingCounter++; for (int k = 0; k < bvhSkeleton.Bones.Count; k++) { double[] bonevector = KinectSkeletonBVH.getBoneVectorOutofJointPosition(bvhSkeleton.Bones[k], skel); if (this.intializingCounter == 1) { tempOffsetMatrix[0, k] = Math.Round(bonevector[0] * 100, 2); tempOffsetMatrix[1, k] = Math.Round(bonevector[1] * 100, 2); tempOffsetMatrix[2, k] = Math.Round(bonevector[2] * 100, 2); } else { tempOffsetMatrix[0, k] = (this.intializingCounter * tempOffsetMatrix[0, k] + Math.Round(bonevector[0] * 100, 2)) / (this.intializingCounter + 1); tempOffsetMatrix[1, k] = (this.intializingCounter * tempOffsetMatrix[1, k] + Math.Round(bonevector[1] * 100, 2)) / (this.intializingCounter + 1); tempOffsetMatrix[2, k] = (this.intializingCounter * tempOffsetMatrix[1, k] + Math.Round(bonevector[2] * 100, 2)) / (this.intializingCounter + 1); } } }