コード例 #1
0
        public static Vector3d CalculateCenterOfMass(
            Vector3d[] vertices,
            TriangleMesh[] triangleMeshes,
            double mass)
        {
            var inertiaTensor = new InertiaTensorEngine(
                vertices,
                triangleMeshes,
                mass,
                false);

            return(inertiaTensor.Execute().CenterOfMass);
        }
コード例 #2
0
        public static InertiaTensorOutput GetInertiaTensor(
            Vector3d[] vertexPosition,
            TriangleMesh[] triangleMeshes,
            Vector3d position,
            double mass)
        {
            var inertiaTensor = new InertiaTensorEngine(
                vertexPosition,
                triangleMeshes,
                mass,
                true);

            var inertiaTensorRes = inertiaTensor.Execute();

            Vector3d  r           = inertiaTensorRes.CenterOfMass - position;
            Matrix3x3 baseTensors = inertiaTensorRes.InertiaTensor +
                                    (Matrix3x3.IdentityMatrix() * r.Dot(r) - Matrix3x3.OuterProduct(r, r)) *
                                    mass;

            return(new InertiaTensorOutput(baseTensors, inertiaTensorRes.CenterOfMass, inertiaTensorRes.DensityMass));
        }