System method for servo motor position control

Abstract

The invention discloses a system method for servo motor position control. The system method for the servo motor position control includes following steps: firstly, using an orthogonal encoder to follow a rotor of a servo motor to rotate coaxially with the rotor of the servo motor, and generating an A phase pulse and a B phase pulse which are orthogonal and of the same frequency, wherein a phase position difference between the A phase pulse and the B phase pulse is 90 degrees; and then collecting the two pulses in real time by using an FPGA (field programmable gate array) chip and using an HDL (hardware description language), performing phase demodulation and add and subtraction counting on four change states in a period of the A phase pulse and the B phase pulse, and figuring out a rotation speed value through a counting value; and finally, using the FPGA chip to return the counting value and the rotation speed value which are figured out into a DSP (digital signal processor) chip through three buses, and using the DSP chip to perform comparison calculation on a rotation pulse number sent to the servo motor and the actual count value of the servo motor, returned through the three buses, so as to compensate actual rotation error of the servo motor and achieve close loop control for the servo motor. Accordingly, a forward transmission position or an inversion position of the servo motor is controlled, and the system method for the servo motor position control improves position control accuracy of the servo motor.

Description

technical field [0001] The invention relates to a system method for position control of a servo motor, which belongs to the field of position control of a high-precision servo motor. Background technique [0002] Modern high-precision CNC machine tools have higher and higher requirements for servo systems. High-performance servo motors, servo drives, controllers, and high-performance position and speed sensors are all indispensable components of servo systems. High responsiveness, high precision sensor is the key technology of the servo system. The performance of the servo system mainly depends on the performance of the sensor. [0003] At present, most quadrupling frequency counting and phase detection modules of quadrature encoding pulses are completed by state transition, that is, quadrupling frequency is realized after switching from one state to another specific state and then counting, but the changes of these four states may be Random jumps are prone to miscountin...

AI Technical Summary

Problems solved by technology

[0003] At present, most quadrupling frequency counting and phase detection modules of quadrature encoding pulses are completed by state transition, that is, quadrupling frequency is realized after switching from one state to another specific state and then counting, but the changes of these four states may be Random jumps are prone to miscounting and missing counting, especially in the case of frequent commutation, so its counting value cannot reach a stable state

Images