# Kane Method Based Dynamics Modeling and Control Study for Space Manipulator Capturing a Space Target

Authors: Yanhua Han
Journal: International Journal of Aerospace Engineering
 (2016)

---

## Abstract

Dynamics modeling and control problem of a two-link manipulator mounted on a spacecraft (so-called carrier) freely flying around a space target on earth’s circular orbit is studied in the paper. The influence of the carrier’s relative movement on its manipulator is considered in dynamics modeling; nevertheless, that of the manipulator on its carrier is neglected with the assumption that the mass and inertia moment of the manipulator is far less than that of the carrier. Meanwhile, we suppose that the attitude control system of the carrier guarantees its side on which the manipulator is mounted points accurately always the space target during approaching operation. The ideal constraint forces can be out of consideration in dynamics modeling as Kane method is used. The path functions of the manipulator’s end-effector approaching the space target as well as the manipulator’s joints control torque functions are programmed to meet the soft touch requirement that the end-effector’s relative velocity to the space target is zero at touch moment. Numerical simulation validation is conducted finally.


---

## Body

## 1. Introduction

Tethered space robot and space manipulator are two means for on-orbit operation such as satellite maintenance, refueling, retrieval, or space debris removal. The main advantage of the former over the latter is its long operation distance (from tens of meters to dozens of kilometers), while the disadvantage of the former is obvious such as inherent instability in retrieval procedure and huge difficulties in control design for the procedure [1]. Compared to tethered space robot, space manipulator can work efficiently within the scope of tens of meters or smaller [2, 3], such as SRMS (Shuttle Remote Manipulator System) [2].Generally, the system dynamics of space manipulator is more complex than that on the ground [4, 5]. In the field of space manipulator dynamics, [6] presents the singularity-free dynamic equations of the dynamically equivalent manipulator (DEM) of spacecraft-manipulator systems, which is computationally efficient and meanwhile possesses the same dynamic properties as the corresponding free-floating spacecraft-manipulator system. Reference [7] outlines a procedure for modeling three-dimensional flexible multibody manipulators during maneuvering and payload capture. The manipulators are capable of performing large rigid-body translations and rotations, as well as experiencing deformation as a result of their inherent flexibility. This motion is highly nonlinear, so a nonlinear corotational finite element method is used. Reference [8] presents a study to understand the true dynamics of the tested space manipulator aiming at the problem encountered in ground physical simulation that the air-bearing support system changes the dynamics characteristics of the manipulator such as the natural frequencies, stiffness, and damping. References [9–11] study the configuration, dynamics, and control problem of a tendon-actuated lightweight space manipulator.Trajectory optimization of manipulator with redundant degree of freedom for capturing space target is researched in [12, 13] with the influence of manipulator’s movement on its carrier taken into account. An improved manipulator trajectory optimization method for such system with nonconserved momentum and angular momentum is presented in [14]. The method allows minimization of a quadratic norm connected with the power use of motors in manipulator joints. The method differs from its previous version in including the possibility of constraint final velocity of the end-effector and by considering period of the capture maneuver as a parameter that is optimized.The closed loop control law is designed for manipulator when approaching and capturing space target in [15, 16]. In [15], the flexibility of manipulator’s joints is considered, and then the notion of artificial potential is introduced to design the control law so as to guarantee the stability of the closed loop, while linear quadratic control theory is adopted in [16]. In [17], contact mechanics between the end-effector of manipulator and space target is taken into account, and the dynamics for the whole procedure is modeled; then the control law is designed. Reference [18] has discussed the control strategies for the autonomous target capture of a free-flying space robot. The highlight is made on the reactionless manipulation and the generalized Jacobian matrix. The reactionless manipulation is obtained from the reaction null-space (RNS) of the coupling inertia matrix that describes the dynamic interaction between the manipulator and the base attitude motions. The obtained manipulator motion yields zero attitude disturbance on the base satellite. Reference [19] presents a method for control of micro-macro manipulators. The method splits the control problem into two parts. The first part is to devise a controller which moves the macro manipulator close to the desired path, and the second part is to design a controller to enforce the tracking error of the end-effector to zero. The main advantage of the controller is that it does not try to prevent fast motion of macro manipulator to avoid excitation of higher modes. In [20], fuzzy logic is applied to control a novel two-link robotic arm. The control system has three levels. A conventional controller consisting of the feedback linearization technique combined with proportional-derivative control is used in the bottom level of the hierarchical system to control the servomotors of the robot. A second layer consists of a servo-expert that preprocesses the high-resolution information coming from joint encoders and extracts the status of the system. A third, intelligent layer is added at the top of the hierarchy to complete the control structure. The main purpose of the top level is to tune the parameters of the conventional controller to improve the response of the system.For tethered space robot dynamics and control problem, the involved orbit dynamics is taken into account adequately [21–30]. In [21–25], the main satellite or shuttle (from which the tethered space robot is released out) is on circular orbit around the earth, while in [26–30], the influence of the eccentricity of the main satellite’s ellipse orbit on the dynamics of the tethered system is studied. Compared to the tethered space robot, almost all the dynamics modeling for space manipulator presented in documented literatures to date is conducted with respect to inertial reference system; that is to say, the influence of the relative orbit dynamics between the carrier and the target on the system dynamics modeling is not taken into account. The paper attempts to derive the dynamics model of two-link manipulator when its end-effector approaches target based on Kane method with respect to the carrier body-fixed noninertial coordinate system; that is to say, the relative orbit dynamics of the carrier to the space target is considered in system dynamics modeling. Then the end-effector’s path function and the manipulator’s corresponding joints control torque function are programmed to meet the requirement of soft touch, which means that the relative velocity of the end-effector to the target is zero at touch moment. Finally, numerical simulation will be conducted to validate the work done in the paper.


## 2. System Dynamics Modeling

### 2.1. Preliminary Work

A space target is supposed to fly on a circular orbit around the earth. An operation spacecraft (called carrier uniformly afterwards in the paper) flies freely around the target governed by the well-known homogenous C-W equations [31], as shown in Figure 1. In the figure, the origin of coordinate system oxAyA denotes the space target. Axis oxA points the direction of the velocity of the space target relative to the earth’s center, and axis oyA lies on the extended line from the earth’s center to the space target with the positive direction deviating from the earth. The ellipse denotes the relative trajectory of the carrier to the target and is supposed to be coplanar with the space target’s circular orbit around the earth. The direction of the carrier flying around the target in Figure 1 should be anticlockwise according to C-W equations. Two links of the manipulator are identified as I and II. Their mass, moment of inertia with respect to their centers of mass, length, and angle of rotation are mi,Ji,li,θi (i=1,2 corresponding to I, II), respectively, and both of the two links are assumed to be homogenous in mass. Two motors are mounted on the joints identified as I and II, and their driving torques are M1 and M2, respectively. The distance between joint I and the center of mass of the carrier is d. The assumption that the mass and inertia moment of the carrier is far bigger than that of the manipulator is adopted here, and then the influence of the manipulator’s movement to the carrier can be ignored. We also suppose that the attitude control system of the carrier guarantees its side on which the manipulator is mounted points accurately always the space target during approaching operation.Figure 1
Illustration of space manipulator capturing an on-orbit target around the earth.Some coordinate systems and the corresponding unit orthogonal basis are defined as follows:(1)
Earth-centered inertial coordinate systemoxIyI: the origin is at the center of the earth. Axis oxI points a fixed direction in inertia space. Axis oyI is got by rotating axis oxI with 90o anticlockwise. i→1 and i→2 are unit vectors lying on axes oxI and oyI, respectively, and their directions are the same as the positive directions of the corresponding axes, respectively.(2)
Space target fixed coordinate systemoxAyA: being defined above, it will not be repeated here. a→1 and a→2 are unit vectors lying on axes oxA and oyA, respectively, and their directions are the same as the positive directions of the corresponding axes, respectively.(3)
Carrier body-fixed coordinate systemoxByB: the origin is at the center of mass of the carrier. Axis oxB lies on the extended line from the space target to the carrier with the positive direction deviating from the space target. Axis oyB is got by rotating axis oxB with 90o anticlockwise. b→1 and b→2 are unit vectors lying on axes oxB and oyB, respectively, and their directions are the same as the positive directions of the corresponding axes, respectively.(4)
Link I fixed coordinate systemoxCyC: the origin is at the center of mass of the link I. Axis oxC is aligned with the longitudinal direction of the link with the positive direction deviating from joint I. Axis oyC is got by rotating axis oxC with 90o anticlockwise. c→1 and c→2 are unit vectors lying on axes oxC and oyC, respectively, and their directions are the same as the positive directions of the corresponding axes, respectively.(5)
Link II fixed coordinate systemoxDyD: the origin is at the center of mass of the link II. Axis oxD is aligned with the longitudinal direction of the link with the positive direction deviating from joint II. Axis oyD is got by rotating axis oxD with 90o anticlockwise. d→1 and d→2 are unit vectors lying on axes oxD and oyD, respectively, and their directions are the same as the positive directions of the corresponding axes, respectively.In accordance with the above definition, the vector groupsI≜(i→1,i→2), A≜(a→1,a→2), B≜(b→1,b→2), C≜(c→1,c→2), D≜(d→1,d→2) are all unit orthogonal basis vector groups with the transformation relations among them as follows:(1)A=ITIA,B=ATAB,C=BTBC,D=CTCD,(2)B=ITIA·TAB=ITIB,where the transformation matrixes are as follows:(3)TIA=cos⁡ntsin⁡nt-sin⁡ntcos⁡nt,TAB=cos⁡ϕ-sin⁡ϕsin⁡ϕcos⁡ϕ,TBC=-sin⁡θ1-cos⁡θ1cos⁡θ1-sin⁡θ1,TCD=-cos⁡θ2-sin⁡θ2sin⁡θ2-cos⁡θ2,(4)TIB=TIA·TAB=cos⁡nt-ϕsin⁡nt-ϕ-sin⁡nt-ϕcos⁡nt-ϕ.The following equations can be easily obtained accordingly:(5)TIBT·T˙IB=0n-ϕ˙ϕ˙-n0.What should be pointed out is that a vector keeps its value when being moved in parallel. So unit orthogonal basis of vector groupsC and D can be moved in parallel departing from their corresponding coordinate systems oxCyC and oxDyD, as shown in Figure 1.In Figure1, coordinate system oxAyA is fixed upon the space target and moves around the earth at a constant angular velocity n=μ/R3, where μ=GMe, and G, Me, R are gravitational constant, the mass of the earth, and the radius of the space target’s circular orbit, respectively. We know that with a group of specific initial conditions the relative trajectory of the carrier to the space target is an ellipse with eccentricity ratio of 3/2, and the relative motion equations are as follows under the coordinate system oxAyA [31]:(6a)x¨=-2ny˙,y¨=3n2y+2nx˙,(6b)x˙=-2ny0cos⁡nt-nx0sin⁡nt,y˙=n2x0cos⁡nt-ny0sin⁡nt,(6c)x=x0cos⁡nt-2y0sin⁡nt,y=y0cos⁡nt+x02sin⁡nt,where x0,y0 denote the position coordinates of the carrier relative to the target at initial moment (t=0).The following equations can be obtained easily:(7a)r=x2+y2,ϕ=arctan⁡yxappropriate  for  first  quadrant,(7b)r˙=x˙cos⁡ϕ+y˙sin⁡ϕ,ϕ˙=-x˙sin⁡ϕ+y˙cos⁡ϕr,(7c)r¨=rϕ˙2+x¨cos⁡ϕ+y¨sin⁡ϕ,ϕ¨=-2r˙ϕ˙-x¨sin⁡ϕ+y¨cos⁡ϕr,where r is the distance between the center of the carrier and the space target and ϕ is the phase angle of the carrier flying around the target.We know the origin of coordinate systemoxAyA moves around the earth at angular velocity n; meanwhile, the coordinate system rotates about its own origin at the same angular velocity. So the coordinate system is noninertial. Nevertheless, its translational movement around the earth as well as the gravities exerted on the objects under the coordinate system (which are the manipulator and its carrier) can be out of consideration simultaneously, since the translational movement of the coordinate system originates from the gravity. So the equivalent centrifugal forces exerted on the objects under the coordinate system resulted from the coordinate system’s circle movement counteract exactly the corresponding gravities of them. However the rotation of coordinate system oxAyA about its own origin should be considered in dynamics modeling. Coordinate system oxByB moves around the space target (the trajectory is an ellipse) and meanwhile rotates about its own origin at angular velocity ϕ˙. According to the analysis above, the linear acceleration of coordinate system oxByB relative to oxAyA can be regarded as that relative to inertial reference system; meanwhile, the angular velocity of coordinate system oxByB relative to coordinate system oxAyA (it is ϕ˙) minus that of oxAyA relative to inertial reference system (it is n) is equal to that of oxByB relative to inertial reference system. Obviously it is ϕ˙-n. So the effects of the linear acceleration of coordinate system oxByB relative to oxAyA and its rotation angular velocity relative to inertial reference system should be considered in system dynamics modeling.


### 2.2. Analysis of Kinematics and Mechanics

The position vector of the origin of coordinate systemoxByB relative to the space target is (8)r→=Br0.The time derivative of (8) is (9)v→≜dr→dt=dBdtr0+Βr˙0.In the same way, the time derivative of (9) is (10)a→≜dv→dt=d2Bdt2r0+2dBdtr˙0+Βr¨0,where v→ and a→ are the velocity and acceleration of the origin of coordinate system oxByB relative to the space target, respectively. According to (2), we obtain(11a)dBdt=IT˙IB=BTIBT·T˙IB,(11b)d2Bdt2=BTIBTT˙IB2+BddtTIBT·T˙IB.The rotation angular velocity and acceleration of coordinate systemoxByB relative to inertial reference system are, respectively, given as follows:(12)ω→=b→3ϕ˙-n,ε→=b→3ϕ¨,where b→3=b→1×b→2.The position vector of the center of mass of link I relative to the origin of coordinate systemoxByB is(13)r→1c=d→+12l→1,where(14)d→=B-d0,l→1=Cl10.Substituting (14) into (13) meanwhile employing the third equation of (1) and the third equation of (3) yields(15)r→1c=B-d-l12sin⁡θ1l12cos⁡θ1.Taking the first and second order time relative derivative of (15) yields the relative velocity and acceleration of the center of mass of link I with respect to coordinate system oxByB as follows:(16)v→1c=Bddt-d-l12sin⁡θ1l12cos⁡θ1.a→1c=Bd2dt2-d-l12sin⁡θ1l12cos⁡θ1.(Note: the relative derivative of r→1c does not contain the term (dB/dt)-d-l1/2sin⁡θ1(l1/2)cos⁡θ1. The same rule is suitable for the calculation of relative derivative of v→1c.)The rotation angular velocity and acceleration of link I relative to coordinate systemoxByB are, respectively, given as follows:(17)ω→1=b→3θ˙1,(18)ε→1=b→3θ¨1.The all forces upon link I (including the inertia forces) except for the constraint ones will be analyzed below.The inertia force upon link I induced by linear accelerationa→ of coordinate system oxByB is(19)F→1a=-m1a→.The centrifugal force induced by rotation angular velocityω→ of coordinate system oxByB is (20)F→1ω=-m1ω→×ω→×r→1c.The inertia force induced by rotation angular accelerationε→ of coordinate system oxByB is (21)F→1ε=-m1ε→×r→1c.The Coriolis force induced commonly byω→ and v→1c is (22)F→1C=-2m1ω→×v→1c.The relative inertia force induced by relative accelerationa→1c of the center of mass of link I is (23)F→1a1c=-m1a→1c.All the moments of force (including the inertia forces) with respect to link I’s center of mass will be analyzed below.It can be proved that the moments ofF→1a, F→1ω, F→1C are all zero (proof can be seen in Appendix). The moment of inertia force F→1ε is (24)M→1ε=-J1ε→.The moment of inertia force induced by relative angular accelerationε→1 of link I is (25)M→1ε1=-J1ε→1.Finally, the torque exerted on link I by the motors mounted on joints I and II is(26)M→1′=b→3M1+M2.The resultant force and moment exerted on link I are, respectively,(27)F→1=F→1a+F→1ω+F→1ε+F→1C+F→1a1c,M→1total=M→1ε+M→1ε1+M→1′.Now we study link II.The position vector of the center of mass of link II relative to the origin of coordinate systemoxByB can be calculated out in the same way as for link I mentioned before:(28)r→2c=B-d-l1sin⁡θ1+12l2sin⁡θ1-θ2l1cos⁡θ1-12l2cos⁡θ1-θ2.Taking the first and second order time relative derivative of (28) yields the relative velocity and acceleration of the center of mass of link II with respect to coordinate system oxByB as follows:(29)v→2c=Bddt-d-l1sin⁡θ1+12l2sin⁡θ1-θ2l1cos⁡θ1-12l2cos⁡θ1-θ2a→2c=Bd2dt2-d-l1sin⁡θ1+12l2sin⁡θ1-θ2l1cos⁡θ1-12l2cos⁡θ1-θ2.The relative rotation angular velocity and acceleration of link II to coordinate systemoxByB are, respectively,(30)ω→2=b→3θ˙1-θ˙2,(31)ε→2=b→3θ¨1-θ¨2.The inertia force upon link II induced by linear accelerationa→ of coordinate system oxByB is(32)F→2a=-m2a→.The centrifugal inertia force induced by rotation angular velocityω→ of coordinate system oxByB is(33)F→2ω=-m2ω→×ω→×r→2c.The inertia force induced by rotation angular accelerationε→ of coordinate system oxByB is(34)F→2ε=-m2ε→×r→2c.The Coriolis force induced commonly byω→ and v→2c is(35)F→2C=-2m2ω→×v→2c.The relative inertia force induced by relative accelerationa→2c of the center of mass of link II is (36)F→2a2c=-m2a→2c.All the moments of force (including the inertia forces) with respect to link II’s center of mass will be analyzed below.For the same reason as for link I aforementioned, among the moments of the inertia forces induced by the translational motion or rotation of coordinate systemoxByB, only the moment of inertia force F→2ε needs to be calculated here as follows:(37)M→2ε=-J2ε→.In addition, the moment of inertia force induced by relative angular accelerationε→2 of link II is (38)M→2ε2=-J2ε→2.Finally, the torque exerted on link II by the motor mounted on joint II is(39)M→2′=b→3-M2.The resultant force and moment exerted on link II are, respectively,(40)F→2=F→2a+F→2ω+F→2ε+F→2C+F→2a2c,M→2total=M→2ε+M→2ε2+M→2′.


### 2.3. Equilibrium Equations of Generalized Forces

The essence of Kane method is to project all the active and inertia forces on the directions of the generalized coordinate curves, converting them into generalized forces, and then to write the equilibrium equations of the generalized forces. So it is also called generalized D’Alembert’s principle. For the multibody system of two-link manipulator researched in the paper, rotation anglesθ1 and θ2 of links I and II are defined as generalized coordinates, so the matrixes of projection (called partial velocity and/or partial angular velocity in Kane method) can be calculated out according to (15), (17), (28), and (30) as follows:(41)
∂
v
→
1
c
∂
θ
˙
1
=
∂
r
→
1
c
∂
θ
1
=
B
-
l
1
2
cos
⁡
θ
1
-
l
1
2
sin
⁡
θ
1
,
∂
v
→
1
c
∂
θ
˙
2
=
∂
r
→
1
c
∂
θ
2
=
0
,
∂
v
→
2
c
∂
θ
˙
1
=
∂
r
→
2
c
∂
θ
1
=
B
-
l
1
cos
⁡
θ
1
+
1
2
l
2
cos
⁡
θ
1
-
θ
2
-
l
1
sin
⁡
θ
1
+
1
2
l
2
sin
⁡
θ
1
-
θ
2
,
∂
v
→
2
c
∂
θ
˙
2
=
∂
r
→
2
c
∂
θ
2
=
B
-
1
2
l
2
cos
⁡
θ
1
-
θ
2
-
1
2
l
2
sin
⁡
θ
1
-
θ
2
,
∂
ω
→
1
∂
θ
˙
1
=
b
→
3
,
∂
ω
→
1
∂
θ
˙
2
=
0
,
∂
ω
→
2
∂
θ
˙
1
=
b
→
3
,
∂
ω
→
2
∂
θ
˙
2
=
-
b
→
3
.The equilibrium equations of the generalized forces are(42)F→1·∂r→1c∂θ1+F→2·∂r→2c∂θ1+M→1total·∂ω→1∂θ˙1+M→2total·∂ω→2∂θ˙1=0,F→1·∂r→1c∂θ2+F→2·∂r→2c∂θ2+M→1total·∂ω→1∂θ˙2+M→2total·∂ω→2∂θ˙2=0.Substituting (5), (10)~(12), (15)~(16), (18)~(29), and (31)~(41) into (42) yields the system dynamics equations of the two-link manipulator as follows:(43a)
-
J
1
+
J
2
+
1
4
m
1
l
1
2
+
m
2
l
1
2
+
1
4
m
2
l
2
2
-
m
2
l
1
l
2
cos
⁡
θ
2
θ
¨
1
+
J
2
+
1
4
m
2
l
2
2
-
1
2
m
2
l
1
l
2
cos
⁡
θ
2
θ
¨
2
+
1
2
m
1
l
1
cos
⁡
θ
1
+
m
2
l
1
cos
⁡
θ
1
-
1
2
m
2
l
2
cos
⁡
θ
1
-
θ
2
d
-
r
n
2
-
m
1
+
2
m
2
l
1
sin
⁡
θ
1
-
m
2
l
2
sin
⁡
θ
1
-
θ
2
n
r
˙
-
m
1
l
1
cos
⁡
θ
1
+
2
m
2
l
1
cos
⁡
θ
1
-
m
2
l
2
cos
⁡
θ
1
-
θ
2
d
-
r
n
ϕ
˙
+
1
2
m
1
+
m
2
l
1
cos
⁡
θ
1
-
1
2
m
2
l
2
cos
⁡
θ
1
-
θ
2
r
¨
-
J
1
+
J
2
+
1
4
m
1
l
1
2
+
m
2
l
1
2
+
1
4
m
2
l
2
2
+
1
2
m
1
+
m
2
d
-
r
l
1
sin
⁡
θ
1
-
1
2
m
2
d
-
r
l
2
sin
⁡
θ
1
-
θ
2
-
m
2
l
1
l
2
cos
⁡
θ
2
ϕ
¨
+
1
2
m
1
+
m
2
l
1
cos
⁡
θ
1
-
1
2
m
2
l
2
cos
⁡
θ
1
-
θ
2
d
-
r
ϕ
˙
2
+
m
1
+
2
m
2
l
1
sin
⁡
θ
1
-
m
2
l
2
sin
⁡
θ
1
-
θ
2
r
˙
ϕ
˙
+
m
2
l
1
l
2
n
-
ϕ
˙
θ
˙
2
sin
⁡
θ
2
+
1
2
m
2
l
1
l
2
θ
˙
2
2
sin
⁡
θ
2
-
m
2
l
1
l
2
θ
˙
1
θ
˙
2
sin
⁡
θ
2
+
M
1
=
0
,
(43b)
J
2
+
1
4
m
2
l
2
2
-
1
2
m
2
l
1
l
2
cos
⁡
θ
2
θ
¨
1
-
J
2
+
1
4
m
2
l
2
2
θ
¨
2
+
1
2
m
2
d
-
r
c
o
s
θ
1
-
θ
2
+
l
1
sin
⁡
θ
2
l
2
n
2
-
m
2
l
2
n
r
˙
sin
⁡
θ
1
-
θ
2
-
m
2
d
-
r
cos
⁡
θ
1
-
θ
2
+
l
1
sin
⁡
θ
2
l
2
n
ϕ
˙
+
1
2
m
2
l
2
r
¨
cos
⁡
θ
1
-
θ
2
+
J
2
+
1
4
m
2
l
2
2
+
1
2
m
2
r
-
d
l
2
sin
⁡
θ
1
-
θ
2
-
1
2
m
2
l
1
l
2
cos
⁡
θ
2
ϕ
¨
+
1
2
m
2
d
-
r
cos
⁡
θ
1
-
θ
2
+
l
1
sin
⁡
θ
2
l
2
ϕ
˙
2
+
m
2
l
2
r
˙
ϕ
˙
sin
⁡
θ
1
-
θ
2
+
m
2
l
1
l
2
ϕ
˙
-
n
θ
˙
1
sin
⁡
θ
2
+
1
2
m
2
l
1
l
2
θ
˙
1
2
sin
⁡
θ
2
+
M
2
=
0
.


## 2.1. Preliminary Work

A space target is supposed to fly on a circular orbit around the earth. An operation spacecraft (called carrier uniformly afterwards in the paper) flies freely around the target governed by the well-known homogenous C-W equations [31], as shown in Figure 1. In the figure, the origin of coordinate system oxAyA denotes the space target. Axis oxA points the direction of the velocity of the space target relative to the earth’s center, and axis oyA lies on the extended line from the earth’s center to the space target with the positive direction deviating from the earth. The ellipse denotes the relative trajectory of the carrier to the target and is supposed to be coplanar with the space target’s circular orbit around the earth. The direction of the carrier flying around the target in Figure 1 should be anticlockwise according to C-W equations. Two links of the manipulator are identified as I and II. Their mass, moment of inertia with respect to their centers of mass, length, and angle of rotation are mi,Ji,li,θi (i=1,2 corresponding to I, II), respectively, and both of the two links are assumed to be homogenous in mass. Two motors are mounted on the joints identified as I and II, and their driving torques are M1 and M2, respectively. The distance between joint I and the center of mass of the carrier is d. The assumption that the mass and inertia moment of the carrier is far bigger than that of the manipulator is adopted here, and then the influence of the manipulator’s movement to the carrier can be ignored. We also suppose that the attitude control system of the carrier guarantees its side on which the manipulator is mounted points accurately always the space target during approaching operation.Figure 1
Illustration of space manipulator capturing an on-orbit target around the earth.Some coordinate systems and the corresponding unit orthogonal basis are defined as follows:(1)
Earth-centered inertial coordinate systemoxIyI: the origin is at the center of the earth. Axis oxI points a fixed direction in inertia space. Axis oyI is got by rotating axis oxI with 90o anticlockwise. i→1 and i→2 are unit vectors lying on axes oxI and oyI, respectively, and their directions are the same as the positive directions of the corresponding axes, respectively.(2)
Space target fixed coordinate systemoxAyA: being defined above, it will not be repeated here. a→1 and a→2 are unit vectors lying on axes oxA and oyA, respectively, and their directions are the same as the positive directions of the corresponding axes, respectively.(3)
Carrier body-fixed coordinate systemoxByB: the origin is at the center of mass of the carrier. Axis oxB lies on the extended line from the space target to the carrier with the positive direction deviating from the space target. Axis oyB is got by rotating axis oxB with 90o anticlockwise. b→1 and b→2 are unit vectors lying on axes oxB and oyB, respectively, and their directions are the same as the positive directions of the corresponding axes, respectively.(4)
Link I fixed coordinate systemoxCyC: the origin is at the center of mass of the link I. Axis oxC is aligned with the longitudinal direction of the link with the positive direction deviating from joint I. Axis oyC is got by rotating axis oxC with 90o anticlockwise. c→1 and c→2 are unit vectors lying on axes oxC and oyC, respectively, and their directions are the same as the positive directions of the corresponding axes, respectively.(5)
Link II fixed coordinate systemoxDyD: the origin is at the center of mass of the link II. Axis oxD is aligned with the longitudinal direction of the link with the positive direction deviating from joint II. Axis oyD is got by rotating axis oxD with 90o anticlockwise. d→1 and d→2 are unit vectors lying on axes oxD and oyD, respectively, and their directions are the same as the positive directions of the corresponding axes, respectively.In accordance with the above definition, the vector groupsI≜(i→1,i→2), A≜(a→1,a→2), B≜(b→1,b→2), C≜(c→1,c→2), D≜(d→1,d→2) are all unit orthogonal basis vector groups with the transformation relations among them as follows:(1)A=ITIA,B=ATAB,C=BTBC,D=CTCD,(2)B=ITIA·TAB=ITIB,where the transformation matrixes are as follows:(3)TIA=cos⁡ntsin⁡nt-sin⁡ntcos⁡nt,TAB=cos⁡ϕ-sin⁡ϕsin⁡ϕcos⁡ϕ,TBC=-sin⁡θ1-cos⁡θ1cos⁡θ1-sin⁡θ1,TCD=-cos⁡θ2-sin⁡θ2sin⁡θ2-cos⁡θ2,(4)TIB=TIA·TAB=cos⁡nt-ϕsin⁡nt-ϕ-sin⁡nt-ϕcos⁡nt-ϕ.The following equations can be easily obtained accordingly:(5)TIBT·T˙IB=0n-ϕ˙ϕ˙-n0.What should be pointed out is that a vector keeps its value when being moved in parallel. So unit orthogonal basis of vector groupsC and D can be moved in parallel departing from their corresponding coordinate systems oxCyC and oxDyD, as shown in Figure 1.In Figure1, coordinate system oxAyA is fixed upon the space target and moves around the earth at a constant angular velocity n=μ/R3, where μ=GMe, and G, Me, R are gravitational constant, the mass of the earth, and the radius of the space target’s circular orbit, respectively. We know that with a group of specific initial conditions the relative trajectory of the carrier to the space target is an ellipse with eccentricity ratio of 3/2, and the relative motion equations are as follows under the coordinate system oxAyA [31]:(6a)x¨=-2ny˙,y¨=3n2y+2nx˙,(6b)x˙=-2ny0cos⁡nt-nx0sin⁡nt,y˙=n2x0cos⁡nt-ny0sin⁡nt,(6c)x=x0cos⁡nt-2y0sin⁡nt,y=y0cos⁡nt+x02sin⁡nt,where x0,y0 denote the position coordinates of the carrier relative to the target at initial moment (t=0).The following equations can be obtained easily:(7a)r=x2+y2,ϕ=arctan⁡yxappropriate  for  first  quadrant,(7b)r˙=x˙cos⁡ϕ+y˙sin⁡ϕ,ϕ˙=-x˙sin⁡ϕ+y˙cos⁡ϕr,(7c)r¨=rϕ˙2+x¨cos⁡ϕ+y¨sin⁡ϕ,ϕ¨=-2r˙ϕ˙-x¨sin⁡ϕ+y¨cos⁡ϕr,where r is the distance between the center of the carrier and the space target and ϕ is the phase angle of the carrier flying around the target.We know the origin of coordinate systemoxAyA moves around the earth at angular velocity n; meanwhile, the coordinate system rotates about its own origin at the same angular velocity. So the coordinate system is noninertial. Nevertheless, its translational movement around the earth as well as the gravities exerted on the objects under the coordinate system (which are the manipulator and its carrier) can be out of consideration simultaneously, since the translational movement of the coordinate system originates from the gravity. So the equivalent centrifugal forces exerted on the objects under the coordinate system resulted from the coordinate system’s circle movement counteract exactly the corresponding gravities of them. However the rotation of coordinate system oxAyA about its own origin should be considered in dynamics modeling. Coordinate system oxByB moves around the space target (the trajectory is an ellipse) and meanwhile rotates about its own origin at angular velocity ϕ˙. According to the analysis above, the linear acceleration of coordinate system oxByB relative to oxAyA can be regarded as that relative to inertial reference system; meanwhile, the angular velocity of coordinate system oxByB relative to coordinate system oxAyA (it is ϕ˙) minus that of oxAyA relative to inertial reference system (it is n) is equal to that of oxByB relative to inertial reference system. Obviously it is ϕ˙-n. So the effects of the linear acceleration of coordinate system oxByB relative to oxAyA and its rotation angular velocity relative to inertial reference system should be considered in system dynamics modeling.


## 2.2. Analysis of Kinematics and Mechanics

The position vector of the origin of coordinate systemoxByB relative to the space target is (8)r→=Br0.The time derivative of (8) is (9)v→≜dr→dt=dBdtr0+Βr˙0.In the same way, the time derivative of (9) is (10)a→≜dv→dt=d2Bdt2r0+2dBdtr˙0+Βr¨0,where v→ and a→ are the velocity and acceleration of the origin of coordinate system oxByB relative to the space target, respectively. According to (2), we obtain(11a)dBdt=IT˙IB=BTIBT·T˙IB,(11b)d2Bdt2=BTIBTT˙IB2+BddtTIBT·T˙IB.The rotation angular velocity and acceleration of coordinate systemoxByB relative to inertial reference system are, respectively, given as follows:(12)ω→=b→3ϕ˙-n,ε→=b→3ϕ¨,where b→3=b→1×b→2.The position vector of the center of mass of link I relative to the origin of coordinate systemoxByB is(13)r→1c=d→+12l→1,where(14)d→=B-d0,l→1=Cl10.Substituting (14) into (13) meanwhile employing the third equation of (1) and the third equation of (3) yields(15)r→1c=B-d-l12sin⁡θ1l12cos⁡θ1.Taking the first and second order time relative derivative of (15) yields the relative velocity and acceleration of the center of mass of link I with respect to coordinate system oxByB as follows:(16)v→1c=Bddt-d-l12sin⁡θ1l12cos⁡θ1.a→1c=Bd2dt2-d-l12sin⁡θ1l12cos⁡θ1.(Note: the relative derivative of r→1c does not contain the term (dB/dt)-d-l1/2sin⁡θ1(l1/2)cos⁡θ1. The same rule is suitable for the calculation of relative derivative of v→1c.)The rotation angular velocity and acceleration of link I relative to coordinate systemoxByB are, respectively, given as follows:(17)ω→1=b→3θ˙1,(18)ε→1=b→3θ¨1.The all forces upon link I (including the inertia forces) except for the constraint ones will be analyzed below.The inertia force upon link I induced by linear accelerationa→ of coordinate system oxByB is(19)F→1a=-m1a→.The centrifugal force induced by rotation angular velocityω→ of coordinate system oxByB is (20)F→1ω=-m1ω→×ω→×r→1c.The inertia force induced by rotation angular accelerationε→ of coordinate system oxByB is (21)F→1ε=-m1ε→×r→1c.The Coriolis force induced commonly byω→ and v→1c is (22)F→1C=-2m1ω→×v→1c.The relative inertia force induced by relative accelerationa→1c of the center of mass of link I is (23)F→1a1c=-m1a→1c.All the moments of force (including the inertia forces) with respect to link I’s center of mass will be analyzed below.It can be proved that the moments ofF→1a, F→1ω, F→1C are all zero (proof can be seen in Appendix). The moment of inertia force F→1ε is (24)M→1ε=-J1ε→.The moment of inertia force induced by relative angular accelerationε→1 of link I is (25)M→1ε1=-J1ε→1.Finally, the torque exerted on link I by the motors mounted on joints I and II is(26)M→1′=b→3M1+M2.The resultant force and moment exerted on link I are, respectively,(27)F→1=F→1a+F→1ω+F→1ε+F→1C+F→1a1c,M→1total=M→1ε+M→1ε1+M→1′.Now we study link II.The position vector of the center of mass of link II relative to the origin of coordinate systemoxByB can be calculated out in the same way as for link I mentioned before:(28)r→2c=B-d-l1sin⁡θ1+12l2sin⁡θ1-θ2l1cos⁡θ1-12l2cos⁡θ1-θ2.Taking the first and second order time relative derivative of (28) yields the relative velocity and acceleration of the center of mass of link II with respect to coordinate system oxByB as follows:(29)v→2c=Bddt-d-l1sin⁡θ1+12l2sin⁡θ1-θ2l1cos⁡θ1-12l2cos⁡θ1-θ2a→2c=Bd2dt2-d-l1sin⁡θ1+12l2sin⁡θ1-θ2l1cos⁡θ1-12l2cos⁡θ1-θ2.The relative rotation angular velocity and acceleration of link II to coordinate systemoxByB are, respectively,(30)ω→2=b→3θ˙1-θ˙2,(31)ε→2=b→3θ¨1-θ¨2.The inertia force upon link II induced by linear accelerationa→ of coordinate system oxByB is(32)F→2a=-m2a→.The centrifugal inertia force induced by rotation angular velocityω→ of coordinate system oxByB is(33)F→2ω=-m2ω→×ω→×r→2c.The inertia force induced by rotation angular accelerationε→ of coordinate system oxByB is(34)F→2ε=-m2ε→×r→2c.The Coriolis force induced commonly byω→ and v→2c is(35)F→2C=-2m2ω→×v→2c.The relative inertia force induced by relative accelerationa→2c of the center of mass of link II is (36)F→2a2c=-m2a→2c.All the moments of force (including the inertia forces) with respect to link II’s center of mass will be analyzed below.For the same reason as for link I aforementioned, among the moments of the inertia forces induced by the translational motion or rotation of coordinate systemoxByB, only the moment of inertia force F→2ε needs to be calculated here as follows:(37)M→2ε=-J2ε→.In addition, the moment of inertia force induced by relative angular accelerationε→2 of link II is (38)M→2ε2=-J2ε→2.Finally, the torque exerted on link II by the motor mounted on joint II is(39)M→2′=b→3-M2.The resultant force and moment exerted on link II are, respectively,(40)F→2=F→2a+F→2ω+F→2ε+F→2C+F→2a2c,M→2total=M→2ε+M→2ε2+M→2′.


## 2.3. Equilibrium Equations of Generalized Forces

The essence of Kane method is to project all the active and inertia forces on the directions of the generalized coordinate curves, converting them into generalized forces, and then to write the equilibrium equations of the generalized forces. So it is also called generalized D’Alembert’s principle. For the multibody system of two-link manipulator researched in the paper, rotation anglesθ1 and θ2 of links I and II are defined as generalized coordinates, so the matrixes of projection (called partial velocity and/or partial angular velocity in Kane method) can be calculated out according to (15), (17), (28), and (30) as follows:(41)
∂
v
→
1
c
∂
θ
˙
1
=
∂
r
→
1
c
∂
θ
1
=
B
-
l
1
2
cos
⁡
θ
1
-
l
1
2
sin
⁡
θ
1
,
∂
v
→
1
c
∂
θ
˙
2
=
∂
r
→
1
c
∂
θ
2
=
0
,
∂
v
→
2
c
∂
θ
˙
1
=
∂
r
→
2
c
∂
θ
1
=
B
-
l
1
cos
⁡
θ
1
+
1
2
l
2
cos
⁡
θ
1
-
θ
2
-
l
1
sin
⁡
θ
1
+
1
2
l
2
sin
⁡
θ
1
-
θ
2
,
∂
v
→
2
c
∂
θ
˙
2
=
∂
r
→
2
c
∂
θ
2
=
B
-
1
2
l
2
cos
⁡
θ
1
-
θ
2
-
1
2
l
2
sin
⁡
θ
1
-
θ
2
,
∂
ω
→
1
∂
θ
˙
1
=
b
→
3
,
∂
ω
→
1
∂
θ
˙
2
=
0
,
∂
ω
→
2
∂
θ
˙
1
=
b
→
3
,
∂
ω
→
2
∂
θ
˙
2
=
-
b
→
3
.The equilibrium equations of the generalized forces are(42)F→1·∂r→1c∂θ1+F→2·∂r→2c∂θ1+M→1total·∂ω→1∂θ˙1+M→2total·∂ω→2∂θ˙1=0,F→1·∂r→1c∂θ2+F→2·∂r→2c∂θ2+M→1total·∂ω→1∂θ˙2+M→2total·∂ω→2∂θ˙2=0.Substituting (5), (10)~(12), (15)~(16), (18)~(29), and (31)~(41) into (42) yields the system dynamics equations of the two-link manipulator as follows:(43a)
-
J
1
+
J
2
+
1
4
m
1
l
1
2
+
m
2
l
1
2
+
1
4
m
2
l
2
2
-
m
2
l
1
l
2
cos
⁡
θ
2
θ
¨
1
+
J
2
+
1
4
m
2
l
2
2
-
1
2
m
2
l
1
l
2
cos
⁡
θ
2
θ
¨
2
+
1
2
m
1
l
1
cos
⁡
θ
1
+
m
2
l
1
cos
⁡
θ
1
-
1
2
m
2
l
2
cos
⁡
θ
1
-
θ
2
d
-
r
n
2
-
m
1
+
2
m
2
l
1
sin
⁡
θ
1
-
m
2
l
2
sin
⁡
θ
1
-
θ
2
n
r
˙
-
m
1
l
1
cos
⁡
θ
1
+
2
m
2
l
1
cos
⁡
θ
1
-
m
2
l
2
cos
⁡
θ
1
-
θ
2
d
-
r
n
ϕ
˙
+
1
2
m
1
+
m
2
l
1
cos
⁡
θ
1
-
1
2
m
2
l
2
cos
⁡
θ
1
-
θ
2
r
¨
-
J
1
+
J
2
+
1
4
m
1
l
1
2
+
m
2
l
1
2
+
1
4
m
2
l
2
2
+
1
2
m
1
+
m
2
d
-
r
l
1
sin
⁡
θ
1
-
1
2
m
2
d
-
r
l
2
sin
⁡
θ
1
-
θ
2
-
m
2
l
1
l
2
cos
⁡
θ
2
ϕ
¨
+
1
2
m
1
+
m
2
l
1
cos
⁡
θ
1
-
1
2
m
2
l
2
cos
⁡
θ
1
-
θ
2
d
-
r
ϕ
˙
2
+
m
1
+
2
m
2
l
1
sin
⁡
θ
1
-
m
2
l
2
sin
⁡
θ
1
-
θ
2
r
˙
ϕ
˙
+
m
2
l
1
l
2
n
-
ϕ
˙
θ
˙
2
sin
⁡
θ
2
+
1
2
m
2
l
1
l
2
θ
˙
2
2
sin
⁡
θ
2
-
m
2
l
1
l
2
θ
˙
1
θ
˙
2
sin
⁡
θ
2
+
M
1
=
0
,
(43b)
J
2
+
1
4
m
2
l
2
2
-
1
2
m
2
l
1
l
2
cos
⁡
θ
2
θ
¨
1
-
J
2
+
1
4
m
2
l
2
2
θ
¨
2
+
1
2
m
2
d
-
r
c
o
s
θ
1
-
θ
2
+
l
1
sin
⁡
θ
2
l
2
n
2
-
m
2
l
2
n
r
˙
sin
⁡
θ
1
-
θ
2
-
m
2
d
-
r
cos
⁡
θ
1
-
θ
2
+
l
1
sin
⁡
θ
2
l
2
n
ϕ
˙
+
1
2
m
2
l
2
r
¨
cos
⁡
θ
1
-
θ
2
+
J
2
+
1
4
m
2
l
2
2
+
1
2
m
2
r
-
d
l
2
sin
⁡
θ
1
-
θ
2
-
1
2
m
2
l
1
l
2
cos
⁡
θ
2
ϕ
¨
+
1
2
m
2
d
-
r
cos
⁡
θ
1
-
θ
2
+
l
1
sin
⁡
θ
2
l
2
ϕ
˙
2
+
m
2
l
2
r
˙
ϕ
˙
sin
⁡
θ
1
-
θ
2
+
m
2
l
1
l
2
ϕ
˙
-
n
θ
˙
1
sin
⁡
θ
2
+
1
2
m
2
l
1
l
2
θ
˙
1
2
sin
⁡
θ
2
+
M
2
=
0
.


## 3. Design of the Control Torque of Joints

The related information of space target such as its position relative to the carrier or the end-effector can be obtained easily by the camera mounted on the carrier-manipulator system [32–34]. The end-effector of the manipulator is programmed to move along a virtual line from the center of mass of the carrier to the space target until touch happens. At initial moment (t=0), the manipulator is folded at θ1=θ10 and θ2=θ20=2θ10, where θ10 is a positive small value. Assuming l1=l2, then the end-effector of the manipulator locates at a virtual line from the center of mass of the carrier to the space target, and the distance between them is r-d-2l1sin⁡θ10. At the initial moment, the manipulator is static relative to the carrier; that is, θ˙1=θ˙2=0; nevertheless, the end-effector moves toward the space target with the radial velocity r˙ induced by the carrier’s relative motion to the target. We set the time t=tf when the soft touch between the end-effector and the space target happens; that is, the distance and relative velocity between them reach zero simultaneously. We program the distance between the end-effector and the space target with respect to time as in the following polynomial function:(44a)ρct=a0+a1t+a2t2+a3t3.So(44b)ρ˙ct=a1+2a2t+3a3t2(44c)ρ¨ct=2a2+6a3t.where ai (i = 0~3) can be determined by the boundary conditions in time domain as follows:(45)ρc0=a0=r0-d-2l1sin⁡θ10ρ˙c0=a1=r˙0ρctf=a0+a1tf+a2tf2+a3tf3=0ρ˙ctf=a1+2a2tf+3a3tf2=0.The parametersai (i = 0~3) can be solved out easily according to (44a), (44b), (44c), and (45):(46)a0=r0-d-2l1sin⁡θ10,a1=r˙0,a2=-2a1tf+3a0tf2,a3=a1tf+2a0tf3.The command of the position of the end-effector under coordinate systemoxAyA should be as follows to meet the requirement aforementioned that the end-effector locates always at a virtual line from the center of mass of the carrier to the space target:(47)xc=ρccos⁡ϕ,yc=ρcsin⁡ϕ.The actual position coordinates of the end-effector are denoted by(xe,ye), so we should demand(48)xe=xc,ye=yc.The two-order time derivative of (48) is(49)x¨e=x¨c,y¨e=y¨c.The position vector of the end-effector relative to the space target is(50)r→e=Axeye=r→+d→+l→1+l→2,where (51)l→2=Dl20.Substituting (8), (14), and (51) into (50) meanwhile employing (1) and (3) yields the following: (52)xe=r-dcos⁡ϕ-l1sin⁡ϕ+θ1+l2sin⁡ϕ+θ1-θ2,ye=r-dsin⁡ϕ+l1cos⁡ϕ+θ1-l2cos⁡ϕ+θ1-θ2.Taking the second order derivative of (47) and (52) with respect to time, then substituting the results into (49) yields the following:(53)θ¨1=1l1sin⁡θ2ρ¨c-r¨sin⁡θ1-θ2-l1sin⁡θ2+d-r+ρccos⁡θ1-θ2ϕ¨+r-d-ρcsin⁡θ1-θ2-l1cos⁡θ2+l2ϕ˙2+2r˙-ρ˙cϕ˙cos⁡θ1-θ2+2l2-l1cos⁡θ2ϕ˙θ˙1-2l2ϕ˙θ˙2+l2-l1cos⁡θ2θ˙12+l2θ˙22-2l2θ˙1θ˙2θ¨2=1l1l2sin⁡θ2r¨-ρ¨cl1sin⁡θ1-l2sin⁡θ1-θ2+ϕ¨d-r+ρcl1cos⁡θ1-l2cos⁡θ1-θ2+l12+l22+d+ρc-rl1sin⁡θ1-l2sin⁡θ1-θ2-2l1l2cos⁡θ2ϕ˙2+2ρ˙c-rϕ˙l1cos⁡θ1-l2cos⁡θ1-θ2+2l12+l22-2l1l2cos⁡θ2ϕ˙θ˙1+2l1cos⁡θ2-l2l2ϕ˙θ˙2+l12+l22-2l1l2cos⁡θ2θ˙12+l2-l1cos⁡θ2l2θ˙22+2l1cos⁡θ2-l2l2θ˙1θ˙2.θ ¨ 1 , θ ¨ 2 shown in (53) are the demanded rotation angular acceleration of links I and II, respectively, for that the end-effector of the manipulator can move in our programmed path aforementioned and touch the target softly at final time tf.Substituting (6a), (6b), (6c), (7a), (7b), (7c), (44a), (44b), (44c), (46), and (53) into (43a) and (43b) can yield the demanded driving torques M1 and M2 expressed as the functions of the current time t, the current rotation angle, and angular velocity of the two links I and II θ1,θ2,θ˙1,θ˙2, with x0,y0 as parametric variables. That is to say, Mi=Mi(t,θ1,θ2,θ˙1,θ˙2;x0,y0) (i=1,2). Due to space limitations, the detailed expressions of them will not be written here.It can be noticed that (53) will be singular if θ2=0. So the manipulator will not be fully folded (i.e., θ10=θ20=0) at initial time of deployment procedure in order to avoid singularity. θ10 takes a small positive value ε, and θ20=2θ10 so as to guarantee the end-effector locates at a virtual line connecting the carrier and the space target at initial time; then driven by the open loop control law Mi=Mi(t,θ1,θ2,θ˙1,θ˙2;x0,y0) (i=1,2) designed before, θ2 will increase gradually, but it will not reach π until touching the space target since the total length of the two links I and II is bigger than the distance between the carrier and the target in the cases we study. So the initial value of θ10=ε>0 and θ20=2θ10 can avoid the dynamics singularity during approaching operation.


## 4. Numerical Simulation

The inlet parameters for numerical simulation are shown in Table1.Table 1
Inlet parameters for numerical simulation.
Inlet parameters Values m 1 (kg) 2 m 2 (kg) 2 l 1 (m) 6 l 2 (m) 6 J 1 c (kg⋅m2) 6 J 2 c (kg⋅m2) 6 d (m) 2 n (rad/s) 0.0012 x 0 (m) 10 y 0 (m) 2 θ 10 (deg) 5 θ 20 (deg) 10 t f (s) 60The results of numerical simulation are shown in Figures2~7.Figure 2
The relative trajectory of the carrier to the space target.Figure 3
The relative trajectory of the end-effector to the space target and the corresponding configuration variation of the manipulator.Figure 4
The distance and phase angle of the carrier relative to the space target.Figure 5
The command versus the real value of the end-effector position coordinate.Figure 6
The distance and relative velocity of the end-effector to the space target.Figure 7
The rotation angles, angular velocities of the links I and II, and the corresponding driving torques of the motors.The results of the numerical simulation indicate that the actual position of the end-effector closely tracks the command; in fact, the response curves almost overlap the command curves exactly. At the final timet=tf=60(s) we preassigned, the distance and the radial velocity of the end-effector relative to the space target reach zero simultaneously, satisfying the requirement of soft touch, so avoiding the probable damage to the end-effector or the space target by the impact between them. We also see from the simulation results that the driving torques of the motors are less than 0.1(N·m), so it is easy to implement in engineering practice.The simulation neglecting the inertia forces exerted on the manipulators induced by the carrier body-fixed coordinate system has been conducted as well. The deviations of the simulation results neglecting the inertia forces and moments from that considering the inertia forces and moments mentioned above have been shown in Figures8~10.Figure 8
The deviation of driving torques neglecting the inertia forces and moments from that considering them.Figure 9
The deviation of link’s rotation angles neglecting the inertia forces and moments from that considering them.Figure 10
The deviation of end-effector’s position coordinates and its distance relative to the space target neglecting the inertia forces and moments from that considering them.In Figures8~10, the variables labeled by “∗” such as M1∗~ρe∗ come from the simulation neglecting the inertia forces exerted on the space manipulators. From the third curve of Figure 10, we see that the deviation of the distance between the end-effector and the space target reaches up to 0.15(m) at final time tf=60(s) from the simulation results considering the inertia forces. Since ρe(tf)=0, then ρe∗(tf)=ρe(tf)+Δρe(tf)=0.15(m). The miss distance of 15(cm) is too big to realize pinpoint capturing target for on-orbit operation. In the future, more quick and more pinpoint operation of space manipulator may be required, and then the rotation angular velocity of the manipulator’s links will be faster than that in the simulation here. In that situation, the inertia force such as Coriolis force induced commonly by the coordinate system’s rotation and the manipulator’s links relative motion will be larger than that in the simulation here, so they cannot be neglected even more in dynamics modeling and control design.


## 5. Conclusions

The two-link manipulator’s dynamics model during its end-effector approaching of a space target is derived using Kane method under the situation that the carrier is flying freely around the space target, governed by the C-W equations. The relative orbit dynamics of the carrier to the space target is considered in system dynamics modeling. The path functions of the end-effector of the manipulator as well as the corresponding driving torques functions of the joints are programmed in accordance with the requirement of soft touch between the end-effector and the target for the purpose of avoiding the damage to them by touch impact. The results of numerical simulation show the effectiveness of the control law proposed in the paper. The issues left for the future study are as follows: (1) the coupling dynamics between the carrier and the manipulators; (2) the complicated manipulator system dynamics in the nonideal situations such that the orbit of the space target around the earth is not circle with C-W equations being not tenable; and (3) the optimization of the open control law for the driving torque or the design of closed loop control law so as to acquire the robustness to perturbations.



---

*Source: 7375685-2016-07-20.xml*