Abstract:In order to solve the problem of moving object tracking by robot in unknown environment,an estimation algorithm based on extended Kalman filter(EKF) is proposed.The states of robot,environment feature and object are used to form system state as a whole in the algorithm,such that sufficient relation is established gradually among states of different objects in iteration process,which improves accuracy of object state estimation.Moreover,a method of moving object detection based on occupancy grid map is combined with our algorithm to obtain the measurements of moving object and environment landmarks,so that the final algorithm can be used in actual environment.Furthermore,the step of data association proposed in algorithm can deal with the system state estimation disturbance caused by false object observations.Simulation experiment and real robot experiment results prove the effectiveness and accuracy of the presented approach.
[1] Smith R,Self M,Cheeseman P.Estimating uncertain spatial relationships in robotics[M]//Autonomous robot vehicles.New York,USA:Springer-Verlag,1990:167-193.
[2] Guivant J E,Nebot E M.Solving computational and memory requirements of feature-based simultaneous localization and mapping algorithms[J].IEEE Transactions on Robotics and Automation,2003,19(4):749-755.
[3] Frese U,Hirzingcr G.Simultaneous localization and mapping:A diseussion[C]//Proceedings of the IJCAI Workshop on Reasoning with Uncertainty in Robotics.Seattle,USA:IJCAI,2001:17-26.
[4] Thrun S,Koller D,Ghahramani Z,et al.Simultaneous mapping and localization with sparse extended information filters:Theory and initial results[C]//International Workshop on Algorithmic Foundations of Robotics.Berlin,Germany:SpringerVerlag,2003:363-380.
[5] Newman R On the structure and solution of the simultaneous localization and map building problem[D].Australian:University of Sydney,1999.
[6] Montemerlo M,Thrun S,Koller D,et al.Fast-SLAM:A factored solution to the simultaneous localization and mapping problem[C]//AAAI National Conference on Artificial Intelligence.Menlo Park,CA,USA:AAAI,2002:593-598.
[7] Besl P J,Mckay N D.A method for registration of 3-D shapes[J].IEEE Transactions on Pattern Analysis and Machine Intelligence,1992,14(2):239-256.
[8] Fu L,Milios E.Robot pose estimation in unknown environments by matching 2D range scans[J].Journal of Intelligent and Robotic Systems,1997,18(3):249-275.
[9] Minguez J,Lamiranx F,Montesano L.Metric-based scan matching algorithms for mobile robot displacement estimation[C]//IEEE International Conference on Robotics and Automation.Piseataway,NJ,USA:IEEE,2005:3557-3563.
[10] Wang C C,Thorpe C.Simultaneous localization and mapping with detection and tracking of moving objects[C]//IEEE International Conference on Robotics and Automation.Piscataway,NJ,USA:IEEE,2002:2918-2924.
[11] Wang C C,Thorpe C,Thrun S.Online simultaneous localization and mapping with detection and tracking of moving objects:Theory and results from a ground vehicle in crowded urban areas[C]//IEEE International Conference on Robotics and Automation.Piscataway,NJ,USA:IEEE,2003:842-849.
[12] Borrmann D,Elseberg J,Lingemann K,et al.Globally consistent 3D mapping with scan matching[J].Robotics and Autunomous Systems,2008,56(2):130-142.
[13] Arras K O.Feature-based robot navigation in known and unknown environments[D].Switzerland:Federal Institute of Technology Lausanne,2003.
[14] Campion G,Bastin G,D'Andrea-Novel B.Structural properties and classification of kinematic and dynamic models of wheeled mobile robots[J].IEEE Transactions on Robotics and Automation,1996,12(1):47-62.
[15] Bar-Shalom Y,Li X R,Kirubarajan T.Estimation with applications to tracking and navigation[M].USA:Wiley Interscience,2001.
[16] Frese U.A discussion of simultaneous localization and mapping[J].Autonomous Robots,2006,20(1):25-42.
[17] Smith R,Self M,Cheeseman P.A stochastic map for uncertain spatial relationships[C]//Proceedings of the International Symposium on Robotics Research.Cambridge,MA,USA:MIT,1988:467-474.
[18] Wolf D E Sukhatme G S.Mobile robot simultaneous localization and mapping in dynamic environmants[J].Autonomous Robots,2005,19(1):53-65.
[19] Chong K S,Kleeman L.Accurate odometry and error modelling for a mobile robot[C]//IEEE International Conference on Robotics and Automation.Piscataway,NJ,USA:IEEE,1997:2783-2788.
[20] Kobilarov M,Sukhatme G,Hyams J,et al.People tracking and following with mobile robot using an omnidirectional camera and a laser[C]//IEEE International Conference on Robotics and Automation.Piscataway,NJ,USA:IEEE,2006:557-562.