Automated Construction of Robotic Manipulation Programs

Society is becoming more automated with robots beginning to perform most tasks in factories and starting to help out in home and office environments. One of the most important functions of robots is the ability to manipulate objects in their environment. Because the space of possible robot designs, sensor modalities, and target tasks is huge, researchers end up having to manually create many models, databases, and programs for their specific task, an effort that is repeated whenever the task changes. Given a specification for a robot and a task, the presented framework automatically constructs the necessary databases and programs required for the robot to reliably execute manipulation tasks. It includes contributions in three major components that are critical for manipulation tasks. The first is a geometric-based planning system that analyzes all necessary modalities of manipulation planning and offers efficient algorithms to formulate and solve them. This allows identification of the necessary information needed from the task and robot specifications. Using this set of analyses, we build a planning knowledge-base that allows informative geometric reasoning about the structure of the scene and the robot's goals. We show how to efficiently generate and query the information for planners. The second is a set of efficient algorithms considering the visibility of objects in cameras when choosing manipulation goals. We show results with several robot platforms using grippers cameras to boost accuracy of the detected objects and to reliably complete the tasks. Furthermore, we use the presented planning and visibility infrastructure to develop a completely automated extrinsic camera calibration method and a method for detecting insufficient calibration data. The third is a vision-centric database that can analyze a rigid object's surface for stable and discriminable features to be used in pose extraction programs. Furthermore, we show work towards a new voting-based object pose extraction algorithm that does not rely on 2D/3D feature correspondences and thus reduces the early-commitment problem plaguing the generality of traditional vision-based pose extraction algorithms. In order to reinforce our theoric contributions with a solid implementation basis, we discuss the open-source planning environment OpenRAVE, which began and evolved as a result of the work done in this thesis. We present an analysis of its architecture and provide insight for successful robotics software environments.

[1]  Richard Fikes,et al.  STRIPS: A New Approach to the Application of Theorem Proving to Problem Solving , 1971, IJCAI.

[2]  Samuel Hunt Drake,et al.  Using compliance in lieu of sensory feedback for automatic assembly. , 1978 .

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

[4]  Robert C. Bolles,et al.  3DPO: A Three- Dimensional Part Orientation System , 1986, IJCAI.

[5]  Stephen Cameron,et al.  A study of the clash detection problem in robotics , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[6]  W. Eric L. Grimson,et al.  Recognition and localization of overlapping parts from sparse data in two and three dimensions , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[7]  R. Dubey,et al.  A Comparative Study of Generalized Coordinates for Solving the Inverse- Kinematics Problem of a 6R Robot Manipulator , 1986 .

[8]  Chris Goad,et al.  Special purpose automatic programming for 3D model-based vision , 1987 .

[9]  A. Morgan,et al.  SOLVING THE 6R INVERSE POSITION PROBLEM USING A GENERIC-CASE SOLUTION METHODOLOGY , 1991 .

[10]  Mark D. Wheeler,et al.  Towards a Vision Algorithm Compiler for Recognition of Partially Occluded 3-D Objects , 1992 .

[11]  J. Canny,et al.  Nonholonomic Motion Planning , 1992 .

[12]  P. Tseng,et al.  On the convergence of the coordinate descent method for convex differentiable minimization , 1992 .

[13]  Katsushi Ikeuchi,et al.  Appearance-Based Vision and the Automatic Generation of Object Recognition Programs , 1992 .

[14]  Klara Kedem,et al.  A Convex Polygon Among Polygonal Obstacles: Placement and High-clearance Motion , 1993, Comput. Geom..

[15]  Eric Mjolsness,et al.  New Algorithms for 2D and 3D Point Matching: Pose Estimation and Correspondence , 1998, NIPS.

[16]  Dinesh Manocha,et al.  A fast algorithm and system for the inverse kinematics of general serial manipulators , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[17]  Peter Norvig,et al.  Artificial Intelligence: A Modern Approach , 1995 .

[18]  Katsushi Ikeuchi,et al.  Sensor Modeling, Probabilistic Hypothesis Generation, and Robust Localization for Object Recognition , 1995, IEEE Trans. Pattern Anal. Mach. Intell..

[19]  Marc Levoy,et al.  Better optical triangulation through spacetime analysis , 1995, Proceedings of IEEE International Conference on Computer Vision.

[20]  Rachid Deriche,et al.  A Robust Technique for Matching two Uncalibrated Images Through the Recovery of the Unknown Epipolar Geometry , 1995, Artif. Intell..

[21]  Narayan Srinivasa,et al.  Algorithms for Constructing Immobilizing Fixtures and Grasps of Three-Dimensional Objects , 1997 .

[22]  Jitendra Malik,et al.  Normalized cuts and image segmentation , 1997, Proceedings of IEEE Computer Society Conference on Computer Vision and Pattern Recognition.

[23]  Andrew Blake,et al.  Caging Planar Bodies by One-Parameter Two-Fingered Gripping Systems , 1999, Int. J. Robotics Res..

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

[25]  Steven M. LaValle,et al.  Rapidly-Exploring Random Trees: Progress and Prospects , 2000 .

[26]  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).

[27]  Zhengyou Zhang,et al.  A Flexible New Technique for Camera Calibration , 2000, IEEE Trans. Pattern Anal. Mach. Intell..

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

[29]  Dave Eberly Testing for Intersection of Convex Objects: The Method of Separating Axes , 2001 .

[30]  Danica Kragic,et al.  Real-time tracking meets online grasp planning , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[31]  Matthew T. Mason,et al.  Mechanics of Robotic Manipulation , 2001 .

[32]  Gaurav S. Sukhatme,et al.  Most valuable player: a robot device server for distributed control , 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).

[33]  Mitul Saha,et al.  Exact Collision Checking of Robot Paths , 2002, WAFR.

[34]  Andrew Zisserman,et al.  Multi-view Matching for Unordered Image Sets, or "How Do I Organize My Holiday Snaps?" , 2002, ECCV.

[35]  Cordelia Schmid,et al.  An Affine Invariant Interest Point Detector , 2002, ECCV.

[36]  Adrian David Cheok,et al.  Online 6 DOF augmented reality registration from natural features , 2002, Proceedings. International Symposium on Mixed and Augmented Reality.

[37]  Li Zhang,et al.  Rapid shape acquisition using color structured light and multi-pass dynamic programming , 2002, Proceedings. First International Symposium on 3D Data Processing Visualization and Transmission.

[38]  Vincent Lepetit,et al.  Fully automated and stable registration for augmented reality applications , 2003, The Second IEEE and ACM International Symposium on Mixed and Augmented Reality, 2003. Proceedings..

[39]  Li Zhang,et al.  Spacetime stereo: shape recovery for dynamic scenes , 2003, 2003 IEEE Computer Society Conference on Computer Vision and Pattern Recognition, 2003. Proceedings..

[40]  Cordelia Schmid,et al.  Shape recognition with edge-based features , 2003, BMVC.

[41]  Dinesh Manocha,et al.  Fast swept volume approximation of complex polyhedral models , 2003, SM '03.

[42]  Masayuki Inaba,et al.  Motion Planning for Humanoid Robots , 2003, ISRR.

[43]  Philip David,et al.  SoftPOSIT: Simultaneous Pose and Correspondence Determination , 2002, International Journal of Computer Vision.

[44]  T. Tuytelaars,et al.  Matching Widely Separated Views Based on Affine Invariant Regions , 2004, International Journal of Computer Vision.

[45]  Takeo Kanade,et al.  Object Detection Using the Statistics of Parts , 2004, International Journal of Computer Vision.

[46]  Anthony Stentz,et al.  Delayed D*: The Proofs , 2004 .

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

[48]  Andrew Zisserman,et al.  An Affine Invariant Salient Region Detector , 2004, ECCV.

[49]  Cordelia Schmid,et al.  Scale & Affine Invariant Interest Point Detectors , 2004, International Journal of Computer Vision.

[50]  Fumio Kanehiro,et al.  Humanoid robot HRP-2 , 2008, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[51]  Peter K. Allen,et al.  An SVM learning approach to robotic grasping , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[52]  Peter K. Allen,et al.  Graspit! A versatile simulator for robotic grasping , 2004, IEEE Robotics & Automation Magazine.

[53]  Marilena Vendittelli,et al.  The SRT method: randomized strategies for exploration , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[54]  Ronald C. Arkin,et al.  Incorporating Motivation in a Hybrid Robot Architecture , 2004, J. Adv. Comput. Intell. Intell. Informatics.

[55]  Thomas Serre,et al.  Object recognition with features inspired by visual cortex , 2005, 2005 IEEE Computer Society Conference on Computer Vision and Pattern Recognition (CVPR'05).

[56]  Pietro Perona,et al.  Evaluation of Features Detectors and Descriptors based on 3D Objects , 2005, Tenth IEEE International Conference on Computer Vision (ICCV'05) Volume 1.

[57]  Manuela Veloso,et al.  Levels of Multi-Robot Coordination for Dynamic Environments , 2005 .

[58]  K. Gorski,et al.  HEALPix: A Framework for High-Resolution Discretization and Fast Analysis of Data Distributed on the Sphere , 2004, astro-ph/0409513.

[59]  Philip David,et al.  Object recognition in high clutter images using line features , 2005, Tenth IEEE International Conference on Computer Vision (ICCV'05) Volume 1.

[60]  A. Stentz,et al.  The Field D * Algorithm for Improved Path Planning and Replanning in Uniform and Non-Uniform Cost Environments , 2005 .

[61]  K. Okada,et al.  Humanoid motion generation system on HRP2-JSK for daily life environment , 2005, IEEE International Conference Mechatronics and Automation, 2005.

[62]  Gunilla Borgefors,et al.  An Approximation of the Maximal Inscribed Convex Set of a Digital Object , 2005, ICIAP.

[63]  Rej Chum Ond Two-view geometry estimation by random sample and consensus , 2005 .

[64]  Katsushi Ikeuchi,et al.  Planning multiple observations for object recognition , 2005, International Journal of Computer Vision.

[65]  Robert M. Haralick,et al.  Review and analysis of solutions of the three point perspective pose estimation problem , 1994, International Journal of Computer Vision.

[66]  David G. Lowe,et al.  What and Where: 3D Object Recognition with Accurate Pose , 2006, Toward Category-Level Object Recognition.

[67]  Masayuki Inaba,et al.  Cooking for humanoid robot, a task that needs symbolic and geometric reasonings , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[68]  Sebastian Thrun,et al.  Single agent and multi-agent path planning in unknown and dynamic environments , 2006 .

[69]  Satoshi Kagami,et al.  An intelligent joystick for biped control , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[70]  Tamim Asfour,et al.  An integrated approach to inverse kinematics and path planning for redundant manipulators , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[71]  Masayuki Inaba,et al.  Vision based behavior verification system of humanoid robot for daily environment tasks , 2006, 2006 6th IEEE-RAS International Conference on Humanoid Robots.

[72]  Wen-Han Qian,et al.  An Enhanced Ray-Shooting Approach to Force-Closure Problems , 2006 .

[73]  Matei T. Ciocarlie,et al.  Dimensionality reduction for hand-independent dexterous robotic grasping , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[74]  Joel Chestnutt,et al.  Navigation planning for legged robots , 2007 .

[75]  William Whittaker,et al.  Robotic introspection for exploration and mapping of subterranean environments , 2007 .

[76]  James J. Kuffner,et al.  Randomized statistical path planning , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[77]  Olivier Stasse,et al.  Online object search with a humanoid robot , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[78]  Sylvain Miossec,et al.  Continuous gradient proximity distance for humanoids free-collision optimized-postures , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[79]  Gerd Hirzinger,et al.  Capturing robot workspace structure: representing robot capabilities , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[80]  G. Griffin,et al.  Caltech-256 Object Category Dataset , 2007 .

[81]  Angel P. del Pobil,et al.  Task-Oriented Grasping using Hand Preshapes and Task Frames , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[82]  Dmitry Berenson,et al.  Grasp planning in complex scenes , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[83]  Tat-Jen Cham,et al.  Online Learning Asymmetric Boosted Classifiers for Object Detection , 2007, 2007 IEEE Conference on Computer Vision and Pattern Recognition.

[84]  Siddhartha S. Srinivasa,et al.  Randomized path planning for redundant manipulators without inverse kinematics , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[85]  Oussama Khatib,et al.  Synthesis and control of whole-body behaviors in humanoid systems , 2007 .

[86]  Satoshi Kagami,et al.  Learning Object Models for Humanoid Manipulation , 2007 .

[87]  Paul E. Rybski,et al.  An Architecture for the Rapid Development of Robot Behaviors , 2007 .

[88]  Sukhan Lee,et al.  VIsion force control in task-oriented grasping and manipulation , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[89]  Martial Hebert,et al.  A Framework for Learning to Recognize and Segment Object Classes using Weakly Supervised Training Data , 2007, BMVC.

[90]  Elmar Schömer,et al.  Complete, Exact and Efficient Implementation for Computing the Adjacency Graph of an Arrangement of Quadrics , 2007, ESA.

[91]  Heiko Wersing,et al.  Towards incremental hierarchical behavior generation for humanoids , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[92]  Mike Stilman,et al.  Task constrained motion planning in robot joint space , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[93]  Antonio Torralba,et al.  Sharing Visual Features for Multiclass and Multiview Object Detection , 2007, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[94]  Tamim Asfour,et al.  Manipulation Planning Among Movable Obstacles , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[95]  Peter K. Allen,et al.  Grasp Planning via Decomposition Trees , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[96]  Timothy Bretl,et al.  Motion Planning for Legged Robots on Varied Terrain , 2008, Int. J. Robotics Res..

[97]  Takeo Kanade,et al.  A Generative Shape Regularization Model for Robust Face Alignment , 2008, ECCV.

[98]  Stuart J. Russell,et al.  Angelic Hierarchical Planning: Optimal and Online Algorithms , 2008, ICAPS.

[99]  Siddhartha S. Srinivasa,et al.  The robotic busboy: Steps towards developing a mobile robotic home assistant , 2008 .

[100]  John Kenneth Salisbury,et al.  Towards a personal robotics development platform: Rationale and design of an intrinsically safe personal robot , 2008, 2008 IEEE International Conference on Robotics and Automation.

[101]  Advait Jain,et al.  Behaviors for Robust Door Opening and Doorway Traversal with a Force-Sensing Mobile Manipulator , 2008 .

[102]  Oliver Brock,et al.  Motion for Manipulation Tasks , 2008, Springer Handbook of Robotics, 2nd Ed..

[103]  Masayuki Inaba,et al.  Manipulation and recognition of objects incorporating joints by a humanoid robot for daily assistive tasks , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[104]  P. Michel Integrating perception & planning for humanoid autonomy , 2008 .

[105]  Stergios I. Roumeliotis,et al.  Appearance-based mapping using minimalistic sensor models , 2008, Auton. Robots.

[106]  Alexei A. Efros,et al.  Recognition by association via learning per-exemplar distances , 2008, 2008 IEEE Conference on Computer Vision and Pattern Recognition.

[107]  Jan-Michael Frahm,et al.  3D model matching with Viewpoint-Invariant Patches (VIP) , 2008, 2008 IEEE Conference on Computer Vision and Pattern Recognition.

[108]  Siddhartha S. Srinivasa,et al.  Manipulation planning with caging grasps , 2008, Humanoids 2008 - 8th IEEE-RAS International Conference on Humanoid Robots.

[109]  Siddhartha S. Srinivasa,et al.  BiSpace Planning: Concurrent Multi-Space Exploration , 2008, Robotics: Science and Systems.

[110]  Shuuji Kajita,et al.  Kinodynamic gait planning for full-body humanoid robots , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[111]  James J. Kuffner,et al.  OpenRAVE: A Planning Architecture for Autonomous Robotics , 2008 .

[112]  Nico Blodow,et al.  Towards 3D Point cloud based object maps for household environments , 2008, Robotics Auton. Syst..

[113]  Sukhan Lee,et al.  Robotic execution of everyday tasks by means of external vision/force control , 2008, Intell. Serv. Robotics.

[114]  Stefan Schaal,et al.  Learning to Control in Operational Space , 2008, Int. J. Robotics Res..

[115]  Alexei A. Efros,et al.  An empirical study of context in object detection , 2009, 2009 IEEE Conference on Computer Vision and Pattern Recognition.

[116]  Maxim Likhachev,et al.  Planning Long Dynamically Feasible Maneuvers for Autonomous Vehicles , 2008, Int. J. Robotics Res..

[117]  Manuela M. Veloso,et al.  Prioritized Multihypothesis Tracking by a Robot with Limited Sensing , 2009, EURASIP J. Adv. Signal Process..

[118]  Jean-Michel Morel,et al.  ASIFT: A New Framework for Fully Affine Invariant Image Comparison , 2009, SIAM J. Imaging Sci..

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

[120]  Gerd Hirzinger,et al.  Using a model of the reachable workspace to position mobile manipulators for 3-d trajectories , 2009, 2009 9th IEEE-RAS International Conference on Humanoid Robots.

[121]  Takeo Kanade,et al.  A robust shape model for multi-view car alignment , 2009, 2009 IEEE Conference on Computer Vision and Pattern Recognition.

[122]  J. Matousek,et al.  Geometric Discrepancy: An Illustrated Guide , 2009 .

[123]  Geoffrey A. Hollinger,et al.  Combining search and action for mobile robots , 2009, 2009 IEEE International Conference on Robotics and Automation.

[124]  Takeo Kanade,et al.  Accurate camera calibration using iterative refinement of control points , 2009, 2009 IEEE 12th International Conference on Computer Vision Workshops, ICCV Workshops.

[125]  Dae-Jin Kim,et al.  Eye-in-hand stereo visual servoing of an assistive robot arm in unstructured environments , 2009, 2009 IEEE International Conference on Robotics and Automation.

[126]  Takeo Kanade,et al.  Integrating grasp planning and visual feedback for reliable manipulation , 2009, 2009 9th IEEE-RAS International Conference on Humanoid Robots.

[127]  Kenji Shimada,et al.  Morphological design optimization of kinematically redundant manipulators using weighted isotropy measures , 2009, 2009 IEEE International Conference on Robotics and Automation.

[128]  Matei T. Ciocarlie,et al.  Hand Posture Subspaces for Dexterous Robotic Grasping , 2009, Int. J. Robotics Res..

[129]  Michael Beetz,et al.  Learning and performing place-based mobile manipulation , 2009, 2009 IEEE 8th International Conference on Development and Learning.

[130]  Victor Ng-Thow-Hing,et al.  Fast smoothing of manipulator trajectories using optimal bounded-acceleration shortcuts , 2010, 2010 IEEE International Conference on Robotics and Automation.

[131]  Geoffrey A. Hollinger,et al.  HERB: a home exploring robotic butler , 2010, Auton. Robots.

[132]  Steven M. LaValle,et al.  Generating Uniform Incremental Grids on SO(3) Using the Hopf Fibration , 2010, WAFR.

[133]  Daniel Leidner,et al.  Exploiting structure in two-armed manipulation tasks for humanoid robots , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.