Aiming at the perturbation of motion capability and the deviation of end effector from its desired trajectory caused by joint effectiveness partial loss failure, a fault-tolerant control strategy considering motion capability optimization is proposed to ensure that the faulty space manipulator can carry on-orbit operation tasks. Firstly, the joint effectiveness partial loss failure model is established, and the kinematic and dynamic model of the faulty manipulator is established based on the failure model. The kinematic and dynamic coupling relationship of the faulty manipulator is also analyzed. Then based on sliding mode control, the fault-tolerant control strategy that ensures the end effector trajectory tracking and base orientation deflection attenuation is designed. Meanwhile, the motion capability optimization model is designed based on the redundancy characteristic of the manipulator and combined with the fault-tolerant control system. This combined system can realize end effector trajectory tracking, base orientation deflection attenuation, and motion capability optimization at the same time. Finally, simulation experiment is carried out to verify the proposed fault-tolerant control strategy for the faulty manipulator. The result shows that the proposed fault-tolerant control strategy can realize end effector trajectory tracking, base orientation deflection attenuation, and motion capability optimization with high control accuracy, high convergence rate, and significant motion capability optimization effect. For both joint velocity partial loss and joint torque partial loss failure, the duration of convergence is less than 0.5 s, the steady-state error is less than 1×10-4 m for end effector position and less than 1×10-5 degree for base orientation deflection, and the motion capability indexes have been raised by over 40%.
Read full abstract