GNSS/SINS/visual navigation robust algorithm
DOI:
CSTR:
Author:
Affiliation:

Information Engineering University

Clc Number:

Fund Project:

The National Natural Science Foundation of China (General Program, Key Program, Major Research Plan)

  • Article
  • |
  • Figures
  • |
  • Metrics
  • |
  • Reference
  • |
  • Related
  • |
  • Cited by
  • |
  • Materials
  • |
  • Comments
    Abstract:

    Global Navigation Satellite System (GNSS), Strapdown Inertial Navigation System (SINS) and visual sensors complement each other, and their information fusion can obtain high-precision, drift-free navigation and positioning information. Aiming at the problem that GNSS/SINS/vision fusion navigation is vulnerable to the impact of motion speed, light change, occlusion, etc., which leads to the decrease of navigation positioning accuracy and robustness, this paper adds the SoftLone robust kernel function to the cost function of the graph optimization framework, and sets the gross error test procedure of the measured value to reduce the negative impact of outliers. Further, the chi-square test is performed on the calculated residuals of the measured value, and the weight of the over-limit residual is reduced to improve the accuracy and robustness of the system. The experimental results show that the algorithm in this paper has higher accuracy and better robustness than the traditional algorithm without robust kernel function, outlier elimination strategy and chi-square test, and the algorithm with other robust kernel functions. It can greatly improve the positioning accuracy and robustness of GNSS/SINS/visual navigation. In large scale environment, there is no large drift errors, and absolute pose root mean square error is 0.735m, and the standard deviation of absolute pose error is 0.336m.

    Reference
    Related
    Cited by
Get Citation
Share
Article Metrics
  • Abstract:
  • PDF:
  • HTML:
  • Cited by:
History
  • Received:February 14,2023
  • Revised:April 20,2023
  • Adopted:May 11,2023
  • Online:
  • Published:
Article QR Code

Address:No. 219, Ningliu Road, Nanjing, Jiangsu Province

Postcode:210044

Phone:025-58731025