千万不要一边循环一边erase!!!
方法:
stl::remove_if配合vector.erase
auto end =std::remove_if(line_vector.begin(), line_vector.end(), [&](float p) { return IsLightPoint(p); });
line_vector.erase(end, line_vector.end());
bool IsLightPointCloud2D(float point_cloud)
{
if (distance > line_limit_distance)
{
...
return false;
}
else
{
...
return true;
}
}