Electric steering engine simulation control method based on pseudo differential feedback, electronic equipment and storage medium
By adopting a pseudo-differential feedback control method in the electric servo, combining the mathematical model of brushless DC motor, reduction transmission mechanism and rudder load torque, the lack of accuracy and robustness of traditional controllers in nonlinear time-varying environments is solved. The problem of high response speed and anti-interference ability have been improved.
Patent Information
- Application Number
- CN202411242272.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-05
- Publication Date
- 2024-11-12
AI Technical Summary
Traditional PID controllers are difficult to achieve accuracy and robustness in electric servos, and are susceptible to interference from nonlinear time-varying environmental factors and parameter changes, resulting in poor position control.
Using a control method based on pseudo-differential feedback, a mathematical model of brushless DC electric servo is established, combined with a mathematical model of pseudo-differential feedback controller model, a mathematical model of deceleration transmission mechanism and rudder surface load torque, an electric servo position control closed-loop simulation model is constructed. Improve anti-interference ability.
While maintaining high response speed, the anti-interference ability and robustness of the electric servo is improved, and the simulation simulation degree and actual control accuracy are improved.
Smart Images

Figure CN118938712A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of electric steering gear simulation, and in particular to an electric steering gear simulation control method based on pseudo differential feedback, an electronic device and a storage medium. Background Art
[0002] As servos are widely used in missiles, aircraft, and rocket systems in the aerospace field, the requirements for the integrity of servos are getting higher and higher, which has prompted servos to develop in the direction of continuously reducing size and mass; electric servos have attracted widespread attention and research due to their simplicity, reliability, light weight, small size, easy use and maintenance, and easy control. Electric servos usually have the characteristics of nonlinearity and fast time-varying. Since they are often used in various complex environments and are affected by nonlinear time-varying environmental factors, the accuracy and robustness of traditional PID controllers are poor, and there are problems such as susceptibility to interference and parameter changes affecting the position control of the servo. Summary of the invention
[0003] The purpose of the present invention is to overcome the deficiencies of the prior art and provide an electric servo simulation control method based on pseudo differential feedback, an electronic device and a storage medium.
[0004] The objective of the present invention is achieved through the following technical solutions:
[0005] A first aspect of the present invention provides an electric servo simulation control method based on pseudo differential feedback, comprising the following steps:
[0006] Establishing a mathematical model of a brushless DC electric servo, including establishing a mathematical model of a brushless DC motor, a mathematical model of a reduction transmission mechanism, and a mathematical model of a rudder surface load torque;
[0007] Establish a pseudo-differential feedback controller model for the position loop of the electric servo;
[0008] Combining the pseudo-differential feedback controller model, the mathematical model of the brushless DC motor, the mathematical model of the reduction transmission mechanism and the mathematical model of the rudder surface load torque, a closed-loop simulation model of the electric servo position control based on the pseudo-differential controller is obtained.
[0009] Furthermore, the establishment of the mathematical model of the brushless DC motor comprises the following steps:
[0010] Build a mathematical model of the drive:
[0011]
[0012] Among them, K pwm is the driver voltage amplification factor, U c is the PWM input voltage, T sis the time constant 1 / f of the field effect tube, and f is the PWM switching frequency. Since the PWM modulation frequency of the inverter is high, T s is very small and can be ignored, so the mathematical model of the PWM driver is simplified to G pwm =K pwm ;
[0013] Build an electrical model of a brushless DC motor:
[0014]
[0015] Where: U a is the armature voltage, L is the armature inductance, i a is the armature current, R is the armature phase resistance, E a is the back electromotive force constant;
[0016] Performing Laplace transform on the electrical model yields:
[0017] U a (s)-E a (s)=sL a I a (s)+R a I a (s)
[0018] The transfer function of voltage and current is obtained:
[0019]
[0020] Build a mechanical model of the brushless DC motor:
[0021]
[0022] Where: T e is the electromagnetic torque of the motor, T L is the load torque converted to the motor shaft, J m is the motor moment of inertia, ω m is the angular velocity of the motor shaft, B is the damping coefficient;
[0023] Ignoring viscous friction, Laplace transform of the mechanical model yields:
[0024] T e (s)-T L (s)=sJ m ω m (s)
[0025] The transfer function of current and speed is obtained:
[0026]
[0027] Where E a =K e ·dθ / dt,K e is the back electromotive force constant; T e =K T ·i a , K T is the electromagnetic torque constant;
[0028] For E a and T e The value formula is Laplace transformed to obtain the transfer function of electromotive force and speed and the transfer function of torque and current:
[0029] E a (s) = K e ω m (s)
[0030] T e (s) = K T I a (s)
[0031] After sorting out, the equation group corresponding to the mathematical model of the brushless DC motor is:
[0032]
[0033] Thus, the Simulink block diagram of the brushless DC motor is drawn.
[0034] Furthermore, the establishment of the mathematical model of the reduction transmission mechanism includes:
[0035] The electric steering gear adopts a two-stage involute cylindrical gear transmission + a two-stage planetary transmission structure reducer. The transfer function of the reducer is the reduction ratio 1 / i of the reducer. The conversion coefficient from the motor output arc angle to the rudder deflection angle is 180 / pai. Adding the mechanical clearance of the steering gear, the mathematical model of the motor output angle to the rudder surface angle is obtained, that is, the mathematical model of the reduction transmission mechanism.
[0036] Thus, the Simulink block diagram of the reduction transmission mechanism is drawn.
[0037] Furthermore, the establishment of the mathematical model of the rudder surface load moment includes:
[0038] T L (s) = K h θ
[0039] Where K h =T lm / θ m , K h is the load moment coefficient, T lm Rated torque of servo, θ mThe maximum rudder surface deflection angle, θ is the actual rudder deflection angle; the transmission efficiency of the reduction transmission mechanism is n, and the mathematical model of the load torque corresponding to the rudder deflection angle is obtained, that is, the mathematical model of the rudder surface load torque;
[0040] Thus, the Simulink block diagram of the rudder surface load torque is drawn.
[0041] Furthermore, the establishment of a pseudo differential feedback controller model for the position loop of the electric servo includes: using a pseudo differential feedback control block diagram of a second-order controlled object.
[0042] Furthermore, the pseudo-differential feedback controller model, the mathematical model of the brushless DC motor, the mathematical model of the reduction transmission mechanism and the mathematical model of the rudder surface load torque are combined to obtain a closed-loop simulation model of the electric servo position control based on the pseudo-differential controller, including:
[0043] The initial control input terminal of the pseudo differential feedback controller model inputs a rudder angle command, and the output terminal of the pseudo differential feedback controller model outputs a control voltage to the initial control input terminal of the mathematical model of the brushless DC motor;
[0044] The output end of the mathematical model of the brushless DC motor outputs the motor rotation angle to the initial control input end of the mathematical model of the brushless DC motor and the mathematical model of the reduction transmission mechanism;
[0045] The output end of the mathematical model of the reduction transmission mechanism outputs the actual rudder deflection angle to the mathematical model of the steering gear load torque, the initial control input end of the pseudo differential feedback controller model, the pseudo differential control input end of the pseudo differential feedback controller model and the outside;
[0046] The output end of the mathematical model of the servo load torque outputs the load torque to the torque adjustment input end of the mathematical model of the brushless DC motor.
[0047] Furthermore, a saturation limiter is provided between the output end of the pseudo differential feedback controller model and the initial control input end of the mathematical model of the brushless DC motor.
[0048] Furthermore, the method further comprises the following steps:
[0049] The closed-loop simulation model of the electric servo position control based on the pseudo-differential controller is simulated and observed to obtain the input rudder angle command and feedback corresponding comparison curve to verify the tracking performance.
[0050] According to a second aspect of the present invention, there is provided an electronic device comprising a storage unit and a processing unit, wherein the storage unit stores computer instructions that can be executed on the processing unit, and the processing unit executes the steps of the electric servo simulation control method based on pseudo-differential feedback when running the computer instructions.
[0051] According to a third aspect of the present invention, there is provided a storage medium having computer instructions stored thereon, which, when executed, execute the steps of the electric servo simulation control method based on pseudo-differential feedback.
[0052] The beneficial effects of the present invention are:
[0053] In an exemplary embodiment of the present invention, the mathematical model of the brushless DC electric servo not only includes the mathematical model of the brushless DC motor, but also introduces the mathematical model of the reduction transmission mechanism and the mathematical model of the rudder surface load torque. This is mainly due to the fact that the electric servo system, as a nonlinear time-varying system, is easily affected by load torque interference and parameter changes, so the simulation data is closer to the actual parameters to improve the simulation degree; and the feedback controller model adopts a pseudo-differential feedback controller model, so that the electric servo has improved anti-interference ability while maintaining a high response speed and has strong robustness. BRIEF DESCRIPTION OF THE DRAWINGS
[0054] Figure 1 It is a flow chart of an electric servo simulation control method based on pseudo differential feedback provided in an exemplary embodiment of the present invention;
[0055] Figure 2 A Simulink block diagram of a brushless DC motor provided in an exemplary embodiment of the present invention;
[0056] Figure 3 A Simulink block diagram of a reduction transmission mechanism provided in an exemplary embodiment of the present invention;
[0057] Figure 4 A Simulink block diagram of a rudder surface load moment provided in an exemplary embodiment of the present invention;
[0058] Figure 5 A pseudo differential feedback control block diagram of a second-order controlled object provided in an exemplary embodiment of the present invention;
[0059] Figure 6 A block diagram of a closed-loop simulation model of an electric servo position control based on a pseudo-differential controller provided in an exemplary embodiment of the present invention;
[0060] Figure 7 It is a schematic diagram of a comparison curve between a rudder command and a feedback response provided in an exemplary embodiment of the present invention. DETAILED DESCRIPTION
[0061] The technical solution of the present invention is described clearly and completely below in conjunction with the accompanying drawings. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0062] In the description of the present invention, it should be noted that the directions or positional relationships indicated by "center", "up", "down", "left", "right", "vertical", "horizontal", "inside", "outside", etc. are directions or positional relationships based on the drawings, which are only for the convenience of describing the present invention and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as limiting the present invention. In addition, "first" and "second" are only used for descriptive purposes and cannot be understood as indicating or implying relative importance.
[0063] In the description of the present invention, it should be noted that, unless otherwise clearly specified and limited, "installation", "connection" and "connection" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be indirectly connected through an intermediate medium, or it can be the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0064] In addition, the technical features involved in the different embodiments of the present invention described below can be combined with each other as long as they do not conflict with each other.
[0065] See also Figure 1 , Figure 1 The present invention shows an electric servo simulation control method based on pseudo differential feedback provided in an exemplary embodiment of the present invention, comprising the following steps:
[0066] Establishing a mathematical model of a brushless DC electric servo, including establishing a mathematical model of a brushless DC motor, a mathematical model of a reduction transmission mechanism, and a mathematical model of a rudder surface load torque;
[0067] Establish a pseudo-differential feedback controller model for the position loop of the electric servo;
[0068] Combining the pseudo-differential feedback controller model, the mathematical model of the brushless DC motor, the mathematical model of the reduction transmission mechanism and the mathematical model of the rudder surface load torque, a closed-loop simulation model of the electric servo position control based on the pseudo-differential controller is obtained.
[0069] Specifically, in this exemplary embodiment, the mathematical model of the brushless DC electric servo not only includes the mathematical model of the brushless DC motor, but also introduces the mathematical model of the reduction transmission mechanism and the mathematical model of the rudder surface load torque. This is mainly due to the fact that the electric servo system is a nonlinear time-varying system and is easily affected by load torque interference and parameter changes. The simulation data is closer to the actual parameters to improve the degree of simulation. The feedback controller model adopts a pseudo-differential feedback controller model, which enables the electric servo to improve its anti-interference ability while maintaining a high response speed and has strong robustness.
[0070] The following content will describe various exemplary embodiments in detail:
[0071] More preferably, in an exemplary embodiment, the establishment of the mathematical model of the brushless DC motor comprises the following steps:
[0072] Build a mathematical model of the drive:
[0073]
[0074] Among them, K pwm is the driver voltage amplification factor, U c is the PWM input voltage, T s is the time constant 1 / f of the field effect tube, and f is the PWM switching frequency. Since the PWM modulation frequency of the inverter is high, T s is very small and can be ignored, so the mathematical model of the PWM driver is simplified to G pwm =K pwm ;
[0075] Build an electrical model of a brushless DC motor:
[0076]
[0077] Where: U a is the armature voltage, L is the armature inductance (mH), i a is the armature current (A), R is the armature phase resistance (Ω), E a is the back electromotive force constant (V·s / rad);
[0078] Performing Laplace transform on the electrical model yields:
[0079] U a (s)-E a (s)=sL a I a (s)+R a I a (s)
[0080] The transfer function of voltage and current is obtained:
[0081]
[0082] Build a mechanical model of the brushless DC motor:
[0083]
[0084] Where: T e is the electromagnetic torque of the motor (N·m), T L is the load torque converted to the motor shaft (N·m), J m is the motor moment of inertia (kg·m 2 ),ω m is the angular velocity of the motor shaft (rad / s), B is the damping coefficient;
[0085] Ignoring viscous friction, Laplace transform of the mechanical model yields:
[0086] T e (s)-T L (s)=sJ m ω m (s)
[0087] The transfer function of current and speed is obtained:
[0088]
[0089] Where E a =K e ·dθ / dt,K e is the back electromotive force constant (V·s / rad); T e =K T ·i a , K T is the electromagnetic torque constant (N·m / A);
[0090] For E a and T e The value formula is Laplace transformed to obtain the transfer function of electromotive force and speed and the transfer function of torque and current:
[0091] E a (s) = K e ω m (s)
[0092] T e (s) = K T I a (s)
[0093] After sorting out, the equation group corresponding to the mathematical model of the brushless DC motor is:
[0094]
[0095] Thus, the Simulink block diagram of the brushless DC motor is drawn, as shown in Figure 2 shown.
[0096] More preferably, in an exemplary embodiment, the establishment of the mathematical model of the reduction transmission mechanism includes:
[0097] The electric steering gear adopts a two-stage involute cylindrical gear transmission + a two-stage planetary transmission structure reducer. The transfer function of the reducer is the reduction ratio 1 / i of the reducer. The conversion coefficient from the motor output arc angle to the rudder deflection angle is 180 / pai. Adding the mechanical clearance of the steering gear, the mathematical model of the motor output angle to the rudder surface angle is obtained, that is, the mathematical model of the reduction transmission mechanism.
[0098] The Simulink block diagram of the reduction transmission mechanism is thus drawn, as shown in Figure 3 shown.
[0099] More preferably, in an exemplary embodiment, the establishment of the mathematical model of the rudder surface load moment includes:
[0100] T L (s) = K h θ
[0101] Where K h =T lm / θ m , K h is the load moment coefficient, T lm Rated torque of servo, θ m The maximum rudder surface deflection angle, θ is the actual rudder deflection angle; the transmission efficiency of the reduction transmission mechanism is n, and the mathematical model of the load torque corresponding to the rudder deflection angle is obtained, that is, the mathematical model of the rudder surface load torque;
[0102] The Simulink block diagram of the rudder load moment is drawn as follows: Figure 4 shown.
[0103] More preferably, in an exemplary embodiment, the establishing of a pseudo differential feedback controller model for the position loop of the electric servo includes: using a pseudo differential feedback control block diagram of a second-order controlled object.
[0104] Specifically, pseudo differential feedback control is a high-performance control method based on actual engineering constraints. It takes the actual engineering system as the starting point, and then designs the controller according to various performance indicators of the actual controlled object. It selects pure integral control as the ideal control action, and only sets the integral control operation in the forward channel. At the same time, the final control element is introduced. By operating on the input error signal, an output instruction is generated for the final control element and its energy output is adjusted, causing the controlled object to move in the direction of reducing the error. It can be considered as an integral control system using state feedback. In this exemplary embodiment, the pseudo differential feedback control block diagram of the second-order controlled object is as follows: Figure 5 As shown, Figure 5 The controlled object in the equation is the mathematical model of the brushless DC electric servo (including the mathematical model of the brushless DC motor, the mathematical model of the reduction transmission mechanism and the mathematical model of the rudder surface load torque).
[0105] This method uses the difference between the command data and the feedback value as the input of the integral controller (i.e., the initial control input of the pseudo-differential feedback controller model) to avoid the static error of the system. Figure 5 M2) is used as the design condition to make full use of the power provided by the driver. In the feedback link, only a differential component one level lower than the system is required to reduce the amount of calculation, so that the system has strong filtering and suppression capabilities for normal and low-frequency signals.
[0106] The parameter setting formula is as follows:
[0107] Ki=6.52·[M max / (I·r0)] 1.5
[0108] Kd1=8.53·M max / (I·r0)
[0109] Kd2=4.13·[M max / (I·r0)] 0.5
[0110] Among them, I is the maximum order coefficient of the controlled object, r0 is the maximum value of the step reference input of the system, M max It is the maximum output value of the final control element.
[0111] More preferably, in an exemplary embodiment, Figure 6 As shown, the pseudo differential feedback controller model, the mathematical model of the brushless DC motor, the mathematical model of the reduction transmission mechanism and the mathematical model of the rudder surface load torque are combined to obtain a closed-loop simulation model of the electric servo position control based on the pseudo differential controller, including:
[0112] The initial control input terminal of the pseudo differential feedback controller model inputs a rudder angle command, and the output terminal of the pseudo differential feedback controller model outputs a control voltage to the initial control input terminal of the mathematical model of the brushless DC motor;
[0113] The output end of the mathematical model of the brushless DC motor outputs the motor rotation angle to the initial control input end of the mathematical model of the brushless DC motor and the mathematical model of the reduction transmission mechanism;
[0114] The output end of the mathematical model of the reduction transmission mechanism outputs the actual rudder deflection angle to the mathematical model of the steering gear load torque, the initial control input end of the pseudo differential feedback controller model, the pseudo differential control input end of the pseudo differential feedback controller model and the outside;
[0115] The output end of the mathematical model of the servo load torque outputs the load torque to the torque adjustment input end of the mathematical model of the brushless DC motor.
[0116] More preferably, in an exemplary embodiment, Figure 6 As shown, a saturation limiter (saturation in the figure) is also provided between the output end of the pseudo differential feedback controller model and the initial control input end of the mathematical model of the brushless DC motor.
[0117] Specifically, in this exemplary embodiment, a limiter is added to the output end of the integral link to prevent the integral controller from saturating, so that the system can have the best response performance while ensuring system stability.
[0118] More preferably, in an exemplary embodiment, the method further comprises the following steps:
[0119] The closed-loop simulation model of the electric servo position control based on the pseudo-differential controller is simulated and observed to obtain the input rudder angle command and feedback corresponding comparison curve to verify the tracking performance.
[0120] Specifically, in this exemplary embodiment, the setting value of the selected brushless DC electric servo is:
[0121] J m =11.06 g cm 2 ,R a =5.54Ω,L a =0.0057H,K e =0.061V·s / rad,i=245,K t =0.060N·m / A,
[0122] K h =0.2667N·m / °, n=0.762. According to the relevant formula, the parameter values of pseudo-differential feedback control are:
[0123] Ki=6.52·[0.07 / (J m ·45)] 1.5 =3.4391·10 5
[0124] Kd1=8.53·0.07 / (J m 45) = 1.1997*10 4
[0125] Kd2=4.13·[0.07 / (J m ·45)] 0.5 =154.8871
[0126] The rudder control signal θc=25sin(2t), the air wind disturbance is 0.05N·m, the above series of parameters are used, the method of the present invention is applied to control the steering gear servo system, and the system is simulated and verified using the Simulink platform, and the results are as follows: Figure 7 Comparison curve of rudder command and feedback response. The horizontal axis in the figure is time (unit s), and the vertical axis is angf, which represents the angle. The red color is the rudder command curve, and the blue color is the feedback response curve.
[0127] The simulation results show that the control method has accurate steady-state tracking performance under the conditions of parameter disturbance and external interference, which verifies the practical feasibility of the present invention.
[0128] Having the same inventive concept as the above exemplary embodiment, another exemplary embodiment of the present invention provides an electronic device, including a storage unit and a processing unit, wherein the storage unit stores computer instructions that can be executed on the processing unit, and the processing unit executes the steps of the electric servo simulation control method based on pseudo-differential feedback when running the computer instructions.
[0129] The electronic device is presented in the form of a general-purpose computing device. The components of the electronic device may include, but are not limited to: the at least one processing unit, the at least one storage unit, and a bus connecting different system components (including the storage unit and the processing unit).
[0130] The storage unit stores program codes, which can be executed by the processing unit, so that the processing unit performs the steps of various exemplary embodiments of the present invention described in the above “Exemplary Method” section of this specification. For example, the processing unit can perform the following steps: Figure 1 The method shown in .
[0131] The storage unit may include a readable medium in the form of a volatile memory unit, such as a random access memory unit (RAM) and / or a cache memory unit, and may further include a read-only memory unit (ROM).
[0132] The storage unit may also include a program / utility having a set (at least one) of program modules, such program modules including but not limited to: an operating system, one or more application programs, other program modules, and program data, each of which or some combination may include an implementation of a network environment.
[0133] The bus may represent one or more of several types of bus structures, including a memory unit bus or memory unit controller, a peripheral bus, an accelerated graphics port, a processing unit, or a local bus using any of a variety of bus architectures.
[0134] The electronic device may also communicate with one or more external devices (e.g., keyboards, pointing devices, Bluetooth devices, etc.), may communicate with one or more devices that enable a user to interact with the electronic device, and / or may communicate with any device that enables the electronic device to communicate with one or more other computing devices (e.g., routers, modems, etc.). Such communication may be performed through an input / output (I / O) interface. Furthermore, the electronic device may also communicate with one or more networks (e.g., local area networks (LANs), wide area networks (WANs), and / or public networks, such as the Internet) through a network adapter. The network adapter communicates with other modules of the electronic device through a bus. It should be understood that other hardware and / or software modules may be used in conjunction with the electronic device, including but not limited to: microcode, device drivers, redundant processing units, external disk drive arrays, RAID systems, tape drives, and data backup storage systems, etc.
[0135] Through the above description, it is easy for those skilled in the art to understand that the example implementation described here can be implemented by software or by combining software with necessary hardware. Therefore, the technical solution according to this exemplary embodiment can be embodied in the form of a software product, which can be stored in a non-volatile storage medium (which can be a CD-ROM, a USB flash drive, a mobile hard disk, etc.) or on a network, and includes several instructions to enable a computing device (which can be a personal computer, a server, a terminal device, or a network device, etc.) to execute the method according to this exemplary embodiment.
[0136] With the same inventive concept as the above exemplary embodiment, another exemplary embodiment of the present invention provides a storage medium having computer instructions stored thereon, which execute the steps of the electric servo simulation control method based on pseudo-differential feedback when the computer instructions are executed.
[0137] Based on such understanding, the technical solution of this embodiment can essentially or the part that contributes to the prior art or the part of the technical solution can be embodied in the form of a software product (program product). The computer software product is stored in a storage medium and includes a number of instructions for enabling a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the methods described in each embodiment of the present invention.
[0138] The program product may use any combination of one or more readable media. The readable medium may be a readable signal medium or a readable storage medium. The readable storage medium may be, for example, but not limited to, an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, device or device, or any combination of the above. More specific examples (non-exhaustive list) of readable storage media include: an electrical connection with one or more wires, a portable disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above.
[0139] Computer readable signal media may include data signals propagated in baseband or as part of a carrier wave, in which readable program code is carried. Such propagated data signals may take a variety of forms, including but not limited to electromagnetic signals, optical signals, or any suitable combination of the above. Readable signal media may also be any readable medium other than a readable storage medium, which may send, propagate, or transmit a program for use by or in conjunction with an instruction execution system, apparatus, or device.
[0140] The program code embodied on the readable medium may be transmitted using any appropriate medium, including but not limited to wireless, wired, optical cable, RF, etc., or any suitable combination of the foregoing.
[0141] Program code for performing the operations of the present invention may be written in any combination of one or more programming languages, including object-oriented programming languages such as Java, C++, etc., and conventional procedural programming languages such as "C" or similar programming languages. The program code may be executed entirely on the user computing device, partially on the user device, as a separate software package, partially on the user computing device and partially on a remote computing device, or entirely on a remote computing device or server. In cases involving a remote computing device, the remote computing device may be connected to the user computing device through any type of network, including a local area network (LAN) or a wide area network (WAN), or may be connected to an external computing device (e.g., through the Internet using an Internet service provider).
[0142] Obviously, the above embodiments are merely examples for clear explanation, and are not intended to limit the implementation methods. For ordinary technicians in the relevant field, other different forms of changes or modifications can be made based on the above description. It is not necessary and impossible to list all the implementation methods here. The obvious changes or modifications derived from them are still within the protection scope of the invention.
Claims
1. The electric servo simulation control method based on pseudo differential feedback is characterized by: The following steps are involved: Establishing a mathematical model of a brushless DC electric servo, including establishing a mathematical model of a brushless DC motor, a mathematical model of a reduction transmission mechanism, and a mathematical model of a rudder surface load torque; Establish a pseudo-differential feedback controller model for the position loop of the electric servo; Combining the pseudo-differential feedback controller model, the mathematical model of the brushless DC motor, the mathematical model of the reduction transmission mechanism and the mathematical model of the rudder surface load torque, a closed-loop simulation model of the electric servo position control based on the pseudo-differential controller is obtained.
2. The electric steering gear simulation control method based on pseudo differential feedback according to claim 1 is characterized in that: The establishment of the mathematical model of the brushless DC motor comprises the following steps: Build a mathematical model of the drive: Among them, K pwm is the driver voltage magnification multiple, U c is the PWM input voltage, T s is the time constant 1 / f of the field effect tube, and f is the PWM switching frequency. Since the PWM modulation frequency of the inverter is high, T s is very small and can be ignored, so the mathematical model of the PWM driver is simplified to G pwm =K pwm ; Build an electrical model of a brushless DC motor: Where: U a is the armature voltage, L is the armature inductance, i a is the armature current, R is the armature phase resistance, E a is the back electromotive force constant; Performing Laplace transform on the electrical model yields: U a (s)-E a (s)=sL a I a (s)+R a I a (s) The transfer function of voltage and current is obtained: Build a mechanical model of the brushless DC motor: Where: T e is the electromagnetic torque of the motor, T L is the load torque converted to the motor shaft, J m is the motor moment of inertia, ω m is the angular velocity of the motor shaft, B is the damping coefficient; Ignoring viscous friction, Laplace transform of the mechanical model yields: T e (s)-T L (s)=sJ m ω m (s) The transfer function of current and speed is obtained: Where E a =K e ·dθ / dt,K e is the back electromotive force constant; T e =K T ·i a , K T is the electromagnetic torque constant; For E a and T e The value formula is Laplace transformed to obtain the transfer function of electromotive force and speed and the transfer function of torque and current: E a (s)=K e oh m (s) T e (s)=K T I a (s) After sorting out, the equation group corresponding to the mathematical model of the brushless DC motor is: Thus, the Simulink block diagram of the brushless DC motor is drawn.
3. The electric steering gear simulation control method based on pseudo differential feedback according to claim 1, characterized in that: The mathematical model of the reduction transmission mechanism is established, including: The electric steering gear adopts a two-stage involute cylindrical gear transmission + a two-stage planetary transmission structure reducer. The transfer function of the reducer is the reduction ratio 1 / i of the reducer. The conversion coefficient from the motor output arc angle to the rudder deflection angle is 180 / pai. Adding the mechanical clearance of the steering gear, the mathematical model of the motor output angle to the rudder surface angle is obtained, that is, the mathematical model of the reduction transmission mechanism. Thus, the Simulink block diagram of the reduction transmission mechanism is drawn.
4. The electric steering gear simulation control method based on pseudo differential feedback according to claim 1 is characterized in that: The establishment of the mathematical model of the rudder surface load moment includes: T L (s)=K h θ Where K h =T lm / θ m , K h is the load moment coefficient, T lm Rated torque of servo, θ m The maximum rudder surface deflection angle, θ is the actual rudder deflection angle; the transmission efficiency of the reduction transmission mechanism is n, and the mathematical model of the load torque corresponding to the rudder deflection angle is obtained, that is, the mathematical model of the rudder surface load torque; Thus, the Simulink block diagram of the rudder surface load torque is drawn.
5. The electric steering gear simulation control method based on pseudo differential feedback according to claim 1, characterized in that: The method of establishing a pseudo differential feedback controller model for the position loop of the electric servo includes: adopting a pseudo differential feedback control block diagram of a second-order controlled object.
6. The electric steering gear simulation control method based on pseudo differential feedback according to any one of claims 1 to 5, characterized in that: The pseudo-differential feedback controller model, the mathematical model of the brushless DC motor, the mathematical model of the reduction transmission mechanism and the mathematical model of the rudder surface load torque are combined to obtain a closed-loop simulation model of the electric servo position control based on the pseudo-differential controller, including: The initial control input terminal of the pseudo differential feedback controller model inputs a rudder angle command, and the output terminal of the pseudo differential feedback controller model outputs a control voltage to the initial control input terminal of the mathematical model of the brushless DC motor; The output end of the mathematical model of the brushless DC motor outputs the motor rotation angle to the initial control input end of the mathematical model of the brushless DC motor and the mathematical model of the reduction transmission mechanism; The output end of the mathematical model of the reduction transmission mechanism outputs the actual rudder deflection angle to the mathematical model of the steering gear load torque, the initial control input end of the pseudo differential feedback controller model, the pseudo differential control input end of the pseudo differential feedback controller model and the outside; The output end of the mathematical model of the servo load torque outputs the load torque to the torque adjustment input end of the mathematical model of the brushless DC motor.
7. The electric steering gear simulation control method based on pseudo differential feedback according to claim 6 is characterized in that: A saturation limiter is also provided between the output end of the pseudo differential feedback controller model and the initial control input end of the mathematical model of the brushless DC motor.
8. The electric steering gear simulation control method based on pseudo differential feedback according to claim 6 is characterized in that: The method further comprises the following steps: The closed-loop simulation model of the electric servo position control based on the pseudo-differential controller is simulated and observed to obtain the input rudder angle command and feedback corresponding comparison curve to verify the tracking performance.
9. An electronic device, comprising a storage unit and a processing unit, wherein the storage unit stores computer instructions that can be executed on the processing unit, wherein: When the processing unit runs the computer instructions, the processing unit executes the steps of the electric servo simulation control method based on pseudo-differential feedback as claimed in any one of claims 1 to 8.
10. A storage medium having computer instructions stored thereon, characterized in that: When the computer instructions are executed, the steps of the electric servo simulation control method based on pseudo differential feedback as described in any one of claims 1 to 8 are executed.
Citation Information
Cited By
Generalized and modularized modeling and simulation method and system for electric steering engine system
CN119989570A
