Intelligent vehicle layered control method combining four-wheel steering and differential braking

文档序号:1636413 发布日期:2020-01-17 浏览:36次 中文

阅读说明:本技术 一种四轮转向联合差动制动的智能车辆分层控制方法 (Intelligent vehicle layered control method combining four-wheel steering and differential braking ) 是由 朱梁鹏 刘成晔 赵景波 朱燕 于 2019-09-19 设计创作,主要内容包括:本发明公开一种四轮转向联合差动制动的无人驾驶车辆分层控制方法,以非线性模型预测(MPC)算法设计联合控制器,对车辆进行四轮转向和差动制动控制。该方法具有三层控制结构,上层为轨迹规划层,实现对车辆纵向、横向以及横摆角跟踪,输出理想横摆角速度和质心侧偏角;中间层为MPC集中控制层,实现车辆后轮转角控制和附加横摆力矩控制;下层为制动力分配器,通过附加横摆力矩的计算,转化为对单个车轮的制动控制;最终,MPC联合控制器输出的四轮转角和差动制动力作用于整车,实现目标路径的稳定性跟踪。本方法利用MPC控制方法滚动优化的特性,在提高跟踪精度的基础上,实现了四轮转向和差动制动的联合控制,提高了高速车况下智能汽车轨迹跟踪的稳定性。(The invention discloses a four-wheel steering and differential braking combined unmanned vehicle hierarchical control method, which designs a combined controller by a nonlinear Model Prediction (MPC) algorithm to control four-wheel steering and differential braking of a vehicle. The method has a three-layer control structure, the upper layer is a track planning layer, so that the longitudinal, transverse and yaw angles of the vehicle are tracked, and an ideal yaw angular speed and a centroid side slip angle are output; the middle layer is an MPC centralized control layer to realize the control of the rear wheel steering angle and the control of the additional yaw moment of the vehicle; the lower layer is a braking force distributor which is converted into braking control on a single wheel through the calculation of an additional yaw moment; finally, the MPC is combined with the four-wheel corner and the differential braking force output by the controller to act on the whole vehicle, so as to realize the stability tracking of the target path. The method utilizes the rolling optimization characteristic of the MPC control method, realizes the combined control of four-wheel steering and differential braking on the basis of improving the tracking precision, and improves the stability of intelligent automobile track tracking under the condition of high-speed automobiles.)

1. A layered control method for four-wheel steering combined differential braking is characterized in that: the device has a three-layer control structure, which specifically comprises the following steps:

and (3) upper layer: the track planning layer is used for tracking the longitudinal direction, the transverse direction and the yaw angle of the vehicle and outputting an ideal yaw angular speed and a centroid side slip angle;

an intermediate layer: the MPC centralized control layer realizes the control of the rear wheel steering angle and the control of the additional yaw moment of the vehicle;

the lower layer: the braking force distributor is used for converting the calculation of the additional yaw moment into braking control on a single wheel;

finally, the MPC is combined with the four-wheel corner and the differential braking force output by the controller to act on the whole vehicle, so as to realize the stability tracking of the target path.

2. The hierarchical control method of four-wheel steering combined differential braking according to claim 1, characterized in that: the specific control process of the upper track planning layer is as follows:

(1) an MPC controller of an upper track planning layer is established to realize front wheel steering control

(1.1) building a vehicle kinematic model according to a vehicle monorail model, and writing the vehicle kinematic model into a state space expression form:

Figure FDA0002207863800000011

wherein the state quantities are:

Figure FDA0002207863800000012

in the formula: x is the longitudinal displacement of the vehicle, Y is the transverse displacement of the vehicle,

Figure FDA0002207863800000013

the control quantity is selected as follows:

u=[v,δf]T

in the formula: v is the central speed of the rear axle of the vehicle, deltafA front wheel deflection angle;

(1.2) carrying out linear processing on the vehicle kinematic nonlinear model shown by the formula to obtain a linear time-varying system as follows:

Figure FDA0002207863800000014

(1.3) discretizing the formula by a first-order difference quotient method to obtain a discrete state space expression:

Figure FDA0002207863800000015

wherein: a. thek=I+A*T;Bk=I+B*T;

(1.4) setting a certain moment in the vehicle track tracking process as a time t, and establishing the following objective function for solving the front wheel rotation angle at the time t:

Figure FDA0002207863800000021

in the formula: n is a radical ofPIs a prediction time domain; n is a radical ofcIs a control time domain; rho is a weight coefficient; epsilon is a relaxation factor;

(1.5) the formula replaces the control quantity with the control increment to control the system, so the formula is rewritten as a state space equation of the control increment formula:

Figure FDA0002207863800000022

Figure FDA0002207863800000023

wherein:

Figure FDA0002207863800000024

(1.6) constraining the control quantity and the control increment in the control process:

umin(k+1)<u<umax(k+1)

Δumin(k+1)<Δu<Δumax(k+1)

(1.7) solving the objective function to obtain a series of control input increments in the control time domain

Figure FDA0002207863800000025

Applying the first element in the control sequence at time t as a control input increment to the system, namely:

u(t)=u(t-1)+Δu(t)

(1.8) repeating the steps at the time t +1 to complete the tracking of the expected track and obtain a series of control quantities v, deltaf

(2) Establishing an ideal vehicle following model, and calculating an ideal mass center slip angle and a yaw angular velocity under trajectory tracking

(2.1) vehicle ideal centroid cornering angle model

The ideal centroid slip angle at vehicle steady state is:

Figure FDA0002207863800000026

in the formula: l is the wheelbase; lfIs the centroid to front wheel distance; lrIs the distance from the center of mass to the rear wheel; k is a radical ofrIs rear wheel cornering stiffness;

the centroid slip angle at the maximum adhesion limit of the tire is:

Figure FDA0002207863800000027

in the formula: μ is the attachment rate; g is the acceleration of gravity;

the ideal vehicle centroid slip angle is:

βd=min(|βideal|,|βmax|)·sgn(βideal)

(2.2) model of ideal yaw rate of vehicle

Figure FDA0002207863800000031

The maximum yaw acceleration at the tire adhesion limit is:

Figure FDA0002207863800000032

the ideal vehicle yaw rate is:

rd=min(|rideal|,|rmax|)·sgn(rideal)。

3. the hierarchical control method of four-wheel steering combined differential braking according to claim 2, characterized in that: the specific control process of the middle layer MPC centralized control layer is as follows: establishing an intermediate-layer MPC controller, calculating an additional yaw moment generated by braking force, and realizing rear wheel steering angle control;

(1) establishing a vehicle four-wheel steering and differential braking combined dynamic model, and rewriting the model into a state space expression form:

Figure FDA0002207863800000033

wherein the state quantities are:

x=[β,r]T

in the formula: beta is the vehicle mass center slip angle, r is the vehicle yaw rate,

Figure FDA0002207863800000034

the control quantity is selected as follows:

u=[δr,Ms]T

in the formula: msAdditional yaw moment, delta, generated for brakingrA rear wheel deflection angle;

(2) the vehicle kinematics nonlinear model shown in the formula is subjected to linear processing to obtain a linear time-varying system as follows:

(3) discretizing the formula by a first-order difference quotient method to obtain a discrete state space expression:

Figure FDA0002207863800000036

wherein: a. thek=I+A*T;Bk=I+B*T;

(4) Setting a certain moment in the vehicle track tracking process as a moment t, and establishing the following objective function for solving the front wheel rotation angle at the moment t:

Figure FDA0002207863800000037

in the formula: n is a radical ofPIs a prediction time domain; n is a radical ofcIs a control time domain; rho is a weight coefficient; epsilon is a relaxation factor

(5) The formula replaces the control quantity with the control increment to carry out the control of the system, so the formula is rewritten into a state space equation of the control increment formula:

Figure FDA0002207863800000038

Figure FDA0002207863800000041

wherein:

Figure FDA0002207863800000042

(6) and (3) constraining the control quantity and the control increment in the control process:

umin(k+1)<u<umax(k+1)

Δumin(k+1)<Δu<Δumax(k+1)

(7) solving the objective function to obtain a series of control input increments in the control time domain

Figure FDA0002207863800000043

Applying the first element in the control sequence at time t as a control input increment to the system, namely:

u(t)=u(t-1)+Δu(t)

(8) repeating the steps at the moment of t +1 to complete the tracking of the expected track and obtain a series of control quantities Msr

4. A hierarchical control method of four-wheel steering combined differential braking according to claim 3, characterized in that: the specific control process of the lower-layer braking force distributor is as follows:

(1) vehicle steering condition determination

In the formula:

Figure FDA0002207863800000045

when K is1=0,

Figure FDA0002207863800000046

Neutral steering: k is equal to 0, and K is equal to 0,

Figure FDA0002207863800000047

oversteer: k<0,

Figure FDA0002207863800000048

understeer: k>0,Decrease;

(2) single wheel brake pressure calculation

Figure FDA00022078638000000410

(3) Brake application decision

Technical Field

The invention relates to the field of intelligent vehicle control, in particular to a track tracking layered control method for an unmanned vehicle with four-wheel steering combined with differential braking.

Background

The existing path tracking control of the unmanned vehicle mostly carries out transverse tracking control through front wheel steering, the stability of the vehicle cannot be ensured only by the front wheel steering control under the high-speed working condition due to strong nonlinearity of a vehicle model, and the design and application difficulty of an over-integrated control algorithm is too high, so that the comprehensive consideration of the four-wheel steering combined differential braking hierarchical control is an effective way for solving the path tracking stability of the unmanned vehicle.

Disclosure of Invention

In order to solve the problems of unmanned vehicle path tracking control precision and vehicle stability, the invention provides a layered control method of four-wheel steering combined differential braking, which aims to: a combined controller is designed by a nonlinear Model Prediction (MPC) algorithm, four-wheel steering and differential braking control is carried out on the vehicle, and stable tracking of an expected path under a high-speed vehicle condition is realized.

In order to achieve the purpose, the invention adopts the technical scheme that:

a layered control method for four-wheel steering combined differential braking has a three-layer control structure, and specifically comprises the following steps:

and (3) upper layer: the track planning layer is used for tracking the longitudinal direction, the transverse direction and the yaw angle of the vehicle and outputting an ideal yaw angular speed and a centroid side slip angle;

an intermediate layer: the MPC centralized control layer realizes the control of the rear wheel steering angle and the control of the additional yaw moment of the vehicle;

the lower layer: the braking force distributor is used for converting the calculation of the additional yaw moment into braking control on a single wheel;

finally, the MPC is combined with the four-wheel corner and the differential braking force output by the controller to act on the whole vehicle, so as to realize the stability tracking of the target path.

Specifically, the method comprises the following steps:

a first layer: kinematics based MPC control

1 establishing an MPC controller of an upper track planning layer to realize front wheel steering control

1.1 according to the vehicle single-track model, a vehicle kinematic model is established and written into a state space expression form as follows:

Figure BDA0002207863810000011

wherein the state quantities are:

Figure BDA0002207863810000021

in the formula: x is the longitudinal displacement of the vehicle, Y is the transverse displacement of the vehicle,

Figure BDA0002207863810000022

is the vehicle yaw angle;

the control quantity is selected as follows:

u=[v,δf]T

in the formula: v is the central speed of the rear axle of the vehicle, deltafFor deflecting the angle of the front wheel

1.2, carrying out linear processing on the vehicle kinematic nonlinear model shown by the formula to obtain a linear time-varying system as follows:

Figure BDA0002207863810000023

1.3 discretizing the formula by a first-order difference quotient method to obtain a discrete state space expression:

Figure BDA0002207863810000024

wherein: a. thek=I+A*T;Bk=I+B*T;

1.4, setting a certain moment in the vehicle track tracking process as a moment t, and establishing the following objective function for solving the front wheel rotation angle at the moment t:

Figure BDA0002207863810000025

in the formula: n is a radical ofPIs a prediction time domain; n is a radical ofcIs a control time domain;rho is a weight coefficient; epsilon is a relaxation factor

1.5 formula replaces the controlled variable with the control increment to control the system, so the formula is rewritten as a state space equation of the control increment formula:

Figure BDA0002207863810000026

Figure BDA0002207863810000027

wherein:

Figure BDA0002207863810000028

1.6, the control quantity and the control increment in the control process are restrained:

umin(k+1)<u<umax(k+1)

Δumin(k+1)<Δu<Δumax(k+1)

1.7 solving the objective function to obtain a series of control input increments in the control time domain

Figure BDA0002207863810000029

Applying the first element in the control sequence at time t as a control input increment to the system, namely:

u(t)=u(t-1)+Δu(t)

1.8 repeating the steps at the moment t +1 to complete the tracking of the expected track and obtain a series of control quantities v, deltafA second layer: ideal following model

2. Establishing an ideal vehicle following model, and calculating an ideal mass center slip angle and a yaw angular velocity under trajectory tracking

2.1 vehicle ideal centroid cornering angle model

The ideal centroid slip angle at vehicle steady state is:

Figure BDA0002207863810000031

in the formula: l is the wheelbase; lfIs the centroid to front wheel distance; lrIs the distance from the center of mass to the rear wheel; k is a radical ofrThe centroid slip angle under the maximum adhesion limit of the tire with the rear wheel side slip stiffness is as follows:

in the formula: μ is the attachment rate; g is the acceleration of gravity

The ideal vehicle centroid slip angle is:

βd=min(|βideal|,|βmax|)·sgn(βideal)

2.2 model of ideal yaw rate of vehicle

Figure BDA0002207863810000033

The maximum yaw acceleration at the tire adhesion limit is:

Figure BDA0002207863810000034

the ideal vehicle yaw rate is:

rd=min(|rideal|,|rmax|)·sgn(rideal)

and a third layer: middle control layer

3. An intermediate-layer MPC controller is established, an additional yaw moment generated by braking force is calculated, and rear wheel steering angle control is realized

3.1, establishing a vehicle four-wheel steering and differential braking combined dynamic model, and rewriting the model into a state space expression form:

Figure BDA0002207863810000036

wherein the state quantities are:

x=[β,r]T

in the formula: beta is the vehicle mass center slip angle, r is the vehicle yaw rate,

Figure BDA0002207863810000035

a front wheel deflection angle;

the control quantity is selected as follows:

u=[δr,Ms]T

in the formula: msAdditional yaw moment, delta, generated for brakingrFor deflecting the angle of the rear wheel

3.2, carrying out linear processing on the vehicle kinematic nonlinear model shown by the formula to obtain a linear time-varying system as follows:

Figure BDA0002207863810000041

3.3 discretizing the formula by a first-order difference quotient method to obtain a discrete state space expression:

wherein: a. thek=I+A*T;Bk=I+B*T;

3.4, setting a certain moment in the vehicle track tracking process as a moment t, and establishing the following objective function for solving the front wheel rotation angle at the moment t:

Figure BDA0002207863810000043

in the formula: n is a radical ofPIs a prediction time domain; n is a radical ofcIs a control time domain; rho is a weight coefficient; epsilon is a relaxation factor;

and 3.5, replacing the control quantity with the control increment to carry out system control by adopting a control increment formula, and therefore rewriting the formula into a state space equation of the control increment formula:

Figure BDA0002207863810000044

wherein:

3.6, the control quantity and the control increment in the control process are restrained:

umin(k+1)<u<umax(k+1)

Δumin(k+1)<Δu<Δumax(k+1)

3.7 solving the objective function to obtain a series of control input increments in the control time domain

Figure BDA0002207863810000047

Applying the first element in the control sequence at time t as a control input increment to the system, namely:

u(t)=u(t-1)+Δu(t)

3.8 repeating the steps at the moment t +1 to complete the tracking of the expected track and obtain a series of control quantities MsrA fourth layer: braking force distribution layer

4.1 vehicle steering Condition discrimination

Figure BDA0002207863810000048

In the formula:

Figure BDA0002207863810000049

when K is1=0,

Figure BDA0002207863810000051

Neutral steering: k is equal to 0, and K is equal to 0,

Figure BDA0002207863810000052

is the median value;

over-rotationThe method comprises the following steps: k<0,

Figure BDA0002207863810000053

Increasing;

understeer: k>0,

Figure BDA0002207863810000054

Decrease;

4.1 Single-wheel brake pressure calculation

Figure BDA0002207863810000055

4.2 brake application decisions

Figure BDA0002207863810000056

Compared with the prior art, the invention has the following beneficial effects:

1. the invention designs an intelligent vehicle track tracking layered control method of four-wheel steering combined differential braking considering vehicle stability, which tracks an expected path through an upper track planning layer, optimizes and calculates a rear wheel corner and an additional yaw moment control quantity by using a front wheel corner, an expected yaw velocity and a mass center sideslip angle planned by the upper layer through an intermediate layer, and distributes braking force through a lower layer controller, thereby realizing the active adjustment of four-wheel corners and differential braking of an unmanned vehicle and improving the stability of vehicle track tracking.

2. The invention brings the four-wheel steering control into the control algorithm, and improves the maneuverability and the stability of the vehicle under the high-speed working condition.

3. The invention realizes the differential braking control of the track tracking, and can actively adjust the steering angle and the braking moment of the rear wheel of the automobile, thereby optimizing the mass center slip angle, the yaw velocity and the lateral displacement of the automobile and improving the track tracking stability of the intelligent vehicle under the high-speed working condition.

4. The method adopts the model prediction controller as a control algorithm, carries out real-time prediction and rolling optimization on the control target, processes the multi-constraint optimization problem, and greatly improves the stability of track tracking.

Drawings

Other features, objects and advantages of the invention will become more apparent upon reading of the detailed description of non-limiting embodiments with reference to the following drawings:

FIG. 1 is a diagram of a vehicle kinematic model according to the present invention;

FIG. 2 is a frame diagram of a hierarchical control algorithm of an intelligent vehicle with four-wheel steering combined with differential braking according to the present invention;

FIG. 3 is a control strategy simulation diagram of the present invention;

FIG. 4 is a diagram of a trace-tracking simulation result of the present invention;

FIG. 5 is a diagram of a simulation result of four wheel turning angles according to the present invention;

FIG. 6 is a diagram showing the simulation result of four wheel longitudinal force according to the present invention.

Detailed Description

In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention.

Referring to fig. 1-5, the invention relates to a four-wheel steering combined differential braking unmanned vehicle layered control method, which has a three-layer control structure. The upper layer is a track planning layer, so that the longitudinal, transverse and yaw angles of the vehicle are tracked, and an ideal yaw rate and a centroid side slip angle are output. The middle layer is an MPC centralized control layer, and the control of the rear wheel steering angle and the control of the additional yaw moment of the vehicle are realized. The lower layer is a braking force distributor which is converted into braking control of a single wheel through calculation of an additional yaw moment. Finally, the MPC is combined with the four-wheel corner and the differential braking force output by the controller to act on the whole vehicle, so as to realize the stability tracking of the target path.

A first layer: upper track following control layer

The design of the upper layer model predicted trajectory tracking controller is explained in detail below with reference to fig. 1:

1. vehicle kinematics modeling

Figure BDA0002207863810000061

Figure BDA0002207863810000062

Figure BDA0002207863810000063

In the formula: l is the vehicle wheel base; v is the vehicle rear axle center speed; deltafFor deflecting the angle of the front wheel

2. From the formula, it can be derived as a state space expression of the form:

Figure BDA0002207863810000064

wherein the state quantities are:

in the formula: x is the longitudinal displacement of the vehicle, Y is the transverse displacement of the vehicle,

Figure BDA0002207863810000072

is the vehicle yaw angle;

the control quantity is selected as follows:

u=[v,δf]T

in the formula: v is the central speed of the rear axle of the vehicle, deltafFor deflecting the angle of the front wheel

3. Establishing a linear error equation

3.1 because the vehicle model has the non-linear characteristic, the model needs to be linearized, because the expected input can not give the information of all state points, the invention adopts the approximate linearization method to linearize the model, applies the constant control quantity of a certain working point to the system, designs the control algorithm according to the deviation of the track and the actual state of the working point, considers a certain working of the systemIs represented by the following formula0,u0],x0To always apply a control quantity of u0The system state quantity obtained later is

x0(k+1)=f(x0(k),u0)

x0(0)=x0

By derivation, it can be obtained that:

Figure BDA0002207863810000073

in the formula:

Figure BDA0002207863810000074

3.2 discretizing the formula by a first-order difference quotient method to obtain a discrete state space expression:

Figure BDA0002207863810000075

y(k)=Ckx(k)

wherein:

Figure BDA0002207863810000077

Figure BDA0002207863810000078

3.3 formula replaces the controlled variable with the control increment to control the system, so the formula is rewritten as a state space equation of the control increment formula:

Figure BDA0002207863810000079

Figure BDA0002207863810000081

wherein:

Figure BDA0002207863810000082

3.4 through derivation, a prediction output expression of the system can be obtained:

Figure BDA0002207863810000089

Figure BDA0002207863810000083

Figure BDA0002207863810000085

Figure BDA0002207863810000087

4. establishing rolling time domain optimization controller

4.1 for the trajectory tracking control problem, the following control objective function is established

Figure BDA0002207863810000088

In the formula: n is a radical ofPIs a prediction time domain; n is a radical ofcIs a control time domain; rho is a weight coefficient; epsilon is a relaxation factor; q and R are weight matrixes.

4.2 in order to increase the smoothness of the track tracking, the control quantity and the control increment need to be restrained:

umin(t+k)≤u(t+k)≤umax(t+k)

Δumin(t+k)≤Δu(t+k)≤Δumax(t+k)

in the formula: Δ u is the control increment, uminFor controlling incremental minimums, umaxSetting the control quantity limit to u for control increment maximum the present inventionmin=[-0.2-0.6]T,umax=[0.2 0.6]T,Δumin=[-0.34-0.02]T,Δumax=[0.02]TYmax=[-3-0.3]T,Ymin=[3 0.3]T

4.3 converting the objective function into a standard quadratic form and combining constraint conditions to solve the following optimization problems:

J(ξ(t),u(t-1),ΔU(t))=[ΔU(t)T,ε]Ht[ΔU(t)T,ε]+Gt[ΔU(t)T,ε]

Figure BDA0002207863810000091

Figure BDA0002207863810000092

Figure BDA0002207863810000093

in the formula:

Figure BDA0002207863810000094

etfor predicting tracking errors in the time domain

4.3 solving the objective function to obtain a series of control input increments in the control time domain

Figure BDA0002207863810000095

Applying the first element in the control sequence at time t as a control input increment to the system, namely:

u(t)=u(t-1)+Δu(t)

repeating the steps at the moment t +1 to finish the pairThe desired trajectory is tracked, resulting in a series of control quantities v, deltaf

A second layer: ideal following model

2. Establishing an ideal vehicle following model, and calculating an ideal mass center slip angle and a yaw angular velocity under trajectory tracking

2.1 vehicle ideal centroid cornering angle model

The ideal centroid slip angle at vehicle steady state is:

Figure BDA0002207863810000096

in the formula: l is the wheelbase; lfIs the centroid to front wheel distance; lrIs the distance from the center of mass to the rear wheel; k is a radical ofrThe centroid slip angle under the maximum adhesion limit of the tire with the rear wheel side slip stiffness is as follows:

Figure BDA0002207863810000097

in the formula: μ is the attachment rate; g is the acceleration of gravity

The ideal vehicle centroid slip angle is:

βd=min(|βideal|,|βmax|)·sgn(βideal)

2.2 model of ideal yaw rate of vehicle

Figure BDA0002207863810000101

The maximum yaw acceleration at the tire adhesion limit is:

Figure BDA0002207863810000102

the ideal vehicle yaw rate is:

rd=min(|rideal|,|rmax|)·sgn(rideal)

and a third layer: middle control layer

1. Vehicle kinematics modeling

Figure BDA0002207863810000103

In the formula: i is rotational inertia; lf,lrIs the wheelbase; k is a radical off,krFor side deflection rigidity of front and rear wheels

2. From the formula, it can be derived as a state space expression of the form:

Figure BDA0002207863810000105

wherein the state quantities are:

x=[β,r]T

in the formula: beta is the vehicle mass center slip angle, r is the vehicle yaw rate,a front wheel deflection angle;

the control quantity is selected as follows:

u=[δr,Ms]T

in the formula: msAdditional yaw moment, delta, generated for brakingrFor deflecting the angle of the rear wheel

3. Establishing a linear error equation

3.1 because the vehicle model has the non-linear characteristic, the model needs to be linearized, because the expected input can not give the information of all state points, the invention adopts the approximate linearization method to linearize the model, applies the constant control quantity of a certain working point to the system, designs the control algorithm according to the deviation of the track and the actual state of the working point, considers that the certain working point of the system is [ x [ ]0,u0],x0To always apply a control quantity of u0The system state quantity obtained later is

x0(k+1)=f(x0(k),u0)

x0(0)=x0

By derivation, it can be obtained that:

Figure BDA0002207863810000111

in the formula:

Figure BDA0002207863810000112

3.2 discretizing the formula by a first-order difference quotient method to obtain a discrete state space expression:

Figure BDA0002207863810000113

wherein:

Figure BDA0002207863810000114

Figure BDA0002207863810000115

3.3 formula replaces the controlled variable with the control increment to control the system, so the formula is rewritten as a state space equation of the control increment formula:

Figure BDA0002207863810000116

Figure BDA0002207863810000117

wherein:

Figure BDA0002207863810000118

the formula replaces the control quantity with the control increment to carry out the control of the system, so the formula is rewritten into a state space equation of the control increment formula:

Figure BDA0002207863810000119

Figure BDA00022078638100001110

wherein:

Figure BDA00022078638100001111

3.4 through derivation, a prediction output expression of the system can be obtained:

Figure BDA00022078638100001112

Figure BDA00022078638100001113

Figure BDA0002207863810000121

Figure BDA0002207863810000122

Figure BDA0002207863810000124

4. establishing rolling time domain optimization controller

4.1 for the trajectory tracking control problem, the following control objective function is established

Figure BDA0002207863810000125

In the formula: n is a radical ofPIs a prediction time domain; n is a radical ofcIs a control time domain; rho is a weight coefficient; epsilon is relaxationA factor; q and R are weight matrixes.

4.2 in order to increase the smoothness of the track tracking, the control quantity and the control increment need to be restrained:

umin(t+k)≤u(t+k)≤umax(t+k)

Δumin(t+k)≤Δu(t+k)≤Δumax(t+k)

in the formula: Δ u is the control increment, uminFor controlling incremental minimums, umaxFor control increment maximum the invention sets the control quantity limit to:

umin=[-0.6 -100]T,umax=[0.2 100]T,Δumin=[-0.34 -5]T,Δumin=[0.34 5]T,Ymax=[-1.5 -10]T,Ymin=[1.5 10]T

4.3 converting the objective function into a standard quadratic form and combining constraint conditions to solve the following optimization problems:

J(ξ(t),u(t-1),ΔU(t))=[ΔU(t)T,ε]Ht[ΔU(t)T,ε]+Gt[ΔU(t)T,ε]

Figure BDA0002207863810000132

Figure BDA0002207863810000133

in the formula:etfor predicting tracking errors in the time domain

4.3 solving the objective function to obtain a series of control input increments in the control time domain

Figure BDA0002207863810000135

Applying the first element in the control sequence at time t as a control input increment to the system, namely:

u(t)=u(t-1)+Δu(t)

repeating the steps at the moment of t +1 to complete the tracking of the expected track and obtain a series of control quantities deltar,Ms

A fourth layer: braking force distribution layer

4.1 vehicle steering Condition discrimination

Figure BDA0002207863810000136

In the formula:

Figure BDA0002207863810000137

when K is1=0,

Figure BDA0002207863810000138

Neutral steering: k is equal to 0, and K is equal to 0,

Figure BDA0002207863810000139

is the median value;

oversteer: k<0,

Figure BDA00022078638100001310

Increasing;

understeer: k>0,

Figure BDA00022078638100001311

Decrease;

4.1 Single-wheel brake pressure calculation

Figure BDA00022078638100001312

4.2 brake application decisions

Figure BDA00022078638100001313

Figure BDA0002207863810000141

The technical means disclosed in the invention scheme are not limited to the technical means disclosed in the above embodiments, but also include the technical scheme formed by any combination of the above technical features. All other embodiments, which can be obtained by a person skilled in the art without any inventive step based on the embodiments of the present invention, are within the scope of the present invention.

20页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:用于产生影响汽车车轮滑转调节的指令信号的设备和方法

网友询问留言

已有0条留言

还没有人留言评论。精彩留言会获得点赞!

精彩留言,会给你点赞!

技术分类