An innovative multi-robot simultaneous localization and mapping(SLAM)is proposed based on a mobile Ad hoc local wireless sensor network(Ad-WSN).Multiple followed-robots equipped with the wireless link RS232/485module ...An innovative multi-robot simultaneous localization and mapping(SLAM)is proposed based on a mobile Ad hoc local wireless sensor network(Ad-WSN).Multiple followed-robots equipped with the wireless link RS232/485module act as mobile nodes,with various on-board sensors,Tp-link wireless local area network cards,and Tp-link wireless routers.The master robot with embedded industrial PC and a complete robot control system autonomously performs the SLAM task by exchanging information with multiple followed-robots by using this self-organizing mobile wireless network.The PC on the remote console can monitor multi-robot SLAM on-site and provide direct motion control of the robots.This mobile Ad-WSN complements an environment devoid of usual GPS signals for the robots performing SLAM task in search and rescue environments.In post-disaster areas,the network is usually absent or variable and the site scene is cluttered with obstacles.To adapt to such harsh situations,the proposed self-organizing mobile Ad-WSN enables robots to complete the SLAM process while improving the performances of object of interest identification and exploration area coverage.The information of localization and mapping can communicate freely among multiple robots and remote PC control center via this mobile Ad-WSN.Therefore,the autonomous master robot runs SLAM algorithms while exchanging information with multiple followed-robots and with the remote PC control center via this local WSN environment.Simulations and experiments validate the improved performances of the exploration area coverage,object marked,and loop closure,which are adapted to search and rescue post-disaster cluttered environments.展开更多
According to the effective sampling of particles and the particles impoverishment caused by re-sampling in particle filter,an improved particle filtering algorithm based on observation inversion optimal sampling was p...According to the effective sampling of particles and the particles impoverishment caused by re-sampling in particle filter,an improved particle filtering algorithm based on observation inversion optimal sampling was proposed. Firstly,virtual observations were generated from the latest observation,and two sampling strategies were presented. Then,the previous time particles were sampled by utilizing the function inversion relationship between observation and system state. Finally,the current time particles were generated on the basis of the previous time particles and the system one-step state transition model. By the above method,sampling particles can make full use of the latest observation information and the priori modeling information,so that they further approximate the true state. The theoretical analysis and experimental results show that the new algorithm filtering accuracy and real-time outperform obviously the standard particle filter,the extended Kalman particle filter and the unscented particle filter.展开更多
To solve the problem of information fusion in the strapdown inertial navigation system(SINS)/celestial navigation system(CNS)/global positioning system(GPS) integrated navigation system described by the nonlinear/non-...To solve the problem of information fusion in the strapdown inertial navigation system(SINS)/celestial navigation system(CNS)/global positioning system(GPS) integrated navigation system described by the nonlinear/non-Gaussian error models,a new algorithm called the federated unscented particle filtering(FUPF) algorithm was introduced.In this algorithm,the unscented particle filter(UPF) served as the local filter,the federated filter was used to fuse outputs of all local filters,and the global filter result was obtained.Because the algorithm was not confined to the assumption of Gaussian noise,it was of great significance to integrated navigation systems described by the non-Gaussian noise.The proposed algorithm was tested in a vehicle's maneuvering trajectory,which included six flight phases:climbing,level flight,left turning,level flight,right turning and level flight.Simulation results are presented to demonstrate the improved performance of the FUPF over conventional federated unscented Kalman filter(FUKF).For instance,the mean of position-error decreases from(0.640×10-6 rad,0.667×10-6 rad,4.25 m) of FUKF to(0.403×10-6 rad,0.251×10-6 rad,1.36 m) of FUPF.In comparison of the FUKF,the FUPF performs more accurate in the SINS/CNS/GPS system described by the nonlinear/non-Gaussian error models.展开更多
To solve the highly nonlinear and non-Gaussian recursive state estimation problem in geomagnetic navigation, the unscented particle filter （UPF） was introduced to navigation system. The simulation indicates that geo...To solve the highly nonlinear and non-Gaussian recursive state estimation problem in geomagnetic navigation, the unscented particle filter （UPF） was introduced to navigation system. The simulation indicates that geomagnetic navigation using UPF could complete the position estimation with large initial horizontal position errors. However, this navigation system could only provide the position information. To provide all the kinematics states estimation of aircraft, a novel autonomous navigation algorithm, named unscented particle and Kalman hybrid navigation algorithm （UPKHNA）, was proposed for geomagnetic navigation, The UPKHNA used the output of UPF and barometric altimeter as position measurement, and employed the Kahnan filter to estimate the kinematics states of aircraft. The simulation shows that geomagnetic navigation using UPKHNA could provide all the kinematics states estimation of aircraft continuously, and the horizontal positioning performance is better than that only using the UPF.展开更多
As to the fact that it is difficult to obtain analytical form of optimal sampling density and tracking performance of standard particle probability hypothesis density(P-PHD) filter would decline when clustering algori...As to the fact that it is difficult to obtain analytical form of optimal sampling density and tracking performance of standard particle probability hypothesis density(P-PHD) filter would decline when clustering algorithm is used to extract target states,a free clustering optimal P-PHD(FCO-P-PHD) filter is proposed.This method can lead to obtainment of analytical form of optimal sampling density of P-PHD filter and realization of optimal P-PHD filter without use of clustering algorithms in extraction target states.Besides,as sate extraction method in FCO-P-PHD filter is coupled with the process of obtaining analytical form for optimal sampling density,through decoupling process,a new single-sensor free clustering state extraction method is proposed.By combining this method with standard P-PHD filter,FC-P-PHD filter can be obtained,which significantly improves the tracking performance of P-PHD filter.In the end,the effectiveness of proposed algorithms and their advantages over other algorithms are validated through several simulation experiments.展开更多
基金Projects(61573213,61473174,61473179)supported by the National Natural Science Foundation of ChinaProjects(ZR2015PF009,ZR2014FM007)supported by the Natural Science Foundation of Shandong Province,China+1 种基金Project(2014GGX103038)supported by the Shandong Province Science and Technology Development Program,ChinaProject(2014ZZCX04302)supported by the Special Technological Program of Transformation of Initiatively Innovative Achievements in Shandong Province,China
文摘An innovative multi-robot simultaneous localization and mapping(SLAM)is proposed based on a mobile Ad hoc local wireless sensor network(Ad-WSN).Multiple followed-robots equipped with the wireless link RS232/485module act as mobile nodes,with various on-board sensors,Tp-link wireless local area network cards,and Tp-link wireless routers.The master robot with embedded industrial PC and a complete robot control system autonomously performs the SLAM task by exchanging information with multiple followed-robots by using this self-organizing mobile wireless network.The PC on the remote console can monitor multi-robot SLAM on-site and provide direct motion control of the robots.This mobile Ad-WSN complements an environment devoid of usual GPS signals for the robots performing SLAM task in search and rescue environments.In post-disaster areas,the network is usually absent or variable and the site scene is cluttered with obstacles.To adapt to such harsh situations,the proposed self-organizing mobile Ad-WSN enables robots to complete the SLAM process while improving the performances of object of interest identification and exploration area coverage.The information of localization and mapping can communicate freely among multiple robots and remote PC control center via this mobile Ad-WSN.Therefore,the autonomous master robot runs SLAM algorithms while exchanging information with multiple followed-robots and with the remote PC control center via this local WSN environment.Simulations and experiments validate the improved performances of the exploration area coverage,object marked,and loop closure,which are adapted to search and rescue post-disaster cluttered environments.
基金Project(60634030) supported by the Key Project of the National Natural Science Foundation of ChinaProject(60702066) supported by the National Natural Science Foundation of China+1 种基金Project (2007ZC53037) supported by Aviation Science Foundation of ChinaProject(CASC0214) supported by the Space-Flight Innovation Foundation of China
文摘According to the effective sampling of particles and the particles impoverishment caused by re-sampling in particle filter,an improved particle filtering algorithm based on observation inversion optimal sampling was proposed. Firstly,virtual observations were generated from the latest observation,and two sampling strategies were presented. Then,the previous time particles were sampled by utilizing the function inversion relationship between observation and system state. Finally,the current time particles were generated on the basis of the previous time particles and the system one-step state transition model. By the above method,sampling particles can make full use of the latest observation information and the priori modeling information,so that they further approximate the true state. The theoretical analysis and experimental results show that the new algorithm filtering accuracy and real-time outperform obviously the standard particle filter,the extended Kalman particle filter and the unscented particle filter.
基金Project(60535010) supported by the National Nature Science Foundation of China
文摘To solve the problem of information fusion in the strapdown inertial navigation system(SINS)/celestial navigation system(CNS)/global positioning system(GPS) integrated navigation system described by the nonlinear/non-Gaussian error models,a new algorithm called the federated unscented particle filtering(FUPF) algorithm was introduced.In this algorithm,the unscented particle filter(UPF) served as the local filter,the federated filter was used to fuse outputs of all local filters,and the global filter result was obtained.Because the algorithm was not confined to the assumption of Gaussian noise,it was of great significance to integrated navigation systems described by the non-Gaussian noise.The proposed algorithm was tested in a vehicle's maneuvering trajectory,which included six flight phases:climbing,level flight,left turning,level flight,right turning and level flight.Simulation results are presented to demonstrate the improved performance of the FUPF over conventional federated unscented Kalman filter(FUKF).For instance,the mean of position-error decreases from(0.640×10-6 rad,0.667×10-6 rad,4.25 m) of FUKF to(0.403×10-6 rad,0.251×10-6 rad,1.36 m) of FUPF.In comparison of the FUKF,the FUPF performs more accurate in the SINS/CNS/GPS system described by the nonlinear/non-Gaussian error models.
基金Project(HIT.NSRIF.2009006) supported by the Fundamental Research Funds for the Central Universities of China
文摘To solve the highly nonlinear and non-Gaussian recursive state estimation problem in geomagnetic navigation, the unscented particle filter （UPF） was introduced to navigation system. The simulation indicates that geomagnetic navigation using UPF could complete the position estimation with large initial horizontal position errors. However, this navigation system could only provide the position information. To provide all the kinematics states estimation of aircraft, a novel autonomous navigation algorithm, named unscented particle and Kalman hybrid navigation algorithm （UPKHNA）, was proposed for geomagnetic navigation, The UPKHNA used the output of UPF and barometric altimeter as position measurement, and employed the Kahnan filter to estimate the kinematics states of aircraft. The simulation shows that geomagnetic navigation using UPKHNA could provide all the kinematics states estimation of aircraft continuously, and the horizontal positioning performance is better than that only using the UPF.
文摘As to the fact that it is difficult to obtain analytical form of optimal sampling density and tracking performance of standard particle probability hypothesis density(P-PHD) filter would decline when clustering algorithm is used to extract target states,a free clustering optimal P-PHD(FCO-P-PHD) filter is proposed.This method can lead to obtainment of analytical form of optimal sampling density of P-PHD filter and realization of optimal P-PHD filter without use of clustering algorithms in extraction target states.Besides,as sate extraction method in FCO-P-PHD filter is coupled with the process of obtaining analytical form for optimal sampling density,through decoupling process,a new single-sensor free clustering state extraction method is proposed.By combining this method with standard P-PHD filter,FC-P-PHD filter can be obtained,which significantly improves the tracking performance of P-PHD filter.In the end,the effectiveness of proposed algorithms and their advantages over other algorithms are validated through several simulation experiments.
