CuikSLAM: A Kinematics-based Approach to SLAM

In this paper, we depart from the fact that Simultaneous Localization and Mapping (SLAM) is a sub-case of the general kinematic problem, and, thus, all techniques used in kinematics are potentially applicable to SLAM. We describe how to formalize a SLAM problem as a typical kinematic problem and we propose a simple SLAM algorithm based on an interval-based kinematic method called Cuik previously developed in our group. This new algorithm solves the SLAM problem taking advantage of the structure imposed in the SLAM problem by the motion and sensing capabilities of the autonomous robots. However, since we use a kinematic approach instead of a probabilistic one (the usual approach for SLAM) we can perfectly model the constraints between robot poses and between robot poses and landmarks, including the nonlinearities, and we can ensure those constraints to be fulfilled at any time during the map construction and refinement. The viability of the new algorithm is shown with a small test.

[1]  De Figueiredo,et al.  Self-validated numerical methods and applications , 1997 .

[2]  Gordon M. Crippen,et al.  Distance Geometry and Molecular Conformation , 1988 .

[3]  Peter F. Stadler,et al.  Interchangeability of Relevant Cycles in Graphs , 2000, Electron. J. Comb..

[4]  Henrik I. Christensen,et al.  Graphical SLAM - a self-correcting map , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[5]  Carme Torras,et al.  A branch-and-prune solver for distance constraints , 2005, IEEE Transactions on Robotics.

[6]  Nando de Freitas,et al.  Sequential Monte Carlo Methods in Practice , 2001, Statistics for Engineering and Information Science.

[7]  Andrea Garulli,et al.  A Set Theoretic Approach to Dynamic Robot Localization and Mapping , 2004, Auton. Robots.

[8]  Sebastian Thrun,et al.  Robotic mapping: a survey , 2003 .

[9]  Gregory S. Chirikjian,et al.  A modal approach to hyper-redundant manipulator kinematics , 1994, IEEE Trans. Robotics Autom..

[10]  Kurt Konolige,et al.  Large-Scale Map-Making , 2004, AAAI.

[11]  S. Agrawal,et al.  Inverse kinematic solution of robot manipulators using interval analysis , 1998 .

[12]  Evangelos E. Milios,et al.  Globally Consistent Range Scan Alignment for Environment Mapping , 1997, Auton. Robots.

[13]  Hugh F. Durrant-Whyte,et al.  Mobile robot localization by tracking geometric beacons , 1991, IEEE Trans. Robotics Autom..

[14]  Sukhan Lee,et al.  Computer-Aided Mechanical Assembly Planning , 1991 .

[15]  Eric Walter,et al.  Robust Autonomous Robot Localization Using Interval Analysis , 2000, Reliab. Comput..

[16]  Federico Thomas,et al.  Towards an efficient interval method for solving inverse kinematic problems , 1997, Proceedings of International Conference on Robotics and Automation.

[17]  Hugh F. Durrant-Whyte,et al.  Simultaneous Localization and Mapping with Sparse Extended Information Filters , 2004, Int. J. Robotics Res..

[18]  José A. Castellanos,et al.  Simultaneous Localization and Map Building , 1999 .

[19]  B. Roth,et al.  Synthesis of Path-Generating Mechanisms by Numerical Methods , 1963 .

[20]  K. Sridharan.  Computing two penetration measures for curved 2D objects , 1999, Inf. Process. Lett..

[21]  Nando de Freitas,et al.  Sequential Monte Carlo in Practice , 2001 .

[22]  Dinesh Manocha,et al.  Efficient inverse kinematics for general 6R manipulators , 1994, IEEE Trans. Robotics Autom..

[23]  Carme Torras,et al.  Solving Multi-Loop Linkages by Iterating 2D Clippings , 2002 .

[24]  M. Thorpe,et al.  Rigidity theory and applications , 2002 .

[25]  A. Castellet,et al.  An Algorithm for the Solution of Inverse Kinematics Problems Based on an Interval Method , 1998 .

[26]  Federico Thomas,et al.  Solving geometric constraints by iterative projections and backprojections , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[27]  J. Merlet,et al.  A formal-numerical approach to determine the presence of singularity within the workspace of a parallel robot. , 2001 .

[28]  Bernard Mourrain,et al.  Computer Algebra Methods for Studying and Computing Molecular Conformations , 1999, Algorithmica.

[29]  Paul Newman,et al.  On the Structure and Solution of the Simultaneous Localisation and Map Building Problem , 1999 .

[30]  A. Morgan,et al.  Numerical Continuation Methods for Solving Polynomial Systems Arising in Kinematics , 1990 .

[31]  James Nielsen,et al.  On the Kinematic Analysis of Robotic Mechanisms , 1999, Int. J. Robotics Res..

[32]  Nicholas M. Patrikalakis,et al.  Computation of the solutions of nonlinear polynomial systems , 1993, Comput. Aided Geom. Des..