Skip to content

Commit

Permalink
Add reference to documentation
Browse files Browse the repository at this point in the history
  • Loading branch information
isorrentino committed Jan 24, 2024
1 parent f23e38b commit 0a44679
Showing 1 changed file with 2 additions and 0 deletions.
2 changes: 2 additions & 0 deletions src/Estimators/src/UkfModel.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -151,6 +151,8 @@ bool UkfModel::updateState()
m_kinDynWrapperList[subModelIdx]->getFrameVel(
value.frame));

// See reference: https://traversaro.github.io/traversaro-phd-thesis/traversaro-phd-thesis.pdf
// Paragraph 4.4.2
m_baseAcceleration.coeffs().head(3).noalias()
= baseHimu.rotation() * m_accMap[key]
- m_bOmegaIB.cross(m_bOmegaIB.cross(baseHimu.translation()));
Expand Down

0 comments on commit 0a44679

Please sign in to comment.