• Optics and Precision Engineering
  • Vol. 31, Issue 5, 621 (2023)
Xiaoxue JIA, Dongqing ZHAO*, Letian ZHANG, Guorui XIAO, and Qing XU
Author Affiliations
  • Geography Space Information Institute, Information Engineering University, Zhengzhou450001, China
  • show less
    DOI: 10.37188/OPE.20233105.0621 Cite this Article
    Xiaoxue JIA, Dongqing ZHAO, Letian ZHANG, Guorui XIAO, Qing XU. A visual SLAM algorithm based on adaptive inertial navigation assistant feature matching[J]. Optics and Precision Engineering, 2023, 31(5): 621 Copy Citation Text show less

    Abstract

    This paper proposes a feature-matching algorithm based on an adaptive search radius to improve the accuracy of SLAM localization and mapping. This method can overcome the problem in which the search radius of feature matching is fixed in the traditional algorithm, leading to a high mismatching rate of the visual odometer in high dynamic motion. The algorithm first extracts and matches the features of the left and right images of the binocular camera and obtains the three-dimensional coordinates of the map points. Second, the camera pose is predicted by the measured values of the pre-integral inertial measurement unit. Then, the covariance of the predicted pose is calculated according to the error propagation law. Finally, the predicted pose is used to project the map points to the image to get the corresponding pixel coordinates. According to the error in pixel coordinates, the most likely radius of the map point is determined. Experimental results show that this method can effectively reduce the search radius of feature matching and significantly improve the accuracy of image feature matching. The position and pose accuracy of the tracking thread in the ORB-SLAM3 system is improved by approximately 38.09%, and the system's whole position and pose accuracy is improved by approximately 16.38%. This method can provide an adaptive region constraint for each feature point, improve the accuracy of feature point matching, improve the precision of position and pose estimation of the whole SLAM system, and build a more accurate dense map.
    z=fbdd=| pl-pr |(1)

    View in Article

    Pc=zfu-cxv-cyf(2)

    View in Article

    ΔRbibj=k=1j-1Exp((ω˜k-bkg-ηkgd)ΔTimu)Δvbibj=k=ij-1ΔRbibk(f˜k-bka-ηkad)ΔTimuΔtbibj=k=ij-112ΔRbibk(f˜k-bka-ηkad)ΔTimu2+ΔvbibkΔTimu(3)

    View in Article

    Rwbj=RwbiRbibjtwbj=Rwbitbibj+twbi+vwbiΔTc+12gwΔTc2(4)

    View in Article

    Rbjw=RwbjTtbjw=-Rbjwtwbj(5)

    View in Article

    Rcw=RcbRbjwtcw=Rcbtbjw+tcb(6)

    View in Article

    Pc=RcwPw+tcwu=fxXcZc+cxv=fyYcZc+cy(7)

    View in Article

    δϕbibj=k=ij-1ΔR˜bkbjTJrkηkgdΔTimuδvbibj=k=ij-1-ΔR˜bibk(a˜k-bia)δϕbibkΔTimu+ΔR˜bibkηkadΔTimuδpbibj=k=ij-112ΔR˜bibkηkadΔTimu2+δvbibkΔTimu-12ΔR˜bibk(a˜k-bia)δϕbibkΔTimu2(8)

    View in Article

    δϕbibjδvbibjδpbibj=ΔR˜bibj-100-ΔR˜bibj-1(f˜j-1-bi(a))ΔTimuI0-12ΔR˜bibj-1(f˜j-1-bi(a))ΔTimu2ΔTimuIIδϕbibj-1δvbibj-1δpbibj-1+Jrj-100ΔR˜bjbj-1ΔTimu012ΔR˜bibj-1ΔTimu2ηj-1gdηj-1ad(9)

    View in Article

    Σbibj=AΣbibj-1AT+BΣbj-1dBT(10)

    View in Article

    A=ΔR˜bibj-100-ΔR˜bibj-1(f˜j-1-bia)ΔTimuI0-12ΔR˜bibj-1(f˜j-1-bia)ΔTimu2ΔTimuII(11)

    View in Article

    B=Jrj-100ΔR˜bibj-1ΔTimu012ΔR˜bibj-1ΔTimu2(12)

    View in Article

    Σbid=Σbi+1d==Σbj-1d=ηgdx2000000ηgdy2000000ηgdz2000000ηadx2000000ηady2000000ηadz2(13)

    View in Article

    ln(Rwbj)Rbibj=limϕ0ln(RwbiRbibjExp(ϕ))-ln(RwbiRbibj)ϕ=limϕ0ln(RwbiRbibj)+Jr-1ϕ-ln(RwbiRbibj)ϕ=Jr-1(ln(Rwbj))twbjtbibj=(Rwbitbibj)tbibj=Rwbi(11)

    View in Article

    Σwbj=CΣbibjCTC=Jr-1(ln(Rwbj))00Rwbi(12)

    View in Article

    Σcw=DΣwbjDTD=-Jr-1(ln(Rcw))0Rcwtwbj-Rcw(13)

    View in Article

    ΣPc=EΣcwETE=-(RcwPw)I(14)

    View in Article

    Σp=FΣPcFTF=fxZc0-fxXcZc20fyZc-fyYcZc2(15)

    View in Article

    σu=σ0Σpuσv=σ0Σpvm=3max{σu,σv}(16)

    View in Article

    Xiaoxue JIA, Dongqing ZHAO, Letian ZHANG, Guorui XIAO, Qing XU. A visual SLAM algorithm based on adaptive inertial navigation assistant feature matching[J]. Optics and Precision Engineering, 2023, 31(5): 621
    Download Citation