Kinematic analysis and fault-tolerant trajectory planning of space manipulator under a single joint failure
- Zonggao Mu^{1},
- Liang Han^{1},
- Wenfu Xu^{1}Email author,
- Bing Li^{1} and
- Bin Liang^{2}Email author
DOI: 10.1186/s40638-016-0048-9
© The Author(s) 2016
Received: 16 July 2016
Accepted: 12 September 2016
Published: 3 October 2016
Abstract
A space manipulator plays an important role in spacecraft capturing, repairing, maintenance, and so on. However, the harsh space environment will cause its joints fail to work. For a non-redundant manipulator, single joint locked failure will cause it to lose one degree of freedom (DOF), hence reducing its movement ability. In this paper, the key problems related to the fault-tolerant including kinematics, workspace, and trajectory planning of a non-redundant space manipulator under single joint failure are handled. First, the analytical inverse kinematics equations are derived for the 5-DOF manipulator formed by locking the failure joint of the original 6-DOF manipulator. Then, the reachable end-effector pose (position and orientation) is determined. Further, we define the missions can be completed by the 5-DOF manipulator. According to the constraints of the on-orbital mission, we determine the grasp envelope required for the end-effector. Combining the manipulability of the manipulator and the performance of its end-effector, a fault tolerance parameter is defined and a planning method is proposed to generate the reasonable trajectory, based on which the 5-DOF manipulator can complete the desired tasks. Finally, typical cases are simulated and the simulation results verify the proposed method.
Background
SPACE manipulators are expected to be widely used in various space missions, including constructing large space structures, removing orbit debris, and repairing malfunctioned satellite [1–3]. However, a space robot in harsh space environment is prone to failure, resulting in decreased performance of it.
It is extremely difficult, even impossible, to repair or replace these malfunctioning devices on orbit. Therefore, fault tolerance is critical for space manipulators. Because each joint is generally controlled and driven independently, we can deal with the problem respectively when a joint fails. There are mainly two types of joint failure: locked [4, 5] and free-swinging [5, 6] failures. The former refers to a malfunctioning joint that is constrained mechanically, whereas with the latter, actuator torque is lost, and the joint revolves according to the coupling torques of the other joints. In fact, the most common joint failures are joint locked failures. So this paper focuses on the fault-tolerant planning under single joint locked failures. This failure covers two cases: active locking, in which a joint can be locked by fail-safe brakes, and passive locking, in which a joint is locked unexpectedly due to mechanical failure. For previous works [7, 8], the scholars studied the fault-tolerant planning and control methods for redundant manipulators. The redundancy is used to compensate for the motions of the failed joint to continue the designed tasks. However, for a non-redundant manipulator, such as a 6-DOF (degree of freedom) space manipulator, these methods can not be directly applied.
When a joint is locked, a 6-DOF manipulator will decrease to a 5-DOF manipulator, which has insufficient degrees of freedoms to make its end-effector freely move in 3D space. The kinematics, workspace, and trajectory planning are much more different from the original 6-DOF manipulator. There are two types of methods to solve the inverse kinematics of such manipulator with single locked joint: One is to directly solve the 5-DOF manipulator; the other is to construct a new 6-DOF manipulator with a virtual joint. For the former, there are various methods [9, 10] to obtain the inverse solution of the manipulator. The methods based on vector algebra and linear transform [11–13] are always used to solve the inverse solution of a manipulator with insufficient degrees of freedoms. Such manipulator can not attain some given pose (attitude and position), i.e., there will be no any rational inverse solutions for some desired pose. Correspondingly, there will be no rational trajectory to achieve the desired pose. If single variable arc tangent function [14, 15] is used in solving the joint angles, one solution of arc tangent function may be lost.
On the other hand, a virtual joint can be added to construct a new 6-DOF manipulator. Li Xiaotang [16] assumed that the robot grabs bar-like object, so that an attitude parameter corresponding to the gripper rotating around the centerline of rods is not considered. The attitude parameter was regarded as a virtual rotary joint. Then a numerical method was used to solve the inverse kinematics equations. Similarly, Masayuki Shimizu [17] and Zhang Chengkun [18] also constituted a new 6R robot from the 5-DOF manipulator by using a virtual rotary joint. The inverse solution can be derived according to the kinematics of 6-DOF manipulator. However, these papers did not deeply analyze the fault tolerance at any configuration by considering arbitrary joint which is locked.
To take full advantage of space robot under a single joint failure, this paper carries out the workspace analysis for any joint which is fail to work. The bivariate tangent function is used to solve the joint variables, and the quadrant can be determined by the symbolic of independent variable. Then, the analytical inverse solution of the space manipulator under a single joint failure is obtained. By introducing the concept of fault tolerance angle, the 5-DOF robot can complete more tasks at various fault conditions under different fault tolerance requirements. Finally, the Cartesian linear trajectory planning simulation under the 2nd joint failure is performed. The simulation results show the effectiveness of the algorithm.
Kinematic analysis of a 6-DOF manipulator under single joint failure
Kinematics modeling and workspace analysis
D-H parameter of the manipulator
i | a _{ i−1}/mm | α _{ i−1}/° | d _{ i }/mm | θ _{ i } /° |
---|---|---|---|---|
1 | 0 | −90 | 0 | 90 |
2 | a_{2} | 0 | 0 | 0 |
3 | 0 | 90 | 0 | 90 |
4 | 0 | −90 | d _{4} | 0 |
5 | 0 | 90 | 0 | 0 |
6 | 0 | 0 | d _{6} | 0 |
Inverse kinematics
The main existing inverse solution method for space robot includes analytical method, geometric method, numerical methods and neural network method. Generally, the inverse solution of joint angles is calculated in the range of 360°, and if a single variable arc tangent function is used in solving joint angle, an arc tangent function of the solution may be lost. So the analytical method and bivariate arc tangent function are adopted to solve the inverse solution of space robot in this paper.
Analytical inverse kinematics of a 5-DOF manipulator
For adjusting the structural parameters of the failure joint and the adjacent joints, the rotation matrix of failure joint is still remained in the kinematic equations, and the current angle of failure joint locked is substituted into kinematic equations. For different failure joints and location, only the corresponding joint variables in the kinematics should be converted to a constant which is currently locked rotation angle. Then the normal analytical solution algorithm is used to solve the equations. This method can improve the solvability of insufficient DOF manipulator and achieve its trajectory planning; this will make sure 6-DOF manipulator still accomplishes most tasks in case of a single joint failure.
It can be seen from the above derivation process of inverse kinematics. When the second joint is failure, θ _{1}, θ _{3}, θ _{4}, θ _{5}, θ _{6} can also be obtained from the formula corresponding to the value of θ _{2}. Similarly, the analytical inverse solution of other joint failure can also be analyzed.
Analytical inverse kinematics of a 6-DOF manipulator
In order to avoid the possibility of the solution being lost during the inverse solutions of the manipulator joint angles process, bivariate arctangent function is used in this paper, and then the quadrant of the joint angle can be determined by the argument symbolic. If the pose of end-effector has been given, namely n, o, a, p is known, the value of θ _{1}, θ _{2}, θ _{3}, θ _{4}, θ _{5}, θ _{6} can be determined. This paper gives a solution results directly.
Fault-tolerant trajectory planning methods
Fault-tolerant planning based on the inverse solution of 5-DOF manipulator
In practice, when a joint of the 6-DOF manipulator fails, the system will lock the joint and keeps it in the current angle. In this way, the 6-DOF manipulator becomes a 5-DOF manipulator, which also names the insufficient DOF manipulator. Actually, it is vital for the insufficient DOF manipulator to complete the expected task accurately by the effective artificially motion control and trajectory planning. For example, a 6-DOF manipulator in aerospace cannot be put to work anymore when a failure happened in one of its joint. But if we use the control system with a new inverse solution algorithm instead of the inverse solution algorithm, in spite of the fact that the manipulator has become the insufficient DOF manipulator, the manipulator can still reach the most pose in its original workspace, and this means that the robot can still put to work and complete the most planning tasks which will improve the capacitive and availability of the entire spacecraft system.
When there is a single joint failure in a 6-DOF manipulator, its related workspace will be reduced accordingly, as shown in Fig. 3. Therefore, the manipulator is still able to complete part of its task based on its ability to work. As for the tasks that a 5-DOF manipulator with the fault can complete, we can carry out the trajectory planning with conventional planning methods, including getting the inverse solution in accordance with “Analytical inverse kinematics of a 5-DOF manipulator” of formula 5-DOF and calculate the angles about the movable joint.
Fault-tolerant planning based on the inverse solution of 6-DOF manipulator
The introduction of fault-tolerant method
The insufficient DOF manipulator can only reach part of the position and attitude in their original workspace, so that the inverse solution of the desired position and attitude may not exist. Because not all the location and attitude are solvable, the unrealizable attitudes of manipulator will lead to the failure of expected tasks. In most cases, the vector algebra, linear transformation, and other methods are used to get the inverse solution about the position of the insufficient DOF manipulator. But if there is no inverse solution of a certain posture when using the ordinary inverse solution algorithm, the manipulator trajectory planning cannot be achieved and the insufficient DOF manipulator with a failure joint will not able to complete the task. Therefore, it is full of high research value and practical value to study inverse solution algorithm about the position of 6-DOF manipulator with fault-tolerant performance.
- 1.
When a single joint fails, the desired joint angle of each joint can still be substituted into the kinematic equations in order to calculate the target point relative to the base coordinate system of the position and attitude matrix _{ e } ^{0} T;
- 2.
The matrix _{ e } ^{0} T is multiplied with the homogeneous transformation matrix of the rotational angle γ which rotates around X-axis of the tool coordinate system, we obtain _{ e } ^{0} T:
$$ {}_{e}^{0} T \cdot \left[ {\begin{array}{*{20}c} 0 & {} & \quad 0 &\quad 0 &\quad 0 \\ 0 &\quad {\cos (\gamma )} & {} &\quad { - \sin (\gamma )} & 0 \\ 0 & \quad{ \, \sin (\gamma )} & {} &\quad {\cos (\gamma )} & 0 \\ 0 &\quad {} & 0 &\quad 0 &\quad 1 \\ \end{array} } \right] $$(18) - 3.
Respectively, the matrix _{ e } ^{0} T ^{′} is calculated corresponding to the increments of γ from −180° to 180° and the inverse kinematics solution of the manipulator is obtained based on _{ e } ^{0} T ^{′};
- 4.
In the condition that the type of reference manipulator has been set, the value of the joint angle can be determined one to one using the inverse kinematics solution according to the failure joint when the angle γ changes in the range of 360°. So we can draw the diagram between the attitude angle γ and the fault joint.
- 5.
The values of each joint angle that meet the job requirements can be obtained based on a consideration of the range of fault-tolerant angle, real fault angle of the fault joints.
- 6.
After determining each desired angle, the trajectory will be re-planned in accordance with the analytic solution of inverse kinematics of the 5-DOF to complete scheduled tasks.
The algorithm takes advantage of the normal arm inverse kinematics, so that we don’t need to re-identify the parameters and reconstruction of the manipulator even when the joint fails. After obtaining the graph, we can consider the actual fault condition about the fault tolerance and the size of angle in the fault joint. As a result, when the target matrix rotates around the X-axis in coordinate system with the angle γ, the insufficient DOF manipulator can still be able to complete the scheduled tasks due to the substitute motion by other joints. But if a joint failure occurs in some less flexible operating space, the value of angle γ calculated by this method will be relatively large, which leads to the fact that the manipulator will fail to complete scheduled tasks with the solution of the six joint angle values, because the corresponding position and posture of the manipulator may cause a collision between the end-effector and the target object.
The analysis of fault tolerance under a single joint failure
The trajectory planning and simulation about fault tolerance under the typical tasks
Based on the discrete end straight path in the formulas (19) and (20), we can carry out verification of the fault-tolerance planning under the single joint failure.
The straight trajectory planning under conditions of the failure in joint 2 (without fault-tolerant attitude error)
The straight trajectory planning under conditions of the failure in joint 2 (fault-tolerant attitude error ≤10°)
Initial position: [62.7315, −65.3258, −520.9870], the initial attitude Euler angles: [0.5931, −0.3826, −0.0452]. Terminal position: [−98.3390, −66.2696, −37.8197], terminal Euler attitude angle: [1.5573, −0.1427, 0.0945], according to the inverse kinematics of each joint in the paper, we can get the initial joint angle of each joint q_0 = [0, 30, 30, 10, −80, 30] and the terminal joint angle q_f = [5, 60, 65, 10, −120, 90].
Conclusion
This paper conducts a research on fault tolerance trajectory planning for a 6-DOF space manipulator under a single joint failure, and the workspace of the manipulator for pre- or post-failure is analyzed based on the actual situation of joint failure. The analytical inverse kinematics equation of the 5-DOF formed from the 6-DOF manipulator with locking single joint is derived to ensure the completion of part tasks in the workspace. In order to further represent the ability of the manipulator under a single joint failure, the concept of fault-tolerant angle is introduced. Then the relationship between the fault tolerance angle and the locked joint is established. Based on it, the best choice of desired angle of each joint which is most suitable for specific task can be determined. This paper provided an effective way to maximize the ability of a space manipulator under a single joint failure.
Declarations
Authors’ contributions
ZM and LH have jointly carried out the research on section II, section III, and section IV, and ZM revised and completed all the figures. Finally, WX and ZM have jointly written section I and section V. All authors read and approved the final manuscript.
Acknowledgements
This work was supported in part by the National Natural Science Foundation of China (61573116) and the Basic Research Program of Shenzhen (JCYJ 20150529141408781).
Competing interests
The authors declare that they have no competing interests.
Open AccessThis article is distributed under the terms of the Creative Commons Attribution 4.0 International License (http://creativecommons.org/licenses/by/4.0/), which permits unrestricted use, distribution, and reproduction in any medium, provided you give appropriate credit to the original author(s) and the source, provide a link to the Creative Commons license, and indicate if changes were made.
Authors’ Affiliations
References
- McCourt R, De S. Autonomous robotic capture of a satellite using constrained predictive control. IEEE/ASME Trans Mechatron. 2006;11(6):699–708.View ArticleGoogle Scholar
- Boning P, Dubowsky S. Coordinated control of space robot teams for the On-Orbit construction of large flexible space structures. Adv Robot. 2010;24(3):303–23.View ArticleGoogle Scholar
- Nanos K, Papadopoulos E. On the use of free-floating space robots in the presence of angular momentum. Intell Serv Robot. 2010;4(1):3–15.View ArticleGoogle Scholar
- Lewis CL, Maciejewski AA. Fault tolerant operation of kinematically redundant manipulators for locked joint failures. IEEE Trans Robot Autom. 1997;13(4):622–9.View ArticleGoogle Scholar
- English JD, Maciejewski AA. Fault tolerance for kinematically redundant manipulators: anticipating free-swinging joint failures. IEEE Trans Robot Autom. 1998;14(4):566–75.View ArticleGoogle Scholar
- English JD, Maciejewski AA. Failure tolerance through active braking: a kinematic approach. Int J Robot Res. 2001;20(4):287–99.View ArticleGoogle Scholar
- Xu W, She Y, Xu Y. Analytical and semi-analytical inverse kinematics of SSRMS-type manipulators with single joint locked failure. Acta Astronaut. 2014;105(1):201–17.View ArticleGoogle Scholar
- She Y, Xu W, Su H, Liang B, Shi H. Fault-tolerant analysis and control of SSRMS-type manipulators with single-joint failure. Acta Astronaut. 2016;120:270–86.View ArticleGoogle Scholar
- Morishita T, Tojo O. Integer inverse kinematics method using Fuzzy logic. Intell Serv Robot. 2012;6(2):101–8.View ArticleGoogle Scholar
- Zhou D, Ji L, Zhang Q, Wei X. Practical analytical inverse kinematic approach for 7-DOF space manipulators with joint and attitude limits. Intell Serv Robot. 2015;8(4):215–24.View ArticleGoogle Scholar
- Zhou Y, Xi F. Exact kinematic analysis of the general 5R robot. Mech Mach Theory. 1998;33(1–2):175–84.MathSciNetView ArticleMATHGoogle Scholar
- Tsai L, Morgan A. Solving the kinematics of the most general six- and five-degree-of-freedom manipulators by continuation methods. J Mech Trans Autom Des. 1985;107(2):189–200.View ArticleGoogle Scholar
- Kohli D, Osvatic M. Inverse kinematics of general 6R and 5R, P serial manipulators. J Mech Des Trans ASME. 1993;115(4):922–31.View ArticleGoogle Scholar
- Wang X, Xu S, Hao J. New inferential method and efficient solutions for inverse kinematics equations of robot MOTOMAN. J China Univ Min Technol. 2001;30(1):73–6.Google Scholar
- Wang Q, Xu X. A new inferential method and efficient solutions for inverse kinematics equations of PUMA robot manipulator. Robot Auton Syst. 1998;20(2):81–7.Google Scholar
- Li X, Wei S, Liao Q, Wang P. Position reverse solution on 6R manipulator with error tolerance property. J Mach Des. 2006;23(7):16–9.Google Scholar
- Masayuki S. Analytical inverse kinematics for 5-DOF humanoid manipulator under arbitrarily specified unconstrained orientation of end-effector. Robotica. 2015;33(4):747–67.View ArticleGoogle Scholar
- Zhang C. Fault-tolerant trajectory planning and experiment research on the 6R space robot system. Beijing: Beijing University of Posts and Telecommunications; 2008.Google Scholar