Control method for dispersion S-shaped curve speed of mechanical arm

Abstract

A control method for the dispersion S-shaped curve speed of a mechanical arm includes the following steps that firstly, the operation speed of the mechanical arm is segmented into multiple speed sections, and the minimum speed value (shown in the specifications), the maximum speed value (shown in the specifications), the minimum acceleration (shown in the specifications), the maximum acceleration (shown in the specifications) and the jerk (shown in the specifications) of the current speed section are determined; secondly, the mechanical arm modifies the maximum speed value in the practical control process with the time period T as the speed planned period; and thirdly, speed control is divided into the acceleration stage, the constant speed stage and the speed reduction stage, real-time speed planning is conducted, the mechanical arm is accelerated in an S-shaped curve manner with the minimum speed (shown in the specifications) as the initial speed, and when the system position pulse sending time t is larger than or equal to the speed planned period T, in other words, t is larger than or equal to T, one time of speed planning operation is conducted. By means of the control method, stability of movement is effectively improved; and meanwhile, in two-axis synchronous movement control, the speed synchronization error can be compensated for in real time, and the control precision can be effectively improved.

Description

technical field [0001] The invention relates to a speed control method of a manipulator, in particular to a discrete S-curve speed control method used in manipulator control, and belongs to the field of motion control. Background technique [0002] China is a big manufacturing country. With the decline of the demographic dividend, the traditional labor-intensive production model is difficult to sustain. It is imperative to replace labor with machines. The upgrading and transformation of enterprises to automated production has become the main direction of development. "Machine substitution" in China's manufacturing industry is gradually being implemented. , has achieved certain results. As an important branch of industrial robots, the manipulator is one of the equipment that is in great demand in the process of machine replacement and upgrading. Domestic small and medium-sized enterprises have a strong demand for mid-to-low-end manipulators. Cartesian coordinate manipulators...

AI Technical Summary

Problems solved by technology

[0004] In order to overcome the shortcomings of the existing manipulator speed control mode, such as the poor smooth control of the speed in the single-axis manual operation mode and the poor synchronization of the two-axis linkage speed control, the present invention proposes a discrete S-curve speed control of the manipulator. The method can effectively realize the smooth control of the speed in the single-axis manual operation mode; for the two-axis linkage speed control, the synchronization time error can be compensated in real time to achieve more accurate synchronization control

Images