155
ADAPTIVE REACTIONLESS CONTROL OF A SPACE MANIPULATOR FOR POST-CAPTURE OF AN UNCOOPERATIVE TUMBLING TARGET Thai Chau Nguyen Huynh Department of Mechanical Engineering McGill University, Montr´ eal February 2013 A Thesis submitted to the Faculty of Graduate Studies and Research in partial fulfilment of the requirements for the degree of Doctor of Philosophy c Thai Chau Nguyen Huynh, 2012

ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

  • Upload
    dinhtu

  • View
    230

  • Download
    0

Embed Size (px)

Citation preview

Page 1: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

ADAPTIVE REACTIONLESS CONTROL OF A

SPACE MANIPULATOR FOR

POST-CAPTURE OF AN UNCOOPERATIVE

TUMBLING TARGET

Thai Chau Nguyen Huynh

Department of Mechanical Engineering

McGill University, Montreal

February 2013

A Thesis submitted to the Faculty of Graduate Studies and Research

in partial fulfilment of the requirements for the degree of

Doctor of Philosophy

c© Thai Chau Nguyen Huynh, 2012

Page 2: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative
Page 3: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

ABSTRACT

Abstract

The increasing number of satellites and space debris in the Earth orbit has created

an urgent need to develop robotic technologies for on-orbit servicing and space debris

removal. The system solution investigated in this thesis involves a servicer (base)

with an attached robotic manipulator and this system must dock to, or get a hold

of the target satellite in order to conduct the required operations. In that context,

the problem of post-capture of a tumbling target with unknown inertial properties

and angular momentum, by using a space manipulator, is addressed. In particu-

lar, a critical aspect investigated is how to maintain minimum coupling between the

manipulator-target and the base in order to keep the base attitude unchanged while

estimating the unknown properties of the target – this without the use of attitude

control devices.

First, the kinematics and dynamics of a free-floating space manipulator are an-

alyzed where particular attention is given to the coupling motion between the arm

and the base. Then, the previously developed concept of reactionless manipulation is

introduced by presenting the reaction null-space control method, which is unique to

free-floating space manipulators.

Next, motivated by the reaction null-space control method, a new Adaptive Re-

actionless Control algorithm to produce arm motions with minimum disturbance to

the base is proposed. The algorithm aims to generate the reactionless manipulation

i

Page 4: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

ABSTRACT

in the presence of uncertainty as a result of capturing an unknown target. In addi-

tion, the online momentum-based estimation method is developed for inertia param-

eter identification, after the space manipulator grasps an unknown tumbling target.

The combined control/identification scheme is intended to segue from the instant of

capture till the unknown parameters are identified and/or the available stabilization

methods can be applied properly. To verify the validity and feasibility of the proposed

concept, MSC.Adams/Simulink co-simulation platform is employed to implement a

planar base-manipulator-target model as well as the three-dimensional model of the

Engineering Test Satellite VII system. The numerical results show that the space

manipulator is able to perform reactionless motion while the inertial parameters of

the target are identified, for a range of target sizes relative to the base.

To make the proposed control scheme practical, a redundancy resolution tech-

nique is formulated within the adaptive reactionless control algorithm to integrate

a secondary manipulation task, while executing the reactionless motion in the post-

capture scenario. In particular, the gradient projection method is employed and

implemented to avoid the physical joint limits of the manipulator. The performance

of the algorithm is verified through simulations of the two aforementioned models,

thus demonstrating that minimum disturbance on the base and joint-limit avoidance

can be achieved after capture of an unknown tumbling target. Lastly, a preliminary

design for a planar test-bed that can serve for experimental validation of the proposed

algorithms is presented. The design utilizes an air-bearing table to create a near fric-

tionless surface which would support a base-3-DOF manipulator and a target satellite

mock-up. The design includes the dimensioning and sizing of the main components,

and selection of actuation, sensing and control hardware.

ii

Page 5: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

RESUME

Resume

Une augmentation alarmante du nombre de satellites et de debris orbitaux autour

de la Terre a engendre un besoin grandissant de developper des technologies pour

l’entretien des satellites en orbite et afin de disposer des debris existants. Cette these

porte sur une solution constituee d’un satellite de service muni d’un manipulateur

robotise qui lui permet de s’arrimer au satellite cible et en maintenir le controle afin

de completer les operations requises. Plus specifiquement, cette etude porte sur la

phase apres la saisie d’un satellite culbutant avec un moment angulaire inconnu et

ayant des proprietes inertielles inconnues. Un aspect critique a l’etude est le maintien

d’un niveau minimal de liens dynamiques entre le satellite capture et la base du

manipulateur afin de preserver son orientation spatiale tout en estimant les proprietes

inconnues de la cible, et ce, sans autres systemes de controle d’attitude.

Tout d’abord, la cinematique et la dynamique d’un manipulateur en apesanteur

sont analysees avec une attention particuliere sur les liens mecaniques entre le ma-

nipulateur et le satellite de service a sa base. Ensuite, un concept deja etabli pour

la manipulation sans reaction est introduit par une methode de controle du noyau de

reaction, unique aux manipulateurs spatiaux.

Sur cette fondation, une nouvelle methode de controle adaptative et sans-reaction

est proposee qui produit des trajectoires de manipulation qui minimise les perturba-

tions a la base. L’algorithme permet de generer ces trajectoires tout en faisant face

a l’incertitude quant aux proprietes inconnues de la cible.

iii

Page 6: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

RESUME

De plus, une methode d’estimation en ligne basee sur le moment cinetique est

developpee pour identifier les parametres inertiels a la suite de l’arrimage. Ces

deux methodes, de controle et d’estimation, peuvent etre utilisees de concert jusqu’a

l’identification des parametres inconnus ou jusqu’a ce qu’une methode de stabilisa-

tion puisse etre appliquee. Afin de verifier la validite et la faisabilite de la methode

proposee, une plate-forme de co-simulation entre MSC.Adams et Simulink est utilisee

pour simuler un systeme planaire en plus d’un systeme tridimensionnel representant le

“Engineering Test Satellite VII”. Les resultats demontrent que le manipulateur peut

executer des mouvements sans-reactions tout en identifiant les parametres inertiels,

pour un eventail de dimensions du satellite cible.

Afin de rendre la methode proposee plus pratique, une technique de resolution des

redondances est formulee au sein de l’algorithme de controle adaptatif sans-reaction

pour permettre d’accomplir une tache secondaire en simultane. Par exemple, une

projection du gradient est utilisee pour eviter les limites physiques du manipulateur.

La performance de cette combinaison est verifiee par des simulations qui demontrent

que les perturbations a la base peuvent etre minimisees tout en respectant les lim-

ites du manipulateur apres la saisie d’un satellite culbutant. Finalement, un concept

preliminaire pour une plateforme experimentale planaire est presentee. Cette plate-

forme cree une surface presque sans friction a l’aide d’une table a coussin d’air qui

peut supporter un manipulateur a trois degres de liberte et un satellite-maquette. Ce

concept preliminaire inclut les principales dimensions, la selection des actionneurs,

capteurs, et controleurs.

iv

Page 7: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

ACKNOWLEDGEMENTS

Acknowledgements

I would like to express my gratitude to my supervisor, Prof. Inna Sharf, whose

guidance, stimulating suggestions and continuous encouragement helped me in the

course of this research. I also appreciate her assistance in improving my academic

writing skills with the valuable feedback through editing my written work. Without

her support and confidence in me, I cannot imagine finishing this work.

I also thank Prof. Peter Caines for a valuable discussion and suggestions regard-

ing the adaptive control design. I would like to acknowledge the useful comments and

criticism received from anonymous reviewers of my journal papers and the technical

support from research scientists at Canadian Space Agency. I want to thank specifi-

cally Dr. Dimitar N. Dimitrov for his useful discussions of my work and for providing

the detailed model of the Engineering Testing Satellite VII.

I want to thank my friends at CIM who have created a pleasant atmosphere for

research and shared the hard-working time during the program. I am grateful to

M. Persson for his kind help in translating the thesis abstract in French. Special

thanks to C. Wong and Dr. W. Tao for sharing their computers to run my numerical

simulations.

Finally, deep thanks to my parents, N. Tan and H. Quy, for their love and

encouragement; and to T. Nguyen: thank you for your love and patience during the

past three years. Thanks also to everyone I could not include.

This work was financially supported by the McGill MEDA award and Prof.

Sharf’s research grants.

v

Page 8: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative
Page 9: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CLAIM OF ORIGINALITY

Claim of Originality

The main contributions of this dissertation toward developing solutions for autonomous

capture of objects in space with a satellite-based robotic manipulator are summarized

as follows:

• Derivation of a new formula to compute the reactionless motions for a

free-floating space manipulator, without the use of attitude control devices.

The reactionless joint rates are computed based on their deviations from

the current joint rates and the observed response of the base attitude.

• Development of Adaptive ReactionLess Control (ARLC) algorithm to gen-

erate joint motion commands to the manipulator arm in order to minimize

disturbance to the base attitude, in the presence of dynamics uncertainty

as a result of capturing an unknown target.

• Integration of a momentum-based inertial parameter identification algo-

rithm with the ARLC scheme to estimate the inertial properties of the

target while executing adaptive reactionless motion in online manner.

• Reformulation of ARLC scheme for integration with the redundancy res-

olution technique to satisfy a secondary manipulation task. In particular,

employing the resulting formulation to ensure joint-limit avoidance within

the ARLC scheme.

• Formulation of the minimum kinetic energy attainable by a free-floating

space manipulator with constant angular/linear momentum.

vii

Page 10: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CLAIM OF ORIGINALITY

• Development of a co-simulation platform using MSC.Adams and Simulink

to validate the proposed control algorithms for two base-manipulator-target

models: a planar model with a 3-DOF manipulator and a 3D model with

a 7-DOF manipulator emulating the ETS-VII arm.

• Database of simulation results validating and demonstrating the effective-

ness of the proposed control algorithms in the post-capture of an unknown

tumbling target.

• Conceptual design of an experimental test-bed for testing autonomous cap-

ture missions, with the air hockey table concept employed to emulate the

free-floating condition in space, a base-3-DOF manipulator-target system

and the required sensing and control hardware.

viii

Page 11: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

TABLE OF CONTENTS

TABLE OF CONTENTS

Abstract . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . i

Resume . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . iii

Acknowledgements . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . v

Claim of Originality . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . vii

LIST OF FIGURES . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . xiii

LIST OF TABLES . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . xvii

NOMENCLATURE . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . xix

CHAPTER 1. Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . 1

1.1. Background . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 1

1.2. Thesis Objectives . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 8

1.3. Literature Review . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9

1.3.1. Kinematics and dynamics of space manipulators . . . . . . . . . . 9

1.3.2. Control of space manipulator . . . . . . . . . . . . . . . . . . . . 10

1.3.3. Target capture by space manipulator . . . . . . . . . . . . . . . . 12

1.3.4. Inertia parameter identification . . . . . . . . . . . . . . . . . . . 15

1.4. Thesis Outline . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 16

CHAPTER 2. Kinematics, Dynamics and Reactionless

Control of Space Manipulator . . . . . . . . . . . . . . . . . . . 19

ix

Page 12: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

TABLE OF CONTENTS

2.1. Kinematics of Space Manipulator . . . . . . . . . . . . . . . . . . . . 19

2.2. Momentum Equations . . . . . . . . . . . . . . . . . . . . . . . . . . . 22

2.3. Generalized Jacobian Matrix . . . . . . . . . . . . . . . . . . . . . . . 27

2.4. Dynamics Equations . . . . . . . . . . . . . . . . . . . . . . . . . . . . 30

2.5. Reaction Null-Space Motion Control . . . . . . . . . . . . . . . . . . . 33

2.6. Remarks on Kinetic Energy of Space Manipulator . . . . . . . . . . . 35

2.7. Numerical Co-simulation Platform . . . . . . . . . . . . . . . . . . . . 36

2.8. Summary . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 38

CHAPTER 3. Adaptive Reactionless Control Algorithm . . . . . . . . . . . 39

3.1. Formulation of Adaptive Reactionless Motion . . . . . . . . . . . . . . 41

3.2. Recursive Adaptation . . . . . . . . . . . . . . . . . . . . . . . . . . . 43

3.2.1. Parameter adaptation of time-varying systems . . . . . . . . . . . 45

3.2.2. Stability Analysis . . . . . . . . . . . . . . . . . . . . . . . . . . . 48

3.3. Simulation Study . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 51

3.3.1. Planar Test Case . . . . . . . . . . . . . . . . . . . . . . . . . . . 51

3.3.2. 3D Test Case . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 64

3.4. Summary . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 66

CHAPTER 4. Adaptive Reactionless Control for Parameter Identification . . 67

4.1. Momentum-based Parameter Identification . . . . . . . . . . . . . . . 69

4.2. QR Decomposition Recursive Least Squares . . . . . . . . . . . . . . . 72

4.3. Persistent Excitation of ARLC Motions . . . . . . . . . . . . . . . . . 75

4.4. Simulation Study . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 76

4.4.1. Planar Test Case . . . . . . . . . . . . . . . . . . . . . . . . . . . 76

4.4.2. 3D Test Case . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 79

4.5. Summary . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 83

CHAPTER 5. Adaptive Reactionless Control with Joint-Limit Avoidance . . 85

5.1. Formulation of ARLC for Joint-Limit Avoidance . . . . . . . . . . . . 86

5.2. ARLC with Joint-Limit Avoidance . . . . . . . . . . . . . . . . . . . . 89

x

Page 13: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

TABLE OF CONTENTS

5.2.1. Redundancy resolution . . . . . . . . . . . . . . . . . . . . . . . . 89

5.2.2. Integration with ARLC scheme . . . . . . . . . . . . . . . . . . . 91

5.3. Simulation Study . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 92

5.3.1. 2D Test Case . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 93

5.3.2. 3D Test Case . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 96

5.4. Summary . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 99

CHAPTER 6. Analysis and Preliminary Design of Experimental Test-bed . . 103

6.1. Experimental Apparatus . . . . . . . . . . . . . . . . . . . . . . . . . 105

6.2. Base-3-DOF Manipulator-Target . . . . . . . . . . . . . . . . . . . . . 106

6.2.1. Base design . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 107

6.2.2. Arm design . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 109

6.2.3. Target Design . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 111

6.3. Air-bearing Table . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 112

6.4. Sensing System . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 114

6.5. Computer and Control Interface . . . . . . . . . . . . . . . . . . . . . 115

6.6. Summary . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 116

CHAPTER 7. Conclusions and Recommendations for Future Research . . . 117

7.1. Summary and Conclusions . . . . . . . . . . . . . . . . . . . . . . . . 117

7.2. Recommendations for Future Research . . . . . . . . . . . . . . . . . 120

BIBLIOGRAPHY . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 123

xi

Page 14: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative
Page 15: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

LIST OF FIGURES

LIST OF FIGURES

1.1 Two generations of Canadarm: (A) Canadarm1 viewed from the

Space Shuttle; (B) Canadarm1 and Canadarm2 working side by side

[1] . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 2

1.2 Space vehicles equipped with a robotic arm: (A) Remote manipulator

system (JEMRMS) [2]; (B) Engineering Test Satellite VII [3] . . . . . 3

1.3 Canadarm2 moves SpaceX Dragon spacecraft into place for attach-

ment to the ISS [4] . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4

1.4 Space Infrastructure Servicing [5] . . . . . . . . . . . . . . . . . . . . . . 5

1.5 Capture mission phases . . . . . . . . . . . . . . . . . . . . . . . . . . . 6

1.6 Base, manipulator, target system and on-board devices . . . . . . . . . 7

2.1 General Model of Space Manipulator Robot. . . . . . . . . . . . . . . . 20

2.2 Two decompositions of total angular momentum . . . . . . . . . . . . . 24

2.3 Co-simulation platform using MSC.Adams and Matlab/Simulink . . . 37

2.4 Space manipulator models built in MSC.Adams . . . . . . . . . . . . . 37

3.1 ARLC as part of capture mission . . . . . . . . . . . . . . . . . . . . . . 41

3.2 Adaptive reactionless control scheme. . . . . . . . . . . . . . . . . . . . 48

3.3 Planar base-3-DOF manipulator-target model . . . . . . . . . . . . . . 52

3.4 Reaction null-space system response for model verification . . . . . . . 54

3.5 Joint rates, Lt = 0, without ARLC. . . . . . . . . . . . . . . . . . . . . 56

xiii

Page 16: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

LIST OF FIGURES

3.6 Base angular rate, Lt = 0, without ARLC. . . . . . . . . . . . . . . . . 56

3.7 Joint rates, Lt = 0, with ARLC. . . . . . . . . . . . . . . . . . . . . . . 57

3.8 Base angular velocity, Lt = 0, with ARLC . . . . . . . . . . . . . . . . 57

3.9 The relationship between Lm and Lt, Lt = 0, with ARLC . . . . . . . 58

3.10 Joint rates, Lt 6= 0, mt = 250 kg . . . . . . . . . . . . . . . . . . . . . . 59

3.11 Base response: angular velocity and attitude, Lt 6= 0, mt = 250 kg. . . 60

3.12 ARLC joint rates error, Lt 6= 0, mt = 250 kg. . . . . . . . . . . . . . . . 60

3.13 The relationship between Lm and Lt, Lt 6= 0, mt = 250 kg . . . . . . . 61

3.14 Joint accelerations, Lt 6= 0, mt = 250 kg. . . . . . . . . . . . . . . . . . 61

3.15 Five configurations (snapshots) of the arm after capturing a spinning

target, Lt 6= 0, mt = 250 kg . . . . . . . . . . . . . . . . . . . . . . . . . 62

3.16 ARLC with Lt 6= 0, mt = 500 kg . . . . . . . . . . . . . . . . . . . . . . 63

3.17 ARLC with Lt 6= 0, mt = 125 kg . . . . . . . . . . . . . . . . . . . . . . 63

3.18 Base angular velocity, mt = 500 kg, 3D case. . . . . . . . . . . . . . . . 64

3.19 Joint rates φ1, φ2, φ3, mt = 500 kg, 3D case. . . . . . . . . . . . . . . . 65

3.20 Joint rates, φ4 – φ7, mt = 500 kg, 3D case. . . . . . . . . . . . . . . . . 65

4.1 Incorporation of ARLC and momentum-based parameter identifica-

tion into the capture mission . . . . . . . . . . . . . . . . . . . . . . . . 69

4.2 Estimation of medium target, mt = 250 kg . . . . . . . . . . . . . . . . 78

4.3 Estimation of target mass, mt = 500 kg (Target 1) and mt = 125 kg

(Target 3) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 79

4.4 Estimation of I33, mt = 500 kg and mt = 125 kg . . . . . . . . . . . . . 80

4.5 Estimation of position of the center of mass, mt = 500 kg and mt =

125 kg . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 80

4.6 Estimation of target mass, mt = 500 kg, 3D case . . . . . . . . . . . . . 81

4.7 Estimation of position of the center of mass, mt = 500 kg, 3D case . . 82

4.8 Estimation of moment of inertia, mt = 500 kg, 3D case . . . . . . . . . 82

xiv

Page 17: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

LIST OF FIGURES

5.1 Adaptive reactionless control scheme with joint-limit avoidance . . . . 92

5.2 ARLC motion without joint-limit avoidance, Lt 6= 0, mt = 250 kg . . . 93

5.3 ARLC motion with joint-limit avoidance, Lt 6= 0, mt = 250 kg . . . . . 94

5.4 Joint angles and potential function for 2D case, Lt 6= 0, mt = 250kg . 95

5.5 Momentum exchange between Lt and Lm, mt = 250 kg . . . . . . . . . 96

5.6 ARLC motion with joint-limit avoidance, Lt 6= 0, mt = 500 kg . . . . . 97

5.7 ARLC motion with joint-limit avoidance, Lt 6= 0, mt = 125 kg . . . . . 98

5.8 Base angular velocity, 3D test case, Lt 6= 0, mt = 500kg. . . . . . . . . 99

5.9 Joint rates, 3D test case, mt = 500 kg . . . . . . . . . . . . . . . . . . . 100

5.10 Joint angles, 3D test case, mt = 500 kg . . . . . . . . . . . . . . . . . . 101

6.1 Experimental apparatus . . . . . . . . . . . . . . . . . . . . . . . . . . . 105

6.2 Free-flying test-bed at Canadian Space Agency . . . . . . . . . . . . . . 106

6.3 Top view of the base-manipulator-target system . . . . . . . . . . . . . 107

6.4 Joint rates profile and base response for Model1 . . . . . . . . . . . . . 108

6.5 Four configurations of Model1 during simulated motion . . . . . . . . . 108

6.6 Satellite base with on-board devices . . . . . . . . . . . . . . . . . . . . 109

6.7 Link and motor-link interconnection . . . . . . . . . . . . . . . . . . . . 111

6.8 Joint rates and torque profiles for ARLC with joint-limit avoidance

(Model3) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 111

6.9 Animation snapshot for dimensioning air-table, 125×125 cm2 wire-

frame test case . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 114

xv

Page 18: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative
Page 19: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

LIST OF TABLES

LIST OF TABLES

3.1 Planar 3-DOF manipulator simulation model parameters . . . . . . . . 52

3.2 3D, 7-DOF manipulator simulation model parameters . . . . . . . . . . 53

3.3 Denavit-Hartenberg parameters of 7-DOF manipulator . . . . . . . . . 53

5.1 Joint limit constraints for 7-DOF and 3-DOF manipulators. . . . . . . 92

6.1 Base-3-DOF manipulator testing models . . . . . . . . . . . . . . . . . 107

6.2 Selection of motor for manipulator joints . . . . . . . . . . . . . . . . . 110

xvii

Page 20: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative
Page 21: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

NOMENCLATURE

NOMENCLATURE

ai position vector pointing from joint i to the mass center of link i

nan position of center of mass of last link with respect to Σn frame

bi position vector pointing from mass center of link i to joint i+ 1

E identity matrix

Ii inertia tensor of link i with respect to its mass center

nIn inertia tensor of last link with respect to its mass center represented in Σn

frame

J∗ generalized Jacobian matrix for space manipulator

L angular momentum of whole system with respect to inertial frame

Lm angular momentum of space manipulator before capture with respect to

inertial frame

Lg system angular momentum with respect to mass center of whole system

Lt angular momentum of target with respect to inertial frame

mi mass of link i (i = 0 represents the base)

M total mass of system

pr position vector of end-effector from origin of inertial frame

P linear momentum of whole system with respect to inertial frame

rg position vector of mass center of whole system

ri position vector of mass center of link i

IRn rotation matrix from frame Σn to ΣI

T kinetic energy of system

xix

Page 22: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

NOMENCLATURE

v0 linear velocity vector of base

vr linear velocity vector of end-effector

ζ arbitrary vector with units of angular rates

φi joint rate of revolute joint i

φimax mechanical limit of ith joint

φ arm joint rates

τ arm joint torques

ω0 angular velocity of base

ωi angular velocity of link i

ωn angular velocity of last link

(.) skew-symmetric matrix of vector (.)

ΣI inertial coordinate system

Σn last link body fixed frame

xx

Page 23: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

1.1 BACKGROUND

CHAPTER 1

Introduction

1.1 Background

For several decades now, space activities not only have had a strategic value in

space exploration missions, but also a high commercial value. In addition to the

highly popularized activities of the International Space Station, many commercial

satellite stations have been operating on-orbit for different purposes, such as, weather

forecasting, television broadcasting and telecommunication. These services play an

important role for human life on Earth. With increasing utilization of space and in

particular, the increase in space activities in near-Earth orbits, a new application of

robotic manipulators and related technologies has emerged over the past decade –

the on-orbit servicing. Similar to other industries on Earth, serving satellites even

after they lift off the ground, is a must for the development of space industry. Since

human safety considerations make such missions too risky for astronauts, robotics

technology is the only means to fulfill these missions.

The use of robotics in space has been of vital importance in orbital operations

for several decades. Their main missions to date have been to maneuver payloads, to

replace/assemble components on the International Space Station (ISS) and to sup-

port astronauts during space walks. The first ever robotic arm installed on the space

shuttle is the Shuttle Remote Manipulator System (SRMS), or Canadarm1 (Fig. 1.1).

1

Page 24: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 1. INTRODUCTION

(A) (B)

Figure 1.1. Two generations of Canadarm: (A) Canadarm1 viewed fromthe Space Shuttle; (B) Canadarm1 and Canadarm2 working side by side [1]

After many years of successful operation and numerous demonstrations of the prin-

ciples of robotic manipulation in space, Canadarm1 was retired on the final shuttle

mission in July 2011. Currently, there are three robotic arms operating on the ISS:

the European Robotic Arm built by European Space Agency (ESA), Canadarm2

built by Canadian Space Agency (CSA), and the Japanese Remote Manipulator Sys-

tem (JEMRMS) developed by Japan Aerospace Exploration Agency (JAXA). JEM-

RMS is being used on the Japanese science module of the ISS for moving equipment

around the module (Fig. 1.2A). With the success of two consecutive generations of

Canadarm, Canada has maintained its world leadership in space robotic technologies

and operational experience for over three decades.

For the purpose of advancing robotic technologies and research on robotic on-

orbit servicing, the first free-flying spacecraft with a robotic arm, the Engineering Test

Satellite VII (Fig. 1.2B), was launched by JAXA in 1998 for conducting a number of

basic experiments related to docking rendezvous, ground teleoperation, exchange of

Orbital Replacement Units (ORUs), dynamic coupling control and capturing a target

[3]. A more recent mission flown as the Orbital Express Demonstration Manipulator

System (OEDMS) and funded by the Defense Advanced Research Projects Agency

(DARPA) was aimed to study the safety and to demonstrate the cost effectiveness of

autonomous satellite servicing in-orbit.

2

Page 25: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

1.1 BACKGROUND

(A) (B)

Figure 1.2. Space vehicles equipped with a robotic arm: (A) Remote ma-nipulator system (JEMRMS) [2]; (B) Engineering Test Satellite VII [3]

Over the past decade, however, the risks associated with increased space utiliza-

tion have become a serious concern for space communities around the world. It is

now widely acknowledged that the increasing number of space debris, including mal-

functioning and out of control satellites in the near-Earth and geostationary orbits,

can seriously affect and even pose danger to human and unmanned space activities.

An example of a recent catastrophic accident in space in 2009 is a collision that took

place between a deactivated Kosmos 2251 and an operating Iridium 33, with a high

impact as the two craft collided at a relative speed of more than 10km/s and were

both completely destroyed. To reduce the risks of such collisions, in addition to the

new satellite manufacture policies issued by NASA, one system solution that has been

under investigation by several research groups and space agencies around the world

is a servicing vehicle equipped with a robotic arm to be used for space debris re-

moval and on-orbit servicing. The specific tasks such a system could be launched and

employed for are to refuel, repair, stabilize and de-orbit space objects or debris [6].

Success of such missions relies on the availability of proven and robust algorithms for

autonomous robotic capture of free-floating uncooperative objects in space and this

has spurred considerable amount of research on various aspects of this problem [7].

3

Page 26: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 1. INTRODUCTION

Figure 1.3. Canadarm2 moves SpaceX Dragon spacecraft into place forattachment to the ISS [4]

Over the past several years, there have been some remarkable achievements and

substantial progress on the capture task of free-floating objects. The successful com-

pletion of OEDMS mission in 2007 confirmed the ability of a robotic arm to au-

tonomously dock and rendezvous to a cooperative object [8]. Recently, Canadarm2

has completed a historic mission by successfully berthing the Dragon spacecraft with

the ISS (Fig. 1.3). SpaceX Dragon is the first commercial vehicle in history to suc-

cessfully attach to the ISS and this mission opened a new era for commercial on-orbit

activities. However, the aforementioned missions were accomplished with the perfect

cooperation from the target to be captured. Such conditions are not likely to be

available when capturing an unknown target, such as space debris.

Research and development of methodologies for the capture of uncooperative tar-

gets have become a significant part of research programs of space agencies around the

world. In particular, the DLR German Space Operations Center has been developing

two on-orbit servicing missions, DEutsche Orbitale Servicing Mission (DEOS) and

Orbital Life Extension Vehicle (OLEV), which focus on capturing non-supportive

and/or not specially prepared client spacecraft [9]. The creator of Canadarm, MDA

4

Page 27: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

1.1 BACKGROUND

Figure 1.4. Space Infrastructure Servicing [5]

Cooperation is planning to launch the Space Infrastructure Servicing (SIS) in approx-

imately 2015 [6]. The SIS, equipped with a robotic arm, will be used for refueling,

performing critical maintenance and repair tasks, as well as stabilizing or towing

smaller space objects or debris. The on-orbit servicing community has not only been

concerned with the technical aspects of the problem, but also other aspects: mar-

ket potential, commercial implications, political and regulatory issues are all being

addressed by the global community [10].

A number of investigations on the capture of satellites and space debris have also

been carried out in the academic space robotics community. Due to the complexity

of capture missions in space, researchers in this field typically separate the problem

into four phases: the pre-capture, contact (impact), post-capture and compound

stabilization [11]. The illustrations of the four capture mission phases are included in

Fig. 1.5. In the pre-capture phase, the space manipulator is controlled to approach

the targeted object by maintaining a relative position between the end-effector and

the grapple fixture mechanism (if one is available) [12]. At the instant of capture, the

main issue to be considered is to minimize the impact between the space manipulator

and target, and hence the capture phase is also known as the impact phase [13,

14]. The servicer-manipulator-target becomes a serial-chain multibody system when

the capture is established. In the post-capture phase, the control strategy need to

be developed to deal with the tumbling motion as well as dynamic uncertainties

as a result of target capture. To bring the whole system to rest, the compound

5

Page 28: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 1. INTRODUCTION

Figure 1.5. Capture mission phases

stabilization phase has to damp out any initial angular momentum transferred to

the space manipulator system from the captured target by using the attitude control

system (ACS) devices, such as thrusters or reaction wheels [15].

A wide range of problems arise in the four aforementioned phases of the on-orbit

capture mission. The scope of the present research is limited to the post-capture

phase issues. In this phase, one critical aspect is to maintain minimum coupling

between the manipulator-target and the servicer, also referred to as base, in order to

keep its attitude unchanged. As illustrated in Fig. 1.6, this is desirable for several

reasons, in particular, to ensure that the pointing requirements for high-gain antennas

are satisfied since these antennas are not omnidirectional [16]; for efficient thermal

control of the base satellite, and to maintain the target in the field of view of the

sensors mounted on the base, such as cameras [17]. Disturbances of the base satellite’s

orientation and angular motion will require the use of corrective action from the ACS

devices and ultimately shorten the life time of the servicing spacecraft by increasing

the fuel consumption of the ACS, which is a non-renewable and expensive resource

in space. In addition, although the system’s attitude can be corrected by reaction

6

Page 29: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

1.1 BACKGROUND

BASE

Target

RW

High Gain Antenna for Communication

On-board Camera

RW: Reaction Wheels

Thrusters(cost fuel)

Earth

Figure 1.6. Base, manipulator, target system and on-board devices

wheels powered by solar panels, the compensation they provide is limited as reaction

wheels can easily reach saturation for certain rotational disturbances. As a result of

momentum conservation, the attitude of the base can be significantly disturbed by the

tumbling motion of the target and the motion of the robotic arm during the capture

maneuver. Hence, it is necessary to design trajectories for the manipulator after

impact with the uncooperative target so that the reactions transferred to the base

are minimized. On the other hand, when capturing an unknown target, in particular,

with unknown inertial properties, the performance of existing motion planning and

control algorithms for a free-floating space manipulator will deteriorate due to the

dynamic uncertainties of the system. Therefore, the availability of target’s inertial

properties is required for the compound stabilization phase and the next motion

planning task after completing the capture phase of the mission.

At this point, it is requisite that we define more precisely the term already perused

in the above discussion to characterize the target: “uncooperative” in this dissertation

will refer to a target (e.g., satellite, debris) undergoing a tumbling motion, with

unknown angular momentum and unknown inertial properties. It is noted, however,

that the on-orbit servicing community have used the same term to describe other

7

Page 30: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 1. INTRODUCTION

aspects of “un-cooperativeness”, for example, lack of special grapple fixtures or visual

support devices on the target, but these aspects are not dealt with in this thesis.

To summarize the above discussion, this research is devoted to answer two spe-

cific questions: (i) How to autonomously control only the arm motion to ensure the

minimum disturbance to the base after capturing an uncooperative target with tum-

bling motion? (ii) How to identify the inertia parameters of the unknown target after

capture?

1.2 Thesis Objectives

The proposed research focuses on solving the problem of post-capture of an un-

cooperative target, such as space debris, with a free-floating space manipulator. The

principal objectives of this thesis are as follows:

1. To develop a control algorithm for space manipulator to maintain the min-

imum disturbance to the base i.e., reactionless motion, after capturing an

uncooperative target, without the use of attitude control devices. The pro-

posed control scheme is intended for use from the instant of capture till

the unknown parameters of the target are identified and/or the available

stabilization methods can be applied properly.

2. To identify the inertia properties of the captured target while executing

the above proposed control algorithm and reactionless manipulation. The

satisfaction of this objective is relevant for attaining a smooth transition

from post-capture to stabilization phase, as well as the implementation of

a model-based motion control.

3. To make the proposed control scheme practical by incorporating in it a

scheme for joint-limit avoidance. Without explicit consideration of joint

limits, the application of ARLC is likely to violate the physical joint limits

and as a result, the desired goal of reactionless motion will be severely

compromised.

8

Page 31: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

1.3 LITERATURE REVIEW

1.3 Literature Review

According to the objectives of this thesis, the related research literature is re-

viewed in this section. First, the relevant research on kinematics and dynamics of

space manipulators is summarized. Next, current state of the art in control of space

manipulators is reviewed. Then, particular attention is focused on the literature

dealing with the target capture task by a space manipulator. The literature review is

completed by summarizing most relevant work on the problem of inertial parameter

identification.

1.3.1 Kinematics and dynamics of space manipulators. A space ma-

nipulator system is characterized by a number of unique features, distinct from the

robotic systems on Earth, since it is mounted on a freely moving base and is sub-

ject to the micro-gravity condition, as well as momentum conservation principle [18].

Based on how the base is controlled, the modeling of a space manipulator can be

categorized into two types: free-flying and free-floating. In the former, the use of an

attitude control system to control the motion of the base is considered; whereas in the

latter, the motions of the base are directly affected by the reaction of the manipulator

and target [19]. There are a number of studies that have considered how to model

the coupling dynamics between the manipulator and the base. Longman et al. [20]

proposed a kinematic and dynamic computational approach for a space manipulator

with attitude control devices, to calculate the reaction force and moment from the

motion of the manipulator to the base. From results of these calculations, the attitude

control system is commanded to compensate for the base disturbance.

The kinematic and dynamics equations of a space manipulator can be derived by

applying one of the several multibody dynamics formulations which are well defined

for a conventional fixed-base manipulator [21]. One interesting idea to simplify the

dynamics modeling methodology for a space manipulator was proposed by Vafa and

Dubowsky [22], called the virtual manipulator concept. The virtual manipulator is

constructed as an ideal kinematic chain such that one of its ends remains coincident

9

Page 32: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 1. INTRODUCTION

with the selected point on the real manipulator and the other end is attached to the

fixed point in inertial space. The idea behind this technique is to formulate the rules

for calculating the properties of virtual manipulator, such as link dimensions and joint

axes, and its joint movements as a function of the real manipulator joint movements.

This approach facilitates the planning and control design for space manipulators.

However, in operational space control analysis, the virtual manipulator approach is

only useful for the scenario where the orientation of the base can be directly controlled

[18, 23]. On the other hand, similarly to ground manipulator dynamics modeling

research, the dynamics model of a space manipulator is often formulated by using

the Lagrangian formulation, as presented in [18, 24–26]. With the assumption that

no external force or torque is exerted on the system, the momentum conservation

equations can be used as additional motion constraints to simplify the dynamics

equations of a space manipulator [18, 25].

1.3.2 Control of space manipulator. The development of motion control

algorithms for space manipulators has progressed based on the available concepts of

model-based motion control for fixed-base robotic arms. Due to the differences in

kinematic and dynamic characteristics, the conventional controllers available for a

ground-based manipulator cannot be applied directly to a space manipulator, if the

base of the latter is not controlled perfectly. By using reaction wheels to keep the

base attitude fixed, a conventional adaptive control was proposed in [27] for obtaining

a stable end-effector trajectory tracking. Taking into account the reaction effect of

the manipulator on the base, a well-known resolved motion rate control method was

proposed in [28] by introducing the Generalized Jacobian Matrix (GJM) which can

serve as a surrogate for a standard manipulator Jacobian in solving the kinematic

problems for a space manipulator. In fact, feedback control theory can be applied to

position control of space arm end-effector, with GJM used instead of the conventional

Jacobian [18]. In the formulation of GJM, the momentum conservation equations

are involved as the non-integrable motion constraints at the velocity level; the non-

integrability of these constraints establish the nonholonomic nature of a free-floating

10

Page 33: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

1.3 LITERATURE REVIEW

space manipulator [29]. The implementation of nonholonomic motion planning for

trajectory control of space manipulator was presented in [30].

As mentioned above, although ground manipulator controllers can be applied to

a space manipulator, if the position and attitude of the base are perfectly controlled

during a maneuver by the attitude control systems, the development of control algo-

rithms for the free-floating base scenario is highly desirable. Dubowsky and Torres

[31] proposed the Enhanced Disturbance Map (EDM) representing graphically the

effect of the manipulator motion on the free-floating base. The EDM provides a bet-

ter understanding of the dynamic disturbance created by the arm, which is useful for

designing the minimum disturbance trajectories as a solution to the motion planning

problem. Another unique issue arising in model-based motion planning and control

of a free-floating manipulator is existence of dynamic singularities, since the relation

between the end-effector linear/angular velocity and the set of joint rates involves

the dynamic properties of the system [32]. It is noted that the dynamic singularity

configurations cannot be predicted from the kinematic configurations of the manipu-

lator, and all Jacobian-based control algorithms, such as resolved motion rate control,

will fail or produce large errors at the dynamic singularity configurations. To reduce

the effects of dynamic singularities, the damped least-squares method [33, 34] used

for computing the inverse kinematics of ground-based manipulators to find feasible

joint rates can be applied [35]. It is worth mentioning that if the base attitude is

maintained constant, the dynamic singularity reduces to the manipulator kinematic

singularity.

For space manipulator control in a free-floating scenario, the availability of redun-

dant degrees of freedom becomes important since the base and the end-effector need

to be controlled simultaneously. The redundancy of manipulator alleviates the issues

of singularity avoidance and minimum reaction motion control. To tackle the dynamic

interaction problems of free-floating robots, Reaction Null Space control (RNSC) law

was originally proposed in [36] to generate control inputs that induce minimum vi-

bration in the flexible space structure on which the manipulator system is mounted.

11

Page 34: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 1. INTRODUCTION

This algorithm was subsequently implemented for end-effector path tracking with

reactionless motion and vibration suppression [37]. The RNS-based reactionless ma-

nipulation was also verified with the Engineering Test Satellite VII (ETS-VII) facility

flown in space [3]. The utilization of task-priority redundancy resolution techniques

has been thoroughly investigated in ground-based manipulator motion planning lit-

erature. For example, the extra degrees of freedom are employed to alleviate the

kinematic singularity issues in [38]; and, the framework of task-priority control for

redundant robots was proposed in [39, 40] to address the joint limit and obstacle

avoidance issues. In general, these aforementioned approaches can be formulated to

control space manipulators, if the condition on degree of redundancy is satisfied. It is

noted that the degree of redundancy of a free-floating manipulator depends on which

task is to be controlled: base motion control task or end-effector motion control task.

Detailed analysis and implementation of redundancy resolution for a free-floating

space manipulator were presented in [41]. In [42], the redundancy control technique

was employed to formulate the distributed momentum control algorithm to achieve

two specific tasks: the distribution and absorbtion of the initial angular momentum

from target capture while satisfying the tracking control of the end-effector.

1.3.3 Target capture by space manipulator. Since the scope of this re-

search is the post-capture of an uncooperative target with a free-floating manipulator,

state of the art control algorithms related to the post-capture and stabilization prob-

lems are reviewed in this subsection. Researchers normally address the post-capture

issues in the ideal scenario with the assumption that the impact at the grasp is min-

imal [11], which means that the relative velocity between the end-effector and the

target’s grapple point is approximately zero. In practice, this condition is difficult to

achieve at the instant of capture. Although minimizing impact is one of the main ob-

jectives of the pre-capture mission, impact at capture is practically unavoidable and

presents an issue for the post-capture control phase. Thus, a number of investigations

have been conducted on the effects of impact on the post-capture behavior of the ma-

nipulator. Based on the angular coupling momentum equation, detailed analysis of

12

Page 35: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

1.3 LITERATURE REVIEW

space manipulator behavior, in particular, the changes in joint rates and base angular

velocity during impact and post-impact, were presented in [36]. From these analyt-

ical results, the magnitude of impact force impulse can be minimized with proper

initial configurations of the space manipulator. In [14, 43], two types of post-impact

dynamics, soft impact and hard impact, were defined based on the relative velocity

of end-effector and target. Then, the feedback linearization controller was applied to

compensate for the differences in dynamics response depending on whether the cap-

ture is smooth or with an impact. An interesting idea was proposed in [44] on how

to use contact/impact to damp the angular momentum of an uncooperative spinning

target in order to alleviate the capture mission. In particular, a contact/push-based

control method using a cushion-type damper was presented in order to dissipate the

rotational motion of the target. However, since robot end-effector with the passive

damper has to touch a spinning target several times to reduce its angular momentum,

it is difficult to stabilize and coordinate the control of the whole robot-target system.

Reaction null-space control concept is not only useful in path planning and control

of a space manipulator in the pre-capture phase, but also can be employed as a

foundation for developing post-capture and stabilization algorithms. In [42, 45, 46],

the Distributed Momentum Control (DMC) strategy for capturing a free-floating

spinning satellite was presented. The RNS motion control was applied to facilitate

the pre-impact and post-impact control phases. Recently, the reactionless trajectory

tracking control method was derived in [47], with consideration of constraints on

the reaction wheel torques and on the angular momentum that the reaction wheels

can absorb. Moreover, a motion planner was developed in [15] based on optimal

control theory (Pontryagin’s principle), and PD quaternion feedback for base attitude

control was applied to stabilize the system under torque constraints in minimum time.

However, the methods proposed in these references require knowledge of kinematics

and dynamics of the tumbling target, in addition to those of the manipulator arm,

as well as the use of reaction wheels for controlling the base’s attitude.

13

Page 36: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 1. INTRODUCTION

The presence of uncertainties in the system is one of the main concerns for design-

ing controllers in the post-capture and stabilization of an unknown target. The control

algorithms to deal with the presence of dynamic parameter uncertainties caused by

the target have been well studied for ground-based manipulators, in particular, with

the implementation of adaptive control techniques [48–51]. In general, these conven-

tional adaptive control methods require that the dynamics model of manipulator can

be parameterized linearly in terms of unknown inertial parameters. The free-floating

manipulator model derived from the Lagrangian formulation presented in [24, 25, 28]

cannot be linearized in terms of the inertial parameters. Consequently, the application

of conventional adaptive control to free-floating space manipulators with dynamics

equations derived by Lagrangian formulation is not possible, since the aforementioned

dynamics equations are nonlinear in the inertial parameters [25]. This can be possible,

however, only with joint-space control if reaction wheels are available for base attitude

control [27]. To overcome this drawback, the articulated-body concept was used in

[52] to model the space manipulator system. With the linearity of unknown param-

eters in the articulated-body model, a conventional adaptive control can be applied

to the trajectory tracking problem. In addition, the linearity in terms of unknown

parameters in the momentum equation implies that the dynamics coupling equation,

which is attained from the time derivative of the momentum of manipulator arm, has

the same characteristic. Hence, by redefining the input command to the coupling dy-

namics equation, a conventional adaptive control was implemented in [35] to achieve

the positioning of the end-effector while the vibrations of the flexible-structure-base

manipulator converged to zero. The aforementioned references [35, 52], however, do

not explicitly deal with the capture of an unknown tumbling target. The authors

of [11] propose a control law to accumulate the angular momentum resulting from

capture of a tumbling target, in the presence of uncertainty in dynamic parameters of

the target. The manipulator motion is assumed to follow a pre-defined stabilization

trajectory [53] and the parameter adaptation law is based on the error in the coupling

force between the base satellite and the robot arm.

14

Page 37: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

1.3 LITERATURE REVIEW

1.3.4 Inertia parameter identification. One of the requirements for post-

capture stabilization algorithms is that the inertial parameters of the target are ac-

curately estimated in real time, if unknown prior to capture [54]. To date, several

articles have been published addressing the inertial parameter estimation aspect of the

space-manipulator/target problem. Although the solutions proposed vary in detail,

most of them were developed based on three fundamental approaches: vision-based

[54, 55], force-based [56] and momentum-based [56–58]. The vision-based method is

very useful in motion prediction for the pre-capture phase, since it provides an es-

timation and prediction of full states as well as inertial parameters, including ratios

of moments of inertia, position of the center of mass and orientation of principal

axes of the target [54, 55]. However, the target’s mass cannot be obtained from this

method. In the force-based method, the estimation problem is formulated based on

the Newton-Euler equations of motion and all of the inertial parameters including

the mass of the target can be estimated [56]. The momentum-based method formu-

lated from the conservation of momentum principle is preferable because it requires

only velocity measurements for inertial parameter identification, these being easily

available on space manipulators. On the other hand, the two former methods require

the space manipulator to be equipped with dedicated sensors and the corresponding

processing algorithms are more susceptible to signal noise, which is further aggra-

vated in space systems [57]. The momentum-based inertial parameter identification

method is unique to space manipulators, since the key equation for identification

problem is derived from the momentum conservation equations. This procedure re-

quires a sequence of sufficiently rich motions spanning a wide range of manipulator

configurations, in order to produce large changes in the velocity of the target. In

[56–58], the momentum-based parameter identification was conducted in an off-line

mode with the motion sequences designed randomly in order to achieve robot config-

urations as different as possible. However, a control scheme for the post-capture of a

tumbling target integrated with target’s parameter identification procedure has not

been developed to date.

15

Page 38: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 1. INTRODUCTION

1.4 Thesis Outline

This dissertation is organized into seven Chapters. First, with the kinematic

and dynamic characteristics of free-floating space manipulators being different from

those of ground-based systems, the relevant fundamental equations are summarized

systematically in Chapter 2. To understand and point out the unique features of

space manipulator systems, we first introduce the momentum conservation equations

and their expressions with respect to two different points, the mass center of the base

and that of the whole system. Details related to the holonomic and nonholonomic

constraints of space manipulators are also discussed. Then, the dynamics equations

of space manipulators are derived by using the Lagrangian method. Since the control

concept proposed in this dissertation is developed based on the reaction null-space

control, the fundamental equations of reaction null-space control concept are reviewed

in detail. Next, the minimum kinetic energy expression of space manipulators is

derived with some relevant remarks on the post-capture control missions. Chapter

2 is closed with the description of the numerical platform using the co-simulation

of MSC.Adams and Matlab/Simulink with the two models of space manipulators, a

planar model and a 3D model of the ETS-VII system.

In Chapter 3, a new reactionless motion control algorithm is formulated from

the momentum conservation equations for a free-floating space manipulator, without

the use of attitude control devices. In the presence of dynamics uncertainties, as

a result of capturing an unknown target, the adaptive control scheme is developed

to adaptively produce the arm motions with minimum disturbance to the base –

hereafter, it is referred to as Adaptive ReactionLess Control (ARLC) algorithm. The

co-simulation platform introduced in Chapter 2 is employed to verify the validity and

feasibility of the proposed concept. The numerical simulation results are obtained for

two basic scenarios: one where the initial (prior to capture) angular momentum of

the target is zero and the second where the target is tumbling.

The ARLC scheme proposed in Chapter 3 provides a buffer in time to segue be-

tween the post-capture and stabilization phases. In Chapter 4, the momentum-based

16

Page 39: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

1.4 THESIS OUTLINE

parameter identification method is derived for estimating the unknown properties

of the captured target while the manipulator arm executes ARLC motions. Since

the total momentum of the system after capture is unknown, the momentum-based

identification algorithm is formulated in incremental form to eliminate the need for

knowledge of system momentum. The recursive least squares technique using QR

decomposition is employed for solving the linear estimation problem. Two control

objectives – maintaining minimum disturbance on the base and achieving conver-

gence to the inertial parameters of the unknown target – are verified through the

same models and test case scenarios as used in Chapter 3.

The manipulator arm following ARLC motions may fail to maintain minimum

disturbance on the base attitude if the joints reach their physical limits. Hence, in

Chapter 5, the ARLC is reformulated in order to implement the redundancy resolu-

tion control technique for a secondary manipulation task. In particular, the gradient

projection method is applied within the ARLC scheme to avoid the physical joint lim-

its of the manipulator. Again, the correct performance of this approach is confirmed

with the same numerical models as used in previous Chapters.

Chapter 6 presents the design concept and the initial design specifications for an

experimental test-bed which could serve as a physical validation and demonstration

platform for the algorithms developed in this thesis. The concept is based on the

air-bearing table principle to create the free-floating conditions for a planar system

configuration. The design allows for a small (3-DOF) robotic arm attached to a free-

floating base, a separate free-floating target, and the required sensing and control

hardware. Finally, Chapter 7 concludes this dissertation and suggests some directions

for future research in this area.

17

Page 40: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative
Page 41: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

2.1 KINEMATICS OF SPACE MANIPULATOR

CHAPTER 2

Kinematics, Dynamics and Reactionless

Control of Space Manipulator

Fundamental kinematic and dynamics equations of space manipulator are system-

atically presented in this Chapter. Since the present dissertation deals with the

coupling motion between the manipulator and the base, the relation between the

end-effector/base motions and the set of joint rates and the coupling dynamics equa-

tions are discussed in detail. The system investigated in this study is comprised of a

serial manipulator mounted on a free-floating base. Since most of the space manipu-

lators in history as well as those planned for launch in the near future, for example,

the Space Infrastructure Servicing, are built with revolute joints, this study focuses

on manipulators with revolute joints only. Here, it is assumed that the system is

composed of rigid bodies and no external forces or torques are exerted. The role of

reaction wheels or other momentum exchange devices is not considered in this study.

2.1 Kinematics of Space Manipulator

Figure 2.1 shows a schematic and important parameters of a servicing system

comprised of a serial-link manipulator holding a target, and a base spacecraft. The

basic kinematic equations of a n-axis serial manipulator mounted on a free-floating

base are derived in this Section. The system is comprised of n+ 1 rigid bodies where

19

Page 42: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 2. KINEMATICS, DYNAMICS AND REACTIONLESS CONTROL OF SPACE MANIPULATOR

……..

O

Z

XY

BASE

Inertial FrameI

n

3 2

10

1

23n

Target

g0rnrnp

nna

0b

1b1a

End-effector

1k k

2k3k

nk

0r

grrp

Figure 2.1. General Model of Space Manipulator Robot

the target is assumed to be rigidized by the end-effector to the last link of the arm

when the capture is established. From Fig. 2.1, it is easy to write the position relation

as:

pr = r0 + b0 +n∑i=1

li (2.1)

where pr denotes the position vector of the end-effector from the origin of the inertial

frame; li = ai+bi with ai being the vector pointing from joint i to the mass center of

link i and bi defining the vector pointing from the mass center of link i to joint i+ 1.

There is a difference from the analogous formula for a fixed-base manipulator due to

the appearance of vectors r0 and b0 which are, respectively, the position of the mass

center of the base relative to the inertial frame at O and the vector pointing from the

mass center of the base to the first joint. Note that all vectors must be expressed in

the same inertial frame ΣI which is assumed to exist in the vicinity of the orbiting

system translating at its orbital speed for the short duration of the capture maneuver.

20

Page 43: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

2.1 KINEMATICS OF SPACE MANIPULATOR

Differentiating both sides of equation (2.1), the end-effector linear velocity is

obtained as follows:

vr = v0 + ω0 × b0 +n∑i=1

ωi × li (2.2)

while the angular velocity of link i can be written as:

ωi = ω0 +i∑

j=1

kjφj (2.3)

Substituting (2.3) into (2.2) with the use of (2.1), we have:

vr = v0 + ω0 × (pr − r0) +n∑i=1

ki × (pr − pi) φi (2.4)

In the above, v0 and ω0 represent the linear and angular velocities of the base; pi

is the position vector of joint i; φi and ki are a joint rate and unit vector associated

with each revolute joint i, respectively. From (2.3), the angular velocity vector of the

last link can be written as:

ωn = ω0 +n∑i=1

kiφi (2.5)

From equations (2.4) and (2.5), ωn and vr can be expressed in a more compact

form as: vr

ωn

= Js

v0

ω0

+ Jmφ (2.6)

where we combine the joint rates into the joint vector and introduce two Jacobian

matrices, defined as:

φ =[φ1 φ2 ... φn

]T∈ IRn

Js =

E −p0r

0 E

∈ IR6×6, p0r = pr − r0

and

Jm =

k1 × (pr − p1) k2 × (pr − p2) · · · kn × (pr − pn)

k1 k2 · · · kn

∈ IR6×n

21

Page 44: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 2. KINEMATICS, DYNAMICS AND REACTIONLESS CONTROL OF SPACE MANIPULATOR

In the above, E denotes the identity matrix and (.) is a skew-symmetric matrix of

vector (.) defined as:

(.) ,

0 −(.)z (.)y

(.)z 0 −(.)x

−(.)y (.)x 0

From equation (2.6), it is apparent that the relationship for the end-effector velocity

involves two separate terms. According to [59], the coefficient matrix of the base

velocity term is defined as the Jacobian matrix for the base, whereas that of the joint

rate vector term is the Jacobian matrix for the fixed-base manipulator. In order to

derive the relationship mapping the set of joint rates to the end-effector velocities,

an additional motion constraint is needed. Under the previously stated assumptions

that there are no external forces or torques exerted on the system and no ACS devices

are used, the total momentum of the space system is conserved and this represents

the nonholonomic motion constraint which is a unique and defining characteristic of

space manipulator systems. In the next Sections, particular attention is given to the

analysis of the momentum equations because they are fundamental to developing the

control algorithms in the next Chapters.

2.2 Momentum Equations

In this Section, the momentum equations of a serial manipulator are first derived.

Next, the compact expressions for the total momentum of the system with respect

to the mass center of the base as well as the mass center of the whole system are

presented. Let P and L denote the linear and angular momenta, respectively, of the

whole manipulator and target system with respect to the inertial frame shown in Fig.

2.1. Then, by definition we have:

P =n∑i=0

miri (2.7)

L =n∑i=0

(Iiωi + ri ×miri) (2.8)

22

Page 45: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

2.2 MOMENTUM EQUATIONS

where ri ∈ IR3 is the position vector of the mass center of link i; Ii ∈ IR3×3 is the

inertia tensor of link i w.r.t. its mass center and ωi ∈ IR3 is the angular velocity of

link i; mi is the mass of rigid body i. Again, all vectors are expressed in the inertial

frame.

By employing the forward kinematics relations for a serial space manipulator,

similarly to the derivation of equations (2.4), we have the expansion of the linear

velocity of center of mass of link i as:

ri = v0 + ω0 × (ri − r0) +i∑

j=1

kj × (ri − pj) φj (2.9)

Substituting (2.9) and (2.3) into (2.7) and (2.8), we obtain:

P = Mv0 +M rT0gω0 +n∑i=1

i∑j=1

mi [kj × (ri − pj)] φj (2.10)

L = M rgv0 +

(n∑i=0

(Ii −mirir0i)

)ω0

+n∑i=1

i∑j=1

miri [kj × (ri − pj)] + Iikj φj

(2.11)

where

M =n∑i=0

mi : Total mass of the whole system

rg =

∑ni=0 miriM

: Position of the mass center of the whole system

r0i = ri − r0; and r0g = rg − r0

We next further formulate specifically the angular momentum of the system with

the view to deriving its compact decomposition. To this end, two pertinent locations

in our system – the mass center of the whole system and the mass center of the base

satellite – can be used to decompose the total angular momentum into the angular

momentum about the aforementioned point and the linear momentum term. These

23

Page 46: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 2. KINEMATICS, DYNAMICS AND REACTIONLESS CONTROL OF SPACE MANIPULATOR

……..

O

Z

XY

BASE

I

Targ

et

grg0r

gL

P

0r

(A)

……..

O

Z

XY

BASE

I

Targ

et

grg0r

0LP

0r

(B)

Figure 2.2. Two decompositions of total angular momentum

decompositions are useful for the analysis and development of the manipulator control

algorithms.

Letting Lg denote the angular momentum of the system with respect to the mass

center of the whole system, as illustrated in Fig. 2.2A, the system angular momentum

L can be decomposed into:

L = Lg + rg ×P (2.12)

From (2.12), Lg can be computed with the use of (2.10) and (2.11) as follows:

Lg = L− rg ×P =

[n∑i=0

(Ii −mirir0i)−M rgrT0g

]ω0

+n∑i=1

i∑j=1

mirgi [kj × (ri − pj)] + Iikj φj

(2.13)

According to the definition of rg, we have the relation:

M rgr0g = rg

n∑i=1

mi [ri − r0] =n∑i=1

mirgr0i (2.14)

Then, (2.13) can be simplified as follows:

Lg =

[n∑i=1

(Ii +mir

Tgir0i

)+ I0

]ω0

+n∑i=1

i∑j=1

mirgi [kj × (ri − pj)] + Iikj φj

(2.15)

24

Page 47: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

2.2 MOMENTUM EQUATIONS

Now, combining equations (2.10) and (2.11) into a compact form by making use of

(2.12) and (2.15), we obtain:P

L

=

ME M rT0g

0 Hω

v0

ω0

+

JTω

Hωφ

φ+

0

rg ×P

(2.16)

where

Hω =n∑i=1

(Ii +mir

Tgir0i

)+ I0 ∈ IR3×3

Hωφ =n∑i=1

(IiJRi +mirgiJT i) ∈ IR3×n

JT i = [k1 × (ri − p1),k2 × (ri − p2), · · · ,ki × (ri − pi),0, · · · ,0]

JRi = [k1,k2, · · · ,ki,0, · · · ,0]

JTω =n∑i=1

miJT i

The advantage of the decomposition above is that the linear velocity of the base v0 is

eliminated from the bottom part of (2.16), which is the angular momentum equation

of the system. Equation (2.16) has been used as a starting point for developing the

coupling motion control algorithms in the literature [11, 45]. This equation also plays

a key role in the derivation of the proposed control scheme presented in Chapter 3.

Similarly to the above derivation, the system angular momentum equations can

be rewritten to obtain the compact form in terms of the angular momentum of the

system w.r.t. the center of mass of the base and linear momentum, as illustrated in

Fig. 2.2B. Letting L0 be the angular momentum of the system w.r.t. the center of

mass of the base, we have:

L = L0 + r0 ×P (2.17)

Following the same procedure of the derivations of equations (2.13) and (2.14), but

now with r0 used instead of rg, we obtain the angular momentum of the system w.r.t.

25

Page 48: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 2. KINEMATICS, DYNAMICS AND REACTIONLESS CONTROL OF SPACE MANIPULATOR

the center of mass of the base L0 as:

L0 = L− r0 ×P =

[n∑i=1

(Ii +mir

T0ir0i

)+ I0

]ω0

+n∑i=1

i∑j=1

mir0i [kj × (ri − pj)] + Iikj φj

(2.18)

and the linear and angular momenta can be decomposed into a compact form by

using relations (2.17) and (2.18) as follows:P

L

=

ME M rT0g

M r0g HΩ

v0

ω0

+

JTω

HΩΦ

φ+

0

r0 ×P

(2.19)

where

HΩ =n∑i=1

(Ii +mir

T0ir0i

)+ I0 ∈ IR3×3

HΩΦ =n∑i=1

(IiJRi +mir0iJT i) ∈ IR3×n

The coefficient matrix of the base velocity term (first term in (2.19)) is the base

inertia matrix, while that of the joint rates is the coupling inertia matrix. Unlike the

coefficient matrix of the base velocity term resulting in (2.16), the base inertia matrix

of (2.19) is symmetric and always invertible.

Under the stated conditions, the motion of the space manipulator is subject to

the conservation of momentum, that is, the linear and angular momenta of the system

(P, L) remain constant. Hence, the momentum equations presented above impose

motion constraints on the space manipulator system. Although these constraints are

all represented in velocity form, only the linear momentum motion constraint can

be analytically integrated with respect to time. Indeed, integrating equation (2.7),

yields: ∫ t

0

Pdt =

∫ t

0

n∑i=0

miridt =n∑i=0

miri(t)−n∑i=0

miri(0)

= M (rg(t)− rg(0))

(2.20)

26

Page 49: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

2.3 GENERALIZED JACOBIAN MATRIX

It can be seen from equation (2.20) that the mass center of the whole system does

not displace if the initial (and constant) linear momentum of the system is zero. The

linear momentum conservation constraint, which can be expressed as a configuration

or as a velocity constraint, is a holonomic constraint. On the other hand, the angular

momentum constraint cannot be expressed as a configuration constraint due to the

nonintegrability of the angular momentum of the system (see equation (2.8)). Hence,

it imposes a nonholonomic constraint on a free-floating manipulator system. This

unique feature of free-floating space manipulators can be visualized by considering

a scenario where the end-effector of the arm returns to the same initial position

and orientation in inertial space after following a closed trajectory, but the base

orientation and manipulator configuration will not be the same as the initial ones [30,

32]. As already mentioned in [20, 22], the kinematics problem of a free-floating space

manipulator is difficult to solve even for the forward kinematics because the position

and orientation of the end-effector depend on the history of manipulator maneuver.

To overcome this difficulty, the kinematics of space manipulator is usually defined

at the velocity level. Thus, the generalized Jacobian matrix was introduced in [28]

to formulate the relationship between the end-effector velocities and the manipulator

joint rates. This is a relevant concept in motion control of space manipulators because

a number of fixed-base manipulator control schemes can be adopted to their space

analogues by using this concept. The derivation of the generalized Jacobian matrix

is presented in the following section.

2.3 Generalized Jacobian Matrix

The generalized Jacobian matrix (GJM) was originally derived by Umetani and

Yoshida [28] for free-floating and free-flying space manipulators as a direct analogue

of the standard Jacobian matrix for fixed-base (ground-based) manipulators. The

formulations of GJM for two cases are presented in this Section: first, the GJM is

formulated with the additional assumption that the linear and angular momenta of

27

Page 50: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 2. KINEMATICS, DYNAMICS AND REACTIONLESS CONTROL OF SPACE MANIPULATOR

the system are zero; second is the general case where the system momenta can be

varied by jet thrusters, ACS devices or external forces/torques.

From the momentum equation (2.19), the motion constraint for P = L = 0 can

be written as: ME M rT0g

M r0g HΩ

v0

ω0

+

JTω

HΩΦ

φ = 0 (2.21)

Since the base inertia matrix in the above is always invertible as mentioned previously,

equation (2.21) can be solved for the base velocities with:v0

ω0

= −

ME M rT0g

M r0g HΩ

−1 JTω

HΩΦ

φ (2.22)

The above relation between the base velocities and joint rates allows us to elimi-

nate the base velocity term in the forward kinematics equation (2.6), thereby yielding

a direct relationship between the manipulator operational space (end-effector) veloc-

ities vr and ωn and the joint space rates φ:vr

ωn

=

Jm − Js

ME M rT0g

M r0g HΩ

−1 JTω

HΩΦ

φ (2.23)

and consequently revealing the Generalized Jacobian Matrix, J∗, for a space manipu-

lator:

J∗ = Jm − Js

ME M rT0g

M r0g HΩ

−1 JTω

HΩΦ

∈ IR6×n (2.24)

The GJM formula captures the fundamental invariant of a space-based system – its

momentum – thereby implicitly linking the kinematics and dynamics of the system.

It is also apparent from the above formula that the matrix J∗ reduces to the standard

Jacobian Jm for a ground-based manipulator as the mass and inertia tensor of the

base approach infinity.

Now, the GJM for a non-zero momentum scenario, where the momentum of the

system is varied through the effects of jet thrusters from ACS or external natural

forces, as for example, generated by the gradient of gravity, is derived. Proceeding

28

Page 51: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

2.3 GENERALIZED JACOBIAN MATRIX

analogously to the derivation just presented starting with equation (2.19) to eliminate

the base velocities from equation (2.6) and making use of the definition of GJM in

(2.24), we obtain:vr

ωn

= J∗φ+ Js

ME M rT0g

M r0g HΩ

−1 P

L− r0 ×P

(2.25)

Since HΩ is always invertible, the base inertia matrix can be inverted symbolically as

follows:ME M rT0g

M r0g HΩ

−1

=

(ME−M rT0gH−1Ω M r0g

)−1 −rT0g(HΩ −M r0gr

T0g

)−1

−(HΩ −M r0gr

T0g

)−1r0g

(HΩ −M r0gr

T0g

)−1

Equations (2.23) and (2.25) describe the relation between the end-effector veloc-

ity in inertial space and a set of rates in joint space, with (2.25) also accounting for

non-zero and variable P and L. The generalized Jacobian matrix is a function of both

kinematic and dynamic parameters and depends on the robot configuration. Making

use of equations (2.23) and (2.25), the resolved motion-rate control and resolved ac-

celeration control have been employed to track the prescribed (desired) end-effector

motion with the allowance for the reaction from the arm motion onto the base. In

practice, these algorithms were successfully implemented and flown on the ETS-VII

[3]. Based on the explicit formula of GJM, it is realized that the kinematics infor-

mation alone is not sufficient for solving the inverse kinematics problem. Knowledge

of the dynamics characteristics of the whole system is necessary to formulate the

motion control algorithm. This is also the motivation for the proposed parameter

identification approach presented in Chapter 4 of this dissertation, since uncertainty

in inertial parameters of the system is introduced in the post-capture of unknown

target mission.

29

Page 52: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 2. KINEMATICS, DYNAMICS AND REACTIONLESS CONTROL OF SPACE MANIPULATOR

2.4 Dynamics Equations

As mentioned in Section 2.2, since the momentum equation provides direct in-

sight into the motion of the system, in particular, reactive motion between the base,

manipulator and target, the proposed control algorithm presented in Chapter 3 is not

developed from the dynamics equations. However, they of course form the dynamics

kernel of the commercial dynamics simulator, MSC.Adams, employed in this work

for testing and demonstrating the performance of the algorithms developed. There-

fore, for completeness, in this Section, the dynamics equations of a free-floating space

manipulator are formulated by employing the Lagrangian method. Starting with the

kinetic energy of the system, by definition, it can be written as:

T =1

2

n∑i=0

ωTi Iiωi +mir

Ti ri

(2.26)

By using the forward kinematics of a space manipulator, equations (2.9) and (2.3),

the kinetic energy in (2.26) can be reformulated in terms of the base velocity and

joint rates as follows:

T =1

2

[vT0 ω

T0 φ

T]

ME M rT0g JTω

M r0g HΩ HΩΦ

JTTω HTΩΦ Hφ

v0

ω0

φ

(2.27)

where

Hφ =n∑i=1

(JTRiIiJRi +miJ

TT iJT i

)∈ IRn×n

For a free-floating manipulator system without considering the attitude control

mechanisms, it is apparent that the generalized coordinates are defined to be the ac-

tive joint angles φ ∈ IRn×1 of the manipulator. Therefore, following the derivation of

the equations of motion using the Lagrangian method, it is suggested that the kinetic

energy should be expressed as a function of φ and φ. Under the assumption that

no external torques or forces are exerted on the system, the momentum conservation

30

Page 53: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

2.4 DYNAMICS EQUATIONS

equation can be used as an additional constraint equation to eliminate the base ve-

locities from the kinetic energy function. For simplicity, we further assume that the

initial momentum of the system is zero so that the nonholonomic constraint equation

(2.21) can be applied. Hence, the kinetic energy T can be written as:

T =1

2φT

Hφ −[JTTω HT

ΩΦ

] ME M rT0g

M r0g HΩ

−1 JTω

HΩΦ

φ (2.28)

and the above expression for T can be directly applied into the Lagrangian equations.

Since the system is operated under the micro-gravity condition, the system’s potential

energy is approximately zero. Hence, the system dynamics equation is derived from

the simplified Lagrange’s equations:

d

dt

(∂T

∂φ

)− ∂T

∂φ= τ (2.29)

where τ = [τ1 τ2 ... τn]T is the vector of joint torques corresponding to the generalized

coordinates φ. Substituting for T from (2.28) into (2.29), the equation of motion in

terms of φ, φ and φ is obtained as:

M(φ)φ+ C(φ, φ)φ = τ (2.30)

where the inertia matrix M is a symmetric and positive definite matrix defined ex-

plicitly in terms of the previously introduced matrices as:

M = Hφ −[JTTω HT

ΩΦ

] ME M rT0g

M r0g HΩ

−1 JTω

HΩΦ

(2.31)

and the nonlinear coriolis and centrifugal terms as:

C(φ, φ)φ = Mφ− ∂

∂φ

(1

2φTMφ

)(2.32)

Several important properties need to be noted regarding the dynamics equation

of a free-floating space manipulator as listed below:

31

Page 54: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 2. KINEMATICS, DYNAMICS AND REACTIONLESS CONTROL OF SPACE MANIPULATOR

• First, a relationship between matrices M and C that exists for ground-

based manipulators also holds for a space-based manipulator, in particular,

M− 2C is a skew-symmetric matrix [25].

• Second, it can be observed from equation (2.31) that the inertia matrix

M is composed of two separate terms. Analogously to the generalized Ja-

cobian matrix formula, the first term is a function of manipulator inertia,

geometry and configuration only, whereas the second term takes the cou-

pling dynamics between the base and manipulator into account. It should

be noted that the inertia matrix M for a space manipulator reduces to that

of a ground-based manipulator if the mass and the inertia tensor of the

base approach infinity.

• Finally, the most significant feature of the dynamics equation of a space ma-

nipulator is the nonlinearity of parametrization property, since the second

term in equation (2.31) cannot be expressed linearly in terms of the dynam-

ics parameters of the system [25]. This is an important consideration for

studies on post-capture of unknown target. In fact, the implementation of

nonlinear control or adaptive control methods for the post-capture problem

is preferred for ground-based manipulator control, since these approaches

have been demonstrated to offer very good performance in controlling a ma-

nipulator with unknown grasping payload [48, 60]. However, the linearity of

the parameterization is one of the prerequisite conditions for designing most

of the existing adaptive control approaches. Hence, these approaches can-

not be analogously implemented for the dynamics equations of free-floating

space manipulators derived with the Lagrangian method.

In this study, the main consideration is the disturbances of the manipulator mo-

tion on the free-floating base. Hence, it is not necessary to consider the problem at

acceleration or torque level because the investigation of motion rates and momenta

is sufficient for designing a control algorithm [28]. In the next Section, the powerful

concept of the arm manipulation producing minimum disturbance to the base, which

32

Page 55: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

2.5 REACTION NULL-SPACE MOTION CONTROL

is the main inspiration for the present research, is presented. This concept has become

widely known as the reaction null-space motion control.

2.5 Reaction Null-Space Motion Control

Reaction null-space (RNS) motion control was introduced by Nenchev et al. [36,

61] to address the problem of minimizing coupling disturbance for a free-floating

space manipulator. RNS motion is defined as a set of joint rates producing zero

disturbance to the base. A manipulator system with non-zero degree of redundancy

(DOR) is required for the existence of RNS solutions. However, the definition of

DOR for a space manipulator is not the same as that for a conventional ground-

based manipulator, the latter defined as the difference between the degree-of-freedom

(DOF) of the arm and the dimension of the end-effector task space [40]. Since the

control task of a free-floating space manipulator does not only deal with the end-

effector motion, but also the base motion (w.r.t. the inertial frame), the DOR has

to be defined according to the dimension of the task space which poses as the main

objective for the controller to be designed. A detailed explanation of DOR in the

context of the free-floating manipulator control problem can be found in [41].

Now, the RNS concept is presented for the basic scenario where the initial linear

and angular momenta of both manipulator and target with respect to the defined

inertial frame are zero (P, L = 0), that is, neither are translating nor rotating

relative to the inertial frame. Considering the rotational motion of the base as the

main control task, we assume that the necessary condition for the existence of RNS,

which is the kinematic redundancy condition with respect to the base motion task,

holds. From (2.16), it follows that the angular momentum equation can be simplified

to:

Hωω0 + Hωφφ = 0 (2.33)

The above statement of the angular momentum of the system has formed the basis

of the RNS control algorithm [41, 62], which generates the joint motion resulting in

zero disturbance to the base under ideal conditions. Specifically, by substituting the

33

Page 56: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 2. KINEMATICS, DYNAMICS AND REACTIONLESS CONTROL OF SPACE MANIPULATOR

desired angular velocity of the base, ω0 = 0, into (2.33) and solving the remaining

homogeneous equation, we obtain the null-space solutions for joint rates φ:

φRNS =(E−H+

ωφHωφ

)ζ (2.34)

In the above, H+ωφ denotes the right pseudo-inverse of matrix Hωφ and ζ ∈ IRn is

an arbitrary vector with units of angular rates [rad/s]. It is apparent that the RNS

joint rates are generated by projecting an arbitrary vector ζ onto the null-space of

the inertia coupling matrix Hωφ via an orthogonal projection PRNS = E−H+ωφHωφ.

From the existence condition of RNS, the solution (2.34) exists if:

dim(RNS) = n− rank(Hωφ) > 0

where recall n is the DOF of the arm. The formulation of the RNS motion can also be

used as a benchmark to ascertain the accuracy of the numerical simulation platform

for a free-floating space manipulator as is executed in Chapter 3, in the simulation

study Section 3.3.

For the general case where the initial system angular momentum is non-zero,

although the RNS motion defined by (2.34) produces a zero net angular momentum

of the manipulator arm, there is no guarantee of zero disturbance to the base since the

momentum of the base must accumulate the non-zero total angular momentum. By

the same token, the general formula of reactionless motion for the non-zero angular

momentum scenario can be obtained as follows:

φRL = H+ωφL +

[E−H+

ωφHωφ

]ζ (2.35)

Equations (2.34) and (2.35) have been employed as fundamental equations in

many studies on trajectory planning and control of space manipulators [3, 36, 63].

Moreover, the validity of the RNS motion was experimentally proved with the ETS-

VII in orbit. In the next Chapter, this powerful concept is put to further use to

develop a control method for the post-capture problem with the presence of dynamics

uncertainties as a result of unknown target capture.

34

Page 57: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

2.6 REMARKS ON KINETIC ENERGY OF SPACE MANIPULATOR

2.6 Remarks on Kinetic Energy of Space Manipulator

Our analysis of the space manipulator system also demonstrates that there is a

maximum amount of kinetic energy which can be dissipated by the manipulator arm

during and/or after capture of a tumbling target and this value depends on the initial

momenta of the target and the arm configuration at capture. In fact, assuming that

the space system is initially at rest, the kinetic energy of the system T is equal to the

work done by the actuators W , that is:

T = W =

∫ tf

0

τ T φdt (2.36)

where as before τ is the assembly of manipulator joint torques [Nm] and φ is the

vector of joint rates [rad/s]. From equation (2.36), it immediately follows that:

T = τ T φ (2.37)

and therefore, we can conclude that the kinetic energy of the space system reaches its

minimum value at φ = 0. From the kinetic energy of the system expression obtained

previously in equation (2.27), it then follows that the minimum kinetic energy of the

space manipulator system can be reduced to the following:

Tmin =1

2

[vT0 ω

T0

] ME M rT0g

M r0g HΩ

v0

ω0

(2.38)

Making use of the momentum conservation equations (2.19) with the initial linear

momentum P and angular momentum L, the above formula for Tmin can be expressed

as follows:

Tmin =1

2

[PT LT

0

]ME M rT0g

M r0g HΩ

−1 P

L0

(2.39)

where recall L0 can be computed from L0 = L− r0 ×P.

In the above, the matrix inverse depends on the configuration of the manipulator.

This result demonstrates that, for the given initial momentum of the system, there

is a maximum amount of kinetic energy which can be dissipated by the manipulator

35

Page 58: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 2. KINEMATICS, DYNAMICS AND REACTIONLESS CONTROL OF SPACE MANIPULATOR

arm. Therefore, the residual kinetic energy has to ultimately be accommodated by

the attitude control devices, such as reaction wheels, for stabilizing the whole sys-

tem.1 Simulation results verifying the minimum kinetic energy expression for a space

manipulator, equation (2.39), are presented in [64].

2.7 Numerical Co-simulation Platform

Developing an experimental facility for testing a free-floating space manipulator

on Earth is one of the biggest challenges and constraints for research scientists in

this field. Still, there are a number of test-beds that have been constructed for this

purpose: the planar air-bearing table is suitable for testing 2D scenarios; the par-

abolic flight can be used for short duration experiments; under-water facilities are

few in the world but they can provide a fully 3D neutrally-buoyant environment [65].

These methods are costly and may be rather limited, for example, the under-water

facilities are not suitable for direct testing of a space robot prototype. In Chapter

6 of this thesis, we present an initial design for a small-scale planar facility that

could be used in the future to demonstrate the algorithm developed here. For the

present, however, a numerical co-simulation platform was developed to analyze and to

demonstrate the behaviors of two space manipulators and to test the proposed control

and identification algorithms. The co-simulation platform combines the advantages of

Automatic Dynamic Analysis of Mechanical Systems (MSC.Adams) software in mod-

eling and simulating complex multibody dynamics systems, with the advantages of

Matlab/Simulink with special capabilities for control system design. It is worth men-

tioning that MSC.Adams has been used by NASA Jet Propulsion Laboratory (JPL)

as a main simulation platform for the Curiosity’s descent and landing simulation on

Mars [66].

A schematic of the co-simulation setup employed in this research is illustrated in

Fig. 2.3 where the dynamics model of space manipulators are built and computed in

MSC.Adams and the control and parameter identification algorithms are developed

1In the context of spacecraft attitude control, this is referred to as detumbling control problem[16].

36

Page 59: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

2.7 NUMERICAL CO-SIMULATION PLATFORM

Robot Model

MSC.ADAMS

Control/IdentificationAlgorithm

Matlab/SimulinkPositions

Joint angles/rates

Base angular velocity

Control input (Torques)

Figure 2.3. Co-simulation platform using MSC.Adams and Matlab/Simulink

Base Target

Link

1 Link2

Link3

End-effector

Top view

Gripper

Target

F

F

Front view

Grapple Fixture

(A) Planar Base-3-DOF manipulator and target

Link1

Link2

Lin

k3

Link6

Lin

k4

Link5

Link7 + Target

Inertial Frame

(B) ETS-VII model

Figure 2.4. Space manipulator models built in MSC.Adams

in Simulink. The outputs from MSC.Adams including position vectors (the end-

effector, center of mass of the base and links), joint angles/rates and base angular

velocity are the inputs to the Simulink program. Then, the control outputs from

Simulink, specifically the commanded torques to each joint of the manipulator arm,

are the inputs to MSC.Adams. As previously mentioned, the dynamics kernel of the

space manipulator is executed in MSC.Adams simulator.

The investigation and verification of the proposed concepts in this dissertation are

conducted with two models of space manipulator systems created in MSC.Adams as

37

Page 60: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 2. KINEMATICS, DYNAMICS AND REACTIONLESS CONTROL OF SPACE MANIPULATOR

shown in Fig. 2.4. Fig. 2.4A shows a model snapshot of the planar system comprised

of the base, 3-DOF manipulator and the target. Realistic capture is considered in this

model scenario with the solid to solid impact modeling capabilities of MSC.Adams

employed to model impact and contact between the gripper and grapple fixture. At

the instant of capture, the target is grasped and held firmly with two forces F applied

to the gripper perpendicular to the gripper jaw surfaces, in the plane of the system.

Fig. 2.4B shows the model of the ETS-VII servicing satellite employed for testing the

proposed algorithms with a non-planar scenario. In this model, the target is assumed

to be attached rigidly to the end-effector at the instant the capture is established.

Thus, the last link of the 3D model in Fig. 2.4B is annotated as Link7+Target. The

detailed kinematic and dynamics parameters of the aforementioned models as well as

the specific simulation conditions will be presented in the simulation study Section

3.3 in the next Chapter.

2.8 Summary

The fundamental equations, in particular, kinematic, momentum and dynamics

equations, for developing control algorithms of a free-floating space manipulator were

presented in this Chapter. The unique features of a free-floating space manipulator

were discussed in detail including the nonholonomic motion constraints, generalized

Jacobian matrix and dynamics equations derived with the Lagrangian method. In

addition, the formula for minimum kinetic energy attainable by a space manipulator

without the use of momentum exchange devices was derived. In this Chapter, we

particularly focused on analyzing the coupling motion between the arm and the base,

and the reaction null-space control concept. These concepts and corresponding equa-

tions will be used again in the following Chapters to develop the adaptive reactionless

control and momentum-based parameter identification algorithms.

38

Page 61: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

CHAPTER 3

Adaptive Reactionless Control Algorithm

The main contribution of this research is presented in this Chapter. A new reactionless

motion control algorithm is proposed to satisfy the principal objective of maintaining a

minimum disturbance to the base in the post-capture of an uncooperative target with

a space manipulator. Since the target becomes an integral part of the manipulator

after capture, the dynamics properties of the whole system are changed in a priori

known or unknown manner, depending on the available information on the target.

As already stated, the control method proposed in this study focuses on solving the

problem of capturing an unknown tumbling target.

To date, a number of control strategies have addressed the post-capture problem.

With the availability of system properties as well as knowledge of target’s motion, an

optimal control technique was designed in [15, 67] to coordinate control between the

base, manipulator and the target to bring the whole system to rest in minimum time,

where the input torque to control the attitude of the base is generated by reaction

wheels. In [42, 45, 46], a distributed momentum control algorithm was developed

based on the angular momentum equation to generate the arm motion so that the

initial angular momentum (assumed to be known) from the captured target is dis-

tributed to the arm and is absorbed by reaction wheels in the base. Considering the

dynamics uncertainties after capturing an unknown target, the adaptive control tech-

nique was proposed in [35, 52] to deal with the problem of end-effector motion control

39

Page 62: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

while holding an unknown payload. However, none of these approaches resolved the

issues arising when capturing an unknown and tumbling target.

The unknown changes in the dynamics parameters of the system, as a result of

capturing an unknown target, must be accommodated as otherwise they may lead

to poor performance of the trajectory control and attitude stabilization systems. In

addition, the amount of unknown angular momentum of a tumbling target trans-

ferred to the space manipulator after capture can lead the reaction wheels to their

saturation state due to the limitations on the available output torque [47]. Since the

attitude control mechanisms cannot instantly absorb an arbitrary angular momen-

tum from the target in order to minimize the disturbance to the base, a task buffer

time is necessary for the stabilization phase. To address this issue, a new concept,

the adaptive reactionless manipulation to segue between target capture and system

stabilization phases of the capture mission, is proposed in this study. It is motivated

by the RNS control concept introduced in Chapter 2; however, the dynamics param-

eters as well as the total momentum of the system are not exactly known in advance.

This scheme is intended for use in the transition phase from the instant of capture

till the unknown parameters are identified and/or the available stabilization methods

can be applied properly. The proposed adaptive control scheme is referred to here as

Adaptive ReactionLess Control (ARLC) and its role as part of the complete capture

mission is illustrated in Fig. 3.1.

In Section 3.1, the new reactionless manipulation formula is developed based

on the momentum equations. Then, in Section 3.2, an adaptive control scheme is

implemented with the use of the recursive least squares algorithm for parameter

adaptation. The feasibility of the proposed concept is verified through simulations

conducted with two manipulator systems: a planar and a three-dimensioned model

presented in Section 3.3. In this study, the planar model is comprised of a free-floating

base equipped with 3-DOF manipulator to capture the target spinning about the axis

perpendicular to the plane; and, the model of the real ETS-VII system is employed

for the non-planar test cases.

40

Page 63: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

3.1 FORMULATION OF ADAPTIVE REACTIONLESS MOTION

Approaching Target(Pre-capturing Phase)

Capturing Target(Impact Phase)

RNSC

Adaptive ReactionLess Control (ARLC)

Post-capturing Phase

System Stabilization Algorithm

Compound Stabilization Phase

Figure 3.1. ARLC as part of capture mission

3.1 Formulation of Adaptive Reactionless Motion

The important assumptions for the existence of reactionless manipulation in the

post-capture phase are first stated. Since the new formula for the reactionless mo-

tion is developed from the fundamental formula for the reaction null-space motion,

the necessary conditions for the existence of reaction null-space solutions for a free-

floating manipulator are assumed to be satisfied in the development. In this study,

the primary concern is the base attitude and not the base translation resulting from

the manipulator motion. As we pointed out in Section 1.1, in practice it is important

to avoid the attitude disturbances on the base, whereas the translational disturbance

does not pose significant undesirable side effects [15]. For the target capture mission,

since the present study focuses on the effect of the target angular momentum on the

system, and in particular on the attitude of the base, it can be assumed, without

loss of generality, that the initial linear momenta of both the target and the space

manipulator are zero, i.e., Pm = Pt = 0, where Pm and Pt are the linear momentum

of the space manipulator and target, respectively [45]. With respect to the existence

of reaction null-space motion, it is sufficient for the servicing system to be kinemati-

cally redundant with respect to the base task space. The latter, in light of the above

comments, contains attitude degrees of freedom only. It is also noted that the algo-

rithm developed here does not require knowledge of the motion of the target before

capture as it assumes that the capture itself has been completed successfully. The

impact which occurs as a result of the capture has no effect on the conservation of

41

Page 64: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

momentum of the whole system, which in turn forms the basis of the adaptive con-

troller derived here. The target is assumed to be rigidized by the end-effector to the

last link of the manipulator when the capture is established.

Under changing inertial parameters of the arm, which result from target capture,

our objective is to develop a new procedure to incrementally compute a set of reac-

tionless joint rates in an online manner based on the current observed performance:

the joint motions of the arm and the disturbance on the base attitude. In the follow-

ing, the derivation of the regressor form based on the angular momentum equation

and the reaction null-space theory is presented.

The angular momentum of a space manipulator after capturing a tumbling target

with an initial angular momentum Lt can be restated based on the bottom part of

equation (2.16) as follows:

Hωω0 + Hωφφ = Lm + Lt (3.1)

where Lm is the angular momentum of the space manipulator before capture. The

matrices Hω and Hωφ in equation (3.1) include the inertia term of the target by

assuming that the target becomes rigidly attached to the end-effector. In the ideal

scenario where perfect knowledge of target properties is available, the reactionless

motion for the manipulator to produce zero attitude disturbance to the base can be

computed according to the generalization of equation (2.34) as:

φr = H+ωφL +

[E−H+

ωφHωφ

]ζ (3.2)

where L = Lm + Lt is the angular momentum of the whole system after capture and

φr denotes the required reactionless joint rates. Thus, in the ideal scenario, φr would

be computed from equation (3.2) and then commanded to the joint controller of the

manipulator, thereby producing reactionless motion.

However, in the absence of accurate knowledge of Hωφ due to the unknown prop-

erties of the target, the manipulator motion will be governed by (3.1) with nonzero

42

Page 65: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

3.2 RECURSIVE ADAPTATION

ω0, and the general solution for the joint rates can be written as:

φ = H+ωφ (L−Hωω0) +

[E−H+

ωφHωφ

]ζ (3.3)

In the above two equations, the null-space solutions are represented by the second

term of equations (3.2) and (3.3) where ζ ∈ IRn is an arbitrary vector. Therefore, the

set of joint rates computed from the aforementioned equations is not unique in terms

of the angular velocity of the base ω0. To satisfy the control objective, it is necessary

to choose a particular solution φr from the general solution φ in order to obtain a

desired base angular velocity. Substituting for φr from (3.2) into (3.3) yields:

φ = −H+ωφHωω0 + φr (3.4)

or more succinctly,

φr − φ = Kω0 (3.5)

where

K = H+ωφHω

The regressor form in equation (3.5) is the foundation of the proposed control

scheme. The left hand side of this equation can be viewed as the deviation from

the reactionless motion or its perturbation. It is apparent from the above that if φ

closely follows φr, then ω0 converges to zero, i.e., zero attitude disturbance to the

base is produced. Equation (3.5) forms the basis of the adaptive reactionless control

algorithm (ARLC) where the regressor formulation is coupled with the well-known

recursive least squares algorithm for parameter adaptation, as presented next.

3.2 Recursive Adaptation

Equation (3.5) can be considered as an alternative to equation (3.2) to compute

the reactionless manipulator motion, if perfect knowledge of kinematics and dynamics

of the space manipulator is available. However, for the capture mission of an unknown

43

Page 66: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

target, the transition between the approach phase and the post-impact phase will in-

volve an unpredictable change in the inertia properties, as well as the total momentum

of the base-manipulator-target system. For a safe and smooth transition, a certain

buffer in time is needed to achieve the convergence of the target’s identification pro-

cedure or to provide the attitude control system with the additional time to correct

for the initial (pre-capture) angular momentum of the target Lt while maintaining

minimum disturbance to the base. Thus, it is necessary to setup an adaptive control

scheme to compute reactionless joint rates online, in the presence of uncertainties.

The benefit of equation (3.5) is apparent when it is utilized as a regressor form for

deriving an adaptive control algorithm. In the following, the adaptive reactionless

control scheme is developed by using the certainty equivalence adaptive control ap-

proach. In the adaptive control scheme, the recursive least squares (RLS) algorithm

[68, 69] is employed to adaptively update reactionless joint rates in online manner.

In our conception of ARLC algorithm, we presumed that it is not necessary for the

manipulator to follow any specific trajectory because the main objective of ARLC is

to ensure minimum disturbance of the base attitude right after capturing a tumbling

target. Since the target capture changes the inertial properties of the arm in a priori

unknown way, we redefine the reference joint rates φr as follows:

ˆφr − φ = Kω0 (3.6)

where φ and ω0 represent the actual joint rates and base angular velocity, respectively.

Notation . is employed to denote the unknown post-capture vector and matrices,

which incorporate the properties of the unknown target.

With the current estimates . and the exact measurements of φ and ω0, it is

natural to define the prediction error e of equation (3.6) as follows:

e(t) = ˆφr(t− 1)− φ(t)− K(t− 1)ω0(t) (3.7)

where the time index is introduced in the above equation to make clear the discrete

nature of the process, in this case characterized by two consecutive time instants,

44

Page 67: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

3.2 RECURSIVE ADAPTATION

or time samples in a practical control system. Now, the well-known recursive least

squares parameter adaptation algorithm [70] is used to update the time-varying ma-

trix K(t) in order to minimize the total prediction error:

J =

t∫0

e2(τ)dτ (3.8)

3.2.1 Parameter adaptation of time-varying systems. In the adaptive

control literature, although the analysis of most techniques is restricted to time-

invariant systems, their real motivation is to provide a practical control scheme for

dealing with time-varying systems [68, 71]. Indeed, the control problem for a time-

varying system can be fundamentally viewed as a combination of an on-line parameter

adaptation with an on-line control system synthesis. The primary concern for the

time-varying case is that the parameter adaptation algorithm is capable of continually

tracking the time-varying parameters.

The online parameter adaptation algorithm updating the estimated parameters

at each time sample plays a key role in designing the adaptive control algorithm. As

per [69], the general structure of a parameter adaptation algorithm can be described

as follows:New estimated

parameters

←Previous estimated

parameters

+

Adaptation

gain

Measurement

vector

Prediction

errors

From the above, we can see that the role of the parameter adaptation algorithm is to

adjust the estimated parameters based on the current measurements and the previ-

ous estimates in order to minimize the prediction error. Several types of parameter

adaptation algorithms are available in the literature such as heuristic approach, gra-

dient method and least squares minimization. The recursive least squares algorithm

is implemented for the derivation of ARLC in this study.

45

Page 68: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

The RLS algorithm has been known to provide extremely fast initial convergence.

However, this advantage has to be weighed against the requirement for continuous

tracking of the time-varying parameters, because as the adaptation gain approaches

zero, signifying convergence, the parameter adaptation algorithm effectively comes

to a halt. In addition, to track the slowly time-varying parameters, it is necessary

to employ the forgetting factor to discount old data. However, the phenomenon of

estimator windup and bursts, when the adaptation gain becomes sufficiently large

due to poor excitation, can lead to an unstable control system [71]. Hence, the

modification of RLS with covariance resetting proposed by Goodwin and Sin [68] is

implemented to attain the initial convergence while ensuring that the gain is bounded

both away from zero and from growing excessively large.

As per [68], the RLS algorithm to compute the updates for K(t) takes the fol-

lowing form, using the current (at time t) joint rates and base angular velocity, these

in turn either measured on a real system or simulated in a simulation environment:

K(t) = K(t− 1) +[

ˆφr(t− 1)− φ(t)− K(t− 1)ω0(t)]

N(t) (3.9)

where

N(t) =ω0(t)TQ(t− 1)

λ+ ω0(t)TQ(t− 1)ω0(t)(3.10)

Q(t) =1

λ

[Q(t− 1)− Q(t− 1)ω0(t)ω0(t)TQ(t− 1)

λ+ ω0(t)TQ(t− 1)ω0(t)

](3.11)

It is noted that N ∈ IR1×3 is a row vector. The initial guess for the adaptation

gain matrix Q ∈ IR3×3 can be chosen as: Q(0) = αE for α > 1. A value of forgetting

factor λ very close to unity is desired to ensure the ARLC algorithm remains stable

during the post-capture maneuvering [72]. As already noted, since the matrix K

changes with time due to its configuration dependence and unknown properties of

the captured target, the covariance resetting algorithm is implemented to avoid the

matrix Q from becoming excessively large or approaching zero. The matrix Q is

reset to its initial value whenever the trace of Q goes beyond the preset thresholds;

46

Page 69: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

3.2 RECURSIVE ADAPTATION

otherwise, the ordinary least squares, i.e., equation (3.11), is employed to compute

Q(t). Letting ti be the time when resetting occurs, then, Q is reset as Q(ti−1) = Q(0)

(in the computation of adaptation gain Q(ti) as per equation (3.11)).

The RLS algorithm requires measurements of the current joint rates φ(t) and the

corresponding base angular velocity ω0(t). The manipulator reactionless joint rates

can be initialized as per (2.34) by using the known pre-capture parameters and the

ARLC algorithm is triggered at the instant of capture. Once K(t) update has been

calculated, the desired reactionless motion of the manipulator which serves as the

reference input to the manipulator joint control law is computed from equation (3.6)

as follows:ˆφr(t) = φ(t) + K(t)ω0(t) (3.12)

In this manner, the reactionless joint rates and the parameter matrix K are adaptively

updated to guarantee minimum disturbance of the base (provided the RLS algorithm

is stable), without knowledge of the inertial properties of the tumbling target. The

block diagram of the algorithm is included in Fig. 3.2 and the main steps are sum-

marized below, assuming a sampling rate of ∆t. Note that the parameter adaptation

algorithm is to be executed continually during the maneuver and this is known as the

non-vanishing adaptation [69].

Step1: Initialization (based on the known pre-capture parameters of the ma-

nipulator)

φr(0) = H+ωφLm +

[E−H+

ωφHωφ

K(0) = H+ωφHω

t = ∆t

Step2: Measure (or simulate) φ(t) and ω0(t).

Step3: Compute K(t) from (3.9) with (3.10) and (3.11).

Step4: Using K(t), update the desired joint rates from (3.12).

Step5: t← t+ ∆t; Return to step 2 until finish.

47

Page 70: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

Parameter Adaptation Algorithm

Space ManipulatorPlant(t)(t)(t)(t) 0r

ˆˆ ωK

tK

];[ 0 ωPD Velocity-based Controller

Inner Loop

Outer Loop

Figure 3.2. Adaptive reactionless control scheme

Two observations need to be made regarding the proposed adaptive control

scheme as follows:

(i) It is emphasized that the ultimate objective of the proposed control scheme

is to adaptively generate the desired reactionless motion for the manipulator

after capturing a tumbling target with unknown inertial properties. The

reactionless motion is computed from the estimates of the plant parameters

“as if these were the true plant parameters” [60]. This idea is well known

in the adaptive control literature as the certainty equivalence principle.

(ii) Since ARLC scheme is based solely on the observed performance of the base-

manipulator system and the total prediction-error is minimized by using the

RLS approach, the control objective of maintaining the reactionless motion,

i.e., ω0 ≈ 0 is still satisfied even though there is a mismatch between the

estimated matrix K and its true value. As illustrated in Fig. 3.2, the

proposed control scheme can be viewed as comprised of two loops: the inner

loop with the PD joint velocity-based controller and the outer loop with an

on-line parameter adaptation algorithm. The incremental perturbation of

the joint rates y = ˆφr − φ is by design driven to zero with the inner loop

controller, since the reference input to the latter is ˆφr, and the updated

reactionless motion is a solution of the on-line adaptation algorithm (RLS).

3.2.2 Stability Analysis. Following our previous discussion of the approach

to deal with a time-varying system, the stability of the proposed scheme is analyzed

48

Page 71: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

3.2 RECURSIVE ADAPTATION

under the assumption that the control algorithm is implemented at a sufficiently

high sampling rate, in order to ensure a relatively small change in K between two

consecutive samples. As discussed in [73], the recursive prediction-error algorithm

presented in the previous subsection can be analyzed by considering the individual

components of prediction error e, in particular, the k-th component for estimating

the k-th row of matrix K. Thus, from (3.7), we have:

ek(t) = ˆφkr(t− 1)− φk(t)− ωT0 (t)KT

k (t− 1) (3.13)

where Kk is k-th row of matrix K; k = 1, ..., n. The RLS parameter adaptation

algorithm for the k-th row Kk of matrix K has the same adaptation gain matrix

Q and regression vector ω0 as the algorithm presented in equations (3.9)-(3.11) and

therefore,

KTk (t) = KT

k (t− 1) + N(t)ek(t) (3.14)

where

N(t) =Q(t− 1)ω0(t)

λ+ ωT0 (t)Q(t− 1)ω0(t)(3.15)

Q(t) =1

λ

[Q(t− 1)− Q(t− 1)ω0(t)ωT0 (t)Q(t− 1)

λ+ ωT0 (t)Q(t− 1)ω0(t)

](3.16)

The approach used by Goodwin and Sin [68] is adopted here for proving stability

and convergence of parameter adaptation algorithm presented in (3.14)-(3.16). First,

a scalar Lyapunov function is introduced as follows:

Vk(t) = Kk(t)Q−1(t)KT

k (t) (3.17)

where Kk(t) = Kk(t) −Kkt and Kk(t − 1) ≈ Kk(t) = Kkt (based on the aforemen-

tioned assumption of small changes in K between two consecutive samples). Sub-

tracting KTkt from both sides of equation (3.14), yields:

KTk (t) = KT

k (t− 1) + N(t)[

ˆφkr(t− 1)− φk(t)− ωT0 (t)KTk (t− 1)

](3.18)

49

Page 72: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

From the discrete form of equation (3.6), we have:

ˆφkr(t− 1)− φk(t) = ωT0 (t)KT

kt (3.19)

and substituting (3.19) into (3.18) with the use of (3.15), we obtain:

KTk (t) = KT

k (t− 1)− Q(t− 1)ω0(t)ωT0 (t)KTk (t− 1)

λ+ ωT0 (t)Q(t− 1)ω0(t)(3.20)

Further manipulating equation (3.20), it follows that:

KTk (t) = λ

1

λ

[Q(t− 1)− Q(t− 1)ω0(t)ωT0 (t)Q(t− 1)

λ+ ωT0 (t)Q(t− 1)ω0(t)

]Q−1(t− 1)KT

k (t− 1) (3.21)

or more simply with the use of equation (3.16),

KTk (t) = λQ(t)Q−1(t− 1)KT

k (t− 1) (3.22)

Considering the relation:

Vk(t)− λVk(t− 1) =[Kk(t)− Kk(t− 1)

]Q−1(t)KT

k (t) (3.23)

= −Kk(t− 1)ω0(t)ωT0 (t)Q(t− 1)

λ+ ωT0 (t)Q(t− 1)ω0(t)Q−1(t)KT

k (t) (3.24)

where we made use of equations (3.17) and (3.22), and then using the hypothesis

0 < λ ≤ 1, (3.24) can be rewritten as:

Vk(t)− Vk(t− 1) = −λKk(t− 1)ω0(t)ωT0 (t)KTk (t− 1)

λ+ ωT0 (t)Q(t− 1)ω0(t)− (1− λ)Vk(t− 1) ≤ 0 (3.25)

Inspecting (3.25) while recalling that the adaptation gain matrix Q is symmetric

and positive definite, we observe the Vk(t) must be a nonincreasing positive scalar

function, thus completing the stability proof.

50

Page 73: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

3.3 SIMULATION STUDY

3.3 Simulation Study

In this section, the proposed approach is verified by using two servicing spacecraft-

manipulator systems: one with a three-degrees-of-freedom (3-DOF) planar manipu-

lator as illustrated in Fig. 3.3 and a second one with a 7-DOF three-dimensional ma-

nipulator model based on the real ETS-VII testing satellite. The dynamics models of

the servicer and the target, in free-floating conditions, are created in MSC.Adams and

co-simulated with Matlab/Simulink in interactive mode (at the communication inter-

val of 0.0001 sec). The detailed description of the MSC.Adams and Matlab/Simulink

co-simulation platform can be found in Section 2.7. The relevant parameters of the

base, the links and the three targets employed in this study (large, medium, small)

are summarized in Table 3.1 for the 2D model and Tables 3.2 and 3.3 for the 3D

model. Note that the target size characterizations for the 2D test case were defined

according to their mass ratios relative to the base.

The desired motion generated by ARLC is produced by driving the joints with

the low-level velocity-based controller where the joint torques are computed as per the

PD control law with constant gains for the whole motion. In particular, the ARLC

control scheme provides joint rate input commands to the manipulator presumed to

be equipped with a velocity servo controller implemented in hardware. In manipulator

control practice, it is acknowledged that the servo follows the velocity-based command

more accurately than, for example, the torque-based command due to the high-gain

hardware-velocity feedback [74]. The velocity-based control is a standard practice

both in space manipulators [11, 28, 35] and ground-based manipulator control.

3.3.1 Planar Test Case. Verification of the proposed algorithm is first pre-

sented by using the numerical simulation platform for the planar model test case. In

the following, the planar model is tested for two basic scenarios: Lt = 0 and Lt 6= 0

before capture (recall Lt is the angular momentum of the target). The first scenario

demonstrates the adaptation of ARLC in producing the reaction null-space motion

51

Page 74: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

sradt /2.0BASE

Link1

Target

Link2

Link3o60

Y

X

Figure 3.3. Planar base-3-DOF manipulator-target model

Table 3.1. Planar 3-DOF manipulator simulation model parameters

Mass (kg) Izz (kgm2) a Dimension

Base 500 83.61 1m×1m

Link1 10 1.05 1m

Link2 10 1.05 1m

Link3 10 1.05 1m

Target 1 500 20.83 0.5m×0.5m

Target 2 250 10.41 0.5m×0.5m

Target 3 125 5.20 0.5m×0.5m

when the inertia parameters of the space manipulator are modified as a result of tar-

get capture. For the case Lt 6= 0, the simulation of the post-capture of an unknown

spinning target is realistically conducted with the incorporation of impact between

the target and manipulator. The simulation study aims to verify the capability of

the proposed scheme to minimize the disturbance to the base. The initial adapta-

tion gain matrix and forgetting factor for the RLS algorithm were chosen as Q(0) =

diag[1000, 1000, 1000] and λ = 0.99, respectively. As already noted, the reaction-

less joint rate command serves as a reference input to the closed-loop PD controller

to generate the input torques in each joint of the manipulator. For all 2D model

simulations, the actual capture/impact occurs at t ≈ 4 sec.

aThe moment of inertia values are computed by MSC.Adams based on geometry and density.

52

Page 75: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

3.3 SIMULATION STUDY

Table 3.2. 3D, 7-DOF manipulator simulation model parameters

Mass (kg) Ixx (kgm2) Iyy Izz

Base 1000 1200 1200 1200

Link1 35.01 1.218 0.5132 1.331

Link2 30 2.10 1.378 2.359

Link3 22.69 0.102 3.378 3.359

Link4 21.38 0.4327 2.266 1.911

Link5 16.75 0.3878 0.3963 0.07271

Link6 26.17 0.5727 0.5987 0.1288

Link7 + Target 500 50 50 50

Table 3.3. Denavit-Hartenberg parameters of 7-DOF manipulator

Link ai (m) αi (deg) bi φi (deg)

1 0 90 0.35 φ1

2 0 90 0.2 φ2 + 90

3 0.87 0 0.275 φ3

4 0.63 0 -0.275 φ4

5 0 90 -0.36 φ5 − 90

6 0.55 90 0.16 φ6 − 90

7 0.532 0 0.2 φ7

The accuracy of the simulation platform was first ascertained by examining the

conservation of system total momentum during the RNS motion without the target,

where the base is initially at rest and the manipulator was commanded with joint

motions as per (2.34) with ζ = [0.1 0.1 0.1]T for the duration of 200 sec. The reac-

tionless joint motions, the response of the base and the system linear and angular

momenta are illustrated in Fig. 3.4. It is apparent that the total momentum of the

system is conserved (to within 10−7 kgm/s for components of P and 10−4 kgm2/s for

Lz) and minimum base disturbance is produced by RNS motion. These results verify

the accuracy of the simulation platform and its suitability for testing the proposed

control concept.

53

Page 76: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

0 50 100 150 200−0.05

0

0.05

0.1

0.15

Time [s]

Join

t rat

es [r

ad/s

]

Joint 1Joint 2Joint 3

50 100 150 200−2

0

2x 10

−4

[rad

/s]

Angular velocity of the base

50 100 150 200−5

0

5x 10

−4

[kgm

2 /s]

Total angular momentum of system

50 100 150 200−1

0

1x 10

−7

Time [s]

[kgm

/s]

Total linear momentum of system

Lx, L

y Lz

PzP

x

Py

Figure 3.4. Reaction null-space system response for model verification

54

Page 77: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

3.3 SIMULATION STUDY

Planar model test case with Lt = 0

After the target is captured and rigidized by the gripper relative to the end-

effector, the inertia parameters of the last link of the manipulator are changed to

the new constant values. For example, for the numerical values of the medium target

considered here, the mass of the last link is modified from 10 kg to 260 kg. To demon-

strate the effect of parameter uncertainty on the base attitude, the response of the

system is simulated by commanding RNS motion computed with the before-capture

knowledge of system parameters, again with ζ = [0.1 0.1 0.1]T . The corresponding

results are shown in Figs. 3.5 and 3.6 from which one can observe that the RNS

motion produces a significant rate disturbance (as high as 0.07 rad/s) on the base

when no adaptation to the change in the inertia of the space manipulator is imple-

mented. Simulation results of the adaptive reactionless algorithm are displayed in

Figs. 3.7, 3.8 and 3.9. In this simulation, the arm is initialized at the instant of

capture with rates φRL computed from (3.2) and the ARLC adaptively updates the

reactionless motion. It is apparent that negligible base rotational motion is achieved

with the ARLC algorithm. The small “blips” at ≈ 43 sec and ≈ 135 sec occur as a

result of the degradation in tracking of the desired ARLC joint rates with the low-

level velocity-based PD controller that occurs for the higher joint rates near these

time instants. The angular momentum profile associated with the target object, the

manipulator and the whole system while undergoing the ARLC motion are also pre-

sented in Fig. 3.9. These results illustrate the momentum exchange between the

target and manipulator resulting from the ARLC motion.

Planar model test case with Lt 6= 0

In this scenario, the implementation of the ARLC when the space manipulator

grasps a spinning unknown target of small, medium and large mass, with respect

to the mass of the base, are conducted. It is assumed that prior to target capture,

the space manipulator has negligible linear/angular momentum and the target is

spinning about the axis perpendicular to the plane of the system with a constant

55

Page 78: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

0 20 40 60 80 100−0.1

−0.05

0

0.05

0.1

0.15

0.2

0.25

0.3

Time [s]

Join

t rat

es [r

ad/s

]

Joint 1Joint 2Joint 3

Figure 3.5. Joint rates, Lt = 0, without ARLC

0 20 40 60 80 100−0.08

−0.06

−0.04

−0.02

0

0.02

0.04

0.06

Time [s]

Bas

e an

gula

r ve

loci

ty [r

ad/s

]

Figure 3.6. Base angular rate, Lt = 0, without ARLC

56

Page 79: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

3.3 SIMULATION STUDY

0 50 100 150 200−0.1

−0.05

0

0.05

0.1

0.15

Time [s]

Join

t rat

es [r

ad/s

]

Joint 1Joint 2Joint 3

Figure 3.7. Joint rates, Lt = 0, with ARLC

0 50 100 150 200−1

0

1

2

3

4

5

6

7x 10

−3

Time [s]

Bas

e an

gula

r ve

loci

ty [r

ad/s

]

Figure 3.8. Base angular velocity, Lt = 0, with ARLC

57

Page 80: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

0 50 100 150 200−1.5

−1

−0.5

0

0.5

1

1.5

Time [s]

The

rel

atio

nshi

p be

twee

n L

m a

nd L

t [kgm

2 /s]

Lt

Lm

Lm

+Lt

Figure 3.9. The relationship between Lm and Lt, Lt = 0, with ARLC

angular velocity ωt = 0.2 rad/s, as shown in Fig. 3.3. The target is grasped firmly

by the gripper to the end-effector at the grasping point after the capture.

1) Medium target, mt = 250 kg

The principle objective of the proposed control scheme is confirmed through the

simulation results of ARLC joint rates and the response of the base (angular velocity

and attitude) shown in Figs. 3.10 and 3.11, respectively. The impact between the

manipulator and the target is reflected in the abrupt changes in the joint rate and base

angular velocity profiles at t = 4 sec. However, these perturbations are very quickly

damped out with the ARLC controller. From these results, it is observed that the

ARLC algorithm is able to maintain the base attitude nearly unchanged with the

online adaptation of the joint rates, while the manipulator holds the unknown target.

The reason for the higher values in the base angular velocity at around 30 sec and 85

sec is again the degradation in the joint tracking of the PD controller that occurs for

the higher joint rates. Indeed, the error profiles of the low-level velocity-based PD

controller shown in Fig. 3.12 match the base angular velocity profile in Fig. 3.11.

58

Page 81: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

3.3 SIMULATION STUDY

0 50 100 150 200−0.2

−0.1

0

0.1

0.2

0.3

Time [s]

Join

t rat

es [r

ad/s

]

Joint 1Joint 2Joint 3

Figure 3.10. Joint rates, Lt 6= 0, mt = 250 kg

This suggests that with a better tracking controller, the base angular motion could

be reduced even further.

In Fig. 3.13, the angular momentum distribution between the target and the arm

is illustrated as well as conservation of the total angular momentum of the system,

Lm + Lt at the value equal to the target’s pre-capture angular momentum. The

joint acceleration profiles of ARLC motion are also presented in Fig. 3.14 showing

that they are quite low and feasible. To visualize the motion of the arm during the

adaptation, five snapshots of the system are shown in Fig. 3.15, where the fixed frame

is also drawn to illustrate the uncompensated translational motion of the base.

2) Large and small targets, mt = 500 kg and mt = 125 kg

The capability of ARLC in dealing with a wide range of target masses is demon-

strated through two sets of simulations in capturing a large (500 kg) and a small (125

kg) target, relative to the base. The targets’ properties are shown in Table 3.1 and in

both cases, the targets are spinning at angular velocity ωt = 0.2 rad/s before capture,

59

Page 82: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

0 50 100 150 200−8

−6

−4

−2

0

2

4

6x 10

−5

Time [s]

Bas

e an

gula

r ve

loci

ty [r

ad/s

]

0 50 100 150 200−2

−1.5

−1

−0.5

0

0.5

1x 10

−3

Time [s]

Bas

e at

titud

e [r

ad]

Figure 3.11. Base response: angular velocity and attitude, Lt 6= 0, mt = 250 kg.

0 50 100 150 200−1

−0.5

0

0.5

1 x 10−3

Time [s]

Join

t rat

es c

ontro

l err

or [r

ad/s

]

Joint 1Joint 2Joint 3

Cause of spikes in the base angular velocity

Figure 3.12. ARLC joint rates error, Lt 6= 0, mt = 250 kg.

60

Page 83: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

3.3 SIMULATION STUDY

0 50 100 150 200−1.5

−1

−0.5

0

0.5

1

1.5

2

2.5

3

3.5

Time [s]

The

rel

atio

nshi

p be

twee

n L

m a

nd L

t [kgm

2 /s]

Lt

Lm

Lm

+Lt

Figure 3.13. The relationship between Lm and Lt, Lt 6= 0, mt = 250 kg

0 50 100 150 200−0.03

−0.02

−0.01

0

0.01

0.02

0.03

Time [s]

Join

t acc

eler

atio

ns [r

ad/s2 ]

Joint 1Joint 2Joint 3

Figure 3.14. Joint accelerations, Lt 6= 0, mt = 250 kg

61

Page 84: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

X

Y

X

Y

X

Y

X

Y

Y

X

Figure 3.15. Five configurations (snapshots) of the arm after capturing aspinning target, Lt 6= 0, mt = 250 kg

62

Page 85: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

3.3 SIMULATION STUDY

0 50 100 150 200−0.3

−0.2

−0.1

0

0.1

0.2

0.3

0.4

Time [s]

Join

t rat

es [r

ad/s

]

Joint 1Joint 2Joint 3

(A)

0 50 100 150 200−1.5

−1

−0.5

0

0.5

1x 10

−3

Time [s]

Bas

e an

gula

r ve

loci

ty [r

ad/s

]

(B)

Figure 3.16. ARLC with Lt 6= 0, mt = 500 kg

0 50 100 150 200−0.1

−0.05

0

0.05

0.1

0.15

Time [s]

Join

t rat

es [r

ad/s

]

Joint 1Joint 2Joint 3

(A)

0 50 100 150 200−3

−2.5

−2

−1.5

−1

−0.5

0

0.5

1x 10

−4

Time [s]

Bas

e an

gula

r ve

loci

ty [r

ad/s

]

(B)

Figure 3.17. ARLC with Lt 6= 0, mt = 125 kg

thus, resulting in Ltz of 4.16 and 1.04 kgm2/s for the large and small target, respec-

tively. With the similar simulation setup as the previous test case, the reactionless

joint rates and base responses are presented in Fig. 3.16 for 500 kg target and Fig.

3.17 for 125 kg target. The above angular rate disturbances remain on the scale of

10−3 rad/s and 10−4 rad/s for the 500 kg and 125 kg targets, respectively. These

results confirm the capability of ARLC scheme to perform well for a wide range of

target masses.

63

Page 86: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

0 20 40 60 80 100−1.5

−1

−0.5

0

0.5

1x 10

−3

Time [s]

Bas

e an

gula

r ve

loci

ty [r

ad/s

]

ωx

ωy

ωz

Figure 3.18. Base angular velocity, mt = 500 kg, 3D case.

3.3.2 3D Test Case. The implementation of the ARLC algorithm for a

general 3D model is presented in this section. The proposed control algorithm is tested

by simulating the capture of a tumbling target with the 7-DOF manipulator based on

the model of ETS-VII system. For the purposes of this simulation, it is assumed that

the target is attached rigidly to the last link immediately after capture, that is, the

impact is not modeled. As a result of capture, the mass of the last link is modified

from 18.07 kg to 500 kg and the corresponding properties are changed accordingly, as

per information in Table 3.2. To emulate the tumbling motion, an external impulsive

torque of 15Nm is applied to the end-effector about each of the three axes for the

duration of 0.2 seconds. This results in the initial angular disturbance to the base

about the three axes, as shown in Fig. 3.18. The reactionless joint rates are shown in

Figs. 3.19 and 3.20 for all seven joints. As can be seen from Fig. 3.18, the impulsive

angular momentum causes a spike in the base response at ≈ 1 sec, after which time

the ARLC maintains the minimum disturbance to the base (on the order of 10−4

rad/s) by generating the reactionless motion of the ETS-VII arm.

64

Page 87: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

3.3 SIMULATION STUDY

0 20 40 60 80 100−0.06

−0.04

−0.02

0

0.02

0.04

Time [s]

Join

t rat

es [r

ad/s

]

Joint 1Joint 2Joint 3

Figure 3.19. Joint rates φ1, φ2, φ3, mt = 500 kg, 3D case.

0 20 40 60 80 100

−0.1

−0.05

0

0.05

0.1

Time [s]

Join

t rat

es [r

ad/s

]

Joint 4Joint 5Joint 6Joint 7

Figure 3.20. Joint rates, φ4 – φ7, mt = 500 kg, 3D case.

65

Page 88: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 3. ADAPTIVE REACTIONLESS CONTROL ALGORITHM

3.4 Summary

A new formulation as well as a control scheme to adaptively produce reactionless

manipulation for a space manipulator during and after capture of an unknown tum-

bling target are presented in this chapter. Similarly to the reaction null-space control,

the proposed adaptive reactionless control is derived from the conservation of angu-

lar momentum for the system and the adaptation of the desired manipulator motion

is computed by using the recursive least squares procedure and the use of certainty

equivalence concept. The feasibility of the approach was verified with the numerical

simulations of a base-3-DOF manipulator-target planar model and the ETS-VII 3D

model, both co-simulated in MSC.Adams and Matlab/Simulink. It was shown that

the adaptive reactionless control algorithm is effective in generating the required joint

rates which produce minimum reaction to the base after capturing an unknown tar-

get. Moreover, although the parameter matrix K does not converge to its true value

with the correct dynamics parameters of the system, the algorithm still produces the

reactionless motion of the arm. The benefits of ARLC in the post-capture mission

will be demonstrated in the next chapter with the identification of the target’s inertial

properties while executing ARLC motion.

66

Page 89: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 4. ADAPTIVE REACTIONLESS CONTROL FOR PARAMETER IDENTIFICATION

CHAPTER 4

Adaptive Reactionless Control for

Parameter Identification

One of the critical issues for control of space manipulator after capturing a target

satellite or space debris is the uncertainty, or in the extreme case, complete lack

of information on the inertial properties of the target. In the case of satellite cap-

ture, the inertial parameters may be available from the design specifications; however,

even then, they can be different in orbit as a result of uncertain fuel consumption,

mechanical malfunctions, or damage accrued from years of operation in orbit. In

this Chapter, the adaptive reactionless control scheme presented in Chapter 3 for the

post-capture of an unknown target is integrated with the target’s parameters iden-

tification procedure. In literature, the on-orbit stabilization algorithms addressing

the post-capture issues require accurate models of kinematics and dynamics of the

space-manipulator-target system. Moreover, the available control methods for space

manipulators which have been successfully demonstrated on systems in orbit, such

as resolved motion rate control using generalized Jacobian matrix [28] or reactionless

manipulation control [3], also require precise knowledge of inertial parameters of the

system. Indeed, the formulations of reaction null-space motion and generalized Ja-

cobian matrix for space manipulator require not only geometric parameters but also

inertial parameters. Hence, the unknown inertial parameters which are the mass,

67

Page 90: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 4. ADAPTIVE REACTIONLESS CONTROL FOR PARAMETER IDENTIFICATION

center of mass and moment of inertia of the payload need to be identified accurately

to achieve such controllers after the manipulator grasps an unknown object.

The problem of dynamics parameter identification for a ground-based manipula-

tor holding a payload were addressed in the literature by using estimation procedures

based on the Newton-Euler formulation of the system dynamics equations [75]. How-

ever, the estimation procedure based on the relationship between acceleration and

torque/force in each joint is difficult to implement for the space manipulators due to

the difficulty and accuracy of joint acceleration and torque measurements. Hence, the

parameter identification procedure derived from the momentum conservation equa-

tions is preferable for space manipulator systems since this method requires only

velocity data measurements. It is known as the momentum-based estimation method

and is unique to space manipulator systems. In Chapter 3, the ARLC scheme is

proposed as a means to transition between post-capture and compound stabilization

phases, thus providing a buffer in time during which the base is undisturbed. Now,

this capability of ARLC is exploited to implement the momentum-based parameter

identification algorithm [56, 58] while the reactionless motion of the arm is generated

by ARLC. The principal differences of the proposed procedure from the previous

related studies can be stated as follows:

(i) Two objectives are satisfied conjointly: minimization of disturbance to the

base and estimation of inertial parameters after capturing an unknown tum-

bling target (without using the attitude control devices).

(ii) The parameter identification task is performed online while the arm is

executing ARLC motion.

(iii) The regression form of the parameter identification problem is formulated

for the case of the tumbling target with an unknown initial angular mo-

mentum.

The implementation of ARLC and momentum-based parameter identification in the

capture mission is illustrated in Fig. 4.1.

68

Page 91: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

4.1 MOMENTUM-BASED PARAMETER IDENTIFICATION

Approaching Target(Pre-capturing Phase)

Capturing Target(Impact Phase)

RNSC

Adaptive ReactionLess Control (ARLC)

Post-capturing Phase

System Stabilization Algorithm

Compound Stabilization PhaseJoint Rates and Base

Velocity Measurements

Momentum-BasedParameter Identification

Figure 4.1. Incorporation of ARLC and momentum-based parameter iden-tification into the capture mission

4.1 Momentum-based Parameter Identification

The momentum-based parameter identification for a space manipulator is formu-

lated in this Section. In the following derivation, it is assumed that shortly after the

manipulator grasps the target, the target is rigidized relative to the end-effector, and

hence the inertial parameters of the last link of the arm are changed after capture.

Under this assumption, the unknown parameters to be identified are: mn, nan, and

nIn, which denote the mass, the position of center of mass w.r.t. Σn frame and the

inertia tensor of the last link, respectively. The kinematic and dynamics parameters

of the manipulator, except for the last link with the unknown target, are assumed to

be known a priori and it is also assumed that the joint angles and rates are available

from standard joint encoder measurements. The momentum-based identification to

estimate the inertial parameters of the last link of space manipulator after target

capture, without the knowledge of the target’s initial angular momentum, is now

derived.

The momentum-based method is developed based on the momentum conservation

equations. To identify the inertial properties of the last link, the conservation of

momentum equations can be decomposed into the measured terms, involving joint

69

Page 92: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 4. ADAPTIVE REACTIONLESS CONTROL FOR PARAMETER IDENTIFICATION

rates and base velocity, and the estimated quantities, which depend on the inertial

parameters of the last link. Then, the momentum equations are cast into a regressor

form in order to apply the least-squares technique to estimate the unknown quantities.

From their definitions, the linear and angular momentum equations, (2.7) and

(2.8), are thus rewritten by separating the terms with the known and measured quan-

tities from those involving the unknown parameters of the last link. For clarity, the

latter are surrounded by square brackets as follows:

P =n−1∑i=0

miri + [mnrn] (4.1)

L =n−1∑i=0

(Iiωi + ri ×miri) + [Inωn + rn ×mnrn] (4.2)

Realizing that the position of the center of mass of the last link, the vector nan, is

embedded in rn, rn is decomposed as:

rn = pn + IRnnan (4.3)

where IRn is the rotation matrix from frame Σn to ΣI . Furthermore, rn is itself

embedded in the derivative rn which can be expanded by using forward kinematics

of the system as:

rn = v0 + ω0 × (rn − r0) +n∑j=1

(kj × (rn − pj)) φj (4.4)

Introducing u =∑n−1

i=0 miri for compactness of presentation to denote the known

quantities in Eq. (4.1) and with P = 0, (4.1) becomes:

mnrn = −u (4.5)

70

Page 93: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

4.1 MOMENTUM-BASED PARAMETER IDENTIFICATION

Substituting for rn from (4.4) with rn replaced as per (4.3) and separating the terms

involving the parameters to be identified on the right-hand-side gives:

(v0 + ω0 × (pn − r0) +

n∑j=1

(kj × (pn − pj)) φj

)

= u

[1

mn

]+ (ω0

IRn +n∑j=1

φjkjIRn) [nan]

(4.6)

where again the square brackets were placed around the terms involving the param-

eters to be identified. Note that ω0 and kj notation is used in Eq. (4.6) to allow

a matrix product computation where the corresponding terms multiply a rotation

matrix resulting from substitution of Eq. (4.3).

Proceeding similarly for the angular momentum equation, after replacing rn and

rn in the last term of (4.2), we obtain:

L =n−1∑i=0

(Iiωi + ri ×miri) + u× pn +[Inωn + uIRn

nan]

(4.7)

and again introducing the known quantities q as:

q =n−1∑i=0

(Iiωi + ri ×miri) + u× pn (4.8)

Separating out the known terms, the angular momentum equation (4.2) is rewritten

as:

L− q = uIRnnan + IRn

nInnωn (4.9)

However, the angular momentum of the whole system after the target capture is

equal to L and is unknown. Since the momentum is conserved for the free-floating

space manipulator maneuvering with ARLC motion, the angular momentum L can

be eliminated by replacing (4.9) with its incremental form. Thus, the increment of

the total angular momentum L(t), as the system evolves from configuration at time

tk to another configuration at the instant tk+1, is zero. This results in:

−∆q = ∆(uIRn)nan + ∆Ωnin (4.10)

71

Page 94: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 4. ADAPTIVE REACTIONLESS CONTROL FOR PARAMETER IDENTIFICATION

where the symbol ∆(·) now denotes the increment of the (·) between time tk and

tk+1. The matrix Ωn and the vector in are defined as follows:

Ωn = IRn

nωnx

nωnynωnz 0 0 0

0 nωnx 0 nωnynωnz 0

0 0 nωnx 0 nωnynωnz

in = [I11, I12, I13, I22, I23, I33]T

The left-hand-side of (4.10) contains known quantities only, while the right-hand-

side contains the unknown parameters nan and in, the latter stringing the moments

and products of inertia in a column vector. Combining equations (4.6) and (4.10)

into matrix form and factoring out the vector of unknown parameters, the standard

linear equation for the estimation problem is obtained as follows:

v0 + ω0 × (pn − r0) +∑n

j=1 (kj × (pn − pj)) φj

∆q

=

u ω0IRn +

∑nj=1 kjφj

IRn 0

0 ∆(uIRn) ∆Ωn

1/mn

nan

in

(4.11)

Equation (4.11) represents an underdetermined system of equations for the ten

inertial parameters of the last link after capture; it, therefore, requires more than one

set of measurements for a solution. It can be solved with any of the existing least

squares techniques for linear estimation problems and in this study, solution of (4.11)

is obtained recursively by using the conventional QR decomposition recursive least

squares algorithm. The estimation is performed online with the set of measurements

generated during the ARLC motions.

4.2 QR Decomposition Recursive Least Squares

The QR decomposition recursive least squares (QRD-RLS) is a numerically reli-

able method which uses orthogonal transformation of the coefficient matrix for solving

72

Page 95: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

4.2 QR DECOMPOSITION RECURSIVE LEAST SQUARES

the linear least squares problem [76]. It has been found to produce more accurate

and smoother results compared to the standard RLS procedure [77]. In this Section,

the implementation of QRD-RLS method to recursively estimate the unknown quan-

tities in equation (4.11) is presented. The momentum-based parameter identification

problem is formulated as the least squares solution to a system of linear equations as

follows:

y = Ax (4.12)

where

y = −

v0 + ω0 × (pn − r0) +∑n

j=1 (kj × (pn − pj)) φj

∆q

∈ IR6×1

A =

u ω0IRn +

∑nj=1 kjφj

IRn 0

0 ∆(uIRn) ∆Ωn

∈ IR6×10; and x =

1/mn

nan

in

∈ IR10×1

Assuming that the measurements are available at each time step, up to and

including time step k − 1 we have the measurement equations of the form:

y(k−1) = A(k−1)x (4.13)

where

y(k−1) =

y1

...

yk−1

, A(k−1) =

A1

...

Ak−1

In the above, yi and Ai are the known vector/matrix quantities obtained at time step

i. It is noted that the vector/matrix ∆(·) in y and A can be computed as follows:

∆(·)i = (·)i − (·)l (4.14)

where (·)l represents the known quantities measured at time step l < i and (·)l can

represent a fixed value at a certain configuration during the identification procedure.

The numerically reliable approach using orthogonal transformations is implemented

73

Page 96: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 4. ADAPTIVE REACTIONLESS CONTROL FOR PARAMETER IDENTIFICATION

to obtain the least-squares estimate xk−1 of x. Supposing at time step k− 1, we have

obtained the QR decomposition of A(k−1) as:

A(k−1) = Qk−1Rk−1 (4.15)

where Qk−1 is orthogonal and Rk−1 is nonsingular upper triangular. From (4.13) and

(4.15), the estimate xk−1 of x can then be obtained by solving the upper triangular

equation:

Rk−1xk−1 = QTk−1y

(k−1) (4.16)

The benefits of employing the QR decomposition are two-fold: it allows for a numer-

ically reliable solution for the parameter estimates as per equation (4.16), and it also

provides an efficient algorithm to recursively compute the QR decomposition at the

next time step without repeating the whole procedure from the beginning. At time

step k, the manipulator evolved to a new configuration with the new measurement

equation, and hence the total measurement equation is written as:

y(k) = A(k)x (4.17)

where

y(k) =

y(k−1)

yk

, A(k) =

A(k−1)

Ak

At this point, we can obtain xk by integrating the latest measurements in the estimate

but without repeating the full algorithm. This is possible by computing the QR

decomposition of A(k) based on the already obtained QR decomposition of A(k−1).

In particular, the QR decomposition of A(k) is computed by appending the new

measurements Ak to the upper triangular Rk−1, which is stored from the previous

time step, and annihilating Ak by a sequence of Givens rotations. As a result, the

new QR components of A(k), Qk and Rk, are obtained as follows:

QTk

Rk−1

Ak

=

Rk

0

(4.18)

74

Page 97: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

4.3 PERSISTENT EXCITATION OF ARLC MOTIONS

Analogously to (4.16), the least squares estimate xk of x is also obtained by solving

the upper triangular equations.

The implementation of the parameter identification algorithm for the planar

model can be simplified to efficiently obtain the estimates and avoid numerical prob-

lems. Since the translational motion takes place in the x-y plane and all rotational

motions are about the z-axis, the number of unknown inertial parameters reduces to

4 and the vectors and matrices in the linear equation (4.12) are redefined as:

y = −

[v0 + ω0 × (pn − r0) +∑n

j=1 (kj × (pn − pj)) φj

]xy

∆qz

∈ IR3×1

A =

u2×1

[ω0

IRn +∑n

j=1 kjφjIRn

]2×2

02×1

0[∆(uIRn)

]1×2

∆ωnz

∈ IR3×4; and x =

1/mn

nanxnany

I33

∈ IR4×1

The above simplified formulas are employed for the planar test cases presented in the

simulation study Section of this Chapter.

4.3 Persistent Excitation of ARLC Motions

In the previous Section, the identification problem for the inertial parameters

of the target was formulated. As is well known, convergence of the identification

algorithm to accurate parameter values can only be guaranteed if the input motion of

the arm is sufficiently or persistently exciting [78]. The issue of persistent excitation of

input trajectories for a robotic manipulator has been tackled extensively in the context

of robot dynamics identification [78–80]. In the dynamics identification of ground-

based manipulator problem, the objective is to determine the inertial parameters of

every link of the arm as well as the payload, and hence the problem addressed here

can be viewed as a special case of this more general problem. The complexity of

finding the persistently exciting trajectories for the manipulator to allow complete

75

Page 98: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 4. ADAPTIVE REACTIONLESS CONTROL FOR PARAMETER IDENTIFICATION

identification of all inertial parameters of the robot links has been acknowledged

[78, 81]. This same issue for inertial parameter estimation of the captured object

with a space manipulator is discussed in [56] and [58] where the trajectories are

chosen intuitively.

A commonly used measure of persistent excitation is the condition number of the

normalized global regression matrix [79], which is formed by assembling the regression

matrices at the individual time steps over the whole maneuver. Thus, in our case, the

global regression matrix is A(k) defined in Section 4.2. The condition number measure

is employed in Section 4.4 in order to demonstrate that the trajectories generated with

the ARLC scheme are indeed persistently exciting.

4.4 Simulation Study

In this Section, the verification of the ARLC with momentum-based parameter

identification is presented by using two servicing spacecraft, the planar and 3D mod-

els, presented in Section 3.3. Our primary objective here is identification of inertial

parameters of the target tested for the scenario of capturing an unknown tumbling

target with initial angular momentum Lt 6= 0. Recall that the objective of minimiz-

ing the disturbance to the base with ARLC was already verified with the simulation

results presented in Section 3.3. Now, the momentum-based parameter identification

method is executed in parallel with ARLC scheme after the capture is established.

4.4.1 Planar Test Case. The same simulation setup for testing the planar

base-3-DOF manipulator capturing a spinning unknown target with Lt 6= 0 is em-

ployed here for the implementation of momentum-based identification algorithm. The

target is realistically captured by the manipulator with the incorporation of impact.

After the impact, the target is assumed to be firmly held by the gripper mechanism

as illustrated in Fig. 2.4A. The momentum-based identification algorithm is derived

based on the assumption that the target is rigidized to the end-effector immediately

after capture. However, in practice, this does not happen as it takes a certain time af-

ter impact to rigidize the connection between the gripper and grapple fixture. In our

76

Page 99: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

4.4 SIMULATION STUDY

simulations, where the simple gripper mechanism and the grapple fixture are modeled

on the end-effector and the target respectively (see Fig. 2.4A), small sliding motion

still occurs between the end-effector and the target after the capture is established.

This will delay the convergence of the identification algorithm. With the same con-

ditions as stated in subsection 3.3.1 for the scenario Lt 6= 0, the momentum-based

identification simulation results for three different targets with small, medium and

large mass, and the inertial properties indicated in Table 3.1, are presented in the

following.

1) Medium target, mt = 250 kg

The implementation of the ARLC for inertial parameter identification when the

space manipulator grasps a spinning unknown target of intermediate weight (relative

to the base), mt = 250 kg, is presented. The motions generated by ARLC to minimize

the disturbance on the base attitude (see results in Fig. 3.10 and 3.11) provide the

measurements required for solving the parameter identification problem stated in

equation (4.11). In particular, with the ARLC trajectory, the condition number of

the normalized global regression matrix for this case is 18.5 which is very low, thus,

promising a good quality of estimation. The corresponding estimation results are

displayed in Fig. 4.2 where the dot-dashed lines indicate the real values. It is noted

that these values correspond to the properties of the last link including the target. It

can be seen that approximately 110 seconds after capture, the parameter estimates

for mn, nan, and I33, converge to their real values.

2) Large and small targets, mt = 500 kg and mt = 125 kg

To demonstrate the capability of momentum-based estimation for a range of

targets, estimation results for a large target (mt = 500 kg) and a small target (mt =

125 kg) are presented in Figs. 4.3, 4.4 and 4.5. These estimation results were obtained

with the ARLC motion shown in Figs. 3.16 and 3.17. Similarly to the capability of

ARLC in keeping the attitude of the base unchanged for different size targets, it is

apparent that the momentum-based identification scheme is also able to handle a wide

range of target masses. It is noted that convergence of the estimates is somewhat

77

Page 100: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 4. ADAPTIVE REACTIONLESS CONTROL FOR PARAMETER IDENTIFICATION

0 50 100 150 200−100

−50

0

50

100

150

200

250

300

Time [s]

Est

imat

ion

of th

e m

ass

[kg]

0 50 100 150 200−1

0

1

2

nanx

0 50 100 150 200−1

−0.5

0

0.5

Time [s]Est

imat

ion

of th

e po

sitio

n of

the

mas

s ce

nter

[m]

nany

0 50 100 150 200−5

0

5

10

15

20

25

Time [s]

Est

imat

ion

of I 33

[kgm

2 ]

Figure 4.2. Estimation of medium target, mt = 250 kg

78

Page 101: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

4.4 SIMULATION STUDY

0 50 100 150 200−100

0

100

200

300

400

500

Time [s]

Est

imat

ion

of th

e m

ass

[kg]

Target 3

Target 1

Figure 4.3. Estimation of target mass, mt = 500 kg (Target 1) and mt =125 kg (Target 3)

faster for the larger target, which is also corroborated by the condition number of the

regression matrix: 13.36 and 20.05 for targets 1 and 3, respectively.

The simulation results presented in this section demonstrate the important role

of the proposed ARLC scheme in the post-capture mission. Indeed, the availability of

inertial parameters for the whole base-manipulator-target system facilitates the post-

capture stabilization task, since precise knowledge of space manipulator dynamics is

necessary for many model-based control algorithms, such as trajectory control [28],

optimal control [15] or distributed momentum control [45].

4.4.2 3D Test Case. In this subsection, the proposed parameter identifica-

tion scheme is verified with a general 3D model with the 7-DOF manipulator based

on the model of ETS-VII system. Under the same assumptions and simulation setup

as stated in Section 3.3.2, the momentum-based parameter identification algorithm

begins execution immediately after the capture impulse is applied to the end-effector.

It is noted that the target is attached rigidly to the last link at the same instant, that

79

Page 102: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 4. ADAPTIVE REACTIONLESS CONTROL FOR PARAMETER IDENTIFICATION

0 50 100 150 200−10

−5

0

5

10

15

20

25

30

35

Time [s]

Est

imat

ion

of I 33

[kgm

2 ]

Target 1

Target 3

Figure 4.4. Estimation of I33, mt = 500 kg and mt = 125 kg

0 50 100 150 200−1

0

1

Est

imat

ion

of th

e po

sitio

n of

the

mas

s ce

nter

[m]

nanx

0 50 100 150 200−1

−0.5

0

0.5

Time [s]

nany

Target 1 (500kg)Target 3 (125kg)

Target 1

Target 1

Target 3

Target 3

Figure 4.5. Estimation of position of the center of mass, mt = 500 kg andmt = 125 kg

80

Page 103: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

4.4 SIMULATION STUDY

0 20 40 60 80 1000

100

200

300

400

500

600

700

Time [s]

Est

imat

ion

of th

e m

ass

[kg]

Figure 4.6. Estimation of target mass, mt = 500 kg, 3D case

is, the impact is not modeled. The target properties are incorporated in the last link

and this results in the change of the inertial parameters of the last link as indicated

in Table 3.2 (Link7 + Target). The estimation results for the mass, position of the

center of mass and diagonal components of the inertia tensor (products of inertia

of the target are set to zero for this test case) are presented in Figs. 4.6, 4.7 and

4.8, respectively. These results confirm that the objectives of the proposed control

scheme are also achieved for the non-planar manipulator model. The parameters con-

verge to their real values after ≈ 50 sec. Because the 3D simulation test case does

not model the actual capture and the associated impact between the target and the

end-effector, the rigidization of the target to the last link occurs instantaneously and

the convergence rate of the estimation procedure is faster than what is observed in

the 2D test case. In the planar simulation examples, modelling of the actual impact

initially incurs a relative motion between the target and the last link which results in

a slower convergence of parameter estimation.

81

Page 104: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 4. ADAPTIVE REACTIONLESS CONTROL FOR PARAMETER IDENTIFICATION

0 20 40 60 80 1000

0.5

nanx

0 20 40 60 80 100−0.4−0.2

00.2

Est

imat

ion

of th

e po

sitio

n of

cen

ter

of m

ass

[m]

nany

0 20 40 60 80 100−0.2

0

0.2

0.4

Time [s]

nanz

Figure 4.7. Estimation of position of the center of mass, mt = 500 kg, 3D case

0 20 40 60 80 1000

204060

Ixx

0 20 40 60 80 1000

204060

Est

imat

ion

of in

ertia

tens

or [

kgm

2 ]

Iyy

0 20 40 60 80 1000

204060

Time [s]

Izz

Figure 4.8. Estimation of moment of inertia, mt = 500 kg, 3D case

82

Page 105: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

4.5 SUMMARY

4.5 Summary

The results obtained in this Chapter show the relevance and utility of the pro-

posed adaptive reactionless control scheme to the post-capture stabilization. The

ARLC is effective in generating arm joint rates which produce minimum disturbance

to the base, thus eliminating the need for operation of the attitude control system,

while providing a certain buffer in time to allow for target’s properties estimation.

This is supported with the numerical results presented in this Chapter showing the

quality of the inertial parameter estimates obtained. With the combination of ARLC

and momentum-based parameter identification approach, two relevant problems of

post-capture control of space manipulator are addressed simultaneously. However,

the reactionless manipulation under ARLC as presented in Chapter 3 will inevitably

result in the arm reaching and exceeding practical joint limits after a certain time. In

the next Chapter, the ARLC will be reformulated in order to avoid the joint limit con-

straints of the arm by using the redundancy resolution control scheme for redundant

manipulators.

83

Page 106: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative
Page 107: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 5. ADAPTIVE REACTIONLESS CONTROL WITH JOINT-LIMIT AVOIDANCE

CHAPTER 5

Adaptive Reactionless Control with

Joint-Limit Avoidance

In this Chapter, the previously developed adaptive reactionless control algorithm is

extended to minimize the disturbance transferred to the base with consideration of

joint limit constraints. Avoiding the joint limits is necessary for a practical imple-

mentation of the proposed ARLC scheme on space manipulators, as otherwise the

space manipulator may reach physical joint limits when executing the ARLC motion

after capturing an unknown tumbling target. Moreover, if the joint limit constraints

are not explicitly taken into account and the ARLC motion violates these constraints,

a significant base disturbance may result.

In literature, local optimization methods are widely used to address the manipu-

lator control problem with more than one manipulation task [82]. These approaches

require the manipulator arm to be kinematically redundant, i.e., the manipulator has

to be designed with non-zero degree-of-redundancy. As previously mentioned, the

free-floating space manipulators are designed to be kinematically redundant for flex-

ibility and versatility. For instance, the ETS-VII and Dextre arms, the latter known

as the Special Purpose Dextrous Manipulator of the ISS servicing system, are both

redundant manipulators. In this Chapter, the redundancy of space manipulators is

85

Page 108: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 5. ADAPTIVE REACTIONLESS CONTROL WITH JOINT-LIMIT AVOIDANCE

exploited to address the joint-limit avoidance issue. In particular, redundancy res-

olution through local optimization using the gradient projection method [40, 83] is

formulated within the ARLC scheme with the primary task to maintain minimum

angular disturbance to the base, without the use of attitude control devices, and the

secondary task to avoid the physical joint limits. In the following, the ARLC is refor-

mulated in a suitable form to apply a redundancy resolution technique for joint-limit

avoidance. Then, the implementation of the gradient projection method within the

ARLC scheme is presented. To verify the validity and feasibility of the proposed al-

gorithm, the same simulation platform as presented in previous Chapters is employed

to obtain the numerical results for a planar base-manipulator-target model as well as

the three-dimensional model of ETS-VII servicing satellite.

5.1 Formulation of ARLC for Joint-Limit Avoidance

In this Section, the ARLC scheme is reformulated in order to incorporate a local

optimization technique to satisfy a secondary task. In particular, two specific tasks

are tackled with the proposed control scheme. The primary task is to update the

reactionless motion of the manipulator in an online manner, under the conditions of

changing inertial parameters of the arm resulting from target capture. The secondary

task is to ensure that the joint limit constraints are satisfied while executing the ARLC

motion.

Under the same conditions as stated in the derivation of ARLC (see Section 3.1),

the angular momentum of a space manipulator after capturing a tumbling target with

an initial angular momentum Lt can be rewritten as follows:

Hωω0 + Hωφφ = Lm + Lt = L (5.1)

The reactionless motion for the manipulator to produce zero attitude disturbance to

the base can be computed from equation (5.1) as:

φr = H+ωφL +

[E−H+

ωφHωφ

]ζ1 (5.2)

86

Page 109: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

5.1 FORMULATION OF ARLC FOR JOINT-LIMIT AVOIDANCE

where ζ1 ∈ IRn is an arbitrary vector. However, in the presence of disturbances on the

base, the manipulator motion will be governed by (5.1) with nonzero ω0, the general

solution of which for the joint rates can be written as:

φ = H+ωφ (L−Hωω0) +

[E−H+

ωφHωφ

]ζ2 (5.3)

with ζ2 ∈ IRn an arbitrary vector. The difference between the general and the

reactionless joint rates can be obtained by subtracting (5.3) from (5.2) to yield:

φr − φ = H+ωφHωω0 +

[E−H+

ωφHωφ

]ζ (5.4)

where ζ = ζ1 − ζ2 ∈ IRn is an arbitrary vector; the matrix[E−H+

ωφHωφ

]is a

projection operator, which projects an arbitrary vector ζ ∈ IRn onto the null-space

of Hωφ. The motion generated by the second term on the right hand side of equation

(5.4) does not cause any rotational motion of the base. Since the matrix Hω is always

invertible and assuming Hωφ has a full row rank, (5.4) can be rewritten as follows:

φr − φ =[H−1ω Hωφ

]+ω0 +

E−

[H−1ω Hωφ

]+ [H−1ω Hωφ

]ζ (5.5)

or more succinctly,

φr − φ = Kω0 +[E−KK+

]ζ (5.6)

where the matrix K is the same as defined in Chapter 3, repeated here for quick

reference:

K = H+ωφHω

Equation (5.6) is now in the standard redundancy resolution form where the

secondary task can be implemented by defining ζ ∈ IRn as a gradient of a function

to be optimized [40, 84]. Hence, this equation is the foundation of the ARLC control

scheme with joint-limit avoidance. The left hand side of this equation can be viewed

as the deviation from the reactionless motion, the primary manipulation task, or its

perturbation. In this study, the conventional gradient projection method originally

87

Page 110: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 5. ADAPTIVE REACTIONLESS CONTROL WITH JOINT-LIMIT AVOIDANCE

proposed by Liegeois [83] is implemented for avoiding the joint limits, and will be

presented in the next Section.

Since the target capture changes the inertia properties of the arm in a priori

unknown way, we redefine the reference joint rates φr in equation (5.6) as follows:

ˆφr − φ = Kω0 +

[E− KK+

]ζ (5.7)

where recall φ and ω0 represent the actual joint rates and base angular velocity. As

before, the notation . is employed to denote the unknown post-capture vector and

matrices, which incorporate the properties of the target. Similarly to the procedure

presented in Chapter 3, the well-known recursive least squares parameter adaptation

algorithm [70] is used to update the time-varying matrix K(t). However, with the

view to implementing the gradient projection approach for joint-limit avoidance, the

prediction error e is now defined as:

e(t) = ˆφr(t− 1)− φ(t)− K(t− 1)ω0(t)−

[E− K(t− 1)K+(t− 1)

]ζ(t) (5.8)

As per [69], the RLS algorithm to compute the updates for K(t) takes the fol-

lowing form, using the current (measured) joint rates and base angular velocity:

K(t) = K(t− 1) +

ˆφr(t− 1)− φ(t)− K(t− 1)ω0(t)

−[E− K(t− 1)K(t− 1)+

]ζ(t)

N(t) (5.9)

where

N(t) =ω0(t)TQ(t− 1)

λ+ ω0(t)TQ(t− 1)ω0(t)(5.10)

Q(t) =1

λ

[Q(t− 1)− Q(t− 1)ω0(t)ω0(t)TQ(t− 1)

λ+ ω0(t)TQ(t− 1)ω0(t)

](5.11)

In the above, the initial guess values as well as the implementation of covariance

resetting algorithm to estimate the time-varying matrix K(t) are provided in detail

in Chapter 3 (see Section 3.2). Then, the reactionless joint rate update is adaptively

88

Page 111: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

5.2 ARLC WITH JOINT-LIMIT AVOIDANCE

computed based on the current estimate K(t) as:

ˆφr(t) = φ(t) + K(t)ω0(t) +

[E− K(t)K(t)+

]ζ(t) (5.12)

The above signal represents the commanded/desired input to the joint control law.

It was previously noted that the development of the ARLC scheme in Chapter

3 is based on the assumption that the space manipulator system is kinematically re-

dundant with respect to the base task space (attitude degrees of freedom). However,

with the reactionless joint rates calculated from (5.12) with an arbitrary ζ, some joints

may be driven to their physical limits thus reducing the degree of redundancy in the

whole system. Therefore, the ARLC motion may fail to maintain the base attitude

unchanged, unless there is an explicit joint-limit avoidance criterion incorporated in

the control. From a practical standpoint, the implementation of the proposed adap-

tive reactionless control scheme on a space manipulator requires that the problem of

joint-limit avoidance be addressed. In literature, a motion planning algorithm for a

free-flying manipulator considering the joint limit constraints was presented in [53].

However, the optimization problem with inequality constraints was formulated based

on perfect knowledge of the robot system, unlike the situation treated here. Joint lim-

its violation is also an issue with the conventional adaptive control techniques [35, 52]

where the adaptive scheme is not formulated for utilizing the redundancy resolution

control. According to the reformulated ARLC joint reference motion equation (5.12),

the implementation of a redundancy resolution technique to minimize a desired per-

formance index is feasible [51]. In the next Section, the gradient projection method

(GPM) is employed within the ARLC scheme for utilizing the redundancy of the arm

to avoid its physical joint limits.

5.2 ARLC with Joint-Limit Avoidance

5.2.1 Redundancy resolution. In literature on kinematic control of re-

dundant manipulators, redundancy has been widely utilized to avoid joint limits,

89

Page 112: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 5. ADAPTIVE REACTIONLESS CONTROL WITH JOINT-LIMIT AVOIDANCE

singularities, and obstacles, while tracking the desired primary task such as end-

effector trajectory. There are two fundamental approaches to a redundancy utilization

problem: local optimization and global optimization [82]. Since the latter requires

knowledge of the complete trajectory information in advance and is computationally

costly, it is not well suited for tasks requiring on-line real-time implementation. On

the other hand, although the local optimization method does not guarantee global

optimality, its computation cost is inexpensive and suitable for most real-time appli-

cations [40]. In this Section, the gradient projection method [83] is utilized to satisfy

the joint limit constraints while simultaneously maintaining the minimum reaction

disturbance transmitted to the base after capturing an unknown tumbling target.

The gradient projection method has been widely used in literature because a

variety of performance criteria can be easily incorporated into the control scheme

with this approach [82]. The performance criterion for avoiding joint limits is defined

as a smooth potential function of joint angles and their limits, p(φ), which is to be

optimized. According to [40], the “joint limit” potential function can be defined as:

p(φ) =n∑i=1

1

(φ2imax − φ2

i )(5.13)

where φimax > 0 is the mechanical limit of the ith joint, i.e., the corresponding joint

limit constraint is |φi| ≤ φimax. As per equation (5.13), p(φ) is a scalar function

dependent on the manipulator configuration; it represents a penalty function on the

joint limits by returning high weights for the joints approaching their limits and going

to infinity at their bounds. Then, to satisfy the secondary task, the arbitrary vector

ζ ∈ IRn in equation (5.6) can be defined as the gradient of the joint limit function at

φ as follows:

ζ = −k ∂p∂φ

= −k

2φ1

(φ21max−φ21)2

2φ2(φ22max−φ22)2

...

2φn(φ2nmax−φ2n)2

(5.14)

90

Page 113: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

5.2 ARLC WITH JOINT-LIMIT AVOIDANCE

where k is a user-defined positive constant. From the above, the reactionless motion

necessary to optimize the performance criterion can be obtained by projecting the

gradient of the performance criterion onto the null-space of matrix Hωφ.

5.2.2 Integration with ARLC scheme. In the context of adaptive re-

actionless control scheme where the matrix K is recursively updated based on the

observed performance, the concept of using the null-space of the approximate matrix

to minimize a performance index as mentioned in [51] is implemented in the form of

(5.7).

The proposed ARLC scheme with joint-limit avoidance requires measurements

of the current joint rates φ(t) and the corresponding base angular velocity ω0(t).

Also, the current joint angles φ(t) are needed for computing the potential function

gradient in (5.14). Since the main task of the proposed control scheme is to generate

the reactionless maneuver for the manipulator without using the momentum exchange

devices, it is not necessary for the manipulator to follow a specific desired trajectory.

Hence, the manipulator reactionless joint rates can be initialized as per (2.34) by

using the known pre-capture parameters and the ARLC algorithm is triggered at

the instant of capture. The schematic of the complete algorithm with joint-limit

avoidance is included in Fig. 5.1 and the main steps are summarized below:

Step1: Initialization (based on pre-capture parameters of the manipulator)

φr(0) = H+ωφLm +

[E−H+

ωφHωφ

t = ∆t

Step2: Measure (or simulate) φ(t) and ω0(t).

Step3: Compute ζ from (5.14).

Step4: Compute K(t) from (5.9) with (5.10) and (5.11).

Step5: Using K(t), update the desired motion from (5.12).

Step6: t← t+ ∆t;

Return to step 2 until finish

91

Page 114: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 5. ADAPTIVE REACTIONLESS CONTROL WITH JOINT-LIMIT AVOIDANCE

Parameter Adaptation Algorithm

Space ManipulatorPlant )(ˆˆ

ˆˆ0r

t(t)(t)

(t)(t)(t)(t)

ζKKE

ωK

tK

];;[ 0 ωPD Velocity-based Controller

Inner Loop

Outer LoopT

pkt

)(ζ

Figure 5.1. Adaptive reactionless control scheme with joint-limit avoidance

Table 5.1. Joint limit constraints for 7-DOF and 3-DOF manipulators

Joint # 1 2 3 4 5 6 7φimax [deg] 3-DOF 90 140 140φimax [deg] 7-DOF 180 90 90 120 120 90 120

5.3 Simulation Study

Before presenting the verification of the ARLC with joint-limit avoidance, we first

demonstrate the violation of joint limit constraints while executing the ARLC without

joint-limit avoidance. Similarly to the planar test case presented in Section 3.3.1,

simulations are conducted with the initial angular momentum of the target Lt 6= 0

and consideration of the impact between the capture mechanism and target. In this

scenario, the space manipulator grasps a spinning unknown target of intermediate

weight, mt = 250 kg. All simulation parameters are the same as those used in

Chapter 3 and the joint limits for the 3-DOF manipulator are stated in Table 5.1.

The value of constant k was set to 0.0005 for planar test simulations and 0.001 for

3D model test case for ARLC with joint-limit avoidance. Results for joint angle and

base time histories response for ARLC without joint limits are shown in Fig. 5.2 from

which we observe that the ARLC motion violates the joint limits while maintaining

minimum disturbance to the base.

92

Page 115: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

5.3 SIMULATION STUDY

0 50 100 150 200−200

−100

0

100

200

300

400

Time [s]

Join

t ang

les

[deg

]

Joint 1

Joint 2

Joint 3

Joint 1 Limit

Joint 2 and 3 Limit

0 50 100 150 200−8

−6

−4

−2

0

2

4

6x 10

−5

Time [s]

Bas

e an

gula

r ve

loci

ty [r

ad/s

]

Figure 5.2. ARLC motion without joint-limit avoidance, Lt 6= 0, mt = 250 kg

5.3.1 2D Test Case.

5.3.1.1 Medium target, mt = 250 kg. The ARLC with joint-limit avoidance is

applied to the same test case scenario as described above. The primary task of the

proposed control scheme is verified through the simulated response of the base and

joint rates shown in Fig. 5.3. The impact between the manipulator and the target

is reflected in the abrupt changes in the motion profiles at t = 4 sec. Figure 5.4A

shows the joint angles of ARLC with joint-limit avoidance to demonstrate that the

secondary task of the proposed control scheme is completely satisfied. The potential

function p is presented in Fig. 5.4B. Similarly to the simulation results presented in

[83] demonstrating the use of task-priority for joint-limit avoidance, it is seen that

the potential function is forced to decrease whenever the joints approach their limits

(different joints at different times). In Fig. 5.5, the angular momentum distribution

between the target and the arm is illustrated, as well as conservation of the total

angular momentum of the system, Lm + Lt, at the value equal to the target’s pre-

capture angular momentum. From these results we observe that the ARLC algorithm

is able to maintain the base attitude nearly unchanged and avoid the joint limits

by updating the reactionless joint rates according to the base disturbance and the

arm configuration, after capturing the unknown spinning target. However, we also

observe that the enforcement of joint limit constraints does compromise somewhat

93

Page 116: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 5. ADAPTIVE REACTIONLESS CONTROL WITH JOINT-LIMIT AVOIDANCE

0 50 100 150 200−0.3

−0.2

−0.1

0

0.1

0.2

0.3

Time [s]

Join

t rat

es [r

ad/s

]

Joint 1Joint 2Joint 3

0 50 100 150 200−5

0

5x 10

−4

Time [s]

Bas

e an

gula

r ve

loci

ty [r

ad/s

]

Figure 5.3. ARLC motion with joint-limit avoidance, Lt 6= 0, mt = 250 kg

the primary task. In fact, comparing the results in Figs. 3.10 and 3.11 with the

results in Fig. 5.3, it is apparent that the performance of the ARLC with joint limits

is worse as evidenced by the larger in magnitude spikes in the base response (O(10−5)

vs. O(10−4)), especially when the joints approach their limits. By comparing the

joint rates profiles, we can see that the spikes observed in the base response while

executing ARLC with joint-limit avoidance result from high variation of the joint

rates commanded.

5.3.1.2 Large and small targets, mt = 500 kg and mt = 125 kg. The proposed

control scheme is also tested with Target1 (500 kg) and Target3 (125 kg) to verify its

capability in dealing with the wide range of target masses. The joint rates, response

of the base and joint angles of the ARLC motion with joint-limit avoidance after

capturing Target1 and Target3 are shown in Figs. 5.6 and 5.7, respectively. These

results demonstrate that the two specific tasks of the proposed adaptive control are

also achieved with different target masses. Note that the same constant coefficient k

is used for computing ζ from (5.14) in the three planar test cases. Again, the com-

promise between the base disturbance and violating the joint limits can be observed

in the test cases with Target1 (comparing base angular velocity response in Fig. 5.6

vs. Fig. 3.16) and Target3 (comparing base angular velocity response in Fig. 5.7 vs.

Fig. 3.17).

94

Page 117: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

5.3 SIMULATION STUDY

0 50 100 150 200−150

−100

−50

0

50

100

150

Time [s]

Join

t ang

les

[deg

]

Joint 1Joint 2Joint 3Joint 2 and 3 Limit

Joint 1 Limit

(A)

0 50 100 150 2000.8

1

1.2

1.4

1.6

1.8

2

Time [s]

Pot

entia

l fun

ctio

n [r

ad−2 ]

(B)

Figure 5.4. Joint angles and potential function for 2D case, Lt 6= 0, mt = 250kg

95

Page 118: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 5. ADAPTIVE REACTIONLESS CONTROL WITH JOINT-LIMIT AVOIDANCE

0 20 40 60 80 100 120 140 160 180 200

−2

−1

0

1

2

3

4

5

Time [s]

The

rel

atio

nshi

p be

twee

n L

m a

nd L

t [kgm

2 /s]

Lt

Lm

Lt+L

m

Figure 5.5. Momentum exchange between Lt and Lm, mt = 250 kg

5.3.2 3D Test Case. In this subsection, the proposed control algorithm

is tested for the general 3D model by simulating the capture of a tumbling target

with the 7-DOF manipulator (see Table 3.2). The joint limit constraints of the

manipulator are summarized in Table 5.1.1 As in the previous simulations, we assume

that the target is attached rigidly to the last link after capture and its tumbling

motion is emulated with an external impulse torque of 15 Nm applied to the end-

effector about the three axes for the duration of 0.2 seconds. As can be seen from

Fig. 5.8, this creates an initial angular disturbance on the base. This disturbance,

however, is successfully reduced with the ARLC motion presented in Fig. 5.9. As well,

satisfaction of the joint limit constraints is illustrated in Fig. 5.10. The compromise

in satisfying two manipulation tasks is not obvious in the 3D test case: comparison

of Fig. 5.8 and Fig. 3.18 does not show significant differences in the base response.

This is because the joints do not approach their limits closely, and not at the same

time in this test case, unlike was the case for the planar tests.

1Since information on the real joint limit constraints of ETS-VII is not available in public domain,these constraints are made up for the purpose of this study.

96

Page 119: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

5.3 SIMULATION STUDY

0 50 100 150 200

−0.3

−0.2

−0.1

0

0.1

0.2

0.3

0.4

Time [s]

Join

t rat

es [r

ad/s

]

Joint 1Joint 2Joint 3

0 50 100 150 200−1.5

−1

−0.5

0

0.5

1

1.5x 10

−3

Time [s]

Bas

e an

gula

r ve

loci

ty [r

ad/s

]

0 50 100 150 200−150

−100

−50

0

50

100

150

Time [s]

Join

t ang

les

[deg

]

Joint 1

Joint 2

Joint 3

Joint 1 Limit Joint 2 and 3 Limit

Figure 5.6. ARLC motion with joint-limit avoidance, Lt 6= 0, mt = 500 kg

97

Page 120: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 5. ADAPTIVE REACTIONLESS CONTROL WITH JOINT-LIMIT AVOIDANCE

0 50 100 150 200−0.2

−0.15

−0.1

−0.05

0

0.05

0.1

0.15

0.2

Time [s]

Join

t rat

es [r

ad/s

]

Joint 1Joint 2Joint 3

0 50 100 150 200−3

−2

−1

0

1

2

3

4x 10

−4

Time [s]

Bas

e an

gula

r ve

loci

ty [r

ad/s

]

0 50 100 150 200−150

−100

−50

0

50

100

150

Time [s]

Join

t ang

les

[deg

]

Joint 1

Joint 2

Joint 3

Joint 1 Limit Joint 2 and 3 Limit

Figure 5.7. ARLC motion with joint-limit avoidance, Lt 6= 0, mt = 125 kg

98

Page 121: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

5.4 SUMMARY

0 20 40 60 80 100−8

−6

−4

−2

0

2

4

6x 10

−4

Time [s]

Bas

e an

gula

r ve

loci

ty [r

ad/s

]

ωx

ωy

ωz

Figure 5.8. Base angular velocity, 3D test case, Lt 6= 0, mt = 500kg

5.4 Summary

The proposed adaptive reactionless control algorithm is reformulated in this

Chapter for implementing kinematic redundancy resolution through a local optimiza-

tion method. Specifically, the gradient projection method is employed to avoid the

physical joint limits while executing the reactionless motion in the post-capture sce-

nario. Simulation results show that two specific tasks, minimizing disturbance on

the base and avoiding joint limits, are satisfied. Although the standard gradient pro-

jection method has been implemented within the ARLC scheme to avoid the joint

limits, these results also demonstrate the possibility of utilizing a redundancy reso-

lution technique within the ARLC to satisfy a general secondary manipulation task.

This feature is significant in controlling a free-floating space manipulator especially

for the post-capture and stabilization missions.

99

Page 122: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 5. ADAPTIVE REACTIONLESS CONTROL WITH JOINT-LIMIT AVOIDANCE

0 20 40 60 80 100−0.08

−0.06

−0.04

−0.02

0

0.02

0.04

0.06

Time [s]

Join

t rat

es [r

ad/s

]

Joint 1Joint 2Joint 3

0 20 40 60 80 100−0.1

−0.05

0

0.05

0.1

Time [s]

Join

t rat

es [r

ad/s

]

Joint 4Joint 5Joint 6Joint 7

Figure 5.9. Joint rates, 3D test case, mt = 500 kg

100

Page 123: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

5.4 SUMMARY

0 20 40 60 80 100

−3

−2

−1

0

1

2

3

Time [s]

Join

t ang

les

[rad

]

Joint 1Joint 2Joint 3Joint 1 limit

Joint 2 and 3 limit

0 20 40 60 80 100

−2

−1.5

−1

−0.5

0

0.5

1

1.5

2

Time [s]

Join

t ang

les

[rad

]

Joint 4Joint 5Joint 6Joint 7

Joint 4,5 and 7 limit

Joint 6 limit

Figure 5.10. Joint angles, 3D test case, mt = 500 kg

101

Page 124: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative
Page 125: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 6. ANALYSIS AND PRELIMINARY DESIGN OF EXPERIMENTAL TEST-BED

CHAPTER 6

Analysis and Preliminary Design of

Experimental Test-bed

In this Chapter, the development of a free-floating test-bed for testing autonomous

capture algorithms is presented. Truthful emulation of free-floating conditions of

space here on Earth is one of the main challenges for space systems researchers and

engineers around the world. To date, a number of methods to simulate the zero-

gravity condition in space have been proposed [65], including the air-bearing planar

systems, suspension systems, parabolic flight and under water environment. All these

methods have associated advantages and disadvantages depending on the specific

testing purposes. As well, for testing the pre-capture phase of the capture mission,

some researchers have used two robotic arms, where one arm moves a satellite mockup

according to its orbital dynamics and the other is used to simulate the approach and

capture of the mockup satellite [85]. This test-bed works under the assumption that

the base attitude is controlled perfectly; as well, the coupling motion of the arm and

the base can not be simulated. Validation of autonomous capture algorithms for a

free-floating manipulator with consideration of disturbances on the base generated

by the arm motion and capture of a tumbling target is difficult, in particular for a

3D scenario. In addition to gravity compensation, the test-bed must be designed to

allow the arm and the base to move freely in any direction. Moreover, the movement

103

Page 126: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 6. ANALYSIS AND PRELIMINARY DESIGN OF EXPERIMENTAL TEST-BED

of the base, arm and the disturbance of the arm motion onto the base have to be

measurable and trackable.

A well-known approach to laboratory testing of planar motion of space robotic

systems in micro-gravity is by using the air-bearing table to support the equipment

to be tested; this approach has been used to validate hardware and control algorithms

for space manipulator systems for several decades. In the academic community, the

first air-bearing table equipped with a manipulator arm was developed at the Stanford

Aerospace Robotics Laboratory (ARL) for research on semi-autonomous construction

in space [86]. Similarly to the Stanford ARL test-bed, researchers at the Tokyo In-

stitute of Technology built the Experimental Free-Floating Robot Satellite Simulator

(EFFORTS) [87]. This facility was used to verify a number of control algorithms such

as the resolved rate motion control using GJM and payload inertial parameter identi-

fication algorithms [56]. With the same principle, the dual-arm manipulator test-bed

with significant link and joint flexibility developed at the University of Victoria was

used for many years to study dynamics and control of flexible and macro-micro ma-

nipulators [88]. The aforementioned test-beds were designed with the granite or glass

surface to support the manipulator/satellite equipment, the particular surfaces cho-

sen in order to minimize frictional effects. The base and manipulator are floated on

the surface by a cushion of air supplied at particular points on the main components

of the system.

In the following, we present the analysis and preliminary design of a free-floating

space manipulator test-bed that could be used to validate the algorithms developed

in this dissertation, as well as other methodologies relevant to on-orbit servicing. The

particular design was motivated by the existing facility, hardware, as well as technical

and scientific expertise available at the Canadian Space Agency, combined with the

knowledge base of researchers in the Aerospace Mechatronics Laboratory at McGill

University. We anticipate that the proposed test-bed will be constructed and housed

at CSA and ultimately used to evaluate control techniques for the capture mission of

a spinning target with a free-floating manipulator mounted on a chaser craft.

104

Page 127: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

6.1 EXPERIMENTAL APPARATUS

Air Table

I/O card

Wireless Communication

Target satellite

Base

Pressure Control System

Magnetic Contact

Compressor

Antenna for wireless communication

Global Sensing System

Figure 6.1. Experimental apparatus

6.1 Experimental Apparatus

Figure 6.1 shows a schematic of the proposed experimental apparatus including

the supporting table, the base body with a 3-DOF arm, the target satellite, computer

control interface and sensing system. Since the objective of the designed test-bed is

to simulate the free-floating condition of a space system, a frictionless table surface

is required to minimize the external forces in a horizontal plane. In this design, the

air-table with pinholes through which high pressure air can flow, similarly to the air

hockey table concept, will be employed for creating a near frictionless surface to simu-

late the free-floating condition in space. In the following sections, we first present the

analysis and design of the base-3-DOF manipulator chaser system and target. Then,

the air-bearing table design is detailed based on the selected manipulator model. Fi-

nally, a discussion of the sensing system options and control interface is presented.

105

Page 128: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 6. ANALYSIS AND PRELIMINARY DESIGN OF EXPERIMENTAL TEST-BED

Granite Table

Free-flyingSpacecraft

Wireless Communication Attenna

Air Source Connection

25 cm

Figure 6.2. Free-flying test-bed at Canadian Space Agency

6.2 Base-3-DOF Manipulator-Target

The dimensions of the base and the arm were determined by scaling the test-

ing servicing satellite system, the ETS-VII. In that system, the mass scaling factor

between the arm and the base is:

Total mass of links

Mass of the base=

340

1000= 0.34 (6.1)

Using the above scale as a guideline, three base-manipulator models were defined as

summarized in Table 6.1, corresponding to the mass scaling factors of 0.1, 0.2 and 0.4,

approximately. The dimensioning of the facility was done by using the dimensions

of the existing free-flying satellite test-bed at CSA (see Fig. 6.2) [89] as a guideline,

while keeping the overall size of the facility reasonable. In terms of dimensions, all

three models have the same dimensions of the base and links, as shown in Fig. 6.3

and stated in Table 6.1. Model1 has the heaviest base, Model2 and Model3 have the

identical lighter base and Model3 has the heaviest links. Note that the three links of

the manipulator are assumed to be identical in dimensions and inertia, and these are

listed in Table 6.1 for a single link for each model.

Since one of the behaviors we wish to demonstrate with the experimental facility

is the disturbance created by the motion of the arm/target onto the base, the three

106

Page 129: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

6.2 BASE-3-DOF MANIPULATOR-TARGET

Table 6.1. Base-3-DOF manipulator testing models

Mass (kg) Izz (kgm2) Dimension (cm)

Base Model1 31.25 0.32 25× 25× 25

Link Model1 1.14 1.23 10−4 25

Base Model2 15.6 0.16 25× 25× 25

Link Model2 1.14 1.23 10−4 25

Base Model3 15.6 0.16 25× 25× 25

Link Model3 2.04 1.29 10−2 25

BASELink1 TargetLink2 Link3

Y

X

25 cm

25 cm

Magnetic Contact

Figure 6.3. Top view of the base-manipulator-target system

models just described were simulated in order to determine how visible and measur-

able the reaction from the arm to the base is, based on the resulting motion of the

base. For this purpose, a joint rate PD controller is implemented and the response

of the models is simulated with the desired joint rate inputs switching between the

two setpoints, −0.1 and 0.1 rad/s, as shown in Fig. 6.4A. The base angular veloc-

ity response and four configurations (snapshots) of the base-manipulator system are

shown in Figs 6.4B and 6.5, respectively, for Model1. These results illustrate that the

disturbances generated by the arm motions onto the base are visible and measurable.

Similar conclusions were reached from simulations of Model2 and Model3. Hence, all

three models are satisfactory for demonstrating the coupling effects between the base

and the arm.

6.2.1 Base design. The base with all the necessary on-board devices includ-

ing cold air tank for thruster control, possibly a reaction wheel for attitude control,

107

Page 130: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 6. ANALYSIS AND PRELIMINARY DESIGN OF EXPERIMENTAL TEST-BED

0 10 20 30 40 50−0.2

−0.15

−0.1

−0.05

0

0.05

0.1

0.15

Time [s]

Join

t rat

es [r

ad/s

]

Joint 1Joint 2Joint 3

(A)

0 10 20 30 40 50

−0.08

−0.06

−0.04

−0.02

0

0.02

0.04

0.06

Time [s]

Bas

e an

gula

r ve

loci

ty [r

ad/s

]

(B)

Figure 6.4. Joint rates profile and base response for Model1

Y

X

Y

X

Y

X

Y

Xt = 0st = 5s

t = 30s t = 45s

Figure 6.5. Four configurations of Model1 during simulated motion

motor driver boards, Inertial Measurement Unit (IMU) for attitude measurement,

and either the DAQ card or a motion control board is schematically illustrated in

Fig. 6.6. The base satellite is expected to be of similar size and design as the free-

flying spacecraft of the existing facility at CSA, shown in Fig. 6.2. Based on the

information collected to date, we anticipate the weight of the base to be in the range

of 10–20 kg, in line with Model2 and Model3 sizing. It is noted that installation of

108

Page 131: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

6.2 BASE-3-DOF MANIPULATOR-TARGET

25 cm

Motor Driver Boards

DAQ on-board card

Air tank for thruster control

Reaction Wheel

Weight: 10 - 20 kg

IMU Sensor

DAQ card is available at CSA; alternatively DAQ cards from Quanser Inc. can be considered for this application.

Model: IMU400CC-100 (Crossbow Technology, Inc.)

These would be procured with the motors purchased for the test-bed

One wheel rotating about the Z-axis (optional)

Cold-gas thrusters for base satellite attitude control (optional)

Figure 6.6. Satellite base with on-board devices

a cold air tank and a reaction wheel are not necessary for testing the control algo-

rithms put forward in this thesis for a free-floating space manipulator, but they will

be required for experiments on complete stabilization of the system.

6.2.2 Arm design. A single link of the arm, the driving motor and their inter-

connection are illustrated in Fig. 6.7. Engineers at CSA have previously constructed

a 3-DOF arm for a different project and it was decided that similar construction of

the arm would be used for this test-bed (with the same and/or similar motors and

possibly reusing the links). Based on the 3-DOF arm designed at CSA, no coupler

is required to make the motor/link interconnection. The motor stator is attached

directly to the previous (aft) link and the motor shaft is connected to the following

(fore) link. Since the joint has to be supported by the air-table, a circular pad of

8–10 cm in diameter will need to be installed at each joint to support its weight. In

addition, the magnetic contact is installed at the end-effector of the arm in order to

attach to the grapple fixture on the target.

109

Page 132: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 6. ANALYSIS AND PRELIMINARY DESIGN OF EXPERIMENTAL TEST-BED

Table 6.2. Selection of motor for manipulator joints

Model number RH-8D-6006-TE100AL

(Harmonic Drive, LLC)

Max. Continuous Torque 1.5 Nm

Max. Output Speed 100 rpm

Weight 0.39 kg

including tachometer (optional) and encoder

Encoder resolution 1000 P/rev

An important consideration is the maximum torques required to produce the

maneuvers that we wish to demonstrate with the facility. This information is required

for sizing and choosing the motors to be used on the arm. Based on the simulations

conducted with the three base-manipulator design models, it is apparent that the

torque requirements for the ARLC algorithm tend to be higher than for reasonably

slow, arbitrary motion of the arm, as for example the motions shown in Fig. 6.4A.

In particular, the joint rates and torque profiles obtained with ARLC incorporating

joint-limit avoidance algorithm for Model3 are presented in Fig. 6.8. The target in

this test case has the same mass and moment of inertia as the base (see Table 6.1) and

is spinning with the initial angular velocity of 0.1 rad/s. It is attached rigidly to the

end-effector of manipulator at 1 second so that impact is not modeled for simplicity.

According to these results, the peak torques observed under a range of conditions

for the 3 joints are below 0.15 Nm. Although the peak torques will be different for

the 3 joints, it would be more practical to use the same motors and links for the

designed arm. For this test-bed, we suggest that the joints are driven by harmonic

drive actuators from Harmonic Drive LLC, with motor specifications stated in Table

6.2. With the combination of precision harmonic drive gear and DC servo motors, the

selected RH actuator provides the precise velocity-based control required for testing

the ARLC algorithms. The joint angles are measured by encoders mounted on the

motors. Including tachometers in the motors is optional and is not necessary for the

current design.

110

Page 133: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

6.2 BASE-3-DOF MANIPULATOR-TARGET

8-10 cm

20-25 cm

Link

Link 2Link 1

Pad of 8-10 cm in contact with the air table

Motor

Motor

Motor mount

Figure 6.7. Link and motor-link interconnection

0 10 20 30 40 50−1

−0.5

0

0.5

1

1.5

Time [s]

Join

t rat

es [r

ad/s

]

Joint 1Joint 2Joint 3

(A)

0 10 20 30 40 50−0.15

−0.1

−0.05

0

0.05

0.1

Time [s]

Tor

que

Con

trol

Inpu

ts [N

m]

Joint 1Joint 2Joint 3

(B)

Figure 6.8. Joint rates and torque profiles for ARLC with joint-limit avoid-ance (Model3)

6.2.3 Target Design. The target is expected to have the same dimensions as

the base, and would be equipped with magnetic contact mechanism to attach rigidly

to the end-effector when the capture happens (see Fig. 6.3). The mass and moment

of inertia of the target must be adjustable by the user in order to allow testing of the

111

Page 134: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 6. ANALYSIS AND PRELIMINARY DESIGN OF EXPERIMENTAL TEST-BED

developed algorithms for different conditions. To generate a spinning motion for the

target, the user can manually apply a torque to the target of a specific magnitude

and direction to ensure that the magnetic contact mechanism attaches the target to

the end-effector. It is not necessary to have an IMU installed on the target because

its motion can be tracked by the global sensing system described in Section 6.4, for

the purposes of capture by manipulator.

6.3 Air-bearing Table

In our design of supporting planar surface, the key difference from the common

air-table designs employed for testing space manipulators on the ground is that the

cushion of air is generated from the table surface itself. One advantage of this ap-

proach is that it eliminates the need of an on-board air-tank, which is limited in vol-

ume, and, compared to the designs with an off-board air supply, the present method

does not suffer from potential disturbances on the base-arm resulting from the pipe

connections to the air source. Several special issues and considerations, however, as

related to the construction and operation of the air-table need to be considered, as

listed below.

Weight of system to be supported by air-table: Different loads were tested with

the free-floating satellite on the granite table available at CSA (Fig. 6.2) and the

results showed that the mockup satellite can maintain the free-floating conditions

with a very high load at the supplied pressure. As indicated in [90], the supplied

pressure of 100 psi can support payloads up to several thousand pounds (order of 104

N) with a flow rate of few cubic feet per minute (order of 10−2 m3/min).

Table sizing and construction: Determining the appropriate table size is very

important because of construction costs and available space constraints. For the

envisioned facility, assuming that the target has the same dimensions as the base, the

length of the whole system in a full straight out configuration is 125 cm. Since the base

is intended to move freely in translation and rotation, it is necessary to consider the

workspace required for possible testing maneuvers. In this preliminary design, the size

112

Page 135: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

6.3 AIR-BEARING TABLE

and the aspect ratio of the table are determined by inspecting the system’s workspace

for a series of simulations conducted with MSC.Adams for arbitrary motions of the

arm as well as for motions resulting from application of ARLC algorithm. To this end,

by using MSC.Adams in the post-processing mode, animations of arbitrary motions

of the arm and those obtained with the ARLC algorithm are setup to execute within

a wire-frame around the workspace of the system, as shown in Fig. 6.9. From these

results, the minimum frame for all simulations that have been conducted to date

with the three models, without violating the frame boundaries, was determined to

be 125×125 cm2. Allowing for a margin of error and keeping in mind other possible

future experiments with the facility, we suggest that the designed table be larger than

the minimum frame by approximately 40–50% on each side, giving a tentative size

of 175×200 cm2. Additional length along the lengthwise dimension of the base-arm-

target is suggested in order to have additional workspace to maneuver the target.

It is noted that since we expect to conduct most experiments with the initial linear

momentum of the system at zero, the mass center of the whole system will remain

nearly stationary (assuming minor frictional disturbance). Hence, a square table is

preferred.

Two options were considered for the construction of the air table of the afore-

mentioned size: (i) using a single piece (175×200 cm2) or (ii) by joining together

several smaller pin-hole pieces. Personnel at CSA have previously constructed and

tested a 30×30 cm2 air-table piece and thus using such pieces as a “tiles” for the big

table (second option) is viable. This would allow for a modular table construction

and hence easy resizing of the table if desired, but also reduce the possibility of large

pressure fluctuations which may occur for a single-piece construction, resulting in un-

even air-pad. On the other hand, it is necessary to ascertain that joining two pieces

in the “tile” approach will not compromise the air-pad quality as the load moves

over the joint between the two tiles. Another relevant issue for table construction is

the separation of the pin-holes. Preliminary testing conducted at CSA with 30×30

cm2 air-table piece showed that 2.5 cm is a reasonable separation distance of the

113

Page 136: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 6. ANALYSIS AND PRELIMINARY DESIGN OF EXPERIMENTAL TEST-BED

Base

Target

Link1

Link

2

Link3

Wire-frame

25 cm

25 cm25 cm

Figure 6.9. Animation snapshot for dimensioning air-table, 125×125 cm2

wire-frame test case

pin-holes; based on that geometry, we suggest the use of 8–10 cm in diameter pads

for supporting manipulator joints as shown in Fig. 6.7.

Initial stabilization: This issue relates to how much movement of the base-

manipulator system is likely to occur at the beginning of the experiment when the

air-table is turned on. This is a concern since one of the goals of the experiment

is to demonstrate the feasibility of reactionless motion of the arm, which, however

may be compromised if there is significant motion over the table when the arm is not

actuated. At this time, it is difficult to predict whether this effect will pose a serious

problem. That said, it was also suggested that the motion due to floatation can be

considered as an external disturbance on the system and in fact could allow us to

demonstrate the robustness of ARLC scheme.

6.4 Sensing System

The global sensing system located above the test-bed, as illustrated in Fig. 6.1,

can be used to measure the position and attitude of the base and target. The over-

head system complements the on-board sensors which are directly used by the ARLC

114

Page 137: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

6.5 COMPUTER AND CONTROL INTERFACE

controller: it provides measurements for the validation of the methodology. In addi-

tion, it can be used to track the motion of the target in order to enable its capture

by the grapple fixture (magnetic contact mechanism).

Two options for the global sensing system have been considered in this preliminary

design: a CCD camera system currently available at CSA and the stereo Bumblebee

camera. The CCD camera at CSA is a highly accurate measuring system that was

acquired and used by CSA for the active flatness control of membrane antenna pro-

totype project. In order to use this system for the present facility, some involvement

from the supplier would be required to update and modify the software interface to

the camera system. Also, the previously used update frequency of the camera is 1Hz

which is too low for the present application. The second option would involve the use

of two Bumblebee cameras: one installed over the vicinity of the base and the other

over the target.

For the purpose of testing the coupling motion control and the identification

algorithms developed in this thesis for a capture mission, it is not necessary to install

a force sensor at the end-effector of manipulator to measure the contact forces and

moments. The instant of capture can be detected either by using a switch arrangement

to detect the impact and possibly with the overhead camera as well. As already noted,

the feedback signals required for the ARLC algorithm are obtained from the IMU and

encoders for the angular velocity of the base and joint angles, respectively.

6.5 Computer and Control Interface

In this design, wireless communication between the DAQ card on board the satel-

lite base and the ground station is a viable option and already exists on the facility

at CSA. Although issues might arise with the reliability of wireless communication,

avoiding wired connection is beneficial in terms of eliminating undesirable distur-

bances on the free-floating system. Another option is to use a dedicated motion

control board mounted on the satellite base, which would allow all control computa-

tions to be done on board the system.

115

Page 138: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 6. ANALYSIS AND PRELIMINARY DESIGN OF EXPERIMENTAL TEST-BED

We expect that standard motion control method is applied and velocity control

mode is employed to control the actuators of the manipulator. The control code

will be developed and executed within the RT-Lab software from Opal-RT, already

available on the CSA’s facility.

6.6 Summary

The analysis and preliminary design of experimental test-bed for testing au-

tonomous capture missions in a plane is presented in this Chapter, taking the ex-

isting facility at CSA as a starting point. The air hockey table concept is proposed

here for emulating the free-floating conditions in space. The base satellite and the

arm are designed with sensors for closed-loop control on board the system, similar

to the real application. Two options for the global sensing system are put forward

for validation of the proposed methodologies. This design is recommended for testing

and validation of control and system identification algorithms for on-orbit servicing

missions.

116

Page 139: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

7.1 SUMMARY AND CONCLUSIONS

CHAPTER 7

Conclusions and Recommendations for

Future Research

7.1 Summary and Conclusions

The main goal of this research is to develop a control scheme for the problem

of post-capture of an unknown tumbling target by using a free-floating space ma-

nipulator. In the course of on-orbit servicing and space debris removal missions, a

priori information on the tumbling motion and inertial properties of the target to be

captured are normally unavailable. These uncertainties deteriorate the control per-

formance in the post-capture and stabilization phases, in particular, they may cause

disturbances on the base attitude which is a critical issue for free-floating space ma-

nipulator control. These considerations motivated the present research and led to the

formulation of a new adaptive reactionless control algorithm to adaptively compute

reactionless motion commands to the arm, thereby, not requiring the use of attitude

control devices to maintain the attitude of the base. The relevance of adaptive reac-

tionless motion to facilitating the stabilization phase is demonstrated by coordinating

the proposed control scheme with the momentum-based parameter identification al-

gorithm to obtain the inertial properties of the target. The combination of parameter

identification and adaptive reactionless control scheme allow for a time buffer as a

117

Page 140: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 7. CONCLUSIONS AND RECOMMENDATIONS FOR FUTURE RESEARCH

segue from the instant of capture (after impact) to the final control phases in the

capture mission.

We began this dissertation by analyzing the kinematics and dynamics of a free-

floating space manipulator. The system under investigation is subject to the con-

servation of momentum, following from the assumption that no external forces nor

torques are exerted on it. To obtain a thorough understanding of the coupling motion

between the arm and the base, which is our main concern in this research, the mo-

mentum conservation equations as well as the reaction null-space control are analyzed

in detail. These are the key ingredients in the development of adaptive reactionless

control and momentum-based parameter identification algorithms. In addition, the

momentum conservation and reaction null-space motion are used to ascertain the ac-

curacy of the co-simulation platform employed in this study. From the analysis of

energy balance of the free-floating space manipulator, we also demonstrate that the

kinetic energy that can be dissipated by the manipulator arm is limited and this value

depends on the initial momentum of the target and the arm configuration.

Based on the momentum conservation equations and inspired by the reaction

null-space control, a new control algorithm to adaptively produce the reactionless

manipulation in the presence of uncertainty is presented in Chapter 3. The proposed

Adaptive ReactionLess Control scheme plays an important role in generating the joint

motions in the post-capture phase, as it serves as an intermediate step between the

instant of capture and the final stabilization phase. Based on extensive numerical

simulations both for a planar and three-dimensional scenario, for a range of target

sizes, we conclude that the proposed ARLC scheme is viable and produces the desired

reactionless motion after capturing a target with unknown inertial properties and

unknown angular momentum. The results obtained in this study show that the

proposed algorithm is effective in generating arm joint rates which produce minimum

disturbance to the base, thus eliminating the need for using the attitude control

system.

118

Page 141: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

7.1 SUMMARY AND CONCLUSIONS

In Chapter 4, the online momentum-based parameter identification method is de-

rived to identify the inertial properties of the target without knowledge of the system

momentum, while the arm is executing adaptive reactionless motion. The relevance

and utility of this proposed scheme to the post-capture stabilization are supported

by the quality of the inertial parameter estimates obtained for a wide range of target

sizes relative to the base. The combination of ARLC and identification procedure ad-

dress two critical aspects of the post-capture control mission: maintaining minimum

disturbance on the base created by the manipulator-target motion and identifying

the target’s properties.

It has been argued in this thesis that the use of ARLC scheme can be beneficial for

the post-capture and stabilization operations since it provides a buffer in time after the

instant of capture. However, the duration of the time buffer may be very short because

the ARLC algorithm developed in Chapter 3 will fail to meet its objective if any of the

manipulator joints reach their limits during the execution of the algorithm. This issue

is addressed in Chapter 5 by reformulating the ARLC scheme to perform with the joint

limit constraints. To this end, the redundancy resolution control scheme is formulated

within ARLC in order to implement a secondary manipulation task. Although the

secondary task validated in the present thesis is joint-limit avoidance, it is possible

to satisfy other secondary tasks that are relevant to the present application, many of

which have been previously demonstrated in the literature on redundancy resolution

control for redundant ground-based manipulators. There is a compromise on the

performance of ARLC with joint-limit avoidance, although the base disturbances

observed in our simulations still remain small. We also note that it is not necessary

to have a higher degree of redundancy beyond what is already required for ARLC to

satisfy a secondary task. This is the main idea behind the task-priority resolution

techniques where the control scheme performs the primary task preferentially and the

secondary task is satisfied with the remaining degrees of freedom.

119

Page 142: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

CHAPTER 7. CONCLUSIONS AND RECOMMENDATIONS FOR FUTURE RESEARCH

The ARLC scheme derived in this dissertation is conceptually simple as it em-

ploys the certainty equivalence principle. Moreover, the desired reactionless manip-

ulation as well as the momentum-based parameter identification are computed with

the recursive least squares procedure, which is computationally very efficient. This is

particularly important for real-time implementation of the proposed control scheme

for space applications.

Finally, the analysis and preliminary design of a base-3-DOF-manipulator-target

system to be operated on an air-bearing table to simulate the free-floating condition

in two dimensions is presented in Chapter 6. This preliminary design can eventually

serve as a basis for the construction of an experimental facility recommended for

evaluating control algorithms that have been and will be developed for autonomous

capture missions.

7.2 Recommendations for Future Research

Several recommendations for future research based on the results presented in

this dissertation can be made as follows:

• A coordinated post-capture methodology based on the ARLC algorithm

presented here and momentum exchange mechanism control can be devel-

oped to stabilize the whole system and complete the capture mission. A

number of detumbling motion control and momentum distribution algo-

rithms from literature [15, 45, 67] can be implemented with the availability

of target inertial properties and the system’s total momentum, as obtained

with the ARLC control/identification scheme.

• The formulation of adaptive reactionless control algorithm derived in this

study has not taken into account the issue of joint rate measurements.

Hence, performance of ARLC should be investigated in the presence of noise

and uncertainty in joint rate estimation. Modifications to ARLC in order

to make it more robust to noise and uncertainty in joint rate estimation is

recommended for future research.

120

Page 143: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

7.2 RECOMMENDATIONS FOR FUTURE RESEARCH

• The effect of joint rate constraints was not investigated in this thesis, but

these are likely to limit the possibilities for reactionless motion when very

large tumbling targets are to be captured. Similarly, momentum exchange

device requirements and limitations as far as final stabilization of the system

must be studied and defined.

• Self-collision avoidance for a manipulator is a critical aspect for operations

in space, especially after capturing a large-size unknown target. Although a

number of studies have addressed this problem for redundant ground-based

manipulators, solving this problem for space manipulators is recommended

for future research.

• Another concern when designing motion control for a free-floating space

manipulator is the dynamic singularity issue [32]. In fact, due to a lack of

knowledge of dynamics properties, the singularity hypersurfaces in the ma-

nipulator joint space of the free-floating space manipulator after capturing

an unknown target is unpredictable. Hence, dynamic singularity avoidance

should be investigated as the next phase of this study by exploiting the

benefits of the ARLC/identification scheme proposed in this dissertation.

• In Chapter 6, a preliminary design for an experimental test-bed for au-

tonomous capture missions was laid out. However, construction of this

facility has not taken place to date due to budgetary constraints at CSA.

Constructing the experimental test-bed and validating the proposed control

algorithms are strongly recommended for future work.

121

Page 144: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative
Page 145: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

BIBLIOGRAPHY

BIBLIOGRAPHY

[1] NASA Photo. (2006) STS-116 Shuttle Mission Imagery. Retrieved September 01,

2012. [Online]. Available: http://spaceflight.nasa.gov/gallery/images/shuttle/

sts-116/html/s116e05765.html

[2] ——. (2005) Japanese Experiment Module (JEM) of the ISS. Retrieved

October 10, 2012. [Online]. Available: http://commons.wikimedia.org/wiki/File:

Japanese Experiment Module Kibo.jpg

[3] K. Yoshida, “Engineering test satellite VII flight experiments for space robot

dynamics and control: theories on laboratory test beds ten years ago, now in

orbit,” International Journal of Robotics Research, vol. 22, no. 5, pp. 321–35,

2003.

[4] NASA Photo. (2012) The SpaceX Dragon commercial cargo craft is grappled

by the Canadarm2 robotic arm at the iss. Retrieved September 10,

2012. [Online]. Available: http://spaceflight.nasa.gov/gallery/images/station/

crew-31/html/iss031e070804.html

[5] MDA Photo. (2011) MDA Satellite Servicer. Retrieved September 10, 2012.

[Online]. Available: http://www.mdacorporation.com/corporate/news/press/

MDA on-orbit servicing.jpg

[6] MDA Corporation. (2011) On-Orbit servicing missions. [Online]. Available:

http://sm.mdacorporation.com/

[7] T.-C. Nguyen-Huynh and I. Sharf, “Adaptive reactionless motion for space ma-

nipulator when capturing an unknown tumbling target,” in IEEE International

123

Page 146: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

BIBLIOGRAPHY

Conference on Robotics and Automation, Shanghai, China, 2011, pp. 4202–4207.

[8] P. Motaghedi, “On-orbit performance of the orbital express capture system,” in

Proc. SPIE - The International Society for Optical Engineering (USA), vol. 6958,

2008, pp. 69 580–1.

[9] F. Sellmaier, J. Spurmann, and T. Boge, “On-orbit servicing missions at

DLR/GSOC,” in 61st International Astronautical Congress 2010, IAC 2010,

vol. 10, 2010, pp. 8376–8382.

[10] J. Kreisel, “On-orbit servicing (OOS): Issues commercial implications,” in 54th

International Astronautical Congress of the International Astronautical Federa-

tion (IAF), vol. 1, 2003, pp. 3045–3049.

[11] S. Abiko and G. Hirzinger, “On-line parameter adaptation for a momentum

control in the post-grasping of a tumbling target with model uncertainty,” in

IEEE/RSJ International Conference on Intelligent Robots and Systems, San

Diego, CA, USA, 2007, pp. 847–52.

[12] T. Miyabe, A. Konno, M. Uchiyama, and M. Yamano, “An approach toward an

automated object retrieval operation with a two-arm flexible manipulator,” The

International Journal of Robotics Research, vol. 23, no. 3, pp. 275–291, 2004.

[13] K. Yoshida, H. Nakanishi, H. Ueno, N. Inaba, T. Nishimaki, and M. Oda, “Dy-

namics, control and impedance matching for robotic capture of a non-cooperative

satellite,” Advanced Robotics, vol. 18, no. 2, pp. 175–198, 2004.

[14] X. Cyril, A. K. Misra, M. Ingham, and G. J. Jaar, “Postcapture dynamics of

a spacecraft-manipulator-payload system,” Journal of Guidance, Control, and

Dynamics, vol. 23, no. 1, pp. 95–100, 2000.

[15] F. Aghili, “Optimal control of a space manipulator for detumbling of a target

satellite,” in IEEE International Conference on Robotics and Automation, 2009,

pp. 3019–3024.

[16] ——, “Time-optimal detumbling control of spacecraft,” Journal of Guidance,

Control, and Dynamics, vol. 32, no. 5, pp. 1671–1675, 2009.

124

Page 147: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

BIBLIOGRAPHY

[17] D. Doody, Basics of Space Flight. California Institute of Technology: Bluroof

Press - National Aeronautics and Space Administration, 2011.

[18] Y. Masutani, F. Miyazaki, and S. Arimoto, “Modeling and sensory feedback

control for space manipulators,” in Proceedings IEEE International Conference

on Robotics and Automation, 1989, pp. 1346–51.

[19] E. Papadopoulos, “On the dynamics and control of space manipulator,” PhD

thesis, Massachusetts Institute of Technology, 1990.

[20] R. W. Longman, R. E. Lindberg, and M. F. Zedd, “Satellite-mounted robot ma-

nipulators: new kinematics and reaction moment compensation,” International

Journal of Robotics Research, vol. 6, no. 3, pp. 87–103, 1987.

[21] J. Angeles, Fundamentals of Robotic Mechanical Systems. New York: Springer,

2007.

[22] Z. Vafa and S. Dubowsky, “The kinematics and dynamics of space manipula-

tors: The virtual manipulator approach,” The International Journal of Robotics

Research, vol. 9, no. 4, pp. 3–21, 1990.

[23] S. Dubowsky and E. Papadopoulos, “The kinematics, dynamics, and control

of free-flying and free-floating space robotic systems,” IEEE Transactions on

Robotics and Automation, vol. 9, no. 5, pp. 531–543, 1993.

[24] E. Papadopoulos and S. Dubowsky, “On the nature of control algorithms for free-

floating space manipulators,” IEEE Transactions on Robotics and Automation,

vol. 7, no. 6, pp. 750–758, 1991.

[25] Y. Xu and H.-Y. Shum, “Dynamic control and coupling of a free-flying space

robot system,” Journal of Robotic Systems, vol. 11, no. 7, pp. 573–589, 1994.

[26] S. a. A. Moosavian and E. Papadopoulos, “Explicit dynamics of space free-flyers

with multiple manipulators via spacemaple,” Advanced Robotics, vol. 18, no. 2,

pp. 223–244, 2004.

[27] M. W. Walker and L. B. Wee, “Adaptive control of space-based robot manipula-

tors,” IEEE Transactions on Robotics and Automation, vol. 7, no. 6, pp. 828–35,

1991.

125

Page 148: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

BIBLIOGRAPHY

[28] Y. Umetani and K. Yoshida, “Resolved motion rate control of space manipu-

lators with generalized jacobian matrix,” IEEE Transactions on Robotics and

Automation, vol. 5, no. 3, pp. 303–314, 1989.

[29] E. G. Papadopoulos, “Nonholonomic behavior in free-floating space manipulators

and its utilization, contributed chapter in nonholonomic motion,” in Nonholo-

nomic Motion Planning. Kluwer Academic Publishers, 1993, pp. 423–445.

[30] Y. Nakamura and R. Mukherjee, “Nonholonomic path planning of space robots

via a bidirectional approach,” IEEE Transactions on Robotics and Automation,

vol. 7, no. 4, pp. 500–14, 1991.

[31] S. Dubowsky and M. A. Torres, “Path planning for space manipulators to mini-

mize spacecraft attitude disturbances,” in Proceedings IEEE International Con-

ference on Robotics and Automation, 1991, pp. 2522–8.

[32] E. Papadopoulos and S. Dubowsky, “Dynamic singularities in free-floating space

manipulators,” Journal of Dynamic Systems, Measurement and Control, Trans-

actions of the ASME, vol. 115, no. 1, pp. 44–52, 1993.

[33] Y. Nakamura and H. Hanafusa, “Inverse kinematic solutions with singularity

robustness for robot manipulator control,” Transactions of the ASME. Journal

of Dynamic Systems, Measurement and Control, vol. 108, no. 3, pp. 163–71, 1986.

[34] A. Deo and I. Walker, “Overview of damped least-squares methods for inverse

kinematics of robot manipulators,” Journal of Intelligent and Robotic Systems,

vol. 14, no. 1, pp. 43–68, 1995.

[35] S. Abiko and K. Yoshida, “Adaptive reaction control for space robotic applica-

tions with dynamic model uncertainty,” Advanced Robotics, vol. 24, pp. 1099–

1126, 2010.

[36] D. N. Nenchev, K. Yoshida, P. Vichitkulsawat, and M. Uchiyama, “Reaction

null-space control of flexible structure mounted manipulator systems,” IEEE

Transactions on Robotics Automation, vol. 15, no. 6, pp. 1011–23, 1999.

[37] Y. Fukazu, N. Hara, Y. Kanamiya, and D. Sato, “Reactionless resolved accelera-

tion control with vibration suppression capability for JEMRMS/SFA,” in IEEE

126

Page 149: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

BIBLIOGRAPHY

International Conference on Robotics and Biomimetics, Piscataway, NJ, USA,

2008, pp. 1359–1364.

[38] B. John, H. John, and B. Roger, “Programming and control of kinematically

redundant manipulators,” in Decision and Control, 1984. The 23rd IEEE Con-

ference on, vol. 23, pp. 768–774.

[39] Y. Nakamura, H. Hanafusa, and T. Yoshikawa, “Task-priority based redun-

dancy control of robot manipulators,” International Journal of Robotics Re-

search, vol. 6, no. 2, pp. 3–15, 1987.

[40] Y. Nakamura, Advanced robotics: redundancy and optimization. Reading, Mass.:

Addison-Wesley Pub. Co., 1991.

[41] D. Nenchev, Y. Umetani, and K. Yoshida, “Analysis of a redundant free-flying

spacecraft/manipulator system,” IEEE Transactions on Robotics Automation,

vol. 8, no. 1, pp. 1–6, 1992.

[42] T. Oki, H. Nakanishi, and K. Yoshida, “Whole-body motion control for capturing

a tumbling target by a free-floating space robot,” in IEEE/RSJ International

Conference on Intelligent Robots and Systems, 2007, pp. 2256–2261.

[43] X. Cyril, G. J. Jaar, and A. K. Misra, “Dynamical modelling and control of a

spacecraft-mounted manipulator capturing a spinning satellite,” Acta Astronau-

tica, vol. 35, no. 2-3, pp. 167–174, 1995.

[44] S. Matunaga, T. Kanzawa, and Y. Ohkami, “Rotational motion-damper for the

capture of an uncontrolled floating satellite,” Control Engineering Practice, vol. 9,

no. 2, pp. 199–205, 2001.

[45] D. N. Dimitrov and K. Yoshida, “Momentum distribution in a space manipulator

for facilitating the post-impact control,” in IEEE/RSJ Int. Conf. on Intelligent

Robots and Systems, vol. 4, Sendai, Japan, 2004, pp. 3345–3350.

[46] D. Dimitrov, “Dynamics and control of space manipulators during a satellite

capturing operation,” PhD thesis, Tohoku University, Japan, 2005.

[47] T. Oki, H. Nakanishi, and K. Yoshida, “Time-optimal manipulator control for

management of angular momentum distribution during the capture of a tumbling

127

Page 150: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

BIBLIOGRAPHY

target,” Advanced Robotics, vol. 24, no. 3, pp. 441–466, 2010.

[48] J. J. E. Slotine and L. Weiping, “On the adaptive control of robot manipulators,”

International Journal of Robotics Research, vol. 6, no. 3, pp. 49–59, 1987.

[49] J. J. Craig, P. Hsu, and S. S. Sastry, “Adaptive control of mechanical manipula-

tors,” The International Journal of Robotics Research, vol. 6, no. 2, pp. 16–28,

1987.

[50] H. Seraji, “Configuration control of redundant manipulators: theory and imple-

mentation,” IEEE Transactions on Robotics and Automation, vol. 5, no. 4, pp.

472–490, 1989.

[51] C. C. Cheah, C. Liu, and J. J. E. Slotine, “Adaptive tracking control for robots

with unknown kinematic and dynamic properties,” International Journal of Ro-

botics Research, vol. 25, no. 3, pp. 283–96, 2006.

[52] W. Liang-Boon, M. W. Walker, and N. H. McClamroch, “An articulated-body

model for a free-flying robot and its use for adaptive motion control,” IEEE

Transactions on Robotics and Automation, vol. 13, no. 2, pp. 264–77, 1997.

[53] R. Lampariello, S. Agrawal, and G. Hirzinger, “Optimal motion planning for free-

flying robots,” in IEEE International Conference on Robotics and Automation,

vol. 3, Sep 14, 2003, pp. 3029–3035.

[54] F. Aghili and K. Parsa, “Motion and parameter estimation of space objects using

laser-vision data,” Journal of Guidance, Control, and Dynamics, vol. 32, no. 2,

pp. 537–549, 2009.

[55] U. Hillenbrand and R. Lampariello, “Motion and parameter estimation of a free-

floating space object from range data for motion prediction,” European Space

Agency, no. 603, pp. 461–470, 2005.

[56] Y. Murotsu, K. Senda, M. Ozaki, and S. Tsujio, “Parameter identification of un-

known object handled by free-flying space robot,” Journal of Guidance, Control,

and Dynamics, vol. 17, no. 3, pp. 488–94, 1994.

128

Page 151: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

BIBLIOGRAPHY

[57] K. Yoshida and S. Abiko, “Inertia parameter identification for a free-flying space

robot,” in AIAA Guidance, Navigation, and Control Conference, Monterey, Cal-

ifornia, 5-8 August 2002, pp. 579–586.

[58] O. Ma, H. Dang, and K. Pham, “On-orbit identification of inertia properties of

spacecraft using a robotic arm,” Journal of Guidance, Control, and Dynamics,

vol. 31, no. 6, pp. 1761–1771, 2008.

[59] X. Yangsheng, Space Robotics: Dynamics and Control. Kluwer Academic Pub-

lishers, 1993.

[60] J. J. E. Slotine and W. Li, Applied nonlinear control. Englewood Cliffs, N.J. :

Prentice Hall, 1991.

[61] D. N. Nenchev, K. Yoshida, and M. Uchiyama, “Reaction null-space based control

of flexible structure mounted manipulator systems,” in Proceedings of the 35th

IEEE Decision and Control, vol. 4, 1996, pp. 4118–4123.

[62] K. Yoshida, “A general formulation for under-actuated manipulators,” in Proc.

of the IEEE/RSJ Int. Conf. on Intelligent Robot and Systems, vol. 3, New York,

NY, USA, 1997, pp. 1651–1657.

[63] P. Piersigilli, I. Sharf, and A. K. Misra, “Reactionless capture of a satellite by

a two degree-of-freedom manipulator,” Acta Astronautica, vol. 66, no. 1-2, pp.

183–192, 2010.

[64] T. C. Nguyen Huynh and I. Sharf, “Capture of spinning target with space ma-

nipulator using magneto rheological damper,” in AIAA Guidance, Navigation,

and Control Conference, Toronto, Canada, August 2010.

[65] C. Menon, S. Busolo, S. Cocuzza, A. Aboudan, A. Bulgarelli, C. Bettanini,

M. Marchesi, and F. Angrilli, “Issues and solutions for testing free-flying robots,”

Acta Astronautica, vol. 60, no. 12, pp. 957–965, 2007.

[66] MSC.Adams. (2012) MSC software’s adams plays key role in curiosity’s descent

and landing on mars. [Online]. Available: http://www.mscsoftware.com

[67] F. Aghili, “Coordination control of a free-flying manipulator and its base attitude

to capture and detumble a noncooperative satellite,” in IEEE/RSJ International

129

Page 152: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

BIBLIOGRAPHY

Conference on Intelligent Robots and Systems, 2009, pp. 2365–2372.

[68] G. C. Goodwin and K. S. Sin, Adaptive filtering prediction and control. Engle-

wood Cliffs, N.J. : Prentice-Hall, 1984.

[69] L. R. Landau, I. and M. M’Saad, Adaptive Control. London: Springer-Verlag,

1998.

[70] G. C. Goodwin, H. Elliott, and E. K. Teoh, “Deterministic convergence of a self-

tuning regulator with covariance resetting,” IEE Proceedings D (Control Theory

and Applications), vol. 130, no. 1, pp. 6–8, 1983.

[71] K. J. Astrom, “Theory and applications of adaptive control – A survey,” Auto-

matica, vol. 19, no. 5, pp. 471–486, 1983.

[72] C. Paleologu, J. Benesty, and S. Ciochina, “A robust variable forgetting factor

recursive least-squares algorithm for system identification,” IEEE Signal Pro-

cessing Letters, vol. 15, pp. 597–600, 2008.

[73] L. Ljung and T. Soderstrom, Theory and Practice of Recursive Identification.

Cambridge, Mass.: The MIT Press, 1983.

[74] A. Konno, M. Uchiyama, Y. Kito, and M. Murakami, “Configuration-dependent

vibration controllability of flexible-link manipulators,” International Journal of

Robotics Research, vol. 16, no. 4, pp. 567–76, 1997.

[75] C. G. Atkeson, C. H. An, and J. M. Hollerbach, “Estimation of inertial pa-

rameters of manipulator loads and links,” The International Journal of Robotics

Research, vol. 5, no. 3, pp. 101–119, 1986.

[76] M. L. R. de Campos, M. G. Siqueira, A. Antoniou, and J. Wilson, A. N., “A

QR-decomposition LMS-Newton adaptive filtering algorithm with variable con-

vergence factor,” in IEEE Pacific Rim Conf. on Communications, Computers

and Signal Processing, May 1993, pp. 350–353.

[77] J. Jos Antonio Apolinrio, QRD-RLS Adaptive Filtering. New York: London :

Springer, 2009.

[78] B. Armstrong, “On finding exciting trajectories for identification experiments

involving systems with nonlinear dynamics,” International Journal of Robotics

130

Page 153: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

BIBLIOGRAPHY

Research, vol. 8, no. 6, pp. 28–48, 1989.

[79] M. Gautier and W. Khalil, “Exciting trajectories for the identification of base

inertial parameters of robots,” in Proceedings of the 30th IEEE Conference on

Decision and Control, 11-13 Dec. 1991, pp. 494–9.

[80] J. Swevers, C. Ganseman, D. B. Tukel, J. de Schutter, and H. Van Brussel,

“Optimal robot excitation and identification,” IEEE Transactions on Robotics

and Automation, vol. 13, no. 5, pp. 730–40, 1997.

[81] P. K. Khosla, “Real-time control and identification of direct-drive manipulator,”

PhD thesis, Carnegie Mellon University, 1986.

[82] D. N. Nenchev, “Redundancy resolution through local optimization: a review,”

Journal of Robotic Systems, vol. 6, no. 6, pp. 769–98, 1989.

[83] A. Liegeois, “Automatic supervisory control of the configuration and behavior of

multibody mechanisms,” IEEE Transactions on Systems, Man and Cybernetics,

vol. SMC-7, no. 12, pp. 868–71, 1977.

[84] C. A. Klein and B. E. Blaho, “Dexterity measures for the design and control of

kinematically redundant manipulators,” The International Journal of Robotics

Research, vol. 6, no. 2, pp. 72–83, 1987.

[85] F. Aghili and K. Parsa, “An adaptive vision system for guidance of a robotic ma-

nipulator to capture a tumbling satellite with unknown dynamics,” in IEEE/RSJ

International Conference on Intelligent Robots and Systems, 2008, pp. 3064–71.

[86] H. Schubert and J. P. How, “Space construction: An experimental testbed to de-

velop enabling technologies,” in Telemanipulator and Telepresence Technologies

IV, Pittsburg, PA, October 1997.

[87] Y. Murotsu, K. Senda, A. Mitsuya, and K. Fujii, “Experimental studies for

control of manipulators mounted on a free-flying space robot,” in Proceedings of

IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS

’93), 1993, pp. 2148–54.

[88] M. Nahon, C. Damaren, A. Bergen, and J. Goncalves, “Test facility for multi-

armed space-based manipulators,” Canadian Aeronautics and Space Journal,

131

Page 154: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

BIBLIOGRAPHY

vol. 41, no. 4, pp. 150–162, 1995.

[89] H. Chaoui, P. Sicard, J. Lee, and A. Ng, “Neural network modeling of cold-

gas thrusters for a spacecraft formation flying test-bed,” in IEEE Conference on

Industrial Electronics Society, Montreal, Qc, October 2012.

[90] J. L. Schwartz, M. A. Peck, and C. D. Hall, “Historical review of air-bearing

spacecraft simulators,” Journal of Guidance, Control, and Dynamics, vol. 26,

no. 4, pp. 513–522, 2003.

132

Page 155: ADAPTIVE REACTIONLESS CONTROL OF A SPACE …digitool.library.mcgill.ca/thesisfile117066.pdf · adaptive reactionless control of a space manipulator for post-capture of an uncooperative

Document Log:

Manuscript Version 0

Typeset by AMS-LATEX — 26 February 2013

Thai Chau Nguyen Huynh

Centre for Intelligent Machines, McGill University, 3480 University St., Mon-

treal (Quebec), H3A 2A7, Canada

E-mail address: [email protected]

Typeset by AMS-LATEX