diff --git a/wave_optimization/include/wave/optimization/factor_graph/FactorMeasurement.hpp b/wave_optimization/include/wave/optimization/factor_graph/FactorMeasurement.hpp index ea9294c7..7aa7615f 100644 --- a/wave_optimization/include/wave/optimization/factor_graph/FactorMeasurement.hpp +++ b/wave_optimization/include/wave/optimization/factor_graph/FactorMeasurement.hpp @@ -8,6 +8,7 @@ #include "wave/optimization/factor_graph/FactorVariable.hpp" #include "wave/optimization/factor_graph/Noise.hpp" +#include "wave/optimization/factor_graph/OutputMap.hpp" namespace wave { /** @addtogroup optimization @@ -77,9 +78,10 @@ class FactorMeasurement : public FactorVariable { template inline Eigen::Matrix::Size, 1> operator-( - const Eigen::Ref::Size, 1>> - &lhs, + const ResultOut::Size> &lhs, const FactorMeasurement &rhs) { + // We need to accept the specific ResultOut type (instead of a generic Eigen + // map) as for some reason they are not converted with Eigen 3.2. See #151 return lhs - Eigen::Map< const Eigen::Matrix::Size, 1>>{