Robot small-line-segment proactive planning method based on position and posture restraint

Abstract

The invention discloses a robot small-line-segment proactive planning method based on position and posture restraint. The small-line-segment proactive planning method is adopted to obtain angular velocity planning data of each joint of a robot, the method is characterized by adopting a fusion velocity vector to take the place of a linear velocity to serve as a planning variable in the proactive planning method, wherein v1, v2 and v3 represent the linear velocities of a tail end coordinate system origin moving along base coordinate X, Y and Z axial directions, and omega1, omega2 and omega3 represent angular velocities of euler angles. The robot small-line-segment proactive planning method based on the position and posture restraint has the advantages that the positions and postures are restrained, the situations that any one of the positions and postures of the tail end coordinate system suddenly changes or the positions and postures of the tail end coordinate system simultaneously suddenly change can be effectively avoided, if the postures are not changed, the linear velocity can reach a set maximum value, the efficiency is high, the posture velocity and linear velocity are fused into an variable, the controlled variable is reduced, the calculation is simpler, and the operating rate is quicker.

Description

Technical field [0001] The invention relates to the field of an industrial robot welding, spraying, assembling and processing curved surfaces and curves according to a certain track. Background technique [0002] In industrial production practice, industrial robots are widely used in welding, spraying, assembly and processing fields. Sometimes the robot is required to run along a specific curve, and it is difficult to obtain the required trajectory path through traditional teaching methods. At this time, it is necessary to use offline programming software to divide the curve into many small straight lines and arcs. In conventional trajectory planning, acceleration and deceleration are performed on each small line segment to make the speed at both ends of the line segment zero. This method not only requires frequent start and stop of the motor, but also results in the end running speed is always low, which does not meet the requirements. [0003] When the end coordinate system is ...

AI Technical Summary

Problems solved by technology

In conventional trajectory planning, each small line segment is accelerated and decelerated so that the speed at both ends of the line segment is zero. This method not only requires the motor to start and stop frequently, but also leads to the end running speed is always low, which cannot meet the requirements.

[0003] When the terminal coordinate system moves, the existing forward-looking algorithm only considers the linear velocity planning of the terminal coordinate system origin movement, and does not consider the change of the terminal coordinate system attitude

Images