Skip to content

Commit

Permalink
replace structured binding with exclusive access
Browse files Browse the repository at this point in the history
  • Loading branch information
varunagrawal committed Dec 29, 2023
1 parent 9d70605 commit b15bcb1
Showing 1 changed file with 2 additions and 1 deletion.
3 changes: 2 additions & 1 deletion gtsam/navigation/NavState.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -106,7 +106,8 @@ bool NavState::equals(const NavState& other, double tol) const {
//------------------------------------------------------------------------------
NavState NavState::retract(const Vector9& xi, //
OptionalJacobian<9, 9> H1, OptionalJacobian<9, 9> H2) const {
auto [nRb, n_t, n_v] = (*this);
Rot3 nRb = R_;
Point3 n_t = t_, n_v = v_;
Matrix3 D_bRc_xi, D_R_nRb, D_t_nRb, D_v_nRb;
const Rot3 bRc = Rot3::Expmap(dR(xi), H2 ? &D_bRc_xi : 0);
const Rot3 nRc = nRb.compose(bRc, H1 ? &D_R_nRb : 0);
Expand Down

0 comments on commit b15bcb1

Please sign in to comment.