c语言同名标靶点自动匹配算法实现实例代码
更新时间:2020年4月25日 17:28 点击:1327
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 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语言同名标靶点自动匹配算法实现实例代码的全部内容,希望对大家有所帮助。感兴趣的朋友可以继续参阅本站其他相关专题,如有不足之处,欢迎留言指出。感谢朋友们对本站的支持!
上一篇: C语言实现三子棋游戏
下一篇: C语言实现三子棋小游戏
相关文章
- 这篇文章主要为大家详细介绍了C语言实现放烟花的程序,有音乐播放,文中示例代码介绍的非常详细,具有一定的参考价值,感兴趣的小伙伴们可以参考一下...2021-02-23
- 本篇文章主要介绍C语言中char的知识,并附有代码实例,以便大家在学习的时候更好的理解,有需要的可以看一下...2020-04-25
- 作者:Sabine 【导读】本文介绍了C#的四种排序算法:冒泡排序、选择排序、插入排序和希尔排序 冒泡排序 using System; namespace BubbleSorter { public class Bubb...2020-06-25
- 这篇文章主要用实例讲解C#递归算法的概念以及用法,文中代码非常详细,帮助大家更好的参考和学习,感兴趣的朋友可以了解下...2020-06-25
- 这篇文章主要介绍了详解如何将c语言文件打包成exe可执行程序,文中通过示例代码介绍的非常详细,对大家的学习或者工作具有一定的参考学习价值,需要的朋友们下面随着小编来一起学习学习吧...2021-02-25
- free函数是释放之前某一次malloc函数申请的空间,而且只是释放空间,并不改变指针的值。下面我们就来详细探讨下...2020-04-25
- 这篇文章主要介绍了C语言中计算正弦的相关函数总结,包括正弦和双曲线正弦以及反正弦的函数,需要的朋友可以参考下...2020-04-25
详解C语言中的rename()函数和remove()函数的使用方法
这篇文章主要介绍了详解C语言中的rename()函数和remove()函数的使用方法,是C语言入门学习中的基础知识,需要的朋友可以参考下...2020-04-25- 这篇文章主要介绍了C语言中求和、计算平均值、方差和标准差的实例,具有很好的参考价值,希望对大家有所帮助。一起跟随小编过来看看吧...2020-12-10
- 本篇文章主要讲解C语言 基本语法,这里提供简单的示例和代码来详细讲解C语言的基本语法,开始学习C语言的朋友可以看一下,希望能够给你带来帮助...2021-09-18
- 这篇文章主要是介绍了.net C# 实现任意List的全组合算法实现代码,需要的朋友可以参考下...2020-06-25
同时兼容JS和C#的RSA加密解密算法详解(对web提交的数据加密传输)
这篇文章主要给大家介绍了关于同时兼容JS和C#的RSA加密解密算法,通过该算法可以对web提交的数据进行加密传输,文中通过图文及示例代码介绍的非常详细,需要的朋友们可以参考借鉴,下面来一起看看吧。...2020-06-25图文详解Heap Sort堆排序算法及JavaScript的代码实现
这篇文章以图文详解Heap Sort堆排序算法及JavaScript的代码实现,堆排序算法基于类二叉树的堆数据结构,需要的朋友可以参考下...2016-05-05- 这篇文章主要介绍了C语言中send()函数和sendto()函数的使用方法,是C语言入门学习中的基础知识,需要的朋友可以参考下...2020-04-25
- 今天小编就为大家分享一篇C语言实现从文件读入一个3*3数组,并计算每行的平均值,具有很好的参考价值,希望对大家有所帮助。一起跟随小编过来看看吧...2020-04-25
- 这篇文章主要介绍了使用C语言操作文件的基本函数整理,包括创建和打开以及关闭文件的操作方法,需要的朋友可以参考下...2020-04-25
- 这篇文章主要介绍了C语言中memcpy 函数的用法详解的相关资料,需要的朋友可以参考下...2020-04-25
- 这篇文章主要介绍了C#常用数据结构和算法,这里我们总结了一些知识点,可以帮助大家理解这些概念。...2020-06-25
- 这篇文章主要介绍了C语言中查找字符在字符串中出现的位置的方法,分别是strchr()函数和strrchr()函数的使用,需要的朋友可以参考下...2020-04-25
- 很多同学在学习c语言的时候是不是会碰到a++和++a都有甚么作用啊。今天我们就来探讨下...2020-04-25