Cooperative control method for full-state constraint mechanical arm trajectory tracking

Abstract

The invention relates to a cooperative control method for full-state constraint mechanical arm trajectory tracking, and belongs to the technical field of control engineering. The method combines ABLF-based thrust-reversing control with Hamilton energy theory-based control, and builds a cooperative controller: establishing a mechanical arm system dynamics equation of n-joint constraint, and performing coordinate transformation on the equation to obtain a state-space equation of the system; designing an ABLF-based thrust-reversing controller, so as to improve system initial response speed, and prevent constraint from being damaged at the same time; designing the Hamilton energy theory-based controller, so as to improve tracking stability of a later period of system response; and designing the cooperative controller to realize rapid and stable control of a full-state constraint mechanical arm system. ON the premise of not damaging a full-state constraint condition, the cooperative controlmethod provided by the invention can improve dynamic-state and steady-state performance of the system, ensure fast mechanical arm system response speed and high positioning precision, and can effectively improve working performance of the mechanical arm in a robot system.

Description

technical field [0001] The invention relates to a control method, in particular to a cooperative control method for trajectory tracking of a full-state constrained mechanical arm, which belongs to the technical field of control engineering. Background technique [0002] The mechanical arm used by the robot is a nonlinear system, and its state, such as position and speed, is limited by various constraints. Once these practical constraints are violated, the performance of the system will be seriously degraded, and even the system will be endangered. Therefore, it is necessary to consider constraints in practical systems. At present, the problem of constrained control of nonlinear systems has been widely concerned. The methods to solve this kind of problems mainly include backstepping control method based on barrier Lyapunov function (BLF) and control method based on Hamilton (Hamilton) energy theory. [0003] The backstepping control method based on BLF can design the Lyapun...

AI Technical Summary

Problems solved by technology

[0005] However, for the robot system, although the BLF-based backstepping control method takes into account the influence of the actual constraints on the system, it has problems such as low tracking accuracy and poor steady-state performance; while the simple Hamilton control method does not fully consider the influence of the mechanical arm itself. Due to the actual constraints of the position and velocity, the dynamic performance of the system still needs to be further improved.

Images