Unified frequency domain characteristic control synchronization control method for dual-motor motion system
By designing virtual spindles and virtual motors in a dual-axis motor system, the control signal coupling feedback and error compensation are realized, the problem of unbalanced load of the dual-axis motor is solved, the accuracy and stability of synchronous control are improved, and efficient load characteristics are provided and dynamic response.
Patent Information
- Application Number
- CN202410983385.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-22
- Publication Date
- 2024-11-15
AI Technical Summary
The dual-axis motor has unbalanced problems in high-inertia and high-power load control, resulting in system jitter and instability, the accuracy performance of the uncoupled control structure is low, and the anti-interference ability is poor.
The virtual spindle and virtual motor are designed, the coupling feedback of the control signal is realized through the master-slave synchronous control structure, and the error compensation controller is optimized. The electrical signal is used to simulate the mechanical axis, set inertia and control parameters to achieve high-precision control of servo motion.
It realizes high tracking accuracy, stable real-time synchronization and fast dynamic response of dual motor synchronization control, improves load characteristics and provides a foundation for engineering practice.
Smart Images

Figure CN118971709A_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the field of dual-motor synchronous control, and in particular is a unified frequency domain characteristic control synchronous control method for a dual-motor motion system. Background Art
[0002] With the innovation of modern control theory and the development and improvement of servo motion control technology, servo motors have been widely used in large industrial fields such as machine tool processing, mechanical manufacturing, aerospace and military industry. Therefore, it is inevitable to stably control large inertia and high power loads. It is difficult to meet the power requirements by using only a single motor drive, and a single force point can easily cause the system to vibrate and become unstable due to uneven force. Using dual motor synchronous drive can achieve good control effects.
[0003] In terms of multi-motor control structure, compared with the traditional mechanical synchronization method, the electric synchronization method has the advantages of good flexibility and high control accuracy, and has been widely used in various fields. Common control structures are divided into whether they have coupling control. The non-coupling control structure has the advantages of simple system structure, no interference between motors, and good start-stop effect. However, because the system is an open-loop structure and there is no error compensation feedback, the accuracy performance is low and the anti-interference ability is poor. Therefore, based on the above problems, the present invention provides a unified frequency domain characteristic control synchronization control method for a dual-motor motion system. Summary of the invention
[0004] In order to solve the imbalance problem caused by the large load torque of the dual-axis motor in the prior art, the present invention provides a unified frequency domain characteristic control synchronization control method for a dual-motor motion system, which can use the synchronization control structure of the virtual spindle and combine with the weighted coupling controller to compensate for the error, thereby realizing dual-motor synchronization control.
[0005] To achieve the above purpose, the specific technical solution is as follows:
[0006] One of the present inventions is to provide a unified frequency domain characteristic control synchronization control method for a dual-motor motion system, including designing a dual-axis synchronization control system model, the model including setting a virtual spindle, imitating the spindle synchronization mode, and on the basis of master-slave synchronization control, feeding back the driving torque of the slave axis to the spindle control loop, thereby realizing the coupling feedback of the control signal between the spindle and the slave axis;
[0007] Design a virtual motor and use electrical signals to simulate the actual mechanical axis to achieve control of servo motion, including the design of inertia parameters and control parameters.
[0008] The inertia parameter is the rotational inertia setting of the virtual motor, and the control parameters include the equivalent transfer function parameters of each link including the PID controller;
[0009] Optimize the design of compensation controller. During synchronous motion, the errors include synchronization error between axes and tracking error between axes and instructions.
[0010] The second aspect of the present invention is to provide a unified frequency domain characteristic control synchronous control system for a dual-motor motion system, comprising:
[0011] A dual-axis synchronous control system model, which includes setting a virtual spindle and a virtual motor;
[0012] The virtual spindle imitates the spindle synchronization mode. On the basis of master-slave synchronization control, the drive torque of the slave axis is fed back to the spindle control loop, realizing the coupling feedback of the control signal between the spindle and the slave axis.
[0013] Virtual motor uses electrical signals to simulate actual mechanical axes to achieve control of servo motion, including the design of inertia parameters and control parameters;
[0014] Optimize the design of compensation controller. During synchronous motion, the errors include synchronization error between axes and tracking error between axes and instructions.
[0015] The third aspect of the present invention is to provide a unified frequency domain characteristic control synchronous control device for a dual-motor motion system, and the device is communicatively connected with the unified frequency domain characteristic control synchronous control system of the dual-motor motion system.
[0016] A fourth aspect of the present invention is to provide a computer-readable medium having a computer program stored thereon, which, when executed by a processor, implements the method as described in one of the purposes.
[0017] Compared with the prior art, the beneficial effects of the present invention are at least:
[0018] According to the synchronous control strategy of dual motors, the present invention designs a control structure using an electronic virtual spindle based on the premise of large inertia matching, and also designs a suitable error compensation controller to realize the coupling control of the dual motors, so that the control system has high tracking accuracy, stable real-time synchronization, fast dynamic response and good load characteristics, providing an engineering practice basis for the synchronous control of dual motors. BRIEF DESCRIPTION OF THE DRAWINGS
[0019] Figure 1 It is the load motion structure diagram of the present invention;
[0020] Figure 2 This is a structural diagram of the fine spindle control of the present invention;
[0021] Figure 3 It is a schematic diagram of the mathematical model of the servo motor of the present invention;
[0022] Figure 4 It is a schematic diagram of the relative position of the instruction and the motor of the present invention;
[0023] Figure 5 It is the error compensation flow chart of the present invention. DETAILED DESCRIPTION
[0024] The present invention will be described in detail below in conjunction with the specific embodiments shown in the accompanying drawings. However, these embodiments do not limit the present invention, and any structural, methodological or functional changes made by a person skilled in the art based on these embodiments are all within the scope of protection of the present invention.
[0025] like Figure 1 The figure shows the load motion structure diagram, which is a schematic diagram of the motor installation position and force under actual motion state. The middle block is a simulated load. Specifically, after the motor rotates, the load is pulled along the track by the ball screw. Due to the influence of gravity and uneven mass distribution, the driving torque of the upper and lower motors is quite different, which increases the control difficulty. The premise of designing the synchronous control method is to ignore the influence of the position error of the screw and only design the precise synchronous control problem caused by large and different load inertia.
[0026] Embodiment 1
[0027] A unified frequency domain characteristic control synchronization control method process of a dual-motor motion system includes:
[0028] S1: Set a virtual spindle to imitate the spindle synchronization mode. On the basis of master-slave synchronization control, the drive torque of the slave axis is fed back to the spindle control loop, thus realizing the coupling feedback of the control signal between the spindle and the slave axis.
[0029] S2: Design a virtual motor and use electrical signals to simulate the actual mechanical axis to achieve control of the servo motion, including the design of inertia parameters and control parameters;
[0030] S3: Optimize the design of compensation controller. During synchronous motion, the errors include synchronization error between axes and tracking error between axes and instructions.
[0031] In the above step S1, if Figure 2 As shown in the figure, the electronic virtual spindle synchronization control is an imitation of the mechanical spindle synchronization mode. On the basis of the traditional master-slave synchronization control, the drive torque of the slave axis is fed back to the spindle control loop, realizing the coupling feedback of the control signal between the master axis and the slave axis, while the spindle is set virtually.
[0032] In the above process, the main axis receives the instruction from the host computer, and obtains the drive instruction after operation through the virtual main axis controller processing unit. Each axis moves according to the instruction, and the corresponding state of the actual motor is fed back to the speed loop and position loop through the encoder. The driver compares the feedback value with the feedforward value of the virtual main axis, thereby adjusting the state of the two slave axes;
[0033] This method combines parallel synchronization and master-slave synchronization. The instructions issued by the virtual master axis are processed, interference-free digital signals, so the tracking performance is better. At the same time, the transmission mechanisms between the master and slave axes are all set virtually, and there will be no energy loss and attenuation during operation. Its parameters can be freely set through software, such as adjusting its moment of inertia or angular acceleration to match the output of the load, which has good flexibility in practical applications.
[0034] It is worth mentioning that the system is a fully closed-loop control system. There is command interaction between the master and slave axes, but each slave axis is relatively independent. If one axis is disturbed, it will not affect other axes, and good synchronous control robustness can be achieved.
[0035] In the above step S2, the control principle of the virtual axis is to use electrical signals to simulate the actual mechanical axis, thereby controlling the servo motion, and using the feedback error signal received by the virtual axis to compensate for the instruction to achieve the effect of synchronous control;
[0036] Depend on Figure 2 From the control structure, it can be seen that the design of the virtual axis is mainly the design of inertia parameters and control parameters. The inertia parameters are mainly the rotational inertia settings of the virtual motor, while the control parameters include the equivalent transfer function parameters of each link including the PID controller.
[0037] In the mechanical spindle system, its inertia has the function of energy storage. When the slave axis is disturbed, the spindle will reasonably distribute the energy through the corresponding algorithm to overcome the disturbance. However, the virtual spindle cannot store energy. The power of the system comes from the actual slave axes. When working, it will rely on electronic gears to simulate the transmission mechanism function of the mechanical spindle.
[0038] If the spindle inertia is set too large, the spindle speed will not be easy to change when the slave axis is disturbed, and the speed difference between the master and slave axes will become larger, causing the spindle to lose control.
[0039] When the master axis inertia is too small, considering the differences among the slave axes, if the output torque of a slave axis has reached the upper limit but the synchronization error cannot be eliminated, the virtual master axis will drive the remaining slave axes to adjust to reduce the synchronization error between the slave axes. However, at this time, the system has deviated from the command reference as a whole, which may cause system oscillation.
[0040] Therefore, when setting the spindle moment of inertia, the motion characteristics of each slave axis and the maximum allowable error of the system itself should be considered comprehensively. If better instruction tracking performance is required, a larger spindle moment of inertia should be set;
[0041] If the reference signal can be deviated appropriately and the real-time synchronization performance is required to be higher, the spindle inertia can be reduced to achieve better feedback speed regulation effect. The selection of inertia is directly related to the required torque, and the torque relationship should satisfy:
[0042] T-∑T i =J m ω m
[0043] In the above formula, T is the main shaft driving torque; T i is the torque fed back from each axis to the main axis, where i = 1, 2; J m ,ω m is the moment of inertia and angular acceleration of the main axis;
[0044] According to Hooke's law, considering the attenuation effect of the main axis, the driving torque calculation formula of each motion axis is obtained:
[0045] T i =b s (ω m -ω i )+K s ∫(ω m -ω i )dt
[0046] In the above formula, b s , K s is the attenuation coefficient and elastic coefficient of the moving axis; ω i is the angular velocity of the motion axis;
[0047] The torque fed back from each slave axis to the virtual master axis is also T i ;
[0048] Comprehensive consideration is taken to make the light axis easy to adjust and the heavy axis more stable. By selecting the inertia according to the actual torque ratio, the appropriate inertia parameters can be obtained.
[0049] like Figure 3 The mathematical model of the servo motor is shown as follows: pi is the transfer function of the current regulator, K t , K u , K b is the system's torque coefficient, induced electromotive force coefficient, and feedback coefficient, R a , L a are the stator resistance and armature inductance, and J is the moment of inertia. It can be seen that the transfer function of the servo motor is
[0050]
[0051] In the motor model of the virtual spindle, the signal at the input end is equivalent to generating a driving torque after passing through a second-order PI controller to drive the spindle to rotate. During the debugging process, the motor parameters can be determined after selecting the motor based on the moment of inertia and power requirements. Then, the PI parameters can be adjusted to obtain the final control parameters. In actual use, the motor model and control parameters are well matched before leaving the factory and can be used directly.
[0052] The synchronous control model is mainly divided into two parts: a virtual axis model with motion characteristics and a synchronous compensation model. The virtual axis model can mainly improve the tracking performance of a single axis to instructions, while the compensation model can reduce the synchronization error between the two axes. Next, the compensation controller will be optimized to obtain better synchronous control performance.
[0053] The above step S3 is mainly based on the compensation analysis of weight coefficient coupling.
[0054] Specifically, Figure 4 As shown, during the synchronous motion process, the errors include the synchronization error between the axes and the tracking error between the axes and the instructions, and the relative position relationship between the instruction position r and the actual positions 1 and 2 of the two motors may appear;
[0055] exist Figure 4 In the figure, the positions of the three points represent the actual positions of the motor shaft (solid points) and the command shaft (hollow points), and the direction of the shaft is the direction of motion of the motor-driven load. Only when the command position is between the actual positions of the two shafts (case b) can the same-direction non-conflicting compensation of the two errors be achieved. Otherwise, reasonable trade-offs must be made according to the actual situation to obtain compensation results that better meet the design requirements.
[0056] Depend on Figure 1 It can be seen that the mass of the load is concentrated in the lower part. According to the relevant parameters and the previous force analysis, the ratio of the driving force of the two axes is less than 1 / 2. The motor selection and matching work has been carried out according to the load thrust in the early stage. The load inertia is directly related to the braking performance. The smaller the inertia, the faster the response at the start, stop or speed change, and the better the dynamic performance. Considering that the load ratio of the two motors of the test object is small, only the light axis is compensated for the synchronization error. The reasons are:
[0057] (1) The light shaft 2 has small inertia and small compensation force, making it easier to compensate;
[0058] (2) The algorithm in single-axis compensation mode is simpler and easier to implement;
[0059] (3) If the stability of the heavier axis 1 at the bottom is ensured, the operational stability of the system can be improved. At the same time, the heavier axis is controlled separately, which can strictly follow the instructions and serve as the basis for system control to achieve high-precision positioning;
[0060] Therefore, axis 1 only performs its own tracking error compensation, axis 2 will take into account the synchronous error s e and its own tracking error The compensation strategy for axis 2 is the sum of the two error compensations. Since the two errors are not coupled to each other, the compensation can be set to
[0061]
[0062] In the above formula, ω e and ω g2 Respectively represent the weight coefficients of synchronization error and axis 2 tracking error;
[0063] During the load movement, the position accuracy requirement is not high, but a high degree of synchronization is required to ensure that the load does not tilt or sway in adverse working conditions. Therefore, the system should focus on reducing the synchronization error when the load moves. The role of the command is to enable the load to be accurately positioned. When the load moves to the end point, the best situation is that the tracking error is zero and the positioning is accurate. Therefore, the influence of the command position should change with the load. The closer to the positioning point, the greater the tracking error, and the more attention should be paid to reducing the tracking error. Suppose the actual position of axis 2 is s2, and the command position is s * , let ω g2 =s2 / s * is the weight coefficient of the tracking error of axis 2. Using the initial and final positioning conditions, we know that ω e =1-ω g2 , the actual compensation amount of the two axes can be obtained as
[0064]
[0065] Under the above compensation control method, when the system is positioned, only the tracking error will be compensated, so it has a higher positioning accuracy. The implementation of this method depends on the real-time feedback and calculation of the data, but it can be found that the first step command position s * When it is zero and used as the denominator, the expression is meaningless. Therefore, it needs to be artificially set to zero during the specific implementation process, and the normal compensation process can only be carried out from the second step.
[0066] Embodiment 2
[0067] The difference between this embodiment and the first embodiment is that in step S3, an error compensation based on a time division method is designed:
[0068] The time division method refers to sampling and calculating the real-time data once every pulse unit time interval during the entire process of load movement, so as to obtain the coordinate feed amount for the next step, and process while calculating until the movement ends. This method can respond to errors more quickly and compensate quickly, has higher processing efficiency and better processing real-time performance, and can be implemented in conjunction with the previous control method to obtain a better compensation effect.
[0069] Compared with the commonly used simple uncoupled linear compensation algorithm, the exponential function has the advantages of fast starting response and smooth transfer speed, while retaining the simplicity of a single function with small control amount, and is suitable for the load conditions of the present invention. Therefore, the exponential curve simulation compensation feed method is selected.
[0070] Compensation is a process of continuously reducing the error until it reaches zero, so the exponential function used for compensation speed is:
[0071] v(t)=v c e -t / τ
[0072] In the above formula, v c is the compensation starting speed; τ is the compensation time constant;
[0073] The total compensation amount obtained by integration is
[0074] s c =∫0 ∞ v(t)=∫0 ∞ v c e -t / τ =v c τ
[0075] Assume a pulse period is T m If the servo system conditions allow, the fastest compensation method should be to complete the next pulse cycle in one step, but this is often impossible to achieve and can easily cause a servo alarm. At this time, the following restrictions need to be clarified:
[0076] (1) Motor position tolerance limit. Since the actual compensation is too large, the motor end will receive too many pulses and the motor will not be able to keep up. Therefore, this condition limits the single-step compensation amount s. c (T m )’s maximum value;
[0077] (2) Maximum speed limit of the motor, that is, the speed difference caused by the compensation amount and the actual speed are vectored, and the result cannot exceed the rated speed of the motor. This condition limits v c The maximum value of
[0078] (3) The maximum output limit of the motor, that is, the maximum acceleration limit of the motor, is obtained by taking the derivative of the compensation speed function: v′ (0) = v c / τ is the value of the compensation acceleration, so this condition limits v c / τ maximum value.
[0079] In order to achieve higher compensation efficiency and faster response, based on the above constraints, we first determine v according to condition (2). c , and then determine τ according to condition (3), and finally use condition (1) to verify whether it is satisfied, and then the fastest feasible response curve can be obtained. It can be found that when T m =3τ, the compensation amount has been completed by 95%, which can be considered as the compensation has been completed. Because the time division is calculated in real time, only the compensation amount of the first step will have a practical impact on the system each time the compensation is performed. The compensation amount is the encoder position change in one pulse cycle, that is,
[0080] In summary, we can get Figure 5 Dual-axis error compensation flow chart.
[0081] Embodiment three:
[0082] A unified frequency domain characteristic control synchronization control system for a dual-motor motion system, comprising:
[0083] A dual-axis synchronous control system model, which includes setting a virtual spindle and a virtual motor;
[0084] The virtual spindle imitates the spindle synchronization mode. On the basis of master-slave synchronization control, the drive torque of the slave axis is fed back to the spindle control loop, realizing the coupling feedback of the control signal between the spindle and the slave axis.
[0085] Virtual motor uses electrical signals to simulate actual mechanical axes to achieve control of servo motion, including the design of inertia parameters and control parameters;
[0086] Optimize the design of compensation controller. During synchronous motion, the errors include synchronization error between axes and tracking error between axes and instructions.
[0087] Embodiment 4:
[0088] A unified frequency domain characteristic control synchronous control device for a dual-motor motion system, wherein the device is communicatively connected with a unified frequency domain characteristic control synchronous control system for the dual-motor motion system.
[0089] Embodiment five:
[0090] A computer readable medium stores a computer program, which, when executed by a processor, implements the method as described in one of the purposes.
[0091] It should be understood that although the present specification is described according to embodiments, not every embodiment contains only one independent technical solution. This description of the specification is only for the sake of clarity. Those skilled in the art should regard the specification as a whole. The technical solutions in each embodiment may also be appropriately combined to form other implementation methods that can be understood by those skilled in the art.
[0092] The series of detailed descriptions listed above are only specific descriptions of feasible implementation methods of the present invention. They are not intended to limit the scope of protection of the present invention. Any equivalent implementation methods or changes that do not deviate from the technical spirit of the present invention should be included in the scope of protection of the present invention.
Claims
1. A unified frequency domain characteristic control synchronization control method for a dual-motor motion system, characterized in that: include: Design a dual-axis synchronous control system model, which includes setting a virtual spindle, imitating the spindle synchronization mode, and feeding back the drive torque of the slave axis to the spindle control loop on the basis of master-slave synchronous control, thus realizing the coupling feedback of the control signal between the spindle and the slave axis; Design a virtual motor and use electrical signals to simulate the actual mechanical axis to achieve control of servo motion, including the design of inertia parameters and control parameters. The inertia parameter is the rotational inertia setting of the virtual motor, and the control parameters include the equivalent transfer function parameters of each link including the PID controller; To set the above spindle moment of inertia, it is necessary to consider the motion characteristics of each slave axis and the maximum allowable error of the system itself. The selection of inertia is directly related to the required torque, and the torque relationship should satisfy: T-∑T i =J m ω m In the above formula, T is the main shaft driving torque; T i is the torque fed back from each axis to the main axis, where i = 1, 2; J m ,ω m is the moment of inertia and angular acceleration of the main axis; According to Hooke's law, considering the attenuation effect of the main axis, the driving torque calculation formula of each motion axis is obtained: T i =b s (ω m -ω i )+K s ∫(ω m -ω i )dt In the above formula, b s , K s is the attenuation coefficient and elastic coefficient of the moving axis; ω i is the angular velocity of the motion axis; The torque fed back from each slave axis to the virtual master axis is also T i ; By selecting the inertia according to the actual torque ratio, the appropriate inertia parameters can be obtained; Calculate the transfer function of the servo motor, expressed as: The above formula is calculated based on the mathematical model of the servo motor, where K t , K u is the torque coefficient and induced electromotive force coefficient of the system, R a , L a are the stator resistance and armature inductance, J is the moment of inertia; Optimize the design of compensation controller. During synchronous motion, the error includes the synchronization error between axes and the tracking error between axes and instructions. Suppose the compensation amount is In the above formula, ω e and ω g2 Respectively represent the weight coefficients of synchronization error and axis tracking error; Assume the actual position of the axis is s2 and the command position is s * , let ω g2 =s2 / s * is the weight coefficient of the axis tracking error. Using the initial and final positioning conditions, we know that ω e =1-ω g2 , the actual compensation amount of the two axes can be obtained as 2. The unified frequency domain characteristic control synchronization control method of a dual-motor motion system according to claim 1, characterized in that: The instructions issued by the virtual main axis are processed, interference-free digital signals. At the same time, the transmission mechanisms between the master and slave axes are all virtually set. There will be no energy loss and attenuation during operation, and parameters can be freely set through software.
3. The unified frequency domain characteristic control synchronization control method of a dual-motor motion system according to claim 1, characterized in that: In the mathematical model of the servo motor, as shown in FIG3, G pi is the transfer function of the current regulator, K t , K u , K b is the system's torque coefficient, induced electromotive force coefficient, and feedback coefficient, R a , L a are the stator resistance and armature inductance, and J is the moment of inertia.
4. The unified frequency domain characteristic control synchronization control method of a dual-motor motion system according to claim 1, characterized in that: In the optimized design of the compensation controller, the possible relative position relationship between the command r and the actual positions 1 and 2 of the two motors can be expressed as Figure 4. The positions of the three points represent the actual positions of the motor shaft (solid points) and the command shaft (hollow points), and the direction of the shaft is the direction of movement of the motor-driven load.
5. The unified frequency domain characteristic control synchronization control method of a dual-motor motion system according to claim 1, characterized in that: The virtual spindle control structure includes a main axis, as shown in Figure 2. The main axis receives instructions from the host computer, and obtains the drive instructions after calculation through the virtual spindle controller processing unit. Each axis moves according to the instruction, and the corresponding state of the actual motor is fed back to the speed loop and the position loop through the encoder. The driver compares the feedback value with the feedforward value of the virtual spindle, thereby adjusting the state of the two slave axes.
6. A unified frequency domain characteristic control synchronous control system for a dual motor motion system, characterized in that: include: A dual-axis synchronous control system model, which includes setting a virtual spindle and a virtual motor; The virtual spindle imitates the spindle synchronization mode. On the basis of master-slave synchronization control, the drive torque of the slave axis is fed back to the spindle control loop, realizing the coupling feedback of the control signal between the spindle and the slave axis. Virtual motor uses electrical signals to simulate actual mechanical axes to achieve control of servo motion, including the design of inertia parameters and control parameters; Optimize the design of compensation controller. During synchronous motion, the errors include synchronization error between axes and tracking error between axes and instructions.
7. A unified frequency domain characteristic control synchronization control device for a dual-motor motion system, characterized in that: The unified frequency domain characteristic control synchronization control device of the dual-motor motion system is communicatively connected to the unified frequency domain characteristic control synchronization control system of the dual-motor motion system according to claim 6.
8. A computer readable medium having a computer program stored thereon, characterized in that: When the program is executed by a processor, the method according to any one of claims 1 to 5 is implemented.
Citation Information
Cited By
Synchronous shaft motion tracking control method and system
CN119781365A
Wheel axle control method and system
CN120276453A
Multi-level collaborative control method and system based on virtual shaft servo pump control unit
CN122776707A
