fix mistake in quat util

PickNikRobotics · Oct 2, 2024 · a98ef09 · a98ef09
1 parent 85d4cfa
commit a98ef09
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/fuse_core/include/fuse_core/util.hpp b/fuse_core/include/fuse_core/util.hpp
@@ -317,9 +317,9 @@ static inline void quaternionToAngleAxis(const double* q, double* angle_axis, do
     else
     {
       jacobian_map.setZero();
+      jacobian_map(0, 0) = 2.0;
       jacobian_map(1, 1) = 2.0;
       jacobian_map(2, 2) = 2.0;
-      jacobian_map(3, 3) = 2.0;
     }
   }
 }