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 22, 2024
1 parent 45d45ba commit a665e51
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 a665e51

Please sign in to comment.