add DistanceConstraintIJ and AngleConstraintIJ

2023-07-08 23:20:27 -06:00
parent cb27f2344b
commit 718b17a2cf
134 changed files with 4218 additions and 556 deletions
--- a/MbDCode/DirectionCosineConstraintIqcJc.cpp
+++ b/MbDCode/DirectionCosineConstraintIqcJc.cpp
@@ -62,10 +62,6 @@ void DirectionCosineConstraintIqcJc::fillAccICIterError(FColDsptr col)
 	col->atiplusNumber(iG, sum);
 }

-void DirectionCosineConstraintIqcJc::addToJointForceI(FColDsptr col)
-{
-}
-
 void DirectionCosineConstraintIqcJc::addToJointTorqueI(FColDsptr jointTorque)
 {
 	auto aBOIp = frmI->aBOp();