Summary of the invention
The purpose of this invention is to provide a kind of new mode that chaufeur disturbs that detects; This method is utilized pilot model; Chaufeur control behavior under the current driving environment of real-time simulation; Through the control data of relatively pilot model real-time simulation and the control data of true chaufeur, can judge exactly whether chaufeur is interfered.
According to the object of the invention; A kind of pilot model comprises: path planning module; Reception is from the driving environment information of vehicle-mounted external sensor, the driving intention of decision-making chaufeur (change or keep track), plans corresponding driving trace, and constantly revises according to the car body position in real time; Take aim at module in advance, according to utilize the characteristic of taking aim in advance of chaufeur to obtain the expected trajectory data from the said data of path planning module; Prediction module obtains the prediction locus data according to the status information from vehicle dynamic model; First comparing module receives expected trajectory data and prediction locus data, and obtains the lateral deviation data through the comparison of these two track datas; The side direction control module outputs to second comparing module and vertical control module respectively according to said lateral deviation direction data calculation dish corner change amount and lateral acceleration and with it; Vertical control module is according to said lateral acceleration calculation expectation longitudinal acceleration, then according to expecting longitudinal acceleration calculation of throttle opening value and exporting vehicle dynamic model to; Second comparing module according to the current steering wheel angle of said steering wheel angle change amount and vehicle dynamic model, is calculated final steering wheel angle and is exported vehicle dynamic model to.
According to the object of the invention; A kind of method of utilizing above-mentioned pilot model to detect the chaufeur disturbance state is proposed; Said method comprises: step a; Obtain the driving environment information of vehicle through vehicle-mounted external sensor,, judge that chaufeur changes or keep the driving intention in track through the relation of vehicle current location and lane boundary of living in relatively; Step b; If judging driving intention is to keep the track; Then pilot model utilizes PD control calculated direction dish corner change amount according to the said driving environment information and the status information of vehicle, and calculates and output accelerator open degree value according to current vehicle speed with by definite expectation longitudinal acceleration of the expected elapsed time (safety time) of vehicle and front truck; Step c; If judge that driving intention is to change; Then pilot model utilizes PD control to obtain steering wheel angle change amount according to the said driving environment information and the status information of vehicle; And, calculate and output accelerator open degree value according to the present speed of vehicle and the expectation longitudinal acceleration of confirming by lateral acceleration; Steps d compares the steering wheel angle of step b or c and accelerator open degree data with the corresponding control data that is obtained true chaufeur by term vehicle internal sensors, judge whether chaufeur is interfered; Step e, repeating step a-d is until parking.
Said method also comprises: before step a, vehicle-mounted external sensor and term vehicle internal sensors are linked to each other with computing machine, debug vehicle-mounted external sensor and term vehicle internal sensors, the initialization pilot model.
Judge the time window of the criterion employing 1s whether chaufeur is interfered; 0.25s renewal amount carry out data handing; Wherein, Judge that criterion that whether chaufeur is interfered utilizes the characteristic of the accumulated deficiency of data in 1s of steering wheel angle, accelerator open degree value and true chaufeur as classification, wherein, judge that the discriminant function whether chaufeur is interfered is that kernel function is the SVMs (SVM) of Gaussian function.
The characteristic of division of aforementioned calculation is inputed to supporting vector machine model, be interfered if the result of model, then can judge chaufeur greater than 0, otherwise, be not interfered.
Pilot model of the present invention is based upon on the existing queuing network cognition system, and when following the trail of expected trajectory, it is the driving performance and the physiology limitation of the true chaufeur of emulation exactly, can embody the driving behavior of experienced driver.The environment sensing sensor in real time of outside vehicle is obtained current driving environment information, and these information real-time are defeated by pilot model.Pilot model calculates the chaufeur control data in real time according to the information of environment sensing sensor.Obtain the real-time control data of true chaufeur through term vehicle internal sensors, just can judge accurately with the control data of true chaufeur whether chaufeur is interfered through the driving data that pilot model relatively calculates.
The invention has the advantages that: proposed a kind ofly to detect the method whether chaufeur is interfered through the Simulation Control data of real-time relatively pilot model and the control data of true chaufeur; This testing process itself can not produce chaufeur and disturb; And hardware realizes that easily cost is low; Drive the driving condition that data can reflect chaufeur truly; Whether be interfered through the emulated data of pilot model and the difference identification chaufeur of the driving data of true chaufeur; Can reduce the False Rate of Interference Detection widely; Improve the accuracy rate that detects, advance the degree of intelligence of DAS (Driver Assistant System).
The specific embodiment
Describe method of inspection below with reference to accompanying drawings in detail according to chaufeur disturbance state of the present invention.In the present invention, in order to simplify description, suppose that pilot model is in identical expected trajectory with true chaufeur, the invention is not restricted to this certainly.
Fig. 1 utilizes pilot model to carry out the schematic diagram of chaufeur Interference Detection.As shown in Figure 1, it is following to utilize pilot model to carry out the principle of chaufeur Interference Detection: (1) through vehicle-mounted external sensor obtain in real time driving environment information (location information in road type (straight line or curve), the current track of living in of vehicle, the speed of a motor vehicle, with vehicle (front truck and the back car) speed of the distance of the front truck in same track and back car, adjacent lane and with the distance of this car); (2) pilot model receives the data from vehicle-mounted external sensor; Driving behavior under the current driving environment of driving behavior real-time simulation of simulation experienced driver; And output chaufeur control data a to kinetic model closed-loop corrected with the driving behavior that realizes emulation, from the driving control data of pilot model output as the benchmark under the normal driving; (3) when carrying out step (2), obtain the control data of true chaufeur in real time to vehicle through onboard sensor; (4) comparison module receives from the pilot model control data of step (2) with from the control data of the true chaufeur of step (3), just can accurately judge with the control data of true chaufeur whether chaufeur is interfered through pilot model relatively.
Be based upon on the existing queuing network cognition system at the pilot model shown in Fig. 1, when following the trail of expected trajectory, it is the driving performance and the physiology limitation of the true chaufeur of emulation exactly, can embody the driving behavior of experienced driver.Describe pilot model in detail with reference to Fig. 2 below.
As shown in Figure 2, pilot model comprises path planning module, takes aim at module, prediction module,comparing module 1, comparing module 2, side direction control module, vertical control module etc. in advance.
On the one hand; Driving environment information input path planning module from vehicle-mounted external sensor; The path planning module decision-making goes out the driving intention (change or keep track) of chaufeur and plans corresponding driving trace; And constantly revise according to the car body position in real time, take aim at module in advance according to utilizing the characteristic of taking aim in advance of chaufeur to obtain the expected trajectory data from the said data of path planning module.
On the other hand, from the car status information (S of vehicle dynamic modeln(x, y, ax, ay, vx, vy, yaw), wherein x is a car body side coordinate, y is the car body along slope coordinate, axBe longitudinal acceleration, ayBe lateral acceleration, vxBe longitudinal velocity, vyBe side velocity, yaw is the car body yaw angle) the input prediction module, prediction module is according to said status information prediction of output track data.Expected trajectory data and prediction locus data are all importedcomparing module 1, obtain lateral deviation data E (will be described below) throughcomparing module 1 these two track datas are compared.The side direction control module is according to outputing to comparing module 2 and vertical control module respectively from the lateral deviation data E calculated direction dish corner change amount Δ δ (will be described below) ofcomparing module 1 and with it.Vertically control module is calculated final accelerator open degree value α (will be described below) and is exported vehicle dynamic model to, and comparing module 2 is according to calculating output final steering wheel angle δ (will be described below) and export it to vehicle dynamic model from the steering wheel angle change amount Δ δ of side direction control module and the current steering wheel angle (will be described below) of vehicle dynamic model.Realize driving behavior closed-loop corrected of pilot model thus.
Because the implementation (for example, software mode, hardware mode etc.) of the control of the comparison/comparison-control module of the sensor-comparison module/comparing module that when describing Fig. 1 and Fig. 2, relates to belongs to prior art, no longer is repeated in this description at this.
Describing in detail with reference to Fig. 3 below utilizes pilot model to carry out the method for chaufeur Interference Detection.
It is following to utilize pilot model to carry out the process of chaufeur Interference Detection:
Instep 301 and 302; Debug vehicle-mounted external sensor and term vehicle internal sensors; Make its normal operation; Each module of initialization pilot model also guarantees that each module clock is consistent, guarantees that simultaneously the time that true chaufeur steering vehicle advances is consistent with the enabling time of each sensor and pilot model.Each sensor and computing machine (for example, car-mounted computer) are linked to each other, to communicate with pilot model.
Instep 303, the chaufeur steering vehicle advances, and vehicle-mounted external sensor obtains current driving environment information in real time, and term vehicle internal sensors is obtained vehicle state information in real time.Certainly, each sensor possibly interrupted by certain situation (for example, sensor fault, vehicle parking etc.).
Instep 304 and 305; Pilot model obtains the driving environment information of vehicle according to vehicle-mounted external sensor; Through the relation of vehicle current location (that is, the position in track of living in) and lane boundary of living in relatively, the driving intention of judgement chaufeur (change or keep track).
The driving intention that obtains according to step 305 (change or keep track); Pilot model is according to the current driving environment information of obtaining from vehicle-mounted external sensor; Carry out path planning according to the drive safety criterion, and constantly revise in real time according to the location information of vehicle.The path planning that obtains according to driving intention is promptly as the expected trajectory of pilot model, and pilot model is followed the trail of this expected trajectory, obtains corresponding driving behavior benchmark.Like this, the expected trajectory that obtains through path planning can guarantee that pilot model is in identical or roughly the same expected trajectory with true chaufeur.
According to the driving intention thatstep 305 obtains, pilot model is followed the trail of the expected trajectory that instep 305, obtains according to corresponding driving intention (change or keeps track) selection Different control mode.
If the driving intention that instep 305, obtains is to keep the track, then in step 306,307,308 and 309, will be through two cars (Ben Che and front truck thereof) the spacing d of vehicle-mounted external sensor acquisitionn, the front truck speed vHnReach the car status information S that obtains through term vehicle internal sensorsn(xn, yn, aXn, aYn, vXn, vYn, yawn) send pilot model to.Pilot model take aim at the path planning that module is obtained throughstep 305 in advance, obtain the current time (T that takes aim in advancep=expected trajectory point P in 1.5s)n(xn, yn), prediction module obtains car status information S through term vehicle internal sensorsn(xn, yn, aXn, aVn, vXn, vVn, yawn) and predict and take aim at time T in advancepInterior vehicle the position coordinate that will arriveJust can obtain the lateral position error E of expected trajectory and prediction locus thusnIn order accurately to follow the trail of expected trajectory, will adjust steering wheel angle and reduce the lateral position deviation.In pilot model, utilize PD control to obtain steering wheel angle change amount.Aspect vertical,, prevent that rear-end collision from taking place, and guarantee two following distances (perhaps greater than safety time) in safe range for the safety that guarantees to drive.For this reason, calculate the pitch time t of two carsCn, expectation longitudinal acceleration aXnThen with the pitch time t of two carsCnWith safety time tf(tf=4s) the proportional relation of difference, the relation according to vehicle dynamics obtains expecting longitudinal acceleration and the cooresponding accelerator open degree of present speed (quicken on the occasion of representative, negative value is represented brake) thus, formula is following:
Δδn=kp·ayn+kd·a′yn (4)
δn=δn-1+Δδn (5)
By formula (1), the lateral position deviation E in n stepnDeduct the side direction coordinate of expected trajectory point through the side direction coordinate of prediction locus point.By formula (2), obtain n step side velocity v according to term vehicle internal sensorsVn, calculate the lateral acceleration a that arrives desired locationYnBy formula (3), can obtain the derivative a ' of n step lateral acceleration divided by the time of taking aim in advance through the difference of n step lateral acceleration and n-1 step lateral accelerationYnBy formula (4),, obtain n step steering wheel angle change amount Δ δ through PD controlnBy formula (5), the steering wheel angle in n-1 step adds steering wheel angle change amount Δ δnJust can obtain final steering wheel angle δnAspect the vertical controlled variable of calculating (being throttle or brake aperture), calculate the pitch time t that n goes on foot two cars by formula (6)Cn, obtain expecting longitudinal acceleration by formula (7)The question blank that is provided by formula (8) at last obtains final accelerator open degree value αn, f (v whereinXn, adXn) be kinetic function expression formula about vehicle motor, the accelerator open degree that different longitudinal accelerations is corresponding different with longitudinal velocity.
Belong to prior art owing to how to realize PD control, no longer describe at this.
Find out that from top description pilot model is known expected trajectory according to vehicle-mounted external sensor,, export to vehicle dynamic model then through the controlled order of the driving performance of emulation experienced driver under the normal driving situation.
If the driving intention that instep 305, obtains is to change, then in step 310,311,312 and 313, the driving environment information of the adjacent lane that will obtain through vehicle-mounted external sensor and the car status information S that obtains through term vehicle internal sensorsn(xn, yn, aXn, aVn, vXn, vVn, yawn) send pilot model to.The method of calculating of taking aim at module, prediction module and steering wheel angle in advance in the pilot model and step 306,307,308 and 309 identical, difference is aspect longitudinal acceleration.Physiology limitation for the true chaufeur of emulation; When changing, the longitudinal acceleration of expectation is according to lateral acceleration decision, obtains expecting that according to the relation of vehicle dynamics the cooresponding accelerator open degree of longitudinal acceleration (quickens on the occasion of representative; Negative value is represented brake), formula is following:
adxn=K·ayn+ad (9)
αn=f(vxn,adxn) (10)
Calculate the needed steering wheel angle of tracking expected trajectory by top formula (1)-(5).By the longitudinal acceleration of formula (9) calculation expectation, wherein aYnBe the lateral acceleration that formula (2) calculates, K, adIt is constant.The question blank that is provided by formula (10) calculates present speed and the accelerator open degree value of expecting under the longitudinal acceleration.
Can obtain the driving behavior data M (δ of pilot model emulation under normal driving situation (for example, keep track or change) by step 306-309 or step 310-313Mn, αMn), obtain true chaufeur controlled in real-time data D (δ by term vehicle internal sensorsDn, αDn), judge through the comparison module (see figure 1) whether chaufeur receives the interference of other tasks then, shown in the following formula of its decision criteria:
In this decision criteria, adopt the time window of 1s, the renewal amount of 0.25s.Steering wheel angle, accelerator open degree value that calculates pilot model by formula (11), (12) respectively and the characteristic of the accumulated deficiency of data in 1s of true chaufeur as classification; Utilize the gaussian kernel function certificate, formula (11), (12) calculated feature values are input in the SVMs function (SVM), according to result of calculation; If output valve can judge promptly that greater than 0 influence (step 314) that whether chaufeur be interfered (promptly; The result of model the characteristic of division of aforementioned calculation inputed to supporting vector machine model, if, can judge then that chaufeur is interfered greater than 0; Otherwise, be not interfered).
Vehicle-mounted external sensor and term vehicle internal sensors are obtained driving environment information and vehicle interior status information in real time, constantly send information to pilot model, promptly repeat above-mentioned step 304-315, until parking always.