| 414 | } |
| 415 | |
| 416 | void projectPointCloud() |
| 417 | { |
| 418 | int cloudSize = laserCloudIn->points.size(); |
| 419 | // fullCloud->resize(cloudSize); |
| 420 | fullCloud->clear(); |
| 421 | for (int i = 0; i < cloudSize; ++i) |
| 422 | { |
| 423 | PointType thisPoint = laserCloudIn->points[i]; |
| 424 | |
| 425 | // 去除过近或过远的点 |
| 426 | float range = pointDistance(thisPoint); |
| 427 | // 1.0 200.0 |
| 428 | if (range < lidarMinRange_0 || range > lidarMaxRange_0) |
| 429 | continue; |
| 430 | |
| 431 | // 对点云中的每个点进行 畸变校正 |
| 432 | thisPoint = deskewPoint(&thisPoint, laserCloudIn->points[i].time); |
| 433 | |
| 434 | // fullCloud->points[i] = thisPoint; |
| 435 | fullCloud->push_back(thisPoint); |
| 436 | } |
| 437 | } |
| 438 | |
| 439 | void RGBpointAssociateToMap(PointType const *const pi, |
| 440 | pcl::PointXYZRGB *const po) { |
nothing calls this directly
no test coverage detected