Development and control of an anthropomorphic telerobotic system [Elektronische Ressource] / Bartłomiej Stańczyk

Informations

• Publié par: technische_universitat_munchen
• Publié le: 01 janvier 2006
• Nombre de lectures: 27
• Langue: English
• Poids de l'ouvrage: 4 Mo

Extrait

Lehrstuhl fur Steuerungs- und Regelungstechnik
Technische Universit at Munc hen
Prof. Dr.-Ing./Univ. Tokio Martin Buss
Development and Control of an
Anthropomorphic Telerobotic System
Bart lomiej Stanczyk
Vollst andiger Abdruck der von der Fakult at fur Elektrotechnik und Informationstechnik
der Technischen Universit at Munc hen zur Erlangung des akademischen Grades eines
Doktor-Ingenieurs (Dr.-Ing.)
genehmigten Dissertation.
Vorsitzender: Univ.-Prof. Dr.-Ing. Eckehard Steinbach
Prufer der Dissertation:
1. Univ.-Prof. Dr.-Ing./Univ. Tokio Martin Buss
2. Univ.-Prof. Dr.-Ing. habil. Heinz Ulbrich
Die Dissertation wurde am 21.02.2006 bei der Technischen Universit at Munc hen einge-
reicht und durch die Fakult at fur Elektrotechnik und Informationstechnik am 17.07.2006
angenommen.2Foreword
This thesis is a result of four years of work in the research group of my thesis adviser
Prof. Martin Buss; at rst at the Technische Universit at Berlin, then at the Technische
Universit at Munc hen. I would like to thank him for giving me the opportunity to conduct
exciting research in one of the most honorable robotics and control groups in Germany, for
providing me with great hardware and a wonderful research environment.
During my time spent with the group, many people gave me support and advice in
numerous ways. I would like to thank Dr. Konstantin Kondak from TU Berlin for leading
my rst steps in Robotics. His help was invaluable during the design phase. Designing
and building of the 7 DoF manipulator would not have been possible without Mr. Franz
Bachmann (TU Berlin), who not only put the design on paper, but personally crafted all
the aluminum elements. I also would like to thank Mr. Josef Gradl, Mr. Horst Kubick
and Mr. Thomas Lowitz at the TU Munc hen for additional developments. Many thanks
for your professionalism, creativity and enthusiasm.
I would like to express my gratitude to all the colleagues at the Lehrstuhl fur Steuerungs-
und Regelungstechnik, especially Sandra Hirche, Angelika Peer and Ulrich Unterhin-
ninghofen, with whom I cooperated closely on the SFB453 Project: for the scienti c input,
advice, help and for the great working atmosphere. Special thanks go to Hasan Esen, who
always supported and encouraged me as a friend.
I am also indebted to my students: Kwang-Kyu Lee, Hongquing Hu, Jiduo Wu, Klaas
Klasing and Martin Ernst. Thank you very much for the contributions you brought to the
project.
Finally, it is necessary to express my gratitude to my parents, my sister and my wife.
They were continuously supporting me with their love and patience, especially when
I needed it most.
Munich, October 2005. Bart lomiej Stanczykto my family
...Abstract
This thesis presents and summarizes the research work carried out during the develop-
ment and experimental evaluation of a dual arm anthropomorphic manipulator designed
for teleoperation purposes. The results are generalizable to other types of manipulators,
especially for robots acting in human environments and/or physically interacting with
humans.
Such applications pose speci c requirements that are in general di eren t from those of
traditional robot design. To assure safety and stable operation, \soft" robotic manipula-
tors are absolutely essential. For this reason, in this work, compliance control methods
were extensively studied and evaluated experimentally. As a result, an impedance control
strategy with underlying sti ness controller in motion control loop is proposed. To achieve
proper workspace matching between the human arm and the developed manipulator, an
adequate singularity handling strategy must be applied. Experimental comparison of such
solutions is performed and an innovative damped inverse kinematics method is introduced.
This method allows for traversing through singularities with simultaneous weighing of the
task space tracking error. Because the kinematic structures of the master/slave manipu-
lators in a teleoperation system are in general dissimilar, there is a need for a universal
kinematic interface, independent of the device structure. The classical approaches using
Euler or Cardanian angles fail due to algebraic singularities introduced by the represen-
tation. To avoid this problem, the unit quaternion was used for describing orientation
and corresponding rotational displacement. In order to avoid the collisions between the
arms and the workspace limits a virtual forces concept was introduced. This application
forms a basis for local optimization strategies and an intuitive force display for the human
operator. Finally, the force - position teleoperation control architecture was analyzed and
a tele-assembly experiment in 6 DoF was successfully performed. The experimental results
con rm the high performance of the developed hardware and control strategies.
Kurzfassung
In der vorliegenden Dissertationsschrift werden die Forschungsarbeiten, die w ahrend der
Entwicklung und experimentellen Bewertung eines speziell fur Telepr asenzanwendungen
konzipierten, zweiarmigen, anthropomorph gestalteten Manipulators durchgefuhrt wur-
den, vorgestellt und zusammengefasst. Die Ergebnisse lassen sich auf andere Arten von
Manipulatoren ub ertragen, insbesondere auf jene, die in fur Menschen gestalteten Umge-
bungen eingesetzt werden oder in direkten physikalischen Kontakt mit menschlichen Perso-
nen treten. Die besonderen Anforderungen der genannten Anwendungsgebiete unterschei-
den sich grunds atzlich von denen klassischer Robotikanwendungen. Um Sicherheit und
Stabilit at zu gew ahrleisten, sind "nachgiebige" Roboterarme unabdingbar. Aus diesem
Grund wurden Methoden nachgiebiger Positionsregelungen ausgiebig untersucht und ex-
perimentell bewertet. Als Ergebnis wird eine Impedanzregelungsstrategie mit unterlagerter
Stei gk eitsregelung vorgeschlagen. Um die Arbeitsbereiche des menschlichen Armes und
des entwickelten Manipulator aufeinander abzustimmen, muss eine angemessene Strate-
gie zur Behandlung von Singularit aten angewandt werden. Ein experimenteller Ver-
gleich derartiger L osungen wird durchgefuhrt, und eine besonders attraktive Methode
iiizur ged ampften inversen Kinematik wird vorgestellt, welche es erlaubt, Singularit aten
zu durchlaufen und dabei den kartesischen Regelfehler im Arbeitsraum abzusch atzen.
Da die kinematischen Strukturen auf Operator- und Teleoperatorseite eines Teleoper-
ationssystems ublic herweise verschieden sind, bedarf es einer allgemein verwendbaren,
ger ateunabh angigen Schnittstelle. Klassische, auf Euler- oder Kardan-Winkeln basierende
Ans atze sind aufgrund der m oglichen algebraischen Singularit aten ungeeignet. Um dieses
Problem zu umgehen, werden Einheitsquaternionen zur Beschreibung von Orientierung
und Orientierungsfehler verwendet. Zur Vermeidung von Kollisionen zwischen den bei-
den Armen und den Arbeitsraumgrenzen wird ein auf virtuellen Kr aften beruhendes
Konzept vorgestellt, welches als Grundlage fur lokale Optimierungsstrategien und eine
intuitive Kraftruc kkopplung an den menschlichen Operator dient. Schlie lic h wird die
Kraft-Positions-Teleoperationsstruktur untersucht und die erfolgreiche Durchfuhrung eines
Experiments zum telepr asenten Fugen gezeigt. Die experimentellen Ergebnisse besttigen
die hohe Performanz der entwickelten Manipulatoren und Steuerungsmethoden.
ivContents
1 Introduction 1
1.1 Teleoperation: De nition and Motivation . . . . . . . . . . . . . . . . . . . 2
1.2 Requirements for the Telemanipulator Development . . . . . . . . . . . . . 5
1.3 Main Contributions and Outline of the Dissertation . . . . . . . . . . . . . 6
2 Telemanipulator Kinematics 9
2.1 Telemanipulator Kinematic Design . . . . . . . . . . . . . . . . . . . . . . 10
2.1.1 Forward Kinematics for a 7 DoF Manipulator . . . . . . . . . . . . 10
2.1.2 De nition of the Elbow Angle: Self Motion Parametrization . . . . 12
2.2 Closed Form Inverse Kinematics Algorithm for 7 DoF Anthropomorphic Arm 13
2.2.1 Position-Based Inverse Kinematics Algorithm . . . . . . . . . . . . 13
2.2.2 Velocity-Based Inverse for a Spherical Wrist . . . . . . . 17
2.3 Singularity-Robust Inverse Kinematics . . . . . . . . . . . . . . . . . . . . 18
2.3.1 Jacobian Methods . . . . . . . . . . . . . . . . . . . . . . . . . . . . 18
2.3.2 Singularity Robustness: State of the Art . . . . . . . . . . . . . . . 19
2.3.3 The Least Square (Pseudoinverse) Method . . . . . . . . . . . . . . 20
2.3.4 Damped Least Square Method . . . . . . . . . . . . . . . . . . . . . 20
2.3.5 Weighted DLS Method with Task Priority . . . . . . . . . . . . . . 21
2.3.6 Adjoint Jacobian Method . . . . . . . . . . . . . . . . . . . . . . . 22
2.3.7 Jacobian Transpose Method . . . . . . . . . . . . . . . . . . . . . . 23
2.4 Experimental Evaluation of the WDLS Method . . . . . . . . . . . . . . . 24
2.5 Redundancy Resolution . . . . . . . . . . . . . . . . . . . . . . . . . . . . 27
2.5.1 Pseudoinverse with Optimization Criteria . . . . . . . . . . . . . . . 28
2.5.2 Extended Kinematics Method . . . . . . . . . . . . . . . . . . . . . 29
2.6 Summary . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 30
3 Task Space De nition and Orientation Error 31
3.1 Problem of Dissimilar Kinematics in Teleoperation . . . . . . . . . . . . . . 31
3.2 Orientation Representation and Orientation Error . . . . . . . . . . . . . . 32
3.2