A Model Reconstruction Method of Single-joint Fault Manipulator Based on Projective Geometry

Abstract

The invention discloses a single-joint fault mechanical arm model rebuilding method based on a projection geometric method. The method mainly includes that a kinematic model of a mechanical arm is characterized on the basis of rotation coordinates, different fault joints are different in axial direction in a base coordinate system, and fault angles of the fault joints influence different parameters of joint rotation coordinates, so that the fault joints are classified according to the axial direction; aiming at different joints, a projection method is adopted to construct a projection plane in a common perpendicular face of axes of the joints, and kinematic model plane projection drawings are acquired; according to the plane projection drawing of each fault joint, a relational expression of the fault angles, length of connecting rods and joint rotation coordinates is established through geometric analysis, and then rebuilding of a single-joint fault mechanical arm model is completed. By using the method, the problem that movement cannot be controlled due to the fact that an original kinematic model is invalid after a single joint of the mechanical arm is in a fault is solved; a rotation theory is used as a base, so that compared with a D-H parameter method, the method has the advantages of high efficiency, high universality and suitability for mechanical arms different in structure.

Description

technical field [0001] The invention relates to a model reconstruction method of a single-joint fault manipulator based on a projection geometry method, and belongs to the technical field of manipulator fault tolerance. Background technique [0002] Since the space environment has the characteristics of ultra-vacuum, high temperature difference, and strong radiation, considering the harsh working environment of the space manipulator and the complexity of the internal structure of the joint, joint failure is very likely to occur during its long-term service. Once the space manipulator fails, it usually cannot be repaired in time, which will lead to the delay or even delay of the space mission, thereby affecting the implementation of the entire space program. At present, for the sudden failure of a single joint of the space manipulator during on-orbit operation, locking the faulty joint is a simple and effective solution. After the joint is locked, due to the damage of the mo...

AI Technical Summary

Problems solved by technology

[0004] The purpose of the present invention is to address the shortcomings of the above-mentioned model reconstruction method, to provide a single-joint failure manipulator model reconstruction method based on the projection geometry method, which solves the problem that the movement model of the manipulator under the single-joint failure state changes and motion control cannot be performed The problem

Images