一种大间距模式下基于双目视觉图像的行星车定位方法.pdf

摘要
申请专利号：	CN201410015292.6	申请日：	2014.01.10
公开号：	CN103927738A	公开日：	2014.07.16
当前法律状态：	撤回	有效性：	无权
法律详情：	发明专利申请公布后的视为撤回IPC(主分类):G06T 7/00申请公布日:20140716\|\|\|实质审查的生效IPC(主分类):G06T 7/00申请日:20140110\|\|\|公开
IPC分类号：	G06T7/00	主分类号：	G06T7/00
申请人：	北京航天飞行控制中心
发明人：	王保丰; 刘传凯; 王镓; 申敬松; 唐歌实; 张强; 卜彦龙; 罗建军; 许柏
地址：	100094 北京市海淀区北清路26号
优先权：
专利代理机构：	国防专利服务中心 11043	代理人：	江亚平
PDF下载：	PDF下载

内容摘要

本发明公开一种大间距模式下基于双目视觉图像的行星车定位方法，包括以下步骤：行星车在大间距的两个位置分别拍摄图像；对两个位置拍摄的左相机图像进行A-SIFT匹配；双目相机左右相机图像的立体匹配；匹配特征点的正确性检查；行星车当前位置与姿态的计算。采用本发明的技术方案，使行星车在未知环境行进时精确计算自身位置和姿态，实现行星车自主定位。

权利要求书

权利要求书
1.  一种大间距模式下基于双目视觉图像的行星车定位方法，其特征在于，包括以下步骤：
S1、行星车在大间距的两个位置分别拍摄图像：将行星车分别移动到两个不同的位置，利用行星车的双目相机拍摄图像，两个位置分别称为上一站和当前站；
S2、行星车在不同位置拍摄图像的Affine-SIFT匹配：根据行星车在上一站和当前站拍摄图像时相机方向，分为同方向拍摄图像的Affine-SIFT匹配和对望图像的Affine-SIFT匹配，提取上一站拍摄的左图像和当前站拍摄的左图像的匹配特征点集；当选用同方向模式时，将上一站的左图像与当前站的左图像直接进行Affine-SIFT匹配；当选用对望模式时，首先将上一站和当前站的左图像生成相应的DOM正射影像图，再将所述相应的DOM正射影像图进行Affine-SIFT匹配；
S3、双目相机左右相机图像的立体匹配：根据同一站点左右相机图像和上一站与当前站点的匹配特征点集，通过左右图像的相关系数匹配方法，得到上一站与当前站点的匹配特征点集；再通过左右图像的最小二乘匹配方法，将图像匹配精度提高到子像素等级；
S4、匹配特征点的正确性检查：利用前方交会算法对立体匹配的结果进行检查，剔除错误的匹配特征点；
S5、计算行星车当前位置与姿态：利用光束法平差以共线方程为依据，根据行星车在上一站点左右相机的位置和姿态以及左右相机图像的匹配特征点集，构建多站点双相机测量定位模型，形成包含相机位置和姿态信息与匹配特征点坐标信息的统一误差方程和法方程，进而求解行星车在当前站点的位姿信息。

2.  如权利要求1所述的一种大间距模式下基于双目视觉图像的行星车定位方法，其特征在于，在S2中，当为对望模式时，将上一站和当前站的左图像生成相应DOM正射影像图，包括四个步骤：
1)确立像点坐标与地面点坐标的转换关系
地面坐标P(X，Y，Z)、相机的外方位参数原始图像上相应的像点坐标p(x，y)满足相机拍摄过程的共线方程，即满足：
x=-fa1(X-Xs)+b1(Y-Ys)+c1(Z-Zs)a3(X-Xs)+b3(Y-Ys)+c3(Z-Zs),y=-fa2(X-Xs)+b2(Y-Ys)+c2(Z-Zs)a3(X-Xs)+b3(Y-Ys)+c3(Z-Zs).---(1)]]>
其中，a1，a2，a3，b1，b2，b3，c1，c2，c3是从摄像机坐标到像平面坐标系旋转变换矩阵的元素
2)确立地面点坐标与DOM图像点坐标转换关系
设地面坐标为P(X，Y，Z)，对应的正射影像上一点P的坐标为(X′，Y′)，DOM正射影像在下角图廓点对应的地面坐标为(X0，Y0，Z0)，DOM正射影像比例尺分母为M，则地面坐标P(X，Y，Z)与DOM正射影像坐标(X′，Y′)间的转换关系表示为：
X=X0+MX′    (2)
Y=Y0+MY′
其中，Z是P点的高程，
3)确立像点坐标与DOM图像点坐标的转换关系
根据公式(1)(2)，得到原始图像的像点坐标p(x，y)与DOM正射影响坐标(X′，Y′)的转换关系，即：
x=-fa1(X0+MX′-Xs)+b1(Y0+MY′-Ys)-c1Zsa3(X0+MX′-Xs)+b3(Y0+MY′-Ys)-c3Zs,y=-fa2(X0+MX′-Xs)+b2(Y0+MY′-Ys)-c2Zsa3(X0+MX′-Xs)+b3(Y0+MY′-Ys)-c3Zs.---(3)]]>
3)DOM图的灰度内插及内插点的灰度赋值
根据公式(3)求得DOM正射影像图点的坐标(X′，Y′)与原始图像点坐标(x，y)的转换关系，采用双线性内插方法，求得P点的灰度值G(X′，Y′)的公式为：
G(X′,Y′)=1Δ2[(x1-X′)(y1-Y′)g(x1,y1)+(x1-X′)(Y′-y0)g(x1,y0)+(X′-x0)(Y′-y0)g(x0,y0)+(X′-x0)(y1-Y′)g(x0,y1)],]]>
其中，g(xi，yi)表示原始图像(xi，yi)像素点的灰度值，为DOM正射影像的扫描采样间隔；
依次对DOM正射影像的每个像素完成上述运算，即获得DOM正射影像。

3.  如权利要求1或2所述的一种大间距模式下基于双目视觉图像的行星车定位方法，其特征在于，S5具体包括以下步骤：
1)根据行星车在上一站的位置和姿态和通过前方交会计算图像匹配特征点和对应的观测点的地面坐标初值Pi(Xi，Yi，Zi)，然后根据观测点地面坐标初值采用后方交会方法计算当前站相机位置和姿态初值和作为光束法平差迭代计算的初始输入值；
2)将空间交会共线方程线性化，使用精确匹配特征点的像点坐标为观测值建立误差方程并线性化，则有公式(4)：

其中vx，vy为像点误差，a11，a12…a26为误差方程系数，分别为外方位角元素和线元素改正值，ΔX，ΔY，ΔZ为特征点对应物方点三维坐标的改正值，lx、ly为相应误差方程式的常数项，则：

将公式(5)简化，可得公式(6)，其中，i为相机的序号，j为观测点的序号：
AijΔi+BijΔj-li=vi     (6)
3)根据误差方程(6)，可得相应的法方程，求解行星车当前站点的位姿的改正数和观测点的位置的改正数ΔX，ΔY，ΔZ；然后利用改正数对行星车当前站点相机位置和姿态初值、观测点地面坐标初值进行改正，反复多次迭代，直至改正数小于规定限差，实现计算收敛；
通过上述求解过程，最终求得当前站左相机的精确位置和姿态即为行星车的位置和姿态。

说明书

说明书一种大间距模式下基于双目视觉图像的行星车定位方法
技术领域
本发明涉及行星车定位技术领域，尤其涉及一种大间距模式下基于视觉图像的行星车定位方法。
背景技术
计算机视觉技术，早在上个世纪70年代的探月活动中就开始得到应用。美国上世纪90年代开始研制的无人导航车，多采用双目视觉测量的导航技术。2003年JPL研发的勇气号和机遇号，以及2012年研发的好奇号，依靠自身的立体相机，实现了在火星表面的长距离安全行走。我国一些高校和科研院所也开始了行星车的研制。目前利用深空站跟踪数据和同波束干涉测量对行星车进行相对定位的精度约在百米量级，该指标远不能满足行星车在陆面行进的定位精度要求，因此行星车一般采用双目视觉系统来实现行星车的自主定位，通过双目视觉系统拍摄图像之间的匹配与特征点的空间关系解算行星车的位置和姿态。然而在大间距模式下利用双目视觉系统进行定位过程中，很难自动匹配图像特征点，并且构建多站点双相机测量定位模型，无法使行星车在未知环境行进时精确计算自身位置和姿势，实现行星车自主定位。
发明内容
本发明要解决的技术问题是，提供一种大间距模式下基于双目视觉图像的行星车定位方法，实现行星车自主定位。
为解决上述问题，本发明采用如下的技术方案：
一种大间距模式下基于双目视觉图像的行星车定位方法包括以下步骤：
S1、行星车在大间距的两个位置分别拍摄图像：将行星车分别移动到两个不同的位置，利用行星车的双目相机拍摄图像，两个位置分别称为上一站和当前站；
S2、行星车在不同位置拍摄图像的Affine-SIFT匹配：根据行星车在上一站和当前站拍摄图像时相机方向，分为同方向拍摄图像的Affine-SIFT匹配和对望图像的Affine-SIFT匹配，提取上一站和当前站图像的匹配特征点集；当选用同方向模式时，将上一站的左图像与当前站的左图像直接进行Affine-SIFT匹配；当选用对望模式时，首先将上一站和当前站的左图像生成相应的DOM正射影像图，然后将所述相应的DOM 正射影像图进行Affine-SIFT匹配；
S3、双目相机左右相机图像的立体匹配：根据同一站点左右相机图像和上一站与当前站点的匹配特征点集，通过相关系数匹配的方法，确定左右图像素点的匹配关系；再根据同一站点左右相机图像和相关系数匹配得到的匹配点坐标，通过左右图像的最小二乘匹配，将图像匹配精度提高到子像素等级；
S4、匹配特征点的正确性检查：利用前方交会算法对立体匹配的结果进行检查，剔除错误的匹配特征点；
S5、计算行星车当前站点位置与姿态：利用光束平差法以共线方程为依据，根据行星车在上一站点左右相机的位置和姿态以及左右相机图像的匹配特征点集，构建多站点双相机测量定位模型，形成包含相机位置和姿态信息与匹配特征点坐标信息的统一误差方程和法方程，进而求解行星车在当前站点的位姿信息。
本发明利用Affine-SIFT算法对上一站与当前站拍摄的左相机图像进行匹配，然后将匹配特征点作为输入，通过相关系数匹配算法进行上一站左、右图像和当前站左、右图像的特征匹配，利用最小二乘法使得影像匹配精度达到子像素等级；利用前方交会算法对上述的匹配结果进行检查，剔除错误匹配点，确保最终定位结算中匹配点输入的正确性；利用行星车双目摄像头在不同位置对目标区的拍摄关系，构建了多站点双相机测量定位模型，实现了通过光束平差算法对行星车位姿的求解。通过S2、S3、S4、S5四个步骤，能够准确地求解行星车的定位问题，通过S2、S3很好地解决行星车在大间距模式下拍摄图像的自动匹配问题，通过S5的行星车定位模型很好地实现了行星车位姿的解算。采用本发明技术方案，使行星车在未知环境行进时精确计算自身位置和姿态，实现行星车自主定位。
附图说明
图1为大间距模式下基于双目视觉对行星车进行定位的流程图；
图2为立体匹配中左图像目标区和右图像搜索区的关系示意图；
图3为立体匹配中最小二乘图像匹配的迭代过程示意图。
具体实施方式
如图1所示，本实施例提供一种大间距模式下基于双目视觉图像的行星车定位方法包括以下步骤：
S1、行星车在大间距的两个位置分别拍摄图像
将行星车分别移动到两个不同的位置，利用行星车的双目相机拍摄图像，两个位置分别称为上一站和当前站。
S2、行星车在不同位置拍摄的图像进行特征提取与匹配
Affine-SIFT方法是一种具备完全仿射不变特征的特征提取与匹配算法。该算法是在SIFT算法的基础上通过增加仿射变换处理改进而来的，能够处理旋转和相对倾斜较大的图像间的匹配；Affine-SIFT通过模拟相机的光轴旋转对图像进行预处理来模拟图像的倾斜变化，实现完全意义上的仿射，能够提高匹配的成功率与正确性。结合Affine-SIFT匹配算法的特点，将行星车在不同位置拍摄的图像进行特征提取与匹配。
根据行星车在上一站和当前站拍摄图像时相机方向，分为同方向拍摄图像的Affine-SIFT匹配和对望图像的Affine-SIFT匹配，提取上一站拍摄的左图像和当前站拍摄的左图像的匹配特征点集{(xFLi,yFLi),(xCLi,yCLi)|i=0,1,...,N}.]]>
当为同方向模式时，将上一站相机拍摄的左图像与当前站相机拍摄的左图像(即L上、L当)直接进行Affine-SIFT特征提取与匹配。
当为对望模式时，先将上一站相机和当前站相机拍摄的左图像(即L上、L当)生成相应的DOM正射影像图，即L′上、L′当，再对所述相应的DOM正射影像图(即L′上和L′当)进行Affine-SIFT特征提取与匹配。
其中，将上一站和当前站的左图像(即L上、L当)生成相应的DOM正射影像图，即L′上、L′当，包括四个步骤：
1)确立像点坐标与地面点坐标的转换关系
地面坐标P(X，Y，Z)、相机的外方位参数原始图像上相应的像点坐标p(x，y)满足相机拍摄过程的共线方程，即满足：
x=-fa1(X-Xs)+b1(Y-Ys)+c1(Z-Zs)a3(X-Xs)+b3(Y-Ys)+c3(Z-Zs),y=-fa2(X-Xs)+b2(Y-Ys)+c2(Z-Zs)a3(X-Xs)+b3(Y-Ys)+c3(Z-Zs).---(1)]]>
其中，a1，a2，a3，b1，b2，b3，c1，c2，c3是从摄像机坐标到像平面坐标系旋转变换矩阵的元素， Xs，Ys，Zs为平移参数，为旋转参数，即满足：
xy-f=a1b1c1a2b2c2a3b3c3XYZ,]]>
其中，(x，y)是像平面坐标，f是焦距。
2)确立地面点坐标与DOM图像点坐标转换关系
设地面坐标为P(X，Y，Z)，对应的正射影像上一点P的坐标为(X′，Y′)，DOM正射影像在下角图廓点对应的地面坐标为(X0，Y0，Z0)，DOM正射影像比例尺分母为M，则地面坐标P(X，Y，Z)与DOM正射影像坐标(X′，Y′)间的转换关系表示为：
X=X0+MX′     (2)
Y=Y0+MY′
其中，Z是P点的高程，令Z=Z0，将地面三维坐标点按照公式式(2)统一降低到同一平面，然后对平面中的每一个坐标进行灰度赋值即可生成的DOM图。
3)确立像点坐标与DOM图像点坐标的转换关系
联立公式(1)(2)，可以得到原始图像的像点坐标p(x，y)与DOM正射影响坐标(X′，Y′)的转换关系，即：
x=-fa1(X0+MX′-Xs)+b1(Y0+MY′-Ys)-c1Zsa3(X0+MX′-Xs)+b3(Y0+MY′-Ys)-c3Zs,y=-fa2(X0+MX′-Xs)+b2(Y0+MY′-Ys)-c2Zsa3(X0+MX′-Xs)+b3(Y0+MY′-Ys)-c3Zs.---(3)]]>
3)DOM图的灰度内插及内插点的灰度赋值
根据公式(3)求得DOM正射影像图点的坐标(X′，Y′)与原始图像点坐标(x，y)的转换关系。由于所求得的像点坐标不一定正好落在其扫描采样的点上，为此这个像点的灰度值不能直接读出，必须进行灰度内插。采用双线性内插方法，求得P点的灰度值G(X′，Y′)的公式为：
G(X′,Y′)=1Δ2[(x1-X′)(y1-Y′)g(x1,y1)+(x1-X′)(Y′-y0)g(x1,y0)+(X′-x0)(Y′-y0)g(x0,y0)+(X′-x0)(y1-Y′)g(x0,y1)],---(4)]]>
其中，g(xi，yi)表示原始图像(xi，yi)像素点的灰度值，为DOM正射影像的扫描采样间隔。
依次对DOM正射影像的每个像素完成上述运算，即获得DOM正射影像，即为L′上、L′当。
S3、双目相机左右图像的立体匹配
步骤一：左右图像的相关系数匹配：以同一站点左右相机图像和上一站与当前站点的匹配特征点集作为输入，通过相关系数匹配的方法，快速确定左右图像素点的匹配关系。主要步骤如下：
1)以上一站或当前站点左图像的某个匹配特征点作为目标点，以此点为中心选取m×n个像素的灰度阵列作为目标区，如图2左侧目标区所示。
2)为了在右图像上搜索左图目标点的匹配点，先估计出该匹配点可能存在的大致范围，确定一个k×l(k>m，l>n)个像素的灰度阵列作为搜索区，如图2右侧搜索区所示。
3)依次在搜索区中取出m×n个像素灰度阵列(搜索窗口通常取m=n)，计算其与目标区的相似性测度ρij(i=i0-l2+n2,...,i0+l2-n2;j=j0-k2+m2,...,j0+k2-m2),]]>(i0，j0)为搜索区中心像素。当ρij取得最大值时，则认为该搜索窗口的中心像素是目标点的匹配点，记匹配点坐标为即或
ρxRi,yRi=maxρiji=i0-l2+n2,...,i0+l2-n2,j=j0-k2+m2,...,j0+k2-m2.---(5)]]>
其中，相似性测度ρij通过目标区图像和搜索区以为中心的m×n个像素阵列的相关系数ρk计算。
ρk=σgg′σggσg′g′(k=0,1,...,m-n)---(6)]]>
设目标点在左图像中的坐标为(x，y)，搜索区内某个点的坐标为(x′，y′)，(x′，y′)相对于(x，y)的偏移表示为(k1，k2)，g(x，y)是以(x，y)为中心的目标区图像，g′(x′，y′)是搜索区中以(x′，y′)为中心的搜索区内m×n像素的图像区域，gij是为目标区坐标(i，j)的图像灰度，是以(x，y)为中心的目标区影像灰度的平均值，是以(x′，y′)为中心的目标区图像灰度的平均值，σgg′是以(x，y)为中心的目标区影像和以(x′，y′)为中心的影像的方差，σgg以(x，y)为中心的目标区图像的方差，σg′g′是搜索区中以(x′，y′)为中心的图像的方差。它们之间的关系式：
g&OverBar;=1mnΣi=1mΣj=1ngij,]]>
g&OverBar;′=1mnΣi=1mΣj=1ngi+k1,j+k2′,]]>
σgg=1mnΣi=1mΣj=1ngij2-g2,---(7)]]>
σg′g′=1mnΣi=1mΣj=1ngi+k1,j+k2′2-g&OverBar;′g&OverBar;′,]]>
σgg′=1mnΣi=1mΣj=1ngijgi+k1,j+k2-gg.]]>
通过左右图像的相关系数匹配，得到上一站与当前站点的匹配特征点集对应的上一站点和当前站点左右图像的匹配点集：{(xFLi,yFLi,xCLi,yCLi),(xFRi,yFRi,xCRi,yCRi)|i=0,1,...,N}.,]]>其中，为相关系数匹配的匹配点，为的相关系数匹配的匹配点。
步骤二：左右图像的最小二乘匹配：以同一站点左右相机图像和相关系数匹配得到的匹配点坐标{(xFLi,yFLi,xCLi),(xFRi,yFRi,xCRi,yCRi)|i=0,1,...,N}.]]>作为输入，通过左右图像的最小二乘匹配，将图像匹配精度提高到子像素等级。如图3所示，主要步骤如下：
1)几何畸变改正：设左图像中特征点坐标为或根据几何变形参数a0，a1，a2，b0，b1，b2将左方图像窗口的像片点变换至右方图像点或因到的变换和到的变换形式完全相同，后面仅对到的变换进行描述。
xFRi=a0+a1xFLi+a2yFLi,xFRi=b0+b1xFLi+b2yFLi.---(8)]]>
考虑右图像相对于左图像的线性灰度畸变可得：
g1(xFLi,yFLi)+n1(xFLi,yFLi)=h0+h1g2(a0+a1xFLi+a2yFLi,b0+b1xFLi+b2yFLi)+n2(xFLi,yFLi)---(9)]]>
其中，g1和g2表示左图像和右图像中像素点的灰度值，n1和n2表示左图像和右图像中像素点的灰度噪声，h0、h1和h2分别表示左右图像线性灰度变换的辐射畸变参数。
2)重采样：根据公式(9)采用双线性内插进行灰度重采样计算线性化后，可得最小二乘图像匹配的误差方程式：
v=c1dh0+c2dh1+c3da0+c4da1+c3da2+c6db0+c7db1+c8db2-Δg     (10)其中，dh0，dh1，da0，…db2是畸变参数的改正值，Δg是相应像素的灰度差，ci，i=1，2，…，8是畸变参数改正数的系数，v是像点误差。
3)辐射畸变改正：利用由最小二乘图像匹配误差方程求得的辐射畸变参数h0，h1，对上述重采样结果作辐射改正，即
4)计算左图像区域与经过几何、辐射改正后的右图像区域的灰度阵列之间的相关系数ρ。若相关系数ρ小于前一次迭代后所求得的相关系数，则计算最佳匹配点，迭代结束；否则进行步骤5)；
5)采用最小二乘图像匹配，解求变形参数的改正值dh0，dh1，da0…；
6)计算变形参数：设是前一次变形参数，是本次迭代所求得的改正值，则几何变形参数通过如下关系改正：
&DoubleRightArrow;1xFRiyFRi=100a0ia1ia2ib0ib1ib2i1xFLiyFLi=100da0i1+da1ida2idb0idb1idn2i100a0i-1a1i-1a2i-1b0i-1b1i-1b2i-11xFLiyFLi,a0i=a0i-1+da0i+a0i-1da1i+b0i-1da2ia1i=a1i-1+a1i-1da1i+b2i-1da2ia2i=a2i-1+a2i-1da1i+b2i-1da2ib0i=b0i-1+db0i+a0i-1db1i+b0i-1db2ib1i=b1i-1+a1i-1db1i+b1i-1db2ib2i=b2i-1+a2i-1db1i+b2i-1db2i]]>
辐射畸变参数通过如下关系改正：
&DoubleRightArrow;1g110dh0i1+dh1i10h0i-1h1i-11g2,h0i=h0i-1+dh0i+h0i-1dh1i,h1i=h1i-1+h1i-1dh1i.]]>
7)计算左图目标点的右图匹配点：根据最小二乘匹配的精度理论可知，坐标精度取决于图像灰度的梯度根据梯度的平方为权，在左图像以为中心的区域窗口WL内对坐标作加权平均：
xFLti=Σx&Element;WLx·g·x2/Σx&Element;WLg·x2,]]>
yFLti=Σy&Element;WLy·g·y2/Σy&Element;WLg·y2.]]>
以它作为目标点坐标，根据最小二乘图像匹配所求得的几何变换参数求得上一站右图像中的匹配点坐标：
xFRti=a0+a1xFLti+a2yFLti,]]>
yFRti=b0+b1xFLti+b2yFLti.]]>
同理可得到当前站左右图像中的匹配点坐标和通过左右图像的最小二乘匹配，将相关系数匹配后得到的上一站点和当前站点左右图像的匹配点集{(xFLi,yFLi,xCLi),(xFRi,yFRi,xCRi,yCRi)|i=0,1,...,N}.]]>进行更新，得到新上一站点和当前站点左右图像的匹配点集：
{(xFLti,yFLti,xCLti,yCLti),(xFRti,yFRti,xCRti,yCRti)|i=0,1,...,N}.]]>
S4、匹配特征点的正确性检查
利用前方交会算法对立体匹配的结果进行检查，剔除错误的匹配点。具体步骤如下：
1)将上一站点和当前站点左右相机图像的匹配特征点集和作为输入，利用前方交会的方法计算获得其对应的地面观测点Pi，i=1，2，…，n的在上一站点和当前站点相机坐标系(左相机坐标系或右相机坐标系)下的三维坐标，设在前一站坐标系下的三维坐标计作Pi(Xi，Yi，Zi)，在当前站坐标系下的三维坐标计作Pi′(Xi′，Yi′，Zi′)；
2)利用获得的匹配点在前一站和当前站坐标系下的坐标计算它们对应的中心点然后计算每点与Pc的距离Di=|Pi-Pc|，Di′=|Pi′-Pc′|；
3)计算ΔDi=|Di-Di′|，剔除满足的Pi点对应的上一站点和当前站点左右图像的匹配点和其中α是权重系数，一般情况下α=3；
4)重复步骤2)和3)，直至所有点对应的ΔDi满足
剔除错误特征点后，输出上一站点和当前站点左右相机图像的匹配特征点集，其中包含的特征点数量要求大于等于4组。新的上一站点和当前站点左右相机图像的匹配特征点集表示为：
{(xFLti,yFLti,xCLti,yCLti),(xFRti,yFRti,xCRti,yCRti)|i=0,1,...,N}.]]>
S5、计算行星车当前位置与姿态
利用光束法平差以共线方程为依据，将行星车在上一站点左右相机的位置和姿态以及左右相机图像的匹配特征点{(xFLti,yFLti,xCLti,yCLti),(xFRti,yFRti,xCRti,yCRti)|i=0,1,...,N}.]]>作为整体输入，构建多站点双相机测量定位模型，形成包含相机位置和姿态信息与匹配特征点坐标的统一误差方程和法方程，求解行星车在当前站点的位姿信息，具体步骤如下：
1)根据行星车在上一站点左右相机位置和姿态和通过前方交会计算图像匹配特征点和对应的观测点的地面坐标初值Pi(Xi，Yi，Zi)，然后根据观测点地面坐标初值采用后方交会方法计算当前站相机位置和姿态初值和作为光束法平差迭代计算的初始输入值；
2)将空间交会共线方程(公式(2))线性化，使用精确匹配特征点的像点坐标为观测值建立误差方程并线性化，则有公式(11)：

其中vx，vy为像点误差，a11，a12…a26为误差方程系数，分别为当前站点的位姿的改正值，ΔX，ΔY，ΔZ为观测点的位置的改正值，lx、ly为相应误差方程式的常数项，有公式(12)：

将公式(12)简化，可得公式(13)，其中i为相机的序号，j为观测点的序号：
AijΔi+BijΔj-li=vi     (13)
3)根据误差方程(13)，可得相应的法方程，求解行星车当前站点的位姿的改正数和观测点的位置的改正数ΔX，ΔY，ΔZ。然后利用改正数对行星车当前站点相机位置和姿态初值、观测点地面坐标初值进行改正，反复多次迭代，直至改正数小于规定限差，实现计算收敛。
通过上述求解过程，最终求得当前站左相机的精确位置和姿态即为行星车的位置和姿态。
以上所述，仅为本发明中的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉该技术的人在本发明所揭露的技术范围内，可理解想到的变换或替换，都应涵盖在本发明的包含范围之内，因此，本发明的保护范围应该以权利要求书的保护范围为准。

资源描述

《一种大间距模式下基于双目视觉图像的行星车定位方法.pdf》由会员分享，可在线阅读，更多相关《一种大间距模式下基于双目视觉图像的行星车定位方法.pdf（14页珍藏版）》请在专利查询网上搜索。

1、(10)申请公布号 CN 103927738 A (43)申请公布日 2014.07.16 CN 103927738 A (21)申请号 201410015292.6 (22)申请日 2014.01.10 G06T 7/00(2006.01) (71)申请人北京航天飞行控制中心地址 100094 北京市海淀区北清路 26 号 (72)发明人王保丰刘传凯王镓申敬松唐歌实张强卜彦龙罗建军许柏 (74)专利代理机构国防专利服务中心 11043 代理人江亚平 (54) 发明名称一种大间距模式下基于双目视觉图像的行星车定位方法 (57) 摘要本发明公开一种大间距模式下基于。

2、双目视觉图像的行星车定位方法，包括以下步骤：行星车在大间距的两个位置分别拍摄图像；对两个位置拍摄的左相机图像进行 A-SIFT 匹配；双目相机左右相机图像的立体匹配；匹配特征点的正确性检查；行星车当前位置与姿态的计算。采用本发明的技术方案，使行星车在未知环境行进时精确计算自身位置和姿态，实现行星车自主定位。 (51)Int.Cl. 权利要求书 3 页说明书 8 页附图 2 页 (19)中华人民共和国国家知识产权局 (12)发明专利申请权利要求书3页说明书8页附图2页 (10)申请公布号 CN 103927738 A CN 103927738 A。

3、 1/3 页 2 1. 一种大间距模式下基于双目视觉图像的行星车定位方法，其特征在于，包括以下步骤： S1、行星车在大间距的两个位置分别拍摄图像：将行星车分别移动到两个不同的位置，利用行星车的双目相机拍摄图像，两个位置分别称为上一站和当前站； S2、行星车在不同位置拍摄图像的 Affine-SIFT 匹配：根据行星车在上一站和当前站拍摄图像时相机方向，分为同方向拍摄图像的 Affine-SIFT 匹配和对望图像的 Affine-SIFT 匹配，提取上一站拍摄的左图像和当前站拍摄的左图像的匹配特征点集；当选用同方向模式时，将上一站的左图像与当前站的左图像直。

4、接进行 Affine-SIFT 匹配；当选用对望模式时，首先将上一站和当前站的左图像生成相应的 DOM 正射影像图，再将所述相应的 DOM 正射影像图进行 Affine-SIFT 匹配； S3、双目相机左右相机图像的立体匹配：根据同一站点左右相机图像和上一站与当前站点的匹配特征点集，通过左右图像的相关系数匹配方法，得到上一站与当前站点的匹配特征点集；再通过左右图像的最小二乘匹配方法，将图像匹配精度提高到子像素等级； S4、匹配特征点的正确性检查：利用前方交会算法对立体匹配的结果进行检查，剔除错误的匹配特征点； S5、计算行星车当前位置与姿态：。

5、利用光束法平差以共线方程为依据，根据行星车在上一站点左右相机的位置和姿态以及左右相机图像的匹配特征点集，构建多站点双相机测量定位模型，形成包含相机位置和姿态信息与匹配特征点坐标信息的统一误差方程和法方程，进而求解行星车在当前站点的位姿信息。 2. 如权利要求 1 所述的一种大间距模式下基于双目视觉图像的行星车定位方法，其特征在于，在 S2 中，当为对望模式时，将上一站和当前站的左图像生成相应 DOM 正射影像图，包括四个步骤： 1) 确立像点坐标与地面点坐标的转换关系地面坐标 P(X， Y， Z)、相机的外方位参数原始图像上相应的像点坐标 p(x， y) 满。

6、足相机拍摄过程的共线方程，即满足：其中， a1， a2， a3， b1， b2， b3， c1， c2， c3是从摄像机坐标到像平面坐标系旋转变换矩阵的元素 2) 确立地面点坐标与 DOM 图像点坐标转换关系设地面坐标为 P(X， Y， Z)，对应的正射影像上一点 P 的坐标为 (X， Y )， DOM 正射影像在下角图廓点对应的地面坐标为 (X0， Y0， Z0)， DOM 正射影像比例尺分母为 M，则地面坐标 P(X， Y， Z) 与 DOM 正射影像坐标 (X， Y ) 间的转换关系表示为： X=X0+MX (2) Y=Y0+MY 其中， Z 是 P 点的高程，权利。

7、要求书 CN 103927738 A 2 2/3 页 3 3) 确立像点坐标与 DOM 图像点坐标的转换关系根据公式 (1)(2)，得到原始图像的像点坐标 p(x， y) 与 DOM 正射影响坐标 (X， Y ) 的转换关系，即： 3)DOM 图的灰度内插及内插点的灰度赋值根据公式 (3) 求得 DOM 正射影像图点的坐标 (X， Y ) 与原始图像点坐标 (x， y) 的转换关系，采用双线性内插方法，求得 P 点的灰度值 G(X， Y ) 的公式为：其中， g(xi， yi) 表示原始图像 (xi， yi) 像素点的灰度值，为 DOM 正射影像的扫描采样间隔；依。

8、次对 DOM 正射影像的每个像素完成上述运算，即获得 DOM 正射影像。 3. 如权利要求 1 或 2 所述的一种大间距模式下基于双目视觉图像的行星车定位方法，其特征在于， S5 具体包括以下步骤： 1) 根据行星车在上一站的位置和姿态和通过前方交会计算图像匹配特征点和对应的观测点的地面坐标初值 Pi(Xi， Yi， Zi)，然后根据观测点地面坐标初值采用后方交会方法计算当前站相机位置和姿态初值和作为光束法平差迭代计算的初始输入值； 2) 将空间交会共线方程线性化，使用精确匹配特征点的像点坐标为观测值建立误差方程并线性化，则有公式 (4) ：。

9、其中 vx， vy为像点误差， a11， a12a26为误差方程系数，分别为外方位角元素和线元素改正值， X， Y， Z 为特征点对应物方点三维坐标的改正值， lx、 ly为相应误差方程式的常数项，则：权利要求书 CN 103927738 A 3 3/3 页 4 将公式 (5) 简化，可得公式 (6)，其中， i 为相机的序号， j 为观测点的序号： Aiji+Bijj-li=vi (6) 3) 根据误差方程 (6)，可得相应的法方程，求解行星车当前站点的位姿的改正数和观测点的位置的改正数 X， Y， Z ；然后利用改正数对行星车当前站点相机位置和姿态初值、。

10、观测点地面坐标初值进行改正，反复多次迭代，直至改正数小于规定限差，实现计算收敛；通过上述求解过程，最终求得当前站左相机的精确位置和姿态即为行星车的位置和姿态。权利要求书 CN 103927738 A 4 1/8 页 5 一种大间距模式下基于双目视觉图像的行星车定位方法技术领域 0001 本发明涉及行星车定位技术领域，尤其涉及一种大间距模式下基于视觉图像的行星车定位方法。背景技术 0002 计算机视觉技术，早在上个世纪 70 年代的探月活动中就开始得到应用。美国上世纪 90 年代开始研制的无人导航车，多采用双目。

11、视觉测量的导航技术。2003 年 JPL 研发的勇气号和机遇号，以及 2012 年研发的好奇号，依靠自身的立体相机，实现了在火星表面的长距离安全行走。我国一些高校和科研院所也开始了行星车的研制。目前利用深空站跟踪数据和同波束干涉测量对行星车进行相对定位的精度约在百米量级，该指标远不能满足行星车在陆面行进的定位精度要求，因此行星车一般采用双目视觉系统来实现行星车的自主定位，通过双目视觉系统拍摄图像之间的匹配与特征点的空间关系解算行星车的位置和姿态。然而在大间距模式下利用双目视觉系统进行定位过程中，很难自动匹配图像特征点，并且构建多站点双相机测量定位模型，无法使行。

12、星车在未知环境行进时精确计算自身位置和姿势，实现行星车自主定位。发明内容 0003 本发明要解决的技术问题是，提供一种大间距模式下基于双目视觉图像的行星车定位方法，实现行星车自主定位。 0004 为解决上述问题，本发明采用如下的技术方案： 0005 一种大间距模式下基于双目视觉图像的行星车定位方法包括以下步骤： 0006 S1、行星车在大间距的两个位置分别拍摄图像：将行星车分别移动到两个不同的位置，利用行星车的双目相机拍摄图像，两个位置分别称为上一站和当前站； 0007 S2、行星车在不同位置拍摄图像的 Affine-SIFT 匹配：根据行星车在上一站和。

13、当前站拍摄图像时相机方向，分为同方向拍摄图像的 Affine-SIFT 匹配和对望图像的 Affine-SIFT 匹配，提取上一站和当前站图像的匹配特征点集；当选用同方向模式时，将上一站的左图像与当前站的左图像直接进行 Affine-SIFT 匹配；当选用对望模式时，首先将上一站和当前站的左图像生成相应的 DOM 正射影像图，然后将所述相应的 DOM 正射影像图进行 Affine-SIFT 匹配； 0008 S3、双目相机左右相机图像的立体匹配：根据同一站点左右相机图像和上一站与当前站点的匹配特征点集，通过相关系数匹配的方法，确定左右图像素点的匹配关系；。

14、再根据同一站点左右相机图像和相关系数匹配得到的匹配点坐标，通过左右图像的最小二乘匹配，将图像匹配精度提高到子像素等级； 0009 S4、匹配特征点的正确性检查：利用前方交会算法对立体匹配的结果进行检查，剔除错误的匹配特征点； 0010 S5、计算行星车当前站点位置与姿态：利用光束平差法以共线方程为依据，根据行说明书 CN 103927738 A 5 2/8 页 6 星车在上一站点左右相机的位置和姿态以及左右相机图像的匹配特征点集，构建多站点双相机测量定位模型，形成包含相机位置和姿态信息与匹配特征点坐标信息的统一误差方程和法方程，进而求解行星车在当。

15、前站点的位姿信息。 0011 本发明利用 Affine-SIFT 算法对上一站与当前站拍摄的左相机图像进行匹配，然后将匹配特征点作为输入，通过相关系数匹配算法进行上一站左、右图像和当前站左、右图像的特征匹配，利用最小二乘法使得影像匹配精度达到子像素等级；利用前方交会算法对上述的匹配结果进行检查，剔除错误匹配点，确保最终定位结算中匹配点输入的正确性；利用行星车双目摄像头在不同位置对目标区的拍摄关系，构建了多站点双相机测量定位模型，实现了通过光束平差算法对行星车位姿的求解。通过 S2、 S3、 S4、 S5 四个步骤，能够准确地求解行星车的定位问题，通过。

16、S2、 S3 很好地解决行星车在大间距模式下拍摄图像的自动匹配问题，通过 S5 的行星车定位模型很好地实现了行星车位姿的解算。采用本发明技术方案，使行星车在未知环境行进时精确计算自身位置和姿态，实现行星车自主定位。附图说明 0012 图 1 为大间距模式下基于双目视觉对行星车进行定位的流程图； 0013 图 2 为立体匹配中左图像目标区和右图像搜索区的关系示意图； 0014 图 3 为立体匹配中最小二乘图像匹配的迭代过程示意图。具体实施方式 0015 如图 1 所示，本实施例提供一种大间距模式下基于双目视觉图像的行星车定位方法包括以下步骤： 0016 S1、行星车在大。

17、间距的两个位置分别拍摄图像 0017 将行星车分别移动到两个不同的位置，利用行星车的双目相机拍摄图像，两个位置分别称为上一站和当前站。 0018 S2、行星车在不同位置拍摄的图像进行特征提取与匹配 0019 Affine-SIFT 方法是一种具备完全仿射不变特征的特征提取与匹配算法。该算法是在 SIFT 算法的基础上通过增加仿射变换处理改进而来的，能够处理旋转和相对倾斜较大的图像间的匹配； Affine-SIFT 通过模拟相机的光轴旋转对图像进行预处理来模拟图像的倾斜变化，实现完全意义上的仿射，能够提高匹配的成功率与正确性。结合 Affine-SIFT 匹配算法的特点，。

18、将行星车在不同位置拍摄的图像进行特征提取与匹配。 0020 根据行星车在上一站和当前站拍摄图像时相机方向，分为同方向拍摄图像的 Affine-SIFT 匹配和对望图像的 Affine-SIFT 匹配，提取上一站拍摄的左图像和当前站拍摄的左图像的匹配特征点集 0021 当为同方向模式时，将上一站相机拍摄的左图像与当前站相机拍摄的左图像 ( 即 L上、 L当) 直接进行 Affine-SIFT 特征提取与匹配。 0022 当为对望模式时，先将上一站相机和当前站相机拍摄的左图像 ( 即 L上、 L当) 生成相应的DOM正射影像图，即L上、 L当，再对所述相应的DOM正射影像图(即L上。

19、和L当) 进行 Affine-SIFT 特征提取与匹配。 0023 其中，将上一站和当前站的左图像 ( 即 L上、 L当) 生成相应的 DOM 正射影像图，即说明书 CN 103927738 A 6 3/8 页 7 L上、 L当，包括四个步骤： 0024 1) 确立像点坐标与地面点坐标的转换关系 0025 地面坐标 P(X， Y， Z)、相机的外方位参数原始图像上相应的像点坐标 p(x， y) 满足相机拍摄过程的共线方程，即满足： 0026 0027 其中， a1， a2， a3， b1， b2， b3， c1， c2， c3是从摄像机坐标到像平面坐标系旋转变换矩阵的元。

20、素， Xs， Ys， Zs为平移参数，为旋转参数，即满足： 0028 0029 其中， (x， y) 是像平面坐标， f 是焦距。 0030 2) 确立地面点坐标与 DOM 图像点坐标转换关系 0031 设地面坐标为 P(X， Y， Z)，对应的正射影像上一点 P 的坐标为 (X， Y )， DOM 正射影像在下角图廓点对应的地面坐标为 (X0， Y0， Z0)， DOM 正射影像比例尺分母为 M，则地面坐标 P(X， Y， Z) 与 DOM 正射影像坐标 (X， Y ) 间的转换关系表示为： 0032 X=X0+MX (2) 0033 Y=Y0+MY 0034 其中， Z 是。

21、P 点的高程，令 Z=Z0，将地面三维坐标点按照公式式 (2) 统一降低到同一平面，然后对平面中的每一个坐标进行灰度赋值即可生成的 DOM 图。 0035 3) 确立像点坐标与 DOM 图像点坐标的转换关系 0036 联立公式 (1)(2)，可以得到原始图像的像点坐标 p(x， y) 与 DOM 正射影响坐标 (X， Y ) 的转换关系，即： 0037 0038 3)DOM 图的灰度内插及内插点的灰度赋值 0039 根据公式 (3) 求得 DOM 正射影像图点的坐标 (X， Y ) 与原始图像点坐标 (x， y) 的转换关系。由于所求得的像点坐标不一定正好落在其扫描采样的点上，。

22、为此这个像点的灰度值不能直接读出，必须进行灰度内插。采用双线性内插方法，求得P点的灰度值G(X， Y ) 的公式为： 0040 0041 其中， g(xi， yi) 表示原始图像 (xi， yi) 像素点的灰度值，说明书 CN 103927738 A 7 4/8 页 8 为 DOM 正射影像的扫描采样间隔。 0042 依次对 DOM 正射影像的每个像素完成上述运算，即获得 DOM 正射影像，即为 L上、 L当。 0043 S3、双目相机左右图像的立体匹配 0044 步骤一：左右图像的相关系数匹配：以同一站点左右相机图像和上一站与当前站点的匹配特征点集作为输入，。

23、通过相关系数匹配的方法，快速确定左右图像素点的匹配关系。主要步骤如下： 0045 1) 以上一站或当前站点左图像的某个匹配特征点作为目标点，以此点为中心选取 mn 个像素的灰度阵列作为目标区，如图 2 左侧目标区所示。 0046 2) 为了在右图像上搜索左图目标点的匹配点，先估计出该匹配点可能存在的大致范围，确定一个 kl(km， ln) 个像素的灰度阵列作为搜索区，如图 2 右侧搜索区所示。 0047 3) 依次在搜索区中取出 mn 个像素灰度阵列 ( 搜索窗口通常取 m=n)，计算其与目标区的相似性测度(i0， j0) 为搜索区中心像素。当 ij取得最大值时，则认为该。

24、搜索窗口的中心像素是目标点的匹配点，记匹配点坐标为即或 0048 0049 其中，相似性测度ij通过目标区图像和搜索区以为中心的mn个像素阵列的相关系数 k计算。 0050 0051 设目标点在左图像中的坐标为 (x， y)，搜索区内某个点的坐标为 (x， y )， (x， y ) 相对于 (x， y) 的偏移表示为 (k1， k2)， g(x， y) 是以 (x， y) 为中心的目标区图像， g (x， y ) 是搜索区中以 (x， y ) 为中心的搜索区内 mn 像素的图像区域， gij是为目标区坐标 (i， j) 的图像灰度，是以 (x， y) 为中心的目标区影像灰度的平均。

25、值，是以 (x， y ) 为中心的目标区图像灰度的平均值， gg是以 (x， y) 为中心的目标区影像和以 (x， y ) 为中心的影像的方差， gg以 (x， y) 为中心的目标区图像的方差， g g是搜索区中以 (x， y ) 为中心的图像的方差。它们之间的关系式： 0052 0053 0054 说明书 CN 103927738 A 8 5/8 页 9 0055 0056 0057 通过左右图像的相关系数匹配，得到上一站与当前站点的匹配特征点集对应的上一站点和当前站点左右图像的匹配点集：其中，为相关系数匹配的匹配点，为的相关系数匹配的匹配点。 0058 步骤二：左右。

26、图像的最小二乘匹配：以同一站点左右相机图像和相关系数匹配得到的匹配点坐标作为输入，通过左右图像的最小二乘匹配，将图像匹配精度提高到子像素等级。如图 3 所示，主要步骤如下： 0059 1) 几何畸变改正：设左图像中特征点坐标为或根据几何变形参数 a0， a1， a2， b0， b1， b2将左方图像窗口的像片点变换至右方图像点或因到的变换和到的变换形式完全相同，后面仅对到的变换进行描述。 0060 0061 考虑右图像相对于左图像的线性灰度畸变可得： 0062 0063 其中， g1和 g2表示左图像和右图像中像素点的灰度值， n1和 n2表示左图像和右图像中像。

27、素点的灰度噪声， h0、 h1和 h2分别表示左右图像线性灰度变换的辐射畸变参数。 0064 2) 重采样：根据公式 (9) 采用双线性内插进行灰度重采样计算线性化后，可得最小二乘图像匹配的误差方程式： 0065 v=c1dh0+c2dh1+c3da0+c4da1+c3da2+c6db0+c7db1+c8db2-g (10) 其中， dh0， dh1， da0，db2是畸变参数的改正值， g 是相应像素的灰度差， ci， i=1， 2， 8 是畸变参数改正数的系数， v 是像点误差。 0066 3) 辐射畸变改正：利用由最小二乘图像匹配误差方程求得的辐射畸变参数 h0， h1，。

28、对上述重采样结果作辐射改正，即 0067 4) 计算左图像区域与经过几何、辐射改正后的右图像区域的灰度阵列之间的相关系数。若相关系数小于前一次迭代后所求得的相关系数，则计算最佳匹配点，迭代结束；否则进行步骤 5) ； 0068 5) 采用最小二乘图像匹配，解求变形参数的改正值 dh0， dh1， da0 ； 0069 6) 计算变形参数：设是前一次变形参数，是本次迭代所求得的改正值，则几何变形参数通过如下关系改正：说明书 CN 103927738 A 9 6/8 页 10 0070 0071 辐射畸变参数通过如下关系改正： 0072 0073 7) 计算。

29、左图目标点的右图匹配点：根据最小二乘匹配的精度理论可知，坐标精度取决于图像灰度的梯度根据梯度的平方为权，在左图像以为中心的区域窗口 WL内对坐标作加权平均： 0074 0075 0076 以它作为目标点坐标，根据最小二乘图像匹配所求得的几何变换参数求得上一站右图像中的匹配点坐标： 0077 0078 0079 同理可得到当前站左右图像中的匹配点坐标和通过左右图像的最小二乘匹配，将相关系数匹配后得到的上一站点和当前站点左右图像的匹配点集进行更新，得到新上一站点和当前站点左右图像的匹配点集： 0080 0081 S4、匹配特征点的正确性检查 0082 利用前方交会。

30、算法对立体匹配的结果进行检查，剔除错误的匹配点。具体步骤如下： 0083 1) 将上一站点和当前站点左右相机图像的匹配特征点集和作为输入，利用前方交会的方法计算获得其对应的地面观测点 Pi， i=1， 2， n 的在上一站点和当前站点相机坐标系 ( 左相机坐标系或右相机坐标系 ) 下的三维坐标，设在前一站坐标系下的三维坐标计作 Pi(Xi， Yi， Zi)，在当前站坐标系下的三维坐标计说明书 CN 103927738 A 10 7/8 页 11 作 Pi (Xi， Yi， Zi ) ； 0084 2) 利用获得的匹配点在前一站和当前站坐标系下的坐标计算它们对应的中心点然。

32、在上一站点左右相机的位置和姿态以及左右相机图像的匹配特征点作为整体输入，构建多站点双相机测量定位模型，形成包含相机位置和姿态信息与匹配特征点坐标的统一误差方程和法方程，求解行星车在当前站点的位姿信息，具体步骤如下： 0091 1) 根据行星车在上一站点左右相机位置和姿态和通过前方交会计算图像匹配特征点和对应的观测点的地面坐标初值 Pi(Xi， Yi， Zi)，然后根据观测点地面坐标初值采用后方交会方法计算当前站相机位置和姿态初值和作为光束法平差迭代计算的初始输入值； 0092 2)将空间交会共线方程(公式(2)线性化，使用精确匹配特征点的像点坐标为观测值建立误。

33、差方程并线性化，则有公式 (11) ： 0093 0094 其中 vx， vy为像点误差， a11， a12a26为误差方程系数，分别为当前站点的位姿的改正值， X， Y， Z 为观测点的位置的改正值， lx、 ly为相应误差方程式的常数项，有公式 (12) ： 0095 说明书 CN 103927738 A 11 8/8 页 12 0096 将公式 (12) 简化，可得公式 (13)，其中 i 为相机的序号， j 为观测点的序号： 0097 Aiji+Bijj-li=vi (13) 0098 3) 根据误差方程 (13)，可得相应的法方程，求解行星车当前站点的位姿的改正。

34、数和观测点的位置的改正数 X， Y， Z。然后利用改正数对行星车当前站点相机位置和姿态初值、观测点地面坐标初值进行改正，反复多次迭代，直至改正数小于规定限差，实现计算收敛。 0099 通过上述求解过程，最终求得当前站左相机的精确位置和姿态即为行星车的位置和姿态。 0100 以上所述，仅为本发明中的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉该技术的人在本发明所揭露的技术范围内，可理解想到的变换或替换，都应涵盖在本发明的包含范围之内，因此，本发明的保护范围应该以权利要求书的保护范围为准。说明书 CN 103927738 A 12 1/2 页 13 图 1 说明书附图 CN 103927738 A 13 2/2 页 14 图 2 图 3 说明书附图 CN 103927738 A 14 。

展开阅读全文