EtherCAT bus position compensation method

Abstract

The invention discloses an EtherCAT bus position compensation method, which comprises a bus fault observer, a motion state cache module and a position increment prediction module; the bus fault observer detects the sequential relationship between DC interruption and PDI interruption of a servo slave station, and when a bus normally runs, the two interruptions are in one-to-one correspondence one after the other, the motion state cache module stores the states of the bus during normal operation, including position increment, acceleration and jerk; when the bus fails, the current acceleration iscalculated according to the acceleration and jerk of the previous moment, the current position increment is calculated according to the current acceleration and the position increment of the previousmoment, and the current position increment is calculated according to the current acceleration and the jerk, wherein the position increment can be given to the position ring to serve as input of theposition ring; meanwhile, the predicted acceleration and position increment are cached. By caching the position increment data when the bus is normal, the most possible position increment can be predicted when the bus fails, so that the bus failure influence, motor jitter and even mechanical failure caused by external interference of the slave station are avoided.

Description

technical field [0001] The invention relates to the technical field of motor drive and motion control, in particular to an EtherCAT bus position compensation method. Background technique [0002] EtherCAT is the abbreviation of Ethernet for Control Automation Technology. It is an open network communication protocol between master station and slave station based on real-time Ethernet developed by BeckhoffAutomation GmbH and managed by ETG (EtherCAT Technology Group) organization. Currently EtherCAT has become a widely used bus communication protocol. [0003] EtherCAT is a high-speed field bus protocol based on Ethernet. It uses UDP to encapsulate the EtherCAT protocol into UDP / IP data packets, and uses a fixed bus cycle for data refresh. During the synchronization process of the EtherCAT protocol, the local clock of the first slave station will be obtained as the reference clock of the entire bus. All slave stations on the entire bus, including the master station, will adj...

AI Technical Summary

Problems solved by technology

At this time, if the data frame is damaged due to external electromagnetic interference and other reasons, the target position of a certain period is not updated to the slave station. At this time, the slave station will generate a sudden change in the position command, causing the vibration of the servo operation, and the servo slave station will Abnormal noise may occur when running at low speed, and may cause alarm when running at high speed, and even cause machine damage or safety accidents in severe cases

[0006] In order to solve this problem, the lost frame retransmission function can be added to the master station. However, there are many EtherCAT master stations from various manufacturers on the market, and many master stations do not have this function. In order to improve the anti-interference ability and stability of the servo slave station, there are also For the compatibility of each master station, this problem must be dealt with

Images