OpenCV检测Marker位姿

Stella981
• 阅读 387
  • Marker检测采用小觅相机,可以实时检测Marker的位置和姿态,效果如下:

OpenCV检测Marker位姿

  参考代码如下:

  1 #include "pch.h"
  2 
  3 #include <Eigen/Dense>
  4 #include <opencv2/core.hpp>
  5 #include <opencv2\highgui.hpp>
  6 #include <opencv2\aruco.hpp>
  7 #include <opencv2\aruco\dictionary.hpp>
  8 #include <opencv2/calib3d.hpp>
  9 #include <opencv2/core/eigen.hpp> 
 10 #include <opencv2/opencv.hpp>
 11 
 12 #include <mynteyed/camera.h>
 13 #include <mynteyed/utils.h>
 14 
 15 #include <vector>
 16 #include <iostream>
 17 #include <Windows.h>
 18 #include <fstream>
 19 
 20 using namespace std;
 21 using namespace cv;
 22 using namespace Eigen;
 23 using  namespace aruco;
 24 
 25 
 26 int main(int argc, char *argv[]) {
 27     mynteyed::Camera cam;
 28     mynteyed::DeviceInfo dev_info;
 29     if (!mynteyed::util::select(cam, &dev_info)) {
 30         return 1;
 31     }
 32     mynteyed::util::print_stream_infos(cam, dev_info.index);
 33 
 34     std::cout << "Open device: " << dev_info.index << ", "
 35         << dev_info.name << std::endl << std::endl;
 36     //设置相机的参数
 37     mynteyed::OpenParams params(dev_info.index);
 38     //params.depth_mode = mynteyed::DepthMode::DEPTH_GRAY;
 39     //params.stream_mode = mynteyed::StreamMode::
 40     params.stream_mode = mynteyed::StreamMode::STREAM_2560x720;
 41     params.color_mode = mynteyed::ColorMode::COLOR_RECTIFIED;
 42     //params.ir_intensity = 4;
 43     params.framerate = 30;
 44 
 45     cam.Open(params);
 46 
 47     
 48 
 49     Ptr<aruco::Dictionary> dictionary = aruco::getPredefinedDictionary(aruco::DICT_6X6_250);
 50     Mat out;
 51     dictionary->drawMarker(100, 600, out, 5);
 52 
 53     Ptr<aruco::DetectorParameters> detectorParams = aruco::DetectorParameters::create();
 54        
 55 
 56     for (;;) {
 57         auto Left_color = cam.GetStreamData(mynteyed::ImageType::IMAGE_LEFT_COLOR);
 58         if (Left_color.img)
 59         {
 60             Mat image = Left_color.img->To(mynteyed::ImageFormat::COLOR_BGR)->ToMat();
 61             Mat  imageCopy;
 62             //相机内参矩阵
 63             const Mat  intrinsic_matrix = (Mat_<float>(3, 3)
 64                 << 713.12554931640625000, 0.0, 634.99163818359375000, 0.0,
 65                 714.41278076171875000, 363.88098144531250000, 0.0, 0.0, 1.0);
 66             
 67             //畸变校正
 68             const Mat  arucodistCoeffs = (Mat_<float>(1, 5) << -0.29668807983398438, 0.07767868041992188,
 69                 0.00000000000000000, -0.00012969970703125,
 70                 0.00000000000000000);
 71             vector< int > ids;
 72             vector< vector< Point2f > > corners, rejected;
 73             vector< Vec3d > rvecs, tvecs;
 74             Mat  R;
 75             MatrixXd M(4, 4);
 76             // detect markers and estimate pose
 77             detectMarkers(image, dictionary, corners, ids, detectorParams, rejected);//rejected拒绝的矩形区域
 78             image.copyTo(imageCopy);
 79             if (ids.size() > 0)
 80             {
 81                 drawDetectedMarkers(imageCopy, corners, ids);
 82                 std::vector <cv::Vec3d> rvecs,tvecs;
 83                 estimatePoseSingleMarkers(corners,0.05, intrinsic_matrix, arucodistCoeffs, rvecs, tvecs);
 84                 //0.05为Marker的大小
 85                 Rodrigues(rvecs[0], R, noArray());//罗德里格斯变换将旋转矩阵变为旋转向量
 86                 MatrixXd r(3, 3);
 87                 VectorXd t(3);
 88                 VectorXd T_mm(3);
 89                 cv2eigen(R, r);
 90                 cv2eigen(tvecs[0], t);
 91                 cv2eigen(tvecs[0], T_mm);
 92                 T_mm = T_mm * 1000;
 93                 M(0, 0) = r(0, 0); M(0, 1) = r(0, 1); M(0, 2) = r(0, 2); M(0, 3) = t(0, 0);
 94                 M(1, 0) = r(1, 0); M(1, 1) = r(1, 1); M(1, 2) = r(1, 2); M(1, 3) = t(1, 0);
 95                 M(2, 0) = r(2, 0); M(0, 1) = r(2, 1); M(2, 2) = r(2, 2); M(2, 3) = t(2, 0);
 96                 M(3, 0) = 0; M(3, 1) = 0; M(3, 2) = 0; M(3, 3) = 1;
 97 
 98                 cout << "R :" << r << endl;
 99                 cout << "T :" << T_mm << endl;
100 
101                 for (int i = 0; i < ids.size(); i++)
102                 {
103                     cv::aruco::drawAxis(imageCopy, intrinsic_matrix, arucodistCoeffs, rvecs[i], tvecs[i], 0.05);
104                 }
105 
106             }
107 
108             imshow("out", imageCopy);
109             char key = (char)waitKey(1);
110             if (key == 27) break;
111         }
112         
113     }
114     return 0;
115 }
116 
117
点赞
收藏
评论区
推荐文章
秃头王路飞 秃头王路飞
2个月前
webpack5手撸vue2脚手架
webpack5手撸vue相信工作个12年的小伙伴们在面试的时候多多少少怕被问到关于webpack方面的知识,本菜鸟最近闲来无事,就尝试了手撸了下vue2的脚手架,第一次发帖实在是没有经验,望海涵。 language JavaScript "name": "vuecliversion2", "version": "1.0.0", "desc
浅梦一笑 浅梦一笑
2个月前
初学 Python 需要安装哪些软件?超级实用,小白必看!
编程这个东西是真的奇妙。对于懂得的人来说,会觉得这个工具是多么的好用、有趣,而对于小白来说,就如同大山一样。其实这个都可以理解,大家都是这样过来的。那么接下来就说一下python相关的东西吧,并说一下我对编程的理解。本人也是小白一名,如有不对的地方,还请各位大神指出01名词解释:如果在编程方面接触的比较少,那么对于软件这一块,有几个名词一定要了解,比如开发环
技术小男生 技术小男生
2个月前
linux环境jdk环境变量配置
1:编辑系统配置文件vi /etc/profile2:按字母键i进入编辑模式,在最底部添加内容: JAVAHOME/opt/jdk1.8.0152 CLASSPATH.:$JAVAHOME/lib/dt.jar:$JAVAHOME/lib/tools.jar PATH$JAVAHOME/bin:$PATH3:生效配置
光头强的博客 光头强的博客
2个月前
Java面向对象试题
1、 请创建一个Animal动物类,要求有方法eat()方法,方法输出一条语句“吃东西”。 创建一个接口A,接口里有一个抽象方法fly()。创建一个Bird类继承Animal类并实现 接口A里的方法输出一条有语句“鸟儿飞翔”,重写eat()方法输出一条语句“鸟儿 吃虫”。在Test类中向上转型创建b对象,调用eat方法。然后向下转型调用eat()方
刚刚好 刚刚好
2个月前
css问题
1、 在IOS中图片不显示(给图片加了圆角或者img没有父级) <div<img src""/</div div {width: 20px; height: 20px; borderradius: 20px; overflow: h
blmius blmius
1年前
MySQL:[Err] 1292 - Incorrect datetime value: ‘0000-00-00 00:00:00‘ for column ‘CREATE_TIME‘ at row 1
文章目录 问题 用navicat导入数据时,报错: 原因这是因为当前的MySQL不支持datetime为0的情况。 解决修改sql\mode: sql\mode:SQL Mode定义了MySQL应支持的SQL语法、数据校验等,这样可以更容易地在不同的环境中使用MySQL。 全局s
小森森 小森森
2个月前
校园表白墙微信小程序V1.0 SayLove -基于微信云开发-一键快速搭建,开箱即用
后续会继续更新,敬请期待2.0全新版本 欢迎添加左边的微信一起探讨!项目地址:](https://www.aliyun.com/activity/daily/bestoffer?userCodesskuuw5n) \2. Bug修复更新日历 2. 情侣脸功能大家不要使用了,现在阿里云的接口已经要收费了(土豪请随意), \ \ 和 注意
晴空闲云 晴空闲云
2个月前
css中box-sizing解放盒子实际宽高计算
我们知道传统的盒子模型,如果增加内边距padding和边框border,那么会撑大整个盒子,造成盒子的宽度不好计算,在实务中特别不方便。boxsizing可以设置盒模型的方式,可以很好的设置固定宽高的盒模型。 盒子宽高计算假如我们设置如下盒子:宽度和高度均为200px,那么这会这个盒子实际的宽高就都是200px。但是当我们设置这个盒子的边框和内间距的时候,那
艾木酱 艾木酱
1个月前
快速入门|使用MemFire Cloud构建React Native应用程序
> MemFire Cloud是一款提供云数据库,用户可以创建云数据库,并对数据库进行管理,还可以对数据库进行备份操作。它还提供后端即服务,用户可以在1分钟内新建一个应用,使用自动生成的API和SDK,访问云数据库、对象存储、用户认证与授权等功能,可专
helloworld_28799839 helloworld_28799839
2个月前
常用知识整理
# Javascript ## 判断对象是否为空 ```js Object.keys(myObject).length === 0 ``` ## 经常使用的三元运算 > 我们经常遇到处理表格列状态字段如 `status` 的时候可以用到 ``` vue