diff --git a/src/modules/local_position_estimator/sensors/lidar.cpp b/src/modules/local_position_estimator/sensors/lidar.cpp index fac18d33de..6b55c03140 100644 --- a/src/modules/local_position_estimator/sensors/lidar.cpp +++ b/src/modules/local_position_estimator/sensors/lidar.cpp @@ -65,11 +65,6 @@ void BlockLocalPositionEstimator::lidarCorrect() if (lidarMeasure(y) != OK) { return; } - // account for leaning - y(0) = y(0) * - cosf(_eul(0)) * - cosf(_eul(1)); - // measurement matrix Matrix C; C.setZero();