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

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

(0)

相关推荐

  • C语言基本排序算法之桶式排序实例

    本文实例讲述了C语言基本排序算法之桶式排序.分享给大家供大家参考,具体如下: 桶式排序是对一个有n个整型元素的数组a[n],其中对任意i,0 <= a[i] <= m的特殊排序算法. 可以对 n==m, n != m分别处理.写代码时需要注意的的是a[i]是访问第i-1个元素,而非第i个. /************************************************************************************/ /* Bucket_Sort.h

  • C语言实现运筹学中的马氏决策算法实例

    本文实例讲述了C语言实现运筹学中的马氏决策算法.分享给大家供大家参考,具体如下: 一.概述 马氏决策(Markov decision)是马尔可夫决策过程(Markov Decision Processes,简记为MDP)的简称,是研究随机序贯决策问题的一门重要理论.马氏决策是一类可连续进行观察的随机动态系统的最优化决策,它将(确定性)动态规划与马尔可夫过程相结合,是随机离散事件动态系统惟一的动态控制方法. 关于马氏决策的具体说明可参考百度百科:https://baike.baidu.com/it

  • C语言基本排序算法之shell排序实例

    本文实例讲述了C语言基本排序算法之shell排序.分享给大家供大家参考,具体如下: shell排序是对直接插入方法的改进方法. /*------------------------------------------------------------------------------------- Shell_sort.h shell排序是对直接插入方法的改进,它并不是对相邻元素进行比较,而是对一定间隔的元素比较. 选择增量序列的几种方法:(为方便,本例采用第一种增量序列) 1. h[1]=

  • C语言基本排序算法之插入排序与直接选择排序实现方法

    本文实例讲述了C语言基本排序算法之插入排序与直接选择排序实现方法.分享给大家供大家参考,具体如下: 声明待排序元素类型 /*-------------------------- typedef.h 方便修改待排序元素类型 -------------------------------------*/ #ifndef TYPEDEF_H #define TYPEDEF_H typedef int T; #endif 插入排序: /*---------------------------------

  • C语言实现文件内容按行随机排列的算法示例

    本文实例讲述了C语言实现文件内容按行随机排列的算法.分享给大家供大家参考,具体如下: 在实际工作上有种需求, 就是需要从给定的数据里,随机抽取一部分. 有一种简单的方法是根据总的数据条数和要抽取的数据条数, 通过简单方法,隔几行取一个,这样也能达到随机抽取一部分的目的. 但这样,源数据是顺序的,则抽取的数据也是顺序的,不满足一些情境. 这里实现的功能是: 将全部数据,按行重新随机排列, 这样从结果头部选几行,就是随机抽取的几行了,比较方便. 实现的思路:  对于N行的数据, 给每一行用[1-N]

  • C语言排序算法之冒泡排序实现方法【改进版】

    本文实例讲述了C语言排序算法之冒泡排序实现方法.分享给大家供大家参考,具体如下: 冒泡排序和改进的冒泡排序 /*------------------------------------------------------------------------------------------- Bubble_sort.h 冒泡排序: 时间复杂度为O(N^2) 改进的冒泡排序: 时间复杂度仍为O(N^2) 一般的冒泡排序方法有可能会在已经排好序的情况下继续比较,改进的冒泡排序 设置了一个哨兵fla

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

    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,

  • C# 模拟浏览器并自动操作的实例代码

    本文主要讲解通过WebBrowser控件打开浏览页面,并操作页面元素实现自动搜索功能,仅供学习分享使用,如有不足之处,还请指正. 涉及知识点 WebBrowser:用于在WinForm窗体中,模拟浏览器,打开并导航网页. HtmlDocument:表示一个Html文档的页面.每次加载都会是一个全新的页面. GetElementById(string id):通过ID或Name获取一个Html中的元素. HtmlElement:表示一个Html标签元素. BackgroundWorker 后台执行

  • Automapper实现自动映射的实例代码

    出于安全考虑,在后台与前台进行数据传输时,往往不会直接传输实体模型,而是使用Dto(Data transfer object 数据传输对象),这样在后台往前台传递数据时可以省略不必要的信息,只保留必要的信息,大大增强数据安全性. 下面给出两个相互对应的关系模型User.UserDto public class User { private const int NameMaxLength = 20; private const int PassWordMaxLength = 16; [Key] p

  • iOS UIScrollView滚动视图/无限循环滚动/自动滚动的实例代码

    我们都知道UIScrollView有一种很流畅的切换效果,结合UIPageControl的辅助展示效果,就可以完成一个很不错的产品介绍功能页面.下面给大家分享iOS UIScrollView滚动视图/无限循环滚动/自动滚动功能,具体代码如下所示: <UIScrollViewDelegate> #define WIDTH [[UIScreen mainScreen] bounds].size.width #define HEIGHT [[UIScreen mainScreen] bounds].

  • Mybatis结果集自动映射的实例代码

    在使用Mybatis时,有的时候我们可以不用定义resultMap,而是直接在<select>语句上指定resultType.这个时候其实就用到了Mybatis的结果集自动映射.Mybatis的自动映射默认是开启的,有需要我们也可以将其关闭(还可以调整自动映射的策略). 1       Mybatis结果集自动映射 在使用Mybatis时,有的时候我们可以不用定义resultMap,而是直接在<select>语句上指定resultType.这个时候其实就用到了Mybatis的结果集

  • c语言5个常用的排序算法实例代码

    1.插入排序 基本思想:插入排序就是每一步都将一个待排数据按其大小插入到已经排序的数据中的适当位置,直到全部插入完毕. void insertSort(vector<int>& nums) { int k = 0; for (int i = 0; i < nums.size(); ++i) { int temp = nums[i]; int j = i; for (; j > 0 && temp < nums[j-1]; --j) nums[j] =

  • 枚举java语言中的修饰符组合的实例代码

    枚举java语言中的修饰符组合,代码如下所示: package model; /*22:37 2019/7/20*/ /* top class的修饰符组合 abstract final public * 2 * 2 warning: abstract final 冲突 最终,共有2*(2*2-1)=6种修饰符组合用于top class */ /* public abstract class PublicAbstractClass{} public final class PublicFinalC

  • 易语言实现YY批量自动加好友的代码

    在做yy爬虫的时候,发现yy这个地方没有使用webkit,还在使用ie内核,这样的话我们就可以对它内嵌的浏览器做些什么了. 信息挺好爬的,顺便分析了一下点加好友,加群和关注这几个按钮,发现到最后都是直接与客户端的setCommand方法通信的,我没有办法直接调用它客户端的函数. 使用jquery触发click是一个比较另类的方法,以前觉得别人搞得还挺神奇的,就是没往这方面想. 哦对了,它底层调用的是window.external.setCommand('addFriend',uid)方法,有兴趣

  • Android实现图片自动切换功能(实例代码详解)

    在Android中图片的自动切换不仅可以实现自动切换,而且还可以使用手动切换.而且一般在切换的时候,在图片下方还带有其他内容的切换,用来标记是第几个图片的切换. 这种效果在我们日常生活中很常见,例如某宝购物,一些商城都可以使用到,用户体验度极好,今天小编就通过实例代码给大家分享android 图片自动切换功能的实现. 实现效果如下: 具体的示例代码如下: 布局代码: <?xml version="1.0" encoding="utf-8"?> <S

  • Go语言实现自动填写古诗词实例代码

    前言 "白日依山尽,___".下句自然填黄河入海流,那么"日月忽其不淹兮,___,___,恐美人之迟暮",中间两句怎么填呢? 最近工作中有个需求,就是1500道语文诗词填空题没有答案,现在需要给这些题目大爷们匹配它们对应的答案,好在题目信息都很完整,指出了诗词出处.作者信息.自然想到到网上爬取对应文章信息然后字符串匹配答案.目前做完,效果还可以,基本上所有题目的答案都有了,现把操作流程记录下,做个总结. 1. 文章信息获取 网上找了很久,目前发现百度汉语对古诗词收录

随机推荐