如何用摄像头来测距(opencv)

 如何用摄像头来测距(opencv)

作者:郭世龙

       最近一直忙着找工作,blog都长草了,今天把以前作的一个东西放上来充充门面吧。记得在哪看到过老外做的这个东西,觉得很好玩,就自己也做了一个。在摄像头下面固定一个激光笔,就构成了这个简易的测距装置。看一下图吧。

  原 理

  假设激光束是与摄像头的光轴完全平行,激光束的中心落点在在摄像头的视域中是最亮的点。激光束照射到摄像头视域中的跟踪目标上,那么摄像头可以捕捉到这个点,通过简单的图像处理的方法,可以在这侦图像中找到激光束照射形成的最亮点,同时可以计算出Y轴上方向上从落点到图像中心的象素的个数。这个落点越接近图像的中心,被测物体距离机器人就越远。由下图图可以计算距离D:

(1)

  等式中h是一个常量,是摄像头与激光发射器之间的垂直距离,可以直接测量获得。

θ可通过下式计算:
θ =Num*Rop+Offset      (2)                           
其中: Num是从图像中心到落点的像素个数
Rop是每个像素的弧度值
Offset是弧度误差
合并以上等式可以得到:
(3)
Num可以从图像上计算得到。Rop和Offset需要通过实验计算获得。首先测量出D的准确值,然后根据等式(1)可以计算出准确的θ,根据等式(2)可到只含有参数Rop和Offset的方程。在不同的距离多次测量D的准确值计算θ,求解方程组可以求出Rop和Offset。这里Rop=0.0030354,Offset=0.056514344。
程 序
头文件:
clas
  • 18
    点赞
  • 119
    收藏
    觉得还不错? 一键收藏
  • 393
    评论
实现效果:http://v.youku.com/v_show/id_XMTU2Mzk0NjU3Ng==.html 如何在你的电脑上运行这个程序? 1,它需要cvblobslib这一个opencv的扩展库来实现检测物体与给物体画框的功能,具体安装信息请见: http://dsynflo.blogspot.com/2010/02/cvblobskib-with-opencv-installation.html,当你配置好cvblobslib之后,你可以用这一的程序进行测试:http://dl.dropbox.com/u/110310945/Blobs%20test.rar 2,视频中两个摄像头之间的距离是6cm,你可以根据你摄像头的型号,来选择合适的距离来达到最好的效果。 3,在进行测距之前,首先需要对摄像头进行标定,那么如何标定呢? 在stdafx.h中把"#define CALIBRATION 0"改成 “#define CALIBRATION 1”表示进行标定,标定之后,你就可以在工程目录下的"CalibFile" 文件夹中得到标定信息的文件。如果标定效果还不错,你就可以吧"#define CALIBRATION " 改成0,以后就不需要再标定,直接使用上一次的标定信息。你还需要把"#define ANALYSIS_MODE 1"这行代码放到stdafx.h中。 4,视频中使用的是10*7的棋牌格,共摄录40帧来计算摄像头的各种参数,如果你像使用其他棋盘格,可以在 "StereoFunctions.cpp"文件中修改相应参数。 5,如果你无法打开摄像头,可以在 "StereoGrabber.cpp"文件中修改代码“cvCaptureFromCAM(index)”中index的值。 6,About computing distance: it interpolates the relationship between depth-value and real-distance to third degree polynomial. So i used excel file "interpolation" for interpolation to find k1 to k4, you should find your own value of these parameters. 7,你可以通过调整控制窗口中各个参数的滑块,从而来得到更好的视差图。 8,在目录下的”distance“文件夹中,有计算距离信息的matlab代码。 9,如果你想了解基本的理论,可以看一下这个文档:http://scholar.lib.vt.edu/theses/available/etd-12232009-222118/unrestricted/Short_NJ_T_2009.pdf 视频中环境:vs2008,opencv2.1
双目摄像头测距是通过计算两个摄像头之间的视差来计算深度信息的。OpenCV中提供了一些函数帮助我们实现双目摄像头测距。 首先,我们需要对图像进行校正,以消除摄像头之间的畸变。可以使用OpenCV中的cv2.stereoRectify()函数进行校正。 接下来,我们需要计算视差图像。可以使用OpenCV中的cv2.StereoSGBM_create()函数计算视差图像。这个函数使用Semi-Global Block Matching (SGBM)算法计算视差图像。 最后,我们可以使用视差图像和相机参数计算深度信息。可以使用OpenCV中的cv2.reprojectImageTo3D()函数将视差图像转换为3D点云,然后使用三角测量法计算深度信息。 下面是一个简单的示例代码,演示了如何使用OpenCV进行双目摄像头测距: ```python import cv2 # 读取左右相机图像 imgL = cv2.imread('left.png', 0) imgR = cv2.imread('right.png', 0) # 校正图像 R1, R2, P1, P2, Q, _, _ = cv2.stereoRectify(K1, D1, K2, D2, imgL.shape[::-1], R, T) mapL1, mapL2 = cv2.initUndistortRectifyMap(K1, D1, R1, P1, imgL.shape[::-1], cv2.CV_16SC2) mapR1, mapR2 = cv2.initUndistortRectifyMap(K2, D2, R2, P2, imgR.shape[::-1], cv2.CV_16SC2) imgL = cv2.remap(imgL, mapL1, mapL2, cv2.INTER_LINEAR) imgR = cv2.remap(imgR, mapR1, mapR2, cv2.INTER_LINEAR) # 计算视差图像 stereo = cv2.StereoSGBM_create(minDisparity=0, numDisparities=16, blockSize=15) disparity = stereo.compute(imgL, imgR) # 计算深度信息 points = cv2.reprojectImageTo3D(disparity, Q) depth = points[:, :, 2] # 显示深度图像 cv2.imshow('Depth', depth) cv2.waitKey(0) cv2.destroyAllWindows() ``` 注意,这只是一个简单的示例代码,实际应用中需要根据具体情况进行调整和优化。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 393
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值