High-precision multi-hydraulic axis linkage control method based on intelligent slave station
By constructing a master-slave architecture and EtherCAT bus communication in the CNC system, and combining flow feedforward compensation, friction feedforward compensation, and disturbance observation, the problems of high precision and low cost of multi-hydraulic axis linkage control system were solved, and high-precision multi-hydraulic axis linkage control was realized.
Patent Information
- Application Number
- CN202611461276.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-09-20
- Publication Date
- 2026-11-17
AI Technical Summary
There is insufficient research on high-precision multi-hydraulic axis linkage control systems in China, which rely on imported modules and are expensive, making it difficult to achieve low-cost high-precision control.
A high-precision multi-hydraulic axis linkage control method based on intelligent slave station is achieved by establishing a master-slave architecture in the CNC system, using EtherCAT bus for bidirectional communication, and combining flow feedforward compensation, friction feedforward compensation, disturbance observation and error feedback.
It achieves low-cost, high-precision multi-hydraulic axis linkage control, improves the system's real-time performance and control accuracy, and avoids dependence on imported modules.
Smart Images

Figure CN123113584A_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of hydraulic control, and in particular to a high-precision multi-hydraulic axis linkage control method based on an intelligent slave station. Background Technology
[0002] Compared to the rapid development of domestic research on general CNC systems such as lathes and milling machines, research on high-precision hydraulic control systems lags significantly behind that of foreign countries. High-precision hydraulic control systems have long been monopolized by foreign companies, such as Bosch Rexroth and Siemens from Germany, and Fanuc from Japan. Domestic research largely focuses on single-axis control, with insufficient depth in multi-axis linkage control. Existing multi-axis hydraulic control systems still rely on imported modules, resulting in high costs. Summary of the Invention
[0003] The main objective of this invention is to propose a high-precision multi-hydraulic axis linkage control method based on an intelligent slave station, which can achieve high-precision control of multi-axis hydraulic control systems at low cost.
[0004] This invention is achieved through the following technical solution:
[0005] A high-precision multi-hydraulic axis linkage control method based on intelligent slave stations includes the following steps:
[0006] Step S1: Construct a master-slave architecture, with the CNC system controller as the master station, the intelligent slave station running the LINUX operating system, and an EtherCAT bus bidirectional communication connection established between the master station and the intelligent slave station.
[0007] Step S2: In the CNC system, a corresponding virtual axis is established for each hydraulic axis. The CNC system performs multi-axis linkage interpolation control, calculates the pulse increment of each virtual axis within the interpolation cycle, and sends the pulse increment to the intelligent slave station through the EtherCAT bus.
[0008] Step S3: The IO module of the intelligent slave station obtains the current position of each hydraulic shaft. The intelligent slave station performs hydraulic control calculations on the pulse increment and current position of each hydraulic shaft to obtain the output analog data of each hydraulic shaft. The hydraulic control calculation process includes flow feedforward compensation, friction feedforward compensation, disturbance observation and error feedback during hydraulic reversal.
[0009] Step S4: The intelligent slave station sends the generated analog output data of each hydraulic axis to the hydraulic proportional valve amplifier to realize the linkage control of multiple hydraulic axes.
[0010] Furthermore, in step S1, the intelligent slave station includes an FPGA and a master control chip. The master control chip accesses the link layer located in the FPGA through a PCIe parallel bus. The link layer has a bidirectional communication connection with the master station. The intelligent slave station runs on a LINUX operating system and installs Beremiz software. The hydraulic control module is developed based on Beremiz software.
[0011] Furthermore, in step S2, the CNC system integrates a two-dimensional CAM module. After importing the DXF file into the CNC system, the two-dimensional CAM module generates G-code based on the DXF file.
[0012] Furthermore, in step S2, the interpolator of the CNC system decodes the G code and plans the trajectory. Based on the feed rate, current position and target position obtained after decoding the G code and planning the trajectory, the interpolator calculates the theoretical displacement increment of each virtual axis in real time within each fixed interpolation cycle and outputs it in the form of pulse increment.
[0013] Furthermore, in step S3, the flow feedforward compensation obtains the transient flow demand. ,in, This refers to the effective working area of the hydraulic actuator corresponding to the hydraulic shaft. The velocity command for the desired trajectory obtained from G-code. This represents the leakage coefficient corresponding to the hydraulic shaft. The effective bulk modulus of the oil. The working cavity volume of the hydraulic actuator. This refers to the load pressure.
[0014] Furthermore, in step S3, the friction force feedforward compensation obtains the feedforward compensation current. ,in, Instantaneous frictional torque, For Coulomb friction, For static friction, The collected hydraulic shaft speed, For Stribeck speed, For symbolic functions, It is an experience index. The coefficient of viscous friction, This is the motor torque constant corresponding to the hydraulic shaft.
[0015] Furthermore, in step S3, the disturbance observation includes: constructing a third-order state observer based on an extended state observer architecture, treating load force mutation, parameter perturbation, and unmodeled dynamics as a unified total disturbance state, estimating the disturbance components including load force mutation, parameter perturbation, and unmodeled dynamics in real time through the third-order state observer, and feeding the estimation results forward into the current output terminal of the IO module for active cancellation.
[0016] Furthermore, in step S3, during the hydraulic control calculation, dead-zone compensation is used to eliminate the cumulative detection error of the IO module, specifically including: when the position deviation... When the deviation of the current position relative to the target position is determined to be within the quantization uncertainty range, if the encoder pulse direction on the hydraulic actuator is opposite to the polarity of the position deviation, the error integration accumulation is paused and the accumulated error in that direction is masked. When pulses in the same direction are continuously detected and At that time, the pulse equivalent absorbed by the dead zone is replenished in one go. ,in, This is the dead zone threshold set based on the quantization resolution of the I / O module.
[0017] Furthermore, the intelligent slave station lacks application layer protocols, distributed clock functionality, and SDO functionality; it functions only as a regular EtherCAT IO device.
[0018] As can be seen from the above description of the present invention, compared with the prior art, the present invention has the following beneficial effects:
[0019] This invention establishes a corresponding virtual axis for each hydraulic axis in the CNC system. The CNC system performs multi-axis linkage interpolation control, calculating the pulse increment of each virtual axis within the interpolation cycle. This pulse increment is then sent to an intelligent slave station via an EtherCAT bus. The slave station's I / O module obtains the current position of each hydraulic axis. The intelligent slave station performs hydraulic control calculations based on the pulse increment and current position of each hydraulic axis, obtaining the output analog data for each axis. The intelligent slave station then sends this generated output analog data to a hydraulic proportional valve amplifier to achieve high-precision linkage of multiple hydraulic axes. By establishing virtual axes, interpolation control and hydraulic control are performed separately at the master and slave stations, respectively, using the EtherCAT bus for communication. This provides strong real-time performance and eliminates the need for imported control modules, thus achieving high-precision control of a multi-axis hydraulic control system at low cost. Attached Figure Description
[0020] The present invention will be further described in detail below with reference to the accompanying drawings and specific embodiments.
[0021] Figure 1 This is a flowchart of the present invention.
[0022] Figure 2This is a block diagram illustrating the hydraulic control calculation principle of the present invention. Detailed Implementation
[0023] The present invention will be further described below through specific embodiments.
[0024] like Figure 1 As shown, the high-precision multi-hydraulic axis linkage control method based on intelligent slave station includes the following steps:
[0025] Step S1: Construct a master-slave architecture, with the CNC system controller as the master station, the intelligent slave station running the LINUX operating system, and an EtherCAT bus bidirectional communication connection established between the master station and the intelligent slave station.
[0026] The intelligent slave station consists of an FPGA and a master control chip. The master control chip accesses the link layer located within the FPGA via a PCIe parallel bus. The link layer communicates bidirectionally with the master station via an EtherCAT bus, with an EtherCAT communication transmission cycle of 1ms. The intelligent slave station lacks application layer protocols, distributed clock functionality, and SDO functionality; it functions solely as a regular EtherCAT I / O device.
[0027] The intelligent slave station is equipped with a LINUX operating system, running a LINUX+Xenomai environment. The installed Beremiz software provides a soft PLC secondary development programming platform compatible with the IEC61131 standard. The hydraulic control module is developed based on Beremiz software and has functions such as flow feedforward compensation during hydraulic reversal, identification and feedforward compensation of hydraulic shaft friction parameters, and identification and compensation of load inertia force.
[0028] Step S2: In the CNC system, a corresponding virtual axis is established for each hydraulic axis. The CNC system performs multi-axis linkage interpolation control, calculates the pulse increment of each virtual axis within the interpolation cycle, and sends the pulse increment to the intelligent slave station through the EtherCAT bus.
[0029] The process of establishing a corresponding virtual axis for each hydraulic axis is existing technology. The CNC system integrates a 2D CAM module. After importing a DXF file into the CNC system, the 2D CAM module generates G-code based on the DXF file. Specifically, the process involves establishing virtual axes X and Y in the CNC system. Essentially, this involves constructing an abstract coordinate system decoupled from the physical servo axes through a software layer. The X and Y axes serve as logical mapping units, directly corresponding to the Cartesian coordinate plane in the 2D CAD drawing. The system extracts the nodes, line segments, and curve parameters of the geometric contour by parsing the CAD file (e.g., DXF format), converting them into a sequence of discrete coordinate points in the virtual axis space. Then, an interpolation algorithm (such as linear interpolation, circular interpolation, or spline interpolation) is used to generate the tool center trajectory, thus completing the seamless conversion from design drawings to G-code (i.e., CNC machining program), achieving a "what you see is what you get" digital manufacturing process.
[0030] The interpolator of the CNC system first decodes the G code and plans the trajectory, decomposing the contour trajectory of the target workpiece into tiny straight line segments or curve segments. Then, based on the feed rate, current position and target position obtained after decoding the G code and planning the trajectory, the interpolator calculates the theoretical displacement increment of each virtual axis (such as X, Y and Z axes) in real time within each fixed interpolation cycle (usually 1 millisecond) and outputs it in the form of pulse increments—that is, converting the distance that each axis needs to move within the cycle into a corresponding number of electrical pulse signals, with each pulse representing a minimum displacement unit (such as 0.001 mm).
[0031] Step S3: The IO module of the intelligent slave station obtains the current position of each hydraulic shaft. The intelligent slave station performs hydraulic control calculations on the pulse increment and current position of each hydraulic shaft to obtain the output analog data of each hydraulic shaft. The hydraulic control calculation process includes flow feedforward compensation, friction feedforward compensation, disturbance observation and error feedback during hydraulic reversal. The analog data includes transient flow demand, feedforward compensation current, real-time estimated disturbance components and pulse equivalent swallowed by dead zone.
[0032] like Figure 2 As shown, the IO module connects to a grating ruler and a pressure sensor located at the end of the hydraulic shaft.
[0033] Flow feedforward compensation is based on the hydraulic system transfer function model. It calculates the flow demand of the valve-controlled cylinder through a dynamic inverse model, predicts the hydraulic system's inertial delay, and suppresses phase lag caused by oil compressibility and pipeline dynamics. The specific process is as follows: based on the speed command of the desired trajectory... With acceleration command Combined with the effective working area of the hydraulic actuator (hydraulic cylinder or hydraulic motor) (The pressure-bearing cross-sectional area of the piston's rodless or rod chamber, in m²), leakage coefficient (Proportional coefficient of oil leakage between piston and cylinder wall and at seals, unit m) 5 / (N·s)), effective bulk elastic modulus of oil (A physical quantity characterizing the compressibility of oil; for mineral oil, it is typically taken as 1.4~2.0 × 10⁻⁶) 9 Pa) and working cavity volume (Total volume of the single-sided cavity and connecting pipes of the hydraulic actuator, in m³), calculate the transient flow demand using the continuity equation. Among them, load pressure (Unit: Pa) From the force balance equation It is estimated that denoted as external load force (in N), m as equivalent mass of piston and load (in kg), and B as viscous damping coefficient (in N·s / m). Friction force (unit: N); this dynamic inverse model converts position commands into the required valve orifice flow rate, compensating in advance for the frictional force caused by the compressibility of the oil. The phase lag caused by the dynamics of the pipeline (item) causes the flow supply to lead the piston movement demand, thus suppressing the system inertial delay.
[0034] Friction feedforward compensation employs the Stribeck model method to quantify nonlinear friction effects (such as Coulomb friction and viscous friction), generating a compensation current to counteract the low-speed creeping phenomenon of the actuator and improve micro-motion positioning accuracy. The specific quantization process involves using the Stribeck friction model to parametrically identify and quantify the nonlinear friction of the hydraulic actuator in real time. The Stribeck friction model converts friction force... Decomposed into Coulomb friction (Constant friction component as velocity approaches infinity, unit: N), static friction (Maximum static friction force when the speed is zero and about to start, in N), coefficient of viscous friction (Viscous damping coefficient proportional to velocity, unit N·s / m) and the Stribeck effect (a nonlinear attenuation characteristic describing the transition from static friction to kinetic friction), whose velocity dependence is expressed as: ,in Stribeck velocity (the critical velocity value corresponding to the decrease of friction to about 1%~2% of Coulomb friction, in m / s). An empirical index (usually 1-2, controlling the steepness of the Stribeck curve transition); identified through existing low-speed round-trip experiments and least-squares fitting. , , , Real-time acquisition of hydraulic actuator speed Substitute the values into the model to calculate the instantaneous frictional torque / force, and then use the motor torque constant as a reference. (Unit: N·m / A, i.e., electromagnetic torque generated per unit current) converted to feedforward compensation current. Direct injection into the intelligent slave station compensates for low-speed crawling and commutation dead zones. The speed of the hydraulic actuator is obtained by differentiating the position acquired by the grating.
[0035] Disturbance observation includes: constructing a third-order state observer based on an extended state observer architecture, treating load force mutation, parameter perturbation, and unmodeled dynamics as a unified total disturbance state, estimating disturbance components including load force mutation, parameter perturbation, and unmodeled dynamics in real time through the third-order state observer, and actively canceling the estimated disturbance components by feeding them forward into the current output of the IO module. Among them, load force mutation refers to the sudden change of the external load borne by the hydraulic actuator, parameter perturbation refers to the deviation between the actual parameters of the CNC system controller and the nominal parameters used in the design, and unmodeled dynamics refers to dynamic characteristics that are ignored or difficult to describe accurately when establishing the control model, such as servo valve dynamics and hydraulic pipeline flexibility effects.
[0036] By combining high-gain observer technology, full-state reconstruction can be achieved under unmeasurable conditions (such as the speed of hydraulic actuators), ensuring the robustness of the feedback control law.
[0037] Hydraulic control calculations also include error feedback control, employing a nonlinear error feedback control law (such as NLSEF in active disturbance rejection control), combined with a proportional-derivative (PD) structure and adaptive gain scheduling, dynamically adjusting the integral strength and differential damping of the error to balance fast response and overshoot suppression. Specifically, for the quantization error of the grating ruler feedback, a dead-zone compensation algorithm is introduced, eliminating the accumulated error of position detection through real-time analysis of the pulse direction (CW / CCW) and deviation polarity. This includes: when the position deviation... When the deviation of the current position relative to the target position is determined to be within the quantization uncertainty range, logical arbitration is performed based on the matching of the encoder pulse direction signal (CW clockwise / CCW counterclockwise) with the actual command direction. That is, if the encoder pulse direction on the hydraulic actuator is opposite in polarity to the position deviation, a "pseudo-back" pulse occurs. If the command requires forward movement but the feedback pulse shows reverse micro-motion, the error integration accumulation of the integrator in the position loop PID is paused and the accumulated error in that direction is masked. Masking the accumulated error means preventing the quantization error from entering the integration term; otherwise, integration updates are allowed. When consecutive pulses in the same direction are detected, and At that time, step error compensation is performed to replenish the pulse equivalent that was swallowed by the dead zone in one go. This eliminates the accumulated position detection error and limit cycle oscillation caused by quantization truncation. If the pulse direction changes frequently, the continuous counter is reset to zero, waiting for a stable direction. If there are no pulses, the status quo is maintained without compensation. The dead zone threshold is set according to the quantization resolution of the IO module. Specifically, it addresses the inherent ±1 pulse equivalent (e.g., 0.5μm or 1μm) quantization resolution limitation of the TTL square wave pulse feedback of the grating ruler. The dead zone threshold δ is set to half a pulse equivalent (e.g., 0.25μm). The current position is obtained through grating acquisition. Round up to the nearest whole number.
[0038] The hydraulic control calculation of the intelligent slave station forms a synergistic effect through the model-driven compensation of the feedforward channel and the closed-loop correction of the feedback channel. Combined with the dynamic decoupling capability of the disturbance observer, it significantly improves the system's ability to suppress time-varying loads, nonlinear friction and external disturbances.
[0039] Step S4: The intelligent slave station sends the generated output analog data of each hydraulic axis to the hydraulic proportional valve amplifier to realize the linkage control of multiple hydraulic axes.
[0040] Specifically, the output analog data is sent to the hydraulic proportional valve amplifier, which in turn controls the servo valve to achieve linkage control of the hydraulic actuator.
[0041] In this invention, the terms "first," "second," and "third," etc., are used only to distinguish similar objects and are not necessarily used to describe a specific order or sequence, nor should they be construed as indicating or implying relative importance. The use of terms such as "upper," "lower," "left," "right," "front," and "rear" to indicate orientation or positional relationships is based on the orientation or positional relationships shown in the accompanying drawings and is only for the convenience of describing the invention, not to indicate or imply that the device referred to must have a specific orientation, or be constructed and operated in a specific orientation. Therefore, it should not be construed as a limitation on the scope of protection of this invention. Those skilled in the art can understand the specific meaning of the above terms in this application according to the specific circumstances.
[0042] Furthermore, in the description of this application, unless otherwise stated, "multiple" means two or more. "And / or" describes the relationship between related objects, indicating that three relationships can exist. For example, A and / or B can represent: A alone, A and B simultaneously, or B alone. The character " / " generally indicates that the preceding and following related objects have an "or" relationship.
[0043] The above are merely specific embodiments of the present invention, but the design concept of the present invention is not limited thereto. Any non-substantial modifications made to the present invention using this concept shall be considered as infringing upon the protection scope of the present invention.
Claims
1. A high-precision multi-hydraulic shaft linkage control method based on an intelligent slave station, characterized in that: Includes the following steps: Step S1: Construct a master-slave architecture, with the CNC system controller as the master station, the intelligent slave station running the LINUX operating system, and an EtherCAT bus bidirectional communication connection established between the master station and the intelligent slave station. Step S2: In the CNC system, a corresponding virtual axis is established for each hydraulic axis. The CNC system performs multi-axis linkage interpolation control, calculates the pulse increment of each virtual axis within the interpolation cycle, and sends the pulse increment to the intelligent slave station through the EtherCAT bus. Step S3: The IO module of the intelligent slave station obtains the current position of each hydraulic shaft. The intelligent slave station performs hydraulic control calculations on the pulse increment and current position of each hydraulic shaft to obtain the output analog data of each hydraulic shaft. The hydraulic control calculation process includes flow feedforward compensation, friction feedforward compensation, disturbance observation and error feedback during hydraulic reversal. Step S4: The intelligent slave station sends the generated analog output data of each hydraulic axis to the hydraulic proportional valve amplifier to realize the linkage control of multiple hydraulic axes.
2. The intelligent slave station based high precision multi-hydraulic axle linkage control method according to claim 1, characterized in that: In step S1, the intelligent slave station includes an FPGA and a master control chip. The master control chip accesses the link layer located in the FPGA through a PCIe parallel bus. The link layer has a bidirectional communication connection with the master station. The intelligent slave station runs on a LINUX operating system and has Beremiz software installed. The hydraulic control module is developed based on the Beremiz software.
3. The high-precision multi-hydraulic axis linkage control method based on intelligent slave station according to claim 2, characterized in that: In step S2, the CNC system integrates a 2D CAM module. After importing a DXF file into the CNC system, the 2D CAM module generates G-code based on the DXF file.
4. The high-precision multi-hydraulic axis linkage control method based on intelligent slave station according to claim 3, characterized in that: In step S2, the interpolator of the CNC system decodes the G code and plans the trajectory. Based on the feed rate, current position and target position obtained after decoding the G code and planning the trajectory, the interpolator calculates the theoretical displacement increment of each virtual axis in real time within each fixed interpolation cycle and outputs it in the form of pulse increment.
5. The high-precision multi-hydraulic axis linkage control method based on intelligent slave station according to claim 1, 2, 3, or 4, characterized in that: In step S3, the flow feedforward compensation obtains the transient flow demand. ,in, This refers to the effective working area of the hydraulic actuator corresponding to the hydraulic shaft. The velocity command for the desired trajectory obtained from G-code. This represents the leakage coefficient corresponding to the hydraulic shaft. The effective bulk modulus of the oil. The working cavity volume of the hydraulic actuator. This refers to the load pressure.
6. The high-precision multi-hydraulic axis linkage control method based on intelligent slave station according to claim 1, 2, 3, or 4, characterized in that: In step S3, the friction force feedforward compensation obtains the feedforward compensation current. ,in, Instantaneous frictional torque, For Coulomb friction, For static friction, The collected hydraulic shaft speed, For Stribeck speed, For symbolic functions, It is an experience index. The coefficient of viscous friction, This is the motor torque constant corresponding to the hydraulic shaft.
7. The high-precision multi-hydraulic axis linkage control method based on intelligent slave station according to claim 1, 2, 3, or 4, characterized in that: In step S3, the disturbance observation includes: constructing a third-order state observer based on an extended state observer architecture, treating load force mutations, parameter perturbations, and unmodeled dynamics as a unified total disturbance state, estimating the disturbance components including load force mutations, parameter perturbations, and unmodeled dynamics in real time using the third-order state observer, and actively canceling the estimation results by feeding them forward into the current output of the IO module. The method for high-precision multi-hydraulic axis linkage control based on intelligent slave stations, as described in claim 1, 2, 3, or 4, is characterized in that: in step S3, dead-zone compensation is used to eliminate accumulated position detection errors in the hydraulic control calculation, specifically including: when the position deviation... When the deviation of the current position relative to the target position is determined to be within the quantization uncertainty range, if the encoder pulse direction on the hydraulic actuator is opposite to the polarity of the position deviation, the error integration accumulation is paused and the accumulated error in that direction is masked. When pulses in the same direction are continuously detected and At that time, the pulse equivalent absorbed by the dead zone is replenished in one go. ,in, The dead zone threshold is set based on the quantization resolution of the IO module.
8. The high-precision multi-hydraulic axis linkage control method based on intelligent slave station according to claim 2, 3, or 4, characterized in that: The intelligent slave station has no application layer protocol, distributed clock function, or SDO function; it is simply a regular EtherCATIO device.
