Aimed at the problem that the state estimation in the measurement update of the simultaneous localization and mapping(SLAM)method is incorrect or even not convergent because of the non-Gaussian measurement noise,outli...Aimed at the problem that the state estimation in the measurement update of the simultaneous localization and mapping(SLAM)method is incorrect or even not convergent because of the non-Gaussian measurement noise,outliers,or unknown and time-varying noise statistical characteristics,a robust SLAM method based on the improved variational Bayesian adaptive Kalman filtering(IVBAKF)is proposed.First,the measurement noise covariance is estimated using the variable Bayesian adaptive filtering algorithm.Then,the estimated covariance matrix is robustly processed through the weight function constructed in the form of a reweighted average.Finally,the system updates are iterated multiple times to further gradually correct the state estimation error.Furthermore,to observe features at different depths,a feature measurement model containing depth parameters is constructed.Experimental results show that when the measurement noise does not obey the Gaussian distribution and there are outliers in the measurement information,compared with the variational Bayesian adaptive SLAM method,the positioning accuracy of the proposed method is improved by 17.23%,20.46%,and 17.76%,which has better applicability and robustness to environmental disturbance.展开更多
For the purpose of positioning in various scenes, including indoors, on open road, and side street buildings, a low-cost personal navigation unit is put forward. The unit consists of a low-cost MEMS(micro-electro-mech...For the purpose of positioning in various scenes, including indoors, on open road, and side street buildings, a low-cost personal navigation unit is put forward. The unit consists of a low-cost MEMS(micro-electro-mechanical system) accelerometer, a gyroscope, a magnetometer and a GPS(global positioning system) chip, and it is capable of switching modes between indoor and outdoor situations seamlessly. The outdoor mode is MIMU(MEMS-inertial measurement unit)/GPS/magnetometer integrated mode and the indoor mode is MIMU/magnetometer integrated mode. The outdoor algorithm uses the extended Kalman filter to fuse data and provide optimum parameters. The indoor algorithm is dead reckoning, which uses vertical and forward accelerations to judge steps and uses a magnetometer to define heading. The two-axis acceleration data is used to calculate the adaptive threshold and estimate the confidence value of the steps, and when the confidence of both two axes data meet the conditions, the steps can be detected in the adaptive time windows. The detection precision is more than 95%. An experiment was conducted in complex situations. The experiment participant wearing the unit walked about 1 600 m in the experiment. The results show that the positioning error is less than 0.2% of the total route distance.展开更多
基金Primary Research and Development Plan of Jiangsu Province(No.BE2022389)Jiangsu Province Agricultural Science and Technology Independent Innovation Fund Project(No.CX(22)3091)the National Natural Science Foundation of China(No.61773113)。
文摘Aimed at the problem that the state estimation in the measurement update of the simultaneous localization and mapping(SLAM)method is incorrect or even not convergent because of the non-Gaussian measurement noise,outliers,or unknown and time-varying noise statistical characteristics,a robust SLAM method based on the improved variational Bayesian adaptive Kalman filtering(IVBAKF)is proposed.First,the measurement noise covariance is estimated using the variable Bayesian adaptive filtering algorithm.Then,the estimated covariance matrix is robustly processed through the weight function constructed in the form of a reweighted average.Finally,the system updates are iterated multiple times to further gradually correct the state estimation error.Furthermore,to observe features at different depths,a feature measurement model containing depth parameters is constructed.Experimental results show that when the measurement noise does not obey the Gaussian distribution and there are outliers in the measurement information,compared with the variational Bayesian adaptive SLAM method,the positioning accuracy of the proposed method is improved by 17.23%,20.46%,and 17.76%,which has better applicability and robustness to environmental disturbance.
基金The National Natural Science Foundation of China(No.61773113)International Special Projects for Scientific and Technological Cooperation(No.2014DFR80750)the National Key Research and Development Program of China(No.2016YFC0303006,2017YFC0601601)
文摘For the purpose of positioning in various scenes, including indoors, on open road, and side street buildings, a low-cost personal navigation unit is put forward. The unit consists of a low-cost MEMS(micro-electro-mechanical system) accelerometer, a gyroscope, a magnetometer and a GPS(global positioning system) chip, and it is capable of switching modes between indoor and outdoor situations seamlessly. The outdoor mode is MIMU(MEMS-inertial measurement unit)/GPS/magnetometer integrated mode and the indoor mode is MIMU/magnetometer integrated mode. The outdoor algorithm uses the extended Kalman filter to fuse data and provide optimum parameters. The indoor algorithm is dead reckoning, which uses vertical and forward accelerations to judge steps and uses a magnetometer to define heading. The two-axis acceleration data is used to calculate the adaptive threshold and estimate the confidence value of the steps, and when the confidence of both two axes data meet the conditions, the steps can be detected in the adaptive time windows. The detection precision is more than 95%. An experiment was conducted in complex situations. The experiment participant wearing the unit walked about 1 600 m in the experiment. The results show that the positioning error is less than 0.2% of the total route distance.