Abstract:Global Navigation Satellite System (GNSS),Strapdown Inertial Navigation System (SINS) and visual sensors can 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 decline 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 proposed algorithm has higher accuracy and better robustness than traditional algorithm without robust kernel function,outlier elimination strategy and chi-square test,and algorithm with other robust kernel functions.It can greatly improve the positioning accuracy and robustness of GNSS/SINS/visual navigation.In large scale scenario,there is no large drift errors,and root mean square error and standard deviation of absolute pose are 0.735 m and 0.336 m,respectively.