上传者: 38644168
|
上传时间: 2021-12-29 20:10:56
|
文件大小: 75KB
|
文件类型: -
按距离显示:第0个点越远越红
第0个点大致在脖子上?
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
using namespace pcl;
using namespace std;
float computeDist(const pcl::PointXYZ& p1, const pcl::PointXYZ& p2)
{
float dist = 0;
dist = sqrt((p1.x - p2.x)*(p1.x - p2.x)