java双目_双目测距-原理及代码实现

本文介绍了使用双目摄像头获取物体3D坐标的原理和方法,包括相机标定、3D坐标计算及其验证过程。通过比较MATLAB和OpenCV的标定效果,探讨了投影矩阵的计算,并展示了实验结果。
摘要由CSDN通过智能技术生成

需求:使用双目摄像头得出物体3D坐标,本质就是利用双目来得到深度信息。

0 知识扫盲

1 相机标定

Q1:用MATLAB标定还是opencv标定?

A1:两种我都试了。总结来说,直接影响标定结果的好坏的因素是图片质量,在图片质量较好的情况下,两者结果基本一样。

Q2:是两个相机一起标定还是单独标定?

A2:MATLAB 和 OPENCV中都有单目标定和双目标定(MATLAB版本>2014)的方式。题主采用的方案是opencv分开标, MATLAB一起标。opencv分开标的主要原因是利用opencv **cv2.stereoCalibrate()**标出的两相机间的RT矩阵实在偏差太大,所以采用了分开标定相机。而MATLAB计算的结果就相当好,示意图和我实际摆放的相机位置基本一样。

使用MATLAB标定。左右照片各15张(共采集19张,MATLAB识别出有效16张,手动删除一张Mean Erro较大的图)。记下 内参参数及两相机间的RT矩阵。MATLAB 标定结果如下。设置棋盘格单位长度25mm。

471a8d543bf1065f50fb7b8a91a90021.png 可以看出标定出的的结果相机及棋盘的摆放位置与实际摆放接近。

364514b301750e2946cd81799bb79e9d.png 图中标定显示棋盘与相机大概700~800mm的距离(棋盘格单位为25mm的前提下)。

2 计算3d坐标。

'''

参数含义:

projMatr13x4 projection matrix of the first camera.

projMatr23x4 projection matrix of the second camera.

projPoints12xN array of feature points in the first image. In case of c++ version it can be also a vector of feature points or two-channel matrix of size 1xN or Nx1.

projPoints22xN array of corresponding points in the second image. In case of c++ version it can be also a vector of feature points or two-channel matrix of size 1xN or Nx1.

points4D4xN array of reconstructed points in homogeneous coordinates.

'''

points4D = cv.triangulatePoints(projMatr1, projMatr2, projPoints1, projPoints2[, points4D])

可见关键步是计算出两个投影矩阵, 然后将待测物体在左右相机成像的像素坐标代入即可得到3d坐标。原理、方法都很简单。 投影矩阵的计算有两种方式:

1.采用立体标定的方案(opencv)。 主要思路是cv2.stereoCalibrate()计算出R|T,将其代入cv2.stereoRectify()得到投影矩阵P1,P2。 此时得到的P1 P2为:

81fc5f8c104c9f4323597e9f3f4408e5.png P1 和P2 之间只差一个平移矩阵。与我们实际摆放的位置不符。实际摆放位置和MATLAB标定的结果类似。原因不清楚,然后采用了方案2计算投影矩阵。

2 自己计算投影矩阵。即内参与外参的乘积。 用图片/stereo512/left.bmp /stereo512/right.bmp计算相机外参。使用了cv.solvePnP()函数

3.验证.

将棋盘格左右像素坐标代入函数cv.triangulatePoints()得到棋盘格格点3d坐标. MATLAB标定结果:

35de5f91f69ffbbe9e12b2b5866b327d.png opencv标定结果:

dea59fc38308160507388a35cc680289.png 可以看出在3维坐标的计算上,三个轴3d坐标与实际值相差都很小,并且opencv标注产生的均方误差在三个轴均略优于MATLAB。

继续验证: 左相机视图:

de94c2a8936a5f6d96494676bd41e7b8.png 实物图:

dd8dae1b7b7239abede7fa6aac9c7d42.png

matlab标定给出的3d结果:

1f183aaff2e2b46f00a4393313dd0ec3.png

opencv标定给出的3d结果:

29fae4d4b859dde1bb9002a82f5d659d.png (结果比较接近,相差6mm。结果负值是坐标系原因。) github代码

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值