Original Research ARTICLE
Different-Level Simultaneous Minimization Scheme for Fault Tolerance of Redundant Manipulator Aided with Discrete-Time Recurrent Neural Network
- 1School of Information Science and Engineering, Lanzhou University, Lanzhou, China
- 2College of Information Science and Engineering, Jishou University, Jishou, China
- 3School of Information Science and Engineering, Huaqiao University, Xiamen, China
- 4Department of Computer Science, University of Otago, Dunedin, New Zealand
By incorporating the physical constraints in joint space, a different-level simultaneous minimization scheme, which takes both the robot kinematics and robot dynamics into account, is presented and investigated for fault-tolerant motion planning of redundant manipulator in this paper. The scheme is reformulated as a quadratic program (QP) with equality and bound constraints, which is then solved by a discrete-time recurrent neural network. Simulative verifications based on a six-link planar redundant robot manipulator substantiate the efficacy and accuracy of the presented acceleration fault-tolerant scheme, the resultant QP and the corresponding discrete-time recurrent neural network.
In recent decades, robotics has drawn more and more attention in scientific areas and engineering applications. Many researches have been focused on this topic, and various kinds of robots have thus been developed and investigated (Roberts and Maciejewski, 1996; Sun et al., 2009; Zhang and Zhang, 2012, 2013; Li et al., 2014; Jin and Zhang, 2015; Jin et al., 2016; Jin and Li, 2017; Jin et al., 2017a,b; Zhang et al., 2017a,b). As a typical kind of robot, redundant manipulators have played a more and more important role in numerous fields of engineering applications (Roberts and Maciejewski, 1996; Zhang and Zhang, 2012, 2013; Jin and Zhang, 2015; Liao and Liu, 2015; Jin et al., 2016, 2017a,b; Jin and Li, 2017; Zhang et al., 2017a,b). For redundant manipulators, they can accomplish subtasks easily and dexterously and optimization of various performance criteria, since they possess more degrees of freedom (DOF) than the minimum amount required to accomplish a given end-effector primary task. Recent progresses have shown advantages of using adaptive neural networks for the control of nonlinear systems (Tang et al., 2014, 2017). For example, an adaptive control scheme was provided in Tang et al. (2014) for robot manipulator systems with unknown functions and dead-zone input by using adaptive neural networks, of which the parameters of the dead zone are assumed to be unknown but bounded. One of the fundamental issues in operating such a redundant manipulator is the inverse-kinematics problem (or termed, redundancy-resolution problem). Specifically, the joint trajectories need to be generated online based on the provided desired Cartesian trajectories of the end-effector. That is, if the manipulator control scheme is fault tolerant, the end-effector can fulfill the required task even if its joint fails. As one essential and challenging issue in inverse kinematics, it is important to tolerate joint failure online during the task execution. For example, in the remote applications such as space or sea exploration, repairing broken actuators is costly or even impossible and the probability of their failure is increased due to the hostile operating environment. To say the least, it may induce the damage to people and/or manipulator if a manipulator without a fault-tolerant scheme being equipped suddenly encounters a joint-lock situation during the execution. Thus, the fault-tolerant ability is an important or even indispensable design criterion for robotic systems.
More recently, the fault tolerance has attracted significant interest in the societies of academia and industry because of the increased demands in practical applications for safety and productivity as well as operating efficiency. Numerous researches on the topic of fault tolerance have thus been presented and investigated (Roberts and Maciejewski, 1996; Izumikawa et al., 2005; Siqueira and Terra, 2009; Li and Zhang, 2012). Authors in Siqueira and Terra (2009) described the fault occurrence for a three-link manipulator based on a Markovian jump model, which took into account all possible fault sequences in a three-link manipulator robot, and defined guidelines to control an n-link manipulator robot with several faults. Izumikawa et al. (2005) designed a controller of a fault-tolerant system with a signal observer for a strain gauge sensor fault. By switching from the controller for normal mode to the controller for unnormal mode, the stability and the control performance of such a system were maintained. Generally speaking, the existing methods for fault tolerance can be categorized as the passive type and the active type (Zhang and Jiang, 2008). The former one fixes and designs the corresponding controllers to be robust against the presumed faults, which needs neither fault detection nor controller reconfiguration, with limited capabilities for fault tolerance. The latter one reacts to the failures of the system actively by reconfiguring control actions to maintain the stability and acceptable performance of the entire system (Bustan et al., 2014).
A fault-tolerant scheme was presented by adding a matrix-vector form equality constraint for the faulty joint, which took the limits of joint angle and joint velocity into consideration (Li and Zhang, 2012). However, this fault-tolerant scheme can not handle the joint-acceleration limits. More seriously, this scheme may introduce the undesirable discontinuity phenomenon in the velocity solution because it was investigated at the joint-velocity level. Thus, it is worthy to investigate the scheme for fault-tolerance of redundant robot manipulators at the joint-acceleration level, which can effectively remedy the discontinuity phenomenon at the joint-velocity level and incorporates robot dynamic. However, up to now there is almost no study on the fault tolerance of redundant robot manipulators on the combination of different level. In other words, the study on the fault tolerance of redundant robot manipulators at the different level is still rare despite its appealingness.
In this paper, we make progress along this direction by presenting a different-level simultaneous minimization scheme, which takes both the robot kinematics and robot dynamics into account. The scheme is then reformulated as a quadratic program (QP) subject to equality and bound constraints. In order to solve such a QP problem, a discrete-time recurrent neural network is developed and applied to online solution of the QP problem. Simulative results based on a six-link planar robot manipulator further illustrate the efficacy and superiority of the proposed fault-tolerant scheme for fault tolerance of redundant robot manipulators.
2. Preliminaries and Scheme Formulation
To lay a basis for further discussion, the relationship between the end-effector velocity ṙ ∈ Rm and the joint velocity for redundant robot manipulators can be given hereinafter directly (Zhang and Zhang, 2012)
where J(q) ∈ Rm×n is the Jacobian matrix of the end-effector with q being the joint-angle vector. By differentiating Equation (1) with respect to time t, the relationship between the end-effector acceleration and the joint acceleration is obtained as follows (Zhang and Zhang, 2012):
where is the time derivative of J(q). Note that, since the manipulator system is redundant (i.e., m < n), Equations (1) and (2) are under-determined, and generally admit an infinite number of feasible solutions in terms of inverse kinematics. This implies the ability to accommodate more functional constraints such as fault tolerance. For example, once a joint is stuck, other joints can take over its workload and move the end-effector to its goal via a fault-tolerant scheme. It is worth mentioning here that the fault-tolerant scheme investigated in Li and Zhang (2012) was based on Equation (1) (i.e., at the joint-velocity level), while the fault-tolerant scheme presented in the ensuing subsections is based on Equation (2) (i.e., at the joint-acceleration level).
For the online solution of Equation (2), the following QP-oriented formulation can be used (Zhang and Zhang, 2012):
where coefficients Λ ∈ Rn×n and c ∈ Rn are defined accordingly for a specific redundancy-resolution scheme. In addition, superscript T denotes the transpose of a matrix or vector.
However, without appropriate remedied measures, when a manipulator suffers a joint failure, its performance would be significantly affected, and even worse, the manipulator fails to complete the prescribed path task. In safety-critical systems, the consequences of a minor fault in a system component can be catastrophic. Therefore, the demands on reliability, safety and fault tolerance are generally high. It is necessary to take fault tolerance into consideration in the above inverse-kinematic scheme (i.e., Equations 3 and 4) in order to improve the reliability and availability while tracking a desirable path. Inspired by Roberts and Maciejewski (1996), at a time instant, if there are nf joints being locked (e.g., the ith, …, and jth joints with i, j ∈ [1, 2, …, n] and i ≠ j), then we directly remove the corresponding joint-acceleration variables in the scheme. For example, if a failed joint i is locked, the corresponding relationship between the end-effector acceleration and the joint acceleration is obtained as
where and with jh and denoting the hth column of J(q) and , respectively. In addition, and . The reduced Equation (5) then determines the kinematic properties of the degraded system.
By incorporating the joint physical constraints as well as the robot dynamic presented in Appendix (Supplementary Material), the different-level simultaneous minimization scheme for fault tolerance of robot manipulators is written as
where α ∈ (0, 1) and β ∈ (0, 1) are the weighting factors with α+β = 1 numerically; θ, , and τ denote the nr dimensional joint-angle, joint-velocity, joint-acceleration and joint-torque vectors, respectively; , and , ; ; with and nr = n − nf [nf denotes the number of faulty joint(s)]. In addition, H denotes the nr × nr dimensional inertia matrix; cτ denotes the nr dimensional Coriolis/centrifugal force vector and gτ denotes the nr dimensional gravitational force vector. Besides, N·m. For simplicity and for example, α is set to be 0.995 (i.e., β = 0.005) in the ensuing simulations.
Remark 1: Fault detection is a fundamental, specialized and relatively independent part for fault tolerance, for which many methods have been proposed. These methods can be classified into two categories: model-based methods and data-based methods (Yüksel and Sezgin, 2010). Model-based methods obtain the deviations signals between the model and the real system named as residuals to detect faults. Data-based methods are based on only processing input and output signals of the system to detect faults. In this paper, for focusing on the superior performance of the fault-tolerant scheme in faulty situation, it can be simply assumed that the fault detection/diagnosis system can always detect and diagnose an unexpected joint fault and immediately give the feedback to the fault-tolerant system. Once the fault-tolerant system receives such a feedback, it activates the reconfiguration mechanism and removes the corresponding joint-acceleration variables in the scheme.
Remark 2: Note that the model disturbance and computational round-off errors always exist in practical application. In order to improve the accuracy of the scheme, the feedback control needs to be incorporated into the forward kinematics equation. One effective approach is to add feedbacks of Cartesian position and velocity error, i.e., instead of using , Equation (7) can be replaced with
where Kp and Kv are positive-definite symmetric m × m gain matrices for position-error and velocity-error feedbacks, respectively. In the ensuing simulations and experiments, the diagonal elements of the gain matrices Kp and Kv are set as 10 and the off-diagonal elements are set as 0 for simplicity and clarity.
With the aid of conversion techniques given in Cheng et al. (1994), Cheng et al. (1995), and Park et al. (1998), the new bound constraint can thus be written as , where the ith elements of η− and η+ are defined respectively as
where ϑ > 0 is a small constant vector used to scale the safety region. Besides, coefficients γp > 0 and γv > 0 determine the deceleration magnitude.
Based on the above analysis, the proposed scheme for physically-constrained redundant robot manipulators can be reformulated into the following standard QP in terms of :
where , , , , and with μ > 0 and ν > 0. In addition, and η± are defined the same as before.
Neural networks have been recognized as a powerful tool for real-time processing and successfully applied widely in various control systems (Wang et al., 2015, 2016). In particular, we use the following discrete-time recurrent neural network for solving online the QP problem (Xiao and Zhang, 2013; Zhang and Zhang, 2013).
where || · ||2 denotes the two-norm of a matrix; the decision variable vector u and its upper and lower bounds u± ∈ RN (with N = nr + m) are defined respectively as
with y ∈ Rm being the auxiliary decision vector (i.e., dual decision vector) defined corresponding to equality constraint (Equation 14), denoting an appropriately dimensioned vector composed of ones, constant ϖ = 1010 ∈ R being defined to replace +∞ numerically, and the augmented matrix M and vector z being defined respectively as
Besides, is a piecewise-linear projection operator defined from space RN onto set Ω, and the ith element of PΩ(u) is defined as
3. Simulative Results
In this paper, a six-link planar manipulator with motor-driven push-rod type joints is presented as a simulative platform to illustrate the effectiveness of the scheme. The hardware system of the six-link planar manipulator, which has six joints, is presented in Zhang and Zhang (2013). The physical parameters of the six-link planar manipulator are shown in Table 1, of which and denote respectively the upper and lower limits of the ith joint-angle vector and li denotes the length of the ith link, i = 1, 2, …, 6. Besides, in the simulations and the ensuing experiment, the final error tolerance of ||e(uk)|| is set as 10−5 for the discrete-time QP solver Equation (16) with the sampling gap being 0.01 s. The end-effector of the six-link planar redundant robot manipulator is expected to track a square-path with side-length being 0.039 m. In addition, the duration of the path-tracking task is 20 s, ϑ = 0.1 rad, joint-velocity limits rad/s, joint-acceleration limits rad/s2 and μ = ν = 4.
For comparison and for illustrating the efficacy of the different-level simultaneous minimization scheme (Equations 6–12) in the faulty situation, the simulation results synthesized by scheme (Equations 6–12) with the first joint being faulty from on t = 15 s are shown in Figure 1. As observed from Figure 1A, the end-effector motion trajectory is close enough to the desired square path (i.e., with the robot dynamics taken into account, the tracking task is also completed), which substantiates the effectiveness of the different-level simultaneous minimization scheme (Equations 6–12) in the faulty situation. In addition, the tracking position error with the maximal position error being less than 4 × 10−6 m shown in Figure 1B further shows the efficacy and accuracy of such a different-level simultaneous minimization scheme. Besides, in Figure 1C, for the first joint torque (i.e., τ1 denoted by the blue lines), the solid lines and dashed lines respectively denote the joint-torque profiles corresponding to the no-fault situation and fault-tolerant situation with the first joint being faulty from on t = 15 s. As observed from Figure 1C, after t = 15 s, the value of the first joint torque becomes zero. With the first joint being faulty from on t = 15 s, the values of the joint velocities and joint accelerations are zero, which implies the efficacy of the different-level simultaneous minimization scheme (Equations 6–12) in the faulty situation. In summary, the above simulation results substantiate the efficacy and accuracy of the the different-level simultaneous minimization scheme (Equations 6–12), which takes both the robot kinematics and robot dynamics into account.
Figure 1. Simulation results of the six-link planar redundant robot manipulator with its end-effector tracking the given square path synthesized by different-level simultaneous minimization scheme (Equations 6–12) and with the first joint being faulty from on t = 15 s. (A) Desired square-path and actual end-effector trajectory. (B) Corresponding tracking position-error profiles. (C) Joint-torque profiles. (D) Joint-angle profiles. (E) Joint-velocity profiles. (F) Joint-acceleration profiles.
Remark 3: Note that, for a fault-tolerant task, it can be classified into the following two cases. (i) The equality constraint is always satisfied; e.g., once some joints are simultaneously faulty, the remainder joints can take over the workload and move the end-effector to its goal via a fault-tolerant scheme. (ii) The equality constraint can not be always satisfied; e.g., with some joints being faulty, the equality constraint does not hold at some time instants, and thus the path-tracking task can not be fulfilled in this situation. Theoretically speaking, the equality constraint should be satisfied all the time. However, strictly speaking, the equality constraint can not be satisfied exactly even for the first case. Specifically, the tracking position-error profiles synthesized by the different-level simultaneous minimization scheme (Equations 6–12) are numerically near zero but nonzero (i.e., 10−6). That is because the simulation and computation are performed on a finite-arithmetic finite-memory digital computer. Then, the tracking position error may be inevitable between the desired path and actual trajectory, which is used to be the input of the feedback to track the task in a more accurate manner. To show clearly the second case (i.e., the equality constraint is not always satisfied), the corresponding motion trajectories and tracking errors with the first five joints being locked from on t = 15 s are visualized in Figure 2. Specifically, as seen from Figure 2, with the first five joints being faulty from on t = 15 s, the values of the corresponding joint velocities and joint accelerations are zero and the corresponding joint angles remain the same as θ(t = 15). To distinguish those two types of position error (i.e., the usual computational error, and the failure error due to the lack of feasible solution) as well as to keep the robotic system more reliable, a criterion can be added to the scheme. For example, the emergency brake of the system can be activated for the position error larger than 0.01 m with an increasing trend. As shown in Figure 2D, with the red dotted line denoting the criterion, the robotic system can be stopped at time instant t ≈ 16 s to prevent the potential damage(s) to nearby people and/or robot arms.
Figure 2. Simulation results of the six-link planar redundant robot manipulator with its end-effector tracking the given square path synthesized by different-level simultaneous minimization scheme (Equations 6–12) with the first five joints being faulty from on t = 15 s. (A) Joint-angle profiles. (B) Joint-velocity profiles. (C) Joint-acceleration profiles. (D) Corresponding tracking position-error profiles.
It is worth pointing out that, although the investigations are based on the joint-lock situation, the efficacy of the proposed different-level simultaneous minimization scheme (Equations 6–12) as well as the resultant QP is not limited to the joint-lock situation. The joint-lock situation is just a representative of lots of joint faulty situations, such as the failure of one joint actuator. In addition, being the representative, the joint-lock situation extensively exists in types of joints (e.g., rotational joints and translational joints). For example, the joints may be locked with a greater probability when the robot works with the sludge. Thus, the proposed different-level simultaneous minimization scheme (Equations 6–12) is generally applicable, and the feasibility and efficacy of such a proposed scheme are not limited by the specific robot structure and failure mode.
In this paper, by incorporating the physical constraints in joint space, a different-level simultaneous minimization scheme, which takes both the robot kinematics and robot dynamics into account, has been presented and investigated for fault-tolerant motion planning of redundant manipulator in this paper. Then, the scheme has been reformulated as a quadratic program (QP) with equality and bound constraints, which has been solved by a discrete-time recurrent neural network. Simulative verifications based on a six-link planar redundant robot manipulator have substantiated the efficacy and accuracy of the presented acceleration fault-tolerant scheme, the resultant QP and the corresponding discrete-time recurrent neural network.
LJ and BL presented the scheme. BL and ML designed experiments. LX and DG carried out experiments. XY analyzed experimental results. LJ and BL wrote the manuscript.
This work is supported by the Hunan Natural Science Foundation of China (No. 2017JJ3257, and No. 2017JJ3258), by the Fundamental Research Funds for the Central Universities (No. lzujbky-2017-37), by the National Natural Science Foundation of China (No. 61563017, No. 61703189, No. 61503152, and 61662025), by the Research Foundation of Education Bureau of Hunan Province, China (No. 17B215, No. 17C1299, and No. 15B192), and by the Scientific Research Foundation of Jishou University (No. jsdxxcfxbskyxm201508).
Conflict of Interest Statement
The authors declare that the research was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.
The reviewer YZ and handling Editor declared their shared affiliation.
The Supplementary Material for this article can be found online at: https://www.frontiersin.org/article/10.3389/fnbot.2017.00050/full#supplementary-material
Bustan, D., Sani, H., and Pariz, N. (2014). Adaptive fault-tolerant spacecraft attitude control design with transient response control. IEEE/ASME Trans. Mechatr. 19, 1404–1411. doi: 10.1109/TMECH.2013.2288314
Izumikawa, Y., Yubai, K., and Hirai, J. (2005). Fault-tolerant control system of flexible arm for sensor fault by using reaction force observer. IEEE/ASME Trans. Mechatr. 10, 391–396. doi: 10.1109/TMECH.2005.852442
Jin, L., Li, S., Hung, L., and Luo, X. (2017a). Manipulability optimization of redundant manipulators using dynamic neural networks. IEEE Trans. Ind. Electron. 64, 4710–4720. doi: 10.1109/TIE.2017.2674624
Jin, L., Li, S., Xiao, L., Lu, R., and Liao, B. (2017b). Cooperative motion generation in a distributed network of redundant robot manipulators with noises. IEEE Trans. Syst. Man Cybern. Syst. doi: 10.1109/TSMC.2017.2693400
Jin, L., Zhang, Y., Li, S., and Zhang, Y. (2016). Modified ZNN for time-varying quadratic programming with inherent tolerance to noises and its application to kinematic redundancy resolution of robot manipulators. IEEE Trans. Ind. Electron. 63, 6978–6988. doi: 10.1109/TIE.2016.2590379
Sun, L., Meng, M., Li, S., Liang, H., and Mei, T. (2009). A novel CPG with proprioception and its application on the locomotion control of quadruped robot. Int. J. Inf. Acquisition 6, 33–46. doi: 10.1142/S0219878909001771
Tang, H., Liu, P., and Liu, S. (2017). Adaptive neural synchronization control for bilateral teleoperation systems with time delay and backlash-like hysteresis. IEEE Trans. Cybern. 1–9. doi: 10.1109/TCYB.2016.2644656
Wang, H., Liu, K., Liu, X., Chen, B., and Lin, C. (2015). Neural-based adaptive output-feedback control for a class of nonstrict-feedback stochastic nonlinear systems. IEEE Trans. Cybern. 45, 1977–1987. doi: 10.1109/TCYB.2014.2363073
Wang, H., Liu, X., and Liu, K. (2016). Robust adaptive neural tracking control for a class of stochastic nonlinear interconnected systems. IEEE Trans. Neural Netw. Learning Syst. 27, 510–523. doi: 10.1109/TNNLS.2015.2412035
Xiao, L., and Zhang, Y. (2013). Acceleration-level repetitive motion planning and its experimental verification on a six-link planar robot manipulator. IEEE Trans. Control Syst. Technol. 21, 906–914. doi: 10.1109/TCST.2012.2190142
Zhang, Z., and Zhang, Y. (2012). Acceleration-level cyclic-motion generation of constrained redundant robots tracking different paths. IEEE Trans. Syst. Man Cybern. B Cybern. 42, 1257–1269. doi: 10.1109/TSMCB.2012.2189003
Zhang, Z., and Zhang, Y. (2013). Variable joint-velocity limits of redundant robot manipulators handled by quadratic programming. IEEE/ASME Trans. Mechatr. 18, 674–686. doi: 10.1109/TMECH.2011.2181977
Zhang, Z., Lin, Y., Li, S., Li, Y., and Luo, Y. (2017b). Tri-criteria optimization-coordination-motion of dual redundant robot manipulators for complex path planning. IEEE Trans. Control Syst. Technol. 27, 178–1186. doi: 10.1109/TCST.2017.2709276
Zhang, Z., Zheng, L., Yu, J., Li, Y., and Yu, Z. (2017a). Three recurrent neural networks and three numerical methods for solving repetitive motion planning scheme of redundant robot manipulators. IEEE/ASME Trans. Mechatr. 22, 1423–1434. doi: 10.1109/TMECH.2017.2683561
Keywords: redundant manipulator, different level, fault tolerance, physical constraint, discrete-time recurrent neural network
Citation: Jin L, Liao B, Liu M, Xiao L, Guo D and Yan X (2017) Different-Level Simultaneous Minimization Scheme for Fault Tolerance of Redundant Manipulator Aided with Discrete-Time Recurrent Neural Network. Front. Neurorobot. 11:50. doi: 10.3389/fnbot.2017.00050
Received: 15 May 2017; Accepted: 28 August 2017;
Published: 11 September 2017.
Edited by:Shuai Li, Hong Kong Polytechnic University, Hong Kong
Reviewed by:Zhijun Zhang, South China University of Technology, China
Yinyan Zhang, Hong Kong Polytechnic University, Hong Kong
Dechao Chen, Sun Yat-sen University, China
Huanqing Wang, Carleton University, Canada
Copyright © 2017 Jin, Liao, Liu, Xiao, Guo and Yan. This is an open-access article distributed under the terms of the Creative Commons Attribution License (CC BY). The use, distribution or reproduction in other forums is permitted, provided the original author(s) or licensor are credited and that the original publication in this journal is cited, in accordance with accepted academic practice. No use, distribution or reproduction is permitted which does not comply with these terms.
*Correspondence: Bolin Liao, email@example.com