private void LoadInertiaData_SingleBone(string filename, int boneIndex)
{
if (!File.Exists(filename))
{
return;
}
TransformRT[] acs = DatParser.parseACSFileToRT(filename);
_bones[boneIndex].InertiaMatrix = new TransformMatrix(acs[0]);
}
public static void test()
{
TransformRT[] inertiaRTs = DatParser.parseInertiaFileToRT(@"P:\Data\Functional_Wrist\E01424\S15R\inertia15R.dat");
TransformRT[] ACS_RT = DatParser.parseACSFileToRT(@"P:\Data\Functional_Wrist\E01424\S15R\AnatCoordSys.dat");
TransformRT[] motion = DatParser.parseMotionFileToRT(@"P:\Data\Functional_Wrist\E01424\S02R\Motion15R02R.dat");
TransformMatrix inertia = new TransformMatrix(inertiaRTs[8]);
TransformMatrix ACS = new TransformMatrix(ACS_RT[0]);
Posture p = CalculatePosture(ACS, inertia);
Posture p2 = CalculatePosture(ACS, inertia, new TransformMatrix(motion[0]), new TransformMatrix(motion[8]));
}