Cooperative control method and system of electromechanical system

By dividing the control cycle and adjusting the control signal in the motor coordinated control, the problem of motor synchronization control error is solved, synchronous or coordinated operation is achieved in a long-term experiment, ensuring the accuracy of the experimental equipment.

CN119010659APending Publication Date: 2024-11-22CHONGQING UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411088481.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-09
Publication Date
2024-11-22

AI Technical Summary

Technical Problem

In the prior art, motor coordinated control is prone to errors, resulting in the inability to maintain synchronization or a specific speed ratio during long-term experiments, affecting the experimental results.

Method used

By dividing the operation process of the simulated rail car into multiple control cycles, the accumulated rotation amount of each motor is obtained, the difference is calculated, and the control signal of the target motor is adjusted in the next control cycle so that its difference falls within the predetermined reference range. , keep the motor rotated in synchronization or coordinated.

Benefits of technology

Effectively maintain the coordinated operation of the motor, avoid the expansion of errors, and ensure the accuracy of the experimental equipment.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119010659A_ABST
    Figure CN119010659A_ABST
Patent Text Reader

Abstract

The invention belongs to the technical field of electromechanical control, and discloses a cooperative control method and system of an electromechanical system, the driving process of a simulated rail car is divided into a plurality of control periods, and the actual rotation amounts of all other motors and a reference single machine are differenced in each control period to obtain a difference value. And when the difference value is greater than the first threshold value, adjusting the control signal of the target motor in the next control period so as to adjust the rotation amount of the target motor in the next control period. Therefore, other motors can be kept in synchronous rotation or cooperative rotation with the reference motor as much as possible in a plurality of control periods. In addition, due to the fact that the time of each control period is short, cooperative operation of the motors can be effectively kept, and the error amount cannot be increased in the long-time experiment process. Therefore, the accuracy of the rail car experiment equipment can be effectively ensured.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the field of electromechanical control technology, and specifically relates to a coordinated control method and system for an electromechanical system. Background Art

[0002] In the field of test equipment, it is often necessary to synchronize motors to simulate various experimental scenarios. For example, to simulate the driving process of a rail car, it is necessary to keep multiple wheels rotating synchronously as much as possible, or when the rail car turns, the motors on both sides need to maintain a specific speed ratio.

[0003] In the prior art, multiple motors are synchronously controlled by pulse signals with the same frequency and number of pulses. However, in the actual control process, due to differences in motor manufacturing quality, control accuracy limitations, etc., synchronization or specific speed ratios will gradually fail to be maintained. Especially after a period of experimental time, such differences will be gradually magnified, affecting the experimental results. Summary of the invention

[0004] In view of this, the present invention provides a method and system for cooperative control of an electromechanical system. The present invention aims to solve the problem that the motor cooperative control in the prior art is prone to errors.

[0005] The present invention provides a coordinated control method for an electromechanical system, comprising the following steps:

[0006] S1. Simulate the operation process of the rail vehicle and divide the simulation experiment process into multiple control cycles;

[0007] Simulate the operation process of a rail vehicle: place a rail vehicle with multiple sets of wheels at the bottom on a test bench, and rotatably connect multiple sets of driving wheels on the upper side of the test bench. Each driving wheel is in contact with the wheel surface of the corresponding wheel. Each driving wheel is equipped with a motor. The motor drives the driving wheel to rotate through the output shaft, thereby driving the wheel to rotate. The motor of each driving wheel is connected to a control device, and the control device controls the rotation of the motor by outputting a pulse signal. Each pulse in the pulse signal can drive the motor to rotate the corresponding step angle. The rotation speed of the motor can be controlled by adjusting the pulse frequency.

[0008] S2. Obtain the cumulative rotation of multiple motors in the current control cycle;

[0009] S3. Select a motor as a reference motor and calculate the difference between the cumulative rotation of the reference motor and the cumulative rotation of other motors;

[0010] ΔR=RR'

[0011] Where ΔR is the difference; R is the cumulative rotation of the reference motor, and R' is the cumulative rotation of other motors;

[0012] S4. Determine the difference reference range of the current control cycle, compare the difference described in step S3 with the difference reference range of the current control cycle, and when the difference between the cumulative rotation amount of any other motor and the cumulative rotation amount of the reference motor is not within the difference reference range of the current control cycle, the motor whose difference is not within the difference reference range of the current control cycle is used as the target motor;

[0013] The difference reference range is used to determine whether the coordinated rotation error of the motor is enlarged;

[0014] S5. In the next control cycle, adjusting the control signal of the target motor based on the difference in step S3, so that in the next control cycle, the difference between the accumulated rotation amount of the target motor and the accumulated rotation amount of the reference motor falls within the difference reference range of the next control cycle, wherein the control signal is a pulse signal;

[0015] S6. Take the next control cycle of step S5 as the current control cycle, and return to step S2, repeat the cycle, and continuously adjust the motor until the coordinated control of all control cycles is completed.

[0016] Furthermore, in step S1, the duration of the simulation experiment is 2 hours, and the control period is 5 seconds.

[0017] Furthermore, in step S2, a photoelectric encoder is used to track the rotation amount of the motor output shaft, and the photoelectric encoder is electrically connected to the control device.

[0018] Furthermore, in step S4, the step of determining the difference reference range of the current control cycle is as follows:

[0019] S4.1 Build the same experimental environment as the rail vehicle simulation operation experiment, synchronously control the motor control group based on the same control signal multiple times in the target time period, and extract the difference ΔR of the cumulative rotation of the motor control group after each target time period i , i is the order of the target time period;

[0020] S4.2 Calculate the difference ΔR of multiple accumulated rotation amounts i The average value A and standard deviation σ are obtained, and an initial reference range is constructed based on the average value A and standard deviation σ: Among them, T1 is the duration of the control cycle, T2 is the duration of the target time period, and n is the proportional parameter;

[0021] S4.3 when the plurality of motors corresponding to the control period simulate the linear motion of the vehicle body, the initial reference range is used as the reference range of the control period;

[0022] S4.4 Calculate the inner track length S when multiple motors corresponding to the control cycle simulate the vehicle body's curved motion 内, the length of the outer track S 外 and the circumference S of the track wheel 轮 , and based on the inner track length S 内 , the length of the outer track S 外 and the circumference S of the track wheel 轮 Calculate the difference in rotation between inner and outer corners ΔR 内外 , ΔR 内外 =(S 外 -S 内 ) / S 轮 ; The reference range corresponding to the motor of the wheel on the same side is the initial reference range, and the reference range corresponding to the motor of the wheel on different sides is:

[0023] Further, the step S5 includes the following sub-steps:

[0024] S5.1 determine the step angle γ of the target motor;

[0025] The step angle γ is the motor rotation angle corresponding to one pulse in the control signal;

[0026] S5.2 Determine the pulse adjustment number x based on the step angle γ of the target motor and the difference ΔR described in step S3, where x=ΔR / γ;

[0027] S5.3 adjusting the control signal of the target motor based on the adjusted number x of pulses;

[0028] When the difference is positive, the adjustment quantity x is an increase, that is, the pulse quantity of the control signal of the next control cycle is adjusted to Ceil(N+x) or Floor(N+x);

[0029] When the difference is negative, the adjustment quantity x is a reduction, that is, the number of pulses of the control signal of the next control cycle is adjusted to Ceil(Nx) or Floor(Nx);

[0030] Among them, Ceil() means rounding up to an integer, and Floor() means rounding down to an integer.

[0031] Furthermore, a coordinated control system of an electromechanical system comprises:

[0032] Acquisition module: used to obtain the cumulative rotation amount of each motor in each control cycle;

[0033] Difference calculation module: used to calculate the difference between the cumulative rotation of the reference motor and the cumulative rotation of other motors;

[0034] Calibration module: used to compare the difference calculated by the difference calculation module with the difference reference range corresponding to the current control cycle, and take the motor whose difference is not within the difference reference range of the current control cycle as the target motor;

[0035] Adjustment module: used to adjust the control signal of the target motor based on the difference calculated by the difference module in the next control cycle, so that in the next control cycle, the difference between the accumulated rotation amount of the target motor and the accumulated rotation amount of the reference motor falls within the difference reference range of the next control cycle.

[0036] Beneficial effects:

[0037] The present invention provides a method and system for cooperative control of an electromechanical system, which divides the simulated rail vehicle driving process into multiple control cycles, and in each control cycle, the actual rotation amounts of all other motors and the reference single machine are subtracted to obtain a difference. Then, when the difference is greater than the first threshold, the control signal of the target motor is adjusted in the next control cycle to adjust the rotation amount of the target motor in the next control cycle. Therefore, other motors can be kept as synchronously or cooperatively rotated as possible with the reference motor in multiple control cycles. Since the time of each control cycle is short, the present application can effectively maintain the coordinated operation of the motors, and the error amount will not be enlarged during long-term experiments. Thereby, the accuracy of the rail vehicle experimental equipment can be effectively guaranteed.

[0038] Other advantages, objectives and features of the present invention will be described in the following description to some extent, and to some extent, will be obvious to those skilled in the art based on the following examination and study, or can be taught from the practice of the present invention. The objectives and other advantages of the present invention can be realized and obtained through the following description. BRIEF DESCRIPTION OF THE DRAWINGS

[0039] Figure 1 A flowchart of a coordinated control method of an electromechanical system according to the present invention;

[0040] Figure 2 This is an application scenario diagram of a cooperative control method of an electromechanical system of the present invention;

[0041] Figure 3 A structural diagram of a cooperative control system of an electromechanical system of the present invention;

[0042] Reference numerals: rail vehicle 110 , wheel 120 , electrode 130 , drive wheel 140 , control device 150 . DETAILED DESCRIPTION

[0043] In order to make the technical solutions, advantages and purposes of the present invention clearer, the technical solutions of the embodiments of the present invention will be clearly and completely described below in conjunction with the accompanying drawings of the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the described embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work belong to the protection scope of this application.

[0044] like Figure 1 As shown, this embodiment provides a coordinated control method of an electromechanical system, comprising the following steps:

[0045] S1. Simulate the operation process of the rail vehicle and divide the simulation experiment process into multiple control cycles;

[0046] Simulate the operation process of rail vehicles: Figure 2 This is an application scenario diagram of the cooperative control method of the electromechanical system shown in an embodiment of the present application, such as Figure 2 As shown, the left side (a) is a side view, and the right side (b) is a front view. The rail car 110 is placed on the experimental bench. A plurality of sets of wheels 120 are provided at the bottom of the rail car 110. Each wheel 120 is driven by a motor 130. The output shaft of the motor 130 is provided with a driving wheel 140. The wheel surface of the driving wheel 140 contacts the wheel surface of the wheel 120, thereby driving the wheel 120 to rotate. The plurality of motors 130 are all connected to a control device 150, and the control device 150 controls the rotation of the motor 130 by outputting a pulse signal. Each pulse in the pulse signal can drive the motor 130 to rotate a corresponding step angle. The rotation speed of the motor 130 can be controlled by adjusting the pulse frequency.

[0047] The above experimental equipment can simulate the running process of the rail vehicle, for example, the acceleration process, the deceleration process, the curve driving, the inertia simulation, etc. Therefore, a variety of experimental data can be measured by the above experimental equipment.

[0048] For example, a planned 2-hour experimental process can be divided into multiple control cycles with a duration of 5 seconds; at the beginning, the first control cycle is taken as the current control cycle.

[0049] S2. Obtain the cumulative rotation of multiple motors in the current control cycle;

[0050] In the present application, a photoelectric encoder is used to track the rotation amount of the motor shaft. The principle of the photoelectric encoder is mainly to convert the mechanical geometric displacement on the output shaft into pulses or digital quantities through photoelectric conversion.

[0051] At the beginning of the current control cycle, the rotation amount of each motor is collected based on the preset photoelectric encoder and accumulated until the end of the current control cycle, and the cumulative rotation amount of multiple motors in the current control cycle is obtained. The photoelectric encoder is connected to the host device, and the cumulative rotation amount collected by the photoelectric encoder will be transmitted to the host device as a basis for whether the current motor has a rotation error.

[0052] S3. Select a motor as a reference motor and calculate the difference between the cumulative rotation of the reference motor and the cumulative rotation of other motors;

[0053] ΔR=RR'

[0054] Where ΔR is the difference; R is the cumulative rotation of the reference motor, and R' is the cumulative rotation of other motors;

[0055] Since the rotation error of the motor may not be very large in a single control cycle, if it keeps accumulating, a large difference will be generated in one of the control cycles. Therefore, the present application calculates the difference between the accumulated rotation amount of the reference motor and the accumulated rotation amount of other motors in each control cycle, so as to timely find the time point when the coordinated rotation error increases.

[0056] S4. Determine the difference reference range of the current control cycle, compare the difference described in step S3 with the difference reference range of the current control cycle, and when the difference between the cumulative rotation amount of any other motor and the cumulative rotation amount of the reference motor is not within the difference reference range of the current control cycle, the motor whose difference is not within the difference reference range of the current control cycle is used as the target motor;

[0057] Wherein, a reference range of difference is predetermined in each control cycle, and the reference range of difference is used to determine whether the coordinated rotation error of the motor is enlarged;

[0058] In step S4, the steps of determining the difference reference range of the current control cycle are as follows:

[0059] S4.1 Build the same experimental environment as the rail vehicle simulation operation experiment, synchronously control the motor control group based on the same control signal multiple times in the target time period, and extract the difference ΔR of the cumulative rotation of the motor control group after each target time period i , i is the order of the target time period;

[0060] When conducting the experiment, the experimental environment built is consistent with the rail vehicle operation experimental environment, and the same motor is used. After the experimental environment is built, a motor control group is used to conduct the experiment. The two motors in the motor control group are driven by pulse signals of the same frequency, and each target time period can be set to 1 hour. During the one-hour synchronous operation, the photoelectric encoder is used to collect the cumulative rotation of the two motors and calculate the difference to obtain the difference ΔR of the cumulative rotation of the motor control group. i . Multiple experiments can obtain a large number of data samples;

[0061] S4.2 Calculate the difference ΔR of multiple accumulated rotation amounts i The average value A and standard deviation σ are obtained, and an initial reference range is constructed based on the average value A and standard deviation σ: Among them, T1 is the duration of the control cycle, T2 is the duration of the target time period, and n is the proportional parameter;

[0062] This application uses the average value and standard deviation of a large number of data samples to construct an initial reference range, and the initial reference range is the initial reference range when the motor is running synchronously;

[0063] S4.3 when the plurality of motors corresponding to the control period simulate the linear motion of the vehicle body, the initial reference range is used as the reference range of the control period;

[0064] When multiple motors simulate the linear motion of the vehicle body, all the track wheels can be considered to be running synchronously. Therefore, if it is a control cycle simulating the linear motion of the vehicle body, the initial reference range can be directly used as the reference range;

[0065] S4.4 Calculate the inner track length S when multiple motors corresponding to the control cycle simulate the vehicle body's curved motion 内 , the length of the outer track S 外 and the circumference S of the track wheel 轮 , and based on the inner track length S 内 , the length of the outer track S 外 and the circumference S of the track wheel 轮 Calculate the difference in rotation between inner and outer corners ΔR 内外 , ΔR 内外 =(S 外 -S 内 ) / S 轮 ; The reference range corresponding to the motor of the wheel on the same side is the initial reference range, and the reference range corresponding to the motor of the wheel on different sides is:

[0066] When multiple motors simulate the vehicle body's curved motion, the track wheels on the same side can be considered to be running synchronously, but the track wheels on different sides are moving in coordination. Therefore, for the track wheels on different sides, this application calculates the length S of the inner track 内 and the length S of the outer track 外 , and then calculate the difference to get the distance of the inner and outer track wheels when driving on the curve, and then divide it by the corresponding track wheel circumference and calculate the difference to get the rotation difference ΔR of the track wheels on both sides. 内外 =(S 外 -S 内 ) / S 轮 In the above control cycle, the reference range corresponding to the motors of the wheels on different sides should be increased by the rotation amount difference ΔR 内外 , the corresponding reference range is:

[0067] S5. In the next control cycle, adjusting the control signal of the target motor based on the difference in step S3, so that in the next control cycle, the difference between the accumulated rotation amount of the target motor and the accumulated rotation amount of the reference motor falls within the difference reference range of the next control cycle, wherein the control signal is a pulse signal;

[0068] If the target motor exists, the control signal of the target motor is adjusted in the next cycle. The specific principle is: adjust the number of pulses of the control signal to increase / decrease the rotation amount of the target motor in the next cycle. Then the difference between the cumulative rotation amount of the target motor and the cumulative rotation amount of the reference motor falls within an acceptable range. Specifically, it includes:

[0069] S5.1 determine the step angle γ of the target motor;

[0070] The step angle γ is the motor rotation angle corresponding to one pulse in the control signal;

[0071] S5.2 Determine the pulse adjustment number x based on the step angle γ of the target motor and the difference ΔR described in step S3, where x=ΔR / γ;

[0072] S5.3 adjusting the control signal of the target motor based on the adjusted number x of pulses;

[0073] When the difference is positive, the adjustment quantity x is an increase, that is, the pulse quantity of the control signal of the next control cycle is adjusted to Ceil(N+x) or Floor(N+x);

[0074] When the difference is negative, the adjustment quantity x is a reduction, that is, the number of pulses of the control signal of the next control cycle is adjusted to Ceil(Nx) or Floor(Nx);

[0075] Among them, Ceil() means rounding up to an integer, and Floor() means rounding down to an integer. For example, if the pulse adjustment number is calculated to be 2.5, it can be adjusted to 2 or 3. The specific one to be taken can fall within the corresponding reference range.

[0076] After adjustment, the difference between the rotation amount of the target motor and the rotation amount of the reference motor can be brought back into a tolerable range, thereby continuously adjusting the motors during operation so that different motors can maintain synchronous / cooperative operation no matter how long they run.

[0077] S6. The next control cycle of step S5 is used as the current control cycle, and the process returns to step S2, and the process repeats itself, continuously adjusting the motor until the coordinated control of all control cycles is completed;

[0078] like Figure 3 As shown, the present invention also discloses a coordinated control system of an electromechanical system, comprising:

[0079] Acquisition module: used to obtain the cumulative rotation amount of each motor in each control cycle;

[0080] Difference calculation module: used to calculate the difference between the cumulative rotation of the reference motor and the cumulative rotation of other motors;

[0081] Calibration module: used to compare the difference calculated by the difference calculation module with the difference reference range corresponding to the current control cycle, and take the motor whose difference is not within the difference reference range of the current control cycle as the target motor;

[0082] Adjustment module: used to adjust the control signal of the target motor based on the difference calculated by the difference module in the next control cycle, so that in the next control cycle, the difference between the accumulated rotation amount of the target motor and the accumulated rotation amount of the reference motor falls within the difference reference range of the next control cycle.

[0083] It is hereby declared that the above embodiments are only used to illustrate the technical solutions of the present invention and are not limiting. Although the present invention is described in detail with reference to the preferred embodiments, those skilled in the art should understand that the technical solutions of the present invention can be modified or replaced by equivalents without departing from the purpose and scope of the technical solutions, which should be included in the scope of the claims of the present invention.

Claims

1. A coordinated control method for an electromechanical system, characterized in that: The following steps are involved: S1. Simulate the operation process of the rail vehicle and divide the simulation experiment process into multiple control cycles; Simulate the operation process of a rail vehicle: place a rail vehicle with multiple sets of wheels at the bottom on a test bench, and rotatably connect multiple sets of driving wheels on the upper side of the test bench. Each driving wheel is in contact with the wheel surface of the corresponding wheel. Each driving wheel is equipped with a motor. The motor drives the driving wheel to rotate through the output shaft, thereby driving the wheel to rotate. The motor of each driving wheel is connected to a control device, and the control device controls the rotation of the motor by outputting a pulse signal. Each pulse in the pulse signal can drive the motor to rotate the corresponding step angle. The rotation speed of the motor can be controlled by adjusting the pulse frequency. S2. Obtain the cumulative rotation of multiple motors in the current control cycle; S3. Select a motor as a reference motor and calculate the difference between the cumulative rotation of the reference motor and the cumulative rotation of other motors; ΔR=RR' Where ΔR is the difference; R is the cumulative rotation of the reference motor, and R' is the cumulative rotation of other motors; S4. Determine the difference reference range of the current control cycle, compare the difference described in step S3 with the difference reference range of the current control cycle, and when the difference between the cumulative rotation amount of any other motor and the cumulative rotation amount of the reference motor is not within the difference reference range of the current control cycle, the motor whose difference is not within the difference reference range of the current control cycle is used as the target motor; The difference reference range is used to determine whether the coordinated rotation error of the motor is enlarged; S5. In the next control cycle, adjusting the control signal of the target motor based on the difference in step S3, so that in the next control cycle, the difference between the accumulated rotation amount of the target motor and the accumulated rotation amount of the reference motor falls within the difference reference range of the next control cycle, wherein the control signal is a pulse signal; S6. Take the next control cycle of step S5 as the current control cycle, and return to step S2, repeat the cycle, and continuously adjust the motor until the coordinated control of all control cycles is completed.

2. The method for cooperative control of an electromechanical system according to claim 1, characterized in that: In step S1, the duration of the simulation experiment is 2 hours, and the control period is 5 seconds.

3. The coordinated control method of a mechatronic system according to claim 1, characterized in that: In the step S2, a photoelectric encoder is used to track the rotation amount of the motor output shaft, and the photoelectric encoder is electrically connected to the control device.

4. The coordinated control method of an electromechanical system according to claim 1, characterized in that: In step S4, the steps of determining the difference reference range of the current control cycle are as follows: S4.1 Build the same experimental environment as the rail vehicle simulation operation experiment, synchronously control the motor control group based on the same control signal multiple times in the target time period, and extract the difference ΔR of the cumulative rotation of the motor control group after each target time period i , i is the order of the target time period; S4.2 Calculate the difference ΔR of multiple accumulated rotation amounts i The average value A and standard deviation σ are obtained, and an initial reference range is constructed based on the average value A and standard deviation σ: Among them, T1 is the duration of the control cycle, T2 is the duration of the target time period, and n is the proportional parameter; S4.3 when the plurality of motors corresponding to the control period simulate the linear motion of the vehicle body, the initial reference range is used as the reference range of the control period; S4.4 Calculate the inner track length S when multiple motors corresponding to the control cycle simulate the vehicle body's curved motion 内 , the length of the outer track S 外 and the circumference S of the track wheel 轮 , and based on the inner track length S 内 , the length of the outer track S 外 and the circumference S of the track wheel 轮 Calculate the difference in rotation between inner and outer corners ΔR 内外 , ΔR 内外 =(S 外 -S 内 ) / S 轮 ; The reference range corresponding to the motor of the wheel on the same side is the initial reference range, and the reference range corresponding to the motor of the wheel on different sides is:

5. The coordinated control method of an electromechanical system according to claim 4, characterized in that: The step S5 comprises the following sub-steps: S5.1 determine the step angle γ of the target motor; The step angle γ is the motor rotation angle corresponding to one pulse in the control signal; S5.2 Determine the pulse adjustment number x based on the step angle γ of the target motor and the difference ΔR described in step S3, where x=ΔR / γ; S5.3 adjusting the control signal of the target motor based on the adjusted number x of pulses; When the difference is positive, the adjustment quantity x is an increase, that is, the pulse quantity of the control signal of the next control cycle is adjusted to Ceil(N+x) or Floor(N+x); When the difference is negative, the adjustment quantity x is a reduction, that is, the number of pulses of the control signal of the next control cycle is adjusted to Ceil(Nx) or Floor(Nx); Among them, Ceil() means rounding up to an integer, and Floor() means rounding down to an integer.

6. A coordinated control system for an electromechanical system, characterized in that: include: Acquisition module: used to obtain the cumulative rotation amount of each motor in each control cycle; Difference calculation module: used to calculate the difference between the cumulative rotation of the reference motor and the cumulative rotation of other motors; Calibration module: used to compare the difference calculated by the difference calculation module with the difference reference range corresponding to the current control cycle, and take the motor whose difference is not within the difference reference range of the current control cycle as the target motor; Adjustment module: used to adjust the control signal of the target motor based on the difference calculated by the difference module in the next control cycle, so that in the next control cycle, the difference between the accumulated rotation amount of the target motor and the accumulated rotation amount of the reference motor falls within the difference reference range of the next control cycle.