Abstract
A strategy for attitude adjustment of a free-floating space robot is proposed to reduce fuel consumption and time required to operate a space manipulator and its carrier before and after the detection of an on-orbit spacecraft. This strategy can be used in such a way that the carrier attitude and space manipulator joint angle reach their expected values at the same time. In order to obtain an advanced effect of carrier attitude adjustment, a novel parameterization method of joint trajectory is proposed, which extends the search scope of the joint trajectory by the fusion of the 4-3-4 and 3-5-3 planning methods. An objective function is defined according to the difference of the expected and initial carrier attitudes. A genetic algorithm is used to search for an optimal solution of the parameters. The effectiveness of the proposed strategy is verified through simulations for a six-degree-of-freedom (6-DOF) space robot system.
Keywords
1. Introduction
Continuous development of space technologies has led to increasing demand for longer life cycles and higher reliability of future spacecraft. To ensure stable and reliable operation of spacecraft in complicated space environments, on-orbit detection has currently become a key technology for spacecraft fault diagnosis and threat warning. At the same time, in fields such as space assembly, system upgrade and logistic support, on-orbit detection technologies have a wide range of requirements [1]. Research projects, such as the XSS Project [2] and MiniAERCam Project [3], promote the development of relevant technologies in the on-orbit detection field.
Typically, space robots in an orbit have good mobility, flying along with a multiple-DOF manipulator system with sensors [4]. Such a system can be used as a novel platform for detection of spacecraft approaching and flight support. Space robotic technologies are currently being developed by several countries; examples include the Japanese ETS-VII [5], the American Orbital Express [6], and the German Light Weight Robot [7] and ROKVISS [8]. A safe, viable and effective close inspection system for specific detection can be realized using a specially designed space robot, which incorporates various non-contact sensors, such as a laser triangulation sensor mounted on the manipulator end-effector. On-orbit detection is aimed at the surface of the spacecraft structure. For a particular detection task, an on-orbit detection procedure using a space manipulator covers the following four processes [9]. First, the space robot system approaches the spacecraft and moves the space manipulator close to the surface of the spacecraft that needs to be tested. Next, the space manipulator tracks the trajectory and detects the surface that needs to be tested on the spacecraft. The third step is to finish the detection task and berth the manipulator. Lastly, the carrier attitude is re-stabilized.
In order to reduce energy consumption, the attitude control system of the space robot system is usually switched off to allow for a free-floating state [10]. Compared to normal space robot operation, the initial values of the carrier attitude and space manipulator joint angles have significant influence on the detection process. If the initial values of the carrier attitude and manipulator configuration are not appropriate, some parts of the carrier will be too close to the spacecraft, leading to a collision during the detection process when the attitude changes and the space manipulator moves. To minimize the collision probability, the carrier attitude and manipulator configuration need to be adjusted before the operation. After the detection operation, the position and attitude of the carrier change from the initial position and attitude. A change in the carrier attitude directly changes the attitude of the solar panel relative to the Sun and that of the antenna relative to the Earth. This affects the performance of the power and communication system on the space robot. As a result, the entire system needs to be re-stabilized to ensure normal working conditions after detections are completed and the system moves to the corresponding attitude [11]. In other words, before and after the on-orbit detection task, the mechanical arm has to carry out two operations. First, it has to berth the manipulator. This is achieved by re-initializing each joint angel to the initial state. Next, re-stabilization of the attitude for the entire system needs to be carried out. Using the dynamic coupling relationship between the space manipulator and its carrier, combined with the manipulator motion, allows the two operations to be carried out at the same time. This also reduces the time to carry out the operations, while saving valuable fuel carried by the space robot system.
Research reported in the literature has primarily taken advantage of the non-holonomic characteristic of space robots and specific trajectory planning methods employed by space manipulators in order to realize the process of finishing the manipulator movement and carrier attitude re-stabilization at the same time. Vafa et al. [12] proposed a carrier attitude adjustment strategy based on the disturbance map and periodic motion method. This control strategy can be realized by using the motion of the space manipulator when tracking a closed trajectory in the joint space. However, this method requires the total change of the carrier attitude to be an integral multiple of attitude change produced by the space manipulator joint space in each periodic motion. Moreover, this method overlooks non-linearity above two orders. Dubowsky et al. [13] proposed an enhanced disturbance map method that requires a large amount of calculations. Consequently, the method is not accurate when used for carrier attitude adjustment. Suzuki et al. [14] improved the calculus of variations and obtained an optimal spiral trajectory. Any change is recorded in 9D state variables, including the end-effector position and attitude of the space manipulator, together with the attitude of the carrier.
The methods discussed previously cannot be used to make the joint angle of the space manipulator reach the expected value while controlling the carrier attitude. To overcome this issue, Tortopidis et al. [15] proposed an analytical method to drive the system to a desired configuration. This method is based on the mapping of the angular momentum to a space where it can be satisfied trivially. Examples of a 2-DOF free-floating space manipulator are discussed in their work. Xu et al. [16] parameterized the joint trajectory to realize the purpose of the controlling carrier attitude. Their method allows the space manipulator joint angle to reach the expected value. However, due to the limited trajectory searching space of this parameterization method, it has certain limitations related to carrier attitude control.
In this paper, a novel joint trajectory parameterization method based on the task requirements is discussed. This is followed by establishing an optimized objective function, where the purpose of controlling the carrier attitude and making the space manipulator joint angle reach the expected value, is realized using an optimization algorithm. The established parameterization equation extends the searching space of the joint trajectory and enhances carrier attitude adjustment effects of free-floating space robots.
2. Carrier attitude adjustment of a space robot
The vector model of an n-DOF space manipulator motion, based on a free-floating satellite carrier, is shown in Figure 1. C i is the centroid of the manipulator linkage i; ∑ I and ∑ E are the inertial coordinate system and end-effector coordinate system, respectively; r i is the position vector of the centroid of the manipulator linkage i in the inertial coordinate system; p i is the position vector of the joint J i in the inertial coordinate system; p e is the position vector of space manipulator end-effector in the inertial coordinate system; a i is the position vector pointing from joint J i to C i ; and b i is the position vector pointing from Ci1 to joint J i .

General kinematic model of a free-floating space robot
According to the model, the position vector of the manipulator end-effector can be expressed as follows:
Linear velocity of the space manipulator end-effector can be obtained by taking the derivative of Equation (1):
The angular velocity of the end-effector can be expressed as follows:
where v0 and ω0 are the carrier mass centre linear and angular velocity relative to the inertial coordinate system, respectively; k i is the unit vector, reflecting the rotation direction of the joint i; and θ i is the rotation angle of the joint i. The following expression can be obtained from Equations (1) and (2):
Equation (4) is a general dynamic equation, where the block matrix Js is the Jacobi matrix related to the carrier motion, while the block matrix Jm is the Jacobi matrix related to the manipulator motion. The corresponding Jacobi matrices of the fixed-base manipulator from Jm and the space manipulator are the same.
During the detection process, to avoid a collision of the space manipulator and spacecraft, and to reduce energy consumption related to attitude adjustment, the system is generally in the state of free-floating; i.e., the position and attitude of the satellite platform as the manipulator carrier is uncontrolled. Non-holonomy is also a characteristic of the system [17]; in other words, the system meets the following two non-holonomic constraints:
According to the above two linear momentum conservation equations, the expression for the carrier linear velocity can be obtained as follows:
The carrier attitude can be expressed as the integral of
According to the non-holonomic characteristics of the space manipulator, the re-stabilizing carrier attitude and berthing space manipulator can be realized by planning the motion of the manipulator joint. In other words, it is anticipated to reach the expected values of the space manipulator joint angle and carrier attitude at the same time. As singularity does not exist in the motion of joint space planning of the manipulator, this method can be easily realized. The expected carrier attitude can be assumed to be Bd, while the norm is defined as ||
The bounded variable of the joint motion range J q is given by the following expression:
In the calculation, when the joint angle exceeds the motion range (θ -i_limit , θ +i_limit ), J q is equal to the positive infinity; hence, the optimization algorithm automatically shields trajectories exceeding the joint motion range.
3. Parameterization of the joint trajectory
The motion trajectory in the joint space refers to the displacement, velocity and acceleration curves for each joint of the robot during movement as a function of time. The joint trajectory is required to meet the following boundary conditions:
In Equation (12), the number of unknown variables is equivalent to that in the constraint condition. Therefore, a parameterization is used to set undetermined parameters in the joint trajectory equation and express other unknown variables with the undetermined parameters according to these boundary conditions. After the joint trajectory is parameterized, different joint trajectories can be obtained by changing undetermined parameters. In the parameterization method, more undetermined parameters can be introduced to obtain a wider searching space of the joint trajectory. However, this would increase the difficulty associated with solving the equation. But, the parameterization method with joint fusion trajectory can be employed to resolve the above contradiction.
Generally, traditional parameterization methods to estimate the joint trajectory can only produce a cluster of trajectory curves for certain specific types with several fixed characteristics. For example, the 4-3-4 planning employs the proportion of quartic polynomials in 4-3-4; namely, the time and displacement are taken as undetermined parameters [18]. The trajectory formed always passes through an intermediate point, which is not dependent on the selection of undetermined parameters.
Based on the traditional trajectory parameterization method, this paper proposes a parameterization method based on the joint fusion trajectory to expand the trajectory search scope. According to this method, the trajectory
where A is the parameter to be optimized. Therefore,
To obtain the parameterization of the equation with the fusion trajectory, the 4-3-4 trajectory planning [18] and 3-5-3 trajectory planning [19] methods are introduced into the parameters that need to be optimized. The same method as discussed above is used to introduce parameters into the two methods. The 3-5-3 planning is provided as an example here (as shown in Figure 2), with the trajectory curve

Trajectory planning using the 3-5-3 method
The total displacement of the joint angle is given by:
Parameters d1, d2 and d3 are the angular displacements of the parameterization trajectory in each section, while t1, t2 and t3 are the run-time of the parameterization trajectory also in each section.
In this method, the following undetermined parameters α and β are introduced:
From this, the joint angular displacement of each section can be expressed as follows:
To make the joint trajectory as smooth as possible, the run-time of the polynomial in each section is assumed to be as follows:
After the time in each section is normalized, the following expression is obtained:
where T is a certain time node in the planning process, with the initial time T assumed to be zero.
The planning trajectory uses the boundary conditions, where the initial angle h0, initial velocity v0, initial joint angular acceleration a0, objective joint angle hf, objective velocity vf and objective acceleration af are all zero.
After the above conditions are substituted into Equation (12), the following polynomial equations for each of the three sections are obtained.
The cubic polynomial equation for the first section is given by:
The quintic polynomial equation for the second section is given by:
The cubic polynomial equation for the third section is given by:
In terms of the trajectory parameterization using the 4-3-4 method, the above method can be used to introduce the undetermined parameters
The quartic polynomial trajectory in the first section is given by:
where
The cubic polynomial trajectory in the second section is given by:
The quartic polynomial trajectory in the third section is given by:
After trajectories
The equation
4. Carrier attitude/adjustment control method
Genetic algorithms (GAs) have excellent global optimization performance. Therefore, the method is more advantageous in comparison to the traditional Gradient Method [20] allowing the optimization of multiple variables.
A GA is employed in this paper to realize the carrier attitude adjustment with the aim of resolving problems associated with trajectory planning in order to adjust the carrier attitude and berth the space manipulator. The following steps are used to implement the GA:
The initial population of undetermined parameters in the parameterization equation related to each joint is generated. In the parameter search scope, for each joint, the initial population of undetermined parameters (
Fitness function in the GA is assumed to be the optimized objective function B. In turn, according to Equation (10), the fitness of each individual in the population is calculated.
The classic roulette algorithm is used as the selection method in the GA. The probability of the individual selection is given by:
where M is the population and f i is the adaptability of individual i.
Two individuals are randomly selected after the selection algorithm. Next, an intersection position is arbitrarily chosen for exchanging parts of the genetic code to form two new individuals.
According to the mutation probability, the genetic code of a certain individual in the population can be altered by taking the inverse with a small probability.
A new population is generated from the offspring.
Steps from (b) to (f) are repeated until an optimal solution meeting the requirements is obtained.
5. Simulations
As shown in Figure 3, according to the configuration when each joint angle in a 6-DOF space manipulator is equal to zero, the coordinate system of the free-floating space robot is established as shown in Figure 3.

Linkage coordinate frames for a 6-DOF manipulator
The coordinate system {1} linked with the linkage i is defined in the position of the joint i (the joint closest to the carrier is defined as joint 1), and Z-axis in the coordinate system is defined as the joint rotation axis. Structural parameters along with the mass and inertia of each linkage are listed in Table 1. Parameter
Linkage parameters of the space robot
In the simulation, the initial value of the joint angel was (175°, −40°, −120°, 0°, 220°, 0°) and the expected value was (160°, 0°, −80°, 20°, 260°, −20°). The motion range of each joint angle was:
Example 1: Global undisturbed attitude optimization.
The optimization objective for the space robot in this example is to move in the joint space from the initial position to the expected position with the attitude of the robot carrier unchanged after the motion is completed. The resulting optimized parameters are shown in Table 2:
Results of the global undisturbed attitude optimization
According to the optimized parameters, the curves of each joint angle and carrier attitude disturbance can be obtained; they are shown in Figures 4 and 5.

Joint angle curves of the global undisturbed attitude optimization

Carrier attitude curves of the global undisturbed attitude optimization
For better visualization of the moving process related to the space robot, a 3D graphic simulation was made based on the results. This 3D simulation is illustrated in Figure 6.

3D image illustrating undisturbed attitude optimization
Example 2: Attitude adjustment optimization.
The optimization objective for the robot in this example is to move in the joint space from the initial position to the expected position, with the requirement that the attitude of the robot is maintained at the expected value after the motion is completed. The initial attitude of the carrier is (0°, 0°, 0°) and the expected attitude is (5°, 5°, 5°).
Optimized parameters are shown in Table 3:
Optimization results of carrier attitude adjustment
According to the optimized parameters, the curves of each joint angle and carrier attitude disturbance can be obtained; they are shown in Figure 7 and Figure 8.

Joint angle curves of carrier attitude adjustment

Carrier position and posture curves of carrier attitude adjustment
A 3D image illustrating the results is shown in Figure 9.

3D image illustrating attitude control/adjustment optimization
Based on the above simulation, it can be seen that, when the space manipulator moves after 50 seconds, the joint angle and carrier attitude reach the expected values, together with a small change in the carrier position.
In order to compare the proposed method using simulation, a trapezoidal speed trajectory planning method in the joint space is introduced. Joint angle curves are shown in Figure 10.

Joint angle curves of the trapezoidal speed trajectory planning method
After the attitude disturbances in three directions from three trajectories are composed and taken with the absolute values, the measured values of the carrier attitude change can be obtained, as shown in Figure 11.

Comparison of measured values of carrier attitude disturbance for each trajectory
In Figure 3, group carrier attitude disturbances are compared during the movement from the initial joint angle (175°, −40°, −120°, 0°, 220°, 5°) to the final joint angle (160°, 0°, −80°, 20°, 260°, −20°). The trajectory produced by the undisturbed attitude optimization of the global attitude of robots was realized with no disturbance of the carrier attitude when the joint angle reached the expected values. The joint motion planned by the attitude adjustment optimization resulted in the final attitude of the carrier reaching the expected value (5°, 5°, 5°), with the adjustment value of the carrier attitude reaching 8.660°. This proved the effectiveness of the joint space parameterization equation and the proposed optimization algorithm.
Regarding the joint trajectory discussed in the above examples, the global attitude disturbance using the trapezoidal planning allowed the attitude disturbance to reach peak value. However, in the two optimization examples, the carrier attitude first generated a peak and then dropped down to zero or the expected attitude. The peak value disturbance of the optimized trajectory far exceeded the trapezoidal planning. This is consistent with the optimized objective function in the paper, which only focuses on the final carrier attitude and does not consider the carrier attitude disturbance during the movement. Accordingly, if the carrier attitude peak value disturbance optimization is needed, it is not enough for the optimized objective function only to include the global attitude. Instead, the peak value should be added into the objective function after introducing corresponding weight coefficients to limit the peak value disturbance. This is done at the expense of the control ability of the global carrier attitude.
The initial and objective configurations of the space manipulator are the same in these three examples. In other words, the displacement in the joint space is the same, yet there are different disturbances in the final carrier attitudes. This also shows that, when the free-floating space robot moves in the joint space, the disturbance of the carrier attitude is related to the movement history.
6. Conclusions
In this paper, a strategy for the carrier attitude adjustment of a space manipulator for on-orbit detection is proposed. A joint trajectory planning method is also proposed, and the objective function is established to reflect the difference in the expected and initial carrier attitudes. The limits of the joint motion range are considered. This algorithm can be used to enable the carrier attitude and space manipulator joint angle to reach their expected values at the same time.
This paper further proposed a novel parameterization algorithm to achieve trajectory planning based on the traditional 3-5-3 and 4-3-4 planning methods. This method allows trajectory selection for a wider search scope, as well as improved optimization. Using simulations for a 6-DOF space manipulator with a free-floating carrier, the effectiveness along with the validity of the carrier adjustment algorithm were verified.
Footnotes
7. Acknowledgements
This work was supported by the National Natural Science Foundation (grant no. 51205090), the Fundamental Research Funds of the Central Universities (grant no. HIT.NSRIF.2015008), the China Postdoctoral Science Foundation (CPSF) (grant no. 2014M551231), and the Heilongjiang Postdoctoral Fund (grant no. LBH-Z12131).
