From 2285b14c5f61d7604fb8edb16b56373db4fb6b92 Mon Sep 17 00:00:00 2001 From: Alex Cunningham Date: Mon, 3 Sep 2012 00:39:02 +0000 Subject: [PATCH] Alternate matrix operation --- gtsam_unstable/slam/PoseRotationPrior.h | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/gtsam_unstable/slam/PoseRotationPrior.h b/gtsam_unstable/slam/PoseRotationPrior.h index 60a29b3e4..30d3828fd 100644 --- a/gtsam_unstable/slam/PoseRotationPrior.h +++ b/gtsam_unstable/slam/PoseRotationPrior.h @@ -67,9 +67,9 @@ public: if (H) { *H = gtsam::zeros(rDim, xDim); if (pose_traits::isRotFirst()) - (*H).leftCols(rDim) = eye(rDim); + (*H).leftCols(rDim).setIdentity(rDim, rDim); // = eye(rDim); // FIXME: avoiding use of assign with eye() else - (*H).rightCols(rDim) = eye(rDim); + (*H).rightCols(rDim).setIdentity(rDim, rDim); // = eye(rDim); } return Rotation::Logmap(newR) - Rotation::Logmap(measured_);