c語言同名標(biāo)靶點自動匹配算法實現(xiàn)實例代碼
更新時間：2018年02月03日 08:45:07 作者：微book
這篇文章主要介紹了c語言同名標(biāo)靶點自動匹配算法實現(xiàn)實例代碼，分享了相關(guān)代碼示例，小編覺得還是挺不錯的，具有一定借鑒價值，需要的朋友可以參考下
1.兩個標(biāo)靶數(shù)據(jù)
2.匹配結(jié)果
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);
}
總結(jié)
以上就是本文關(guān)于c語言同名標(biāo)靶點自動匹配算法實現(xiàn)實例代碼的全部內(nèi)容，希望對大家有所幫助。感興趣的朋友可以繼續(xù)參閱本站其他相關(guān)專題，如有不足之處，歡迎留言指出。感謝朋友們對本站的支持！
相關(guān)文章
這篇文章主要為大家詳細(xì)介紹了C++容器vector實現(xiàn)通訊錄功能，文中示例代碼介紹的非常詳細(xì)，具有一定的參考價值，感興趣的小伙伴們可以參考一下2019-12-12
數(shù)組的排序方法有很多,效率也各不相同,下面這篇文章主要給大家介紹了關(guān)于C語言中數(shù)組常用的一些排序算法的相關(guān)資料,文中通過代碼介紹的非常詳細(xì),需要的朋友可以參考下2024-01-01
C++?Boost?CircularBuffer算法超詳細(xì)精講
Boost是為C++語言標(biāo)準(zhǔn)庫提供擴(kuò)展的一些C++程序庫的總稱。Boost庫是一個可移植、提供源代碼的C++庫，作為標(biāo)準(zhǔn)庫的后備，是C++標(biāo)準(zhǔn)化進(jìn)程的開發(fā)引擎之一，是為C++語言標(biāo)準(zhǔn)庫提供擴(kuò)展的一些C++程序庫的總稱2022-11-11
C/C++中g(shù)etline函數(shù)案例總結(jié)
這篇文章主要介紹了C/C++中g(shù)etline函數(shù)案例總結(jié),本篇文章通過簡要的案例,講解了該項技術(shù)的了解與使用,以下就是詳細(xì)內(nèi)容,需要的朋友可以參考下2021-09-09
C++ 簡單實現(xiàn)MFC ListControl 點擊列頭排序
這篇文章主要介紹了C++ 簡單實現(xiàn)MFC ListControl 點擊列頭排序的相關(guān)資料,需要的朋友可以參考下2015-06-06
C++中的mutable關(guān)鍵字用于修飾類的成員變量,使其在const成員函數(shù)中可以被修改,它主要用于緩存、線程同步和調(diào)試等場景,以支持對象的邏輯常量性,在使用mutable時,應(yīng)確保其修改不會破壞對象的外部表現(xiàn)狀態(tài),本文介紹C++中使用mutable關(guān)鍵字的場景分析,感興趣的朋友一起看看吧2025-02-02
本篇文章是對C++中數(shù)組名與指針用法的比較進(jìn)行了詳細(xì)的分析介紹，需要的朋友參考下2013-05-05
這篇文章主要詳細(xì)介紹了C語言的操作符，文中通過示例代碼介紹的非常詳細(xì)，對大家的學(xué)習(xí)或者工作具有一定的參考學(xué)習(xí)價值，需要的朋友們下面隨著小編來一起學(xué)習(xí)學(xué)習(xí)吧2023-05-05
大家都知道取整這回事,但是對于取整只有單一的認(rèn)識,下面這篇文章主要給大家介紹了關(guān)于C語言取整以及4種函數(shù)的相關(guān)資料,文中通過實例代碼介紹的非常詳細(xì),需要的朋友可以參考下2022-08-08
這篇文章主要介紹了詳解C++編程中的雙目運算符重載,是C++入門學(xué)習(xí)中的基礎(chǔ)知識,需要的朋友可以參考下，希望能夠給你帶來幫助2021-09-09