From 3f8f464ad3ae8f863233fbd13c7fab3ddbb349e9 Mon Sep 17 00:00:00 2001
From: Idril Geer <igeer@iri.upc.edu>
Date: Mon, 22 Feb 2021 15:24:35 +0100
Subject: [PATCH] added assert

---
 src/sensor/sensor_odom_2d.cpp | 1 +
 1 file changed, 1 insertion(+)

diff --git a/src/sensor/sensor_odom_2d.cpp b/src/sensor/sensor_odom_2d.cpp
index c853426d8..574e4277e 100644
--- a/src/sensor/sensor_odom_2d.cpp
+++ b/src/sensor/sensor_odom_2d.cpp
@@ -36,6 +36,7 @@ double SensorOdom2d::getRotVarToRotNoiseFactor() const
 
 Eigen::Matrix2d SensorOdom2d::computeCovFromMotion (const VectorXd& _data) const
 {
+    assert(_data.size() == 2);
     double d = fabs(_data(0));
     double r = fabs(_data(1));
 
-- 
GitLab