双目测距公式解析
看双目测距的时候一个公式就给难住了,网上各种解析很多更是弄得云山雾绕,写下自己的一点理解,自认为非常合理。
就是这个公式: ![\huge \frac{T-(x^{l}-x^{r})}{Z-f}=\frac{T}{Z} \rightarrow Z=\frac{fT}{x^{l}-x^{r}}](https://private.codecogs.com/gif.latex?%5Cinline%20%5Chuge%20%5Cfrac%7BT-%28x%5E%7Bl%7D-x%5E%7Br%7D%29%7D%7BZ-f%7D%3D%5Cfrac%7BT%7D%7BZ%7D%20%5Crightarrow%20Z%3D%5Cfrac%7BfT%7D%7Bx%5E%7Bl%7D-x%5E%7Br%7D%7D)
![](https://img-blog.csdn.net/20181018164942957?watermark/2/text/aHR0cHM6Ly9ibG9nLmNzZG4ubmV0L3dlaXhpbl80MTAxMzQ3MA==/font/5a6L5L2T/fontsize/400/fill/I0JBQkFCMA==/dissolve/70)
点P在成像平面上的两个点Pl、Pr的坐标分别是
![](https://img-blog.csdn.net/20181018165749441?watermark/2/text/aHR0cHM6Ly9ibG9nLmNzZG4ubmV0L3dlaXhpbl80MTAxMzQ3MA==/font/5a6L5L2T/fontsize/400/fill/I0JBQkFCMA==/dissolve/70)
所谓视差,就是指左右图像上的相同特征点在x坐标上的差值,即图中的d,再看一张图
![](https://img-blog.csdn.net/20181018171026216?watermark/2/text/aHR0cHM6Ly9ibG9nLmNzZG4ubmV0L3dlaXhpbl80MTAxMzQ3MA==/font/5a6L5L2T/fontsize/400/fill/I0JBQkFCMA==/dissolve/70)
红色矩形框内的是Pr点在左边成像平面上的相同位置点,则视差d就很明显了,就等于左边绿色线段与黄色线段之和,这段距离长度是Xl-Xr,而两条绿色线段等长(很明显吧,两个成想平面一样大,绿色线段是相对称的线段)。所以利用红色三角形相似于蓝色三角形,红色三角形的底边长就是d,然后就得到了下面的公式
![\huge \frac{T-(x^{l}-x^{r})}{Z-f}=\frac{T}{Z} \rightarrow Z=\frac{fT}{x^{l}-x^{r}}](https://private.codecogs.com/gif.latex?%5Cinline%20%5Chuge%20%5Cfrac%7BT-%28x%5E%7Bl%7D-x%5E%7Br%7D%29%7D%7BZ-f%7D%3D%5Cfrac%7BT%7D%7BZ%7D%20%5Crightarrow%20Z%3D%5Cfrac%7BfT%7D%7Bx%5E%7Bl%7D-x%5E%7Br%7D%7D)
双目测距基本原理:
![](https://img-blog.csdnimg.cn/20190528161453548.png?x-oss-process=image/watermark,type_ZmFuZ3poZW5naGVpdGk,shadow_10,text_aHR0cHM6Ly9ibG9nLmNzZG4ubmV0L3UwMTE4MDg2NzM=,size_16,color_FFFFFF,t_70)
![](https://img-blog.csdnimg.cn/20190528161520264.png?x-oss-process=image/watermark,type_ZmFuZ3poZW5naGVpdGk,shadow_10,text_aHR0cHM6Ly9ibG9nLmNzZG4ubmV0L3UwMTE4MDg2NzM=,size_16,color_FFFFFF,t_70)
双目测距实际操作分4个步骤:相机标定——双目校正——双目匹配——计算深度信息。
相机标定:摄像头由于光学透镜的特性使得成像存在着径向畸变,可由三个参数k1,k2,k3确定;由于装配方面的误差,传感器与光学镜头之间并非完全平行,因此成像存在切向畸变,可由两个参数p1,p2确定。单个摄像头的定标主要是计算出摄像