Control method for acceleration and deceleration of stepping motor of intelligent fire water monitor

Through the intelligent fire water cannon stepper motor acceleration and deceleration control method, dynamic adjustment of the acceleration and deceleration strategy is solved, and the problem of inaccurate change of motor demand during operation in the existing technology is achieved, and the stepper motor is stable and accurate under high-speed changing operation is achieved. run.

CN119051497AActive Publication Date: 2024-11-29FUJIAN NORMAL UNIV +1
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
CN202411231514.8
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-04
Publication Date
2024-11-29
Estimated Expiration
2044-09-04

AI Technical Summary

Technical Problem

The existing stepper motor acceleration and deceleration methods cannot effectively deal with the situation where the motor suddenly changes its demand during operation, resulting in inaccurate control and overshoot, especially in a high-speed changing state of motion, which is difficult to prevent step loss and overshoot.

Method used

The acceleration and deceleration control method of stepper motor of intelligent fire water cannon is adopted. By presetting the system constant conditions, the current speed and direction are obtained, the acceleration and deceleration turning point and maximum speed are calculated, the pulse partition is divided, and the speed of each position is calculated using the stage speed function, dynamic Adjust the acceleration and deceleration strategy to adapt to the motor's motion state.

Benefits of technology

The acceleration and deceleration algorithm in the existing technology has been optimized, the complexity of the S-shaped curve algorithm and the limitations of the trapezoidal algorithm are overcome, and the smooth and accurate operation of stepper motors under high-speed changing operation is achieved, avoiding step loss and overshoot. Suitable for acceleration and deceleration planning for any operation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119051497A_ABST
    Figure CN119051497A_ABST
Patent Text Reader

Abstract

The invention discloses a control method for acceleration and deceleration of a stepping motor of an intelligent fire water monitor, and relates to the technical field of motor control. Comprising the steps of presetting system constant conditions; the current actual operation speed V1 and direction D1 of the stepping motor are obtained; inputting parameters in single acceleration and deceleration, wherein the parameters comprise a target displacement L and a target direction D; judging acceleration and deceleration types which should be executed according to the initial condition; calculating data of key nodes, wherein the data comprises an acceleration turning point M1, a constant speed turning point M2, a deceleration turning point M3, a stop point M4 and the maximum speed Vn of the acceleration stage; and according to the four turning points, dividing 0-M4 stepping motor pulses into four partitions, and calculating the speed of each position in each partition by using a stage speed function. According to the invention, acceleration and deceleration planning is carried out according to any operation condition of the stepping motor, so that the stepping motor can still stably and accurately operate under high-speed change operation.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of motor control, and more specifically to a control method for accelerating and decelerating a stepping motor of an intelligent fire-fighting water cannon. Background Art

[0002] Because of its unique characteristics, the stepper motor can control the position and speed of the motor without feedback devices, so it is widely used in industrial automation equipment. However, in the motion control of the stepper motor, its speed changes greatly, and the acceleration and deceleration are more frequent. The most important thing is that the maximum operating speed of the control system is often much higher than the maximum starting speed of the stepper motor. If the stepper motor is directly started at the maximum operating speed during operation, it cannot start normally because the working speed has exceeded the limit starting frequency. In the worst case, it may lose steps, and in the worst case, it cannot start at all, resulting in stalling. After the system is running, if the pulse train is stopped immediately when the end point is reached, the motor rotor will turn over the equilibrium position due to the inertia of the system. If the inertia of the load is large, the stepper motor is prone to overshoot and operation errors. Therefore, in the stepper motor control system with large speed changes, preventing loss of steps and overshoot is the key to the normal operation of the open-loop control system. Therefore, various speed regulation algorithms have been studied, which can be roughly divided into trapezoidal algorithms and S-curve algorithms. Regardless of the algorithm, the principle is that the start-stop process must have a speed change process from slow to fast, and then from fast to slow.

[0003] The various acceleration and deceleration methods commonly used at present are usually only for the acceleration and deceleration movement of the stepper motor when it is initially stationary, that is, there is no acceleration and deceleration planning for the current motion state of the motor. In actual applications, it is often the case that after sending a target position to the stepper motor, the demand suddenly changes when it is halfway through the operation. When using these algorithms, they still need to be improved again.

[0004] Therefore, it is an urgent problem for technical personnel in this field to propose a control method for accelerating and decelerating the stepping motor of an intelligent fire water cannon to solve the difficulties existing in the prior art. Summary of the invention

[0005] In view of this, the present invention provides a control method for acceleration and deceleration of a stepping motor of an intelligent fire-fighting water cannon, which overcomes the problem that the existing acceleration and deceleration methods in the prior art handle single and incomplete situations.

[0006] In order to achieve the above object, the present invention provides the following technical solutions:

[0007] A control method for accelerating and decelerating a stepping motor of an intelligent fire-fighting water cannon comprises the following steps:

[0008] S1. Preset system constant conditions;

[0009] S2, obtain the actual running speed V1 and direction D1 of the stepper motor;

[0010] S3, input the parameters for single acceleration and deceleration, including target displacement L and target direction D;

[0011] S4. Determine the type of acceleration and deceleration to be performed based on the starting conditions;

[0012] S5. Calculate the data of key nodes, including the acceleration turning point M1, the uniform speed turning point M2, the deceleration turning point M3, the stop point M4, and the maximum speed Vn in the acceleration stage;

[0013] S6: Divide the stepper motor pulses of 0-M4 into four partitions according to the four turning points in S5, and use the stage speed function in each partition to calculate the speed of each position.

[0014] Optionally, the preset system constant conditions in S1 include: system limit maximum acceleration Am, system limit maximum speed Vm, model acceleration speed calculation function V a (s)[V 1 ,V n ,A m ], model deceleration speed calculation function V d (s)[V 1 ,V n ,A m ], model maximum speed calculation function V n (S)[V 0 ,A m ], model acceleration displacement calculation function S(V 1 ,V 2 )[A m ].

[0015] Optional, model acceleration speed calculation function V a (s)[V 1 ,V n ,A m ], during the initialization process, the velocity curve is determined by the initialization parameters in the box, and the velocity of any displacement s in the acceleration process from V1 to Vn is obtained;

[0016] Model deceleration speed calculation function V d (s)[V 1 ,V n ,A m ], during the initialization process, the velocity curve is determined by the initialization parameters in the box, and the velocity of any displacement s in the process of deceleration from Vn to V1 is obtained;

[0017] Model maximum speed calculation function V n (S)[V0 ,A m ], which means that when the stepper motor accelerates from V0 to Vn, the maximum acceleration is Am, the displacement of the stepper motor is S, and Vn is obtained;

[0018] Model acceleration displacement calculation function S(V 1 ,V 2 )[A m ], which means that when the stepper motor accelerates from V1 to V2, the maximum acceleration is Am, the displacement of the stepper motor is S, and S is obtained.

[0019] Optionally, two intermediate transition parameters are also included:

[0020] The maximum speed change displacement X of the system represents the displacement required when the stepper motor accelerates from the minimum starting speed V0 to the maximum limit speed Vm. The calculation method is X = S (V0, Vm) [A m ];

[0021] The displacement K required for the system to stop at the current speed represents the displacement required when the stepper motor decelerates from the current actual speed V1 to the minimum starting speed V0. The calculation method is K=S(V0,V1).

[0022] Optionally, S4 determines the specific content of the acceleration and deceleration type to be executed according to the starting conditions:

[0023] (1) When V1 = 0, the acceleration and deceleration motion starts from a standstill, and then further judgment is made:

[0024] A. When M4>2*X, there are three stages in this movement: acceleration, uniform speed, and deceleration. The maximum speed during the movement is Vn=Vm, the uniform speed point M2=M1+X, and the deceleration point M3=M4-X;

[0025] B. When M4<=2*X, there are two stages of acceleration and deceleration in this movement. During the movement, the actual maximum speed Vn=Vn(M4 / 2), the uniform speed point M2=(M4+M1) / 2, and the deceleration point M3=M2;

[0026] (2) When V1>0 and D1=D, the actual movement direction in this acceleration and deceleration movement is the same as the target direction, and the next step is to make the judgment:

[0027] C. When M4 <= K, deceleration at the maximum acceleration in this movement will still exceed the target displacement, so it is necessary to decelerate first and then accelerate and decelerate in the reverse direction. During the movement, the acceleration point M1 = K, and the stop point M4 = 2*K-M4. After deceleration is completed, the current direction D1 of the motor is controlled to take the opposite value. At this time, the actual speed of the stepper motor is 0, and then jump to (1) for operation.

[0028] D. When M4 > 2*X, there are three stages of acceleration, constant speed, and deceleration in this movement. The maximum speed Vn during the movement process is Vn = Vm. The constant speed point M2 = S(V1, Vm), and the deceleration point M3 = M4 - X;

[0029] E. When K < M4 <= 2*X, there are two stages of acceleration and deceleration in this movement. During the movement process, the actually reached maximum speed Vn = Vn[(M4 + K) / 2]. The constant speed point M2 = M1 + S(V1, V2), and the deceleration point M3 = M2;

[0030] (3) When V1 > 0 and D1!= D, the actual movement direction in this acceleration and deceleration movement is opposite to the target direction. Therefore, it is necessary to decelerate first and then reverse for acceleration and deceleration; during the movement process, the acceleration point M1 = K, the stop point M4 = 2*K + M4. After the deceleration is completed, the current direction D1 of the stepper motor is taken as the opposite value. At this time, the actual speed of the stepper motor is 0, and then it jumps to (1) for operation.

[0031] Optionally, the four partitions in S5 are: reverse deceleration stage, acceleration stage, constant speed stage, and final deceleration stage.

[0032] Optionally, the specific content of the four partitions is as follows:

[0033] In the reverse deceleration stage, directly decelerate from the current motor speed V1 to V0 and stop, and obtain the speed v = Vd(s)[V0, V1, Am] corresponding to any s ∈ (0 - M1) within the stage;

[0034] In the acceleration stage, accelerate from the starting speed V of the acceleration stage to Vn, and obtain the speed v = Va(s - M1)[V, Vn, Am] corresponding to any s ∈ (M1 - M2) within the stage;

[0035] In the constant speed stage, the speed does not change for any s ∈ (M2 - M3) within the stage;

[0036] In the final deceleration stage, decelerate from the speed Vn to V0 and stop for any s ∈ (M3 - M4) within the stage, and obtain the speed v = Vd(s - M3)[V0, Vn, Am] corresponding to any s within the stage.

[0037] As can be seen from the above technical solutions, compared with the prior art, the present invention discloses a control method for the acceleration and deceleration of a stepper motor of an intelligent fire fighting water cannon, and its beneficial effects are as follows:

[0038] 1) The present invention overcomes the disadvantages of complex control, difficult calculation, and difficult implementation of the S-shaped curve algorithm, optimizes the defects of single, incomplete processing, and many introduced parameters of the trapezoidal algorithm, and can be switched arbitrarily between the above two types of acceleration and deceleration models;

[0039] 2) Acceleration and deceleration planning is carried out according to any operating conditions of the stepper motor, so as to control the stepper motor to run smoothly and accurately under high-speed operation. BRIEF DESCRIPTION OF THE DRAWINGS

[0040] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on the provided drawings without paying creative work.

[0041] Figure 1 A flow chart of a control method for accelerating and decelerating a stepping motor of an intelligent fire-fighting water monitor provided by the present invention;

[0042] Figure 2 A structural diagram of the intelligent fire-fighting water monitor provided by the present invention;

[0043] Figure 3 This is a flow chart of the control algorithm initialization for the acceleration and deceleration of the stepping motor of the intelligent fire-fighting water cannon provided by the present invention;

[0044] Figure 4 A flow chart of the acceleration and deceleration types provided by the present invention;

[0045] Figure 5 A flow chart of the stepping motor execution phase provided by the present invention;

[0046] Figure 6 An example diagram of the type 1 of the stepper motor acceleration and deceleration provided by the present invention (the example diagrams are all based on the cosine S acceleration and deceleration model as an example);

[0047] Figure 7 Two examples of the types of acceleration and deceleration of the stepping motor provided by the present invention;

[0048] Figure 8 3 examples of the types of acceleration and deceleration of the stepper motor provided by the present invention;

[0049] Fig. 9 4 examples of the types of acceleration and deceleration of the stepper motor provided by the present invention;

[0050] Fig.10 5 examples of the types of acceleration and deceleration of the stepper motor provided by the present invention;

[0051] Fig.11 6 examples of the types of acceleration and deceleration of the stepper motor provided by the present invention. DETAILED DESCRIPTION

[0052] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. 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.

[0053] See also Figure 1 and Figure 3 As shown, the present invention discloses a control method for accelerating and decelerating a stepping motor of an intelligent fire-fighting water cannon, comprising the following steps:

[0054] S1. Preset system constant conditions;

[0055] S2, obtain the actual running speed V1 and direction D1 of the stepper motor;

[0056] S3, input the parameters for single acceleration and deceleration, including target displacement L and target direction D;

[0057] S4. Determine the type of acceleration and deceleration to be performed based on the starting conditions;

[0058] S5. Calculate the data of key nodes, including the acceleration turning point M1, the uniform speed turning point M2, the deceleration turning point M3, the stop point M4, and the maximum speed Vn in the acceleration stage;

[0059] S6: Divide the stepper motor pulses of 0-M4 into four partitions according to the four turning points in S5, and use the stage speed function in each partition to calculate the speed of each position.

[0060] Specifically, it includes the following functional algebra:

[0061] The system limits the maximum acceleration A m , limit the maximum acceleration of the stepper motor during acceleration and deceleration to ensure that the acceleration of the stepper motor does not exceed this value.

[0062] System limits maximum speed V m , limit the maximum speed of the stepper motor during acceleration and deceleration to ensure that the stepper motor speed does not exceed this value.

[0063] System limit minimum speed V 0 , limit the starting speed of the stepper motor when it is stationary during acceleration and deceleration, so that the stepper motor can be started directly at this speed when it is stationary.

[0064] The target displacement L represents the total displacement of the stepper motor in a certain direction.

[0065] The target displacement direction D indicates the direction in which the stepper motor runs.

[0066] The actual speed V1 of the stepper motor indicates the actual movement speed of the stepper motor at this moment after the movement requirement is specified.

[0067] The actual direction of the stepper motor D1 indicates the actual movement direction of the stepper motor at this moment after the movement requirement is specified.

[0068] The end point M1 of stage one is one of the four stages of acceleration and deceleration of the stepper motor. At this time, the deceleration stage ends, and the Vd function is used to calculate the speed value of each pulse count value s. At the end of the stage, the stepper motor needs to be reversed.

[0069] The end point of stage 2, M2, is one of the four stages of acceleration and deceleration of the stepper motor. At this time, the acceleration stage ends and the constant speed stage begins.

[0070] The end point of stage three is M3, which is one of the four stages of acceleration and deceleration of the stepper motor. At this time, the uniform speed stage ends and the final deceleration stage begins.

[0071] The fourth stage ends at point M4. When initializing, M4=L. This is one of the four stages of stepper motor acceleration and deceleration. At this point, the final deceleration stage ends. Next, the stepper motor stops. The stepper motor reaches the target point and the entire acceleration and deceleration process is completed.

[0072] The pulse count value s in the acceleration and deceleration stage is the pulse count value during the acceleration and deceleration operation of the stepper motor, and the range is [0-M4].

[0073] For details, see Figure 2 As shown, it is realized through an intelligent fire water cannon, which consists of an embedded microprocessor, an ultraviolet module, an image module, a stepper motor module, a communication module, a water pump control module, a solenoid valve control module, a communication module, a limit module and a power supply module.

[0074] Furthermore, the preset system constant conditions in S1 include: system limit maximum acceleration Am, system limit maximum speed Vm, model acceleration speed calculation function V a (s)[V 1 ,V n ,A m ], model deceleration speed calculation function V d (s)[V 1 ,V n ,A m ], model maximum speed calculation function V n (S)[V 0 ,A m ], model acceleration displacement calculation function S(V 1 ,V 2 )[A m ].

[0075] Specifically, according to actual application requirements, the acceleration and deceleration model and its functional function shown in Table 1 are selected.

[0076] Table 1 Acceleration and deceleration models and their functional functions

[0077]

[0078]

[0079] Furthermore, the model acceleration speed calculation function V a (s)[V 1 ,V n ,A m ], during the initialization process, the velocity curve is determined by the initialization parameters in the box, and the velocity of any displacement s in the acceleration process from V1 to Vn is obtained;

[0080] Model deceleration speed calculation function V d (s)[V 1 ,V n ,A m ], during the initialization process, the velocity curve is determined by the initialization parameters in the box, and the velocity of any displacement s in the process of deceleration from Vn to V1 is obtained;

[0081] Model maximum speed calculation function V n (S)[V 0 ,A m ], which means that when the stepper motor accelerates from V0 to Vn, the maximum acceleration is Am, the displacement of the stepper motor is S, and Vn is obtained;

[0082] Model acceleration displacement calculation function S(V 1 ,V 2 )[A m ], which means that when the stepper motor accelerates from V1 to V2, the maximum acceleration is Am, the displacement of the stepper motor is S, and S is obtained.

[0083] Specifically, it is determined by the currently selected model. The round brackets represent independent variables, and the square brackets represent initialization parameters. The first two functions are used to calculate the speed of the actual acceleration and deceleration process of the motor, and the latter two are used to calculate the initialization parameters before the motor moves.

[0084] Furthermore, two intermediate transition parameters are included:

[0085] The maximum speed change displacement X of the system represents the displacement required when the stepper motor accelerates from the minimum starting speed V0 to the maximum limit speed Vm. The calculation method is X = S (V0, Vm) [A m ];

[0086] The displacement K required for the system to stop at the current speed represents the displacement required when the stepper motor decelerates from the current actual speed V1 to the minimum starting speed V0. The calculation method is K=S(V0,V1).

[0087] For further information, see Figure 4 As shown, S4 determines the specific content of the acceleration and deceleration type to be executed according to the starting conditions:

[0088] (1) When V1 = 0, the acceleration and deceleration motion starts from a standstill, and then further judgment is made:

[0089] A. When M4>2*X, there are three stages in this movement: acceleration, uniform speed, and deceleration. The maximum speed during the movement is Vn=Vm, the uniform speed point M2=M1+X, and the deceleration point M3=M4-X;

[0090] Specifically, if M1 = 0 in the end, then the current Figure 7 Type of motion profile shown.

[0091] B. When M4<=2*X, there are two stages of acceleration and deceleration in this movement. During the movement, the actual maximum speed Vn=Vn(M4 / 2), the uniform speed point M2=(M4+M1) / 2, and the deceleration point M3=M2;

[0092] Specifically, if M1 = 0 in the end, then the current Figure 6 Type of motion profile shown.

[0093] (2) When V1>0 and D1=D, the actual movement direction in this acceleration and deceleration movement is the same as the target direction, and the next step is to make the judgment:

[0094] C. When M4 <= K, deceleration at the maximum acceleration in this movement will still exceed the target displacement, so it is necessary to decelerate first and then accelerate and decelerate in the reverse direction. During the movement, the acceleration point M1 = K, and the stop point M4 = 2*K-M4. After deceleration is completed, the current direction D1 of the motor is controlled to take the opposite value. At this time, the actual speed of the stepper motor is 0, and then jump to (1) for operation.

[0095] Specifically, the current Fig.11 Type of motion profile shown.

[0096] D. When M4>2*X, there are three stages in this movement: acceleration, uniform speed, and deceleration. The maximum speed during the movement is Vn=Vm, the uniform speed point M2=S(V1,Vm), and the deceleration point M3=M4-X;

[0097] Specifically, the current Fig. 9 Type of motion profile shown.

[0098] E. When K < M4 <= 2*X, there are two stages of acceleration and deceleration in this movement. During the movement, the actual maximum speed Vn reached is Vn[(M4 + K) / 2], the uniform motion point M2 = M1 + S(V1, V2), and the deceleration point M3 = M2;

[0099] Specifically, currently it is the type of motion curve as Figure 8 shown.

[0100] (3) When V1 > 0 and D1!= D, the actual movement direction in this acceleration and deceleration movement is opposite to the target direction. Therefore, it is necessary to decelerate first and then accelerate in the reverse direction; during the movement, the acceleration point M1 = K, the stop point M4 = 2*K + M4. After the deceleration is completed, the current direction D1 of the stepping motor is taken as the opposite value. At this time, the actual speed of the stepping motor is 0, and then it jumps to (1) for operation.

[0101] Specifically, currently it is the type of motion curve as Fig.10 shown.

[0102] In addition, for Figure 5 where s = s + 1, regardless of which stage of acceleration, uniform motion, or deceleration the algorithm is in, each time it is executed, the stepping motor will take one step. This is an inherent property of the stepping motor.

[0103] Furthermore, the four partitions in S5 are: reverse deceleration stage, acceleration stage, uniform motion stage, and final deceleration stage.

[0104] Specifically, for any acceleration and deceleration process of the stepping motor, the number of pulses to be executed is divided into four stages. Using s to represent the pulse number count of the entire acceleration and deceleration process, the speed of each pulse is obtained through a preset speed calculation function.

[0105] Furthermore, the specific content of the four partitions is:

[0106] In the reverse deceleration stage, directly decelerate from the current motor speed V1 to V0 and stop, obtaining the speed v = Vd(s)[V0, V1, Am] corresponding to any s ∈ (0 - M1) within the stage;

[0107] In the acceleration stage, accelerate from the starting speed V of the acceleration stage to Vn, obtaining the speed v = Va(s - M1)[V, Vn, Am] corresponding to any s ∈ (M1 - M2) within the stage;

[0108] In the uniform motion stage, the speed remains unchanged for any s ∈ (M2 - M3) within the stage;

[0109] In the final deceleration stage, decelerate from the speed Vn to V0 and stop for any s ∈ (M3 - M4) within the stage, obtaining the speed v = Vd(s - M3)[V0, Vn, Am] corresponding to any s within the stage.

[0110] The various embodiments in this specification are described in a progressive manner, and each embodiment focuses on the differences from other embodiments. The same or similar parts between the various embodiments can be referenced to each other.

[0111] The above description of the disclosed embodiments enables one skilled in the art to implement or use the present invention. Various modifications to these embodiments will be apparent to one skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present invention. Therefore, the present invention will not be limited to the embodiments shown herein, but rather to the widest scope consistent with the principles and novel features disclosed herein.

Claims

1. A control method for accelerating and decelerating a stepping motor of an intelligent fire-fighting water monitor, characterized in that: It includes the following steps: S1. Preset system constant conditions; S2. Obtain the current actual running speed V1 and direction D1 of the stepper motor; S3. Input the parameters in a single acceleration / deceleration, including the target displacement L and the target direction D; S4. Determine the type of acceleration / deceleration to be performed according to the starting conditions; S5. Calculate the data of key nodes, including the acceleration turning point M1, the constant-speed turning point M2, the deceleration turning point M3, the stop point M4, and the maximum speed Vn in the acceleration stage; S6: Divide the stepper motor pulses from 0 to M4 into four partitions according to the four turning points in S5, and calculate the speed at each position using the stage speed function within each partition.

2. The control method for accelerating and decelerating a stepping motor of an intelligent fire-fighting water monitor according to claim 1 is characterized in that: The preset system constant conditions in S1 include: system limit maximum acceleration Am, system limit maximum speed Vm, model acceleration speed calculation function V a (s)[V1,V n ,A m ], model deceleration speed calculation function V d (s)[V1,V n ,A m ], model maximum speed calculation function V n (S)[V0,A m ], model acceleration displacement calculation function S(V1,V2)[A m ].

3. The control method for accelerating and decelerating a stepping motor of an intelligent fire-fighting water monitor according to claim 2 is characterized in that: Model acceleration speed calculation function V a (s)[V1,V n ,A m ], during the initialization process, the velocity curve is determined by the initialization parameters in the box, and the velocity of any displacement s in the acceleration process from V1 to Vn is obtained; Model deceleration speed calculation function V d (s)[V1,V n ,A m ], during the initialization process, the velocity curve is determined by the initialization parameters in the box, and the velocity of any displacement s in the process of deceleration from Vn to V1 is obtained; Model maximum speed calculation function V n (S)[V0,A m ], which means that when the stepper motor accelerates from V0 to Vn, the maximum acceleration is Am, the displacement of the stepper motor is S, and Vn is obtained; Model acceleration displacement calculation function S(V1,V2)[A m ], which means that when the stepper motor accelerates from V1 to V2, the maximum acceleration is Am, the displacement of the stepper motor is S, and S is obtained.

4. The control method for accelerating and decelerating a stepping motor of an intelligent fire-fighting water monitor according to claim 2 is characterized in that: It also includes two intermediate transition parameters: The maximum speed change displacement X of the system represents the displacement required when the stepper motor accelerates from the minimum starting speed V0 to the maximum limit speed Vm. The calculation method is X = S (V0, Vm) [A m ]; The displacement K required for the system to stop at the current speed, which represents the displacement required for the stepper motor to decelerate from the current actual speed V1 to the minimum starting speed V0. The calculation method is K = S(V0, V1).

5. The control method for accelerating and decelerating a stepping motor of an intelligent fire-fighting water monitor according to claim 1 is characterized in that: The specific content of S4 to determine the type of acceleration / deceleration to be performed according to the starting conditions is as follows: (1) When V1 = 0, this acceleration / deceleration motion starts from rest, and then further judgment is made: A. When M4 > 2*X, there are three stages of acceleration, constant speed, and deceleration in this motion. The maximum speed Vn during the motion process is Vm, the constant-speed point M2 = M1 + X, and the deceleration point M3 = M4 - X; B. When M4 <= 2*X, there are two stages of acceleration and deceleration in this motion. During the motion process, the actually reached maximum speed Vn = Vn(M4 / 2), the constant-speed point M2 = (M4 + M1) / 2, and the deceleration point M3 = M2; (2) When V1 > 0 and D1 = D, the actual motion direction and the target are in the same direction in this acceleration / deceleration motion, and then the next judgment is made: C. When M4 <= K, decelerating at the maximum acceleration in this motion will still exceed the target displacement. Therefore, it is necessary to decelerate first and then perform reverse acceleration / deceleration. During the motion process, the acceleration point M1 = K, the stop point M4 = 2*K - M4. After deceleration is completed, control the current direction D1 of the motor to take the opposite value. At this time, the actual speed of the stepper motor is 0, and then jump to (1) for operation; D. When M4 > 2*X, there are three stages of acceleration, constant speed, and deceleration in this motion. The maximum speed Vn during the motion process is Vm, the constant-speed point M2 = S(V1, Vm), and the deceleration point M3 = M4 - X; E. When K < M4 <= 2*X, there are two stages of acceleration and deceleration in this motion. During the motion process, the actually reached maximum speed Vn = Vn[(M4 + K) / 2], the constant-speed point M2 = M1 + S(V1, V2), and the deceleration point M3 = M2; (3) When V1 > 0 and D1!= D, the actual motion direction and the target are in the opposite direction in this acceleration / deceleration motion. Therefore, it is necessary to decelerate first and then perform reverse acceleration / deceleration. During the motion process, the acceleration point M1 = K, the stop point M4 = 2*K + M4. After deceleration is completed, control the current direction D1 of the stepper motor to take the opposite value. At this time, the actual speed of the stepper motor is 0, and then jump to (1) for operation.

6. The control method for accelerating and decelerating a stepping motor of an intelligent fire-fighting water monitor according to claim 1 is characterized in that: The four partitions in S5 are: the reverse deceleration stage, the acceleration stage, the constant-speed stage, and the final deceleration stage.

7. The control method for accelerating and decelerating a stepping motor of an intelligent fire-fighting water monitor according to claim 6 is characterized in that: The specific content of the four partitions is as follows: In the reverse deceleration stage, the current motor speed V1 is directly decelerated to V0 to stop, and the speed v=Vd(s)[V0,V1,Am] corresponding to any s∈(0-M1) in the stage is obtained; In the acceleration phase, the speed V is accelerated to Vn from the starting speed of the acceleration phase, and the speed v=Va(s-M1)[V,Vn,Am] corresponding to any s∈(M1-M2) in the phase is obtained; In the uniform speed stage, the speed of any s∈(M2-M3) does not change during the stage; In the final deceleration stage, any s∈(M3-M4) in the stage decelerates at speed Vn to stop at V0, and the speed v=Vd(s-M3)[V0,Vn,Am] corresponding to any s in the stage is obtained.

Citation Information

Patent Citations

  • S-shaped acceleration and deceleration control method for changing speed and position of object on line

    CN106168790A

  • S curve acceleration and deceleration planning method based on trapezoid solution and under random displacement speed

    CN108958173A

  • Method for gently starting, stopping or changing speed of stepping motor

    JP1997103094A

  • Method, apparatus and system for controlling stepping motor, and storage medium

    WO2021042637A1