diff --git a/src/estimator.cpp b/src/estimator.cpp index 2f5953d..426f332 100644 --- a/src/estimator.cpp +++ b/src/estimator.cpp @@ -49,11 +49,6 @@ class Callback { float x, y, z, th, h, c; x = y = z = th = h = c = 0.; - // we want to consider the whole PointCloud - std::vector indices; - for (int i = 0; i < msg->points.size(); ++i) - indices.push_back(i); - // v = eg_1 ^ eg_2 is the plan normal Eigen::Vector3f v = eg.col(0).cross(eg.col(1)); v.normalize(); // to have norm(v) == 1