[Minor] Fix compatibility with Eigen 3.2.0

humanoid-path-planner · Oct 25, 2018 · f99ef04 · f99ef04
1 parent b33a69a
commit f99ef04
Show file tree

Hide file tree

Showing 2 changed files with 4 additions and 3 deletions.
diff --git a/include/hpp/constraints/configuration-constraint.hh b/include/hpp/constraints/configuration-constraint.hh
@@ -72,6 +72,7 @@ namespace hpp {
         vector_t weights_;
         EigenBoolVector_t mask_;
         mutable vector_t diff_;
+        mutable Eigen::Matrix<value_type, 1, Eigen::Dynamic> J_;
     }; // class ComBetweenFeet
   } // namespace constraints
 } // namespace hpp

diff --git a/src/configuration-constraint.cc b/src/configuration-constraint.cc
@@ -80,13 +80,13 @@ namespace hpp {
       matrix_t unused;
 
       LiegroupConstElementRef a (argument, goal_.space());
-      diff_ = goal_ - a;
+      J_ = (goal_ - a).transpose();
 
       // Apply jacobian of the difference on the right.
-      goal_.space()->Jdifference<false> (argument, goal_.vector(), diff_.transpose(), unused);
+      goal_.space()->Jdifference<false> (argument, goal_.vector(), J_, unused);
 
       jacobian.leftCols (robot_->numberDof ()).noalias() =
-        weights_.cwiseProduct(diff_).transpose ();
+        J_.cwiseProduct(weights_.transpose());
     }
   } // namespace constraints
 } // namespace hpp