1.一种基于多相机协同定位的相机优化部署和选择方法,其特征在于,包括S1,在目标周围部署多个移动机器人,每个所述移动机器人上携带结构相同的相机;所述相机的光学中心的高度与目标高度相同,所述相机成像平面垂直于水平面;
S2,获取朝向角ψ;
S3,在像素坐标系下获取所述相机在所述移动机器人前进方向的偏航角α;
S4,通过所述朝向角ψ和所述偏航角α得到目标和所述相机之间的相对角度θ,θ=ψ-α;
S5,通过两个以上所述相机的相对角度θ获取目标的位置;
S6,将获取所述朝向角ψ过程中产生的外部误差ω'和由于相机内部机理测量误差导致测角的内部误差ω”中合得到相机测角总误差ω;
S7,所述内部误差ω”分为由于相机内部噪声和成像平面成像点的波动而导致提取到的质心坐标在u轴方向上跳动而产生的随机误差ωa和因为所述相机内部光心偏移和几何畸变产生的几何误差ωb外部误差ω'、随机误差ωa和几何误差ωb均相互独立;
S8,通过测角模型转变,用正态分布对随机误差ωa建模;
S9,通过分析相机内部机理用瑞利分布对几何误差ωb建模;
S10,将所述外部误差ω'、所述随机误差ωa和所述几何误差ωb通过泰勒展开忽略高阶项,近似为正态误差,并利用正态误差建立多相机协同定位系统的高斯模型;
S11,通过FIM和D优化准则提出精度指标,分析所述相机测角的定位精度,FIM的行列式值越大时,相机测角的定位精度越高;
S12,获取所述相机不同部署位置时的所述正态误差的值,选取所述正态误差的值最小时的相机部署位置为实际部署位置,完成所述相机的实际优化部署和选择。
2.根据权利要求1所述的基于多相机协同定位的相机优化部署和选择方法,其特征在于,所述在像素坐标系下获取所述相机在所述移动机器人前进方向的偏航角α,包括第i个相机光心的坐标是(x0i,y0i,z0i),提取到的目标在像素坐标下成像的质心坐标为(xdi,ydi,zdi),相机的焦距为f,则得到第i个相机测得的偏航角αi的绝对值若偏航角的旋转方向是逆时针方向,则αi的取值为正,否则αi取值为负,第i个相机测得与目标之间的相对角度为:θi=θi'+ω;θi'为第i个相机与目标之间的真实相对角度,ω表示每个相机测角时的总误差。
3.根据权利要求1所述的基于多相机协同定位的相机优化部署和选择方法,其特征在于,所述通过所述朝向角ψ和所述偏航角α得到目标和所述相机之间的相对角度θ,θ=ψ-α;
其中,所述朝向角ψ为所述相机装配在所述移动机器人前进方向与俯视世界坐标系x轴的夹角,所述相机的前进方向垂直于所述相机的成像平面,所述朝向角ψ从移动机器人的里程计中获得;所述偏航角α为移动机器人前进方向与相机和目标连线的夹角。
4.根据权利要求1所述的基于多相机协同定位的相机优化部署和选择方法,其特征在于,所述通过两个以上所述相机测量的相对角度θ获取目标的位置,具体的:其中,yc1为第一个相机的在俯视世界坐标系中的y轴坐标,xc1为第一个相机的在俯视世界坐标系中的x轴坐标;xt和yt分别为目标在俯视世界坐标系中的x轴坐标和y轴坐标。
5.根据权利要求1所述的基于多相机协同定位的相机优化部署和选择方法,其特征在于,所述外部误差ω'为由于移动机器人里程计计算产生的误差噪声导致朝向角产生的误差ω';外部误差ω'为一个符合均值为0方差为的正态分布即所述随机误差ωa导致质心坐标的跳动幅度为Δu,随机误差ωa的表达式如下:
此时,随机误差ωa并不服从于正态分布,令所述相机的光心与目标的连线与朝向线重合即使朝向角为0,此时,随机误差ωa表达为:由于的实际值很小,根据泰勒展开式原理并且忽略高阶项,则随机误差ωa可视为均值为0,方差为的正态分布,即引入两个向量分别表示光心偏移和成像平面畸变对质心坐标的影响,两个向量相互独立并且均满足均值为0且方差为的正态分布,合成的向量的大小l满足瑞利分布,l的概率密度满足如下的关系:所述几何误差ωb表示为:
通过计算可知Ε(l)=1.25σg,var(*)代表计算方差,同理,利用之前分析随机误差ωa的方法,由于合成的向量的大小l本身值很小,所以根据大数定律和中心极限定理l可以近似为均值为Ε(l),方差为var(l)的正态分布,因此所述几何误差ωb表示为:
6.根据权利要求5所述的基于多相机协同定位的相机优化部署和选择方法,其特征在于,所述利用正态误差建立多相机协同定位系统的高斯模型,包括整个相机测角所有的角度信息用向量来表示:
θ=θ'+ω
其中θ=[θ1,θ2,...,θN]T,ω=[ω1,ω2,…,ωN]T,θ'表示每个相机与目标之间的真实值矩阵,ω表示每个相机测角时的总误差矩阵;
相机测角的误差的协方差矩阵用∑=E(ωωT)表示,通过计算:其中:k是一个常系数,F是相机分辨率,f是相机的焦距;
得到关于相机测角协同定位的高斯模型,关于相对角度θ的条件概率密度为:其中p=[xt,yt]表示在俯视世界坐标系下实际目标的位置,θ'(p)为真实各个相机到目标之间的相对角度矩阵,θ表示相机测得的与目标之间的相对角度矩阵,N表示使用相机的个数,Σ是相机测角的误差矩阵。
7.根据权利要求6所述的基于多相机协同定位的相机优化部署和选择方法,其特征在于,所述通过FIM和D优化准则提出精度指标,分析所述相机测角的定位精度,包括当所述相机测角中所有误差均满足正态分布时,FIM可以表示为:FIM=JTΣ-1J
其中
最终算出FIM为:
N为相机的个数,
所述相机的像素点越大会带来拍摄的图像误差越大,用下面公式来描述这一关系:其中,σr为跳动幅度的标准差,F为相机的分辨率,k为一个常数;
得到对目标定位精度影响的函数:
其中:
当相机的分辨率越高,焦距越大时,对目标的定位精度越高。
8.根据权利要求7所述的基于多相机协同定位的相机优化部署和选择方法,其特征在于,所述设定所述相机的所在区域为一个半径为r的圆中,在俯视的二维世界坐标系中,圆心为坐标原点;
当目标在所述相机的所在区域外时:
目标定位精度影响的函数简化为:
当N为偶数,目标的位置在俯视世界坐标系的x轴正半轴,此时相机的测得的角度不是任意的,相机最大测得角度θ*的绝对值小于90°,即|θi|≤θ*<90°,i=1,...,N此时只有下式成立:为保证det(FIM)取最大值,如果θ*≥45°上式是可实现的,若θ*<45°,最大值为即时det(FIM)最大;
①若θ*≥45°,所有的相机与目标的相对角度θ=[θ1,θ2,...,θN]T应满足②若θ*<45°,所有的相机与目标的相对角度θ=[θ1,θ2,...,θN]T应满足当N为奇数时,det(FIM)写成:
其中当时
为保证det(FIM)取最大值,如果上式是可实现的,反之将det(FIM)改写为其中若θ*≥45°,当时,det(FIM)最大,因为1-2sin2θ*<0,因此θ1=0°,若θ*<45°,当时,det(FIM)最大,但是1-2sin2θ*>0,因此|θ1|=θ*;因此得到N为偶数时的优化布局结果:(1)若所有的相机测量角度θ=[θ1,θ2,...,θN]T满足:θ1=0°
(2)若且θ*≥45°,所有的相机与目标的相对角度θ=[θ1,θ2,...,θN]T满足:θ1=0°
(3)若θ*<45°所有的相机与目标的相对角度θ=[θ1,θ2,...,θN]T满足:|θ1|=θ*