diff --git a/include/vision/math/pinhole_tools.h b/include/vision/math/pinhole_tools.h index 4d55810f014168f07ce1459c09b373324c5bd462..2f3912e6546ccd1b74ba6137100e31e337b099a6 100644 --- a/include/vision/math/pinhole_tools.h +++ b/include/vision/math/pinhole_tools.h @@ -429,12 +429,13 @@ Matrix<typename Derived2::Scalar, 2, 1> pixellizePoint(const MatrixBase<Derived1 MatrixSizeCheck<4,1>::check(k); MatrixSizeCheck<2,1>::check(ud); + typedef typename Derived1::Scalar S; typedef typename Derived2::Scalar T; - T u_0 = k(0); - T v_0 = k(1); - T a_u = k(2); - T a_v = k(3); + const S& u_0 = k(0); + const S& v_0 = k(1); + const S& a_u = k(2); + const S& a_v = k(3); Matrix<T, 2, 1> u; u(0) = u_0 + a_u * ud(0);