From 968940902b61803d19c87eca517994937c81215f Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Joan=20Sol=C3=A0?= <jsola@iri.upc.edu>
Date: Fri, 12 Aug 2022 19:42:44 +0200
Subject: [PATCH] Use eigen to cv converter for intrinsic matrix
---
src/processor/processor_visual_odometry.cpp | 9 ++++-----
1 file changed, 4 insertions(+), 5 deletions(-)
diff --git a/src/processor/processor_visual_odometry.cpp b/src/processor/processor_visual_odometry.cpp
index 9664900f7..653b40dd9 100644
--- a/src/processor/processor_visual_odometry.cpp
+++ b/src/processor/processor_visual_odometry.cpp
@@ -24,6 +24,8 @@
//standard
#include "vision/processor/processor_visual_odometry.h"
+#include <opencv2/core/eigen.hpp>
+
#include <chrono>
#include <ctime>
@@ -52,12 +54,9 @@ void ProcessorVisualOdometry::configure(SensorBasePtr _sensor)
{
//Initialize camera sensor pointer
sen_cam_ = std::static_pointer_cast<SensorCamera>(_sensor);
- Eigen::Matrix3d K = sen_cam_->getIntrinsicMatrix();
- Kcv_ = (cv::Mat_<float>(3,3) << K(0,0), 0, K(0,2),
- 0, K(1,1), K(1,2),
- 0, 0, 1);
-
+ // CV type for intrinsic matrix
+ cv::eigen2cv(sen_cam_->getIntrinsicMatrix(), Kcv_);
// Tessalation of the image
cell_grid_ = ActiveSearchGrid(sen_cam_->getImgWidth(), sen_cam_->getImgHeight(),
--
GitLab