Vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation

Through the fuzzy feedforward path tracking control method of hydraulic steering leakage compensation, the steering inconsistency caused by leakage in all hydraulic steering vehicles is solved, and the path tracking accuracy and robustness are achieved, ensuring efficient path tracking of smart vehicles.

WO2024244892A1PCT designated stage expired Publication Date: 2024-12-05ANHUI HELI CO LTD
View PDF 5 Cites 0 Cited by

Patent Information

Application Number
PCT/CN2024/091018
Authority / Receiving Office
WO · WO
Patent Type
Applications
Current Assignee / Owner
Priority Date
2023-05-31
Filing Date
2024-04-30
Publication Date
2024-12-05

AI Technical Summary

Technical Problem

Traditional full hydraulic steering vehicles leak due to manufacturing or installation errors and wear of hydraulic steering pumps, resulting in inconsistent rotation angles between the steering wheel and the steering wheel, affecting the accuracy and robustness of the intelligent vehicle path tracking.

Method used

The fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation is adopted. By obtaining the steering wheel angle, wheel angle and piston rod displacement parameters, the transmission ratio and actual rotation angle error of the hydraulic steering system are determined, and the fuzzy sliding mode controller is used to calculate the feedforward leakage compensation. Parameters, control the compensation solenoid valve for leakage compensation to ensure path tracking accuracy.

Benefits of technology

It effectively improves the accuracy of intelligent vehicle path tracking, performs leakage compensation in advance, avoids system tracking errors, and enhances the robustness and accuracy of path tracking.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN2024091018_05122024_PF_FP_ABST
    Figure CN2024091018_05122024_PF_FP_ABST
Patent Text Reader

Abstract

A vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation, comprising: acquiring a steering wheel rotation angle, a wheel rotation angle, and a piston rod displacement parameter; outputting desired wheel rotation angles and desired steering wheel rotation angles in different periods according to a path tracking algorithm; obtaining a feedforward leakage compensation parameter by means of fuzzy control; constructing a fuzzy control system; performing defuzzification on the fuzzy control system by using the center-of-gravity method to obtain a fuzzy sliding mode controller, performing comparison and analysis on an actual rear wheel angular rotation amount by using the fuzzy sliding mode controller, and controlling a compensation solenoid valve to perform liquid supplementing work in each path tracking period; and repeating the steps above to perform the calculation of the next period of the path tracking algorithm to complete the whole path tracking process. According to the present invention, feedforward compensation parameters can be accurately determined, thereby controlling the duty ratio of the compensation solenoid valve to compensate for leaked oil accurately and in a timely manner, and improving the precision of path tracking of intelligent vehicles.
Need to check novelty before this filing date? Find Prior Art

Description

A fuzzy feedforward path tracking control method for vehicles based on hydraulic steering leakage compensation Technical Field

[0001] The present invention belongs to the field of path tracking control of hydraulic steering vehicles, and in particular relates to a vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation. Background Art

[0002] With the advancement of technology, the application of fully hydraulic synchronous steering in construction machinery, agricultural machinery, and military vehicles is expanding, and the application environments are becoming more complex and diverse. Furthermore, the current trend of comprehensive intelligentization has established a trend of intelligent development in various types of vehicles using fully hydraulic steering. As a result, the requirements for fully hydraulic synchronous steering vehicles have shifted from functional requirements to requirements for efficiency, safety, and precision, and the requirements for steering control capabilities have also increased accordingly.

[0003] Traditional fully hydraulic steering vehicles can experience hydraulic pump "loss of precision" due to factors such as manufacturing or installation errors and wear during use. This means the pump cannot deliver fluid at the intended rate, resulting in a mismatch between the steering wheel angle and the steering wheel angle. For example, in a typical hydraulic steering system, even when the steering wheel's steering angle is at its maximum, leakage can still cause the steering wheel to slide slightly to the side. When the vehicle returns to a straight line, the steering wheel angle deflects relative to the previous straight line, making it impossible to synchronize steering wheel and wheel rotation. This leakage in the steering actuator can cause system tracking errors, impacting the path tracking accuracy and robustness of intelligent vehicles.

[0004] Given the widespread use of fully hydraulic steering systems in vehicles, steering accuracy during path tracking is undoubtedly a key concern in intelligent vehicle research for applications such as engineering, military, and agricultural vehicles equipped with fully hydraulic steering systems. The decisive factors influencing path tracking accuracy are the system's steering precision and reliability. Therefore, improving the path tracking accuracy of these intelligent vehicles requires prioritizing research on steering accuracy and reliability.

[0005] Summary of the Invention

[0006] In order to avoid the shortcomings of the above-mentioned prior art, the present invention proposes a vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation to solve the problem of poor tracking accuracy caused by steering system leakage during the path tracking process of intelligent vehicles using hydraulic steering.

[0007] The present invention adopts the following technical solutions to solve the technical problems:

[0008] A vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation comprises the following steps:

[0009] Step 1: Obtain steering wheel angle, wheel angle and piston rod displacement parameters;

[0010] Step 2: Determine the vehicle's hydraulic steering system transmission ratio K v , the path tracking algorithm outputs the desired wheel angle β in different cycles, and obtains the desired steering wheel angle θ=βK v , inputting the desired steering wheel angle to a vehicle hydraulic steering system to perform a path tracking steering operation;

[0011] Step 3: Determine the steering load force F and the actual steering angle error e(θ), and obtain the feedforward leakage compensation parameter K through fuzzy control. C ;

[0012] Step 4: Using the load force and the actual rotation angle error as inputs of a fuzzy rule, controlling the feedforward leakage compensation parameter as the output of the fuzzy rule, and constructing a fuzzy control system;

[0013] Step 5: Defuzzifying the fuzzy control system using the center of gravity method to obtain a fuzzy sliding mode controller, and using the fuzzy sliding mode controller to compare and analyze the actual detected rear wheel steering angle, and control the compensation solenoid valve to perform fluid replenishment, so that the actual steering angle error of the steering system within the path tracking period is within a reasonable range;

[0014] Step 6: The compensation solenoid valve performs fluid replenishment for each path tracking cycle, and the vehicle hydraulic steering system performs a path tracking steering operation;

[0015] Step 7: Repeat steps 1-6 above to perform calculations for the next cycle of the path tracking algorithm to complete the entire path tracking process.

[0016] In a further solution, the steering wheel angle parameter in step 1 is detected using a steering wheel angle sensor installed on the steering column of the forklift steering wheel; the wheel angle parameter is detected using a wheel angle sensor installed at the rear wheel of the forklift steering wheel; and the piston rod displacement parameter is detected using a displacement sensor installed at the steering piston rod.

[0017] Further solution, the transmission ratio K of the hydraulic steering system in step 2 v It is determined by the characteristics of the vehicle's specific steering system. For example, the steering system transmission ratio K of a 3-ton smart forklift v =11.

[0018] In a further solution, the actual steering angle error e(θ) in step 3 is the steering deviation value, and the difference between the corresponding steering wheel angle value and the actual steering wheel angle value is the steering deviation value. The actual steering wheel angle value is the steering wheel angle value collected by the steering wheel angle sensor, and the corresponding steering wheel angle value is the actual wheel angle value collected by the wheel angle sensor converted by the transmission ratio of the hydraulic steering system.

[0019] In a further solution, the formulation of the fuzzy rules in step 4 includes:

[0020] The feedforward leakage compensation parameter and the load force have the same overall change pattern. The larger the load force, the larger the feedforward leakage compensation parameter.

[0021] When the actual steering angle error is positive, the feedforward leakage compensation parameter should increase as the absolute value of the actual steering angle error increases; when the actual steering angle error is negative, the feedforward leakage compensation parameter should decrease as the absolute value of the actual steering angle error increases.

[0022] The load force and the actual rotation angle error range cover more than 95% of the probability. If the range exceeds the extreme value (including the maximum value or the minimum value), the maximum area of ​​the corresponding language variable is taken.

[0023] The steps of constructing the fuzzy control system include:

[0024] Step 41: Formulate the fuzzy rules and determine the relationship between the load force, the actual rotation angle error and the feedforward leakage compensation parameter;

[0025] Step 42: Determine the expression form of the fuzzy rule, divide the input fuzzy subset and the output fuzzy subset into regions, and establish the membership functions of the input and output systems to obtain a fuzzy control system.

[0026] In a further solution, the input fuzzy subset and the output fuzzy subset are divided into regions including a negative large region, a negative medium region, a negative small region, a zero region, a positive small region, a positive medium region and a positive large region in step 42 .

[0027] In a further solution, the load force F in step 3 is measured by an observer.

[0028] In a further solution, the load force F is measured by an observer, which is obtained by tracking the displacement of the piston rod and then combining the steering cylinder flow equation and the dynamic equation of the hydraulic steering system to predict the load force in real time. The steering cylinder flow equation of the hydraulic steering system is:

[0029] The dynamic equation of the steering cylinder of the hydraulic steering gear is:

[0030] In the above formula: P7 steering cylinder load pressure, A p Steering cylinder working cross-sectional area, V t Cylinder capacity, m p Equivalent mass of piston and piston rod, E Oil bulk elastic modulus, R p is the piston viscous damping coefficient, F is the load force, and y is the actual displacement of the piston rod. ; C t is the oil leakage coefficient, dt is the integral of time;

[0031] According to the analysis of formula (1) and (2), the load force observation state variable is selected:

[0032] The state equation of the hydraulic steering system model is:

[0033] in:

[0034] k ql Flow gain, k c1 is the system flow-pressure coefficient, C t is the oil leakage coefficient, u is the steering wheel angle input by the system;

[0035] The observer state equation used is as follows:

[0036] Where: e is the error between the true state variable of the system and the state estimated by the observer, H is the coefficient of the observer, also called the observation matrix, H = [H1 H2 H3 H4] T ;

[0037] Assume that the expected positions of the load force observation system poles are p1, p2, p3, p4, and the values ​​of the parameters H1, H2, H3, H4 should satisfy: (s-p1)(s-p2)(s-p3)(s-p4)=0 (7)

[0038] The coefficients of the polynomials about s are equal, so find the values ​​of the parameters: H1 = c1-p1-p2-p3-p4+c4 H2 = H1·c1+H1·c4+p1·p2+c2·c3+p4·(p1+p2+p3)+p3·(p1+p2) H3 = {H2·c4-H4·c3-p4·[p1·p2+p3·(p1+p2)]+H1·c2·c3-p1·p2·p3} / c2 H4 = -p1·p2·p3·p4 / (c3·c4) (8).

[0039] The present invention uses the wheel angle value collected by the wheel angle sensor and then converts it into the corresponding steering wheel angle parameter through the transmission ratio conversion of the hydraulic steering system. The difference between this value and the actual steering wheel angle value is then calculated to obtain the actual angle error. Finally, this value, along with the load force observation value, is written into a fuzzy sliding mode controller, which then calculates the feedforward leakage compensation parameter. If the feedforward leakage compensation parameter is zero, the compensation solenoid valve is closed. If it is not zero, the compensation solenoid valve is opened and the corresponding duty cycle of the compensation solenoid valve is adjusted to achieve feedforward compensation of leaked oil during path tracking, thereby improving path tracking accuracy. The steering cylinder outputs the corresponding hydraulic oil to supply the steering mechanism.

[0040] Compared with the existing technology, the beneficial effects of the present invention are embodied in:

[0041] 1. The present invention uses a feedforward combined with a fuzzy sliding mode controller to compensate for leakage in the hydraulic steering system in advance. The compensation adjustment action can be performed in advance before the leakage disturbance occurs, without affecting the path tracking process of the next cycle, thereby improving the accuracy of intelligent vehicle path tracking.

[0042] 2. The fuzzy control proposed in the present invention takes the steering load force and the actual steering angle error as inputs, and can accurately determine the parameters of the feedforward compensation, thereby controlling the duty cycle of the compensation solenoid valve to accurately and timely compensate for the leaked oil.

[0043] 3. The present invention proposes that the load force is measured by an observer. The observer can convert the load force, which is time-varying and difficult to observe directly during the steering process, through a state equation and observe the piston displacement to make a real-time prediction of the load force. BRIEF DESCRIPTION OF THE DRAWINGS

[0044] FIG1 is a flow chart of a path tracking process based on hydraulic steering leakage compensation according to the present invention;

[0045] FIG2 is a schematic diagram of the oil compensation principle of the present invention;

[0046] FIG3 is a schematic diagram of the input and output of the fuzzy controller of the present invention;

[0047] FIG4 is a diagram of the membership function of the input and output systems of the present invention;

[0048] FIG5( a ) is a comparison diagram of the path tracking of the present invention;

[0049] FIG5( b ) is a comparison diagram of the path tracking error of the present invention. DETAILED DESCRIPTION

[0050] The following will clearly and completely describe the technical solutions in the embodiments of the present invention in conjunction with the accompanying drawings. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without making creative efforts are within the scope of protection of the present invention.

[0051] Example 1:

[0052] In this embodiment, a vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation is applied to an intelligent vehicle equipped with an actuator. The actuator includes a hydraulic active steering actuator, which includes a compensation solenoid valve. The solenoid valve is connected to the oil inlet of the oil cylinder, and the ends of the oil cylinder are respectively connected to the vehicle body and the steering axle. The control method is carried out according to the following steps:

[0053] Step 1: Install a steering wheel angle sensor on the steering column of the forklift to obtain steering wheel angle parameters;

[0054] A wheel angle sensor is installed at the forklift's steering wheel (rear wheel) to obtain wheel angle parameters;

[0055] A displacement sensor is installed at the steering piston rod to obtain the piston rod displacement parameter y;

[0056] Step 2: Determine the transmission ratio K of the hydraulic steering system v , where the transmission ratio of the hydraulic steering system is K v It is determined by the characteristics of the vehicle's specific steering system. The steering system transmission ratio used by each vehicle model will be different. The path tracking algorithm outputs the expected wheel angle β in different cycles and converts the expected wheel angle into the gear ratio K of the hydraulic steering system. v Converted to the desired steering wheel angle θ = β □ K v Input is given to the forklift’s hydraulic steering system to perform path-following steering operations;

[0057] Step 3: Determine the steering load force F and the actual steering angle error e(θ). Through fuzzy control, establish the load force F and the actual steering angle error e(θ) together with the feedforward leakage compensation parameter K. C The ambiguous relationship between

[0058] Step 31: The actual steering angle error value is determined by the following method: the actual steering angle value β is collected by the wheel steering angle sensor. a , the corresponding steering wheel angle value θ is obtained by converting the system transmission ratio a , the steering wheel angle sensor collects the actual steering wheel angle value θ b , the difference between the corresponding steering wheel angle value and the actual steering wheel angle value is the steering deviation value, that is, e(θ)=θ b -θ a .

[0059] Step 32: The specific steering load force F is determined by an observer. The observer observation steps are as follows:

[0060] The observer tracks and measures the piston rod displacement, which is easy to measure, and then combines the steering system cylinder flow equation and dynamic equation to predict the load force, which is difficult to measure, in real time.

[0061] The steering cylinder flow equation of the hydraulic steering gear is:

[0062] The dynamic equation of the steering cylinder is:

[0063] Where: P7 steering cylinder load pressure, k ql Flow gain, d Steering gear valve core diameter, A p Steering cylinder working cross-sectional area, D m Hydraulic motor theoretical displacement, V t Cylinder capacity, m p Equivalent mass of piston and piston rod, E Oil bulk elastic modulus, R p is the viscous damping coefficient of the piston, F is the load force, and y is the actual displacement of the piston rod.

[0064] According to the analysis of formula (1) and (2), the load force observation state variable is selected:

[0065] The hydraulic steering system model is the state equation:

[0066] in:

[0067] The observer state equation used is as follows:

[0068] Where: e is the error between the true state variable of the system and the state estimated by the observer, u is the system input (steering wheel angle), and H is the coefficient of the observer, also called the observation matrix. H=[H1 H2 H3 H4] T .

[0069] The determination of the measurement matrix determines whether the system state estimation error under Lumberg observation can be reduced to zero, allowing the system to approach a stable state. Matrices A and B are both determined by the system characteristics. Therefore, a necessary condition for the system to be asymptotically stable is that the characteristic roots of the measurement matrix H (the poles of the system) all fall on the left half of the complex plane. Therefore, the parameter H = [H1 H2 H3 H4] T The value of must ensure that all the characteristic roots of the observation matrix H fall on the left half of the complex plane and their real parts are sufficiently negative.

[0070] Assume that the expected positions of the load force observation system poles are p1, p2, p3, p4, and the values ​​of the parameters H1, H2, H3, H4 should satisfy: (s-p1)(s-p2)(s-p3)(s-p4)=0 (7)

[0071] The coefficients of the polynomial about s are equal to find the value of the parameter:

[0072] Step 4: Use the load force F and the actual angle error e(θ) as the input of the fuzzy rule to control the feedforward leakage compensation parameter K c For the output of fuzzy rules, a fuzzy control system is constructed. The input and output diagram of the specific fuzzy logic controller is shown in Figure 3. The steps of constructing a fuzzy control system include:

[0073] Step 41: formulate fuzzy rules and determine the relationship between the input load force of the fuzzy rules, the actual angle error and the feedforward leakage compensation parameter. In this manual, the relationship is Ψ(K C )=fuzzy(F,e(θ));

[0074] Step 42: Determine the expression form of the fuzzy rule, which is: Rule:IF"F"is"u i "AND"e(θ)"is"u j "THEN"Ψ"is

[0075] The specific rules are as follows:

[0076] The feedforward leakage compensation parameter has the same overall change pattern as the load force. The larger the load force, the larger the feedforward leakage compensation parameter will be.

[0077] When the actual steering angle error is positive, the feedforward leakage compensation parameter should increase as the absolute value of the steering angle error increases; when the actual steering angle error is negative, the feedforward leakage compensation parameter should decrease as the absolute value of the steering angle error increases;

[0078] The load force magnitude and the rotation angle error range cover more than 95% of the probability. If there is a situation where the range extremes (including the maximum value or the minimum value) are exceeded, the maximum area of ​​the corresponding language variable is taken.

[0079] The input and output fuzzy subsets are divided into regions: large negative region, medium negative region, small negative region, zero region, small positive region, medium positive region, and large positive region. This allows fuzzy control to have a wider range of options and be more precise. The membership function of the input and output system is established, and the membership function is shown in Figure 4.

[0080] Step 5: Defuzzify the fuzzy control system using the center of gravity method to obtain a fuzzy sliding mode controller. This controller controls the compensation solenoid valve to replenish fluid, ensuring that the actual steering angle error of the steering system remains within a reasonable range during the path tracking cycle. The specific compensation principle is shown in Figure 2. During the path tracking process, the steering leakage compensation control is performed by first converting the wheel angle value collected by the wheel angle sensor using a fixed steering ratio and calculating it with the steering wheel angle value to obtain the actual steering angle error. This value, along with the load force observation, is then written into the fuzzy sliding mode controller. The fuzzy sliding mode controller then calculates the feedforward leakage compensation parameter. If the feedforward leakage compensation parameter is zero, the compensation solenoid valve is closed. If it is not zero, the compensation solenoid valve is opened, and the corresponding duty cycle of the compensation solenoid valve is adjusted to achieve feedforward compensation of the leakage fluid during the path tracking process, thereby improving path tracking accuracy. The steering cylinder outputs the corresponding hydraulic oil to supply the steering mechanism.

[0081] The expression of the fuzzy sliding mode controller is: in The value of is determined by the above fuzzy rules.

[0082] Step 6: After the compensation solenoid valve replenishes the fluid, the leakage of the vehicle hydraulic steering system during the path tracking cycle will be compensated. After the vehicle hydraulic steering system performs the path tracking steering operation, the vehicle kinematics, position parameters and other information will be used as input into the calculation of the next cycle of the path tracking algorithm to form a closed loop, completing the entire path tracking process. The specific closed-loop tracking process is shown in Figure 1.

[0083] Example 2:

[0084] The fuzzy feedforward path tracking control method for a forklift with hydraulic steering leakage compensation of the present invention is applied to a certain type of 3-ton intelligent forklift. The parameters of the hydraulic steering system of the intelligent forklift are as follows:

[0085] Table Hydraulic Steering System Parameters

[0086] The process of oil leakage compensation during forklift path tracking is as follows:

[0087] Step 1: In a certain path tracking cycle, the expected wheel angle is calculated as β = 22° according to the path tracking algorithm, and the steering system transmission ratio K v =11, the desired steering wheel angle parameter θ = 242° is obtained.

[0088] Step 2: Collect the actual wheel angle value β a =23°, according to the steering system transmission ratio K v =11, the corresponding steering wheel angle parameter θ is converted a =253°, actual collected steering wheel angle θ b =θ=242°, so the actual rotation angle error e(θ)=11°.

[0089] Step 3: The real-time load force F=2320N is collected through the observer;

[0090] Step 4: Obtain the feedforward leakage compensation parameter K at this time through fuzzy control calculation C =0.33;

[0091] Step 5: Construct a fuzzy control system based on the load force, the actual rotation angle error, and the feedforward leakage compensation parameter;

[0092] Step 6: Open the compensation solenoid valve and use a fuzzy sliding mode controller to control the opening of the compensation solenoid valve according to the actual rear wheel steering angle. For example, the fuzzy sliding mode controller outputs a PWM control signal with a duty cycle of 33% to the oil compensation solenoid valve for replenishing fluid.

[0093] Step 7. Repeat the above steps in each cycle to perform closed-loop path tracking control. The comparison diagram of path tracking with leakage compensation and path tracking without leakage compensation and the tracking error comparison diagram are shown in Figures 5(a) and (b). It can be seen from the figure that the fuzzy feedforward path tracking control algorithm for forklifts based on hydraulic steering leakage compensation proposed by the present invention has a very good tracking effect, and the peak value of the tracking error can be lower than 0.25m. In contrast, if the path tracking effect is not performed without leakage compensation of the full hydraulic steering system, it will be very poor. Due to leakage, the wheel angle under steering conditions cannot fully respond to the expected steering wheel angle and is always in an understeering state. Therefore, the error of the entire path tracking process cannot be compensated. The peak value of the tracking error reaches 2.385m, which is far away from the reference path.

[0094] In summary, the forklift fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation of the present invention can effectively compensate for the leakage of the hydraulic steering system during the path tracking process of the intelligent forklift, thereby improving the path tracking accuracy of the intelligent forklift.

[0095] Although this specification is described according to implementation methods, not every implementation method contains only one independent technical solution. This narrative method of the specification is only for the sake of clarity. Those skilled in the art should regard the specification as a whole. The technical solutions in each embodiment can also be appropriately combined to form other implementation methods that can be understood by those skilled in the art.

[0096] Therefore, the above description is only a preferred embodiment of the present application and is not intended to limit the scope of implementation of the present application; that is, all equivalent modifications made according to the scope of the claims of the present application are within the scope of protection of the claims of the present application.

Claims

1. A vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation, Features: The steps include: Step 1, obtaining steering wheel angle, wheel angle and piston rod displacement parameters; Step 2: Determine the vehicle's hydraulic steering system transmission ratio K v , the path tracking algorithm outputs the desired wheel angle β in different cycles, and obtains the desired steering wheel angle θ=βK v , inputting the desired steering wheel angle to a vehicle hydraulic steering system to perform a path tracking steering operation; Step 3: Determine the steering load force F and the actual steering angle error e(θ), and obtain the feedforward leakage compensation parameter K through fuzzy control C ; Step 4: taking the load force and the actual rotation angle error as inputs of fuzzy rules, controlling the feedforward leakage compensation parameter as output of the fuzzy rules, and constructing a fuzzy control system; Step 5: Defuzzify the fuzzy control system using the center of gravity method to obtain a fuzzy sliding mode controller, and use the fuzzy sliding mode controller to compare and analyze the rear wheel steering angle parameters, control the compensation solenoid valve to perform fluid replenishment, so that the actual steering angle error of the steering system within the path tracking period is within a reasonable range; Step 6, the compensation solenoid valve performs fluid replenishment for each path tracking cycle, and the vehicle hydraulic steering system performs a path tracking steering operation; Step 7: Repeat the above steps 1-6 to perform the calculation of the next cycle of the path tracking algorithm to complete the entire path tracking process.

2. A vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation according to claim 1, Features: In step 1, the steering wheel angle parameter is detected by a steering wheel angle sensor installed on the steering column of the forklift steering wheel; the wheel angle parameter is detected by a wheel angle sensor installed at the rear wheel of the forklift steering wheel; and the piston rod displacement parameter is detected by a displacement sensor installed at the steering piston rod.

3. A vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation according to claim 1, Features: The transmission ratio K of the hydraulic steering system described in step 2 v It is determined by the characteristics of the vehicle's specific steering system.

4. A vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation according to claim 1, It is characterized in that The load force F in step 3 is measured by an observer.

5. A vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation according to claim 1, It is characterized in that The actual steering angle error e(θ) in step 3 is the steering deviation value, where the difference between the corresponding steering wheel angle value and the actual steering wheel angle value is the steering deviation value, the actual steering wheel angle value is the steering wheel angle value collected by the steering wheel angle sensor, and the corresponding steering wheel angle value is the actual wheel angle value collected by the wheel angle sensor converted through the transmission ratio of the hydraulic steering system.

6. A vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation according to claim 1, It is characterized in that The formulation of fuzzy rules described in step 4 includes: The feedforward leakage compensation parameter is consistent with the overall change rule of the load force. The larger the load force, the larger the feedforward leakage compensation parameter will be synchronously. When the actual steering angle error is a positive value, the feedforward leakage compensation parameter should increase as the absolute value of the actual steering angle error increases; when the actual steering angle error is a negative value, the feedforward leakage compensation parameter should decrease as the absolute value of the actual steering angle error increases.

7. A vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation according to claim 1, Features: The steps of constructing the fuzzy control system described in step 4 include: Step 41, formulating the fuzzy rules, and determining the relationship between the load force, the actual rotation angle error and the feedforward leakage compensation parameter; Step 42, determine the expression form of the fuzzy rule, divide the input fuzzy subset and the output fuzzy subset into regions, and establish the membership functions of the input and output systems to obtain the fuzzy control system.

8. A vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation according to claim 7, Features: The region division of the input fuzzy subset and the output fuzzy subset described in step 42 includes a negative large region, a negative middle region, a negative small region, a zero region, a positive small region, a positive middle region and a positive large region.

9. A vehicle fuzzy feedforward path tracking control method based on hydraulic steering leakage compensation according to claim 4, Features: The load force F is measured by an observer, which is measured by tracking the displacement of the piston rod, and then combined with the steering cylinder flow equation and the dynamic equation in the hydraulic steering system to predict the load force in real time, where the steering cylinder flow equation of the hydraulic steering gear is: The dynamic equation of the steering cylinder of the hydraulic steering gear is: In the above formula: P 7 Steering cylinder load pressure, A p Steering cylinder working cross-sectional area, V t Cylinder capacity, m p live Equivalent mass of the plug and piston rod, E Bulk elastic modulus of the oil, R p is the piston viscous damping coefficient, F is the load force, and y is the actual displacement of the piston rod. ; C t is the oil leakage coefficient, dt is the integral of time; According to formula (1) and (2), the load force observation state variable is selected: The state equation of the hydraulic steering system model is: in: k ql Flow gain, k c1 is the system flow-pressure coefficient, C t is the oil leakage coefficient, u is the steering wheel angle input by the system; The observer state equation used is as follows: Where: e is the error between the real state variable of the system and the estimated state of the observer, H is the coefficient of the observer, also called the observation matrix, H = [H 1 H 2 H 3 H 4 ] T ; Assume that the expected position of the load force observation system pole is p 1 ,p 2 ,p 3 ,p 4 , parameter H 1 ,H 2 ,H 3 ,H 4 The value of should satisfy: (s-p 1 )(s-p 2 )(s-p 3 )(s-p 4 )=0 (7) The coefficients of the polynomial about s are equal to find the value of the parameter: H 1 =c 1 -p 1 -p 2 -p 3 -p 4 +c 4 H 2 =H 1 ·c 1 +H 1 ·c 4 +p 1 ·p 2 +c 2 ·c 3 +p 4 ·(p 1 +p 2 +p 3 )+p 3 ·(p 1 +p 2 ) H 3 ={H 2 ·c 4 -H 4 ·c 3 -p 4 ·[p 1 ·p 2 +p 3 ·(p 1 +p 2 )]+H 1 ·c 2 ·c 3 -p 1 ·p 2 ·p 3 } / c 2 H 4 =-p 1 ·p 2 ·p 3 ·p 4 / (c 3 ·c 4 ) (8)。

Citation Information

Patent Citations

  • High-precision forklift hydraulic steering system and control method thereof

    CN102806941A

  • Accurate steering control method for heavy-load AGV

    CN115230805A

  • Steering control system and method of full-hydraulic steering system of unmanned vehicle and vehicle

    CN115636011A

  • Vehicle fuzzy feed-forward path tracking control method based on hydraulic steering leakage compensation

    CN116834829A

  • Fuzzy steering controller

    US6442463B1