Skip to content
Snippets Groups Projects
Commit 0c26b6cb authored by Jonathan Youett's avatar Jonathan Youett
Browse files

Fix method 'difference'

When switching to the double covered quaternion pair, the
corresponding distance was not computed correctly
parent d1cbcb59
No related branches found
No related tags found
1 merge request!1Fix method 'difference'
Pipeline #
......@@ -605,7 +605,7 @@ public:
// Make sure we do the right thing if a and b are not in the same sheet
// of the double covering of the unit quaternions over SO(3)
if (dist>=M_PI) {
dist -= M_PI;
dist = 2*M_PI - dist;
diff *= -1;
}
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment