[几何算法] 三维点云的排序

r囧r小猫 2022-09-04 08:59 216阅读 0赞

> 主题：对三维点云的排序  
> 排序规则：优先级，X轴 > Y轴 > Z轴

#### 结果 ####

![在这里插入图片描述][a33c2fe1fe9c47bb8ec80d406b65000d.png]

#### 代码 ####

#include<iostream>
    #include<algorithm>
    
    using namespace std;
    
    struct Point
    { 
    	double x, y, z;
    
    	Point() = default;
    	Point(double a, double b, double c): x(a), y(b), z(c) { }
    
    	friend ostream & operator<<(ostream & os, const Point & pnt);
    
    	//提供默认的构造函数，如果使用std::sort(Point, Point +8)进行排序，sort内部会调用此方法
    	//但不建议使用这种方法，在工程应用中，Point往往是别人定义好的数据结构，我们不能为类再拓展方法
    	inline bool operator<(const Point& rhs)
    	{ 
    		//排序方式，优先级：x轴优先级 > y轴 > z轴
    		if (this->x < rhs.x) return true;
    		else if (this->x > rhs.x) return false;
    		else if (this->y < rhs.y) return true;
    		else if (this->y > rhs.y) return false;
    		else if (this->z < rhs.z) return true;
    		else return false;
    	}
    };
    
    ostream& operator<<(ostream & os, const Point& pnt)
    { 
    	os << pnt.x << '\t' << pnt.y << '\t' << pnt.z;
    	return os;
    }
    
    int main()
    { 
    	//随机生成点云
    	Point pointsCloud[100];
    
    	for(int i = 0; i < 100; i++)
    	{ 
    		pointsCloud[i].x = 1.024*(rand() % 60);
    		pointsCloud[i].y = 1.024*(rand() % 60);
    		pointsCloud[i].z = 100 + 1.024*(rand() % 60);
    	}
    
    	//升序排序
    	std::sort(
    		pointsCloud,
    		pointsCloud+100,
    		[](const Point& lhs, const Point& rhs)->bool //如果第一个参数 < 第二个参数，则返回真
    	{ 
    		//需要满足严格弱序的条件，何谓严格弱序？根据标准库手册的描述，comp需要满足如下属性：
    		// - 对于任一变量a，comp(a, a)为false
    		// - 如果comp(a, b) 为true，那么comp(b, a)为false
    		// - 如果comp(a, b)为true且comp(b, c)true，则comp(a, c)为true
    
    		//排序方式，优先级：x轴优先级 > y轴 > z轴
    		if (lhs.x < rhs.x) return true;
    		else if (lhs.x > rhs.x) return false;
    		else if (lhs.y < rhs.y) return true;
    		else if (lhs.y > rhs.y) return false;
    		else if (lhs.z < rhs.z) return true;
    		else return false;
    	});
    
    	std::for_each(
    		pointsCloud,
    		pointsCloud + sizeof(pointsCloud) / sizeof(Point),
    		[](const Point& item)
    	{ 
    		cout << item << endl;
    	});
    
    	return 0;
    }

[a33c2fe1fe9c47bb8ec80d406b65000d.png]: /images/20220829/ade15d9aa062479581608b96bd202ffa.png