12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

fix compiler error on Mac OS 10.9/clang 5.

release/4.3a0
cbeall3 2014-01-22 12:17:31 -05:00
parent 8aa5bf42da
commit d954cab884
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
gtsam/geometry/Sphere2.cpp
View File

@ -112,7 +112,7 @@ Sphere2 Sphere2::retract(const Vector& v, Sphere2::CoordinatesMode mode) const {
double xi_hat_norm = xi_hat.norm(); double xi_hat_norm = xi_hat.norm();
// Avoid nan // Avoid nan
if ((xi_hat_norm == 0.0)) { if (xi_hat_norm == 0.0) {
if (v.norm () == 0.0) if (v.norm () == 0.0)
return Sphere2 (point3 ()); return Sphere2 (point3 ());
else else
@ -147,7 +147,7 @@ Sphere2 Sphere2::retract(const Vector& v, Sphere2::CoordinatesMode mode) const {
// the below will be nan if theta == 0.0 // the below will be nan if theta == 0.0
if (p == q) if (p == q)
return (Vector (2) << 0, 0); return (Vector (2) << 0, 0);
else if (p == -q) else if (p == (Vector)-q)
return (Vector (2) << M_PI, 0); return (Vector (2) << M_PI, 0);
Vector result_hat = (theta / sin(theta)) * (q - p * cos(theta)); Vector result_hat = (theta / sin(theta)) * (q - p * cos(theta));