This commit is contained in:
Aik-Siong Koh
2023-06-18 01:06:39 -06:00
parent 3b08cd72df
commit 371b13a9e0
147 changed files with 2555 additions and 238 deletions

View File

@@ -34,8 +34,8 @@ void MbD::AbsConstraint::useEquationNumbers()
void MbD::AbsConstraint::fillPosICJacob(SpMatDsptr mat)
{
(*(mat->at(iG)))[iqXminusOnePlusAxis] += 1.0;
(*(mat->at(iqXminusOnePlusAxis)))[iG] += 1.0;
mat->atijplusNumber(iG, iqXminusOnePlusAxis, 1.0);
mat->atijplusNumber(iqXminusOnePlusAxis, iG, 1.0);
}
void MbD::AbsConstraint::fillPosICError(FColDsptr col)
@@ -43,3 +43,8 @@ void MbD::AbsConstraint::fillPosICError(FColDsptr col)
Constraint::fillPosICError(col);
col->at(iqXminusOnePlusAxis) += lam;
}
void MbD::AbsConstraint::fillPosKineJacob(SpMatDsptr mat)
{
mat->atijplusNumber(iG, iqXminusOnePlusAxis, 1.0);
}