Beispiel #1
0
        public override void ConstraintsLoadJacobians()
        {
            // compute jacobians
            // ChVector<> jacw = body.TransformDirectionParentToLocal(shaft_dir);
            ChVector jacw = shaft_dir;

            constraint.Get_Cq_a().ElementN(0) = -1;

            constraint.Get_Cq_b().ElementN(0) = 0;
            constraint.Get_Cq_b().ElementN(1) = 0;
            constraint.Get_Cq_b().ElementN(2) = 0;
            constraint.Get_Cq_b().ElementN(3) = jacw.x;
            constraint.Get_Cq_b().ElementN(4) = jacw.y;
            constraint.Get_Cq_b().ElementN(5) = jacw.z;
        }
Beispiel #2
0
 public override void ConstraintsLoadJacobians()
 {
     constraint.Get_Cq_a().SetElement(0, 0, 1);
     constraint.Get_Cq_b().SetElement(0, 0, -1);
 }