Skip to content

Commit

Permalink
tweaks
Browse files Browse the repository at this point in the history
  • Loading branch information
JulioJerez committed Sep 13, 2024
1 parent 29d85d6 commit 97dee6a
Showing 1 changed file with 6 additions and 6 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -510,13 +510,13 @@ namespace ndAdvancedRobot
return ND_DEAD_PENALTY;
}

const ndMatrix globalBaseMatrix(m_base_rotator->CalculateGlobalMatrix1());
const ndMatrix globalEffectorMatrix(m_effectorMatrixOffset * m_arm_4->CalculateGlobalMatrix0());
const ndMatrix globalTargetMatrix(CalculateTargetMatrix() * globalBaseMatrix);
//const ndMatrix globalBaseMatrix(m_base_rotator->CalculateGlobalMatrix1());
//const ndMatrix globalEffectorMatrix(m_effectorMatrixOffset * m_arm_4->CalculateGlobalMatrix0());
//const ndMatrix globalTargetMatrix(CalculateTargetMatrix() * globalBaseMatrix);
//const ndMatrix effectorMatrix(m_effectorMatrixOffset * m_arm_4->CalculateGlobalMatrix0() * globalBaseMatrix.OrthoInverse());

//const ndMatrix invBaseMatrix(m_base_rotator->CalculateGlobalMatrix1().OrthoInverse());
//const ndMatrix effectorMatrix(m_effectorMatrixOffset * m_arm_4->CalculateGlobalMatrix0() * invBaseMatrix);
const ndMatrix effectorMatrix(m_effectorMatrixOffset * m_arm_4->CalculateGlobalMatrix0() * globalBaseMatrix.OrthoInverse());
const ndMatrix invBaseMatrix(m_base_rotator->CalculateGlobalMatrix1().OrthoInverse());
const ndMatrix effectorMatrix(m_effectorMatrixOffset * m_arm_4->CalculateGlobalMatrix0() * invBaseMatrix);

ndFloat32 azimuth = 0.0f;
const ndVector& posit = effectorMatrix.m_posit;
Expand Down

0 comments on commit 97dee6a

Please sign in to comment.