同名标靶点自动匹配算法实现-三点匹配

1.两个标靶数据


2.匹配结果

3.代码

#include <iostream>
#include <vector>
#include <math.h>
using namespace std;
struct Point
{
    int id;
    float x,y,z;    
    Point(int _id,float _x,float _y,float _z):id(_id),x(_x),y(_y),z(_z){}
};
struct Triangle
{
    Point p1,p2,p3;
};
class PointCloud
{
public: 
    bool readFile(char *filename);
    //void PointMatch(const PointCloud& pc1,const PointClo