Closed ZRS0326 closed 1 year ago
Actually this conditions produce some problems:
((msg->points[i].tag` & 0x30) != RETURN0AND1)
blind
parameter have different meanings what is confusing and lack standarization. I change the above condition to this one and it work better (faster and more points in my PCL)
double range = pl_orig.points[i].x * pl_orig.points[i].x + pl_orig.points[i].y * pl_orig.points[i].y + pl_orig.points[i].z * pl_orig.points[i].z;
if (range < blind) || (msg->points[i].line > N_SCANS) {
continue;
}
cam_d0: -0.0944205499243979 cam_d1: 0.0946727677776504 cam_d2: -0.00807970960613932 cam_d3: 8.07461209775283e-05