A lateral control method of mine car based on augmented LQR

Through the mine car lateral control method based on augmented LQR, a two-degree-of-freedom dynamic model of mine car is established and real-time angle feedback is introduced, which solves the problem of actuator response delay in mine car automatic driving, and achieves higher control accuracy and stability It avoids the complexity of external compensation means and improves the safety of mine truck autonomous driving.

CN114879670BActive Publication Date: 2024-11-19安徽海博智能科技有限责任公司
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210467772.0
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-04-29
Publication Date
2024-11-19
Estimated Expiration
2042-04-29

AI Technical Summary

Technical Problem

There is a problem of actuator response delay in the automatic driving control of mine trucks. The existing LQR-based control method fails to effectively consider the state variables, resulting in limited control effect and difficult to achieve precise control, especially when the curvature of mine roads changes, it is easy to cause collisions or deviations from the road. .

Method used

Using the mine car lateral control method based on augmented LQR, the mine car 2-degree-of-freedom dynamic model is established, real-time angle feedback is introduced, and the optimal feedback control rate is obtained through iterative solution of the Rikati equation. Directly optimize the control amount, avoid external compensation means, and improve control accuracy.

Benefits of technology

Accurate control of mine vehicles is achieved, the risks of collision and deviation from the road are reduced, the control accuracy and stability of autonomous driving are improved, complex parameter calibration of external compensation means is omitted, and the optimality of control volume is ensured.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114879670B_ABST
    Figure CN114879670B_ABST
Patent Text Reader

Abstract

The present invention discloses a lateral control method for a mine car based on augmented LQR, and the specific steps include issuing control instructions through a steering system, and analyzing actual turning angle feedback to obtain the response characteristics of the system; establishing a two-degree-of-freedom dynamic model of the mine car according to the response characteristics of the system; performing operations in the state space equations of the state variables of the two-degree-of-freedom dynamic model of the mine car to form a state control expression based on an augmented form; and then obtaining an optimal feedback control rate and an optimal control amount through iterative solution of the Riccati equation. The present invention forms an augmented form of state control expression, obtains an optimal feedback control rate through iterative solution of the Riccati equation, and finally obtains an optimal control amount, omitting the process of solving the actuator response delay through external compensation means, saving the work of relevant parameter calibration, and can ensure the optimal control amount.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of automatic driving of a mine car, and in particular to a lateral control method of a mine car based on augmented LQR. Background Art

[0002] Faced with the growing demand for mining, major mining companies are increasing the number of transport equipment and the transport capacity of each vehicle on the one hand, and increasing the working hours on the other. However, working for a long time in the harsh environment of the mine is a big challenge to the workers' health, and many transport equipment are very tall and have large blind spots, which are prone to safety accidents. Based on the above reasons, mine autonomous driving is a feasible means to solve the above problems.

[0003] At present, the autonomous driving algorithms for passenger cars are relatively mature, and the autonomous driving algorithms for mine cars are constantly being improved. A major challenge in the autonomous driving of mine cars is the precise control of mine cars, because mine cars have a relatively large actuator response delay due to their huge weight and load. Mine cars work on mine roads with constantly changing curvatures, and the control accuracy directly affects whether the mine car autonomous driving can eventually be operated in batches.

[0004] The shortcomings of the existing technology are that the current mining car itself is relatively wide and the road width is limited. A slightly larger lateral error may cause the car to collide or fall into the infrastructure on both sides of the road. The existing LQR-based control method does not directly consider the actuator response delay characteristics in the form of state variables in the state space expression. It is often necessary to solve the problem of control response delay by adding advanced links, but this method can only solve the problem from the outside of the system, and the control effect is limited. Summary of the invention

[0005] The purpose of the present invention is to overcome the shortcomings of the prior art. To achieve the above purpose, a mine car lateral control method based on augmented LQR is adopted to solve the problems raised in the above background technology.

[0006] A mine car lateral control method based on augmented LQR, the specific steps include:

[0007] Obtain the response characteristics of the system by issuing control instructions through the steering system and analyzing the actual steering angle feedback;

[0008] The two-degree-of-freedom dynamic model of the mine car is established according to the response characteristics of the system;

[0009] Calculation is performed on the state space equation of the state variables of the two-degree-of-freedom dynamic model of the mine car to form a state control expression based on the augmented form;

[0010] Then the optimal feedback control rate is obtained by iteratively solving the Riccati equation, and the optimal control quantity is obtained.

[0011] As a further solution of the present invention: the specific steps of establishing the two-degree-of-freedom dynamic model of the mine car include:

[0012] Based on mathematical models, the dynamic characteristics of the mine vehicle and the response characteristics of the system are expressed;

[0013] Define the state variable as where e 1 ,e 2 Respectively represent the lateral offset and heading angle deviation, and the state space equation is obtained as follows:

[0014]

[0015] Among them, σ 1 =2(C αf +C αr ),σ 2 =-2(l f C αf -l r C αr ), C αf ,C αr ,v x ,m,I z ,l f ,l r They represent the front wheel cornering stiffness, rear wheel cornering stiffness, vehicle longitudinal speed, vehicle mass, yaw moment of inertia, distance from the center of mass of the vehicle to the front axle, and distance from the center of mass of the vehicle to the rear axle, respectively. R is the curvature of the road at the foresight point.

[0016] As a further solution of the present invention: the specific steps of performing operations in the state space equations of the state variables of the two-degree-of-freedom dynamic model of the mine car to form the state control expression based on the augmented form include:

[0017] According to the state space equation of the two-degree-of-freedom dynamic model of the mine car, real-time rotation angle feedback is introduced in the state variable Expand the state space to And based on the analysis of the steering system, the expression is obtained:

[0018]

[0019] Combining the state-space equations, we get:

[0020]

[0021] Then transform the above state space equation into a discrete system according to a fixed time step Δt, and we get:

[0022] x(k + 1) = Ax(k) + Bδ(k) + Dc R (k);

[0023] Wherein, A, B, and D are the coefficient matrices of the system respectively, and k represents the number of steps.

[0024] Meanwhile, according to the above formula, the cost function is obtained:

[0025]

[0026] s.t. X(k + 1) = AX(k) + Bδ(k)

[0027] Wherein, Q and R are positive definite weight matrices respectively, and τ represents the response delay time of the steering system.

[0028] As a further solution of the present invention: the specific steps of obtaining the optimal control quantity by iteratively solving through the Riccati equation to obtain the optimal feedback control rate include:

[0029] Firstly, based on the augmented LQR, the two-degree-of-freedom dynamic model of the mine car is solved to obtain the optimal state feedback control gain matrix K;

[0030] Then, the Riccati equation is iteratively solved;

[0031] Let P = Q, when err > tolerance and iteration_num < max_ineration_num;

[0032] Iteratively execute:

[0033] If iteration_num < max_ineration_num, let K = -(R + B T PB) -1 B T PA;

[0034] Since the control quantity δ = -Kx, the influence of the road curvature needs to be considered and a feedforward quantity is introduced;

[0035] The expression of the introduced feedforward quantity is:

[0036]

[0037] Wherein, L is the wheelbase,

[0038] The total steering angle control quantity is obtained as: δ = -Kx + δ f .

[0039] Compared with the prior art, the present invention has the following technical effects:

[0040] By adopting the above-mentioned technical scheme, control instructions are issued to the steering system, and the actual steering angle feedback is analyzed, and the response characteristics of the system are obtained by using the system identification method; a two-degree-of-freedom dynamic model of the mine car is established, and the four state variables are taken into account in the state space equation to form an augmented form of state control expression, and the optimal feedback control rate is obtained by iteratively solving the Riccati equation to obtain the optimal control quantity, which omits the process of solving the actuator response delay through external compensation means, saves the work of related parameter calibration, and can ensure the optimal control quantity. BRIEF DESCRIPTION OF THE DRAWINGS

[0041] The specific embodiments of the present invention are described in detail below in conjunction with the accompanying drawings:

[0042] Figure 1 A schematic diagram of the steps of a mine car lateral control method according to some embodiments disclosed in the present application;

[0043] Figure 2 A schematic diagram of a two-degree-of-freedom model of a mine car according to some embodiments disclosed in the present application;

[0044] Figure 3 This is a flowchart of a mine car lateral control method according to some embodiments disclosed in this application. DETAILED DESCRIPTION

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

[0046] Please refer to Figure 1 In an embodiment of the present invention, a mine car lateral control method based on augmented LQR includes the following specific steps:

[0047] S1. Obtain the response characteristics of the system by issuing control instructions through the steering system and analyzing the actual steering angle feedback;

[0048] S2. Establish a two-degree-of-freedom dynamic model of the mine car based on the response characteristics of the system;

[0049] The purpose of establishing a two-degree-of-freedom model of a mine car is to express the dynamic characteristics of the vehicle mathematically, and to express the performance of the vehicle and the amount of control applied in mathematical form;

[0050] like Figure 2 As shown, the figure is a schematic diagram of a two-degree-of-freedom model of a mine car;

[0051] In a specific embodiment, the specific steps of establishing a two-degree-of-freedom model of a mine car include:

[0052] Based on mathematical models, the dynamic characteristics of the mine vehicle and the response characteristics of the system are expressed;

[0053] Define the state variable as where e 1 ,e 2 Respectively represent the lateral offset and heading angle deviation, and the state space equation is obtained as follows:

[0054]

[0055] Among them, σ 1 =2(C αf +C αr ),σ 2 =-2(l f C αf -l r C αr ), C αf ,C αr ,v x ,m,I z ,l f ,l r They represent the front wheel cornering stiffness, rear wheel cornering stiffness, vehicle longitudinal speed, vehicle mass, yaw moment of inertia, distance from the center of mass of the vehicle to the front axle, and distance from the center of mass of the vehicle to the rear axle, respectively. R is the curvature of the road at the foresight point.

[0056] In a specific implementation, since there is a delay in the actuator of the mine car vehicle, by analyzing the response characteristics of the hydraulic steering system, it is found that there is a link similar to a first-order delay between the issued steering angle and the actual steering angle response. Therefore, a first-order delay link is used to represent the actual steering angle response and the issued steering angle response.

[0057] S3. Calculate the state space equation of the state variables of the two-degree-of-freedom dynamic model of the mine car to form a state control expression based on the augmented form. The specific steps include:

[0058] According to the state space equation of the two-degree-of-freedom dynamic model of the mine car, real-time rotation angle feedback is introduced in the state variable δ represents the turning angle command, which expands the state space to And based on the analysis of the steering system, the expression is obtained:

[0059]

[0060] Combining the state-space equations, we get:

[0061]

[0062] Then, the above state - space equation is transformed into a discrete system according to a fixed time step Δt, and we get:

[0063] x(k + 1)=Ax(k)+Bδ(k)+Dc R (k);

[0064] where A, B, and D are the coefficient matrices of the system respectively, and k represents the number of steps.

[0065] Meanwhile, according to the above formula, the cost function is obtained:

[0066]

[0067] s.t. X(k + 1)=AX(k)+Bδ(k)

[0068] where Q and R are positive - definite weight matrices respectively, and τ represents the response delay time of the steering system.

[0069] S4. Then, the optimal feedback control rate is obtained by iterative solution of the Riccati equation to get the optimal control quantity. The specific steps include:

[0070] As Figure 3 shown, the figure shows the flow chart of the solution of the scheme;

[0071] First, based on the augmented LQR, the two - degree - of - freedom dynamic model of the mine car is solved to obtain the optimal state - feedback control gain matrix K;

[0072] Then, the Riccati equation is solved by iteration. The specific steps are as follows:

[0073] Let P = Q. When err > tolerance and iteration_num < max_ineration_num;

[0074] Iteratively execute:

[0075] If iteration_num < max_ineration_num, let K =-(R + B T PB) -1 B T PA, and the solution ends;

[0076] Since the control quantity δ=-Kx, and the above solution does not consider the influence of road curvature, therefore, a feed - forward needs to be introduced to eliminate the problem of non - convergence of the control caused by road curvature, and the feed - forward quantity is introduced;

[0077] The expression of the introduced feed - forward quantity is:

[0078]

[0079] Where, L is the wheelbase,

[0080] The total angle control amount is: δ=-Kx+δ f .

[0081] Although the embodiments of the present invention have been shown and described, it will be appreciated by those skilled in the art that various changes, modifications, substitutions and variations may be made to the embodiments without departing from the principles and spirit of the present invention. The scope of the present invention is defined by the appended claims and their equivalents, and all should be included within the scope of protection of the present invention.

Claims

1. A mine car lateral control method based on augmented LQR, characterized in that: include: Obtain the response characteristics of the system by issuing control instructions through the steering system and analyzing the actual steering angle feedback; According to the response characteristics of the system, a two-degree-of-freedom dynamic model of the mine car is established; Calculation is performed on the state space equation of the state variables of the two-degree-of-freedom dynamic model of the mine car to form a state control expression based on the augmented form; Then, the optimal feedback control rate is obtained by iteratively solving the Riccati equation, and the optimal control quantity is obtained. The specific steps include: Firstly, based on the augmented LQR, the two-degree-of-freedom dynamic model of the mine car is solved to obtain the optimal state feedback control gain matrix ; Then the Riccati equation is iteratively solved; make ,when ,and hour; Iterative execution: ; if ,make ; Due to the control , the influence of road curvature needs to be considered and feedforward quantity introduced; The expression of the introduced feedforward quantity is: ; in, is the wheelbase, , , ; The total angle control amount is: ; In the formula, is the system state variable, are the coefficient matrices of the system respectively; are positive definite weight matrices respectively; They respectively represent the cornering stiffness of the front wheel, the cornering stiffness of the rear wheel, the longitudinal speed of the vehicle, the mass of the mine car, the lateral moment of inertia of the mine car, the distance from the center of mass of the mine car to the front axle, the distance from the center of mass of the mine car to the rear axle, and the curvature of the road at the forward viewpoint.

2. According to claim 1, a mine car lateral control method based on augmented LQR is characterized in that: The specific steps of establishing the two-degree-of-freedom dynamic model of the mine car include: Based on mathematical models, the dynamic characteristics of the mine vehicle and the response characteristics of the system are expressed; Define the state variable as ,in Respectively represent the lateral offset and heading angle deviation, and the state space equation is obtained as follows: in, They represent the front wheel cornering stiffness, rear wheel cornering stiffness, vehicle longitudinal speed, mine car mass, mine car yaw moment of inertia, distance from the mine car center of mass to the front axle, and distance from the mine car center of mass to the rear axle. is the curvature of the road at the foresight point.

3. According to claim 1, a mine car lateral control method based on augmented LQR is characterized in that: The specific steps of performing operations in the state space equations of the state variables of the two-degree-of-freedom dynamic model of the mine car to form a state control expression based on the augmented form include: According to the state space equation of the two-degree-of-freedom dynamic model of the mine car, real-time rotation angle feedback is introduced in the state variable , which expands the state space to , and based on the analysis of the steering system, the expression is obtained: ; Combining the state-space equations, we get: Then the above state space equation is transformed into a fixed time step Convert to discrete system, get: ; in, are the coefficient matrices of the system, Indicates the number of steps; At the same time, according to the above formula, the cost function is obtained: in, are positive definite weight matrices, Indicates the response delay time of the steering system.