ros --- 双目相机内参与外参标定
ros --- 双目相机内参与外参标定
- 小觅相机直接获取参数
- 手动重新标定
- 1. 双目相机内外参标定
- 生成标定板
- 录制 stereo_calibra.bag
- 标定
- 标定结果
- 标定验证
- 2. 双目 + imu外参标定
- 录制 stereo+imu_calibra.bag
- 标定
- 标定结果
- 参数说明
- 相机模型
- 畸变模型
小觅相机直接获取参数
Camera Calibration
https://blog.csdn.net/u012871872/article/details/78083299
本文暂时使用 小觅相机,介绍相机内参,相机与imu之间的外参
ROS 中的相机传感器数据,关于相机信息的格式:sensor_msgs/CameraInfo
详细见下面的 官方链接:
http://docs.ros.org/melodic/api/sensor_msgs/html/msg/CameraInfo.html
手动重新标定
使用 kalibr 标定
1. 双目相机内外参标定
生成标定板
标定板类型有
- apriltag 二维码
kalibr_create_target_pdf --type apriltag --nx 6 --ny 6 --tsize 0.02 --tspace 0.3
- Checkerboard 棋盘格
kalibr_create_target_pdf --type checkerboard --nx 6 --ny 6 --csx 0.02 --csy 0.02
运行上述命令会在当前目录下,生成 target.pdf
本文选择 apriltag 精度高,然后按实际大小打印,或者直接用电脑按实际大小显示。
录制 stereo_calibra.bag
启动相机驱动,左右目图像的发布帧率在20到60hz;若直接采集,导致计算量过大,于是需要降低采集频率,使用ros控制话题发布频率的工具 throttle 节点
rosrun topic_tools throttle messages /mynteye/left/image_raw 4.0 /left
rosrun topic_tools throttle messages /mynteye/right/image_raw 4.0 /right
录制
rosbag record -O stereo_calibra.bag /left /right
使用相机对标定板拍摄,大概1分钟
标定
标定命令行中 还需要 标定板的参数,创建 aprilgrid-6_6-2.cm-0.6cm.yaml 文件
target_type: 'aprilgrid' #gridtype
tagCols: 6 #number of apriltags
tagRows: 6 #number of apriltags
tagSize: 0.02 #size of apriltag, edge to edge [m]
tagSpacing: 0.3 #ratio of space between tags to tagSize
标定运行命令
加上 --show-extraction 参数,显示特征提取情况
kalibr_calibrate_cameras --bag /home/chewgum/visual_slam/stereo_calibra.bag --topics /left /right --models pinhole-radtan pinhole-radtan --target /home/chewgum/visual_slam/aprilgrid-6_6-2.cm-0.6cm.yaml --show-extraction
出现问题
:
Cameras are not connected through mutual observations, please check the dataset. Maybe adjust the approx. sync. tolerance.
在上面的标定命令行加上 --approx-sync 0.1 ,将两帧之间的时间同步容忍度加大到0.1s; 或者改变前面录制bag包的频率,从原来的4hz 调整到 20hz。
标定结果
camchain-homechewgumvisual_slamstereo_calibra.yaml
cam0:cam_overlaps: [1]camera_model: pinholedistortion_coeffs: [-0.29493438147961343, 0.07522888381593014, -0.0018319624616570107,-0.002356088773962833]distortion_model: radtanintrinsics: [364.24637873978213, 366.457071766116, 387.4921108720392, 238.7839064461657]resolution: [752, 480]rostopic: /mynteye/left/image_raw
cam1:T_cn_cnm1:- [0.9999076175962174, 0.0033106420159252216, 0.013183168150762868, -0.12038398571176612]- [-0.0032542977725930626, 0.9999854892539586, -0.004293113965493399, 0.00023786133727843532]- [-0.01319718981663118, 0.004249815402556823, 0.9999038820056557, 0.0002842556792255972]- [0.0, 0.0, 0.0, 1.0]cam_overlaps: [0]camera_model: pinholedistortion_coeffs: [-0.3236731263843389, 0.10834524230255492, -0.00159531254814612,0.0006582173691789835]distortion_model: radtanintrinsics: [364.68177731090765, 367.14971555045713, 389.6805771084146, 260.53738481605325]resolution: [752, 480]rostopic: /mynteye/right/image_raw
标定验证
使用calibration validator进行标定结果的验证,原理是对重投影误差进行量化分析。命令行如下:
kalibr_camera_validator --cam camchain.yaml --target target.yaml
命令行中 camchain.yaml 与 target.yaml 分别为上述中camera标定的结果以及 标定板的yaml文件。
2. 双目 + imu外参标定
录制 stereo+imu_calibra.bag
保证imu 的频率200 hz , camera的频率为 20hz
EuRoC数据集,其rosbag,imu的频率为200hz,相机频率为20hz; 所以小觅相机,参数配置文件也要设定为一样的。(毕竟知名数据集的设置是这样的;小觅相机的图像频率默认是10hz,所以需要修改一下)
修改之后的小觅相机驱动参数中 imu 的频率200 hz , camera的频率为 20hz,所以不需要再修改频率,可以直接录制
roslaunch mynt_eye_ros_wrapper display.launchrosrun topic_tools throttle messages /mynteye/imu/data_raw 200 /imu
rosrun topic_tools throttle messages /mynteye/left/image_raw 20 /left
rosrun topic_tools throttle messages /mynteye/right/image_raw 20 /right
录制
rosbag record -O stereo+imu_calibra.bag /left /right /imu
或
rosbag record -O stereo+imu_calibra.bag /mynteye/imu/data_raw /mynteye/left/image_raw /mynteye/right/image_raw
录制运动具体可以参照kalibr的视频,视频中是先面对标定目标,然后俯仰、偏航和横滚三个角度分别面向目标运动,然后是前后左右和上下运动,充分运动起来, 绕8字。时间一分钟即可
标定
创建imu参数文件:mynt_imu_kalibr_format.yaml ;imu的标定见上一讲
#Accelerometers
accelerometer_noise_density: 1.1306635200120034e-02 #Noise density (continuous-time)
accelerometer_random_walk: 5.6369851835317642e-04 #Bias random walk#Gyroscopes
gyroscope_noise_density: 1.0690087672934289e-03 #Noise density (continuous-time)
gyroscope_random_walk: 1.0895815866105891e-05 #Bias random walkrostopic: /mynteye/imu/data_raw #the IMU ROS topic
update_rate: 200.0 #Hz (for discretization of the values above)
相机内参文件 :上面双目标定结果 camchain-homechewgumvisual_slamstereo_calibra.yaml
cam0:cam_overlaps: [1]camera_model: pinholedistortion_coeffs: [-0.29493438147961343, 0.07522888381593014, -0.0018319624616570107,-0.002356088773962833]distortion_model: radtan intrinsics: [364.24637873978213, 366.457071766116, 387.4921108720392, 238.7839064461657]resolution: [752, 480]rostopic: /mynteye/left/image_raw
cam1:T_cn_cnm1:- [0.9999076175962174, 0.0033106420159252216, 0.013183168150762868, -0.12038398571176612]- [-0.0032542977725930626, 0.9999854892539586, -0.004293113965493399, 0.00023786133727843532]- [-0.01319718981663118, 0.004249815402556823, 0.9999038820056557, 0.0002842556792255972]- [0.0, 0.0, 0.0, 1.0]cam_overlaps: [0]camera_model: pinholedistortion_coeffs: [-0.3236731263843389, 0.10834524230255492, -0.00159531254814612,0.0006582173691789835]distortion_model: radtanintrinsics: [364.68177731090765, 367.14971555045713, 389.6805771084146, 260.53738481605325]resolution: [752, 480]rostopic: /mynteye/right/image_raw
命令行:
kalibr_calibrate_imu_camera --target /home/chewgum/visual_slam/aprilgrid-6_6-2.cm-0.6cm.yaml --cam /home/chewgum/visual_slam/camchain-homechewgumvisual_slamstereo_calibra.yaml --imu /home/chewgum/visual_slam/imu_utils/src/imu_utils/data/mynt_imu_kalibr_format.yaml --bag /home/chewgum/visual_slam/stereo+imu_calibra.bag --bag-from-to 5 50
参数:
- –bag-from-to : --bag-from-to 5 50 取bag 5秒到50秒的数据播放;先要查看一下bag包本身的时长;
标定结果
camchain-imucam-homechewgumvisual_slamstereo+imu_calibra.yaml
cam0:T_cam_imu:- [-0.003250347682917931, 0.999969585040646, -0.007089727327536899, 0.042032434603335195]- [-0.9999921462110681, -0.0032663356374186825, -0.002244675407753127, 0.00029240263719737823]- [-0.002267764565071351, 0.007082375670804389, 0.9999723482170573, -0.026176639544284192]- [0.0, 0.0, 0.0, 1.0]cam_overlaps: [1]camera_model: pinholedistortion_coeffs: [-0.29493438147961343, 0.07522888381593014, -0.0018319624616570107,-0.002356088773962833]distortion_model: radtanintrinsics: [364.24637873978213, 366.457071766116, 387.4921108720392, 238.7839064461657]resolution: [752, 480]rostopic: /mynteye/left/image_rawtimeshift_cam_imu: 0.006738289134998647
cam1:T_cam_imu:- [-0.0065905597444152475, 0.9999597599280499, 0.006086299934457427, -0.07869955716605419]- [-0.9999573222080451, -0.006550892479611714, -0.006514566005225936, 0.0005058529699863603]- [-0.006474433162151864, -0.0061289748210814265, 0.9999602579017186, -0.02644333517965107]- [0.0, 0.0, 0.0, 1.0]T_cn_cnm1:- [0.9999076175962189, 0.0033106420159252216, 0.01318316815076287, -0.12038398571176612]- [-0.0032542977725930626, 0.9999854892539601, -0.004293113965493399, 0.00023786133727843532]- [-0.013197189816631181, 0.004249815402556823, 0.9999038820056573, 0.0002842556792255972]- [0.0, 0.0, 0.0, 1.0]cam_overlaps: [0]camera_model: pinholedistortion_coeffs: [-0.3236731263843389, 0.10834524230255492, -0.00159531254814612,0.0006582173691789835]distortion_model: radtanintrinsics: [364.68177731090765, 367.14971555045713, 389.6805771084146, 260.53738481605325]resolution: [752, 480]rostopic: /mynteye/right/image_rawtimeshift_cam_imu: 0.006824621396683813
参数说明
VIO标定(一)针孔相机模型 :https://zhuanlan.zhihu.com/p/93819559
相机模型
相机坐标系 到 归一化平面
相机模型指的是相机坐标系到理想图像平面(通常也称为Normalize 平面/归一化平面)的投影模型
设相机坐标系下的点为 (xc,yc,zc)(x_c ,y_c ,z_c)(xc,yc,zc), 投影到normalize平面/归一化平面的点为 (xu,yu)(x_u,y_u)(xu,yu)
包含:
- 针孔相机模型(Pinhole) : 针孔相机模型利用透镜进行聚光成像的相机使用的模型
- 全向模型(Omnidirectional):全向模型利用面镜(mirror)反射进行成像的相机使用的模型; 其FOV(视场角等于 180o180^o180o)
畸变模型
归一化平面 到真实图像平面
理想的针孔成像模型确定的坐标变换关系均为线性的,而实际上,现实中使用的相机由于镜头中镜片因为光线的通过产生的不规则的折射,镜头畸变(lens distortion)总是存在的,即根据理想针孔成像模型计算出来的像点坐标与实际坐标存在偏差。
畸变模型有:
- radtan畸变模型: 普通相机畸变通常包括径向畸变和切向畸变;主要参数有 k1,k2,k3,p1,p2k_1,k_2,k_3,p_1,p_2k1,k2,k3,p1,p2
- 鱼眼畸变模型 : 主要使用 Equidistant模型(等距投影 Equidistant);也就是 kannala-brandt模型 ,对应 opencv中的fisheye::calibrate;
小觅相机官方使用的畸变模型也是鱼眼畸变模型 distortion_model: KANNALA_BRANDT ;./samples/_output/bin/get_img_params 可以查看
目前接触的相机去畸变参数:
- 针孔相机 : k1,k2,p1,p2
- 鱼眼相机: k1,k2,k3,k4
ros --- 双目相机内参与外参标定相关推荐
- 小觅相机 相机以及IMU外参标定
最近在使用IMU和双目相机进行相关VIO算法的测试,首先要对IMU和相机的外参进行标定,本文主要是对标定过程做一个全面的记录,方便总结和讨论.测试中采用的是小觅双目模组标准版S1030-IR-120/ ...
- Realsense d435i内参、外参标定
使用工具code_utils.imu_utils.kalibr对Realsense d435i 内参.外参标定.本文介绍上述工具的安装,及标定方法. 一.code_utils安装 1.建立工作空间 m ...
- 相机内参和外参的解释
这个我觉得说清楚了,说相机内参包括内参矩阵和畸变矩阵,这样就好理解了,我之前把内参等同于内参矩阵了. 转载自:https://blog.csdn.net/weixin_42872123/article ...
- 二十一.激光、视觉和惯导LVIO-SLAM框架学习之相机与雷达外参标定(1)
专栏系列文章如下: 一:Tixiao Shan最新力作LVI-SAM(Lio-SAM+Vins-Mono),基于视觉-激光-惯导里程计的SLAM框架,环境搭建和跑通过程_goldqiu的博客-CSDN ...
- (九)相机内参、外参、反透视变换python opencv
背景知识 任务需求:将相机上的一个点投影到真实世界平面上去. 原则上单目相机是不可以的,因为只记录了二维信息,真实世界是三维的,双目相机可以通过视差,或者单目+IMU组合,但是由于特征点在地面上的先验 ...
- 相机校正与相机内参、外参
简 介: 对于相机进行校正,是为之后视觉测量奠定基础.本文在总结了相机校正中的基本概念.使用cv2的函数说明校正的过程. 关键词: 相机校正,内参,外参 #mermaid-svg-0bogxxocrI ...
- 相机成像模型、相机内参、外参、以及相机标定
看了一圈各个平台讲解相机模型.相机标定的文章,很多只是简单罗列几个公式,其中的细节都没说明,本着学习的出发点写下这篇文章,希望能给初学者解惑.本文主要讲解相机模型,一步步推导从世界坐标系到图像坐标系的 ...
- 相机内参、外参、畸变系数简介
文章目录 一.相机模型 1.简介 2.针孔相机模型 二.相机内参 1.相机坐标-图像坐标 2.图像坐标-像素坐标 3.相机坐标-像素坐标 三.外参矩阵 1.世界坐标-相机坐标 2.世界坐标-像素坐标 ...
- 三维计算机视觉——相机内参和外参及坐标变换公式
1.定义 相机内参数是与相机自身特性相关的参数,比如相机的焦距.像素大小等: 相机外参数是在世界坐标系中的参数,比如相机的位置.旋转方向等. 定义四个坐标系的意义,世界坐标系(参考坐标系).摄像机坐标 ...
最新文章
- 实测 Mysql UUID 性能(转)
- 如何在一个背景图像上,做半透明的图。
- 【spring boot】 mybatis配置双数据源/多数据源
- 收起.NET程序的dll来
- junit 测试 dao_JUnit测试Spring Service和DAO(带有内存数据库)
- 一加Nord 2配置细节曝光:天玑1200芯片+5000万像素旗舰主摄
- awk命令过滤tomcat的访日日志中IP地址
- 全球首个AI合成主播发布,效果以假乱真!揭秘背后技术原理
- X Lossless Decoder for mac(XLD音频无损解码器)
- 论文笔记_S2D.52_CMRNet++:在激光雷达地图中进行内参未知的相机的单目视觉定位
- mongoDB备份方案
- 17 张程序员壁纸(使用频率很高)
- geopandas下载问题
- 自然人如何在浙江法院网上完成诉讼——具体流程
- python中seek是什么意思_python中seek怎么用
- 联盛德 HLK-W806 (十): 在 CDK IDE开发环境中使用WM-SDK-W806
- css 拉伸 resize —— 实现可拉伸的div(含限制拉伸的尺寸)
- 何时是PNE(纯策略纳什均衡)?何时是MNE(混合策略纳什均衡)?
- python 通信系统仿真_深入浅出通信原理连载22-40(Python代码版)
- patchca实现验证码验证
热门文章
- pyqt5把图标和qss样式表打包
- 【面经】某团面经---一篇到底
- Zhou21Network Representation Learning: From Preprocessing, Feature Extraction to Node Embedding
- Vue版本echarts 全国地图geo、geo3D
- windows10复制文件需要管理员权限,复制需要管理员权限怎么办
- [英语阅读]法国拟禁止非法网络下载
- 原来苹果手机是用这种方式清理垃圾,随意腾出20G,难怪能用5年
- 分片集群实验(3)--雷哥
- 结构体、枚举类型和联合体
- 男人的过错,为什么要让女人来承受