Skip to content

Commit

Permalink
[bugfix] Casting 1e-2 in SO log function
Browse files Browse the repository at this point in the history
  • Loading branch information
cmastalli committed Aug 31, 2023
1 parent b909729 commit 3f4e64c
Showing 1 changed file with 1 addition and 1 deletion.
2 changes: 1 addition & 1 deletion src/multibody/liegroup/special-orthogonal.hpp
Original file line number Diff line number Diff line change
Expand Up @@ -71,7 +71,7 @@ namespace pinocchio
if_then_else(internal::LT, tr, Scalar(-2),
if_then_else(internal::GE, R (1, 0), Scalar(0),
PI_value, -PI_value), // then
if_then_else(internal::GT, tr, Scalar(2) - 1e-2,
if_then_else(internal::GT, tr, Scalar(2) - Scalar(1e-2),
asin((R(1,0) - R(0,1)) / Scalar(2)), // then
if_then_else(internal::GE, R (1, 0), Scalar(0),
acos(tr/Scalar(2)), // then
Expand Down

0 comments on commit 3f4e64c

Please sign in to comment.