PATH TRACKING CONTROL METHOD AND DEVICE FOR INTELLIGENT ELECTRIC VEHICLES
20240253604 ยท 2024-08-01
Inventors
- Xuan Zhao (Xi'an, CN)
- Shu WANG (Xi'an, CN)
- Jian MA (Xi'an, CN)
- Rui LIU (Xi'an, CN)
- Yilin HE (Xi'an, CN)
- Chenyu ZHOU (Xi'an, CN)
Cpc classification
B60T8/17551
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
A path tracking control method for an intelligent electric vehicle. The method includes the following steps. A lateral stability state of a vehicle is determined, where the lateral stability state includes a stable state, a critical-destabilized state, and a destabilized state. Path tracking control is performed on the vehicle according to the lateral stability state of the vehicle. This application also provides a path tracking control device for an intelligent electric vehicle, which includes a lateral stability state determination module and a path tracking control module.
Claims
1. A path tracking control method for an intelligent electric vehicle, comprising: determining a lateral stability state of a vehicle, wherein the lateral stability state comprises a stable state, a critical-destabilized state, and a destabilized state; performing path tracking control on the vehicle according to the lateral stability state of the vehicle; determining, when the vehicle is in the stable state, a front wheel steering increment of the vehicle; and determining a front wheel steering of the vehicle based on the front wheel steering increment of the vehicle; determining, when the vehicle is in the critical-destabilized state, a first yaw moment increment and an additional yaw moment weighting coefficient of the vehicle; determining a first additional yaw moment based on the first yaw moment increment and the additional yaw moment weighting coefficient; and determining a first longitudinal force on each wheel of the vehicle based on the first additional yaw moment; and determining, when the vehicle is in the destabilized state, a second yaw moment increment of the vehicle; determining a second additional yaw moment based on the second yaw moment increment; and determining a second longitudinal force on each wheel based on the second additional yaw moment; wherein the stable state is determined by
2. The path tracking control method of claim 1, wherein when the vehicle is in the stable state, the front wheel steering increment of the vehicle is determined through steps of: constructing an objective function J:
3. The path tracking control method of claim 1, wherein when the vehicle is in the critical-destabilized state, the first yaw moment increment is determined through steps of: constructing an objective function J:
4. The path tracking control method of claim 1, wherein when the vehicle is in the critical-destabilized state, the additional yaw moment weighting coefficient is determined through steps of: constructing a coordination controller based on a reinforcement learning deep deterministic policy gradient (DDPG) algorithm, wherein state inputs are yaw velocity w.sub.r, center-of-mass sideslip angle ?, lateral displacement Y, heading angle ?, front wheel steering angle ?.sub.f and lateral acceleration a.sub.y; and an action output is the additional yaw moment weighting coefficient ?; wherein a reward function of the coordination controller is as follows:
5. The path tracking control method of claim 1, wherein the path tracking control is performed through steps of: acquiring a yaw moment u(k) at a current moment k based on a yaw moment increment ?u(k+0|k) at a (k+0).sup.th moment within a control time domain; wherein u(k)=u(k?1)+?u(k+0|k); determining an additional yaw moment ?M according to the yaw moment u(k) and the additional yaw moment weighting coefficient ?; wherein ?M=?u(k); and determining a longitudinal force on each wheel of the vehicle based on the additional yaw moment ?M in a drive-brake-combined manner.
6. The path tracking control method of claim 1, wherein when the vehicle is in the destabilized state, the second yaw moment increment of the vehicle is determined, and the path tracking control is performed based on the second yaw moment increment through steps of: constructing an objective function J:
7. A path tracking control device for an intelligent electric vehicle, comprising: a lateral stability state determination module; and a path tracking control module; wherein the lateral stability state determination module is configured to determine a lateral stability state of a vehicle, wherein the lateral stability state comprises a stable state, a critical-destabilized state, and a destabilized state; and the path tracking control module is configured to perform path tracking control on the vehicle according to the lateral stability state of the vehicle, determine a front wheel steering increment of the vehicle when the vehicle is in the stable state, determine a front wheel steering of the vehicle based on the front wheel steering increment of the vehicle, determine a first yaw moment increment and an additional yaw moment weighting coefficient of the vehicle when the vehicle is in the critical-destabilized state, determine a first additional yaw moment based on the first yaw moment increment and the additional yaw moment weighting coefficient, determine a first longitudinal force on each wheel of the vehicle based on the first additional yaw moment, determine a second yaw moment increment of the vehicle when the vehicle is in the destabilized state, determine a second additional yaw moment based on the second yaw moment increment, and determine a second longitudinal force on each wheel based on the second additional yaw moment; wherein the stable state is determined by
8. A computer-readable storage medium, wherein the computer-readable storage medium is configured to store a computer program; and the computer program is configured to be executed by a processor to implement the path tracking control method of claim 1.
9. A computer program product, comprising: a computer program or a computer instruction; wherein the computer program or the computer instruction is configured to be executed by a processor to implement the path tracking control method of claim 1.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0052] The present application may be better understood with reference to the following description in conjunction with the accompanying drawings, which are included in and form a part of this specification.
[0053]
[0054]
DETAILED DESCRIPTION OF EMBODIMENTS
[0055] Exemplary embodiments of the present application will be described below with reference to the accompanying drawings. For the sake of clarity and brevity, not all features of the actual embodiments are described in the specification. However, it should be understood that many decisions specific to embodiment can be made during the development of any such practical embodiments to achieve the specific goals of the developer, and these decisions may vary from embodiment to embodiment.
[0056] Furthermore, to avoid obscuring the present application with unnecessary details, only the structure closely related to the embodiments according to the present application is shown in the accompanying drawings, and other details less relevant to the present application have been omitted.
[0057] It should be understood that the present application is not limited to the form of embodiment described with reference to the accompanying drawings below. As far as practicable herein, embodiments may be combined with each other, features can be substituted or borrowed between different embodiments, and one or more features can be omitted in one embodiment.
[0058]
[0059] (S110) A lateral stability state of a vehicle is determined, where the lateral stability condition monitoring function of the vehicle is turned on, and the lateral stability state includes a stable state, a critical-destabilized state, and a destabilized state.
[0060] In this step, the lateral stability state of the vehicle is determined through a center-of-mass sideslip angle-sideslip angular velocity phase plane method. Specifically, the stable state is determined by
the critical-destabilized state is determined by
and the destabilized state is determined by
[0062] (S120) Path tracking control is performed on the vehicle according to the lateral stability state of the vehicle. When the vehicle is in the stable state, a front wheel steering increment of the vehicle is determined, and a front wheel steering of the vehicle is determined based on the front wheel steering increment of the vehicle. When the vehicle is in the critical-destabilized state, a first yaw moment increment and an additional yaw moment weighting coefficient of the vehicle are determined, a first additional yaw moment is determined based on the first yaw moment increment and the additional yaw moment weighting coefficient, and a first longitudinal force on each wheel of the vehicle is determined based on the first additional yaw moment. When the vehicle is in the destabilized state, a second yaw moment increment of the vehicle is determined, a second additional yaw moment is determined based on the second yaw moment increment, and a second longitudinal force on each wheel is determined based on the second additional yaw moment.
[0063] In an embodiment, the stability state of the vehicle is determined, and then according to the different stability states of the vehicle, different control strategies are adopted to maintain the path tracking accuracy while taking into account the stability control of the vehicle, which improves the safety of the intelligent electric vehicle.
[0064] In an embodiment, when the vehicle is in the stable state, the front wheel steering increment of the vehicle is determined, and the front wheel steering is determined based on the front wheel steering increment through the following steps.
[0065] Kinematic equations are established as follows, based on the vehicle kinematics model:
[0067] The path tracking model is established by the above kinematic equations and the objective function is constructed to solve.
[0068] The kinematic equations are represented in state space:
[0070] The formula (2) is linearized and discretized to obtain a discrete state space equation as follows:
[0071] where ?.sub.k,t represents a matrix of difference coefficients of the state variable at a k.sup.th moment when the current moment is t;
T represents a sampling period; {tilde over (?)}represents a state variable difference, and {tilde over (?)}=???.sub.r; ? represents a control variable difference, and ?=u?u.sub.r; {dot over (?)}.sub.r=f(?.sub.r, u.sub.r), which is a Taylor expansion point at any point; ?.sub.r represents a state variable at any point; u.sub.r represents a control variable at any point; &k represents a state variable difference at the k.sup.th moment; and ?.sub.k represents a control variable difference at the k.sup.th moment.
[0072] The state variable and the control variable are combined to reconstruct a new state space expression ?(k|t) as follows:
[0073] The equation (4) is substituted into equation (3) to obtain equation (5) as follows:
?u(k|t) represents a control variable increment at a k.sup.th moment when the current moment is t, and ?u(k|t)=u(k|t)?u(k?1|t); ?(k|t) represents a lateral position coordinate of the vehicle at the k.sup.th moment when the current moment is t; ?R=[C Omxn]; m represents a control variable dimension, and m=1; n represents a state variable dimension, and n=3; Im represents a unit matrix of m dimensions; and O.sub.m?n represents a 0 matrix of m?n.
[0074] To simplify the calculation, the prediction time domain is allowed to be N P the control time domain is allowed to be N.sub.c, and assumptions are made as follows:
[0075] An expression for a predicted output of the system in the prediction time domain N.sub.p is derived as follows:
Y(t)=??(t|t)+??U(t)(7); [0076] in the formula (7),
[0077] ?U(t) represents a sequence of control increment corresponding to the current moment t.
[0078] During the path tracking control of the vehicle, the state error and the control increment of the model prediction controller at each sampling moment are required to be minimized to obtain the best path tracking performance and driving stability of the vehicle. Therefore, the objective function J of the following form is used:
[0080] In the actual control process, the control variable and the control increment are required to be limited within a reasonable range with constraint expressions as follows:
[0082] After solving the objective function in each control time domain, a series of sequences of increment in the control time domain are obtained, i.e., the front wheel steering increment ?u(t+i|t) of the vehicle when the objective function J takes the minimum value.
[0083] According to the model predictive control (MPC) principle, only the first element in the sequence of increment is taken as the actual control input increment to act on the system each time, i.e., the front wheel steering increment ?u(t+0|t) of the vehicle is selected to act on the system to obtain the front wheel steering u(t) of the vehicle corresponding to the current moment t, so as to realize the path tracking control on the vehicle, where u(t)=u(t?1)+?u(t+0|t).
[0084] In an embodiment, when the vehicle is in the critical-destabilized state, a first yaw moment increment and an additional yaw moment weighting coefficient of the vehicle are determined, a first additional yaw moment is determined based on the first yaw moment increment and the additional yaw moment weighting coefficient, and a first longitudinal force on each wheel of the vehicle is determined based on the first additional yaw moment through the following steps.
[0085] (1) The first yaw moment increment is determined.
[0086] An additional yaw moment controller is established, and the dynamics equations considering the yaw stability control are as follows:
[0088] After linearizing the above dynamics equations, the system state equation is obtained as follows:
? represents a yaw angular velocity; and ? represents a center-of-mass sideslip angle of the vehicle.
[0090] To simplify the calculation and the control system, the linear continuous system is discretized using the forward Euler method, expressed as:
X(k+1)=A.sub.kX(k)+B.sub.kU(k)+E.sub.kD(k)(12); [0091] where X(k) is a state variable at a k.sup.th moment; X(k+1) is a state variable at a (k+1).sup.th moment; U(k) represents a control variable at the k.sup.th moment; D(k) is a front wheel angle at the k.sup.th moment; Ex is a parameter matrix of the vehicle at the k.sup.th moment; A.sub.k=1+TA; B.sub.k=TB; T represents a sampling period; I represents a unit matrix. Since the prediction time domain is small, D(k) is considered as constant in the prediction time domain, and does not affect the construction of the objective function. Therefore, the E.sub.kD(k) term can be ignored.
[0092] The model predictive model equation is constructed let. Letting
the state space equation of the predictive model is obtained as follows:
[0095] In the prediction time domain, the predicted value of the output can be calculated by the following equation:
[0098] The objective function is set as follows to ensure a good control effect while smoothing the input of the control variable:
[0100] Considering the constraints on the control variable, the limit value of the control increment and the output, the constraints are organized as follows:
[0101] In this model, the prediction time domain N.sub.p is 5; the control domain N.sub.c is 3;
a simulation step T is 0.01 s; a reference value of the output of the vehicle is represented by Y.sub.ref=[?.sub.ref, ?.sub.ref]; ?.sub.ref is a reference value of the yaw angular velocity; and ?.sub.ref represents a reference value of center-of-mass sideslip angle of the vehicle, which is calculated by the linear two-degree-of-freedom model.
[0102] The objective function J is solved to determine the yaw moment increment ?u(k+i|k) at each moment in the control time domain when the objective function J takes the minimum value.
[0103] (2) The additional yaw moment weighting coefficient is determined.
[0104] A coordination controller is constructed. Since the path tracking performance of the vehicle will be affected after performing the yaw moment control, the coordination controller is constructed based on a reinforcement learning deep deterministic policy gradient (DDPG) algorithm to coordinate the conflict between the trajectory tracking and the stability control, where state inputs are yaw velocity w.sub.r, center-of-mass side slip angle ?, lateral displacement Y, heading angle ?, front wheel steering angle ?.sub.f and lateral acceleration a.sub.y; and an action output is the additional yaw moment weighting coefficient ?(0<?<1) In this case, the path tracking accuracy can be ensured with a stable control on the vehicle. The design principles of a reward function of the coordination controller are described as follows.
[0105] (1) At this time, the vehicle is still not destabilized, and the path tracking requirements should be satisfied first, so let r.sub.1=?(e.sub.y.sup.2+e.sub.?.sup.2)+C.sub.1.
[0106] (2) Since the vehicle is in the critical-destabilized state, to avoid the destabilization of the vehicle, it is necessary to carry out stability control on the vehicle to make it return to the stable state, so let
[0107] (3) During stability control, the discomfort to the driver caused by the generation of additional yaw moment should be minimized, so let r.sub.3=?|a.sub.y|+C.sub.3.
[0108] Finally, the reward function of the coordination controller is r=r.sub.1+r.sub.2+r.sub.3; [0109] where e.sub.y represents a deviation between an actual lateral displacement of the vehicle and a reference path; e.sub.? represents a deviation between the heading angle and a reference heading angle; a.sub.y represents a lateral acceleration of the vehicle; C.sub.1, C.sub.2, and C.sub.3 are constant; c represents a coefficient; k represents a slope; {dot over (?)} represents a center-of-mass sideslip angular velocity of the vehicle; and ? represents a center-of-mass sideslip angle of the vehicle.
[0110] (3) The path tracking control is performed on the vehicle based on the yaw moment increment and the coordinated control weight.
[0111] The yaw moment increment ?u(k+0|k) at a (k+0).sup.th moment in the control time domain is selected to act on the system to obtain a yaw moment u(k) at a current moment k, where u(k)=u(k?1)+?u(k+0|k).
[0112] An additional yaw moment ?M is determined according to the yaw moment u(k) and the additional yaw moment weighting coefficient ?, where ?M=?u(k).
[0113] (4) A longitudinal force on each wheel of the vehicle is determined based on the additional yaw moment ?M in a drive-brake-combined manner.
[0114] After obtaining the output additional jaw moment, the drive-brake-combined method is adopted to convert it into longitudinal forces on four wheels of the vehicle. By adopting the combination of driving and braking, the longitudinal force on the four wheels be reasonably utilized, which can avoid the tire wear caused by braking or driving of a single wheel, and ensure that the speed of the vehicle is unchanged during the control process, thereby reducing the burden of the driver. The relationship between the longitudinal forces at the center of each wheel is as follows:
[0116] (1)
where when ?M>0, F.sub.xft=F.sub.xrl<0 and F.sub.xfr=F.sub.xrr>0; when ?M<0, F.sub.xft=F.sub.xrl>0 and F.sub.xfr=F.sub.xrr<0; and d represents a wheelbase.
[0117] (2) |F.sub.xi|??F.sub.zi, where F.sub.xi represents a longitudinal force of each wheel; i represents a wheel number, corresponding to the left front wheel, the left rear wheel, the right front wheel and the right rear wheel, respectively; F.sub.zi represents a vertical load of each wheel; and ? represents an adhesion coefficient of road surface.
[0118] (3)
where T.sub.max represents the maximum torque of the motor, and r represents a radius of awheel.
[0119] By using the drive-brake combined strategy, the longitudinal force acting on the center of each wheel can be finally obtained to achieve the distribution of the additional yaw moment.
[0120] In an embodiment, when the vehicle is in the destabilized state, the second yaw moment increment of the vehicle is determined, and the path tracking control is performed based on the second yaw moment increment through the following steps.
[0121] An objective function J is constructed:
[0123] The objective function J; is solved to determine the yaw moment increment ?u(k+i|k) at each moment within the control time domain when the objective function J reaches a minimum value.
[0124] The yaw moment increment ?u(k+0|k) at a (k+0).sup.th moment in the control time domain is selected to act on the system to obtain a yaw moment u(k) at a current moment k, where u(k)=u(k?1)+?u(k+0|k).
[0125] An additional yaw moment ?M is determined according to the yaw moment u(k) and the additional yaw moment weighting coefficient ?, where ?M=?u(k).
[0126] A longitudinal force on each wheel of the vehicle is determined based on the additional yaw moment ?M in a drive-brake-combined manner.
[0127] In this embodiment, the specific calculation of the longitudinal force on each wheel of the vehicle refers to the calculation method mentioned in the aforementioned embodiment where the vehicle is in a critical-destabilized state, and will not be repeated herein.
[0128] Based on the same inventive conception as the aforementioned path tracking control method, the present disclosure also provides a path tracking control device corresponding thereto.
[0129] The lateral stability state determination module 210 is configured to determine a lateral stability state of a vehicle, where the lateral stability state comprises a stable state, a critical-destabilized state, and a destabilized state.
[0130] The path tracking control module 220 is configured to perform path tracking control on the vehicle according to the lateral stability state of the vehicle, determine a front wheel steering increment of the vehicle when the vehicle is in the stable state, determine a front wheel steering of the vehicle based on the front wheel steering increment of the vehicle, determine a first yaw moment increment and an additional yaw moment weighting coefficient of the vehicle when the vehicle is in the critical-destabilized state, determine a first additional yaw moment based on the first yaw moment increment and the additional yaw moment weighting coefficient, determine a first longitudinal force on each wheel of the vehicle based on the first additional yaw moment, determine a second yaw moment increment of the vehicle when the vehicle is in the destabilized state, determine a second additional yaw moment based on the second yaw moment increment, and determine a second longitudinal force on each wheel based on the second additional yaw moment.
[0131] The present disclosure also provides a computer-readable storage medium. The computer-readable storage medium is configured to store a computer program, and the computer program is configured to be executed by a processor to implement the aforementioned path tracking control method.
[0132] The present disclosure also provides a computer program product, which includes a computer program or a computer instruction, where the computer program or the computer instruction is configured to be executed by a processor to implement the aforementioned path tracking control method.
[0133] In the embodiments provided herein, it should be understood that the disclosed devices and methods may also be realized in other ways. The device embodiments described above are merely schematic. For example, the flow chart and the block diagram in the accompanying drawings show the architecture, functionality, and operation of possible implementations of devices, methods, and computer program products according to a plurality of embodiments of the present application. In this regard, each box in the flow chart or the block diagram may represent a module, a program segment, or a portion of codes, which contains one or more executable instructions for implementing a prescribed logical function. It should also be noted that in some implementations as substitutions, the functions labeled in the boxes may also occur in a different order than those labeled in the accompanying drawings. For example, two consecutive boxes can actually be executed substantially in parallel, or in reverse order, depending on the involved function. Moreover, each box in the block diagram and/or flowchart, and combinations of boxes in the block diagram and/or flowchart, may be implemented with a specialized hardware-based system that performs the specified function or action, or may be implemented with a combination of specialized hardware and computer instructions.
[0134] In addition, the various function modules in various embodiments of the present application may be integrated together to form a separate part, or the individual modules may stand alone, or two or more modules may be integrated to form a separate part.
[0135] The functions may be stored in a computer-readable storage medium if implemented as software function modules and sold or used as a separate product. Based on this, the technical solutions of the present application may be embodied in the form of a software product, which is essentially or in part a contribution to the prior art, or part of the technical solution may be embodied in the form of a software product. The computer program product is stored in a storage medium, and includes a series of instructions to make a computer device (a personal computer, a server, or a network device, etc.) to carry out all or part of the steps of the method described in the various embodiments of the present application. The aforementioned storage medium can store program codes, and can be a USB flash drive, a removable hard disk, a read-only memory (ROM), a random-access memory (RAM), a diskette or a compact disc.
[0136] Described above are merely various embodiments of the present application, but the scope of protection of the present application is not limited thereto. Any changes or substitutions within the scope of the technology disclosed in the present application can be easily obtained by one of ordinary skilled in the art, and shall be included in the scope of protection of the present application. Therefore, the scope of protection of the present application shall be defined by the claims.