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