6
Impedance Control for a Free-Floating Robot in the Grasping of a Tumbling Target with Parameter Uncertainty Satoko Abiko, Roberto Lampariello and Gerd Hirzinger Institute of Robotics and Mechatronics German Aerospace Center (DLR) 82334, Weßling, Germany satoko.abiko;roberto.lampariello @dlr.de Abstract— This paper addresses an impedance control for a free-floating space robot in the grasping of a tumbling target with model uncertainty. Firstly, the operational space dynamics for a free-floating robot is derived with a novel, computationally efficient formulation. Then, considering the grasped target as a disturbance force on the end-effector, the proposed control method is completely independent of the target inertial parameters and the end-effector can follow a given trajectory in the presence of model uncertainty. To verify the effectiveness of the proposed method, a three-dimensional realistic numerical simulation is carried out. I. I NTRODUCTION Manipulator interaction with the environment requires op- erational space control schemes. Uncertainties in the environ- ment model give rise to undesired forces on the robot end- effector. In the free-floating dynamics scenario, impacts may cause large deviations in motion and, for inadequate control schemes, high control forces. It is therefore reasonable to avoid impact, if possible, and to introduce compliance at the end-effector. In this work, the task of grasping a tumbling target by means of a free-floating robot is addressed. The target is assumed to be initially tumbling in some given arbitrary free motion. Following an operational strategy by which the impact between the robot end-effector and the target is minimized at the grasp, the subsequent stabilization motion is analyzed here for the case of uncertainty in the target dynamic model. This leads to a tracking problem, where a given nominal stabilization trajectory has to be tracked, while accounting for the parameter uncertainty. This problem has been indirectly addressed in the context of adaptive control, in joint space and in operational space [1][2]. A new formulation in the context of impedance control is instead developed here. The resulting method provides a very simple means of deriving the operational space dynamic equations for a free-floating robot as well as a simple control law, based on feedback linearization, for the resolution of the given problem. The control method is tested in simulation for a realistic three-dimensional scenario (see Fig. 1). The paper is organized as follows. Section II describes some related bibliography. Section III introduces the opera- tional strategy for grasping. In section IV, the dynamic model of a space robot is explained by two approaches. Section V discusses the theoretical aspects of the control method. In Section VI, the simulation results are illustrated. The conclusions are summarized in Section VII. Fig. 1: Chaser-robot and target scenario II. RELATED PREVIOUS WORKS The space mission to capture a tumbling target by means of a chaser-robot may be divided into four main phases: (1) following the target motion (Pre-contact), (2) capturing the target with the manipulator (Contact), (3) damping out the motion of the target relative to the chaser (Post-contact), (4) stabilizing the tumbling motion of the compound system (Compound stabilization). Phases (3) and (4) are usually categorized together in pre- vious research. However, in this paper we consider them separately and focus on phase (3) for motion control with uncertainty in the target dynamic properties. To cope with the model uncertainty, Xu and Gu proposed an adaptive control scheme for space robots in both joint space and operational space [1][2]. Specifically, by consid- ering space robots as under-actuated manipulators, adaptive control in the operational space is introduced in [2]. In [3], both damping out of the chaser-target relative motion and the following compound stabilization are dealt with simultaneously by using the principle of conservation of momentum. However, to carry out both tasks, we need to choose a proper trajectory carefully. With regards to phase (2), some previous research has analyzed the impact between the target and the manipulator 1-4244-0259-X/06/$20.00 ©2006 IEEE

Impedance Control for a Free-Floating Robot in the Grasping of a … · 2013-12-12 · robot. On the other hand, if no active actuators are applied on the base, the system is termed

  • Upload
    others

  • View
    3

  • Download
    0

Embed Size (px)

Citation preview

Page 1: Impedance Control for a Free-Floating Robot in the Grasping of a … · 2013-12-12 · robot. On the other hand, if no active actuators are applied on the base, the system is termed

Impedance Control for a Free-Floating Robot in the Graspingof a Tumbling Target with Parameter Uncertainty

Satoko Abiko, Roberto Lampariello and Gerd HirzingerInstitute of Robotics and Mechatronics

German Aerospace Center (DLR)82334, Weßling, Germany

�satoko.abiko;roberto.lampariello�@dlr.de

Abstract— This paper addresses an impedance control fora free-floating space robot in the grasping of a tumblingtarget with model uncertainty. Firstly, the operational spacedynamics for a free-floating robot is derived with a novel,computationally efficient formulation. Then, considering thegrasped target as a disturbance force on the end-effector, theproposed control method is completely independent of thetarget inertial parameters and the end-effector can follow agiven trajectory in the presence of model uncertainty. To verifythe effectiveness of the proposed method, a three-dimensionalrealistic numerical simulation is carried out.

I. INTRODUCTION

Manipulator interaction with the environment requires op-erational space control schemes. Uncertainties in the environ-ment model give rise to undesired forces on the robot end-effector. In the free-floating dynamics scenario, impacts maycause large deviations in motion and, for inadequate controlschemes, high control forces. It is therefore reasonable toavoid impact, if possible, and to introduce compliance at theend-effector.

In this work, the task of grasping a tumbling target bymeans of a free-floating robot is addressed. The target isassumed to be initially tumbling in some given arbitraryfree motion. Following an operational strategy by whichthe impact between the robot end-effector and the target isminimized at the grasp, the subsequent stabilization motionis analyzed here for the case of uncertainty in the targetdynamic model. This leads to a tracking problem, where agiven nominal stabilization trajectory has to be tracked, whileaccounting for the parameter uncertainty.

This problem has been indirectly addressed in the contextof adaptive control, in joint space and in operational space[1][2]. A new formulation in the context of impedance controlis instead developed here. The resulting method provides avery simple means of deriving the operational space dynamicequations for a free-floating robot as well as a simple controllaw, based on feedback linearization, for the resolution of thegiven problem. The control method is tested in simulation fora realistic three-dimensional scenario (see Fig. 1).

The paper is organized as follows. Section II describessome related bibliography. Section III introduces the opera-tional strategy for grasping. In section IV, the dynamic modelof a space robot is explained by two approaches. SectionV discusses the theoretical aspects of the control method.In Section VI, the simulation results are illustrated. Theconclusions are summarized in Section VII.

Fig. 1: Chaser-robot and target scenario

II. RELATED PREVIOUS WORKS

The space mission to capture a tumbling target by meansof a chaser-robot may be divided into four main phases:(1) following the target motion (Pre-contact),(2) capturing the target with the manipulator (Contact),(3) damping out the motion of the target relative to the

chaser (Post-contact),(4) stabilizing the tumbling motion of the compound system

(Compound stabilization).Phases (3) and (4) are usually categorized together in pre-vious research. However, in this paper we consider themseparately and focus on phase (3) for motion control withuncertainty in the target dynamic properties.

To cope with the model uncertainty, Xu and Gu proposedan adaptive control scheme for space robots in both jointspace and operational space [1][2]. Specifically, by consid-ering space robots as under-actuated manipulators, adaptivecontrol in the operational space is introduced in [2]. In[3], both damping out of the chaser-target relative motionand the following compound stabilization are dealt withsimultaneously by using the principle of conservation ofmomentum. However, to carry out both tasks, we need tochoose a proper trajectory carefully.

With regards to phase (2), some previous research hasanalyzed the impact between the target and the manipulator

1-4244-0259-X/06/$20.00 ©2006 IEEE

Page 2: Impedance Control for a Free-Floating Robot in the Grasping of a … · 2013-12-12 · robot. On the other hand, if no active actuators are applied on the base, the system is termed

[4][5][6]. Nenchev et. al. discussed the effect of the impactand proposed an attitude control scheme for the satellite,based on the reaction null space for post-contact [4]. In [5],the dynamic equations in the operational space are introducedand the configuration to minimize the impact is discussed inthe planar case. In [6], Wee also analyzed the dynamicalcontact between two bodies and revealed that the impulseat contact can be minimized by optimal trajectory planing.However, these studies do not consider the capturing of thetarget, namely the model uncertainty in its dynamics.

III. SCENARIO AND ASSUMPTIONS IN THE GRASPING OF

A TUMBLING TARGET

In our envisioned scenario, it is assumed that an inversekinematics algorithm provides the ideal robot trajectory toalign the end-effector velocity with that of the graspingpoint on the target, such that the impact at the grasp isminimal. This may be achieved by means of an ideal visualpath tracker. Subsequently, a motion planner provides astabilization trajectory to bring the relative motion betweenthe robot and the target to zero, while ensuring feasibility ofthe task. However, due to parameter uncertainty in the target,this trajectory will require feedback tracking control.

The tracking problem of the stabilization trajectory maybe formulated in joint or in operational space. It is howeverimportant to realize that the target parameter uncertainty maybe treated as an adaptive control problem [1], if the targetdynamics wants to be included into the control formulation.This however, does not allow to formulate the more generalimpedance control theory, which should be independent ofthe target dynamics, to include consideration of impactforces. In the problem addressed here, the target uncertainty isseen as a disturbance force on the end-effector, with respect tothe expected internal force involved in the stabilizing motion.

IV. MODELING AND EQUATIONS OF MOTION

This section introduces the model of a space robot. Asdescribed above, the focus of this research is to follow adesired trajectory in operational space when the space robotgrasps the target with unknown dynamic properties. Sinceour interest is the influence of the contact forces on theenvironment, or on the target motion in relation to the chaser,it is convenient to refer to operational space schemes.

To derive the dynamics of free-floating space robots inthe operational space, two approaches are possible. Thedynamic equations of free-floating space robots are generallyexpressed with linear and angular velocities of the base andthe motion rate of each joint as generalized coordinates[7].However, considering the system switched around, modeledfrom the end-effector to the base, it can be represented by themotion of the end effector and that of the joints in the samestructure as in the conventional expression. This scheme istermed here the inverted chain approach. On the other hand,we can also obtain the dynamics in the operational space fromthe conventional representation of space robots as introducedin [5] in a straightforward manner, which we term here theforward chain approach.

The following subsections explain the dynamic equationsof the system, developed in the two ways mentioned above,for a serial rigid-link manipulator attached to a floating base,as shown in Fig. 2. It is shown that the inverted chain

Σi

Σb

Σe

Link 0( Base body )

Link 1

Link n

Fe

Link 2

φ 1

φ 2

φ n

rb

rerbe

( End effector )

External force

Fig. 2: General model for a space robot with external force

approach has a computational advantage with respect to theforward chain approach.

A. Dynamics for space robots – Inverted chain approach

Differing from a ground based manipulator, the model ofa free-floating space robot is invertible from the end-effectorto the base, in the sense of no fixed base of the system. Thissubsection explains the dynamics of a space robot in thissense.

1) Equation of motion: Considering the generalized coor-dinates as the linear and angular velocities of the end-effector,��� � ���

����

��� � ����, and the motion rate of the joints,

�� � ����, the equations of motion are expressed in thefollowing form:�

�� ���

��

����

�������

��

�����

���

��

���

��

��� (1)

The symbols used here are defined as follows:

�� � ���� : inertia matrix on the end-effector.�� � ���� : inertia matrix of the arm.��� � ���� : coupling inertia matrix between the

end-effector and the arm.

�� � ���� : non-linear velocity dependent termon the end-effector.

�� � ���� : non-linear velocity dependent termof the arm.

�� � ���� : force and moment exerted on theend-effector.

�� � ���� : force and moment exerted on thebase.

� � ���� : torque on the joints.

In the case that �� is generated actively (e.g. jet thrustersor reaction wheels etc.), the system is called a free-flying

Page 3: Impedance Control for a Free-Floating Robot in the Grasping of a … · 2013-12-12 · robot. On the other hand, if no active actuators are applied on the base, the system is termed

robot. On the other hand, if no active actuators are appliedon the base, the system is termed a free-floating robot. In thispaper, we consider the free-floating robot.

By canceling out the end-effector acceleration ��� in (1),the equations of motion can be reduced to the joint spaceformulation:���

��� ��� � � ���

�����

� �� � ����� (2)

where ��� � �� � ��

�����

����, ��� � �� �

��

�����

���, and ��� � �� � ���

��

����.

2) Equations of motion in the operational space: Theupper part of (1) clearly describes the equations of motionin the operational space:

����� � �� � ������� �� � ��

��� (3)

where �� � ������ describes the input command gener-

ated by the joint actuators.Substituting equation (2) into (3), the acceleration of the

end-effector can be represented by the torques on the jointsand by the external forces/torques on the end-effector, withthe assumption of no external forces/torques on the base�� � �:

��� � ����

����

����

��

����

��� ����

����

���

�����

���� � (4)

where � ����

��� � ���

����

����

���� denotes the

Coriolis and centrifugal forces in operational space.

B. Dynamics for space robots – Forward chain approach

The other way to derive the equations of motion in theoperational space is by applying the classical expressions toa space robot. A similar approach has been introduced in [5].To formulate the dynamics of the system with the forwardchain approach, the general expressions for space robots arebriefly reviewed first.

1) Equations of motion: The equations of motion in jointspace for a free-floating space robot are generally expressedin the following form [7]:

��

���� ��� � � � ���� �� (5)

where ��

�� ����, ��

�� ���� and ��

�� ���� are the

so-called generalized inertia matrix, generalized Coriolis andcentrifugal forces and generalized Jacobian of a space robot,respectively [4].

2) Linear and Angular Momentum Equations: The motionof the system is also governed by the momentum equationsin the absence of external forces:�

����

���� ��� ����

�� (6)

in which the generalized coordinates are the linear and angu-lar velocities of the base satellite, ��� � ���

����

��� � ����

and the motion rate of the joints, �� � ����. �� � ���� and��� � ���� denote the inertia matrix of the base and thecoupling inertia between the base and the joints, respectively.Note that �� and �� represent the total linear and angularmomentum around the base coordinate system.

The total linear and angular momentum can be also ex-pressed around the end-effector coordinates:�

��

���� ��� ����

��� (7)

The expression of the angular momentum is generally de-pendent on the reference frame. Therefore, the followingtransformation can be obtained between (6) and (7):�

����

��

�� ��

���� �

����

�� ������� �

�� ���

� ��

���

�(8)

where � � ���� and �� � ���� respectively denotethe identity matrix and the zero matrix. ��� represents thevector from the base to the end effector and the operator ���indicates the cross product. �� denotes the Jacobian matrixfrom the base to the end effector.

3) Kinematics: The kinematic relationship between theoperational and the joint space is described as follows, byusing (8) and the generalized Jacobian matrix ��

�which

include the dynamic parameters of the system:

��� � ������ � ��

��

�����

� �������

��

���

�(9)

where �� � �� ����

���

���� � ���� denotes the inertia

matrix of the base projected on the end-effector.4) Equations of motion in the operational space: By using

equation (5) and (9), the dynamic equations in the operationalspace can be obtained in a straightforward manner.

The derivative of (9) leads to the equations of motion inthe operational space in function of the acceleration of theend-effector and that of the joints:

��� � �������

��

��� � ��

���� ��

��

���

�(10)

To obtain the equations of motion in function of theacceleration of the end effector and the torques on each joint,equation (5) is substituted into equation (10).

��� � �������

� � � ���� ����

���� � � (11)

where � � ��������

� ���� ��� � ���� denotes the ki-netic energy in the operational space for ground basedmanipulators[8][9]. ���� � �

��

�� is named the extended

generalized inertia tensor [5]. � � ��������

� ���� ���

����

������

��

���

�� ���� expresses the Coriolis and centrifu-

gal forces in operational space.

Page 4: Impedance Control for a Free-Floating Robot in the Grasping of a … · 2013-12-12 · robot. On the other hand, if no active actuators are applied on the base, the system is termed

C. Comparison between the two expressions

Let us compare the above two expressions in the twoprevious subsections for the operational space dynamics. Bycomparing (3) and (10), or (4) and (11), it is clear that thefollowing equalities result.

�� � �� (12)��� ���

�(13)

����

� ��� � ��� (14)

����

��� � ��

� ����

������

��

���

�(15)

The above relationships are obtained by comparison ofthe single terms. Therefore, the two equations (3) and (10),or (4) and (11) are equivalent. However, expression (3) has anadvantage over expression (10) in view of the computationalconsumption ( e.g. the calculation of � � ���

�����

�����

���

and �� � �� ����

���

����). In case of limited computational

performance, it is desired that the computational consumingis reduced as much as possible. By using the inverted chainapproach, we can calculate the inertia matrix of the end-effector �� directly instead of with the calculation of �� ��� ��

��

���

����, which involves two matrix inversions.

V. IMPEDANCE CONTROL IN THE OPERATIONAL SPACE

As mentioned in section III, the robot should follow a giventrajectory to dampen out the motion of the end-effector withrespect to the base coordinate fame, to eventually stabilizethe system.

This section proposes an interaction control for spacerobots, which is based on the ideas of impedance controlfor ground based manipulators [10]. However, the interactioncontrol is exploited here to follow a desired trajectory, byregarding the internal forces at the grasping point of the targetas external forces on the end-effector.

In the grasping of the tumbling target, the uncertainty inthe target inertial properties may give rise to unsustainableforces at the end-effector. The mechanical impedance (mass-damper-spring) imposed on the end-effector, is then useful toavoid this situation. The advantage of the impedance controlis that the inertia (mass) characteristics of the end effectorcan be suitably designed. For example, if the impedancecharacteristics of the end-effector are made similar to those ofthe target, this leads to the so-called mechanical impedancematching [11]. As such, impact can be treated together withuncertainty.

Furthermore, he impedance control is developed in theoperational space, since the impedance characteristics shouldbe determined with respect to the environment, or to the targetmotion, or even to account for collision avoidance for thechaser-target compound.

For the motion damping, let us consider a control modelwhich consists of the space robot alone, while the modelfor the real system includes the target with some modeluncertainty, as shown in Fig. 3. The latter uncertainty issource of error in the motion planning solution for the desireddamping trajectory ��� . The internal forces between the end-effector and the target can be expressed in function of theknown motion of the system, with the assumption of noexternal forces. Therefore, these can then be modeled as

τ

xe , Fexe ,. xe ,..

xe , xe ,. xe..d d d

Chaser robotTarget

Robot System

Fe-Fe

Fe

Chaser robot

Control Model

Control Law( Eq. (17) ~ (19) or (22) ~ (24))

Fig. 3: Control block diagram

virtual external forces for the control model, as shown inFig. 3.

In the case without force measurement, the control law canbe determined as follows (c.f. (3)):

�� � ������ ��� � �� (16)

with � ���� ��

��

����

���� ������� (17)

where ��� � �� � ��� denotes the error between the oper-ational space position and orientation �� and the desiredequilibrium point ��

�. ��, �� and ��, respectively, repre-

sent the desired inertia, damping and stiffness matrices whichspecify the dynamic impedance behavior of the end-effector.The input command on torque level is obtained from (2):

� � ������

���� � ��� (18)

In the presence of internal forces and torques ��, thecontrolled space robot is described in the following form,from (3) and (16):

��� � ����

� �� (19)

that reveals the existence of a nonlinear coupling term dueto the internal forces ��. Substituting (17) into (19) yields

������ ���

���� ������ � �����

� ��� (20)

The expression in (20) establishes a relationship througha generalized mechanical impedance between the vector ofresulting forces ���

��

� �� and the vector of displacements��� in the operational space.To avoid the coupled motion attributed by ���

�in (20),

it is necessary to measure the internal forces and torques

Page 5: Impedance Control for a Free-Floating Robot in the Grasping of a … · 2013-12-12 · robot. On the other hand, if no active actuators are applied on the base, the system is termed

between the target and the end-effector. In this case, thecontrol law is selected as:

�� ��� � �� ��� (21)

with � ���� ��

��

����

���� �������� (22)

The torque input can be expressed in function of the com-mand �� and of the internal forces ��:

� � ������

���� � ��� ���

�����

���� (23)

On the assumption of no error on the force measurements,the following linear impedance can be achieved:

������ ���

���� ������ � �� (24)

With proper selection of the control gains, asymptotic sta-bility is guaranteed. However, the component of the internalforce �� arising from the compound motion, never convergesto zero, until the compound is itself stabilized in the inertialframe. As such, if the force is not measured, one can onlyexpect that the resulting error remains bounded. Clearly,the magnitude of this residual error depends on the controlparameters.

Furthermore, in case of force measurement, the externalforces and torques can be compensated more easily, becauseof the resulting decoupling. In practice, the tolerance of thedeviation error should be analyzed prior to the implementa-tion.

VI. SIMULATION STUDY

This section presents the numerical simulation results ofa realistic three-dimensional model as shown in Fig. 1. Thechaser robot has a 7 DOF manipulator mounted on the basesatellite, whose dynamic parameters are shown in Table I.The size of the target is the same as that of the chaser satellite.It is assumed that prior to the contact, the target is tumblingaround one axis at a constant angular velocity of 0.05 [rad/s]at the capturing with the chaser-robot and that the end effectorof the robot follows the grasping point on the target with thesame velocity. The grasping point is deviated from the centerof mass of the target by 0.5 [m]. As far as the end effectorhas the same velocity as that of the grasping point of thetarget, no impact between the two systems is induced.

In the simulation examples, the target parameters of theplanned motion are given in Table II, while those of thecontrolled motion in Table I, giving the extent of uncertaintyintroduced in the system.

A. Target uncertainty casesTwo cases with different impedance characteristics are

illustrated here. The values of inertia, damping and stiffnessmatrices on the end-effector are selected as shown in TableIII and IV. To obtain the desired control performance onemay also revert to several existing methods (e.g. Factoriza-tion design, Double diagonalization design) [12]. To set theparameters, care should be taken by considering how softlythe end-effector grasps the target, to prevent it from bouncingaway.

Figs. 4 to 6 illustrate the simulation results. Fig. 4 showsthe velocity of the end-effector with respect to the basecoordinate frame. Fig. 5 illustrates the motion of the base

TABLE I: Dynamic parameters for a space robotmass ���� ��������� ��������� ���������

Base 140 18.0 20.0 22.0

mass ���� � ������Each Link 3.3 0.0056

TABLE II: Estimated dynamic parameters for a targetmass ���� ��������� ��������� ���������

Base 50 10.0 10.0 10.0

satellite. Fig. 6 shows the internal forces and torques due tothe target. In these figures, the solid line depicts the desiredtrajectory, the dashed line depicts the case (1) and the dottedline depicts the case (2).

Even if parameter errors occur in the system, the end-effector finally converges to the desired trajectory withrespect to the base coordinate frame. The base satellitecontinues to move in the inertial coordinate frame due tothe non-zero momentum of the system. This motion can becompensated with extra actuators on the base, such as jetthrusters and reaction wheels. The compound motion in theinertial frame causes the bounded internal forces. However,the internal forces due to the target decrease to almost zerohere. If the forces are measured, the error can be compensatedproperly.

Here it is clearly shown that the simple impedance controlmethod is useful to follow the trajectory and we do not needany target parameters to implement the control.

B. Initial impact caseFurthermore, Fig. 7 shows the velocity profile of the end-

effector in case of impact at the contact time (� � �).The solid line depicts the desired trajectory, the dashed linedepicts the case with impact, resulting in an initial velocityerror of 0.05 [rad/s]. It is shown that the end-effector finallyconverges to the desired velocity with the same impedancecontrol scheme.

VII. CONCLUSIONS

A novel and very simple method is presented to derivea dynamic model for a free-floating robot in operationalspace, necessary for the desired control implementation.Furthermore, an impedance control theory is derived fromthis, based on feedback linearization, to account for targetparameter uncertainty. However, the derived formulation ofthe control law is independent of the target parameters. Theeffectiveness of the method is shown with simulation results.

TABLE III: Desired impedance parameters - case (1)x y z roll pitch yaw

�� 100 100 100 300 300 300�� 300 300 300 300 300 300�� 100 100 100 500 500 500

TABLE IV: Desired impedance parameters - case (2)x y z roll pitch yaw

�� 1.0 1.0 1.0 30 30 30�� 0.05 0.05 0.05 20 20 20�� 1.0 1.0 1.0 50 50 50

Page 6: Impedance Control for a Free-Floating Robot in the Grasping of a … · 2013-12-12 · robot. On the other hand, if no active actuators are applied on the base, the system is termed

0 5 10 15 20−0.01

0

0.01

0.02

b X [m

/s]

0 5 10 15 20−0.06−0.04−0.02

00.02

b Y [m

/s]

0 5 10 15 20−0.01

0

0.01

0.02

b Z [m

/s]

0 5 10 15 20−15−10

−505 x 10

−3

0 5 10 15 20-0.03-0.02-0.01

00.01

0 5 10 15 20-0.06-0.04-0.02

00.02

b Rol

l [ra

d/s]

b Pitc

h [ra

d/s]

b Yaw

[rad

/s]

[s]

[s]

[s]

[s]

[s]

[s]

Fig. 4: Linear and angular velocity of the end-effector, � ���

0 5 10 15 200.5

0.55

0.6

X [m

]

0 5 10 15 200.8620.8640.8660.868

0.87

Y [m

]

0 5 10 15 200.7

0.720.740.760.78

Z [m

]

0 5 10 15 20−2.8

−2.75

−2.7

Rol

l [ra

d]

0 5 10 15 200.2

0.3

0.4

0.5

Pitc

h [ra

d]

0 5 10 15 200.80.9

11.11.2

Yaw

[rad

]

[s]

[s]

[s]

[s]

[s]

[s]

Fig. 5: Position and orientation of the base satellite, ���

0 5 10 15 20−1

0

1

2

X [N

]

0 5 10 15 20−0.3−0.2−0.1

00.1

Y [N

]

0 5 10 15 20−0.2−0.1

00.10.2

Z [N

]

0 5 10 15 20−0.02

0

0.02

0.04

Rol

l [N

m]

0 5 10 15 20−0.2−0.1

00.10.2

Pitc

h [N

m]

0 5 10 15 20−0.1

00.10.20.3

Yaw

[Nm

]

[s]

[s]

[s]

[s]

[s]

[s]

Fig. 6: Internal forces and torques due to the target, ��

0 5 10 15 20−0.01

0

0.01

0.02

b X [m

/s]

0 5 10 15 20−0.06−0.04−0.02

00.02

b Y [m

/s]

0 5 10 15 20−0.01

0

0.01

0.02

b Z [m

/s]

0 5 10 15 20−0.02−0.01

00.010.02

b Rol

l [ra

d/s]

0 5 10 15 20−0.06−0.04−0.02

00.02

b Pitc

h [ra

d/s]

0 5 10 15 20−0.1

−0.050

0.050.1

b Yaw

[rad

/s]

[s]

[s]

[s]

[s]

[s]

[s]

Fig. 7: Velocity of the end-effector in the initial impact case,� ���

Finally, the developed method sets a base for more generalcompliance control tasks, which may include impact with theenvironment.

REFERENCES

[1] Y. Xu, H.-Y. Shum, J.-J. Lee, and T. Kanade, “Adaptive Control ofSpace Robot System with an Attitude Controlled Base,” in Proc. ofthe 1992 Int. Conf. on Robotics and Automation, Nice, France, May1992, pp. 2005 – 2011.

[2] Y. L. Gu and Y. Xu, “A Normal Form Augmentation Approach toAdaptive Control of Space Robot Systems,” in Proc. of the 1993 IEEEInt. Conf. on Robotics and Automation, vol. 2, Atlanta, USA, May1993, pp. 731 – 737.

[3] D. N. Dimitrov and K. Yoshida, “Momentum Distribution in a SpaceManipulator for Facilitating the Post-Impact Control,” in Proc. of the2004 IEEE/RSJ Int. Conf. on Intelligent Robots and Systems, Sendai,Japan, September. 2004, pp. 3333 – 3338.

[4] D. N. Nenchev and K. Yoshida, “Impact Analysis and Post-ImpactMotion Control Issues of a Free-Floating Space Robot Subject toa Force Impulse,” IEEE Transactions on Robotics and Automation,vol. 15, no. 3, pp. 548 – 557, June 1999.

[5] K. Yoshida, R. Kurazume, N. Sashida, and Y. Umetani, “Modelingof Collision Dynamics for Space Free-Floating Links with ExtendedGeneralized Inertia Tensor,” in Proc. of the 1992 IEEE Int. Conf. onRobotics and Automation, Nice, France, May 1992, pp. 899 – 904.

[6] L.-B. Wee and M. W. Walker, “On the Dynamics of Contact betweenSpace Robots and Configuration Control for Impact Minimization,”IEEE Transactions on Robotics and Automation, vol. 9, no. 5, pp. 581– 591, October 1993.

[7] Y. Xu and T. Kanade, Eds., Space Robotics: Dynamics and Control.Kluwer Academic Publishers, 1993.

[8] O. Khatib, “A Unified Approach for Motion and Force control of RobotManipulators: The Operational Space Formulation,” IEEE Journal ofRobotics and Automation, vol. RA-3, no. 1, pp. 43 – 53, 1987.

[9] H. Asada, “A Geometrical Representation of Manipulator Dynamicsand Its Application to Arm Design,” Trans. ASME Journal DynamicSystem Measurement Control, vol. 105, no. 3, pp. 131 – 135, 1983.

[10] L. Sciavicco and B. Siciliano, Modelling and Control of Robot Ma-nipulators. Springer, 2000.

[11] K. Yoshida, H. Nakanishi, H. Ueno, N. Inaba, T. Nishimaki, andM. Oda, “Dynamics, Control and Impedance Matching for RoboticCapture of a Non-Cooperative Satellite,” Advanced Robotics, vol. 18,no. 2, pp. 175 – 198, 2004.

[12] A. Albu-Schaffer, C. Ott, U. Frese, and G. Hirzinger, “CartesianImpedance Control of Redundant Robots: Recent Results with theDLR-Light-Weight-Arms,” in Proc. of the 2003 IEEE Int. Conf. ofRobotics and Automation, Taipei, Taiwan, May 2003, pp. 3704 – 3709.