Vehicle stability monitoring method and vehicle stability control method for slope operation

By predicting the projection distance of the centroid and the joint coordinates and adjusting the control model of the support mechanism, the response lag problem in the monitoring and control of the stability of the vehicle body in the slope operation is solved, the adjustment speed and accuracy are improved, and the stability of the vehicle body during the slope operation is ensured. sex.

CN118752963BActive Publication Date: 2024-11-19STATE GRID JIANGXI ELECTRIC POWER CO LTD +1
View PDF 8 Cites 0 Cited by

Patent Information

Application Number
CN202411253222.4
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-09-09
Publication Date
2024-11-19
Estimated Expiration
2044-09-09

AI Technical Summary

Technical Problem

In the prior art, when operating in slope, the vehicle body stability monitoring and control have problems such as lag and slow adjustment speed. It is especially suitable for working equipment with adjustable support mechanisms, and it is difficult to quickly feedback and adjust.

Method used

By predicting the horizontal projection distance of the center of mass coordinates and the combined force coordinates, the stability of the current and next sampling moments is judged, the control model of the support mechanism is adjusted, the moment balance model is used to calculate the combined force coordinates, and different adjustment strategies are adopted according to different control requests.

Benefits of technology

It improves the adjustment speed and accuracy of the vehicle body at different sampling moments, ensures the stability of the vehicle body during slope operation, and reduces response lag.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118752963B_ABST
    Figure CN118752963B_ABST
Patent Text Reader

Abstract

The present invention discloses a vehicle body stability monitoring method and a vehicle body stability control method for slope operation, and belongs to the field of vehicle control technology. The present invention reflects whether the vehicle body needs to be adjusted at the current sampling moment by judging whether the horizontal projection distance between the center of mass coordinates and the first resultant force coordinates is greater than a preset value. By judging whether the horizontal projection distance between the center of mass coordinates and the second resultant force coordinates is greater than a preset value, it is predicted whether the vehicle body needs to be adjusted at the next sampling moment. The present invention calculates the first resultant force coordinates and the second resultant force coordinates of the vehicle body through a torque balance model. Furthermore, the present invention adopts different adjustment strategies according to different control requests to improve the adjustment speed and adjustment accuracy at different sampling moments.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of vehicle control, and in particular to a vehicle body stability monitoring method and a vehicle body stability control method for slope operation. Background Art

[0002] When vehicles and other equipment are operating on a slope, they move along the slope through more than three groups of support mechanisms. In order to ensure the safety of the operation, the stability of the vehicle body must be constantly monitored. If the stability of the vehicle body does not meet the requirements, adjust the length of the support mechanism such as the legs to change the center of mass coordinates of the vehicle body. The Chinese patent application with publication number CN111695215A discloses a method for establishing a zero-turn radius lawn mower ramp rollover prediction model. The method geometrically projects and solves the spatial force on the lawn mower, adds the influencing factors under different working conditions of the mower, and obtains the corresponding vehicle rollover prediction expression. The assignment operation is performed based on MATLAB to predict and analyze the rollover process of the lawn mower. The method can obtain the slope mechanical characteristics of the lawn mower, but its working condition input depends on manual settings and is not suitable for operating equipment with adjustable support mechanisms such as wheels. In operating equipment with adjustable support mechanisms, the elongation of the support mechanism varies with the actual working conditions. Another example is a Chinese patent application with publication number CN114954724A, which discloses a motion control method and system for a quadruped single-arm working robot. This method incorporates the plantar force of the supporting leg and the desired control amount into the prediction parameters, and can achieve stability prediction of an adjustable supporting mechanism. Compared with quadruped robots, the speed of slope working vehicles is lower, and the speed and acceleration components can be ignored when predicting stability, reducing model parameters. The existing quadruped robots have a small mass and a fast system response speed, and the stability prediction model can achieve fast feedback adjustment based on current data. However, the adjustment of slope working vehicles is slow and the response is delayed. Therefore, the prior art needs to be further improved. Summary of the invention

[0003] In order to solve the defects of the above-mentioned prior art, the present invention proposes a vehicle body stability monitoring method and a vehicle body stability control method for slope operation. The present invention predicts the center of mass coordinates according to the current state of the vehicle body, and determines the first resultant force coordinates of the vehicle body in combination with the current value of the inclination angle, the current value of the working resistance and the current value of the supporting force, and judges the stability of the vehicle body at the current sampling moment according to the horizontal projection distance between the first resultant force coordinates and the center of mass coordinates. At the same time, the present invention predicts the changes in the inclination angle, the working resistance and the supporting force at the next sampling moment, determines the second resultant force coordinates of the vehicle body, and predicts the stability of the vehicle body at the next sampling moment in advance. Furthermore, the vehicle body stability control method of the present invention adjusts the support mechanism according to the first control request and the second control request, and calibrates the control model of the support mechanism according to the stability of the vehicle body at the current sampling moment and the stability at the next sampling moment.

[0004] The technical solution of the present invention is achieved in this way:

[0005] A method for monitoring vehicle stability during slope operation comprises the following steps:

[0006] Step 1: The vehicle body has a moving device, a working device and a plurality of supporting mechanisms, the working device is movably mounted on the moving device, at least one supporting mechanism is located on an inclined working surface, and a three-dimensional coordinate system of the vehicle body is established;

[0007] Step 2: After the vehicle enters the driving state, obtain the additional mass of the working device, determine the center of mass coordinates of the mobile device, the working device and the supporting mechanism, and generate the center of mass coordinates of the vehicle (x1, y1, z1);

[0008] Step 3: Obtain the current value of the inclination angle of the inclined working surface and the current value of the working resistance in the working area, and measure the current value of the supporting force of each supporting mechanism;

[0009] Step 4: Substitute the current value of the tilt angle, the current value of the working resistance, and the current value of the supporting force into the moment balance model of the vehicle body to generate the first resultant force coordinate (x2, y2);

[0010] Step 5: If the horizontal projection distance between the center of mass coordinate and the first resultant force coordinate is greater than Rcosθ, issue a first control request and end the task, otherwise proceed to step 6, where θ is the current value of the tilt angle and R is the safe posture offset under the driving state;

[0011] Step 6: Generate the center of mass coordinates (x3, y3, z3) of the vehicle body at the next sampling time according to the driving state, and generate the predicted value of the tilt angle, the predicted value of the operating resistance, and the predicted value of the supporting force according to the current value of the tilt angle, the current value of the operating resistance, and the current value of the supporting force;

[0012] Step 7: Substitute the predicted value of the tilt angle, the predicted value of the working resistance, and the predicted value of the supporting force into the moment balance model of the vehicle body to generate the second resultant force coordinate (x4, y4);

[0013] Step 8: If the horizontal projection distance between the center of mass coordinate and the second resultant force coordinate is greater than Rcosθ', issue a second control request and end the task, otherwise return to step 2, where θ' is the predicted value of the inclination angle.

[0014] In the present invention, in step 1, the three-dimensional coordinate system takes the intersection of one of the support mechanisms and the inclined working surface as the coordinate origin O, the horizontal forward direction of the mobile device as the X-axis, the vertical direction as the Z-axis, and the direction perpendicular to the XOZ plane as the Y-axis.

[0015] In the present invention, in step 2, the mass of the mobile device is M1, the mass of the working device is M2, the additional mass of the working device is M3, the center of mass coordinates of the mobile device are (u1, v1, w1), the center of mass coordinates of the working device are (u2, v2, w2), and the center of mass coordinates of the i-th support mechanism are (u 4i ,v 4i ,w 4i ), , , , M 4i is the mass of the i-th supporting mechanism, and I is the number of supporting mechanisms.

[0016] In the present invention, in step 4, the component F of the current value of the working resistance on the Z axis is determined. 01 , the coordinates of the working resistance acting on the vehicle body are (x0, y0), and the moment balance model is , where g is the acceleration due to gravity, G i is the current value of the supporting force of supporting mechanism i.

[0017] In the present invention, in step 5, the horizontal projection distance = .

[0018] In the present invention, in step 6, historical data of T sampling moments are extracted, wherein the current value of the tilt angle at sampling moment t is θ t , the current value of the operating resistance is F t , the current value of the support force of support mechanism i is G it , predicted tilt angle , predicted value of operation resistance , support force prediction value .

[0019] A vehicle body stability control method comprises the following steps:

[0020] Step 100: executing the vehicle stability monitoring method for slope operation, and predicting the target length of each support mechanism according to the posture model;

[0021] Step 200: if a first control request is issued, proceed to step 300; if a second control request is issued, proceed to step 400; otherwise, return to step 100;

[0022] Step 300: Identify and adjust a support mechanism close to the working device, adjust the differential coefficient of the control model of the support mechanism, and proceed to step 500;

[0023] Step 400: Identify and adjust the support mechanism close to the working device, adjust the integral coefficient of the control model of the support mechanism, identify and adjust the support mechanism far from the working device, adjust the differential coefficient of the control model of the support mechanism, and enter step 500;

[0024] Step 500: Calculate the current adjustment amount of the corresponding support mechanism according to the control model and the target length;

[0025] Step 600: Control the support mechanism according to the current adjustment amount.

[0026] In the present invention, in step 100, the attitude inclination angle γ of the support mechanism is determined, and the attitude adjustment angle β of the support mechanism is predicted according to the current value of the inclination angle θ, the attitude inclination angle γ and the attitude model, and then the target length L1 of the support mechanism is calculated according to the attitude adjustment angle. The attitude model is , H1 is the vertical distance from the center of mass coordinate to the inclined working surface, and S1 is the distance from the support mechanism to the center of mass coordinate.

[0027] In the present invention, in step 500, the control model is , δ p is the proportionality coefficient, δ i is the integral coefficient, δ d is the differential coefficient, τ is the adjustment duration, and ΔL is the current adjustment amount.

[0028] In the present invention, in step 300, the differential coefficient of the control model , is the adjustment step of the differential coefficient, and L0 is the initial value of the support mechanism.

[0029] The vehicle body stability monitoring method and vehicle body stability control method for slope operation implemented in the present invention have the following beneficial effects: by judging whether the horizontal projection distance between the center of mass coordinates and the first resultant force coordinates is greater than a preset value, it is reflected whether the vehicle body needs to be adjusted at the current sampling moment. By judging whether the horizontal projection distance between the center of mass coordinates and the second resultant force coordinates is greater than a preset value, it is predicted whether the vehicle body needs to be adjusted at the next sampling moment. The present invention calculates the first resultant force coordinates and the second resultant force coordinates of the vehicle body through a moment balance model. Furthermore, the present invention adopts different adjustment strategies according to different control requests to improve the adjustment speed and adjustment accuracy at different sampling moments. BRIEF DESCRIPTION OF THE DRAWINGS

[0030] Figure 1 It is a flow chart of the vehicle body stability monitoring method for slope operation of the present invention;

[0031] Figure 2 It is a structural schematic diagram of the vehicle body of the present invention;

[0032] Figure 3It is a structural diagram of the vehicle body of the present invention;

[0033] Figure 4 It is a schematic diagram of a vehicle body of the present invention on an inclined working surface;

[0034] Figure 5 is a schematic diagram of the first resultant force coordinate of the vehicle body of the present invention;

[0035] Figure 6 It is a schematic diagram of the horizontal projection distance between the center of mass coordinate and the first resultant force coordinate of the present invention;

[0036] Figure 7 is a flow chart of a vehicle body stability control method of the present invention;

[0037] Figure 8 A schematic diagram of adjusting a support mechanism located on an inclined working surface according to the present invention;

[0038] Fig. 9 It is a schematic diagram of the control model of the support mechanism of the present invention.

[0039] Reference numerals in the accompanying drawings: 101 moving device, 102 working device, 103 supporting mechanism, 104 posture adjustment device, 105 supporting force sensor, 106 supporting force, 107 gravity, 108 working resistance, 109 geometric center, 110 center of mass coordinates. DETAILED DESCRIPTION

[0040] In order to more clearly understand the purpose, technical solutions and advantages of the present application, the present application is described and illustrated below in conjunction with the accompanying drawings and embodiments.

[0041] When the vehicle body is operating on a slope, the dynamic balance of the vehicle body is considered from the aspect of torque balance, and the first resultant force coordinate and the second resultant force coordinate are obtained. From the perspective of the vehicle body as a whole, the main factor that is most likely to cause tipping is the torque balance in the X-axis direction and the Y-axis direction. Therefore, the present invention establishes a torque balance model for the vehicle body based on the above two torque balances, obtains the first resultant force coordinate and the second resultant force coordinate, and determines whether the vehicle body needs to be adjusted at the current sampling moment based on whether the horizontal projection distance between the center of mass coordinate and the first resultant force coordinate is greater than Rcosθ, and issues a first control request. Based on whether the horizontal projection distance between the center of mass coordinate and the second resultant force coordinate is greater than Rcosθ', it is predicted whether the vehicle body needs to be adjusted at the next sampling moment, and a second control request is issued. Embodiment 1

[0042] like Figures 1 to 6 As shown, the vehicle body stability monitoring method for slope operation of the present invention includes the following steps.

[0043] Step 1: The vehicle body has a mobile device, an operating device and multiple supporting mechanisms. The operating device is movably mounted on the mobile device. At least one supporting mechanism is located on an inclined operating surface. A three-dimensional coordinate system of the vehicle body is established. Figures 2 to 3 As shown, the vehicle body has a moving device 101, a working device 102 and a plurality of supporting mechanisms 103, each supporting mechanism 103 includes a posture adjustment device 104, a supporting force sensor 105 and a wheel, and the posture adjustment device 104 is used to adjust the supporting mechanism. Figure 4 As shown, the three-dimensional coordinate system takes the intersection of one of the support mechanisms and the inclined working surface as the coordinate origin O, the horizontal forward direction of the mobile device as the X-axis, the vertical direction as the Z-axis, and the direction perpendicular to the XOZ plane as the Y-axis.

[0044] Step 2: After the vehicle enters the driving state, the additional mass of the working device is obtained, the center of mass coordinates of the mobile device, the working device and the supporting mechanism are determined, and the center of mass coordinates of the vehicle body (x1, y1, z1) are generated. The present invention can perform a three-dimensional scanning of the vehicle body through a three-dimensional scanner to obtain the three-dimensional structure of the vehicle body, import the three-dimensional structure of the vehicle body into the three-dimensional coordinate system, perform an integral operation on the mobile device to obtain the center of mass coordinates of the mobile device as (u1, v1, w1), , , , M1 is the mass of the mobile device, ρ1(x, y, z) is the density of the mobile device at point (x, y, z), and since the integral operation is set in the computer according to the three-dimensional structure and three-dimensional coordinate system of the vehicle body, the upper and lower limits of the integral are not elaborated in detail here. According to the above operation, the center of mass coordinates (u2, v2, w2) of the working device and the center of mass coordinates (u2, v2, w2) of the i-th support mechanism are obtained. 4i ,v 4i ,w 4i ). Then in the coordinates of the center of mass of the vehicle , , , M 4i is the mass of the i-th supporting mechanism, I is the number of supporting mechanisms, the mass of the working device is M2, and the additional mass of the working device is M3.

[0045] Step 3: Obtain the current value of the inclination angle of the inclined working surface and the current value of the working resistance in the working area, and measure the current value of the supporting force of each supporting mechanism. The current value of the inclination angle is obtained through a gyroscope. The working resistance includes the foundation reaction force of the inclined working surface and the wind resistance, etc. In this embodiment, the wind resistance can be measured by a force sensor, and the foundation reaction force of the inclined working surface can be measured by the foundation vibration during operation. Figure 4As shown, the current value of the supporting force is obtained through the supporting force sensor of each supporting mechanism. In addition to multiple supporting forces 106, the vehicle body is also subject to gravity 107 and operating resistance 108. The torque of the above forces in the XOY plane affects the dynamic balance of the vehicle body.

[0046] Step 4: Substitute the current value of the tilt angle, the current value of the working resistance, and the current value of the supporting force into the moment balance model of the vehicle body to generate the first resultant force coordinate (x2, y2). Determine the component F of the current value of the working resistance on the Z axis 01 , the coordinates of the working resistance acting on the vehicle body are (x0, y0), and the moment balance model is , where θ is the current value of the inclination angle, g is the acceleration due to gravity, G i is the current value of the support force of the support mechanism i. In the present invention, the first resultant force coordinate represents the position of the current resultant force of the vehicle body, referring to Figure 5 In an ideal state, the first resultant force coordinate is located at the geometric center 109 of the support mechanism. In actual conditions, affected by external forces and adjustment lag of the support mechanism, the first resultant force coordinate deviates from the geometric center of the support mechanism.

[0047] Step 5: If the horizontal projection distance between the center of mass coordinate and the first resultant force coordinate is greater than Rcosθ, issue the first control request and end the task, otherwise go to step 6, where θ is the current value of the tilt angle and R is the safe posture deviation under driving conditions. The smaller the horizontal projection distance, the better the vehicle stability. Figure 5 As shown, the centroid coordinates are the coordinates of the centroid in the three-dimensional coordinate system. The horizontal projection distance between the centroid coordinates (x1, y1, z1) and the first resultant force coordinates (x2, y2) = .like Figure 6 As shown, the dotted circle is the range of Rcosθ. When the horizontal projection distance between the center of mass coordinate 110 and the first resultant force coordinate exceeds the range of the dotted circle, the vehicle body will be unstable and the support mechanism needs to be adjusted.

[0048] Step 6: Generate the center of mass coordinates (x3, y3, z3) of the vehicle body at the next sampling moment according to the driving state, and generate the predicted value of the tilt angle, the predicted value of the working resistance, and the predicted value of the supporting force according to the current value of the tilt angle, the current value of the working resistance, and the current value of the supporting force. The present invention uses the law of exponential decay of time series data to predict the tilt angle, working resistance, and supporting force at the next sampling moment according to historical data. Extract the historical data of the previous T sampling moments, and arrange the historical data according to the sampling moment. The larger the sampling moment, the closer it is to the current state. The current value of the tilt angle at sampling moment t is θ t , the current value of the operating resistance is F t 、The current value of the support force is G itThe smaller t is, the less influence its current value has on the predicted value. When t=T, its current value has the greatest influence on the predicted value. , predicted value of operation resistance , support force prediction value . By calculating the predicted value of the inclination angle, the predicted value of the working resistance and the predicted value of the supporting force, data support is provided to predict whether adjustment is needed at the next sampling moment.

[0049] Step 8: If the horizontal projection distance between the center of mass coordinate and the second resultant force coordinate is greater than Rcosθ', issue a second control request and end the task, otherwise return to step 2, θ' is the predicted value of the inclination angle. The second control request is used for feedforward adjustment at the next sampling moment. The horizontal projection distance between the center of mass coordinate and the second resultant force coordinate = If the horizontal projection distance between the center of mass coordinate and the second resultant force coordinate is less than Rcosθ', it is predicted that the vehicle will be stable at the next sampling moment and no adjustment is required. The vehicle continues to move and returns to step 2. Embodiment 2

[0050] like Figures 7 to 9 As shown, the vehicle stability control method of the present invention includes the following steps. The present invention adopts different adjustment strategies for the first control request and the second control request to improve the adjustment speed and adjustment accuracy under different conditions. The support mechanism of the present invention includes a support mechanism close to the working device, and then adjusts the support mechanism away from the working device. Figure 2 In the figure, two groups of supporting mechanisms are close to the working device, and the other two groups of supporting mechanisms are far away from the working device. The supporting mechanisms close to the working device are closer to the center of mass coordinates.

[0051] Step 100: Execute the vehicle stability monitoring method for slope operation, and predict the target length of each support mechanism according to the posture model. The present invention determines the posture inclination angle γ of any support mechanism through a gyroscope and other equipment, predicts the posture adjustment angle β of the support mechanism according to the current value of the inclination angle θ, the posture inclination angle γ and the posture model, and then calculates the target length L1 of the support mechanism according to the posture adjustment angle. Figure 8 As shown, the posture model is , H1 is the vertical distance from the center of mass coordinate to the inclined working surface, and S1 is the distance from the support mechanism to the center of mass coordinate. According to the posture model, the posture adjustment angle β of any support mechanism is inversely solved, and then the relationship between the posture adjustment angle β and the target length L1 of the support mechanism is determined. , θ1 is the side swing joint angle of the supporting mechanism, and θ2 is the front swing joint angle of the supporting mechanism.

[0052] Step 200: If a first control request is issued, proceed to step 300; if a second control request is issued, proceed to step 400; otherwise, return to step 100. Both the first control request and the second control request adjust the length of the support mechanism. The first control request is used for adjustment at the current sampling moment, and the second control request is used for feedforward adjustment at the next sampling moment.

[0053] Step 300: Identify and adjust the support mechanism close to the working device, adjust the differential coefficient of the control model of the support mechanism, and enter step 500. The control model is used to determine the current adjustment amount according to the target length. The total adjustment amount is L1-L0. In order to make the vehicle body posture transition smoothly, the current adjustment amount ΔL obtained by the control model is usually less than L1-L0. In the present invention, the control model is a PID controller, and the control model is , δ p is the proportionality coefficient, δ i is the integral coefficient, δ d is the differential coefficient, and τ is the adjustment time. In this embodiment, the adjustment time τ is equal to the interval between adjacent sampling moments. In the first control request, the control model of the support mechanism close to the working device is adjusted according to the current adjustment amount. Its differential coefficient , is the adjustment step of the differential coefficient, and L0 is the initial value of the support mechanism. By changing the differential coefficient of the support mechanism control model, the influence of the differential coefficient can be reduced when L1 is larger, while the integral coefficient remains unchanged, thus speeding up the adjustment speed.

[0054] Step 400: Identify and adjust the support mechanism close to the working device, adjust the integral coefficient of the control model of the support mechanism, identify and adjust the support mechanism far away from the working device, adjust the differential coefficient of the control model of the support mechanism, and enter step 500. The second control request is feedforward regulation, and feedforward regulation requires a lower regulation speed. Therefore, in order to avoid error accumulation at this time, the integral coefficient of the support mechanism close to the working device is adjusted. Since the feedforward regulation is an adjustment of the predicted data, if the actual value at the next sampling moment is inconsistent with the predicted value, it may cause regulation oscillation. The present invention adjusts the differential coefficient of the support mechanism far away from the working device, reduces the regulation oscillation, and improves the regulation accuracy.

[0055] Step 500: Calculate the current adjustment amount of the corresponding support mechanism according to the control model and the target length. Figure 8 As shown, the control model is According to the target length and the control model, the current adjustment amount is applied to the support mechanism, which acts on the vehicle body through the support mechanism. The proportional coefficient, integral coefficient and differential coefficient of the control model are adjusted according to the horizontal projection distance between the center of mass coordinate of the vehicle body and the first resultant force coordinate or the second resultant force coordinate.

[0056] Step 600: Control the support mechanism according to the current adjustment amount. Adjust the support mechanism to the target length multiple times according to the posture adjustment device. The target length is L1, and the actual length of the support mechanism after adjustment in this step is L0+ΔL. Within multiple adjustment time lengths τ, the actual length gradually approaches the target length. The posture adjustment device of this embodiment is, for example, a hydraulic pump, which is used to adjust the length of the support mechanism.

[0057] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Any modifications, equivalent substitutions and improvements made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

Claims

1. A method for monitoring vehicle stability during slope operation, characterized in that: The following steps are involved: Step 1: The vehicle body has a moving device, a working device and a plurality of supporting mechanisms, the working device is movably mounted on the moving device, at least one supporting mechanism is located on an inclined working surface, and a three-dimensional coordinate system of the vehicle body is established; Step 2: After the vehicle enters the driving state, obtain the additional mass of the working device, determine the center of mass coordinates of the mobile device, the working device and the supporting mechanism, and generate the center of mass coordinates of the vehicle (x1, y1, z1); Step 3: Obtain the current value of the inclination angle of the inclined working surface and the current value of the working resistance in the working area, and measure the current value of the supporting force of each supporting mechanism; Step 4: Substitute the current value of the tilt angle, the current value of the working resistance, and the current value of the supporting force into the moment balance model of the vehicle body to generate the first resultant force coordinate (x2, y2); Step 5: If the horizontal projection distance between the center of mass coordinate and the first resultant force coordinate is greater than Rcosθ, issue a first control request and end the task, otherwise proceed to step 6, where θ is the current value of the tilt angle and R is the safe posture offset under the driving state; Step 6: Generate the center of mass coordinates (x3, y3, z3) of the vehicle body at the next sampling time according to the driving state, and generate the predicted value of the tilt angle, the predicted value of the operating resistance, and the predicted value of the supporting force according to the current value of the tilt angle, the current value of the operating resistance, and the current value of the supporting force; Step 7: Substitute the predicted value of the tilt angle, the predicted value of the working resistance, and the predicted value of the supporting force into the moment balance model of the vehicle body to generate the second resultant force coordinate (x4, y4); Step 8: If the horizontal projection distance between the center of mass coordinate and the second resultant force coordinate is greater than Rcosθ', issue a second control request and end the task, otherwise return to step 2, where θ' is the predicted value of the inclination angle.

2. The method for monitoring vehicle stability during slope operation according to claim 1, characterized in that: In step 1, the three-dimensional coordinate system takes the intersection of one of the support mechanisms and the inclined working surface as the coordinate origin O, the horizontal forward direction of the mobile device as the X-axis, the vertical direction as the Z-axis, and the direction perpendicular to the XOZ plane as the Y-axis.

3. The method for monitoring vehicle stability during slope operation according to claim 1, characterized in that: In step 2, the mass of the mobile device is M1, the mass of the working device is M2, the additional mass of the working device is M3, the coordinates of the center of mass of the mobile device are (u1, v1, w1), the coordinates of the center of mass of the working device are (u2, v2, w2), and the coordinates of the center of mass of the i-th support mechanism are (u 4i ,v 4i ,w 4i ), , , , M 4i is the mass of the i-th supporting mechanism, and I is the number of supporting mechanisms.

4. The method for monitoring vehicle stability during slope operation according to claim 3, characterized in that: In step 4, determine the component F of the current value of the working resistance on the Z axis 01 , the coordinates of the working resistance acting on the vehicle body are (x0, y0), and the moment balance model is , where g is the acceleration due to gravity, G i is the current value of the supporting force of supporting mechanism i.

5. The method for monitoring vehicle stability during slope operation according to claim 4, characterized in that: In step 5, horizontal projection distance = .

6. The method for monitoring vehicle stability during slope operation according to claim 5, characterized in that: In step 6, the historical data of the previous T sampling moments are extracted, where the current value of the inclination angle at the current sampling moment t is θ t , the current value of the operating resistance is F t 、The current value of the support force is G it , predicted tilt angle , predicted value of operation resistance , support force prediction value .

7. A vehicle stability control method, characterized in that: The following steps are involved: Step 100: Execute the vehicle stability monitoring method for slope operation according to claim 1, and predict the target length of each support mechanism according to the posture model; Step 200: if a first control request is issued, proceed to step 300; if a second control request is issued, proceed to step 400; otherwise, return to step 100; Step 300: Identify and adjust a support mechanism close to the working device, adjust the differential coefficient of the control model of the support mechanism, and proceed to step 500; Step 400: Identify and adjust the support mechanism close to the working device, adjust the integral coefficient of the control model of the support mechanism, identify and adjust the support mechanism far from the working device, adjust the differential coefficient of the control model of the support mechanism, and enter step 500; Step 500: Calculate the current adjustment amount of the corresponding support mechanism according to the control model and the target length; Step 600: Control the support mechanism according to the current adjustment amount.

8. The vehicle stability control method according to claim 7, characterized in that: In step 100, the attitude inclination angle γ of the support mechanism is determined, and the attitude adjustment angle β of the support mechanism is predicted according to the current value of the inclination angle θ, the attitude inclination angle γ and the attitude model. Then, the target length L1 of the support mechanism is calculated according to the attitude adjustment angle. The attitude model is: , H1 is the vertical distance from the center of mass coordinate to the inclined working surface, and S1 is the distance from the support mechanism to the center of mass coordinate.

9. The vehicle body stability control method according to claim 8, characterized in that: In step 500, the control model is , δ p is the proportionality coefficient, δ i is the integration coefficient, δ d is the differential coefficient, τ is the adjustment duration, and ΔL is the current adjustment amount.

10. The vehicle body stability control method according to claim 9, characterized in that: In step 300, the differential coefficients of the control model , is the adjustment step of the differential coefficient, and L0 is the initial value of the support mechanism.

Citation Information

Patent Citations

  • Method for establishing zero-turning-radius mower multi-working-condition rollover prediction model

    CN111695215A

  • Motion control method and system for four-foot single-arm operation robot

    CN114954724A

  • Vehicle three-dimensional centroid detection method

    CN110595688A

  • Active suspension inertia regulation and control method and control system based on terrain in front of vehicle

    CN113370734A

  • Four-wheel drive and four-wheel steering autonomous vehicle limit obstacle avoidance working condition trajectory tracking control method and device

    CN115892070A