Lecture Notes in Control and Information Sciences 233 Editor: M. Thoma
Pasquale Chiacchio and Stefano Chiaverini (Eds) Complex Robotic Systems ~ Springer
Series Advisory Board A. Bensoussan M.J. Grimble P. Kokotovic H. Kwakernaak J.L. Masse)" Editors Dr Pasquale Chiacchio Dr Stefano Chiaverini Dipartimento di Informatica e Sistemistica, Universith degli Studi Napoli Federico II, Via Claudio 21,1-80125 Napoli, Italy ISBN 3-540-76265-5 Springer-Verlag Berlin Heidelberg New York British Library Cataloguing in Publication Data Complex robotic systems. - (Lecture notes in control and information sciences ; 233) 1.Robotics I.Chiacchio, Pasquale II.Chiaverini, Stefano 629.8'92 ISBN 3540762655 Library of Congress Cataloging-in-Publication Data A catalog record for this book is available from the L~rary of Congress Apart from any fair dealing for the purposes of research or private study, or criticism or review, as permitted under the Copyright, Designs and Patents Act 1988, this publication may only be reproduced, stored or transmitted, in any form or by any means, with the prior permission in writing of the publishers, or in the case of reprographic reproduction in accordance with the terms of ticences issued by the Copyright Licensing Agency. Enquiries concerning reproduction outside those terms should be sent to the publishers. Springer-Verlag London Limited 1998 Printed in Great Britain The use of registered names, trademarks, etc. in this publication does not imply, even in the absence of a specific statement, that such names are exempt from the relevant laws and regulations and therefore free for general use. The pubnsher makes no representation, express or impued, with regard to the accuracy of the information contained in this book and cannot accept any legal responsibility or liability for any errors or omissions that may be made. Typesetting: Camera read)" by editors Printed and bound at the Athenmum Press Ltd., Gateshead, Tyne & Wear 6913830-543210 Printed on acid-free paper
No' si volta chi a stella ~ fisso. Leonardo da Vinci
Preface The challenges that mankind must face in this era of astonishing progress in technology calls for the development of a common and up-to-date worldwide knowledge base. When working at this book our intention was to realize a small contribution to the achievement of this goal within the field of Robotics. Robotic systems have proven themselves to be of increasing importance and are widely adopted to substitute for humans in repetitive and/or hazardous tasks. Their diffusion has outgrown the limits of industrial applications in manufacturing systems to cover all the aspects of exploration and servicing in hostile environments such as undersea, outer space, battlefields, and nuclear plants. Complex robotic systems, i.e. robotic systems with a complex structure and architecture, are gaining increasing attention from both the academic community and industrial users. The modeling and control problems for these systems cannot be regarded as simple extensions of those for traditional single manipulators since additional complexity arises: to accomplish typical tasks there is the need to ensure coordinated motion of the whole system together with management of interaction between each component of the system. This book focuses on two examples of complex robotic systems; namely, cooperating manipulators and multi-fingered hands. In April 1997 we organized a Tutorial Session on these topics at the IEEE International Conference on Robotics and Automation held in Albuquerque, NM, collecting contributions from distinguished scientists throughout the world. The collected material was of high quality and up-to-date, thus we thought it could be of interest to a wider audience. Therefore, we asked all the contributors to further extend their manuscripts; all of them agreed and the result of this joint effort is this book. Although the book is the outcome of a joint project, the individual contributions are attributed as detailed in the following. We feel the need to thank our colleagues for their motivation during the project. vii
viii Preface In Chapter 1, Masaxu Uchiyama gives a general perspective of the state of the art of multi-arm robot systems. After outlining the historical evolution of studies in this area, he gives the fundamentals of kinematics, statics and dynamics of such systems. Chapter 2 has been written by John T. Wen and Lee S. Wilfinger. They extend the manipulability concept commonly used for serial manipulators to general constrained rigid multibody systems. The concepts of unstable grasp and manipulable grasp are also introduced. In Chapter 3 we present the kinematic control approach for a dualarm system. An effective formulation is presented which fully characterizes a coordinated motion task, and a closed-loop algorithm for the inverse kinematics problem is developed. A joint-space control scheme based on kineto-static filtering of the joint errors is devised and analyzed. Michael A. Unseren in Chapter 4 reviews a method for dynamic load distribution, dynamic modeling, and explicit internal force control when two serial link manipulators mutually lift and transport a rigid object. A control architecture is also suggested which explicitly decouples the two set of equations comprising the model. Ian D. Walker devotes Chapter 5 to a survey of design, analysis, and control of artificial multi-fingered hands and corresponding research in the area of machine dexterity. An extensive bibliography is also provided. In Chapter 6 Friedrich Pfeiffer presents optimal coordination and control of multi-fingered hands for grasping and regrasping. The method is applied to an experimental setup consisting of a hand with hydraulically driven fingers which ensure good force control. The book is addressed to graduate students as well as to researchers in the field. We hope they will find it useful and fruitful. Napoli, Italy, September 1997 Pasquale Chiacchio, Ste/ano Chiaverini Contributors, in chapters' order, are: Masaru Uchiyama, Tohoku University, Japan; John T. Wen and Lee S. Wilfinger, Rensselaer Polytechnic Institute, U.S.A.; Pasquale Chiacchio and Stefano Chiaverini, Universit/~ di Napoli Federico II, Italy; Michael A. Unseren, Oak Ridge National Laboratory, U.S.A.; Inn D. Walker, Clemson University, U.S.A.; Friedrich Pfeiffer, Technische Universit t M/inchen, Germany.
Contents Multi-arm robot systems: A survey 1 1.1 Introduction... 1 1.2 Dynamics of multi-arm robots... 3 1.3 Derivation of task vectors... 6 1.3.1 External and internal forces/moments... 7 1.3.2 External and internal velocities... 8 1.3.3 External and internal positions/orientations... 9 1.4 Hybrid position/force control... 10 1.5 Load sharing... 11 1.6 Practical implementation... 13 1.7 Advanced topics... 18 1.7.1 Multi-flexible-arm robots... 18 1.7.2 Slip detection and robust holding... 22 1.8 Conclusions... 26 References............................... 27 Kinematic manipulability of general mechanical systems 33 2.1 Introduction... 33 2.2 Differential kinematics and static force model... 35 2.2.1 Differential kinematics... 35 2.2.2 Force balance... 39 2.3 Velocity and force manipulability ellipsoids... 41 2.3.1 Serial manipulators... 41 2.3.2 Velocity ellipsoid... 42 2.3.3 Force ellipsoid... 45 2.3.4 Configuration stability and manipulability... 47 2.3.5 Internal force and virtual velocity... 48 2.4 Illustrative examples... 48 2.4.1 Simple two-arm example... 48 2.4.2 Planar Stewart platform example... 50 ix
CONTENTS 2.4.3 Six-DOF Stewart platform example... 53 2.5 Effects of arm posture and bracing on manipulability... 55 2.5.1 Effect of arm posture... 55 2.5.2 Effect of bracing... 59 2.5.3 Effect of brace location... 62 2.5.4 Effect of brace contact type... 63 2.6 Comparison of manipulability ellipsoids... 66 2.7 Conclusions... 73 References............................... 76 3 4 Kinematic control of dual-arm systems 3.1 3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 Introduction... 80 Cooperative task description... 81 Differential ldnematics... 83 Inverse kinematics algorithm... 85 Cooperative system modeling... 87 Joint space control... 89 Stability analysis... 91 3.7.1 Imperfect compensation of gravity terms... 92 Addition of a force loop... 94 Conclusions... 95 References............................... Load distribution and control of interacting manipulators 99 4.1 Introduction... 100 4.2 System description and dynamics... 102 4.2.1 System variables and coordinate frames... 102 4.2.2 Manipulator dynamics... 104 4.2.3 Object dynamics... 105 4.3 A general framework for load distribution... 106 4.3.1 Identifying motion inducing and internal stress components of (~ Y)... 108 4.3.2 Choosing matrix M... 109 4.4 Modeling of ldnematic coupling effects... 112 4.5 Derivation of rigid body model in joint space... 114 4.6 Reduced order model... 117 4.7 Control architecture... 120 4.8 Conclusions... 121 References............................... 123 79 95
CONTENTS xi Multi-fingered hands: A survey 129 5.1 Robot hand hardware..................... 129 5.2 Key issues underlying multifingered manipulation... 132 5.2.1 Contact conditions and the release of constraints.. 133 5.3 Ongoing research issues.................... 134 5.3.1 Grasp synthesis..................... 134 5.3.2 Grasp stability..................... 135 5.3.3 The importance of friction... 136 5.3.4 Finger force distribution issues... 137 5.3.5 Varying contacts: Rolling and sliding... 139 5.3.6 Kinematics of rolling contact... 139 5.3.7 Grasp compliance and control... 141 5.4 Further research issues..................... 143 5.5 Current limitations....................... 144 5.6 Conclusions........................... 145 References............................... 145 6 Grasping optimization and control 161 6.1 Introduction........................... 161 6.2 Grasp strategies......................... 163 6,3 The TUM-hydraulic hand... 168 6.3.1 The design....................... 168 6.3.2 Measurement and control... 169 6.4 Examples............................ 172 6.5 Conclusions........................... 175 References............................... 177