Advanced Robotics - Control of Interactive Robotic Interfaces Volume 29 Part 1 pptx

Springer Tracts in Advanced RoboticsVolume 29 Editors: Bruno Siciliano · Oussama Khatib · Frans Groen... rico II, Via Claudio 21, 80125 Napoli, Italy, email: siciliano@unina.itProfessor

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

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 van Amsterdam, 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-TEX-Production GmbH, Germany (www.ptp-berlin.com) Cover-Design: WMXDesign GmbH, Heidelberg

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)

ROBOTICSResearch

Network European

EUR

ON

* ** **

**

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+= 5
6 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*

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&K42K;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 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

 3+Q W3=L& K&9K7L 3V& 8WYL &&; V&KY V8U8&C UKQ3&K9=K&# W& W=U8$ 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?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

;L 3&$& @3& &Q3&K8;$LA# B!02 B</+(+2.+

>C> ;QK=$U Q5=; C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C >

T

>CTC> ;5V&KL&# &3V5=K ;$ &3V5=K8 EUQ5=;L C C C C C C C C C T

R

>CTCR Y;95 8 YLQ&9L C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C 1

>CTC1 ;?UQL ;$ UQ?UQL C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C '

>C1 9?85 5Q =KQ4958Q=;5; YLQ&9L C C C C C C C C C C C C C C C C C C C C C C C C >1

>C1C>
==K$5;Q& L&$ &?K&L&;QQ5=; C C C C C C C C C C C C C C C C C >'

>C/ &=9&QK5  QQ&K5;2 C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C T/

>CO =; 8UL5=;L C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C R[

> 0.<70, 0 07<(-),<0.) C8<-8 C C C C C C C C C C C C C C C C C C C C C C RR TC> ;QK=$U Q5=; C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C RR TCT L5 =; &?QL =+ LL5V5QY 3&=KY C C C C C C C C C C C C C C C C C C C C C C C C R1 TCTC> &.;5Q5=;L ;$ K=?&KQ5&L C C C C C C C C C C C C C C C C C C C C C C C C C C R1 TCTCT UQ?UQ &&$ 7 Q585ZQ5=; =+ LL5V& YLQ&9L C C C C C R' TCTCR =KQ4958Q=;5; YLQ&9L ;$ LL5V5QY C C C C C C C C C C C C C 1[ TCR ;&K2Y 3?5;2 =+ =KQ4958Q=;5; YLQ&9L C C C C C C C C C C C C C C C 11 TCRC> Q585ZQ5=; Y ;&K2Y 8; 5;2 C C C C C C C C C C C C C C C C C C C 1/ TCRCT 3& =;QK=8 L ;Q&K =;;& Q5=; K$529 C C C C C C C C C C C C /> TCRCR ;&K2Y 3?5;2 L =;QK=8 Y ;Q&K =;;& Q5=; C C C C C C C C // TC1 ;Q&K =;;& Q5=; ;$ 9?5;2
LL52;9&;Q LL5V5QY L&$

=;QK=8 C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C O[ TC/
K58& QKU QUK&
??K= 3 Q= ;&K2Y4L&$ =;QK=8 C C C C C O1 TCO =; 8UL5=;L C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C N1

=
07<(-),<0.)
2270' <0 <' 0.<70, 0 .<7<)0 NN RC> ;QK=$U Q5=; C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C NN RCT ;QK5;L5 88Y LL5V& =;QK=8 =+ ;Q&K Q5=; C C C C C C C C C C C C C C C C C C N'

>CTC1 ;?UQL ;$ UQ?UQL C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C C ''

>C1 9?85 5Q =KQ4958Q=;5; YLQ&9L C C C C C C C C C C C C C C C C C C C C C C C C > ;1. .. B!02 B</+(+2.+

>C> ;QK=$U Q5=; C C C C C C C C C C C C C C C C C C C C C C