SO3.cpp edited online with Bitbucket: KK not K*K
parent
b4edfc2576
commit
e3954d541a
|
@ -63,7 +63,7 @@ SO3 ExpmapFunctor::expmap() const {
|
|||
if (nearZero)
|
||||
return I_3x3 + W;
|
||||
else
|
||||
return I_3x3 + sin_theta * K + one_minus_cos * K * K;
|
||||
return I_3x3 + sin_theta * K + one_minus_cos * KK;
|
||||
}
|
||||
|
||||
DexpFunctor::DexpFunctor(const Vector3& omega)
|
||||
|
|
Loading…
Reference in New Issue