服务器之家

服务器之家 > 正文

c语言同名标靶点自动匹配算法实现实例代码

时间:2021-06-20 15:52     来源/作者:微book

1.两个标靶数据

c语言同名标靶点自动匹配算法实现实例代码

c语言同名标靶点自动匹配算法实现实例代码

2.匹配结果

c语言同名标靶点自动匹配算法实现实例代码

3.代码

?
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
#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 PointCloud &pc2); 
 vector<Point> pData;
 int r,g,b;
};
bool PointCloud::readFile(char *filename)
{
 if(filename==NULL)return false;
 FILE *fp=fopen(filename,"r");
 if (!fp)
 {
  printf("Load file %s failed\n", filename);
  return false;
 }
 char buffer[100];
 int count=0;
 while(!feof(fp))
 {
  fgets(buffer, 300, fp);
  float x,y,z;
  sscanf_s(buffer,"%f%f%f",&x,&y,&z);
  Point p(count++,x,y,z);
  pData.push_back(p);
 }
 pData.pop_back();
}
float calDis(const Point &p1,const Point &p2)
{
 return sqrt((p2.x-p1.x)*(p2.x-p1.x)+(p2.y-p1.y)*(p2.y-p1.y)+(p2.z-p1.z)*(p2.z-p1.z));
}
void PointMatch(const PointCloud& pc1,const PointCloud &pc2)
{
 for (int i=0;i<pc1.pData.size()-2;++i)
  for(int j=i+1;j<pc1.pData.size()-1;++j)
   for (int k=j+1;k<pc1.pData.size();++k)
   {
    Point p1=pc1.pData[i];
    Point p2=pc1.pData[j];
    Point p3=pc1.pData[k];
    float s12=calDis(p1,p2);
    float s13=calDis(p1,p3);
    float s23=calDis(p2,p3);
    for (int m=0;m<pc2.pData.size();++m)
     for (int n=0;n<pc2.pData.size();++n)
      for (int l=0;l<pc2.pData.size();++l)
      {
       if (n!=m&&m!=l&&n!=l)
       {     
        Point _p1=pc2.pData[m];
        Point _p2=pc2.pData[n];
        Point _p3=pc2.pData[l];
        float _s12=calDis(_p1,_p2);
        float _s13=calDis(_p1,_p3);
        float _s23=calDis(_p2,_p3);
        if (fabs(s12-_s12)<0.45&&fabs(s13-_s13)<0.45&&fabs(s23-_s23)<0.45)
        {
         cout<<"pc1....."<<p1.id<<"pc2......"<<_p1.id<<endl;
         cout<<"pc1....."<<p2.id<<"pc2......"<<_p2.id<<endl;
         cout<<"pc1....."<<p3.id<<"pc2......"<<_p3.id<<endl;
        }
       }
      }
 
   }
 
}
int main()
{
 char *file1="测试点云\\点云Mark0.txt";
 char *file2="测试点云\\点云Mark1.txt";
 PointCloud pc1,pc2;
 pc1.readFile(file1);
 pc2.readFile(file2);
 PointMatch(pc1,pc2);
}

总结

以上就是本文关于c语言同名标靶点自动匹配算法实现实例代码的全部内容,希望对大家有所帮助。感兴趣的朋友可以继续参阅本站其他相关专题,如有不足之处,欢迎留言指出。感谢朋友们对本站的支持!

原文链接:http://blog.csdn.net/yanglusheng/article/details/52692552

标签:

相关文章

热门资讯

2020微信伤感网名听哭了 让对方看到心疼的伤感网名大全
2020微信伤感网名听哭了 让对方看到心疼的伤感网名大全 2019-12-26
yue是什么意思 网络流行语yue了是什么梗
yue是什么意思 网络流行语yue了是什么梗 2020-10-11
背刺什么意思 网络词语背刺是什么梗
背刺什么意思 网络词语背刺是什么梗 2020-05-22
苹果12mini价格表官网报价 iPhone12mini全版本价格汇总
苹果12mini价格表官网报价 iPhone12mini全版本价格汇总 2020-11-13
2021德云社封箱演出完整版 2021年德云社封箱演出在线看
2021德云社封箱演出完整版 2021年德云社封箱演出在线看 2021-03-15
返回顶部