Fixed rodriguez
parent
30725a0647
commit
8f36e33566
|
@ -85,8 +85,7 @@ namespace gtsam {
|
||||||
|
|
||||||
/* ************************************************************************* */
|
/* ************************************************************************* */
|
||||||
Rot3 Rot3::rodriguez(const Vector3& w, double theta) {
|
Rot3 Rot3::rodriguez(const Vector3& w, double theta) {
|
||||||
// TODO return QuaternionChart::Expmap(theta,w);
|
return Quaternion(Eigen::AngleAxis<double>(theta, w));
|
||||||
return Rot3();
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/* ************************************************************************* */
|
/* ************************************************************************* */
|
||||||
|
|
Loading…
Reference in New Issue