diff --git a/gtsam/geometry/PinholePose.h b/gtsam/geometry/PinholePose.h index 019cc2609..b5daaebc5 100644 --- a/gtsam/geometry/PinholePose.h +++ b/gtsam/geometry/PinholePose.h @@ -136,6 +136,7 @@ public: Matrix3 Dpc_rot, Dpc_point; const Point3 pc = this->pose().rotation().unrotate(pw, Dpc_rot, Dpc_point); + // only rotation is important Matrix36 Dpc_pose; Dpc_pose.setZero(); Dpc_pose.leftCols<3>() = Dpc_rot;