坐标循环逼进式正交摄像机系统视频定位方法及系统

摘要

本发明公布了一种坐标循环逼进式正交摄像机系统视频定位方法及系统，本发明通过布置光轴正交排列的摄像机，在视觉空间定位中提出了坐标循环逼近的方法，构造迭代算法，且具有优良的收敛性，使得粗糙的初始值很快收敛到准确值，方法简单，从而可实现对目标的快速精确定位。

主权项

1.一种坐标循环逼进式正交摄像机系统视频定位方法，其特征在于，X轴、Y轴、Z轴上各有一台摄像机，坐标原点位于三个摄像机光轴交点，可得到目标成像平面位置U、目标距相机光心距离L、目标与光轴的垂直距离H以及摄像机对应焦距F间存在如下比值关系：L/F＝H/U                      (1)所述方法包括如下步骤：第一步，初始化：给定目标的位置初值(x₀，y₀，z₀)，其中x₀，y₀，z₀分别为目标在X轴、Y轴、Z轴上的空间坐标值；第二步，对应于X轴上的摄像机S₁，根据x₀坐标，求出目标沿此摄像机光轴的距离L₁＝|S₁-x₀|，按(1)式可求出目标与此摄像机光轴相对于Y轴和Z轴的两个垂直距离H值，也即目标在Y轴上的坐标值y₁和Z轴上的坐标值z₁；第三步，对应于Y轴上的摄像机S₂，根据第二步中计算得到的目标坐标值y₁，求出目标沿此摄像机光轴的距离L₂＝|S₂-y₁|，按(1)式可求出目标与此摄像机光轴相对于X轴和Z轴的两个垂直距离H值，也即目标在X轴上的坐标值x₂和Z轴上的坐标值z₂；第四步，对应于Z轴上的摄像机S₃，根据步骤3中计算得到的z₂坐标，可求出目标沿此摄像机光轴距离的L₃＝|S₃-z₂|，按(1)式可求出目标与此摄像机光轴相对于X轴和Y轴的两个垂直距离H值，也即目标在X轴上的坐标值x₃和Y轴上的坐标值y₃；第五步，对第二步至第四步骤所获的目标在X轴、Y轴、Z轴上的坐标值求平均，即$\bar{x}=(x_2+x_3)/2,$$\bar{y}=(x_1+x_3)/2,$$\bar{z}=(z_1+z_2)/2;$第六步，收敛判断：若第五步计算的坐标值平均值与迭代开始的初值x₀，y₀，z₀收敛到给定精度ε，则第五步计算的作为最终目标位置值，迭代结束；否则将作为位置初值，即令转第二步。