A hierarchical mobile robot simultaneous localization and mapping (SLAM) method that allows us to obtain accurate maps was presented. The local map level is composed of a set of local metric feature maps that are guar...A hierarchical mobile robot simultaneous localization and mapping (SLAM) method that allows us to obtain accurate maps was presented. The local map level is composed of a set of local metric feature maps that are guaranteed to be statistically independent. The global level is a topological graph whose arcs are labeled with the relative location between local maps. An estimation of these relative locations is maintained with local map alignment algorithm, and more accurate estimation is calculated through a global minimization procedure using the loop closure constraint. The local map is built with Rao-Blackwellised particle filter (RBPF), where the particle filter is used to extending the path posterior by sampling new poses. The landmark position estimation and update is implemented through extended Kalman filter (EKF). Monocular vision mounted on the robot tracks the 3D natural point landmarks, which are structured with matching scale invariant feature transform (SIFT) feature pairs. The matching for multi-dimension SIFT features is implemented with a KD-tree in the time cost of O(lbN). Experiment results on Pioneer mobile robot in a real indoor environment show the superior performance of our proposed method.展开更多
Simultaneous localization and mapping (SLAM) is a key technology for mobile robots operating under unknown environment. While FastSLAM algorithm is a popular solution to the SLAM problem, it suffers from two major dra...Simultaneous localization and mapping (SLAM) is a key technology for mobile robots operating under unknown environment. While FastSLAM algorithm is a popular solution to the SLAM problem, it suffers from two major drawbacks: one is particle set degeneracy due to lack of observation information in proposal distribution design of the particle filter; the other is errors accumulation caused by linearization of the nonlinear robot motion model and the nonlinear environment observation model. For the purpose of overcoming the above problems, a new iterated sigma point FastSLAM (ISP-FastSLAM) algorithm is proposed. The main contribution of the algorithm lies in the utilization of iterated sigma point Kalman filter (ISPKF), which minimizes statistical linearization error through Gaussian-Newton iteration, to design an optimal proposal distribution of the particle filter and to estimate the environment landmarks. On the basis of Rao-Blackwellized particle filter, the proposed ISP-FastSLAM algorithm is comprised by two main parts: in the first part, an iterated sigma point particle filter (ISPPF) to localize the robot is proposed, in which the proposal distribution is accurately estimated by the ISPKF; in the second part, a set of ISPKFs is used to estimate the environment landmarks. The simulation test of the proposed ISP-FastSLAM algorithm compared with FastSLAM2.0 algorithm and Unscented FastSLAM algorithm is carried out, and the performances of the three algorithms are compared. The simulation and comparing results show that the proposed ISP-FastSLAM outperforms other two algorithms both in accuracy and in robustness. The proposed algorithm provides reference for the optimization research of FastSLAM algorithm.展开更多
A novel mobile robot simultaneous localization and mapping (SLAM) method is implemented by using the Rao- Blackwellized particle filter (RBPF) for monocular vision-based autonomous robot in unknown indoor environment....A novel mobile robot simultaneous localization and mapping (SLAM) method is implemented by using the Rao- Blackwellized particle filter (RBPF) for monocular vision-based autonomous robot in unknown indoor environment. The particle filter combined with unscented Kalman filter (UKF) for extending the path posterior by sampling new poses integrating the current observation. Landmark position estimation and update is implemented through UKF. Furthermore, the number of resampling steps is determined adaptively, which greatly reduces the particle depletion problem. Monocular CCD camera mounted on the robot tracks the 3D natural point landmarks structured with matching image feature pairs extracted through Scale Invariant Feature Transform (SIFT). The matching for multi-dimension SIFT features which are highly distinctive due to a special descriptor is implemented with a KD-Tree. Experiments on the robot Pioneer3 showed that our method is very precise and stable.展开更多
The choice of the particle's distribution model and the consistency of the result are very important for FastSLAM.The improved auxiliary variable model with FastSLAM,and Stirling Interpolation which is used to app...The choice of the particle's distribution model and the consistency of the result are very important for FastSLAM.The improved auxiliary variable model with FastSLAM,and Stirling Interpolation which is used to approximate the nonlinear functions are provided.This approach improves the precision of the approximation for the nonlinear functions,conquers the drawback of the FastSLAM1.0 by using a model ignoring the measurement data,enhances the estimation consistency of the robot pose,and reduces the degradation speed of the particle in FastSLAM algorithm.Simulation results demonstrate the excellence of the proposed algorithm and give the noise parameter influence on the proposed algorithm.展开更多
In order to meet the application requirements of autonomous vehicles,this paper proposes a simultaneous localization and mapping(SLAM)algorithm,which uses a VoxelGrid filter to down sample the point cloud data,with th...In order to meet the application requirements of autonomous vehicles,this paper proposes a simultaneous localization and mapping(SLAM)algorithm,which uses a VoxelGrid filter to down sample the point cloud data,with the combination of iterative closest points(ICP)algorithm and Gaussian model for particles updating,the matching between the local map and the global map to quantify particles' importance weight.The crude estimation by using ICP algorithm can find the high probability area of autonomous vehicles' poses,which would decrease particle numbers,increase algorithm speed and restrain particles' impoverishment.The calculation of particles' importance weight based on matching of attribute between grid maps is simple and practicable.Experiments carried out with the autonomous vehicle platform validate the effectiveness of our approaches.展开更多
Localization plays a vital role in the mobile robot navigation system and is a fundamental capability for autonomous movement.In an indoor environment,the current mainstream localization scheme uses two-dimensional(2D...Localization plays a vital role in the mobile robot navigation system and is a fundamental capability for autonomous movement.In an indoor environment,the current mainstream localization scheme uses two-dimensional(2D)laser light detection and ranging(LiDAR)to build an occupancy grid map with simultaneous localization and mapping(SLAM)technology;it then locates the robot based on the known grid map.However,such solutions work effectively only in those areas with salient geometrical features.For areas with repeated,symmetrical,or similar structures,such as a long corridor,the conventional particle filtering method will fail.To solve this crucial problem,this paper presents a novel coarse-to-fine paradigm that uses visual features to assist mobile robot localization in a long corridor.First,the mobile robot is remote-controlled to move from the starting position to the end along a middle line.In the moving process,a grid map is built using the laser-based SLAM method.At the same time,a visual map consisting of special images which are keyframes is created according to a keyframe selection strategy.The keyframes are associated with the robot’s poses through timestamps.Second,a moving strategy is proposed,based on the extracted range features of the laser scans,to decide on an initial rough position.This is vital for the mobile robot because it gives instructions on where the robot needs to move to adjust its pose.Third,the mobile robot captures images in a proper perspective according to the moving strategy and matches them with the image map to achieve a coarse localization.Finally,an improved particle filtering method is presented to achieve fine localization.Experimental results show that our method is effective and robust for global localization.The localization success rate reaches 98.8%while the average moving distance is only 0.31 m.In addition,the method works well when the mobile robot is kidnapped to another position in the corridor.展开更多
针对移动机器人同时定位与地图创建(Simultaneous localization and mapping,SLAM)中的FastSLAM算法,存在非线性系统线性化处理和计算雅可比矩阵的缺点,本文提出了基于Sterling多项式插值处理非线性系统的SLAM方法.该方法基于Rao-Blackw...针对移动机器人同时定位与地图创建(Simultaneous localization and mapping,SLAM)中的FastSLAM算法,存在非线性系统线性化处理和计算雅可比矩阵的缺点,本文提出了基于Sterling多项式插值处理非线性系统的SLAM方法.该方法基于Rao-Blackwellized粒了滤波框架,利用中心差分滤波方法产生改进的建议分布函数,提高了机器人位姿估计的精度;利用中心差分滤波初始化特征和更新地图中的特征,提高了地图创建的精度;针对实际应用中存在虚假特征的情况提出了一种有效的地图管理方法.在同等粒了数的情况下,该方法改进了SLAM结果的精度.基于仿真和实际数据的实验结果验证了该方法的有效性.展开更多
基金The National High Technology Research and Development Program (863) of China (No2006AA04Z259)The National Natural Sci-ence Foundation of China (No60643005)
文摘A hierarchical mobile robot simultaneous localization and mapping (SLAM) method that allows us to obtain accurate maps was presented. The local map level is composed of a set of local metric feature maps that are guaranteed to be statistically independent. The global level is a topological graph whose arcs are labeled with the relative location between local maps. An estimation of these relative locations is maintained with local map alignment algorithm, and more accurate estimation is calculated through a global minimization procedure using the loop closure constraint. The local map is built with Rao-Blackwellised particle filter (RBPF), where the particle filter is used to extending the path posterior by sampling new poses. The landmark position estimation and update is implemented through extended Kalman filter (EKF). Monocular vision mounted on the robot tracks the 3D natural point landmarks, which are structured with matching scale invariant feature transform (SIFT) feature pairs. The matching for multi-dimension SIFT features is implemented with a KD-tree in the time cost of O(lbN). Experiment results on Pioneer mobile robot in a real indoor environment show the superior performance of our proposed method.
基金supported by Open Foundation of State Key Laboratory of Robotics and System, China (Grant No. SKLRS-2009-ZD-04)National Natural Science Foundation of China (Grant No. 60909055, Grant No.61005070)Fundamental Research Funds for the Central Universities of China (Grant No. 2009JBZ001-2)
文摘Simultaneous localization and mapping (SLAM) is a key technology for mobile robots operating under unknown environment. While FastSLAM algorithm is a popular solution to the SLAM problem, it suffers from two major drawbacks: one is particle set degeneracy due to lack of observation information in proposal distribution design of the particle filter; the other is errors accumulation caused by linearization of the nonlinear robot motion model and the nonlinear environment observation model. For the purpose of overcoming the above problems, a new iterated sigma point FastSLAM (ISP-FastSLAM) algorithm is proposed. The main contribution of the algorithm lies in the utilization of iterated sigma point Kalman filter (ISPKF), which minimizes statistical linearization error through Gaussian-Newton iteration, to design an optimal proposal distribution of the particle filter and to estimate the environment landmarks. On the basis of Rao-Blackwellized particle filter, the proposed ISP-FastSLAM algorithm is comprised by two main parts: in the first part, an iterated sigma point particle filter (ISPPF) to localize the robot is proposed, in which the proposal distribution is accurately estimated by the ISPKF; in the second part, a set of ISPKFs is used to estimate the environment landmarks. The simulation test of the proposed ISP-FastSLAM algorithm compared with FastSLAM2.0 algorithm and Unscented FastSLAM algorithm is carried out, and the performances of the three algorithms are compared. The simulation and comparing results show that the proposed ISP-FastSLAM outperforms other two algorithms both in accuracy and in robustness. The proposed algorithm provides reference for the optimization research of FastSLAM algorithm.
基金Project (No. 2002AA735041) supported by the Hi-Tech Researchand Development Program (863) of China
文摘A novel mobile robot simultaneous localization and mapping (SLAM) method is implemented by using the Rao- Blackwellized particle filter (RBPF) for monocular vision-based autonomous robot in unknown indoor environment. The particle filter combined with unscented Kalman filter (UKF) for extending the path posterior by sampling new poses integrating the current observation. Landmark position estimation and update is implemented through UKF. Furthermore, the number of resampling steps is determined adaptively, which greatly reduces the particle depletion problem. Monocular CCD camera mounted on the robot tracks the 3D natural point landmarks structured with matching image feature pairs extracted through Scale Invariant Feature Transform (SIFT). The matching for multi-dimension SIFT features which are highly distinctive due to a special descriptor is implemented with a KD-Tree. Experiments on the robot Pioneer3 showed that our method is very precise and stable.
基金National High-Tech Research and Development Program of China(No.2003AA1Z2130)Science and Technology Project of Zhejiang Province,China(No.2005C11001-02)
文摘The choice of the particle's distribution model and the consistency of the result are very important for FastSLAM.The improved auxiliary variable model with FastSLAM,and Stirling Interpolation which is used to approximate the nonlinear functions are provided.This approach improves the precision of the approximation for the nonlinear functions,conquers the drawback of the FastSLAM1.0 by using a model ignoring the measurement data,enhances the estimation consistency of the robot pose,and reduces the degradation speed of the particle in FastSLAM algorithm.Simulation results demonstrate the excellence of the proposed algorithm and give the noise parameter influence on the proposed algorithm.
基金Supported by the Major Research Plan of the National Natural Science Foundation of China(91120003)Surface Project of the National Natural Science Foundation of China(61173076)
文摘In order to meet the application requirements of autonomous vehicles,this paper proposes a simultaneous localization and mapping(SLAM)algorithm,which uses a VoxelGrid filter to down sample the point cloud data,with the combination of iterative closest points(ICP)algorithm and Gaussian model for particles updating,the matching between the local map and the global map to quantify particles' importance weight.The crude estimation by using ICP algorithm can find the high probability area of autonomous vehicles' poses,which would decrease particle numbers,increase algorithm speed and restrain particles' impoverishment.The calculation of particles' importance weight based on matching of attribute between grid maps is simple and practicable.Experiments carried out with the autonomous vehicle platform validate the effectiveness of our approaches.
基金supported by the National Natural Science Foundation of China(Nos.61703067,61803058,51604056,and 51775076)the Science and Technology Research Project of Chongqing Education Commission,China(No.KJ1704072)the Doctoral Talent Train Project of Chongqing University of Posts and Telecommunications,China(No.BYJS202006)。
文摘Localization plays a vital role in the mobile robot navigation system and is a fundamental capability for autonomous movement.In an indoor environment,the current mainstream localization scheme uses two-dimensional(2D)laser light detection and ranging(LiDAR)to build an occupancy grid map with simultaneous localization and mapping(SLAM)technology;it then locates the robot based on the known grid map.However,such solutions work effectively only in those areas with salient geometrical features.For areas with repeated,symmetrical,or similar structures,such as a long corridor,the conventional particle filtering method will fail.To solve this crucial problem,this paper presents a novel coarse-to-fine paradigm that uses visual features to assist mobile robot localization in a long corridor.First,the mobile robot is remote-controlled to move from the starting position to the end along a middle line.In the moving process,a grid map is built using the laser-based SLAM method.At the same time,a visual map consisting of special images which are keyframes is created according to a keyframe selection strategy.The keyframes are associated with the robot’s poses through timestamps.Second,a moving strategy is proposed,based on the extracted range features of the laser scans,to decide on an initial rough position.This is vital for the mobile robot because it gives instructions on where the robot needs to move to adjust its pose.Third,the mobile robot captures images in a proper perspective according to the moving strategy and matches them with the image map to achieve a coarse localization.Finally,an improved particle filtering method is presented to achieve fine localization.Experimental results show that our method is effective and robust for global localization.The localization success rate reaches 98.8%while the average moving distance is only 0.31 m.In addition,the method works well when the mobile robot is kidnapped to another position in the corridor.
文摘针对移动机器人同时定位与地图创建(Simultaneous localization and mapping,SLAM)中的FastSLAM算法,存在非线性系统线性化处理和计算雅可比矩阵的缺点,本文提出了基于Sterling多项式插值处理非线性系统的SLAM方法.该方法基于Rao-Blackwellized粒了滤波框架,利用中心差分滤波方法产生改进的建议分布函数,提高了机器人位姿估计的精度;利用中心差分滤波初始化特征和更新地图中的特征,提高了地图创建的精度;针对实际应用中存在虚假特征的情况提出了一种有效的地图管理方法.在同等粒了数的情况下,该方法改进了SLAM结果的精度.基于仿真和实际数据的实验结果验证了该方法的有效性.
