按距离显示:第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)
1