public DeformableBody3d(TetrahedronSource source, double radius, double mass, double stiffness, Matrix4x4d RTS) : base(source.NumParticles, radius, mass) { Stiffness = stiffness; CreateParticles(source, RTS); CreateConstraints(); }
private void CreateParticles(TetrahedronSource source, Matrix4x4d RTS) { for (int i = 0; i < NumParticles; i++) { Vector4d pos = RTS * source.Positions[i].xyz1; Positions[i] = new Vector3d(pos.x, pos.y, pos.z); Predicted[i] = Positions[i]; } int numIndices = source.NumIndices; Indices = new int[numIndices]; for (int i = 0; i < numIndices; i++) { Indices[i] = source.Indices[i]; } }