Control circuit for realizing S curve acceleration and deceleration of motion control system

Abstract

Provided is a control circuit for realizing S curve acceleration and deceleration of a motion control system. A CPU bus interface circuit writes the accelerated acceleration, the average speed, the initial speed, the termination speed and instruction displacement parameters into corresponding registers in an instruction parameter register and sends out the working state of the circuit in response to an external request; an initialization circuit reads instruction parameters in the instruction parameter register, calculates the total speed change and reasonably plans the speed change of each section; an accelerated acceleration integral circuit and an acceleration integral circuit execute integral operation and writes the integral operation into corresponding registers in an execution register; a drive pulse inter-pulse calculation circuit reads a speed register and calculates the inter-pulse count value of drive pulses; a pulse generating circuit uses the inter-pulse count value to count a reference clock so as to achieve the required drive pulses; a displacement control circuit counts the output drive pulses, calculates the output displacement and writes the output displacement into a displacement register; and a state transfer and control circuit causes the S curve acceleration and deceleration control circuit to act in an orderly and coordinated mode in response to the reference clock.

Description

Technical field [0001] The technical solution belongs to the field of motion control, and specifically is a control circuit that realizes S-curve acceleration and deceleration of a motion control system. Background technique [0002] Acceleration and deceleration control is a key technology for robots and high-performance CNC systems. Compared with other methods, S-curve acceleration and deceleration control has the advantages of continuous acceleration, smooth and uniform speed curve, smooth motion, and no impact, and can achieve ideal motion control effects. Combining the actual needs of high-performance CNC, robots, etc., nested forward-looking fast algorithms for S-curve acceleration and deceleration, real-time software and other achievements have appeared successively, but its speed planning model, solution algorithm and real-time performance are urgently needed for research in this field. problem. [0003] In contrast, the existing S-curve acceleration and deceleration cont...

AI Technical Summary

Problems solved by technology

The amount of calculation is large, which has a great impact on the real-time performance of the system, especially the motion control system based on embedded processors.

Images