High-precision position planning and positioning control method and system
By employing high-precision position planning and positioning control methods, the problems of sudden acceleration changes and low positioning accuracy in hydraulic pitch systems have been solved, enabling stable and efficient operation of wind turbine generators.
Patent Information
- Application Number
- CN202410941461.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-15
- Publication Date
- 2024-11-01
AI Technical Summary
In existing hydraulic pitch control systems, traditional linear control and constant acceleration control methods result in sudden acceleration changes and low positioning accuracy, which affect the operational stability and efficiency of wind turbine generators.
A high-precision position planning and positioning control method is adopted. By setting initial parameters to limit the key points of the trajectory, the motion is divided into uniform acceleration, uniform speed and uniform deceleration segments. The key parameters of each segment are calculated using trigonometric function equations, and proportional-integral control is performed in combination with real-time position feedback to achieve smooth trajectory tracking and positioning.
It improves the positioning accuracy and smoothness of the hydraulic pitch system, avoids the shock and vibration caused by sudden acceleration changes, and enhances the stability and efficiency of the wind turbine generator set.
Smart Images

Figure CN118885010A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of hydraulic pitch control for wind power generation, and in particular to a high-precision position planning and positioning control method and system. Background Art
[0002] With the development and popularization of clean energy around the world, more and more new energy utilization methods are being developed and used, and wind power generation is one of the important ones. Since natural wind energy is not constant and controllable, the variable pitch system is an indispensable item to ensure the power generation efficiency and stability and safety of wind power generation, among which hydraulic variable pitch is a commonly used variable pitch system. However, ordinary linear control and constant acceleration control methods have problems such as sudden acceleration changes and low positioning accuracy, which will cause overshoot and jitter in the hydraulic variable pitch system, thereby affecting the normal and efficient operation of the wind turbine. Therefore, how to quickly, stably and smoothly plan the hydraulic variable pitch position and track the positioning is a key issue to ensure the efficiency and stability and safety of wind power generation. Summary of the invention
[0003] The present invention aims to solve at least one of the technical problems in the prior art of sudden acceleration change and low positioning accuracy caused by traditional linear control and constant acceleration control methods in hydraulic pitch control systems.
[0004] To this end, a first aspect of the present invention provides a high-precision position planning and positioning control method.
[0005] A second aspect of the present invention provides a high-precision position planning and positioning control system.
[0006] The present invention provides a high-precision position planning and positioning control method, which is applied to wind turbine pitch control, comprising:
[0007] S1. According to the planning goal, the key points of the trajectory are defined by setting initial parameters, wherein the initial parameters include the initial position, the end position, the set maximum speed, the maximum acceleration, the maximum deceleration, the initial speed, the end speed and the total movement time;
[0008] S2, dividing the pitch motion into a uniform acceleration section, a uniform speed section and a uniform deceleration section, and calculating the total displacement of the uniform acceleration section, the total time of the uniform acceleration section, the total displacement of the uniform deceleration section and the total time of the uniform deceleration section according to the initial parameters;
[0009] S3, comparing the sum of the total displacement of the uniform acceleration segment and the total displacement of the uniform deceleration segment with the total displacement obtained according to the initial parameters, to determine whether the pre-planned trajectory includes a uniform speed segment; for a pre-planned trajectory that does not include a uniform speed segment, recalculate the planned maximum speed; for a pre-planned trajectory that includes a uniform speed segment, set the maximum speed as the planned maximum speed;
[0010] S4. Recalculate the key parameters of each segment according to the maximum acceleration, the maximum deceleration and the planned maximum speed; the key parameters of each segment include: the total time of the uniform acceleration segment, the total displacement of the uniform acceleration segment, the total time of the uniform speed segment, the total displacement of the uniform speed segment, the total time of the uniform deceleration segment and the total displacement of the uniform deceleration segment; wherein, when the pre-planned trajectory does not include the uniform speed segment, it is not necessary to calculate the total time of the uniform speed segment and the total displacement of the uniform speed segment;
[0011] S5, converting the uniform acceleration segment into the acceleration segment, and converting the uniform deceleration segment into the deceleration segment; wherein, according to the relationship between the speed and time in the uniform acceleration segment, a trigonometric function equation of the speed and time in the acceleration segment is established; according to the relationship between the speed and time in the uniform deceleration segment, a trigonometric function equation of the speed and time in the deceleration segment is established; and an equation of the speed and time in the uniform speed segment is established;
[0012] S6. Differentiate and integrate the trigonometric equations of the speed and time in the acceleration section, the trigonometric equations of the speed and time in the deceleration section, and the equations of the speed and time in the uniform speed section, respectively, to obtain the relationship between the position and time of each section, the relationship between the acceleration and time, and the relationship between the deceleration and time;
[0013] S7, outputting the planned trajectory according to the relationship between each position and time, the relationship between acceleration and time, and the relationship between deceleration and time;
[0014] S8. Obtain real-time position feedback results, and use proportional integral control according to the planned trajectory and the real-time position feedback results to complete the tracking and positioning of the planned trajectory.
[0015] The high-precision position planning and positioning control method according to the above technical solution of the present invention may also have the following additional technical features:
[0016] In the above technical solution, step S2 includes:
[0017]
[0018] Where t1 represents the total time of uniform acceleration; t3 represents the total time of uniform deceleration; S1 represents the total displacement of uniform acceleration; S3 represents the total displacement of uniform deceleration; V max0 Indicates setting the maximum speed; V start represents the initial velocity; V end Indicates the termination speed; a max Indicates the maximum acceleration; d max Indicates the maximum deceleration;
[0019] In step S3, the method for determining whether the pre-planned trajectory includes a uniform speed segment includes:
[0020] S1+S3 end -S start When , it is determined that the pre-planned trajectory includes a uniform acceleration segment, a uniform speed segment, and a uniform deceleration segment;
[0021] S1+S3≥S end -S start When , it is determined that the pre-planned trajectory does not contain a uniform speed segment;
[0022] Among them, S end Indicates the end position, S start Indicates the initial position;
[0023] The method for recalculating the planned maximum speed for the pre-planned trajectory that does not include a uniform speed segment includes:
[0024]
[0025] Among them, V max Indicates the planned maximum speed, S total represents the total displacement obtained according to the initial parameters.
[0026] In the above technical solution, in step S4, the calculation method of the key parameters of each segment includes:
[0027]
[0028] S2=S end -S start -S1-S3
[0029]
[0030] Among them, S2 represents the total displacement of the uniform speed segment; t2 represents the total time of the uniform speed segment.
[0031] In the above technical solution, step S5 includes:
[0032] Establish the first trigonometric equation of the acceleration speed and time:
[0033]
[0034] Make the key point (0,V start ), and (t1,V max ) satisfies the first trigonometric function equation, and the equation of the acceleration section speed and time is solved as follows:
[0035]
[0036] Establish the equation of speed and time for the uniform speed segment:
[0037] V (t) =V max ;(t1 <t<(t1+t2))
[0038] Establish the second trigonometric function equation of the speed and time in the deceleration stage:
[0039]
[0040] Let the key point ((t1+t2),V max ), and (t1+t2+t3,V end ) satisfies the second trigonometric function equation, and the equation of speed and time in the deceleration section is solved as follows:
[0041]
[0042] Among them, V (t) It represents the instantaneous speed at time t. A and B are the process parameters for establishing the trigonometric function equation.
[0043] In the above technical solution, in step S6, the relationship between each segment position and time, the relationship between acceleration and time, and the relationship between deceleration and time include:
[0044] The relationship between the acceleration section position and time:
[0045]
[0046] The relationship between acceleration and time in the acceleration section:
[0047]
[0048] The relationship between position and time in the uniform speed segment:
[0049] S (t) =S start +S1+V max ×(t-t1);(t1 <t<(t1+t2))
[0050] The relationship between acceleration and time in uniform speed segment:
[0051] a (t) =0;(t1 <t<(t1+t2))
[0052] The relationship between the deceleration section position and time:
[0053]
[0054] The relationship between deceleration and time in uniform speed segment:
[0055]
[0056] Among them, S (t) represents the position at time t; a (t) Indicates the acceleration or deceleration at time t.
[0057] In the above technical solution, step S8 includes:
[0058] The position curve of the planned trajectory is used as the target position curve of the system operation and as the target parameter of positioning and tracking; the real-time position feedback result is obtained and used as the feedback parameter of positioning and tracking;
[0059] According to the target parameters and feedback parameters, proportional integral control is used to obtain the deviation adjustment calculation results;
[0060] The deviation adjustment calculation result is converted into the opening control of the proportional servo valve to achieve trajectory tracking and positioning.
[0061] The above technical solution also includes:
[0062] S9, according to the set total exercise time, automatically iteratively update the set maximum speed, so that the actual exercise time gradually approaches the set total exercise time;
[0063] The ratio of the actual movement time to the set total movement time is used as an iteration coefficient, and the set maximum speed is scaled by this coefficient.
[0064] The present invention provides a high-precision position planning and positioning control system, comprising:
[0065] The acquisition module is used to collect the hydraulic pitch position in real time and form a real-time position feedback signal;
[0066] A control module, used for performing trajectory planning and positioning control using the high-precision position planning and positioning control method according to any one of claims 1 to 7, wherein the control module generates a control signal according to the planned trajectory and the real-time position feedback signal;
[0067] The execution module receives the control signal and controls the movement speed of the hydraulic variable pitch according to the control signal.
[0068] In the above technical solution, the control module includes a trajectory planning function block; the trajectory planning function block includes:
[0069] A parameter setting unit is used to set initial parameters according to the planning objectives, thereby defining key points of the trajectory;
[0070] An enabling judgment unit, used to judge whether to execute the trajectory planning process according to an enabling signal;
[0071] A pre-planning unit is used to calculate the total displacement of the uniform acceleration segment, the total time of the uniform acceleration segment, the total displacement of the uniform deceleration segment and the total time of the uniform deceleration segment according to the initial parameters according to a pre-set three-segment model: a uniform acceleration segment, a uniform speed segment and a uniform deceleration segment;
[0072] The trajectory type judgment unit is used to compare the sum of the total displacement of the uniform acceleration segment and the total displacement of the uniform deceleration segment with the set total displacement to determine whether the pre-planned trajectory contains a uniform speed segment; and recalculate the planned maximum speed that does not contain the uniform speed segment; determine the trajectory movement direction according to the initial position and the end position, and recalibrate the planned maximum speed, acceleration and deceleration;
[0073] The key point parameter calculation unit recalculates the key parameters of each section according to the maximum acceleration, maximum deceleration and planned maximum speed;
[0074] The trigonometric function smoothing unit uses trigonometric functions to smooth the uniform acceleration and deceleration segments according to the key parameters of each segment, thereby converting them into acceleration and deceleration segments; and uses differential and integral algorithms to obtain the relationship between the position and time of each segment, the relationship between acceleration and time, and the relationship between deceleration and time, to form a planned trajectory;
[0075] The speed iteration unit automatically iterates and updates the set maximum speed according to the set total time, so that the actual movement time gradually approaches the set total movement time.
[0076] In the above technical solution, the control module also includes a tracking and positioning function block; the tracking and positioning function block includes:
[0077] A parameter input unit is used to use the position curve of the planned trajectory as the target position curve of the system operation and as the target parameter of the positioning and tracking; and to obtain the real-time position feedback result and use it as the feedback parameter of the positioning and tracking;
[0078] A deviation adjustment unit automatically calculates deviation adjustment calculation results according to target parameters and feedback parameters;
[0079] The control output unit generates the control signal according to the deviation adjustment calculation result.
[0080] In summary, due to the adoption of the above technical features, the beneficial effects of the present invention are:
[0081] The high-precision position planning and positioning control method and system proposed in the present invention can set different key parameters according to different system requirements, adapt to a variety of different systems, and increase the flexibility and practicality of the planning curve. By checking the speed parameters, on the one hand, the maximum speed can be adjusted to a reasonable level to ensure the accuracy of the planned trajectory, and on the other hand, system operation failures caused by unreasonable parameters can be avoided. The present invention also smoothes the three-stage uniform acceleration and deceleration motion trajectory, and can obtain smooth curves of displacement, velocity, acceleration and time, eliminating sudden changes in acceleration, which is beneficial to improving the smooth operation of the system and reducing impact and jitter. Finally, according to the real-time feedback data and the planned target parameters, the output signal is adjusted to improve the control effect of the proportional servo valve.
[0082] Additional aspects and advantages of the present invention will become apparent from the following description or may be learned by practice of the present invention. BRIEF DESCRIPTION OF THE DRAWINGS
[0083] The above and / or additional aspects and advantages of the present invention will become apparent and easily understood from the description of the embodiments in conjunction with the following drawings, in which:
[0084] Figure 1 is a flow chart of a high-precision position planning and positioning control method according to an embodiment of the present invention;
[0085] Figure 2 It is a planning trajectory result including uniform motion in a high-precision position planning and positioning control method according to an embodiment of the present invention;
[0086] Figure 3 It is a planning trajectory result that does not include uniform motion in a high-precision position planning and positioning control method according to an embodiment of the present invention;
[0087] Figure 4 It is a schematic diagram comparing an acceleration curve output by a high-precision position planning and positioning control method according to an embodiment of the present invention and an acceleration curve of a constant acceleration motion;
[0088] Figure 5 This is a flowchart of tracking and positioning of a planned trajectory in a high-precision position planning and positioning control method according to an embodiment of the present invention:
[0089] Figure 6 It is a schematic diagram of tracking and positioning effect in a high-precision position planning and positioning control method according to an embodiment of the present invention;
[0090] Figure 7 This is a module diagram of a high-precision position planning and positioning control system according to an embodiment of the present invention:
[0091] Figure 8 It is a module schematic diagram of a control module in a high-precision position planning and positioning control system according to an embodiment of the present invention. DETAILED DESCRIPTION
[0092] In order to more clearly understand the above-mentioned purpose, features and advantages of the present invention, the present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments. It should be noted that the embodiments of the present application and the features in the embodiments can be combined with each other without conflict.
[0093] In the following description, many specific details are set forth to facilitate a full understanding of the present invention. However, the present invention may also be implemented in other ways different from those described herein. Therefore, the protection scope of the present invention is not limited to the specific embodiments disclosed below.
[0094] Refer to the following Figures 1 to 8 To describe the high-precision position planning and positioning control method and system provided according to some embodiments of the present invention.
[0095] Some embodiments of the present application provide a high-precision position planning and positioning control method.
[0096] like Figure 1 As shown, the first embodiment of the present invention proposes a high-precision position planning and positioning control method, which is applied to the pitch control of a wind turbine generator set, including steps S1-S8.
[0097] S1. According to the planning goal, the key points of the trajectory are defined by setting initial parameters, which include the initial position S start , end position S end , set the maximum speed V max0 , maximum acceleration a max , maximum deceleration d max , initial velocity V start , terminal speed V end and the total movement time t total .
[0098] S2. Divide the pitch motion into a uniform acceleration section, a uniform speed section and a uniform deceleration section, and calculate the total displacement of the uniform acceleration section, the total time of the uniform acceleration section, the total displacement of the uniform deceleration section and the total time of the uniform deceleration section according to the initial parameters.
[0099] It can be understood that the uniform acceleration segment is the segment with the maximum acceleration a max From the initial speed V start Accelerate uniformly to the set maximum speed V max0 The uniform speed segment is the movement phase with the set maximum speed V max0 The uniform motion stage; the uniform deceleration stage is the stage with the maximum deceleration d max Uniformly decelerate to the terminal speed V end movement phase.
[0100] According to the above physical relationship of each motion stage, the calculation method of the total displacement of the uniform acceleration segment, the total time of the uniform acceleration segment, the total displacement of the uniform deceleration segment and the total time of the uniform deceleration segment can be obtained as follows:
[0101]
[0102] Where t1 represents the total time of uniform acceleration; t3 represents the total time of uniform deceleration; S1 represents the total displacement of uniform acceleration; S3 represents the total displacement of uniform deceleration; V max0 Indicates setting the maximum speed; V start represents the initial velocity; V end Indicates the termination speed; a maxIndicates the maximum acceleration; d max Indicates the maximum deceleration.
[0103] S3, comparing the sum of the total displacement of the uniform acceleration segment and the total displacement of the uniform deceleration segment with the total displacement obtained according to the initial parameters, to determine whether the pre-planned trajectory includes a uniform speed segment; for a pre-planned trajectory that does not include a uniform speed segment, recalculate the planned maximum speed; for a pre-planned trajectory that includes a uniform speed segment, set the maximum speed as the planned maximum speed;
[0104] In some embodiments, the method for determining whether the pre-planned trajectory includes a uniform speed segment in step S3 includes:
[0105] S1+S3 end -S start , it is determined that the pre-planned trajectory includes a uniform acceleration segment, a uniform speed segment, and a uniform deceleration segment; at this time, in the pre-planned trajectory, the corresponding planned maximum speed of the uniform speed segment is the set maximum speed.
[0106] S1+S3≥S end -S start , it is determined that the pre-planned trajectory does not contain a uniform speed segment, that is, it only contains two motion trajectories: a uniform acceleration segment and a uniform deceleration segment. At this time, it is necessary to re-determine a reasonable planned maximum speed to avoid unreasonable maximum speed settings in the initial parameters, which may lead to pitch position exceeding the limit or causing other operational failures.
[0107] The method for recalculating the planned maximum speed for the pre-planned trajectory that does not include a uniform speed segment includes:
[0108] Since the uniform speed segment has been cancelled in the pre-planned trajectory, but its total displacement, initial velocity and terminal velocity remain unchanged, we have:
[0109] S total =|S end -S start |
[0110] S total =S1+S3
[0111] V max 2 -V start 2 =2×a max ×S1
[0112]
[0113] Among them, V max Indicates the planned maximum speed, S total represents the total displacement obtained according to the initial parameters.
[0114] In some embodiments, when the initial parameters are all set to positive numbers, that is, the direction of the pitch movement is uncertain, it is necessary to continue to compare the initial position with the end position according to the pre-planned trajectory, determine the direction of trajectory movement, and recalibrate the maximum speed, acceleration and deceleration.
[0115] Specifically, if S end -S start <0, the pitch motion is judged as negative motion, so that V max =-|V max |, a max =-a max , d max =d max If S end -S start ≥0, the pitch motion is determined to be positive motion, so that V max =|V max |, a max =a max , d max =-d max .
[0116] S4. Recalculate the key parameters of each segment according to the maximum acceleration, maximum deceleration and planned maximum speed; the key parameters of each segment include: total time of uniform acceleration segment, total displacement of uniform acceleration segment, total time of uniform speed segment, total displacement of uniform speed segment, total time of uniform deceleration segment and total displacement of uniform deceleration segment; wherein, when the pre-planned trajectory does not include a uniform speed segment, there is no need to calculate the total time of the uniform speed segment and the total displacement of the uniform speed segment.
[0117] Specifically, in step S4, the calculation method of the key parameters of each segment includes:
[0118]
[0119] S2=S end -S start -S1-S3
[0120]
[0121] Among them, S2 represents the total displacement of the uniform speed segment; t2 represents the total time of the uniform speed segment.
[0122] S5. Convert the uniform acceleration segment into the acceleration segment, and convert the uniform deceleration segment into the deceleration segment; wherein, according to the relationship between the speed and time in the uniform acceleration segment, establish the trigonometric function equation of the speed and time of the acceleration segment; according to the relationship between the speed and time in the uniform deceleration segment, establish the trigonometric function equation of the speed and time of the deceleration segment; and establish the equation of the speed and time of the uniform speed segment.
[0123] Step S5 includes:
[0124] Establish the first trigonometric equation of the acceleration speed and time:
[0125]
[0126] Make the key point (0,V start ), and (t1,V max ) satisfies the first trigonometric function equation, and the equation of the acceleration section speed and time is solved as follows:
[0127]
[0128] It is understandable that the key point (0,V start ), and (t1,V max ) are the velocity relationships between the key time points in the uniform acceleration segment and the corresponding moments. The equation obtained by making the first trigonometric function equation satisfy the above three key points can make the motion of the acceleration segment smoother.
[0129] Establish the equation of speed and time for the uniform speed segment:
[0130] V (t) =V max ;(t1 <t<(t1+t2))
[0131] Establish the second trigonometric function equation of the speed and time in the deceleration stage:
[0132]
[0133] Let the key point ((t1+t2),V max ), and (t1+t2+t3,V end ) satisfies the second trigonometric function equation, and the equation of speed and time in the deceleration section is solved as follows:
[0134]
[0135] Among them, V (t) It represents the instantaneous speed at time t. A and B are the process parameters for establishing the trigonometric function equation.
[0136] Similarly, the key point ((t1+t2), V max ), and (t1+t2+t3,V end ) are the speed relationships between the key time points and the corresponding moments in the uniform deceleration segment. The equation obtained by making the second trigonometric function equation satisfy the above three key points can make the movement of the deceleration segment smoother.
[0137] S6. Differentiate and integrate the trigonometric equations of the velocity and time in the acceleration section, the trigonometric equations of the velocity and time in the deceleration section, and the equations of the velocity and time in the uniform speed section, respectively, to obtain the relationship between the position and time of each section, the relationship between acceleration and time, and the relationship between deceleration and time.
[0138] In step S6, the relationship between each segment position and time, the relationship between acceleration and time, and the relationship between deceleration and time include:
[0139] The relationship between the acceleration section position and time is obtained by integrating the equation of the acceleration section velocity and time:
[0140]
[0141] The relationship between acceleration and time in the acceleration phase is obtained by differentiating the equation between velocity and time in the acceleration phase:
[0142]
[0143] The relationship between the position and time of the uniform speed segment is obtained by integrating the equation of the uniform speed segment and time:
[0144] S (t) =S start +S1+V max ×(t-t1);(t1 <t<(t1+t2))
[0145] The relationship between the acceleration and time of the uniform speed segment is obtained by differentiating the equation of the uniform speed and time:
[0146] a (t) =0;(t1 <t<(t1+t2))
[0147] The relationship between the deceleration section position and time is obtained by integrating the equation of the deceleration section speed and time:
[0148]
[0149] The relationship between the deceleration and time in the uniform speed section is obtained by differentiating the equation between the speed and time in the deceleration section:
[0150]
[0151] Among them, S (t) represents the position at time t; a (t) Indicates the acceleration or deceleration at time t.
[0152] S7. Output the planned trajectory according to the relationship between the position and time of each segment, the relationship between acceleration and time, and the relationship between deceleration and time.
[0153] In one embodiment, the planned trajectory includes an acceleration segment, a constant speed segment, and a deceleration segment. The output planned trajectory is as follows: Figure 2 As shown, curve ① is the relationship curve between position and time, with the ordinate being position and the abscissa being time; curve ② is the relationship curve between acceleration and deceleration and time, with the ordinate being acceleration and deceleration and the abscissa being time; curve ③ is the relationship curve between speed and time, with the ordinate being speed and the abscissa being time.
[0154] In another embodiment, the planned trajectory includes an acceleration segment and a deceleration segment, and the output planned trajectory is as follows: Figure 3 As shown, curve ① is the relationship curve between position and time, with the ordinate being position and the abscissa being time; curve ② is the relationship curve between acceleration and deceleration and time, with the ordinate being acceleration and deceleration and the abscissa being time; curve ③ is the relationship curve between speed and time, with the ordinate being speed and the abscissa being time.
[0155] Figure 4 A schematic diagram showing a comparison between the planned trajectory generated according to the constant acceleration motion and the planned trajectory generated by the present disclosure is shown. Figure 4 It can be seen from points ①, ②, ③, and ④ that in general constant acceleration motion, there is a step mutation at the moment of conversion between uniform acceleration and uniform speed. However, the acceleration curve output by trajectory planning shows that the curve is smooth and continuous, without the step mutation phenomenon in conventional constant acceleration motion, thus avoiding system shock and jitter caused by acceleration mutation.
[0156] S8. Obtain real-time position feedback results, and use proportional integral control according to the planned trajectory and the real-time position feedback results to complete the tracking and positioning of the planned trajectory.
[0157] Specifically, Figure 5 As shown, step S8 includes:
[0158] Parameter setting: Use the position curve of the planned trajectory as the target position curve of the system operation and as the target parameter of positioning and tracking; obtain the real-time position feedback result and use it as the feedback parameter of positioning and tracking;
[0159] Deviation adjustment: Based on the target parameters and feedback parameters, proportional-integral control is used to obtain the deviation adjustment calculation results;
[0160] Output control: Convert the deviation adjustment calculation result into the opening control of the proportional servo valve to achieve trajectory tracking and positioning.
[0161] In one embodiment, the tracking and positioning effect is as follows: Figure 6 As shown: Curve ① is the trajectory curve of the planned position, which is used as the target curve; Curve ② is the trajectory curve of the feedback position.
[0162] In some embodiments, during the trajectory planning process, a speed iteration process may be added, that is, according to the set total movement time, the maximum movement speed parameter is automatically iterated and updated, so that the actual movement time gradually approaches the set total movement time. That is, step S9 is set. It should be noted that, usually, step S9 is executed before S8.
[0163] In step S9, the ratio of the actual movement time to the set total movement time is used as an iteration coefficient, and the set maximum speed is scaled by this coefficient. Specifically:
[0164]
[0165] Update the set maximum speed according to the above method, and return to step S1 after the update is completed, and recalculate t1, t2, and t3 until t1+t2+t3 is equal to t total If the difference meets the threshold requirement, the process goes to step S2, and the trajectory planning result obtained this time is used as the final output result.
[0166] In some embodiments, before performing pre-planning, a planning function enable determination may be added, that is, an enable determination may be performed before step S2. According to specific usage needs, an enable signal is given. When the enable signal is 1, the trajectory planning function flow is entered. If the enable signal is 0, the trajectory planning flow is not executed, and the process returns to step S1 until the enable signal is 1, and the trajectory planning function flow is entered.
[0167] Some embodiments of the present application provide a high-precision position planning and positioning control system.
[0168] The second embodiment of the present invention proposes a high-precision position planning and positioning control system, including: an acquisition module, a control module and an execution module.
[0169] like Figure 7 As shown, the acquisition module includes a displacement sensor and an analog input unit, which are used to collect the hydraulic pitch position in real time to form a real-time position feedback signal. In a specific embodiment, the displacement sensor converts the hydraulic pitch displacement into a 4-20mA current signal to form a real-time position feedback signal; the analog input unit is used to collect the 4-20mA current signal emitted by the displacement sensor and send it to the control module.
[0170] The control module is used to perform trajectory planning and positioning control using the high-precision position planning and positioning control method as described in any of the above embodiments, wherein the control module generates a control signal according to the planned trajectory and the real-time position feedback signal.
[0171] The execution module includes an analog output unit and a proportional servo valve, which are used to receive the control signal and control the movement speed of the hydraulic variable pitch according to the control signal. In a specific embodiment, the analog output unit converts the control module processing calculation result, that is, the control signal, into a 4-20mA current signal and outputs it to the proportional servo valve. The valve opening of the proportional servo valve is controlled by the control signal, thereby controlling the movement speed of the system.
[0172] In some embodiments, the parameter settings in the control module can be set through the human-machine interaction interface HMI, and the human-machine interaction interface HMI can also be used for data display, that is, to display the intermediate calculation amount and the final trajectory planning result.
[0173] In some embodiments, the control module includes a trajectory planning function block and a tracking and positioning function block. Figure 8 As shown, the trajectory planning function block includes: a parameter setting unit, an enable judgment unit, a pre-planning unit, a trajectory type judgment unit, a key point parameter calculation unit, a trigonometric function smoothing unit and a speed iteration unit.
[0174] The parameter setting unit is used to set the initial parameters according to the planning target, and then limit the key points of the trajectory; the enable judgment unit is used to judge whether to execute the trajectory planning process according to the enable signal; the pre-planning unit is used to calculate the total displacement of the uniform acceleration segment, the total time of the uniform acceleration segment, the total displacement of the uniform deceleration segment and the total time of the uniform deceleration segment according to the initial parameters according to the pre-set three-stage model: uniform acceleration segment, uniform speed segment and uniform deceleration segment; the trajectory type judgment unit is used to compare the sum of the total displacement of the uniform acceleration segment and the total displacement of the uniform deceleration segment with the set total displacement to determine whether the pre-planned trajectory contains a uniform speed segment; and recalculate the planned maximum speed that does not contain the uniform speed segment; determine the trajectory according to the initial position and the end position. The key point parameter calculation unit is used to recalculate the key parameters of each segment according to the maximum acceleration, maximum deceleration and planned maximum speed; the trigonometric function smoothing unit is used to smooth the uniform acceleration segment and the uniform deceleration segment according to the key parameters of each segment using trigonometric functions, thereby converting them into acceleration segments and deceleration segments; and the differential and integral algorithms are used to obtain the relationship between the position and time of each segment, the relationship between acceleration and time, and the relationship between deceleration and time, so as to form a planned trajectory; the speed iteration unit automatically iterates and updates the set maximum speed according to the set total time, so that the actual movement time gradually approaches the set total movement time.
[0175] The tracking and positioning function block includes: a parameter input unit, a deviation adjustment unit and a control output unit.
[0176] The parameter input unit is used to use the position curve of the planned trajectory as the target position curve of the system operation and as the target parameter of positioning tracking; and to obtain the real-time position feedback result and use it as the feedback parameter of positioning tracking; the deviation adjustment unit automatically calculates the deviation adjustment calculation result according to the target parameter and the feedback parameter; the control output unit generates the control signal according to the deviation adjustment calculation result.
[0177] In this specification, the schematic representations of the above terms do not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described can be combined in any one or more embodiments or examples in a suitable manner.
[0178] Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the protection scope of the present invention.
Claims
1. A high-precision position planning and positioning control method, It is characterized in that Applied to wind turbine pitch control, including: S1. According to the planning goal, the key points of the trajectory are defined by setting initial parameters, wherein the initial parameters include the initial position, the end position, the set maximum speed, the maximum acceleration, the maximum deceleration, the initial speed, the end speed and the total movement time; S2, dividing the pitch motion into a uniform acceleration section, a uniform speed section and a uniform deceleration section, and calculating the total displacement of the uniform acceleration section, the total time of the uniform acceleration section, the total displacement of the uniform deceleration section and the total time of the uniform deceleration section according to the initial parameters; S3, comparing the sum of the total displacement of the uniform acceleration segment and the total displacement of the uniform deceleration segment with the total displacement obtained according to the initial parameters, to determine whether the pre-planned trajectory includes a uniform speed segment; for a pre-planned trajectory that does not include a uniform speed segment, recalculate the planned maximum speed; for a pre-planned trajectory that includes a uniform speed segment, set the maximum speed as the planned maximum speed; S4. Recalculate the key parameters of each segment according to the maximum acceleration, the maximum deceleration and the planned maximum speed; the key parameters of each segment include: the total time of the uniform acceleration segment, the total displacement of the uniform acceleration segment, the total time of the uniform speed segment, the total displacement of the uniform speed segment, the total time of the uniform deceleration segment and the total displacement of the uniform deceleration segment; wherein, when the pre-planned trajectory does not include the uniform speed segment, it is not necessary to calculate the total time of the uniform speed segment and the total displacement of the uniform speed segment; S5, converting the uniform acceleration segment into the acceleration segment, and converting the uniform deceleration segment into the deceleration segment; wherein, according to the relationship between the speed and time in the uniform acceleration segment, a trigonometric function equation of the speed and time in the acceleration segment is established; according to the relationship between the speed and time in the uniform deceleration segment, a trigonometric function equation of the speed and time in the deceleration segment is established; and an equation of the speed and time in the uniform speed segment is established; S6. Differentiate and integrate the trigonometric equations of the speed and time in the acceleration section, the trigonometric equations of the speed and time in the deceleration section, and the equations of the speed and time in the uniform speed section, respectively, to obtain the relationship between the position and time of each section, the relationship between the acceleration and time, and the relationship between the deceleration and time; S7, outputting the planned trajectory according to the relationship between each position and time, the relationship between acceleration and time, and the relationship between deceleration and time; S8. Obtain real-time position feedback results, and use proportional integral control according to the planned trajectory and the real-time position feedback results to complete the tracking and positioning of the planned trajectory.
2. The high-precision position planning and positioning control method according to claim 1, It is characterized in that Step S2 includes: Among them, t 1 represents the total time of uniform acceleration; t 3 Indicates the total time of the uniform deceleration segment; S 1 represents the total displacement in the uniform acceleration section; S 3 Represents the total displacement in the uniform deceleration stage; V max0 Indicates setting the maximum speed; V start represents the initial velocity; V end Indicates the termination speed; a max Indicates the maximum acceleration; d max Indicates the maximum deceleration; In step S3, the method for determining whether the pre-planned trajectory includes a uniform speed segment includes: S 1 +S 3 end -S start When , it is determined that the pre-planned trajectory includes a uniform acceleration segment, a uniform speed segment, and a uniform deceleration segment; S 1 +S 3 ≥S end -S start When , it is determined that the pre-planned trajectory does not contain a uniform speed segment; Among them, S end Indicates the end position, S start Indicates the initial position; The method for recalculating the planned maximum speed for the pre-planned trajectory that does not include a uniform speed segment includes: Among them, V max Indicates the planned maximum speed, S total represents the total displacement obtained according to the initial parameters.
3. The high-precision position planning and positioning control method according to claim 2, It is characterized in that In step S4, the calculation method of the key parameters of each segment includes: S 2 =S end -S start -S 1 -S 3 Among them, S 2 represents the total displacement in the uniform speed section; t 2 Indicates the total time of the uniform speed segment.
4. The high-precision position planning and positioning control method according to claim 3, It is characterized in that Step S5 includes: Establish the first trigonometric equation of the acceleration speed and time: Make the key point (0, V start ), and (t 1 , V max ) satisfies the first trigonometric function equation, and the equation of the acceleration speed and time is obtained as follows: Establish the equation of speed and time for the uniform speed segment: V (t) =V max ;(t 1 <t<(t 1 +t 2 )) Establish the second trigonometric function equation of the speed and time in the deceleration stage: Make the key point ((t 1 +t 2 ), V max ), and (t 1 +t 2 +t 3 , V end ) satisfies the second trigonometric function equation, and the equation of speed and time in the deceleration section is solved as follows: Among them, V (t) It represents the instantaneous speed at time t. A and B are the process parameters for establishing the trigonometric function equation.
5. The high-precision position planning and positioning control method according to claim 4, It is characterized in that In step S6, the relationship between each segment position and time, the relationship between acceleration and time, and the relationship between deceleration and time include: The relationship between the acceleration section position and time: The relationship between acceleration and time in the acceleration section: The relationship between position and time in the uniform speed segment: S (t) =S start +S 1 +V max ×(t-t 1 );(t 1 <t<(t 1 +t 2 )) The relationship between acceleration and time in uniform speed segment: a (t) =0;(t 1 <t<(t 1 +t 2 )) The relationship between the deceleration section position and time: The relationship between deceleration and time in uniform speed segment: ((t 1 +t 2 )≤t≤(t 1 +t 2 +t 3 )) Among them, S(t) represents the position at time t; a(t) represents the acceleration or deceleration at time t.
6. The high-precision position planning and positioning control method according to claim 1, It is characterized in that Step S8 includes: The position curve of the planned trajectory is used as the target position curve of the system operation and as the target parameter of positioning and tracking; the real-time position feedback result is obtained and used as the feedback parameter of positioning and tracking; According to the target parameters and feedback parameters, proportional integral control is used to obtain the deviation adjustment calculation results; The deviation adjustment calculation result is converted into the opening control of the proportional servo valve to achieve trajectory tracking and positioning.
7. The high-precision position planning and positioning control method according to claim 1, It is characterized in that Also includes: S9, according to the set total exercise time, automatically iteratively update the set maximum speed, so that the actual exercise time gradually approaches the set total exercise time; The ratio of the actual movement time to the set total movement time is used as an iteration coefficient, and the set maximum speed is scaled by this coefficient.
8. A high-precision position planning and positioning control system, It is characterized in that include: The acquisition module is used to collect the hydraulic pitch position in real time and form a real-time position feedback signal; A control module, used for performing trajectory planning and positioning control using the high-precision position planning and positioning control method according to any one of claims 1 to 7, wherein the control module generates a control signal according to the planned trajectory and the real-time position feedback signal; The execution module receives the control signal and controls the movement speed of the hydraulic variable pitch according to the control signal.
9. The high-precision position planning and positioning control system according to claim 8, It is characterized in that The control module includes a trajectory planning function block; the trajectory planning function block includes: A parameter setting unit is used to set initial parameters according to the planning objectives, thereby defining key points of the trajectory; An enabling judgment unit, used to judge whether to execute the trajectory planning process according to an enabling signal; A pre-planning unit is used to calculate the total displacement of the uniform acceleration segment, the total time of the uniform acceleration segment, the total displacement of the uniform deceleration segment and the total time of the uniform deceleration segment according to the initial parameters according to a pre-set three-segment model: a uniform acceleration segment, a uniform speed segment and a uniform deceleration segment; The trajectory type judgment unit is used to compare the sum of the total displacement of the uniform acceleration segment and the total displacement of the uniform deceleration segment with the set total displacement to determine whether the pre-planned trajectory contains a uniform speed segment; and recalculate the planned maximum speed that does not contain the uniform speed segment; determine the trajectory movement direction according to the initial position and the end position, and recalibrate the planned maximum speed, acceleration and deceleration; The key point parameter calculation unit recalculates the key parameters of each section according to the maximum acceleration, maximum deceleration and planned maximum speed; The trigonometric function smoothing unit uses trigonometric functions to smooth the uniform acceleration and deceleration segments according to the key parameters of each segment, thereby converting them into acceleration and deceleration segments; and uses differential and integral algorithms to obtain the relationship between the position and time of each segment, the relationship between acceleration and time, and the relationship between deceleration and time, to form a planned trajectory; The speed iteration unit automatically iterates and updates the set maximum speed according to the set total time, so that the actual movement time gradually approaches the set total movement time.
10. The high-precision position planning and positioning control system according to claim 9, It is characterized in that The control module also includes a tracking and positioning function block; The tracking and positioning functional block includes: A parameter input unit is used to use the position curve of the planned trajectory as the target position curve of the system operation and as the target parameter of the positioning and tracking; and to obtain the real-time position feedback result and use it as the feedback parameter of the positioning and tracking; A deviation adjustment unit automatically calculates deviation adjustment calculation results according to target parameters and feedback parameters; The control output unit generates the control signal according to the deviation adjustment calculation result.
Citation Information
Cited By
Adaptive control system for acceleration of magnetic suspension rotor
CN119292044A
Method, device and system for controlling brush motor
CN121395992A
