Springer Tracts in Advanced Robotics Volume 29 Editors: Bruno Siciliano · Oussama Khatib · Frans Groen Cristian Secchi Stefano Stramigioli Cesare Fantuzzi Control of Interactive Robotic Interfaces A Port-Hamiltonian Approach With 86 Figures Professor Bruno Siciliano, Dipartimento di Informatica e Sistemistica, Universit`a degli Studi di Napoli Fede- rico II, Via Claudio 21, 80125 Napoli, Italy, email: siciliano@unina.it Professor Oussama Khatib, Robotics Laboratory, Department of Computer Science, Stanford University, Stanford, CA 94305-9010, USA, email: khatib@cs.stanford.edu Professor Frans Groen, Department of Computer Science, Universiteit vanAmsterdam, Kruislaan 403, 1098 SJ Amsterdam, The Netherlands, email: groen@science.uva.nl Authors Dr. Cristian Secchi Prof. Dr. Cesare Fantuzzi DISMI – University of Modena and Reggio Emilia Morselli Building Via G. Amendola 2 42100 Reggio Emilia Italy secchi.christian@unimore.it cesare.fantuzzi@unimore.it Prof. Dr. Stefano Stramigioli Universiteit Twente EL/CE Postbus 217 7500 EAE Enschede The Netherlands S.Stramigioli@ieee.org ISSN print edition: 1610-7438 ISSN electronic edition: 1610-742X ISBN-10 3-540-49712-9 Springer Berlin Heidelberg New York ISBN-13 978-3-540-49712-7 Springer Berlin Heidelberg New York Library of Congress Control Number: 2006937681 This work is subject to copyright. All rights are reserved, whether the whole or part of the material is concerned, specifically the rights of translation, reprinting, reuse of illustrations, recitation, broadcasting, reproduction on microfilm or in other ways, and storage in data banks. Duplication of this publication or parts thereof is permitted only under the provisions of the German Copyright Law of September 9, 1965, in its current version, and permission for use must always be obtained from Springer. Violations are liable to prosecution under German Copyright Law. Springer is a part of Springer Science+Business Media springer.com © Springer-Verlag Berlin Heidelberg 2007 Printed in Germany The use of general descriptive names, 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 protective laws and regulations and therefore free for general use. Typesetting: Digital data supplied by authors. Data-conversion and production: PTP-Berlin Protago-T E X-Production GmbH, Germany (www.ptp-berlin.com) Cover-Design: WMXDesign GmbH, Heidelberg Printed on acid-free paper 89/3141/Yu-543210 Editorial Advisory Board EUROPE Herman Bruyninckx, KU Leuven, Belgium Raja Chatila, LAAS, France Henrik Christensen, KTH, Sweden Paolo Dario, Scuola Superiore Sant’Anna Pisa, Italy R¨udiger Dillmann, Universit¨at Karlsruhe, Germany AMERICA Ken Goldberg, UC Berkeley, USA John Hollerbach, University of Utah, USA Lydia Kavraki, Rice University, USA Tim Salcudean, University of British Columbia, Canada Sebastian Thrun, Stanford University, USA ASIA/OCEANIA Peter Corke, CSIRO, Australia Makoto Kaneko, Hiroshima University, Japan Sukhan Lee, Sungkyunkwan University, Korea Yangsheng Xu, Chinese University of Hong Kong, PRC Shin’ichi Yuta, Tsukuba University, Japan STAR (Springer Tracts in Advanced Robotics) has been promoted under the auspices of EURON (European Robotics Research Network) ROBOTICS Research Network European EURON * * * * * * * * * * * * #'0#' Q Q3& $W; =+ Q3& ;&W 9588&;;5U9# K==Q5 L 5L U;$&K2=5;2 96=K QK;L+=K4 9Q5=; 5; L =?& ;$ $59&;L5=;C K=9 8K2&8Y $=95;;Q 5;$ULQK58 += UL# K=4 =Q5 L 5L K?5$8Y &X?;$5;2 5;Q= Q3& 388&;2&L =+ U;LQKU QUK&$ &;V5K=;9&;QLC ;Q&K Q5;2 W5Q3# LL5LQ5;2# L&KV5;2# ;$ &X?8=K5;2 W5Q3 3U9;L# Q3& &9&K25;2 K==QL W588 5; K&L5;28Y Q=U 3 ?&=?8& ;$ Q3&5K 85V&LC 3& 2=8 =+ Q3& ;&W L&K5&L =+ 4<+0(< <B= +0 F0 22B+= 56 5L Q= K5;2# 5; Q59&8Y +L35=;# Q3& 8Q&LQ $V; &L ;$ $&V&8=?9&;QL 5; K=4 =Q5 L =; Q3& L5L =+ Q3&5K L52;5. ; & ;$ EU85QYC Q 5L =UK 3=?& Q3Q Q3& W5$&K $5LL&95;Q5=; =+ K&L&K 3 $&V&8=?9&;QL W588 LQ59U8Q& 9=K& &X 3;2&L ;$ =88=KQ5=;L 9=;2 Q3& K&L&K 3 =99U;5QY ;$ =;QK5UQ& Q= +UKQ3&K $V; &9&;Q =+ Q35L K?5$8Y 2K=W5;2 .&8$C 3& 9=;=2K?3 WK5QQ&; Y K5LQ5; & 35# Q&+;= QK9525=85 ;$ &L4 K& ;QUZZ5 5L += UL&$ =; Q3& K=8& =+ &;&K2Y 5; =;QK=885;2 ?3YL5 8 LYLQ&9LC 3& ?=KQ4958Q=;5; +=K985L9 5L $=?Q&$ W35 3 ?K=V5$&L +K9&W=K7 +=K 9=$&85;2 ?3YL5 8 LYLQ&9L L&$ =; Q3& =; &?QL =+ &;&K2Y# 5;Q&K =;;& Q5=; ;$ ?=W&K ?=KQL $&L K55;2 Q3& ?3&;=9&; =+ &;&K2Y LQ=K2&# &;&K2Y &X 3;2& ;$ &XQ&K;8 5;Q&K Q5=; K&L?& Q5V&8YC 3& ?=Q&;Q58 =+ Q3& W=K7 5L Q= & +=U;$ 5; Q3& 9=$&885;2 ;$ =;QK=8 =+ 5;Q&K Q5V& K==Q5 5;Q&K+ &L# LU 3 L 3?Q5 $&V5 &L ;$ Q&8&9;5?U8Q5=; LYLQ&9LC &9K78Y# Q3& $= Q=K8 Q3&L5L Q Q3& L5L =+ Q35L 9=;=2K?3 WL .;85LQ +=K Q3& 5+Q3 &=K2&L 5K8Q 3 WK$ $&V=Q&$ Q= Q3& &LQ 3 Q3&L5L 5; ==Q5 L 5; UK=?&C .;& $$5Q5=; Q= Q3& L&K5&L* ?8&L# Q8Y# <E02 ++.+02 &?Q&9&K T[[O +B2< ' 3& K=8& =+ &;&K2Y 5; 9=$&85;2 ?3YL5 8 LYLQ&9 5L V&KY W&88 &LQ85L3&$ ;$ L&V&K8 9=$&85;2 +K9&W=K7L# LU 3 L U8&K42K;2& ;$ 958Q=;5; +=K4 985L9L# K& V&KY W&88 7;=W; L5; & L5 =UKL&L =+ ?3YL5 LC &L?5Q& 5QL 594 ?=KQ; & 5; 9=$&85;2# Q3& K=8& =+ &;&K2Y 5; =;QK=885;2 ?3YL5 8 LYLQ&9L 5L ;=Q 8WYL K& =2;5Z&$C 3& ?=KQ4958Q=;5; +=K985L9 ?K=V5$&L +K9&W=K7 +=K 9=$&85;2 ?3Y4 L5 8 LYLQ&9L L&$ =; Q3& =; &?QL =+ &;&K2Y# 5;Q&K =;;& Q5=; ;$ ?=W&K ?=KQL W35 3 9=$&8 Q3& ?3&;=9&; =+ &;&K2Y LQ=K2&# &;&K2Y &X 3;2& ;$ &XQ&K;8 5;Q&K Q5=; K&L?& Q5V&8YC 3UL# W5Q35; Q35L +K9&W=K7 Q3& &;&K2&Q5 ?K=?&KQ5&L =+ ?3YL5 8 LYLQ&9L K& V&KY &V5$&;Q ;$ 5Q 5L ?=LL58& Q= &X?8=5Q Q3&9 Q= U58$ &;&K2Y L&$ =;QK=88&KLC 35L W=K7 5L L&$ =; Q3& 3CC Q3&L5L =+ Q3& .KLQ UQ3=K W35 3 3& $&+&;4 $&$ Q Q3& ;5V&KL5QY =+ =$&; ;$ &225= 9585 @A 5; T[[1 ;$ 5Q $&8L W5Q3 &;&K2Y L&$ =;QK=8 =+ 5;Q&K Q5V& K==Q5 5;Q&K+ &LC 3&; QW= ?3YL5 8 ?3YL5 8 LYLQ&9L 5;Q&K Q Q3&Y &X 3;2& &;&K2Y ;$ 5; =K$&K Q= =;QK=8 Q3& 5;Q&K Q5=; 5; L&;L58& WY# 5Q 5L ;& &LLKY Q= =;QK=8 Q35L &;&K2Y &X 3;2&C ; Q35L ==7# ?=KQ4958Q=;5; +K9&W=K7 5L &X?8=5Q&$ =Q3 +=K 9=$&85;2 ;$ =;QK=885;2 5;Q&K Q5V& K==Q5 5;Q&K+ &LC QKQ5;2 +K=9 Q3& ?=KQ4958Q=;5; 9=$&8# 5Q 5L ?=LL58& Q= 5$&;Q5+Y Q3& &;&K2&Q5 ?K=?&KQ5&L Q3Q 3V& Q= & =;QK=88&$ 5; =K$&K Q= 35&V& $&L5K&$ 5;Q&K Q5V& &3V5=K ;$ 5Q 5L ?=LL58& Q= U58$ ?=KQ4958Q=;5; =;QK=84 8&K Q3Q ?K=?&K8Y K&2U8Q&L Q3& K==Q5 5;Q&K+ &C U& Q= 5QL 2&;&K85QY# ?=KQ4 958Q=;5; +=K985L9 88=WL Q= $&8 8L= W5Q3 =9?8&X 5;Q&K Q5V& LYLQ&9L# LU 3 L 3?Q5 5;Q&K+ &L ;$ Q&8&9;5?U8Q5=; LYLQ&9L# =Q3 85;&K ;$ ;=; 85;&K# 5; V&KY 5;QU5Q5V& WYC ;Y ?&=?8& =;QK5UQ&$ Q= Q3& K&LU8QL ?K&L&;Q&$ 5; Q35L ==7C ; ?KQ54 U8K# Q3& UQ3=KL W=U8$ 857& Q= Q3;7 &K;3K$ L 37& ;$ K6; V; $&K 3+Q W3=L& K&9K7L 3V& 8WYL &&; V&KY V8U8&C UKQ3&K9=K&# W& W=U8$ 857& Q= Q3;7 8&LL;$K= 3&885# 8U$5= &8 35=KK5 ;$ 5 =8 5=85Q5 +=K Q3& V&KY ?8&L;Q ;$ ?K=.Q8& =88=KQ5=;L ;$ $5L ULL5=;LC K5&+ =UQ85;& =+ Q3& ==7 5L 25V&; 5; Q3& +=88=W5;2C D$($ ; 3?Q&K ># LQKQ5;2 +K=9 Q3& L=4 88&$ &3V5=K8 ??K= 3 +=K 9=$&85;2# 5Q 5L L3=W; Q3Q Q3& &;&K2Y ;$ Q3& &;&K2&Q5 5;Q&K =;;& Q5=;L# 8=;2 W35 3 Q3& 5;Q&K;8 ?=W&K &X 3;2& Q7&L ?8 &# ;$# Q3& ?=KQL Q3K=U23 W35 3 ?=W&K 5L &X 3;2&$ W5Q3 Q3& &XQ&K;8 W=K8$# K& Q3& &LL&;Q58 5;2K&$5&;QL Q= 9=$&8 Q3& &3V5=K =+ ?3YL5 8 LYLQ&9LM Q3& 9Q3&9Q5 8 =6& Q =+ 5K LQKU QUK& 5L 5;QK=$U &$ ;$ =Q3 59?85 5Q ;$ &X?85 5Q ?=KQ4958Q=;5; LYLQ&9L K& 5;QK=$U &$C ; 3?Q&K T &;&K2Y 5L &X?8=5Q&$ +=K =;QK=8 ?UK?=L& ;$ 5Q 5L L3=W; 3=W Q= &X?8=5Q Q3& &;&K2&Q5 ?K=?&KQ5&L =+ ?=KQ4958Q=;5; LYLQ&9L Q= U58$ &;&K2Y4 L&$ =;QK=88&KL Q3Q 88=W Q= L=8V& Q3& K&2U8Q5=; ?K=8&9 +=K ?3YL5 8 LY4 LQ&9LC 3& L5 L =+ ?LL5V5QY Q3&=KY K& ?K&L&;Q&$ ;$ Q3& 85;7 &QW&&; LQ585QY =+ &KQ5; =;.2UKQ5=; ;$ Q3& L3?& =+ Q3& &;&K2Y =+ Q3& ?3YL54 8 LYLQ&9 5L 588ULQKQ&$C 3& &;&K2Y L3?5;2 K&2U8Q5=; Q& 3;5EU& +=K ?=KQ4 958Q=;5; LYLQ&9L 5L ?K&L&;Q&$ =Q3 +K=9 ; &;&K2Y 8; 5;2 ;$ ; 5;4 Q&K =;;& Q5=; ; $9?5;2 LL52;9&;Q ?&KL?& Q5V&C =;QK=8 LQKQ&2Y Q3Q &9&$L VK58& LQKU QUK& Q& 3;5EU&L 5; &;&K2Y L&$ =;QK=8 5L 588ULQKQ&$C 3& K&LU8Q5;2 =;QK=8 L 3&9& 88=WL Q= &;3; & K=ULQ;&LL ;$ ?&K+=K9;4 &L 5; K&2U8Q5=; QL7L ;$ 5Q 5L Q3& K&LU8Q =+ =88=KQ5=; W5Q3 8&LL;$K= 3&885 ;$ 8U$5= &8 35=KK5 +K=9 Q3& ;5V&KL5QY =+ =8=2;C ; 3?Q&K R Q3& ?K=8&9 =+ =;QK=885;2 5;Q&K Q5V& K==Q5 5;Q&K+ &L 5L 5;4 QK=$U &$C ; &;&K2&Q5 ;8YL5L =+ 5;Q&K Q5=; 5L ?K=V5$&$ ;$ ; 5;QK5;L5 88Y ?LL5V& =;QK=8 LQKQ&2Y +=K 5;Q&K Q5V& LYLQ&9L 5L ?K&L&;Q&$M ?=KQ4958Q=;5; =;QK=88&KL K& UL&$ Q= L3?& Q3& &;&K2&Q5 ?K=?&KQ5&L =+ Q3& K==Q5 5;Q&K4 + & ;$# Q3&K&+=K&# Q= 35&V& Q3& $&L5K&$ 75;$ =+ =;Q Q &3V5=KC ?=KQ4 958Q=;5; 59?&$; & =;QK=88&K @8L= 88&$ A 5L 5;QK=$U &$ ;$ L=9& ;&W $&V&8=?9&;QL Q3Q 88=W Q= $&8 8L= W5Q3 $&+& Q5V& ;Q3K=?=9=K?35 K==QL ;$ W5Q3 =9?8&X K==Q5 5;Q&K+ &L L K==Q5 3;$L K& 588ULQKQ&$C UKQ3&K9=K&# ; &;&K2&Q5 9=$&8 =+ 2&;&K5 3?Q5 5;Q&K+ & 5L ?K&L&;Q&$ ;$ Q3& ?=KQ4958Q=;5; +=K985L9 5L UL&$ +=K U58$5;2 ; 5;QK5;L5 88Y ?LL5V& =;QK=8 L 3&9& +=K 3?Q5 5;Q&K+ &L W35 3 88=WL LQ8& 5;Q&K Q5=; W5Q3 2&4 ;&K5 # =Q3 85;&K ;$ ;=;85;&K# V5KQU8 &;V5K=;9&;QLC 5;88Y# &X?8=5Q5;2 Q3& ?=KQ4958Q=;5; +=K985L9# L=9& QY?5 8 ?K=8&9L K&8Q&$ Q= 3?Q5 5;Q&K+4 &L L Q3Q =+ $&8Y&$ V5KQU8 &;V5K=;9&;QL ;$ =+ +=K & L 85;2 K& ;8YZ&$ ;$ L=8V&$C ; 3?Q&K 1 58Q&K8 Q&8&9;5?U8Q5=; LYLQ&9L# Q3Q 88=WL Q= 5;Q&K Q W5Q3 K&9=Q& &;V5K=;9&;Q# K& 5;QK=$U &$ ;$ ; &;&K2Y L&$ ;8YL5L 5L ?K=4 V5$&$C =KQ4958Q=;5; +=K985L9 Q=2&Q3&K W5Q3 L QQ&K5;2 Q3&=KY K& UL&$ Q= 35&V& ; 5;QK5;L5 88Y ?LL5V& ?=KQ4958Q=;5; L&$ 58Q&K8 Q&8&9;54 ?U8Q5=; L 3&9& W35 3 &X355QL LQ8& &3V5=K =Q3 5; L& =+ =;Q Q W5Q3 Q3& K&9=Q& &;V5K=;9&;Q ;$ =+ +K&& 9=Q5=;# 5;$&?&;$&;Q8Y =+ ;Y $&8YC Q 5L L3=W; 3=W Q= &XQ&;$ Q3& L 3&9& 5; =K$&K Q= ?LL5V&8Y $&8 W5Q3 Q3& $5L K&Q& ;QUK& =+ Q3& =;QK=88&KL ;$ W5Q3 VK58& $&8Y ? 7&Q LW5Q 35;2 =99U;54 Q5=; 3;;&8L @&C2C ;Q&K;&QAC 5;88Y# ?LL5V5QY ?K&L&KV5;2 5;Q&K?=8Q5=; 82=K5Q39 5L 5;QK=$U &$ 5; =K$&K Q= 59?K=V& ?&K+=K9; &L =+ Q3& Q&8&9;5?U4 8Q5=; L 3&9& 5; L& =+ 8=LL =+ ? 7&QL 5; Q3& =99U;5 Q5=;C D$($ ; 3?Q&K / Q3& ?K=8&9 =+ QK;L?K&; Y 5; 58Q&K8 Q&8&9;5?U8Q5=; 5L 588ULQKQ&$C +K9&W=K7# L&$ =; Q3& &3V5=K8 ??K= 3# +=K Q3& &V8U4 Q5=; =+ QK;L?K&; Y 5L ?K&L&;Q&$ ;$ UL&$ Q= &V8UQ& QK;L?K&; Y =+ ?=KQ4 958Q=;5; L&$ 5;QK5;L5 88Y ?LL5V& 58Q&K8 Q&8&9;5?U8Q5=; L 3&9&LC XQ&;$&$ ?=KQ4958Q=;5; LYLQ&9L K& 5;QK=$U &$ Q= 88=W ?LL5V5QY ?K&4 L&KV5;2 VK5Q5=; =+ ?3YL5 8 ?K9&Q&KL 3K Q&K5Z5;2 Q3& ?=KQ4958Q=;5; =;QK=88&KL UL&$ Q= =;QK=8 9LQ&K ;$ L8V& K==QLC 3&L& K&LU8QL K& Q3& =UQ4 =9& =+ =88=KQ5=; W5Q3 5 =8 5=85Q5 +K=9 Q3& ;5V&KL5QY =+ =8=2;C ;=V&8 L 3&9& Q3Q 88=WL Q= 5; K&L& QK;L?K&; Y 5; ?=KQ4958Q=;5; L&$ 58Q&K8 Q&8&9;5?U8Q5=; 5L ?K=?=L&$ UL5;2 Q3& VK58& ?K9&Q&KL C 5;88Y# 5; ??&;$5X # L=9& 72K=U;$ =; Q3& 9Q3&9Q5 8 Q==8L UL&$ 5; Q3& ==7 5L ?K=V5$&$C &225= 9585 @Q8YA# <+=B+0 )+ ;L 3&$& @3& &Q3&K8;$LA# B!02 B</+(+2.+ U2ULQ T[[O =< 0BEJJ+ #"+"+( 1 'C8), 0,).& . 07<(-),<0.). C8<-8 CCCCCCCCC > >C> ;QK=$U Q5=; CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC > >CT 3& &3V5=K8 K$529 +=K =$&85;2 Y;95 8 YLQ&9L C C C T >CTC> ;5V&KL&# &3V5=K ;$ &3V5=K8 EUQ5=;L CCCCCCCCC T >CTCT ;5+&LQ ;$ Q&;Q K58&L CCCCCCCCCCCCCCCCCCCCCC R >CTCR Y;95 8 YLQ&9L CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC 1 >CTC1 ;?UQL ;$ UQ?UQL CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC ' >CR 3YL5 8=$&85;2CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC >[ >C1 9?85 5Q =KQ4958Q=;5; YLQ&9L CCCCCCCCCCCCCCCCCCCCCCCC >1 >C1C> ==K$5;Q& L&$ &?K&L&;QQ5=; CCCCCCCCCCCCCCCCC >' >C/ &=9&QK5 QQ&K5;2 CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC T/ >CO =; 8UL5=;LCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC R[ > 0.<70, 0 07<(-),<0.). C8<-8 CCCCCCCCCCCCCCCCCCCCCC RR TC> ;QK=$U Q5=; CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC RR TCT L5 =; &?QL =+ LL5V5QY 3&=KY CCCCCCCCCCCCCCCCCCCCCCCC R1 TCTC> &.;5Q5=;L ;$ K=?&KQ5&L CCCCCCCCCCCCCCCCCCCCCCCCCC R1 TCTCT UQ?UQ &&$ 7 Q585ZQ5=; =+ LL5V& YLQ&9L CCCCC R' TCTCR =KQ4958Q=;5; YLQ&9L ;$ LL5V5QY CCCCCCCCCCCCC 1[ TCR ;&K2Y 3?5;2 =+ =KQ4958Q=;5; YLQ&9L CCCCCCCCCCCCCCC 11 TCRC> Q585ZQ5=; Y ;&K2Y 8; 5;2 CCCCCCCCCCCCCCCCCCC 1/ TCRCT 3& =;QK=8 L ;Q&K =;;& Q5=; K$529 C CCCCCCCCCCC /> TCRCR ;&K2Y 3?5;2 L =;QK=8 Y ;Q&K =;;& Q5=; CCCCCCCC // TC1 ;Q&K =;;& Q5=; ;$ 9?5;2 LL52;9&;Q LL5V5QY L&$ =;QK=8 CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC O[ TC/ K58& QKU QUK& ??K= 3 Q= ;&K2Y4L&$ =;QK=8 CCCCC O1 TCO =; 8UL5=;L CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC N1 = 07<(-),<0.). 2270' <0 <' 0.<70, 0 .<7<)0. NN RC> ;QK=$U Q5=; CCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCCC NN RCT ;QK5;L5 88Y LL5V& =;QK=8 =+ ;Q&K Q5=; CCCCCCCCCCCCCCCCCC N' . German Copyright Law. Springer is a part of Springer Science+Business Media springer. com © Springer- Verlag Berlin Heidelberg 2007 Printed in Germany The use. Springer Tracts in Advanced Robotics Volume 29 Editors: Bruno Siciliano · Oussama Khatib · Frans Groen Cristian