Multi-motor driven synchronous control radar servo system and its control method
By employing a multi-control strategy involving differential negative feedback, PID positioning, and backlash elimination, the synchronous control problem of multi-motor driven servo systems was solved, achieving high-precision and high-dynamic performance of radar servo systems. This eliminated the nonlinear effects of mechanical backlash and improved system stability and robustness.
Patent Information
- Application Number
- CN202311523805.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-11-13
- Publication Date
- 2026-11-17
- Estimated Expiration
- 2043-11-13
AI Technical Summary
Existing multi-motor drive servo systems suffer from nonlinear factors in synchronous control, and traditional control strategies have shortcomings, making it difficult to meet the requirements of high-precision and high-dynamic radar servo systems.
A multi-control strategy is adopted, which includes differential negative feedback, PID position method, PID control algorithm and backlash elimination method. By acquiring information from the drive motor and load turntable, drive current is generated to achieve motor synchronization and eliminate the nonlinear effects of mechanical backlash.
It improves the stability and robustness of the radar servo system, achieves precise position tracking and synchronization, and meets the load requirements of high inertia and high precision servo drive systems.
Smart Images

Figure CN117526776B_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of multi-motor radar servo synchronous control, and more specifically to a multi-motor driven synchronous control radar servo system and its control method. Background Technology
[0002] Currently, high-precision, high-dynamic, and high-power integrated measurement devices for radar servo systems are crucial for the future development of radar servo systems. Single-motor servo systems are no longer sufficient in terms of power and performance, making multi-motor drive a significant research direction for servo systems. However, multi-motor driven servo systems are complex, strongly coupled, and nonlinear systems, requiring the development of more rational control strategies to eliminate the influence of nonlinear factors. While dual-motor synchronous drive servo systems have been extensively studied in radar applications, and dual-motor backlash elimination technology overcomes backlash nonlinearity, improving the stability and robustness of radar servo systems, the increasing power of radar systems has led to the development trend of four-motor driven servo systems and corresponding control methods. However, existing technologies such as traditional master-slave control and parallel control have certain shortcomings, necessitating the design of a control strategy to improve the synchronous control performance of multi-motor drives and reduce errors. Summary of the Invention
[0003] To overcome the aforementioned technical problems, a multi-motor driven synchronous control radar servo system and its control method are provided. This control method and system adopt a superposition of multiple control strategies to achieve precise position tracking and synchronization, and eliminate the nonlinear effects of unavoidable gear backlash on the system.
[0004] To achieve the above objectives, embodiments of the present invention provide a control method for a multi-motor driven synchronous control radar servo system. The servo system includes at least four sets of drive motors and a load turntable. The control method includes: The first average speed of two of the four drive motors and the second average speed of the other two drive motors are obtained, along with the set position information and real-time position information of a load turntable. The difference between the first average speed and the second average speed is calculated using a differential negative feedback method and negative feedback is applied to obtain a first electrical signal. The set position information and real-time position information of the load turntable are processed using a PID position method to obtain a second electrical signal. The PID control method is used to obtain the third and fourth electrical signals based on the first and second electrical signals; The fourth electrical signal is processed using a gap elimination method to obtain a first variable bias current corresponding to two sets of drive motors and a second variable bias current corresponding to two sets of drive motors. A drive current for controlling the drive motor is generated based on the third electrical signal, the first variable bias current, and the second variable bias current.
[0005] Optionally, a differential negative feedback method is used to calculate the difference between the first average speed and the second average speed and perform negative feedback to obtain a first electrical signal, including: Obtain the first average speed of two sets of drive motors from one of the four sets of drive motors and the second average speed of two sets of drive motors from the other set. Calculate the difference between the first and second average speeds according to formula (1) to determine the first electrical signal. (1) in, for The first electrical signal at time t, The first average speed of a two-set drive motor The second average speed of the other two sets of drive motors, For reference speed.
[0006] Optionally, the set position information and real-time position information of the load turntable are processed using a PID position method to obtain a second electrical signal, including: The difference between the set location information and the real-time location information is obtained according to formula (2). (2) in, The real-time location information, This refers to the set position information of the load turntable. The difference between the set location information and the real-time location information; The second electrical signal is calculated according to formula (3). (3) in, for The second electrical signal at time [time] The proportional control parameter in the PID position method is... This refers to the integral time parameter in the PID position method. The derivative time parameter in the PID position method is denoted as .
[0007] Optionally, a PID control method is used to obtain a third and a fourth electrical signal based on the first and second electrical signals, including: The third electrical signal is calculated according to formulas (4) and (5). (4) in, This is one component of the third electrical signal. The proportional control parameter of the PID control method is... The integral time parameter of the PID control method is... The derivative time parameter of the PID control method is given. (5) in, This is another component of the third electrical signal. , , , These are the angular velocities of the four drive motors, , , , These are the synchronization control parameters.
[0008] Optionally, the fourth electrical signal is processed using a gap-elimination method to obtain a first variable bias current corresponding to two sets of drive motors and a second variable bias current corresponding to another two sets of drive motors, including: The first variable bias current is determined according to formula (6). (6) in, This is the first bias current. This is the fourth electrical signal. For the inflection point current, This is the zero-point bias current. This is the compensation current at the inflection point current; The second variable bias current is determined according to formula (7). (7) in, This is the second variable bias current. This is the fourth electrical signal. For the inflection point current, This is the zero-point bias current. This is the compensation current at the inflection point current.
[0009] On the other hand, the present invention provides a multi-motor driven synchronous control radar servo system, comprising: At least four drive motors; The load turntable is driven by four sets of drive motors connected to the load turntable via reducers. A PID position controller is electrically connected to the load turntable and processes the set position information and real-time position information of the load turntable to obtain a second electrical signal. A servo driver, electrically connected to the four sets of drive motors and the PID position controller, comprises: The differential negative feedback module is used to obtain a first electrical signal based on the first average speed of one pair of drive motors and the second average speed of the other pair of drive motors using a preset differential negative feedback method. The PID control module is used to obtain the third and fourth electrical signals based on the first and second electrical signals using a preset PID control method. The gap elimination control module is used to obtain a first variable bias current corresponding to two sets of motors and a second variable bias current of two sets of drive motors based on the fourth electrical signal using a preset gap elimination method, and the gap elimination control module is electrically connected to the PID control module. The current controller corresponds one-to-one with the four sets of drive motors, is electrically connected to the PID control module and the backlash elimination control module, receives the third electrical signal, the first variable bias current and the second variable bias current, and outputs the drive current to control the drive motors.
[0010] Optionally, the differential negative feedback module calculates the difference between the first average speed and the second average speed using the differential negative feedback method and performs negative feedback to obtain the first electrical signal, including: Obtain the first average speed of two sets of drive motors from one of the four sets of drive motors and the second average speed of two sets of drive motors from the other set. Calculate the difference between the first and second average speeds according to formula (1) to determine the first electrical signal. (1) in, for The first electrical signal at time t, The first average speed of a two-set drive motor The second average speed of the other two sets of drive motors, For reference speed.
[0011] Optionally, the PID position controller processes the set position information and real-time position information of the load turntable using the PID position method to obtain the second electrical signal, including: The difference between the set location information and the real-time location information is obtained according to formula (2). (2) in, The real-time location information, This refers to the set position information of the load turntable. for The difference between the set location information at a given time and the real-time location information; The second electrical signal is calculated according to formula (3). (3) in, for The second electrical signal at time [time] The proportional control parameter in the PID position method is... This refers to the integral time parameter in the PID position method. The derivative time parameter in the PID position method is denoted as .
[0012] Optionally, the PID control module obtains the third and fourth electrical signals based on the first and second electrical signals using the PID control method, including: The third electrical signal is calculated according to formulas (4) and (5). (4) in, This is one component of the third electrical signal. The proportional control parameter of the PID control method is... The integral time parameter of the PID control method is... The derivative time parameter of the PID control method is given. (5) in, This is another component of the third electrical signal. , , , These are the angular velocities of the four drive motors, , , , These are the synchronization control parameters.
[0013] Optionally, the gap elimination control module processes the fourth electrical signal using the gap elimination method to obtain a first variable bias current corresponding to two sets of motors and a second variable bias current corresponding to two sets of drive motors, including: The first variable bias current is determined according to formula (6). (6) in, This is the first bias current. This is the fourth electrical signal. For the inflection point current, This is the zero-point bias current. This is the compensation current at the inflection point current; The second variable bias current is determined according to formula (7). (7) in, This is the second variable bias current. This is the fourth electrical signal. For the inflection point current, This is the zero-point bias current. This is the compensation current at the inflection point current.
[0014] Through the above technical solutions, the control method and system comprehensively adopt multiple control strategies, including differential negative feedback, PID position, PID control algorithm, and backlash elimination, to rationally process various information from multiple drive motors, achieve synchronous and normal drive of multiple drive motors, greatly improve the carrying capacity of the load turntable, meet the load requirements of large inertia and high precision servo drive systems, achieve accurate position tracking and synchronization, and, while increasing radar power, eliminate the nonlinear effects of unavoidable gear backlash on the system, thereby improving the stability and robustness of the radar servo system.
[0015] Other features and advantages of the embodiments of the present invention will be described in detail in the following detailed description section. Attached Figure Description
[0016] The accompanying drawings are provided to further illustrate embodiments of the present invention and form part of the specification. They are used together with the following detailed description to explain the embodiments of the present invention, but do not constitute a limitation thereof. In the drawings: Figure 1 This is a flowchart of a control method for a multi-motor driven synchronous control radar servo system according to an embodiment of the present invention; Figure 2 This is a structural block diagram of a multi-motor driven synchronous control radar servo system according to an embodiment of the present invention.
[0017] Explanation of reference numerals in the attached figures Detailed Implementation
[0018] The specific embodiments of the present invention will be described in detail below with reference to the accompanying drawings. It should be understood that the specific embodiments described herein are for illustration and explanation only and are not intended to limit the scope of the present invention.
[0019] like Figure 1The diagram shows a flowchart of a control method for a multi-motor driven synchronous control radar servo system according to an embodiment of the present invention. Figure 1 In this context, the control method may include: In step S10, the first average speed of two of the four sets of drive motors and the second average speed of the other two sets of drive motors are obtained, as well as the set position information and real-time position information of a load turntable.
[0020] In step S11, the difference between the first average speed and the second average speed is calculated using a differential negative feedback method and negative feedback is performed to obtain a first electrical signal. The set position information and real-time position information of the load turntable are processed using a PID position method to obtain a second electrical signal.
[0021] In step S12, a PID control method is used to obtain a third electrical signal and a fourth electrical signal based on the first electrical signal and the second electrical signal.
[0022] In step S13, the fourth electrical signal is processed using a gap elimination method to obtain a first variable bias current corresponding to two sets of drive motors and a second variable bias current corresponding to another two sets of drive motors.
[0023] In step S14, a drive current for controlling the drive motor is generated based on the third electrical signal, the first variable bias current, and the second variable bias current.
[0024] This control method groups the four drive motors and uses differential negative feedback to keep the speeds of the four drive motors synchronized during the driving process, reducing asynchrony factors in actual operation. Simultaneously, it eliminates the nonlinear effects of unavoidable gear backlash on the system through backlash elimination control. Furthermore, it employs PID position control and servo driver dual control for position control, offering strong on-site debuggability and increased redundancy, enabling precise control of the load's movement and travel distance. It also allows for real-time acquisition of drive motor operating status, data uploading and processing, and alarm settings, enhancing operational safety and fault monitoring capabilities.
[0025] exist Figure 1In one embodiment of the present invention, in order to establish synchronous control of four groups of drive motors and detect the real-time speed of the four groups of drive motors, a differential negative feedback method can be used to group the four drive motors and calculate the first average speed of one pair of drive motors and the second average speed of the other pair of drive motors. Specifically, the method includes obtaining the first average speed of one pair of drive motors and the second average speed of the other pair of drive motors, and calculating the difference between the first average speed and the second average speed according to formula (1) to determine the first electrical signal. (1) in, for The first electrical signal at time t, The first average speed of a two-set drive motor The second average speed of the other two sets of drive motors, For reference speed.
[0026] exist Figure 1 In one embodiment of the present invention, in order to monitor the operation of the load turntable in real time and accurately control the distance of the load turntable during movement, a PID position method can be used to process the set position information and real-time position information of the load turntable to obtain a second electrical signal. Specifically, this method can obtain the difference between the set position information and the real-time position information according to formula (2). (2) in, For real-time location information, This is the set position information for the load turntable. for The difference between the set location information and the real-time location information at a given time; The second electrical signal is calculated according to formula (3). (3) in, for The second electrical signal at time , These are the proportional control parameters in the PID position method. This refers to the integral time parameter in the PID position method. This refers to the derivative time parameter in the PID position method.
[0027] exist Figure 1In one embodiment of the present invention, in order to synchronize the speeds of the four sets of drive motors, reduce the asynchrony factors in the actual process, and ensure the smooth operation of the four sets of drive motors, a PID control method can be used to obtain a third and fourth electrical signal based on the first and second electrical signals. Specifically, this method can calculate the third electrical signal according to formulas (4) and (5). (4) in, It is a component of the third electrical signal. The proportional control parameters for the PID control method. The integral time parameter of the PID control method. The derivative time parameter for the PID control method; (5) in, This is another component of the third electrical signal. , , , These are the angular velocities of the four drive motors, , , , These are the synchronization control parameters.
[0028] exist Figure 1 In one embodiment of the present invention, in order to eliminate the nonlinear influence of unavoidable gear backlash on the system and improve the stability and robustness of the radar servo system, a backlash elimination method can be used to process the fourth electrical signal to obtain a first variable bias current corresponding to two sets of drive motors and a second variable bias current corresponding to another two sets of drive motors. The method includes determining the first variable bias current according to formula (6). (6) in, This is the first bias current. This is the fourth electrical signal. For the inflection point current, This is the zero-point bias current. This is the compensation current at the inflection point current; The second variable bias current is determined according to formula (7). (7) in, This is the second variable bias current. This is the fourth electrical signal. For the inflection point current, This is the zero-point bias current. This is the compensation current at the inflection point current.
[0029] When the fourth electrical signal In different ranges, the first and second bias currents require different control strategies. In Within the range, apply backlash elimination control to the system when In less than And greater than At this time, there is no need to apply backlash elimination control to the system, thus ensuring the steady operation of the four drive motors.
[0030] On the other hand, the present invention provides a multi-motor driven synchronous control radar servo system, such as... Figure 2 The diagram shown is a structural block diagram of a multi-motor driven synchronous control radar servo system according to an embodiment of the present invention. Figure 2 The system includes four sets of drive motors 1, a load turntable 2, a PID position controller 3, a servo driver 4, and a current controller 8. Specifically, the four sets of drive motors 1 can be connected to the load turntable 2 via a reducer 9. The PID position controller 3 can be connected to the load turntable 2. The servo driver 4 can be electrically connected to the four sets of drive motors 1 and the PID position controller 3. The servo driver 4 may include a differential negative feedback module 5, a PID control module 6, and a backlash elimination control module 7. The current controller 8 can be connected one-to-one with the four sets of drive motors 1 and can also be electrically connected to the PID control module 6 and the backlash elimination control module 7. The speed sensors within the four sets of drive motors 1 can send the speed information of each set of drive motors to the differential negative feedback module 5. The differential negative feedback module 5 uses a preset differential negative feedback method to adjust the speed of one or two sets of drive motors 1 according to their speed. The first average speed of motor 1 and the second average speed of the other two sets of drive motors 1 are used to obtain a first electrical signal. The load turntable 2 can send the set position information and real-time position information to the PID position controller 3 through a rotary encoder. The PID position controller 3 can process the set position information and real-time position information of the load turntable 2 using a PID position method to obtain a second electrical signal. The PID control module 6 can use a preset PID control method to obtain a third and a fourth electrical signal based on the first and second electrical signals. The gap elimination control module 7 can use a preset gap elimination method to obtain a first variable bias current corresponding to one set of motors and a second variable bias current of the other two sets of drive motors based on the fourth electrical signal. The current controller 8 can receive the third electrical signal, the first variable bias current and the second variable bias current, and output the drive current of each set of drive motors 1.
[0031] Through the above technical solution, the system can group the four drive motors and use a differential negative feedback module to control them to keep the speed of each group of drive motors synchronized during the driving process, reducing the asynchrony factors in actual operation. At the same time, the backlash elimination control module uses a backlash elimination method to eliminate the nonlinear effects of unavoidable gear backlash on the system. Meanwhile, the PID position controller uses PID position control and servo drive dual control, which makes the system highly debuggable on site, increases redundancy, and enables precise control of the load movement distance. The system can also acquire the real-time operating status of the drive motors, upload and process the data, and set alarm devices, increasing the safety and fault monitoring capabilities during operation.
[0032] exist Figure 2 In one embodiment of the present invention, in order to establish synchronous control of four groups of drive motors 1, speed sensors in the drive motors 1 can be used to detect the real-time speed of the four groups of drive motors 1 and send the speed information to the differential negative feedback module 5. The differential negative feedback module 5 can then use a differential negative feedback method to group the four drive motors 1 and calculate the first average speed of one pair of drive motors 1 and the second average speed of the other pair of drive motors 1. Specifically, the method includes obtaining the first average speed of one pair of drive motors 1 and the second average speed of the other pair of drive motors 1, and calculating the difference between the first average speed and the second average speed according to formula (1) to determine the first electrical signal. (1) in, for The first electrical signal at time 10:00 The first average speed of a two-set drive motor The second average speed of the other two sets of drive motors, For reference speed.
[0033] exist Figure 2 In one embodiment of the present invention, in order to monitor the operation of the load turntable 2 in real time and accurately control the distance of the load turntable 2 during movement, the rotary encoder on the load turntable 2 sends the real-time position information of the load turntable 2 to the PID position controller 3. The PID position controller 3 can use the PID position method to process the set position information and the real-time position information of the load turntable 2 to obtain a second electrical signal. Specifically, this method can obtain the difference between the set position information and the real-time position information according to formula (2). (2) in, For real-time location information, This is the set position information for the load turntable. for The difference between the set location information and the real-time location information at a given time; The second electrical signal is calculated according to formula (3). (3) in, for The second electrical signal at time , These are the proportional control parameters in the PID position method. This refers to the integral time parameter in the PID position method. This refers to the derivative time parameter in the PID position method.
[0034] exist Figure 2 In one embodiment of the present invention, in order to synchronize the speeds of the four sets of drive motors 1, reduce the asynchrony factors in the actual process, and ensure the smooth operation of the four sets of drive motors 1, the differential negative feedback module 5 of the PID position controller 3 and the servo driver 4 respectively sends the second electrical signal and the first electrical signal to the PID control module 6 of the servo driver 2. The PID control module 6 can use the PID control method to obtain the third electrical signal and the fourth electrical signal based on the first electrical signal and the second electrical signal. Specifically, the method can calculate the third electrical signal according to formula (4) and formula (5). (4) in, It is a component of the third electrical signal. The proportional control parameters for the PID control method. The integral time parameter of the PID control method. The derivative time parameter for the PID control method; (5) in, This is another component of the third electrical signal. , , , These are the angular velocities of the four drive motors, , , , These are the synchronization control parameters.
[0035] exist Figure 2In one embodiment of the present invention, in order to eliminate the nonlinear influence of unavoidable gear backlash on the system and improve the stability and robustness of the radar servo system, the PID control module 6 of the servo driver 4 sends a fourth electrical signal to the backlash elimination control module 7. The backlash elimination control module 7 can process the fourth electrical signal using a backlash elimination method to obtain a first variable bias current corresponding to two sets of drive motors and a second variable bias current corresponding to another two sets of drive motors. The method includes determining the first variable bias current according to formula (6). (6) in, This is the first bias current. This is the fourth electrical signal. For the inflection point current, This is the zero-point bias current. This is the compensation current at the inflection point current; The second variable bias current is determined according to formula (7). (7) in, This is the second variable bias current. This is the fourth electrical signal. For the inflection point current, This is the zero-point bias current. This is the compensation current at the inflection point current.
[0036] When the fourth electrical signal In different ranges, the first and second bias currents require different control strategies. In Within the range, apply backlash elimination control to the system when In less than And greater than At this time, there is no need to apply backlash elimination control to the system, thus ensuring the steady operation of the four drive motors.
[0037] exist Figure 2 In one embodiment of the present invention, in order to synchronously control the speed of the drive motor and ensure the smooth operation of the motor, the drive current of the four sets of drive motors 1 includes a third electrical signal sent by the PID control module 6, a first variable bias current and a second variable bias current generated by the backlash elimination control module 7. The current controller 8 of the four sets of drive motors 1 receives the corresponding variable bias current and the third electrical signal to complete the drive of the drive motor 1. At the same time, the drive current generated by the current controller 8 and the current fed back to the servo driver 4 by the current sensor of the drive motor 1 form a closed loop control, thereby ensuring the smooth operation of the drive motor 1.
[0038] Through the above technical solutions, the system comprehensively adopts multiple control strategies, including differential negative feedback, PID position method, PID control algorithm, and backlash elimination method, to rationally process various information from multiple drive motors, complete the synchronous and normal drive of multiple drive motors, greatly improve the carrying capacity of the load turntable, meet the load requirements of large inertia and high precision servo drive system, achieve accurate position tracking and synchronization, and, while increasing radar power, eliminate the nonlinear influence of unavoidable gear backlash on the system, thereby improving the stability and robustness of the radar servo system.
[0039] It should also be noted that the terms "comprising," "including," or any other variations thereof are intended to cover non-exclusive inclusion, such that a process, method, article, or apparatus that comprises a list of elements includes not only those elements but also other elements not expressly listed, or elements inherent to such process, method, article, or apparatus. Unless otherwise specified, an element defined by the phrase "comprising one..." does not exclude the presence of other identical elements in the process, method, article, or apparatus that includes that element.
[0040] The above are merely embodiments of this application and are not intended to limit the scope of this application. Various modifications and variations can be made to this application by those skilled in the art. Any modifications, equivalent substitutions, improvements, etc., made within the spirit and principles of this application should be included within the scope of the claims of this application.
Claims
1. A control method of a multi-motor driven synchronous control radar servo system, the servo system comprising at least four sets of driving motors and a set of load turntable, characterized in that, The control method includes: The first average speed of two of the four drive motors and the second average speed of the other two drive motors are obtained, along with the set position information and real-time position information of a load turntable. The difference between the first average speed and the second average speed is calculated using a differential negative feedback method and negative feedback is applied to obtain a first electrical signal. The set position information and real-time position information of the load turntable are processed using a PID position method to obtain a second electrical signal. The PID control method is used to obtain the third and fourth electrical signals based on the first and second electrical signals; The fourth electrical signal is processed using a gap elimination method to obtain a first variable bias current corresponding to two sets of drive motors and a second variable bias current corresponding to two sets of drive motors. A drive current for controlling the drive motor is generated based on the third electrical signal, the first variable bias current, and the second variable bias current. The PID control method is used to obtain the third and fourth electrical signals based on the first and second electrical signals, including: The third electrical signal is calculated according to formulas (4) and (5). ,(4) wherein is a component of the third electrical signal, is a proportional control parameter of the PID control method, is an integral time parameter of the PID control method, is a derivative time parameter of the PID control method; ,(5) wherein is another component of the third electrical signal, , , , are angular velocities of the four driving motors, respectively, , , , is a synchronization control parameter; The fourth electrical signal is processed using a gap-elimination method to obtain a first variable bias current corresponding to two sets of drive motors and a second variable bias current corresponding to two sets of drive motors, including: The first variable bias current is determined according to formula (6). ,(6) wherein, is a first variable bias current, is a fourth electrical signal, is a knee current, is a zero point bias current, is a compensation current at the knee current; The second variable bias current is determined according to formula (7). ,(7) wherein, is a second variable bias current, is a fourth electrical signal, is a knee current, is a zero point bias current, is a compensation current at the knee current.
2. The control method according to claim 1, characterized by, The difference between the first average speed and the second average speed is calculated using a differential negative feedback method, and negative feedback is applied to obtain the first electrical signal, including: Obtain the first average speed of two sets of drive motors from one of the four sets of drive motors and the second average speed of two sets of drive motors from the other set. Calculate the difference between the first and second average speeds according to formula (1) to determine the first electrical signal. ,(1) in, for The first electrical signal at time t, The first average speed of a two-set drive motor The second average speed of the other two sets of drive motors, For reference speed.
3. The control method according to claim 1, characterized by, The second electrical signal is obtained by processing the set position information and real-time position information of the load turntable using the PID position method, including: The difference between the set location information and the real-time location information is obtained according to formula (2). ,(2) wherein, is the real-time position information, is the set position information of the load turret, is the difference between the set position information and the real-time position information; The second electrical signal is calculated according to formula (3). ,(3) wherein is the second electrical signal at the moment, is a proportional control parameter in the PID position method, is an integral time parameter in the PID position method, is a derivative time parameter in the PID position method.
4. A multi-motor driven, synchronous control radar servo system, characterized by, include: At least four drive motors; The load turntable is driven by four sets of drive motors connected to the load turntable via reducers. A PID position controller is electrically connected to the load turntable and processes the set position information and real-time position information of the load turntable to obtain a second electrical signal. A servo driver, electrically connected to the four sets of drive motors and the PID position controller, comprises: The differential negative feedback module is used to obtain a first electrical signal based on the first average speed of one pair of drive motors and the second average speed of the other pair of drive motors using a preset differential negative feedback method. The PID control module is used to obtain the third and fourth electrical signals based on the first and second electrical signals using a preset PID control method. The gap elimination control module is used to obtain a first variable bias current corresponding to two sets of drive motors and a second variable bias current of two sets of drive motors based on the fourth electrical signal using a preset gap elimination method, and the gap elimination control module is electrically connected to the PID control module. The current controller corresponds one-to-one with the four sets of drive motors, is electrically connected to the PID control module and the backlash elimination control module, receives the third electrical signal, the first variable bias current and the second variable bias current, and outputs the drive current to control the drive motors. The PID position controller uses the PID position method to process the set position information and real-time position information of the load turntable to obtain the second electrical signal, including: The difference between the set location information and the real-time location information is obtained according to formula (2). ,(2) wherein, the real-time position information, the set position information of the load turntable, the set position information of the load turntable, the difference between the set position information and the real-time position information at the time instant; The second electrical signal is calculated according to formula (3). ,(3) wherein, is the second electrical signal at the moment, is a proportional control parameter in the PID position method, is an integral time parameter in the PID position method, is a derivative time parameter in the PID position method; The gap elimination control module processes the fourth electrical signal using the gap elimination method to obtain a first variable bias current corresponding to two sets of motors and a second variable bias current corresponding to two sets of drive motors, including: The first variable bias current is determined according to formula (6). ,(6) in, This is the first bias current. This is the fourth electrical signal. For the inflection point current, This is the zero-point bias current. This is the compensation current at the inflection point current; The second variable bias current is determined according to formula (7). ,(7) in, This is the second variable bias current. This is the fourth electrical signal. For the inflection point current, This is the zero-point bias current. This is the compensation current at the inflection point current.
5. The servo system of claim 4, wherein, The differential negative feedback module calculates the difference between the first average speed and the second average speed using the differential negative feedback method and performs negative feedback to obtain the first electrical signal, including: Obtain the first average speed of two sets of drive motors from one of the four sets of drive motors and the second average speed of two sets of drive motors from the other set. Calculate the difference between the first and second average speeds according to formula (1) to determine the first electrical signal. ,(1) wherein, is the first electrical signal at the moment, is a first average speed of one of the two sets of drive motors, is a second average speed of the other of the two sets of drive motors, is a reference speed.
6. The servo system of claim 4, wherein, The PID position controller uses the PID position method to process the set position information and real-time position information of the load turntable to obtain the second electrical signal, including: The difference between the set location information and the real-time location information is obtained according to formula (2). ,(2) wherein, the real-time position information, the set position information of the load turntable, the set position information of the load turntable, the difference between the set position information and the real-time position information at the time instant; The second electrical signal is calculated according to formula (3). ,(3) wherein is the second electrical signal at the moment, is a proportional control parameter in the PID position method, is an integral time parameter in the PID position method, is a derivative time parameter in the PID position method.
