Uncalibrated Vision-Based Control and Motion Planning of Robotic Arms in Unstructured Environments

Many robotic systems are required to operate in unstructured environments. This imposes significant challenges on algorithm design. Particularly, motion control and planning algorithms should be robust to noise and outliers, because uncertainties are inevitable. In addition, independence from scene model and calibration parameters is preferred; otherwise, the tedious model extraction and calibration procedures need to be redone with every change in the environment. The basic problem that this thesis addresses is how to robustly control the motion of a vision-based manipulator and plan occlusion-free paths in unstructured environments. Vision-based motion control without using calibration or a geometric model is studied in Uncalibrated Visual Servoing (UVS). In this thesis, we adopt a framework based on UVS and contribute to two distinct areas: robust visual servoing and robust randomized path planning. We develop a statistically robust algorithm for UVS, which detects outliers and finds robust estimates of the uncalibrated visual-motor Jacobian, a central matrix in the visual servoing control law. We integrate the robust Jacobian estimation into a real-time feedback control loop and present case studies. To avoid the visual and joint-limit constraints, we propose a robust sampling-based path planning algorithm. The proposed planner fits well within the UVS framework and facilitates occlusion-free paths, despite not knowing the obstacle model. Finally, our third and last contribution is a novel UVS approach based on extracting the geometry of three images in the form of the trifocal tensor. We experimentally validate this approach and show that the proposed UVS controller handles some of the most challenging degenerate configurations of image-based visual servoing.

[1]  Rs Roel Pieters,et al.  Visual Servo Control , 2012 .

[2]  François Chaumette,et al.  Point-based and region-based image moments for visual servoing of planar objects , 2005, IEEE Transactions on Robotics.

[3]  Graziano Chesi,et al.  Performance limitation analysis in visual servo systems: Bounding the location error introduced by image points matching , 2009, 2009 IEEE International Conference on Robotics and Automation.

[4]  Lydia E. Kavraki,et al.  Replanning: A powerful planning strategy for hard kinodynamic problems , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Guoqiang Hu,et al.  Homography-Based Visual Servo Control With Imperfect Camera Calibration , 2009, IEEE Transactions on Automatic Control.

[6]  Yunhui Liu,et al.  Adaptive Visual Servoing Using Point and Line Features With an Uncalibrated Eye-in-Hand Camera , 2008, IEEE Transactions on Robotics.

[7]  Ezio Malis Visual servoing invariant to changes in camera-intrinsic parameters , 2001, IEEE Transactions on Robotics and Automation.

[8]  Selim Benhimane,et al.  Homography-based 2D visual servoing , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[9]  Richard I. Hartley,et al.  Reconstruction from six-point sequences , 2000, Proceedings IEEE Conference on Computer Vision and Pattern Recognition. CVPR 2000 (Cat. No.PR00662).

[10]  Danica Kragic,et al.  Robust statistics for 3D object tracking , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[11]  Farrokh Janabi-Sharifi,et al.  Using scale-invariant feature points in visual servoing , 2004, SPIE Optics East.

[12]  Josechu J. Guerrero,et al.  Visual control through the trifocal tensor for nonholonomic robots , 2010, Robotics Auton. Syst..

[13]  Nicholas R. Gans,et al.  Stable Visual Servoing Through Hybrid Switched-System Control , 2007, IEEE Transactions on Robotics.

[14]  Yunhui Liu,et al.  Uncalibrated visual servoing of robots using a depth-independent interaction matrix , 2006, IEEE Transactions on Robotics.

[15]  Éric Marchand,et al.  Robust stereo tracking for space applications , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Vincent Lepetit,et al.  Accurate Non-Iterative O(n) Solution to the PnP Problem , 2007, 2007 IEEE 11th International Conference on Computer Vision.

[17]  Carlos Sagüés,et al.  A Sliding Mode Control law for epipolar visual servoing of differential-drive robots , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[18]  Lee E. Weiss,et al.  Dynamic sensor-based control of robots with visual feedback , 1987, IEEE Journal on Robotics and Automation.

[19]  Seth Hutchinson,et al.  Visual Servo Control Part I: Basic Approaches , 2006 .

[20]  Eitan M. Gurari,et al.  Introduction to the theory of computation , 1989 .

[21]  Daniel E. Koditschek,et al.  Exact robot navigation using artificial potential functions , 1992, IEEE Trans. Robotics Autom..

[22]  Rajeev Sharma,et al.  The role of exploratory movement in visual servoing without calibration , 1998, Robotics Auton. Syst..

[23]  Peter I. Corke,et al.  Performance Tests for Visual Servo Control Systems, with Application to Partitioned Approaches to Visual Servo Control , 2003, Int. J. Robotics Res..

[24]  Peter J. Rousseeuw,et al.  Robust regression and outlier detection , 1987 .

[25]  Rajeev Sharma,et al.  A framework for robot motion planning with sensor constraints , 1997, IEEE Trans. Robotics Autom..

[26]  François Chaumette,et al.  Image moments: a general and useful set of features for visual servoing , 2004, IEEE Transactions on Robotics.

[27]  Guillaume Morel,et al.  Ensuring visibility in calibration-free path planning for image-based visual servoing , 2006, IEEE Transactions on Robotics.

[28]  Gary R. Bradski,et al.  ORB: An efficient alternative to SIFT or SURF , 2011, 2011 International Conference on Computer Vision.

[29]  Christopher G. Atkeson,et al.  Constructive Incremental Learning from Only Local Information , 1998, Neural Computation.

[30]  Graziano Chesi,et al.  Visual servoing for large camera displacements , 2004, IEEE Transactions on Robotics.

[31]  François Chaumette,et al.  2 1/2 D Visual Servoing with Respect to Unknown Objects Through a New Estimation Scheme of Camera Displacement , 2000, International Journal of Computer Vision.

[32]  Martin Jägersand,et al.  Global Visual-Motor Estimation for Uncalibrated Visual Servoing , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[33]  Minoru Asada,et al.  Versatile visual servoing without knowledge of true Jacobian , 1994, Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS'94).

[34]  J. T. Shwartz,et al.  On the Piano Movers' Problem : III , 1983 .

[35]  Francois Chaumette,et al.  Potential problems of unstability and divergence in image-based and position-based visual servoing , 1999, 1999 European Control Conference (ECC).

[36]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[37]  Domenico Prattichizzo,et al.  A visual servoing algorithm based on epipolar geometry , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[38]  Giulio Sandini,et al.  Machine-learning based control of a human-like tendon-driven neck , 2010, 2010 IEEE International Conference on Robotics and Automation.

[39]  Andrew Zisserman,et al.  Multiple View Geometry in Computer Vision (2nd ed) , 2003 .

[40]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[41]  François Chaumette,et al.  Analysis of classical and new visual servoing control laws , 2008, 2008 IEEE International Conference on Robotics and Automation.

[42]  William J. Wilson,et al.  Hybrid motion control and planning strategies for visual servoing , 2005, IEEE Transactions on Industrial Electronics.

[43]  François Chaumette,et al.  Visual servoing from three points using a spherical projection model , 2010, 2010 IEEE International Conference on Robotics and Automation.

[44]  Éric Marchand,et al.  Kinematic sets for real-time robust articulated object tracking , 2007, Image Vis. Comput..

[45]  Myung Jin Chung,et al.  Image space path planning in consideration of mechanical constraints for image-based visual servoing , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[46]  Yeung Sam Hung,et al.  Global Path-Planning for Constrained and Optimal Visual Servoing , 2007, IEEE Transactions on Robotics.

[47]  Peter I. Corke,et al.  A robotics toolbox for MATLAB , 1996, IEEE Robotics Autom. Mag..

[48]  Patrick Rives,et al.  A new approach to visual servoing in robotics , 1992, IEEE Trans. Robotics Autom..

[49]  Danica Kragic,et al.  Robust Visual Servoing , 2003, Int. J. Robotics Res..

[50]  Christophe Collewet,et al.  Using Robust Estimation for Visual Servoing Based on Dynamic Vision , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[51]  Harvey Lipkin,et al.  Uncalibrated dynamic visual servoing , 2004, IEEE Transactions on Robotics and Automation.

[52]  François Chaumette,et al.  Visual servo control. I. Basic approaches , 2006, IEEE Robotics & Automation Magazine.

[53]  Patrick Rives,et al.  Robustness of image-based visual servoing with respect to depth distribution errors , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[54]  James J. Little,et al.  Dynamic visibility checking for vision-based motion planning , 2008, 2008 IEEE International Conference on Robotics and Automation.

[55]  Bernhard P. Wrobel,et al.  Multiple View Geometry in Computer Vision , 2001 .

[56]  James J. Little,et al.  Path Planning for Improved Visibility Using a Probabilistic Road Map , 2010, IEEE Transactions on Robotics.

[57]  Martin Jägersand,et al.  Robust sampling-based planning for uncalibrated visual servoing , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[58]  Danica Kragic,et al.  Nonholonomic epipolar visual servoing , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[59]  Gary Bradski,et al.  Computer Vision Face Tracking For Use in a Perceptual User Interface , 1998 .

[60]  Claude Samson,et al.  Robot Control: The Task Function Approach , 1991 .

[61]  Gregory D. Hager,et al.  X Vision: A Portable Substrate for Real-Time Vision Applications , 1998, Comput. Vis. Image Underst..

[62]  J. Latombe,et al.  Adaptive dynamic collision checking for single and multiple articulated robots in complex environments , 2005, IEEE Transactions on Robotics.

[63]  Maurizio Ficocelli,et al.  Adaptive filtering for pose estimation in visual servoing , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[64]  Nicola J. Ferrier,et al.  Visual servoing: path interpolation by homography decomposition , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[65]  Jean-Claude Latombe,et al.  Numerical potential field techniques for robot path planning , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[66]  Éric Marchand,et al.  ViSP for visual servoing: a generic software platform with a wide class of robot control skills , 2005, IEEE Robotics & Automation Magazine.

[67]  François Chaumette,et al.  Optimal Camera Trajectory with Image-Based Control , 2003, Int. J. Robotics Res..

[68]  Danica Kragic,et al.  Robust Real-Time Visual Tracking: Comparison, Theoretical Analysis and Performance Evaluation , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[69]  A. Shademan,et al.  Sensitivity analysis of EKF and iterated EKF pose estimation for position-based visual servoing , 2005, Proceedings of 2005 IEEE Conference on Control Applications, 2005. CCA 2005..

[70]  Michael J. Black,et al.  EigenTracking: Robust Matching and Tracking of Articulated Objects Using a View-Based Representation , 1996, International Journal of Computer Vision.

[71]  Guillaume Morel,et al.  Calibration Free Image Point Path Planning Simultaneously Ensuring Visibility and Controlling Camera Path , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[72]  Peter I. Corke,et al.  A tutorial on visual servo control , 1996, IEEE Trans. Robotics Autom..

[73]  Myung Jin Chung,et al.  Path planning with uncalibrated stereo rig for image-based visual servoing under large pose discrepancy , 2003, IEEE Trans. Robotics Autom..

[74]  Pradeep K. Khosla,et al.  Vision resolvability for visually servoed manipulation , 1996, J. Field Robotics.

[75]  John H. Reif,et al.  Complexity of the mover's problem and generalizations , 1979, 20th Annual Symposium on Foundations of Computer Science (sfcs 1979).

[76]  S. Hutchinson,et al.  Visual Servo Control Part II : Advanced Approaches , 2007 .

[77]  François Chaumette,et al.  Visual servo control. II. Advanced approaches [Tutorial] , 2007, IEEE Robotics & Automation Magazine.

[78]  Danica Kragic,et al.  Cue integration for visual servoing , 2001, IEEE Trans. Robotics Autom..

[79]  James J. Little,et al.  Trajectory specification via sparse waypoints for eye-in-hand robots requiring continuous target visibility , 2008, 2008 IEEE International Conference on Robotics and Automation.

[80]  Joseph Culberson,et al.  Sokoban is PSPACE-complete , 1997 .

[81]  Danica Kragic,et al.  New shortest-path approaches to visual servoing , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[82]  Camillo J. Taylor,et al.  Robust vision-based pose control , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[83]  P. Rousseeuw,et al.  Wiley Series in Probability and Mathematical Statistics , 2005 .

[84]  Martin Jägersand,et al.  Robust Jacobian Estimation for Uncalibrated Visual Servoing , 2010, 2010 IEEE International Conference on Robotics and Automation.

[85]  Gregory D. Hager,et al.  Incremental focus of attention for robust visual tracking , 1996, Proceedings CVPR IEEE Computer Society Conference on Computer Vision and Pattern Recognition.

[86]  Danica Kragic,et al.  Survey on Visual Servoing for Manipulation , 2002 .

[87]  Kamal K. Gupta,et al.  Kinodynamic planning for visual servoing , 2011, 2011 IEEE International Conference on Robotics and Automation.

[88]  Carlos Sagüés,et al.  Pose-estimation-based visual servoing for differential-drive robots using the 1D trifocal tensor , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[89]  James J. Little,et al.  Planning collision-free and occlusion-free paths for industrial manipulators with eye-to-hand configuration , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[90]  Andrew Zisserman,et al.  Multiple View Geometry , 1999 .

[91]  Giuseppe Oriolo,et al.  Image-Based Visual Servoing for Nonholonomic Mobile Robots Using Epipolar Geometry , 2007, IEEE Transactions on Robotics.

[92]  Graziano Chesi,et al.  Visual Servoing Path Planning via Homogeneous Forms and LMI Optimizations , 2009, IEEE Transactions on Robotics.

[93]  Kamal K. Gupta,et al.  Global path planning for robust Visual Servoing in complex environments , 2009, 2009 IEEE International Conference on Robotics and Automation.

[94]  S. LaValle Rapidly-exploring random trees : a new tool for path planning , 1998 .

[95]  François Chaumette,et al.  Potential problems of stability and convergence in image-based and position-based visual servoing , 1997 .

[96]  Éric Marchand,et al.  Real-time keypoints matching: application to visual servoing , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[97]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[98]  Peter I. Corke,et al.  Generic decoupled image-based visual servoing for cameras obeying the unified projection model , 2009, 2009 IEEE International Conference on Robotics and Automation.

[99]  Graziano Chesi,et al.  Visual Servoing via Advanced Numerical Methods , 2010 .

[100]  John Canny,et al.  The complexity of robot motion planning , 1988 .

[101]  J. Schwartz,et al.  On the “piano movers” problem. II. General techniques for computing topological properties of real algebraic manifolds , 1983 .

[102]  William J. Wilson,et al.  Relative end-effector control using Cartesian position based visual servoing , 1996, IEEE Trans. Robotics Autom..

[103]  William J. Wilson,et al.  Stability and robustness of visual servoing methods , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[104]  Howie Choset,et al.  Principles of Robot Motion: Theory, Algorithms, and Implementation ERRATA!!!! 1 , 2007 .

[105]  Daniel E. Koditschek,et al.  Visual servoing via navigation functions , 2002, IEEE Trans. Robotics Autom..

[106]  Domenico Prattichizzo,et al.  EGT for multiple view geometry and visual servoing: robotics vision with pinhole and panoramic cameras , 2005, IEEE Robotics & Automation Magazine.

[107]  Philippe Martinet,et al.  Position based visual servoing: keeping the object in the field of vision , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[108]  Philippe Martinet,et al.  Decoupled visual servoing based on the spherical projection of a set of points , 2009, 2009 IEEE International Conference on Robotics and Automation.

[109]  Michel Dhome,et al.  An efficient method to compute the inverse Jacobian matrix in visual servoing , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[110]  Koichiro Deguchi,et al.  Optimal motion control for image-based visual servoing by decoupling translation and rotation , 1998, Proceedings. 1998 IEEE/RSJ International Conference on Intelligent Robots and Systems. Innovations in Theory, Practice and Applications (Cat. No.98CH36190).

[111]  Éric Marchand,et al.  Statistically robust 2-D visual servoing , 2006, IEEE Transactions on Robotics.

[112]  C. S. George Lee,et al.  Weighted selection of image features for resolved rate visual feedback control , 1991, IEEE Trans. Robotics Autom..

[113]  Danica Kragic Visual Servoing for Manipulation : Robustness and Integration Issues , 2001 .

[114]  Robert C. Bolles,et al.  Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography , 1981, CACM.

[115]  Minoru Asada,et al.  Trajectory generation for obstacle avoidance of uncalibrated stereo visual servoing without 3D reconstruction , 1995, Proceedings 1995 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human Robot Interaction and Cooperative Robots.

[116]  Vincent Lepetit,et al.  BRIEF: Binary Robust Independent Elementary Features , 2010, ECCV.

[117]  François Chaumette,et al.  Path planning for robust image-based control , 2002, IEEE Trans. Robotics Autom..

[118]  Christopher Hunt,et al.  Notes on the OpenSURF Library , 2009 .

[119]  Benedetto Allotta,et al.  3D Motion Planning for Image-Based Visual Servoing Tasks , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[120]  Ville Kyrki Control uncertainty in image-based visual servoing , 2009, 2009 IEEE International Conference on Robotics and Automation.

[121]  Olac Fuentes,et al.  Experimental evaluation of uncalibrated visual servoing for precision manipulation , 1997, Proceedings of International Conference on Robotics and Automation.

[122]  G LoweDavid,et al.  Distinctive Image Features from Scale-Invariant Keypoints , 2004 .

[123]  François Chaumette,et al.  Theoretical improvements in the stability analysis of a new class of model-free visual servoing methods , 2002, IEEE Trans. Robotics Autom..

[124]  E. Malis,et al.  2 1/2 D Visual Servoing , 1999 .

[125]  Guillaume Morel,et al.  Calibration free path planning for visual servoing yielding straight line behaviour both in image and work space , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[126]  Martin Jägersand,et al.  Three-view uncalibrated visual servoing , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[127]  D. Koditschek,et al.  Robot navigation functions on manifolds with boundary , 1990 .

[128]  Steven M. LaValle,et al.  Planning algorithms , 2006 .