Disclosure of Invention
The invention aims to provide an automatic driving switching method and device based on a C-EPS system. The invention can effectively switch the driving modes according to the driving conditions of the driver, thereby reducing the harm brought by driving. In addition, the invention can also realize the perception of the road surface quality and the adhesion coefficient of the road surface so as to improve the accuracy and the safety of the automatic driving system to the vehicle control.
The technical scheme of the invention is as follows: an automatic driving switching method based on a C-EPS system comprises a driving system, wherein an automatic driving mode, an emergency steering mode and a manual driving mode are arranged in the driving system; in the manual driving mode, the C-EPS system is in a power-assisted mode; in the automatic driving mode, the C-EPS system is in an active steering mode; in the emergency steering mode, the C-EPS system is in an emergency power-assisted active steering mode; the C-EPS system calculates a lower threshold and an upper threshold of the steering wheel input torque according to the rotating speed and the rotating inertia of the steering wheel; when the steering wheel input torque is smaller than a lower threshold value, the vehicle is switched to an automatic driving mode, and when the steering wheel input torque is larger than the lower threshold value, the vehicle is switched to an artificial driving mode; after the manual driving mode is switched, when the angular acceleration of the steering wheel is larger than the angular acceleration threshold of the steering wheel, and the input torque of the steering wheel exceeds the upper threshold of the input torque of the steering wheel, the driving system judges that the vehicle is in an emergency state, if the steering wheel angle controlled by the driver is in the same direction as the target steering wheel angle of the C-EPS system and the steering wheel angle approaches to the target steering wheel angle, the driving system is switched to the emergency steering mode, and the manual driving mode is assisted to complete the avoidance of the emergency.
In the automatic driving switching method based on the C-EPS system, the lower threshold of the steering wheel input torque is as follows:
in the formula: i is
cIs the steering wheel moment of inertia;
is the angular acceleration of the steering wheel, i.e. the second derivative of the steering wheel angle;
in the foregoing automatic driving switching method based on the C-EPS system, the calculation process of the steering wheel angular acceleration threshold and the upper threshold of the steering wheel input torque is as follows: establishing a model of a C-EPS system:
in the formula: a is a system state space matrix, represented as:
Kcthe steering column mandrel stiffness; b iscDamping the steering column; j. the design is a squarecIs the rotational inertia of the steering column; j is the reduction ratio of the steering motor reducer; j. the design is a squareeqEquivalent rotational inertia of a steering transmission mechanism and a steering gear; keqThe equivalent rigidity of a steering transmission mechanism and a steering gear is provided; b iseqThe damping is equivalent to a steering transmission mechanism and a steering gear; kbIs the steering motor electromagnetic torque constant; keIs the counter electromotive force coefficient of the steering motor; rmIs the armature inductance of the steering motor; l ismArmature resistance of steering motor;
θ
cis the steering wheel angle;
steering wheel speed, the first derivative of steering wheel angle; theta
mIs the motor corner;
is the rotating speed of the steering motor, namely the first derivative of the rotating angle of the steering motor; i is
mIs the current of the steering motor; b is
1To control the matrix, it is expressed as:
u=u
dis the driving voltage; b is
2Is an interference input matrix, expressed as:
w is the interference input, w ═ T
hT
R]
T,T
hFor steering input torque, when in the automatic driving mode, T
h=0;T
RIs the steering drag torque;
T
moutputting torque for a steering motor; c is the output matrix, expressed as:
according to a mathematical model of vehicle dynamics and a steering input torque T
hVehicle speed v and current I of steering motor
mCalculated power-assisted torque T
cCalculating the yaw angular velocity beta and the lateral acceleration a under the current vehicle speed in real time
y(ii) a When yaw rate beta and lateral acceleration a
yAre all larger than the upper threshold value of the yaw rate under the current vehicle speed
And an upper threshold for lateral acceleration
Current steering input torque T
hAnd angular acceleration of steering wheel
I.e. the upper threshold value of the steering wheel input torque at the current vehicle speed
And steering wheel angular acceleration threshold
The yaw rate upper threshold value
And an upper threshold for lateral acceleration
Respectively as follows:
β(v)=βmax(v)·k2;
aymax(v) maximum lateral acceleration at the current vehicle speed, betamax(v) Is the maximum yaw rate, k, at the current vehicle speed1And k2The safety factors are respectively, and the value is 0.5-0.7.
In the automatic driving switching method based on the C-EPS system, in an automatic driving mode, an automatic driving decision layer is used for releasing a steering control law that a steering system target corner gives to the C-EPS system, the steering control law controls a driving voltage to drive a steering motor to complete steering of the steering system, and in the steering process of the steering system, the steering resistance reference value, the steering resistance estimation value and the current estimation value of the steering motor are used for judging the road surface quality and the road surface adhesion coefficient, so that the road surface quality and the road surface adhesion coefficient are sensed.
According to the automatic driving switching method based on the C-EPS system, the steering resistance reference value is calculated according to the steering wheel angle and the automobile speed, and the steering resistance estimation value is calculated according to the steering wheel angle, the current of a steering motor and the driving voltage; calculating the current estimation value of the steering motor according to the steering resistance estimation value and the target rotation angle of the steering system; the method specifically comprises the following steps:
when in the automatic driving mode, D ═ B2 B1]TAnd constructing an unknown input observer:
in the formula, DTIs a transpose of matrix D; e is the base number of the natural logarithm; i is an identity matrix having the same dimension as matrix A;
obtaining the interference input w of the C-EPS system at the time k according to each parameter value in the x matrix of the C-EPS system at the time k +1, thereby obtaining the estimated value of the steering resistance at the time k
Calculating a steering resistance reference value T according to the automobile mathematical model and the automobile driving and steering working conditionsR0:
In the formula: f is TR0Refers to a calculation function; v is vehicle speed; mu.s0Taking 0.7 by reference to the adhesion coefficient;
steering the system by a target angle theta
refAngle of rotation theta of steering wheel
cThe subtracted value is input into a PID controller and output to obtain a driving voltage u
d(ii) a According to the rotation speed of the steering motor
And steering motor back electromotive force coefficient K
eCalculating to obtain induced electromotive force epsilon, and driving voltage u
dSubtracting the induced electromotive force epsilon and inputting the subtracted result into a motor circuit transfer function, wherein the output of the motor circuit function is a current estimated value of the steering motor
Finally, the steering resistance reference value T is calculated
R0Steering resistance estimation value
And current estimation value of steering motor
Inputting the road surface quality and adhesion coefficient into a judging module for judging, wherein the judging result
Therefore, the average value of S is more than 0 in a period of time, the road adhesion coefficient is more than 0.7, and the road quality is good; and if the average value of S is less than 0 in a period of time, the road adhesion coefficient is less than 0.7, and the road quality is poor.
The device of the automatic driving switching method based on the C-EPS system comprises a steering column assembly with a C-EPC system and a steering wheel; the lower end of the steering column assembly is connected with a planetary gear reducer through a coupler, and the lower end of the planetary gear reducer is connected with a steering motor; the upper end of the steering column assembly is provided with a steering mandrel gear and a steering column gear idler wheel which are meshed with each other; the lower end of the steering wheel is provided with a steering wheel gear; the steering wheel gear is meshed with the steering column gear idler wheel.
According to the device for the automatic driving switching method based on the C-EPS system, a steering wheel center piece is arranged in the middle of the steering wheel; the lower end of the steering wheel central piece is provided with a fixed shaft, and the fixed shaft is fixedly connected with the upper end of the steering column assembly through a nut.
Compared with the prior art, the C-EPC system calculates the lower threshold of the steering wheel input torque according to the steering wheel rotating speed and the steering wheel rotating inertia; when the input torque of the steering wheel is smaller than the lower threshold value, the vehicle is switched to an automatic driving mode, and when the input torque of the steering wheel is larger than the lower threshold value, the vehicle is switched to an artificial driving mode. Furthermore, the invention can judge the vehicle condition according to the angular acceleration of the steering wheel and the input torque condition of the steering wheel; if the steering wheel angle controlled by the driver is in the same direction as the target steering wheel angle of the C-EPS system and the steering wheel angle approaches to the target steering wheel angle, the driving system is switched into an emergency steering mode to assist the manual driving mode to complete the avoidance of the emergency situation. In the automatic driving mode, the automatic driving decision layer is utilized to release a steering control law of a steering system target corner to a C-EPS system, the steering control law controls driving voltage to drive a steering motor to complete steering of the steering system, and in the steering process of the steering system, the steering resistance reference value, the steering resistance estimation value and the current estimation value of the steering motor are utilized to judge the road surface quality and the road surface adhesion coefficient, so that the road surface quality and the road surface adhesion coefficient are sensed, and the accuracy and the safety of the automatic driving system on vehicle control are improved.
Detailed Description
The invention is further illustrated by the following figures and examples, which are not to be construed as limiting the invention.
Example 1: an automatic driving switching method based on a C-EPS system comprises a driving system, wherein an automatic driving mode, an emergency steering mode and a manual driving mode are arranged in the driving system; in the manual driving mode, the C-EPS system is in a power-assisted mode; in the automatic driving mode, the C-EPS system is in an active steering mode; in the emergency steering mode, the C-EPS system is in an emergency power-assisted active steering mode; the C-EPS system calculates a lower threshold value of the steering wheel input torque according to the rotating speed of the steering wheel and the rotating inertia of the steering wheel; when the steering wheel input torque is smaller than a lower threshold value, the vehicle is switched to an automatic driving mode, and when the steering wheel input torque is larger than the lower threshold value, the vehicle is switched to an artificial driving mode; after the manual driving mode is switched, when the angular acceleration of the steering wheel is larger than the angular acceleration threshold of the steering wheel, and the input torque of the steering wheel exceeds the upper threshold of the input torque of the steering wheel, the driving system judges that the vehicle is in an emergency state, if the steering wheel angle controlled by the driver is in the same direction as the target steering wheel angle of the C-EPS system and the steering wheel angle approaches to the target steering wheel angle, the driving system is switched to the emergency steering mode, and the manual driving mode is assisted to complete the avoidance of the emergency.
Example 2: an automatic driving switching method based on a C-EPS system comprises a driving system, wherein an automatic driving mode, an emergency steering mode and a manual driving mode are arranged in the driving system; as shown in fig. 1, after the vehicle starts, in the manual driving mode, the C-EPS system (abbreviated EPC in fig. 1) is in the assist mode (torque mode); only after the driving system receives an automatic driving request, the driving system starts an automatic driving mode and takes over the vehicle, in the automatic driving mode, the C-EPC system is in an active steering mode (angle mode), due to the existence of the rotational inertia of a steering wheel, the rotation of the steering wheel can cause a torque sensor to output a steering wheel torque signal (the rotating speed of the steering wheel and the rotational inertia of the steering wheel) during automatic driving, and in the emergency steering mode, the C-EPS system is in an emergency power-assisted active steering mode; thus, the C-EPC system calculates a lower threshold for steering wheel input torque based on steering wheel speed and steering wheel moment of inertia
T h(ii) a When steering wheel inputs torque T
hLess than a lower threshold
T hWhen the vehicle is switched to or maintained in the automatic driving mode, the steering wheel inputs torque T
hGreater than a lower threshold
T hWhen the vehicle is switched into a manual driving mode, the vehicle is taken over by a driver, but the automatic driving mode is in a standby state (all modules in the automatic driving mode keep working states, but do not participate in vehicle control); when angular acceleration of steering wheel
Greater than the angular acceleration threshold of the steering wheel
And steering wheel input torque T
hExceeding an upper threshold value for steering wheel input torque
At the moment, the driving system judges that the vehicle is in an emergency state, and if the steering wheel angle theta controlled by the driver at the moment
cAnd a target steering wheel angle theta of the C-EPS system
refIn the same direction, i.e. theta
c′θ
refIs greater than 0, and the steering wheel rotating angle approaches to the target steering wheel rotating angle, namely
And the driving system is switched into an emergency steering mode to assist the manual driving mode to complete the avoidance of emergency situations.
In order to avoid misjudgment of automatic driving switching caused by input torque interference caused by the moment of inertia of a steering wheel and the angular velocity of the steering wheel in an automatic driving mode, the lower threshold value of the input torque of the steering wheel is as follows:
in the formula: i iscIs the steering wheel moment of inertia; thetacIs the angular acceleration of the steering wheel, i.e. the second derivative of the steering wheel angle;
in order to judge whether the vehicle is in an emergency state, the calculation mode of the steering wheel angular acceleration threshold value and the upper threshold value is as follows; as shown in fig. 2, a model of the C-EPS system is established:
in the formula: a is a system state space matrix, represented as:
Kcthe steering column mandrel stiffness; b iscDamping the steering column; j. the design is a squarecIs the rotational inertia of the steering column; j is the reduction ratio of the steering motor reducer; j. the design is a squareeqEquivalent rotational inertia of a steering transmission mechanism and a steering gear; keqThe equivalent rigidity of a steering transmission mechanism and a steering gear is provided; b iseqThe damping is equivalent to a steering transmission mechanism and a steering gear; kbIs the steering motor electromagnetic torque constant; keIs the counter electromotive force coefficient of the steering motor; rmIs the armature inductance of the steering motor; l ismArmature resistance of steering motor;
θ
cis the steering wheel angle;
steering wheel speed, the first derivative of steering wheel angle; theta
mIs the motor corner;
is the rotating speed of the steering motor, namely the first derivative of the rotating angle of the steering motor; i is
mIs the current of the steering motor; b is
1To control the matrix, it is expressed as:
u=u
dis the driving voltage; b is
2Is an interference input matrix, expressed as:
w is the interference input, w ═ T
h T
R]
T,T
hFor steering input torque, when in the automatic driving mode, T
h=0;T
RIs the steering drag torque;
T
moutputting torque for a steering motor; c is the output matrix, expressed as:
according to a mathematical model of vehicle dynamics and a steering input torque T
hVehicle speed v and current I of steering motor
mCalculated power-assisted torque T
c(T
c=I
m×K
b) Calculating the yaw angular velocity beta and the lateral acceleration a under the current vehicle speed in real time
y(ii) a When yaw rate beta and lateral acceleration a
yAre all larger than the upper threshold value of the yaw rate under the current vehicle speed
And an upper threshold for lateral acceleration
Current steering input torque T
hAnd angular acceleration of steering wheel
I.e. the upper threshold value of the steering wheel input torque at the current vehicle speed
And steering wheel angular acceleration threshold
The yaw rate upper thresholdValue of
And an upper threshold for lateral acceleration
Respectively as follows:
β(v)=βmax(v)·k2;
aymax(v) maximum lateral acceleration at the current vehicle speed, betamax(v) Is the maximum yaw rate, k, at the current vehicle speed1And k2The safety factors are respectively, and the value is 0.5-0.7.
Example 3: an automatic driving switching method based on a C-EPS system comprises a driving system, wherein an automatic driving mode, an emergency steering mode and a manual driving mode are arranged in the driving system; in the manual driving mode, the C-EPS system is in a power-assisted mode; in the automatic driving mode, the C-EPS system is in an active steering mode; in the emergency steering mode, the C-EPS system is in an emergency power-assisted active steering mode; the C-EPS system calculates a lower threshold value of the steering wheel input torque according to the rotating speed of the steering wheel and the rotating inertia of the steering wheel; when the steering wheel input torque is smaller than a lower threshold value, the vehicle is switched to an automatic driving mode, and when the steering wheel input torque is larger than the lower threshold value, the vehicle is switched to an artificial driving mode; after the manual driving mode is switched, when the angular acceleration of the steering wheel is larger than the angular acceleration threshold of the steering wheel, and the input torque of the steering wheel exceeds the upper threshold of the input torque of the steering wheel, the driving system judges that the vehicle is in an emergency state, if the steering wheel angle controlled by the driver is in the same direction as the target steering wheel angle of the C-EPS system and the steering wheel angle approaches to the target steering wheel angle, the driving system is switched to the emergency steering mode, and the manual driving mode is assisted to complete the avoidance of the emergency.
In the autonomous driving mode, as shown in FIG. 3, an autonomous driving decision layer (i.e., an autonomous driving decision layer) is utilizedThe automatic-drive upper controller in fig. 3) issues a steering system target steering angle θ
refGiving a steering control law of the C-EPS system, and controlling a driving voltage to drive a steering motor to complete steering of the steering system by the steering control law; however, the existing small passenger cars mostly adopt a rack and pinion steering gear, which has high reverse efficiency, and the steering wheel is deflected by wheel vibration and deflection caused by the road surface, commonly called as the driver. When the C-EPS is in an automatic driving mode, the working mode is an angle mode, when the wheel deflects due to uneven road surface, the steering motor needs extra current to maintain the wheel rotating angle to follow the target rotating angle, and therefore, the current I of the steering motor in a period of time is counted
mAnd current estimation value of steering motor
Variance σ of the difference
IThe current road condition can be judged. If the variance of the difference between the current of the steering motor and the current estimation value of the steering motor is large, the steering motor needs extra current to overcome wheel deflection caused by uneven road, so that the actual turning angle of the steering system can better follow the target turning angle; thus, the steering resistance reference value T is used during steering of the steering system
R0Steering resistance estimation value
And current estimation value I of steering motor
mAnd judging the road surface quality and the road surface adhesion coefficient to realize the perception of the road surface quality and the road surface adhesion coefficient.
As shown in fig. 3, the steering resistance reference value T
R0According to steering wheel rotation angle theta in the steering resistance model
cAnd calculating the speed v of the vehicle, and the estimated value of the steering resistance
According to steering wheel angle theta in unknown input observer
cCurrent I of steering motor
mAnd a driving voltage u
dCalculating; current estimation value I of the steering motor
mAccording to rotation in a mathematical model of a steering systemEstimation of the directional resistance
And a target steering angle theta of the steering system
refCalculating; the method specifically comprises the following steps:
establishing a model of a C-EPS system:
in the formula: a is a system state space matrix, represented as:
K
cthe steering column mandrel stiffness; b is
cDamping the steering column; j. the design is a square
cIs the rotational inertia of the steering column; j is the reduction ratio of the steering motor reducer; j. the design is a square
eqEquivalent rotational inertia of a steering transmission mechanism and a steering gear; k
eqThe equivalent rigidity of a steering transmission mechanism and a steering gear is provided; b is
eqThe damping is equivalent to a steering transmission mechanism and a steering gear; k
bIs the steering motor electromagnetic torque constant; k
eIs the counter electromotive force coefficient of the steering motor; r
mIs the armature inductance of the steering motor; l is
mArmature resistance of steering motor;
θ
cis the steering wheel angle;
steering wheel speed, the first derivative of steering wheel angle; theta
mIs the motor corner;
is the rotating speed of the steering motor, namely the first derivative of the rotating angle of the steering motor; i is
mIs the current of the steering motor; b is
1To control the matrix, it is expressed as:
u=u
dis the driving voltage; b is
2Is an interference input matrix, expressed as:
w is the interference input, w ═ T
h T
R]
T,T
hFor steering input torque, when in the automatic driving mode, T
h=0;T
RIs the steering drag torque;
T
moutputting torque for a steering motor; c is the output matrix, expressed as:
when in the automatic driving mode, D ═ B2 B1]TAnd constructing an unknown input observer:
in the formula, DTIs a transpose of matrix D; e is the base number of the natural logarithm; i is an identity matrix having the same dimension as matrix A;
obtaining the interference input w of the C-EPS system at the time k according to each parameter value in the x matrix of the C-EPS system at the time k +1, thereby obtaining the estimated value of the steering resistance at the time k
Calculating a steering resistance reference value T according to the automobile mathematical model and the automobile driving and steering working conditionsR0:
In the formula: f is TR0Refers to a calculation function; v is vehicle speed; mu.s0Taking 0.7 by reference to the adhesion coefficient;
turning the steering system to the target steering angle theta as shown in FIG. 4
refAngle of rotation theta of steering wheel
cThe subtracted value is input into a PID controller and output to obtain a driving voltage u
d(ii) a According to the rotation speed of the steering motor
And steering motor back electromotive force coefficient K
eCalculating to obtain induced electromotive force epsilon, and driving voltage u
dSubtracting the induced electromotive force epsilon and inputting the subtracted result into a motor circuit transfer function, wherein the output of the motor circuit function is a current estimated value of the steering motor
Finally, the steering resistance reference value T is calculated
R0Steering resistance estimation value
And current estimation value of steering motor
Inputting the road surface quality and adhesion coefficient into a judging module for judging, wherein the judging result
Therefore, the average value of S is more than 0 in a period of time, the road adhesion coefficient is more than 0.7, and the road quality is good; if the average value of S is less than 0 in a period of time, the road surface adhesion coefficient is less than 0.7, and the road surface quality is poor; the accuracy and the safety of the automatic driving mode for vehicle control are improved through the feedback of the road adhesion coefficient and the road quality.
Embodiment 4 an apparatus of an automatic driving switching method based on a C-EPS system, as shown in fig. 5, includes a steering column assembly 1 having a C-EPC system, a steering wheel 2 being provided at an upper end of the steering column assembly 1; the lower end of the steering column assembly 1 is connected with a planetary gear reducer 4 through a coupler 3, and the lower end of the planetary gear reducer 4 is connected with a steering motor 5; the upper end of the steering column assembly 1 is provided with a steering mandrel gear 6 and a steering column gear idler gear 7 which are meshed with each other; the lower end of the steering wheel 2 is provided with a steering wheel gear 8; the steering wheel gear 8 is meshed with the steering column gear idler gear 7; the middle part of the steering wheel 2 is provided with a steering wheel center piece 9; a system control element, a display screen and the like are arranged in the steering wheel center piece 9; the lower end of the steering wheel center piece 9 is provided with a fixed shaft 10, and the fixed shaft 10 is fixedly connected with the upper end of the steering column assembly 1 through a nut.
In conclusion, the invention can effectively switch the driving modes according to the driving conditions of the driver, thereby reducing the harm brought by driving. In addition, the invention can also realize the perception of the road surface quality and the adhesion coefficient of the road surface so as to improve the accuracy and the safety of the automatic driving system to the vehicle control.