unit tests

gtsam/slam/tests/testSlamExpressions.cpp

@@ -45,6 +45,19 @@ TEST(SlamExpressions, project2) {
   EXPECT_CORRECT_EXPRESSION_JACOBIANS(point2_expr, values, 1e-7, 1e-5);
 }
 
+/* ************************************************************************* */
+TEST(SlamExpressions, rotation) {
+  Pose3_ T_(0);
+  const Rot3_ R_ = rotation(T_);
+}
+
+/* ************************************************************************* */
+TEST(SlamExpressions, unrotate) {
+  Rot3_ R_(0);
+  Point3_ p_(1);
+  const Point3_ q_ = unrotate(R_, p_);
+}
+
 /* ************************************************************************* */
 int main() {
   TestResult tr;