[发明专利]一种基于四维实数矩阵的三维图像匹配导航方法

摘要

本发明提供一种基于四维实数矩阵的三维图像匹配导航方法，该方法通过飞行器实时采集三维实测图，并与预先存储的三维参考图基于四维实数矩阵进行图像匹配；根据图像匹配结果计算飞行器的空间螺旋位移四维矩阵的元素值，并利用飞行器的空间螺旋位移四维矩阵与飞行器的连续空间螺旋位移四维实数变换矩阵的元素一一对应关系，计算飞行器的位置与姿态变化，确定导航参数。运用该方法导航，其计算的精度高，能够达到亚像素级精度，并且算法简单，实时性好。

主权项

1.一种基于四维实数矩阵的三维图像匹配导航方法，该方法首先通过飞行器实时采集三维实测图，并与预先存储的三维参考图进行图像匹配，获取实测图与参考图之间的所有一一对应点对；在每次采集图像时，将飞行器的理想位置定义为初始位置，将飞行器的当前位置定义为目标位置；其特征在于：还包括如下过程：飞行器的初始位置用r₁表示，目标位置用r₁′表示，飞行器由初始位置到目标位置的向量方程表示为：r₁′=Rr₁+t  (1)其中R表示正交实数旋转矩阵，t表示初始位置到目标位置的位移，r₁=(x,y,z)^T，r₁′=(x′,y′,z′)^T，令R=a11a12a13a21a22a23a31a32a33,]]>t=(t₁,t₂,t₃)^T飞行器的初始位置r₁在四维空间内表示为r₂，目标位置r₁′在四维空间内表示为r₂′，则飞行器由初始位置到目标位置的向量方程在四维空间内表示为：r₂′=Pr₂  （2）其中P表示空间螺旋位移矩阵，r₂=(x,y,z,w)^T，r₂′=(x′,y′,z′,w′)^T，令P=a11a12a13t1a21a22a23t2a31a32a33t30001;]]>飞行器从初始位置到目标位置的连续空间螺旋位移四维实数变换矩阵表示为：P(ψ,Sψ,θ,Sθ,γ,Sγ)=cosγ0-sinγ0010Sγsinγ0cosγ00001100Sθ0cosθsinθ00-sinθcosθ00001cosψ-sinψ00sinψcosψ00001Sψ0001=]]>其中ψ为航向角、S_ψ为沿Z_b轴的位移、θ为俯仰角、S_θ为沿X_b轴的位移、γ为横滚角、S_γ为沿Y_b轴的位移，飞行器的坐标系为OX_bY_bZ_b，原点O与飞行器质心重合，X_b轴沿飞行器横轴向右，Y_b轴沿飞行器纵轴向前，Z_b轴沿飞行器竖轴向上；令P中元素与P(ψ,S_ψ,θ,S_θ,γ,S_γ)中元素对应相等构建方程组，获取飞行器从初始位置到目标位置的姿态角和位移量的计算公式：根据图像匹配获取的所有一一对应点对，利用最小二乘法计算P中元素的值，将求得的P中元素的值带入公式（3），得到ψ_主,S_ψ,θ_主,S_θ,γ_主,S_γ的值，其中，ψ_主、θ_主、γ_主分别表示航向角ψ、俯仰角θ、横滚角γ的反三角函数的主值；根据航向角ψ、俯仰角θ、横滚角γ的定义域和a₁₃,a₂₁,a₂₂,a₂₃,a₃₃的符号计算航向角ψ，俯仰角θ，横滚角γ的精确值，将ψ,S_ψ,θ,S_θ,γ,S_γ作为导航数据。