We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
1 parent 3c7bb8d commit 4ce69b0Copy full SHA for 4ce69b0
src/adjustment.cpp
@@ -83,11 +83,10 @@ void AdjustmentFramework::update( const VectorXd &x)
83
// m.segment(idx3,3).normalize();
84
85
// (2) via retraction ......................................................
86
- const Vector3d l0 = l0_.segment(idx3,3);
87
- const Vector3d v = null( l0 ) * x.segment(2 * s, 2);
+ const Vector3d p = l0_.segment(idx3,3);
+ const Vector3d v = null(p) * x.segment(2 * s, 2);
88
const double nv = v.norm();
89
if ( nv > T_zero ) {
90
- const Vector3d p = l0_.segment(idx3, 3);
91
l0_.segment( idx3,3) = cos( nv)*p +sin(nv)*v/nv;
92
}
93
0 commit comments