Mobile Robots Perception & Navigation Mobile Robots Perception & Navigation Edited by Sascha Kolski pro literatur Verlag Published by the Advanced Robotic Systems International and pro literatur Verlag plV pro literatur Verlag Robert Mayer-Scholz Mammendorf Germany Abstracting and non-profit use of the material is permitted with credit to the source. Statements and opinions expressed in the chapters are these of the individual contributors and not necessarily those of the editors or publisher. No responsibility is accepted for the accuracy of information contained in the published articles. Publisher assumes no responsibility liability for any damage or injury to persons or property arising out of the use of any materials, instructions, methods or ideas contained inside. After this work has been published by the Advanced Robotic Systems International, authors have the right to republish it, in whole or part, in any publication of which they are an author or editor, and the make other personal use of the work. © 2007 Advanced Robotic Systems International www.ars-journal.com Additional copies can be obtained from: publication@ars-journal.com First published March 2007 Printed in Croatia A catalog record for this book is available from the German Library. Mobile Robots, Perception & Navigation, Edited by Sascha Kolski p. cm. ISBN 3-86611-283-1 1. Mobile Robotics. 2. Perception. 3. Sascha Kolski V Preface Mobile Robotics is an active research area where researchers from all over the world find new technologies to improve mobile robots intelligence and areas of application. Today ro- bots navigate autonomously in office environments as well as outdoors. They show their ability to beside mechanical and electronic barriers in building mobile platforms, perceiving the environment and deciding on how to act in a given situation are crucial problems. In this book we focused on these two areas of mobile robotics, Perception and Navigation. Perception includes all means of collecting information about the robot itself and it’s envi- ronment. To make robots move in their surrounding and interact with their environment in a reasonable way, it is crucial to understand the actual situation the robot faces. Robots use sensors to measure properties of the environment and interpret these measure- ments to gather knowledge needed for save interaction. Sensors used in the work described in the articles in this book include computer vision, range finders, sonars and tactile sensors and the way those sensors can be used to allow the robot the perception of it’s environment and enabling it to safely accomplishing it’s task. There is also a number of contributions that show how measurements from different sensors can be combined to gather more reliable and accurate information as a single sensor could provide, this is especially efficient when sensors are complementary on their strengths and weaknesses. As for many robot tasks mobility is an important issue, robots have to navigate their envi- ronments in a safe and reasonable way. Navigation describes, in the field of mobile robotics, techniques that allow a robot to use information it has gathered about the environment to reach goals that are given a priory or derived from a higher level task description in an ef- fective and efficient way. The main question of navigation is how to get from where we are to where we want to be. Researchers work on that question since the early days of mobile robotics and have devel- oped many solutions to the problem considering different robot environments. Those in- clude indoor environments, as well is in much larger scale outdoor environments and under water navigation. Beside the question of global navigation, how to get from A to B navigation in mobile robot- ics has local aspects. Depending on the architecture of a mobile robot (differential drive, car like, submarine, plain, etc.) the robot’s possible actions are constrained not only by the ro- VI bots’ environment but by its dynamics. Robot motion planning takes these dynamics into account to choose feasible actions and thus ensure a safe motion. This book gives a wide overview over different navigation techniques describing both navi- gation techniques dealing with local and control aspects of navigation as well es those han- dling global navigation aspects of a single robot and even for a group of robots. As not only this book shows, mobile robotics is a living and exciting field of research com- bining many different ideas and approaches to build mechatronical systems able to interact with their environment. Editor Sascha Kolski VII Contents Perception 1. Robot egomotion from the deformation of active contours . 01 Guillem Alenya and Carme Torras 2. Visually Guided Robotics Using Conformal Geometric Computing 19 Eduardo Bayro-Corrochano, Luis Eduardo Falcon-Morales and Julio Zamora-Esquivel 3. One approach To The Fusion Of Inertial Navigation And Dynamic Vision 45 Stevica Graovac 4. Sonar Sensor Interpretation and Infrared Image Fusion for Mobile Robotics 69 Mark Hinders, Wen Gao and William Fehlman 5. Obstacle Detection Based on Fusion Between Stereovision and 2D Laser Scanner 91 Raphaël Labayrade, Dominique Gruyer, Cyril Royere, Mathias Perrollaz and Didier Aubert 6. Optical Three-axis Tactile Sensor 111 Ohka, M. 7. Vision Based Tactile Sensor Using Transparent Elastic Fingertip for Dexterous Handling 137 Goro Obinata, Dutta Ashish, Norinao Watanabe and Nobuhiko Moriyama 8. Accurate color classification and segmentation for mobile robots 149 Raziel Alvarez, Erik Millán, Alejandro Aceves-López and Ricardo Swain-Oropeza 9. Intelligent Global Vision for Teams of Mobile Robots 165 Jacky Baltes and John Anderson 10. Contour Extraction and Compression-Selected Topics 187 Andrzej Dziech VIII Navigation 11. Comparative Analysis of Mobile Robot Localization Methods Based On Proprioceptive and Exteroceptive Sensors . 215 Gianluca Ippoliti, Leopoldo Jetto, Sauro Longhi and Andrea Monteriù 12. Composite Models for Mobile Robot Offline Path Planning . 237 Ellips Masehian and M. R. Amin-Naseri 13. Global Navigation of Assistant Robots using Partially Observable Markov Decision Processes . 263 María Elena López, Rafael Barea, Luis Miguel Bergasa, Manuel Ocaña and María Soledad Escudero 14. Robust Autonomous Navigation and World Representation in Outdoor Environments 299 Favio Masson, Juan Nieto, José Guivant and Eduardo Nebot 15. Unified Dynamics-based Motion Planning Algorithm for Autonomous Underwater Vehicle-Manipulator Systems (UVMS) 321 Tarun K. Podder and Nilanjan Sarkar 16. Optimal Velocity Planning of Wheeled Mobile Robots on Specific Paths in Static and Dynamic Environments . 357 María Prado 17. Autonomous Navigation of Indoor Mobile Robot Using Global Ultrasonic System 383 Soo-Yeong Yi and Byoung-Wook Choi 18. Distance Feedback Travel Aid Haptic Display Design 395 Hideyasu Sumiya 19. Efficient Data Association Approach to Simultaneous Localization and Map Building 413 Sen Zhang, Lihua Xie and Martin David Adams 20. A Generalized Robot Path Planning Approach Without The Cspace Calculation 433 Yongji Wang, Matthew Cartmell, QingWang and Qiuming Tao 21. A pursuit-rendezvous approach for robotic tracking . 461 Fethi Belkhouche and Boumediene Belkhouche 22. Sensor-based Global Planning for Mobile Manipulators Navigation using Voronoi Diagram and Fast Marching 479 S. Garrido, D. Blanco, M.L. Munoz, L. Moreno and M. Abderrahim IX 23. Effective method for autonomous Simultaneous Localization and Map building in unknown indoor environments 497 Y.L. Ip, A.B. Rad, and Y.K. Wong 24. Motion planning and reconfiguration for systems of multiple objects 523 Adrian Dumitrescu 25. Symbolic trajectory description in mobile robotics 543 Pradel Gilbert and Caleanu Catalin-Daniel 26. Robot Mapping and Navigation by Fusing Sensory Information . 571 Maki K. Habib 27. Intelligent Control of AC Induction Motors 595 Hosein Marzi 28. Optimal Path Planning of Multiple Mobile Robots for Sample Collection on a Planetary Surface . 605 J.C. Cardema and P.K.C. Wang 29. Multi Robotic Conflict Resolution by Cooperative Velocity and Direction Control 637 Satish Pedduri and K Madhava Krishna 30. Robot Collaboration For Simultaneous Map Building and Localization . 667 M. Oussalah and D. Wilson X [...]... Vision, 60(2): 91 11 0, 2004 J Borenstein, H.R Everett, L Feng, and D Wehe Mobile robot positioning -sensors and techniques Journal of Robotic Systems, 14 (4):2 31 249, 19 97 M Betke and L Gurvits Mobile robot localization using landmarks IEEE Trans Robot Automat., 13 (2):2 51 263, 19 97 R Sim and G Dudek Learning environmental features for pose estimation Image Vision Comput., 17 :445–460, 20 01 G Jang, S Kim,... rewritten as 4 Mobile Robots, Perception & Navigation where R|2 denotes de 2 X 2 submatrix of R Then, (10 ) where This last equation shows that which we will name ( 1, 2): T can be calculated from the eigenvalues of the matrix MM , (11 ) where 1 is the largest eigenvalue The angle φ can be extracted from the eigenvectors of T MM ; the eigenvector v1 with larger value corresponds to the first column of (12 ) Isolating... See [17 , 11 ] for a more detailed introduction to conformal geometric algebra We will use the letter e to denote the vector basis ei In a geometric algebra Gp,q,r, the geometric product of two basis vectors is defined as 22 Mobile Robots, Perception & Navigation (1) 2 .1 Conformal Geometric Algebra The geometric algebra of a 3D Euclidean space G3,0,0 has a point basis and the motor algebra G3,0 ,1 a line... of legged robots in unstructured environments Pattern Recognition, 34 :15 85 15 99, 20 01 C G Harris and M Stephens Acombined corner edge detector In Proc Alvey Vision Conf., pages 18 9 19 2, Manchester, Aug 19 88 T Cham and R Cipolla Automated b-spline curve representation incorporating mdl and error-minimizing control point insertion strategies IEEE Trans Pattern Anal Machine Intell., 21( 1), 19 99 J Foley,... Color landmark-based self-localization for indoor mobile robots In Proc IEEE Int Conf Robot Automat., pages 10 37 10 42, Washington, May 2002 D Scharstein and A Briggs Real-time recognition of self-similar landmarks Image Vision Comput., 19 (11 ):763–772, 20 01 J Koenderinkand A J van Doorn.Affine structure from motion J Opt Soc Am A, 8 (2):377– 385, 19 91 L S Shapiro, A Zisserman, and M Brady 3D motion recovery... generated subspaces See [12 ] 2.2 Spheres and planes The equation of a sphere of radius centered at point pe Rn can be written as 24 Since coordinates as Mobile Robots, Perception & Navigation (18 ) , we can rewrite the formula above in terms of homogeneous (19 ) Since xc · e = 1 we can factor the expression above and then (20) which finally yields the simplified equation for the sphere as ( 21) where (22) is the... This camera model has been widely used before (Koenderink and van Doorn, 19 91; Shapiro et al., 19 95; Brandt, 2005) 2 Mobile Robots, Perception & Navigation Active contours are a usual tool for image segmentation in medical image analysis The ability of fastly tracking active contours was developed by Blake (Blake and Isard, 19 98) in the framework of dynamics learning and deformable contours Originally,... Intell., 21( 1), 19 99 J Foley, A van Dam, S Feiner, and F Hughes Computer Graphics Principles and Practice 18 Mobile Robots, Perception & Navigation Addison-Wesley Publishing Company, 19 96 E Martínez and C Torras Contour-based 3dmotion recovery while zooming Robotics and Autonomous Systems, 44: 219 –227, 2003 L.Sciavicco and B.Siciliano Modeling and Control of Robot Manipulators Springer-Verlag, London,... quickly, showing that tracking has fixed the target despite its quick translation across the image Figure 10 : Covariance trace resulting from tracking without using inertial information (a) and using it (b) 16 Mobile Robots, Perception & Navigation 6.Conclusions and future work A method for estimating mobile robot egomotion has been presented, which relies on tracking contours in real-time images acquired... is frequently used in the navigation field, it being also called heading-attitude-bank (Sciavicco and Siciliano, 2000) We use the form (17 ) where s and c denote the sinus and cosinus of , respectively The inverse solution is (18 ) (19 ) (20) 6 Mobile Robots, Perception & Navigation Fig 2 Systematic error in the Rx component Continuous line for values obtained with Monte Carlo simulation and dotted line . German Library. Mobile Robots, Perception & Navigation, Edited by Sascha Kolski p. cm. ISBN 3-86 611 -283 -1 1. Mobile Robotics. 2. Perception. 3. Sascha Kolski V Preface Mobile Robotics. Mobile Robots Perception & Navigation Mobile Robots Perception & Navigation Edited by Sascha Kolski pro literatur Verlag Published. for Teams of Mobile Robots 16 5 Jacky Baltes and John Anderson 10 . Contour Extraction and Compression-Selected Topics 18 7 Andrzej Dziech VIII Navigation 11 . Comparative Analysis of Mobile Robot