如同公式所示,距离D是可以被计算出来的。

 

为了计算这个等式,我们需要知道激光器和摄像头之间的距离h,这是个常数,还有角度,角度可以计算。

其中:

pfc=从焦平面到中心的像素数量
rpc=单个像素的弧度
ro=弧度补偿(弥补对齐错误)


代入上式,我们得到:

这样,从图像中就能将焦平面到激光点像素数计算出来。那其他的常数怎么办呢?我们需要执行一个校准来得到这些数据。

为了校准这个系统,我们需要收集一系列测量的数据,每次测得的目标物的距离和这个激光点离中心点的像素数。数据如下

校正数据
pixels from centeractual D (cm)
10329
8145
6558
5571
4990
45109
41127
39159
37189
35218