Skip to content
Snippets Groups Projects
Commit 2a2d968b authored by TSC21's avatar TSC21 Committed by Nuno Marques
Browse files

modules: lpe: fix double correction on lidar

parent 335c319b
No related branches found
No related tags found
No related merge requests found
......@@ -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<float, n_y_lidar, n_x> C;
C.setZero();
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment