This application claims the benefit of priority from Japanese patent application No. 2004-341717, filed Nov. 26, 2004, the disclosure of which is incorporated herein by reference in its entirety.
This application generally relates to a driving intention estimating system and its application, and more specifically, to a driving intention estimating system that provides a stable estimation of a driver's driving intention even when detection of a relationship between an own vehicle and lane markers is lost.
JP2002-331850A describes a driving intention estimator, by which directions that the driver's eyes turn to are projected onto a plane divided into a number of regions, for calculating a distribution of projected eye directions over the divided regions to estimate the driver's driving intention.
Estimating driver's driving intention using eye directions and the frequency distribution thereof are satisfactory to only certain extents. However, the estimation accuracy may vary with different running environments and different drivers because the driver's eye movements associated with the same driving intention may vary with different running environments, and the drivers may show different eye movements associated with the same driving intention.
One approach without relying on the driver's eye movements collects information related to lane markers to estimate a driving intention of the driver. This approach, however, does not address a situation where accurate information regarding the lane marks is lost or unreliable due to variations of the running environment.
Therefore, there is a need remains for a reliable and uninterrupted estimation of driving intention even when a vehicle operates in a constantly changing environment. There is another need to effectively estimate a driving intention even when effective detections or tracking or lane markers cannot be maintained.
This disclosure describes embodiments of driving intention estimations and their applications for providing a stable estimation of a driver's driving intention even when detection of a relationship between an own vehicle and lane markers is lost.
An exemplary system for estimating a driving intention comprising a detector configured to obtain a first type of environmental information and a second type of environmental information relating to a driving environment associated with an own vehicle. The first type of environmental information is different from the second type of environmental information. An operation detector configured to detect an operation of a real driver of the own vehicle. A first imaginary driver's operation calculator is provided to calculate a respective imaginary operation of each of a plurality of imaginary drivers of a first type based on the first type of environmental information. The respective imaginary operation of each of the imaginary drivers of the first type is needed to accomplish a respective imaginary driving intention assigned to each of the imaginary drivers of the first type. A second imaginary driver's operation calculator is used to calculate a respective imaginary operation of each of a plurality of imaginary drivers of a second type based on the second type of environmental information. The respective imaginary operation of each of the imaginary drivers of the second type is needed to accomplish a respective imaginary driving intention assigned to each of the imaginary drivers of the second type. A selector selects the imaginary drivers of the first type or the imaginary drivers of the second type. A driving intention estimator estimates a driving intention of the real driver based on the detected operation of the real driver and the respective imaginary operation of each of the imaginary drivers of the selected type.
In one aspect, the driving intention estimator estimates the driving intention of the real driver based on a predetermined criterion using a threshold. The threshold corresponding to the selected imaginary drivers being the second type is set to be higher relative to the threshold corresponding to the selected imaginary drivers being the first type. The second imaginary driver's operation calculator may calculate the respective operation of each of the imaginary drivers of the second type based on an overlapping ratio of a lap between the own vehicle and a preceding vehicle, relative to a width of the preceding vehicle. Responsive to the imaginary drivers of the second type being selected, the threshold is decreased responding to a decreased overlapping ratio.
According to one embodiment, the second imaginary driver's operation calculator may calculate the respective operation of each of the imaginary drivers of the second type based on a relative lateral positional relationship of the own vehicle to a preceding vehicle. The relative lateral positional relationship may be an overlapping ratio representing a lap between the own vehicle and the preceding vehicle, relative to a width of the preceding vehicle. The system may further include a detector configured to detect lateral acceleration of the own vehicle. The driver's driving intention estimator stops estimating the driving intention of the real driver responsive to the lateral acceleration being no greater than a predetermined acceleration value and a time rate of the overlapping ratio being no less than a predetermined rate value. In another aspect, the relative lateral positional relationship is a lateral distance between a middle point between lateral ends of a front end of the own vehicle and a middle point between lateral ends of a rear end of the preceding vehicle.
According to another embodiment, a detector is provided to detect a behavior of the own vehicle. The second imaginary driver's operation calculator calculates the respective operation of each of the imaginary drivers of the second type based on the detected behavior immediately after a selection by the selector changes from the imaginary drivers of the first type to the imaginary drivers of the second type. The detected behavior of the own vehicle may be lateral acceleration.
According to still another embodiment, a driver assisting system for an own vehicle comprising a detector configured to obtain a first type of environmental information and a second type of environmental information relating to a driving environment associated with an own vehicle. The first type of environmental information is different from the second type of environmental information. An operation detector configured to detect an operation of a real driver of the own vehicle. A first imaginary driver's operation calculator is provided to calculate a respective imaginary operation of each of a plurality of imaginary drivers of a first type based on the first type of environmental information. The respective imaginary operation of each of the imaginary drivers of the first type is needed to accomplish a respective imaginary driving intention assigned to each of the imaginary drivers of the first type. A second imaginary driver's operation calculator is used to calculate a respective imaginary operation of each of a plurality of imaginary drivers of a second type based on the second type of environmental information. The respective imaginary operation of each of the imaginary drivers of the second type is needed to accomplish a respective imaginary driving intention assigned to each of the imaginary drivers of the second type. A selector selects the imaginary drivers of the first type or the imaginary drivers of the second type. A driving intention estimator estimates a driving intention of the real driver based on the detected operation of the real driver and the respective imaginary operation of each of the imaginary drivers of the selected type. An obstacle detector configured to detect an obstacle around the own vehicle, and a risk potential calculator is provided to calculate risk potential associated with the own vehicle based on a detection result of the obstacle detector. A reaction force calculator configured to calculate a reaction force applying to an accelerator pedal based on the risk potential and the estimated driving intention of the real driver.
According to one embodiment, the reaction force calculator corrects the risk potential calculated by the risk potential calculator based on the estimated driving intention, and generates the reaction force based on the corrected risk potential. In one aspect, the risk potential may be corrected in a way that the risk potential corresponding to the estimated driving intention being a driving intention to change lanes is lower than the risk potential corresponding to the estimated driving intention not being a driving intention to change lanes. The risk potential may be corrected in a way that the risk potential corresponding to the estimated driving intention to change lanes that is estimated based on the imaginary drivers of the second type is set to be smaller relative to the risk potential corresponding to the estimated driving intention to change lanes that is estimated based on the imaginary drivers of the first type.
According to another embodiment, the reaction force calculator calculates a value of the reaction force based on the risk potential, and corrects the calculated value of the reaction force based on the estimated driving intention of the real driver. The value of the reaction force may be corrected in a way that the value of the reaction force corresponding to the estimated driving intention being a driving intention to change lanes is set to be smaller than the value of the reaction force corresponding to the estimated driving intention not being a driving intention to change lanes. In one aspect, the value of the reaction force is corrected in a way that the value of the reaction force corresponding to the estimated driving intention to change lanes that is estimated based on the imaginary drivers of the second type is set to be lower relative to the value of the reaction force corresponding to the estimated driving intention to change lanes that is estimated based on the imaginary drivers of the first type.
An exemplary method for estimating a driving intention obtains a first type of environmental information and a second type of environmental information relating to a driving environment associated with an own vehicle. The first type of environmental information is different from the second type of environmental information. An operation of a real driver of the own vehicle is detected. A respective imaginary operation of each of a plurality of imaginary drivers of a first type is calculated based on the first type of environmental information. The respective imaginary operation of each of the imaginary drivers of the first type is needed to accomplish a respective imaginary driving intention assigned to each of the imaginary drivers of the first type. A respective imaginary operation of each of a plurality of imaginary drivers of a second type is calculated based on the second type of environmental information. The respective imaginary operation of each of the imaginary drivers of the second type is needed to accomplish a respective imaginary driving intention assigned to each of the imaginary drivers of the second type. Either the imaginary drivers of the first type or the imaginary drivers of the second type are selected. A driving intention of the real driver is estimated based on the detected operation of the real driver and the respective imaginary operation of each of the plurality of imaginary drivers of the selected type.
The exemplary intention estimation method may be used in assisting a driver in driving the own vehicle. An obstacle around the own vehicle is detected. Risk potential associated with the own vehicle is calculated based on a result of the step of detecting the obstacle. A reaction force applied to an accelerator pedal is calculated based on the risk potential and the estimated driving intention.
Additional advantages and novel features of the present disclosure will be set forth in part in the description which follows, and in part will become apparent to those skilled in the art upon examination of the following, or may be learned by practice of the present disclosure. The embodiments shown and described provide an illustration of the best mode contemplated for carrying out the present disclosure. The disclosure is capable of modifications in various obvious respects, all without departing from the spirit and scope thereof. Accordingly, the drawings and description are to be regarded as illustrative in nature, and not as restrictive. The advantages of the present disclosure may be realized and attained by means of the instrumentalities and combinations particularly pointed out in the appended claims.
Various exemplary embodiments according to the present disclosure are described hereunder in detail with suitable references to the accompanying drawings.
The system 1 has access to reference data, such as data related to a plurality of imaginary drivers. Same or different numbers or types of imaginary drivers may be used depending on the purpose of application or availability of data. Each of the plurality of imaginary drivers has or is given a driving intention, and each imaginary driver is designed to carry out an appropriate operation to accomplish the given driving intention under varying conditions of the vehicle's driving environment. The system 1 compares an operation of the real driver to an operation of each of the plurality of imaginary drivers. The system 1 determines an estimate of driving intention of the real driver based on a degree of similarity between the operation of the real driver and the operation of each of the plurality of imaginary drivers. In one embodiment, the system 1 estimates a driving intention of the real driver based on a time series of likelihood values over a predetermined period from a past point in time to the present point in time.
The vehicle's surrounding detector 10 includes a front camera that covers a field of front view, a yaw angle sensor, and a yaw rate sensor. The front camera acquires image on road conditions, for example, within the field of front view. The vehicle's surrounding detector 10 detects an in-lane lateral distance of the own vehicle within a lane, and a yaw angle of the own vehicle with respect the lane, and the yaw rate. The vehicle's surrounding detector 10 detects an in-lane lateral position of the preceding vehicle ahead. The vehicle's surrounding detector 10 is equipped with an image processor that processes the acquired image by the front camera.
The vehicle's status detector 20 includes a vehicle speed sensor that detects a vehicle speed of the own vehicle. The real driver's operation detector 30 includes a steering angle sensor that is provided in a steering system to detect a steering angle of the own vehicle.
The first imaginary driver's operation calculator 40, second imaginary driver's operation calculator 50, selector 60, likelihood calculator 50, and driver's driving intention estimator 60 are implemented using one or more microcomputers or microcontrollers executing microcode, software programs and/or instructions. The microcode and/or software reside in volatile and/or non-volatile data storage devices and/or machine-readable data storage medium such as read only memory (ROM) devices, random access memory (RAM) devices, SRAM, PROM, EPROM, CD-ROM, disks, carrier waves, etc.
In one embodiment, two types of imaginary drivers are used to estimate the driving invention of the real driver. Information related to the two types of imaginary drivers is generated based on different types of information related to the driving of the own vehicle.
Each of the first and second imaginary driver's operation calculators 40 and 50 is configured to calculate a respective operation of each imaginary driver in driving the own vehicle to accomplish a driving intention given to each imaginary driver. Based on the relative relationship between the own vehicle and the lane marker, which relationship is detected by the vehicle's surrounding detector 10, the first imaginary driver's operation calculator 40 calculates a respective operation of each of a plurality of imaginary drivers of a first type in driving the own vehicle to accomplish the associated driving intention. Based on the relative relationship between the own vehicle and the preceding vehicle, which relationship is detected by the vehicle's surrounding detector 10, the second imaginary driver's operation calculator 50 calculates a respective operation of each of the plurality of imaginary drivers of a second type in driving the own vehicle to accomplish the associated driving intention.
The selector 60 is configured to select the imaginary drivers of the first type or the imaginary drivers of the second type.
The likelihood calculator 70 is configured to calculate a respective likelihood value associated with each of the plurality of imaginary drivers corresponding to the selected type of imaginary drivers as selected by the selector 60, with respect to the detected operation of the real driver, as detected by the real driver's operation detector 30, to give a time series of the calculated likelihood values for each of the plurality of imaginary drivers of the selected type over a predetermined period of time ending with the present moment. The driver's driving intention estimator 80 is configured to estimate a driving intention of the real driver after comparing one time series of the calculated likelihood values for one of the plurality of imaginary drivers of the selected type with another time series.
Referring to
In
If this interrogation at step S101 results in affirmative, indicating that the lane markers are being detected, the program proceeds to step 102 that is provided to read an in-lane lateral position x of the own vehicle, i.e., a lateral position within a lane (or track), and a yaw angle ψ of the own vehicle. As shown in
Next step S103 is provided to calculate an operation of each of a plurality of imaginary drivers of a first type. The operations calculated are called first operations Oid_1 calculated based on the relative relationship of the own vehicle to lane markers. In the exemplary embodiment, three imaginary drivers are utilized, including an imaginary driver A having a lane-keeping intention (LK), an imaginary driver B having a lane-change intention to the right (LCR), and an imaginary driver C having a lane-change intention to the left (LCL). The first operation Oid_1 of each of these three imaginary drivers A, B and C is calculated. The first operation Oid_1 of each of the imaginary drivers A, B and C is needed to accomplish one of the three different driving intentions given to the imaginary driver. More particularly, the first operation Oid_1 is a steering angle θid, by which each of the three imaginary drivers A, B and C manipulates a steering wheel in driving the own vehicle to accomplish the given driving intention. The following description discusses how the first operation Oid_1 is calculated.
(1) Imaginary Driver A having a Lane-Keeping Intention (LK):
To calculate a steering angle θid_lk, by which the imaginary driver A manipulates a steering wheel in driving the own vehicle to accomplish the lane-keeping intention (LK), at least one reference point LK(i) is placed in front, on a longitudinal centerline, of the own vehicle at a distance px(i) from the center O of the own vehicle, and a lateral position p_lk(px(i)) of the reference point LK(i) from a centerline of a lane is calculated. At least one reference point LK(i) includes any desired number of reference points LK(i). In this example, as shown in
A lateral distance lat_pos(px(i)) of the reference point LK(i) from the centerline of the lane is dependent on, and thus determined by, the yaw angle ψ and the distance px(i), which may be, for example, given by processing the acquired image from the front camera. Thus, the lateral position p_lk(px(i)) of the reference point LK(i) may be expressed as:
p—lk(px(i))=lat_pos(px(i)) i={1, . . . , n} (Eq. 1)
The number n is equal to 2 (n=2) in the example shown in
Using the lateral position p_lk(px(i)), the steering angle θid_lk may be expressed as:
θid—lk=Σ{a(i)×p—lk(i))} (Eq. 2)
where: a(i) is an appropriately determined coefficient weighting the lateral position p_lk(px(i)) and is determined based on characteristics of vehicles, such as the gear ratio of a vehicle implementing the system disclosed herein.
(2) Imaginary Driver B having a Lane-Change Intention to the Right (LCR):
To calculate a steering angle θid_lcr, by which the imaginary driver B manipulates a steering wheel in driving the own vehicle to accomplish the lane-change intention to the right (LCR), at least one reference point LCR(i) is placed. At least one reference point LCR(i) includes any desired number of reference points LCR(i). In this example, as shown in
A lateral position p_lcr(px(i)) of the reference point LCR(i) may be given as a sum of lat_pos(px(i)) and a predetermined offset lc_offset_lcr, and thus expressed as:
p—lcr(px(i))=lat_pos(px(i))+lc_offset—lcr i={1, . . . , n} (Eq. 3)
The number n is equal to 2 (n=2) in the example shown in
Using the lateral position p_lcr(px(i)), the steering angle θid_lcr may be expressed as:
θid—lcr=Σ{a(i)×p—lcr(px(i))} (Eq. 4)
where: a(i) is an appropriately determined coefficient weighting the lateral position p_lcr(px(i)) and is determined based on characteristics of vehicles, such as the gear ratio of a vehicle implementing the system disclosed herein.
(3) Imaginary Driver C having Lane-Change Intention to the Left (LCL):
To calculate a steering angle θid_lcl, by which the imaginary driver C manipulates a steering wheel in driving the own vehicle to accomplish the lane-change intention to the left (LCR), at least one reference point LCL(i) is placed. At least one reference point LCL(i) includes any desired number of reference points LCL(i). In this example, as shown in
A lateral position p_lcl(px(i)) of the reference point LCL(i) may be given by a sum of lat_pos(px(i)) and a predetermined offset lc_offset_lcl, and thus expressed as:
p—lcl(px(i))=lat_pos(px(i))+lc_offset—lcl i={1, . . . , n} (Eq. 5)
The number n is equal to 2 (n=2) in the example shown in
Using the lateral position p_lcl(px(i)), the steering angle θid_lcl may be expressed as:
θid—lcl=Σ{a(i)×p—lcl(px(i))} (Eq. 6)
where: a(i) is an appropriately determined coefficient weighting the lateral position p_lcl(px(i)) and is determined based on characteristics of vehicles, such as the gear ratio of a vehicle implementing the system disclosed herein.
After calculating the first operation Oid_1 of each of the imaginary drivers A, B and C of the first type at step S103, the program goes to step S121. If the interrogation at step S101 results in negative, the program goes to step S111 for calculation of a respective operation Oid_2 of each of a plurality of imaginary drivers of a second type based on information different from the relative relationship of the own vehicle to the lane marker. In this example, the number of the imaginary drivers of the second type is set to the same as the imaginary drivers of the first type.
Step S111 is provided to judge whether or not the judgment at step S101 that lane marker has not been detected is made for the first time in the present cycle. If, although lane marker was detected in the last cycle, the detection of lane marker is lost for the first time in the present cycle, the program goes to step S112. Step S112 is provided to set an in-lane lateral position x of the own vehicle, yaw angle ψ and an in-lane lateral position x1 of the preceding vehicle x1, which were stored by reading operation in the last cycle, are set as initial values x0, ψ0 and x10, respectively. If the interrogation at step S111 results in negative, the program directly goes to step S113 bypassing step S112.
Step S113 is provided to calculate an overlapping ratio S between the own vehicle and the preceding vehicle. Referring to
sx=sl/Wl (Eq. 7)
Using this ratio sx, the overlapping ratio S may be expressed as:
S=sgn(dx)×(sx) (Eq. 8)
In the equation (Eq. 8), dx represents a value indicative of an offset direction of a middle point between two lateral ends of the own vehicle from a middle point between two lateral ends of the preceding vehicle. As shown in
Next, step S114 is provided to calculate an in-lane lateral position x of the own vehicle using the overlapping ratio S calculated at step S113.
Referring to
Next step S115 is provided to calculate a yaw angle ψ. The yaw angle ψ is given by adding a time integral of a yaw rate (ψ over-dot) detected by the yaw rate sensor to the yaw angle initial value ψ0.
Step 116 is provided to compare a lateral, acceleration Xg of the own vehicle detected by the lateral acceleration sensor and the time rate Sv of the overlapping ratio S that is calculated at step S114 to predetermined values Xg0 and Sv0, respectively. If the lateral acceleration Xg is not greater than Xg0 (Xg≦Xg0) and the overlapping ratio time rate Sv is not less than Sv0 (Sv≦Sv0), it is judged that accurate calculation of the in-lane lateral position x cannot carried out because the preceding vehicle moves laterally too frequently. If this is the case, the program goes to step S117 to stop estimating a driving intention by setting a value corresponding to the stopping of driving intention estimation.
If the interrogation at step S116 results in negative, the program goes to step S118 to set a threshold T for estimation of intention for lane-change based on the overlapping ratio S. The threshold T is a value to be compared with a lane-change intention score Sc to be described later. Increasing the threshold T reduces errors in estimating a driving intention for lane-change, but lowers the frequency in accurately estimating the driving intention for lane-change when the real driver has intention to change for the adjacent lane. Decreasing the threshold T increases the frequency in accurately estimating a driving intention for lane-change when the real drive has intention to change for the adjacent lane, but increases the frequency in erroneously estimating the driving intention for lane-change.
Accounting for balance between the frequency in erroneously estimating a driving intention for lane-change and the frequency in accurately estimating the driving intention determines the threshold T. The setting is such that when lane marker is being detected, the threshold T is equal to T0 (T=T0), where T0=0.5.
Accuracy with which operation of each of imaginary drivers is calculated after calculating the in-lane lateral position x based on the overlapping ratio S is considered to be less than accuracy with which the operation of each imaginary driver is calculated based on lane marker detected via the front camera. Accordingly, the threshold T is set at a value larger than the value T0 in order to lower the frequency in erroneously estimating a driving intention for lane-change.
When the own vehicle is being offset to the left from the preceding vehicle, the threshold for estimation of lane-change to the left (LCL) is decreased as the overlapping ratio S approaches toward zero, as indicated by the broken line. In this case, the threshold for estimation of lane-change to the right (LCR) is fixed at the predetermined value T1, as indicated by the fully drawn line, because lane-change possibility to the right is low when the own vehicle is being offset to the left from the preceding vehicle.
When the overlapping ratio S is 0 (S=0), the threshold T is set at a predetermined value T2 because the lane-change possibility is high when the own vehicle does not overlap the preceding vehicle. The predetermined values T0, T1 and T2 has the relationship that T0<T1<To2. The threshold for estimation of lane-change to the right (LCR) or the threshold for estimation of lane-change to the left (LCL) is selected as the threshold T. This selection is determined based on selection of a likelihood-series value Pids_lcr for lane-change to the right (LCR) or a likelihood-series value Pids_lcl for lane-change to the left (LCL), which are described later in connection with equation (Eq. 11).
As described earlier, in this embodiment, the number of the imaginary drivers of the second type is set to be the same as that of the imaginary drivers of the first type. In
From step S119 or S103, the program goes to step S121. Step S121 is provided to read a current steering angle θrd detected by the real driver operation detector 30 as an operation Ord of the real driver of the own vehicle.
The next step S122 is provided to calculate a likelihood value Pid of each imaginary driver using the calculated operation of each imaginary driver and the detected operation Ord of the real driver. This calculated operation of each imaginary driver may take the first operation Oid_1 calculated at step S103 based on the relative relationship of the own vehicle to the detected lane marker or the second operation Oid_2 calculated at step S119 based on relative relationship of the own vehicle to the preceding vehicle. When the lane marker is being detected via the front camera, the first operation Oid_1, which corresponds to imaginary drivers of the first type, is selected. When the detection of lane marker is lost, the second operation Oid_2, which corresponds to imaginary drivers of the second type, is selected.
In this discussion, a likelihood value Pid_lk of the imaginary driver A for lane-keeping intention, a likelihood value Pid_lcr of the imaginary driver B for lane-change to the right intention, and a likelihood value Pid_lcl of the imaginary driver C for lane-change to the left intention are generally denoted as the likelihood value Pid. In the same manner, the calculated steering angles θid_lk, θid_lcr and θid_lcl of the imaginary drivers A, B and C are generally denoted as the steering angle θid.
The likelihood value Pid of each imaginary driver is a logarithmic probability of a normalized value of the imaginary driver's steering angle θid against a normal distribution, where the mean (e) is the real driver's steering angle θrd and the variance (σ) is a predetermined value ρrd such as a standard deviation of steering angles. The likelihood value Pid may be expressed as:
Pid=log {Probn[(θid−θrd)/ρrd]} (Eq. 9)
where: Probn is the probability density function that is used to calculate a probability with which a given sample is observed from a population expressed by the normal distribution.
Step S122 is provided to calculate a likelihood value Pid-lk for lane-keeping (LK), a likelihood value Pid-lcr for lane-change to the right (LCR), and a likelihood value Pid-lcl for lane-change to the left (LCL) using the above equation (Eq. 9). These values are calculated at current moment t and generally denoted as Pid(t).
Step S123 is provided to calculate a likelihood-series value Pids over a predetermined period of time from the present moment back to a past moment. Specifically, a respective likelihood-series value Pid for each of the different driving intentions is calculated using m, in number, likelihood values Pid(t) calculated over a predetermined period of time from the present moment t backward to a past moment (t−m+1) and stored at memory locations. In the embodiment, a likelihood-series value Pids_lk for lane-keeping intention (LK), a likelihood-series value Pids_lcl for lane-change to the left and a likelihood-series value Pids_lcr for lane-change to the right are generally denoted as the likelihood-series value Pids. The likelihood value Pids may be expressed as:
where: Π represent a product of m number of likelihood values from a likelihood value Pid(t) calculated at the present moment t back to a likelihood value Pid(t−m+1) calculated at a past moment (t−m+1).
Referring to
At step S123, the equation (Eq. 10) is calculated to give a likelihood-series value Pids_lk for LK, a likelihood-series value Pids_lcr for LCR, and a likelihood-series value Pids_lcl for LCL. A likelihood-series value Pids_lc for lane-change (LC) is set using the likelihood-series values Pids_lcr and Pids_lcl. The likelihood-series value Pids_lc may be expressed as:
Pids_lc=max[Pids_lcr,Pids_lcl] (Eq. 11)
The likelihood-series value Pids_lk expresses a lane-keeping likelihood Pr(LK) of the real driver, and the likelihood-series value Pids_lc expressed a lane-change likelihood Pr(LC) of the rear driver. After calculating the likelihood Pr(LK) and Pr(LC), the program goes to step S124.
Step S124 is provided to estimate a driving intention of the real driver. Using the lane-keeping likelihood Pr(LK) and lane-change likelihood Pr(LC), a lane-change intention score Sc is calculated. This score Sc may be expressed as:
The score Sc as expressed by the equation (Eq. 12) continuously varies between 0 and 1. The score Sc grows as lane-change confidence (probability) grows more than lane-keeping confidence does. The score Sc=0.5 when the lane-change confidence and the lane-keeping confidence are 50:50. The score Sc is equal to 1 (Sc=1) when the lane-change confidence is 100%.
Next, the lane-change intention score Sc is compared to the threshold T. The threshold T is set at T0 when the first operation Oid_1 of each imaginary driver is being used. However, the threshold T is set to the value determined at step S118 using the relationship as illustrated in
A driving intention for lane-change is estimated when the score Sc is greater than the threshold T. A driving intention for lane-keeping is estimated when the score Sc is equal to or less than the threshold T.
Step S125 is provided to provide, as an output λrd, the estimated driving intention obtained at step S124. When it is determined to stop estimating driving intention at step S117, this determination is provided as an output.
The first exemplary embodiment provides effects as follows:
(1) The first imaginary driver's operation calculator 40 is configured to calculate a respective operation Oid_1 of each of a plurality of imaginary drivers of a first type based on detected vehicle's surrounding. The respective operation Oid_1 of each of the plurality of imaginary drivers of the first type is needed to accomplish one of a plurality of different driving intentions given to the imaginary drivers. The second imaginary driver's operation calculator 50 is configured to calculate a respective operation Oid_2 of each of the plurality of imaginary drivers of the second type based on information different from the detected vehicle's surrounding. The respective operation Oid_2 of each of the plurality of imaginary drivers of the second type is needed to accomplish one of the plurality of different driving intentions given to the respective imaginary driver. The selector 60 is configured to select the first operations Oid_1 calculated based on the detected vehicle's surrounding, or the second operations Oid_2 calculated based on the information different from the detected vehicle's surrounding. The likelihood calculator 70 is configured to calculate a respective likelihood-series value Pids of the selected operation Oid of each of the plurality of imaginary drivers with respect to the first operation Ord of the real driver. The driver's driving intention estimator 80 is configured to estimate a driving intention of the real driver based on the calculated likelihood-series values Pids. Accordingly, a driving intention of the real driver is estimated in a stable manner based on likelihood-series value Pids of the respective second operation of each of the plurality of imaginary drivers with respect to the operation of the real driver even when the vehicle's surrounding used by the first imaginary driver's operation calculator 40 cannot be detected.
(2) When the operations of the imaginary drivers of the second type are selected by the selector 60, a criterion that is used by the driver's driving intention estimator 80 in estimating a driving intention of the real driver is set at a high or large value. Specifically, the threshold T is set at the predetermined value T0 when the first operations Oid_1 of the imaginary drivers calculated at the first imaginary driver's operation calculator 40 are being used. The threshold T is set at a value larger than the predetermined value T0 when the second operations Oid_2 calculated at the second imaginary driver's operation calculator 50 are being used in order to increase accuracy with which the lane-change driving intention is estimated. Accordingly, the frequency of error in estimating a lane-change driving intention can be reduced even under conditions when the vehicle's surrounding can not be detected so that calculation accuracy of the operations Oid_1 of the imaginary drivers may drop.
(3) The second imaginary driver's operation calculator 50 calculates the operations Oid_2 of the imaginary drivers of the second type based on the relative lateral relationship between the own vehicle and the preceding vehicle. Accordingly, the calculator 50 can calculate the operations Oid_2 of the imaginary drivers of the second type by considering actions, which the imaginary driver with lane-keeping intention may take against the preceding vehicle and by considering actions, which the imaginary driver with lane-change intention may take against the preceding vehicle.
(4) The second imaginary driver's operation calculator 50 calculates the operations Oid_2 of the imaginary drivers of the second type based on the overlapping ratio S between the own vehicle and the preceding vehicle. Accordingly, the calculator 50 can calculate the operations Oid_2 of the imaginary drivers by considering actions, which the imaginary drivers with different driving intentions may take against the preceding vehicle.
(5) As shown in
(6) The driver's driving intention estimator 80 is configured to stop estimating a driving intention when lateral acceleration Xg of the own vehicle is less than the predetermined value Xg0 and the time rate Sv of the overlapping ratio S is greater than the predetermined value. Accordingly, an error in estimating a driving intention can be avoided by stopping the estimation when the operations Oid_2 of the imaginary drivers cannot be accurately calculated based on the relative positional relationship of the own vehicle to the preceding vehicle due to large displacement of the preceding vehicle relative to lateral displacement of the own vehicle.
The constituent of the second exemplary embodiment is substantially the same as that of the first exemplary embodiment shown in
In the second exemplary embodiment, when lane marker is not detected by a front camera, an in-lane lateral position x of an own vehicle is calculated based on a lateral distance xv of a middle point between lateral ends of the front of the own vehicle from a middle point between lateral ends of the rear of the preceding vehicle.
The operation of the second exemplary embodiment is described in detail using
The flow chart illustrated in
If, at step S201, it is judged that lane marker is not detected, the program goes to step S211 to judge whether or not the detection of lane marker is lost for the first time in the present cycle. If the detection of lane marker is lost for the first time in the present cycle, the program goes to step S212. Step S212 is provided to set an in-lane lateral position x of the own vehicle, yaw angle ψ and an in-lane lateral position x1 of the preceding vehicle x1, which were stored by reading operation in the last cycle, are set as initial values x0, ψ0 and x10, respectively. If the interrogation at step S211 results in negative, the program directly goes to step S213 bypassing step S212.
Step S213 is provided to calculate a lateral distance xv between a middle point Pl between lateral ends of the rear of the preceding vehicle and a middle point Po between lateral ends of the front of the own vehicle as shown in
Next, step S214 is provided to calculate an in-lane lateral position x of the own vehicle. The in-lane lateral position x is given by adding the lateral distance xv calculated at step 213 to the in-lane lateral position x10 obtained at step S212. The in-lane lateral position x of the own vehicle may be expressed as:
x=x10+xv (Eq. 13)
Next step S215 is provided to calculate a yaw angle ψ. The yaw angle ψ is given by adding a time integral of a yaw rate (ψ over-dot) detected by the yaw rate sensor to the yaw angle initial value ψ0. Step 216 is provided to compare a lateral acceleration Xg of the own vehicle detected by the lateral acceleration sensor and the time rate Sv of the overlapping ratio S that is calculated in the same manner as the first embodiment to predetermined values Xg0 and Sv0, respectively. If the lateral acceleration Xg is not greater than Xg0 (Xg≦Xg0) and the overlapping ratio time rate Sv is not less than Sv0 (Sv≧Sv0), the program goes to step S217 to stop estimating a driving intention by setting a value corresponding to the stopping of driving intention estimation. The time rate Sv of the overlapping ratio S may be replaced with the time rate of the lateral distance xv.
If the interrogation at step S216 results in negative, the program goes to step S218 to set a threshold T for estimation of intention for lane-change. Accuracy with which operation of each of imaginary drivers is calculated after calculating the in-lane lateral position x based on the lateral distance xv is considered to be less than accuracy with which the operation of each imaginary driver is calculated based on lane marker detected via the front camera. Accordingly, the threshold T is set at a value larger than the predetermined value T0 in order to lower the frequency in erroneously estimating a driving intention for lane-change.
As illustrated by the fully drawn line in
Step S219 is provided to calculate the respective second operation Oid_2 of each of the imaginary drivers based on the in-lane lateral position x of the own vehicle, which has been calculated at step S214, and the yaw angle ψ, which has been calculated at step S215.
From step S219 or S203, the program goes to step S221. The flow chart of
In addition to the effects provided by the first exemplary embodiment, the second exemplary embodiment provides the following effects:
(1) The second imaginary driver's operation calculator 50 calculates the respective second operation Oid_2 of each of the imaginary drivers of the second type based on the lateral distance xv between the middle point Po between the lateral ends of the front of the own vehicle and the middle point Pl between the lateral ends of the rear of the preceding vehicle. Accordingly, the calculator 50 can calculate the operations Oid_2 of the imaginary drivers of the second type by considering actions, which the imaginary drivers with different driving intentions may take against the preceding vehicle.
(2) When the operations Oid_2 calculated at the second imaginary driver's operation calculator 50 are selected, the larger the in-lane lateral position x, the smaller the threshold T. Accordingly, estimation of a lane-change driving intention can be made at an earlier time when the in-lane position x is small so that the lane-change possibility is high.
The constituent of the third exemplary embodiment is substantially the same as that of the first exemplary embodiment shown in
In the third exemplary embodiment, when lane marker is not detected by a front camera, an in-lane lateral position x of an own vehicle is calculated based on a value x0 of the in-lane lateral position x when the lane marker has been lost and the lateral movement of the own vehicle.
The operation of the third exemplary embodiment is described in detail using
If, at step S301, it is judged that lane marker is not detected, the program goes to step S311 to judge whether or not the detection of lane marker is lost for the first time in the present cycle. If the detection of lane marker is lost for the first time in the present cycle, the program goes to step S312. Step S312 is provided to set an in-lane lateral position x of the own vehicle, yaw angle ψ and an in-lane lateral position x1 of the preceding vehicle x1, which were stored by reading operation in the last cycle, are set as initial values x0, ψ0 and x10, respectively. If the interrogation at step S311 results in negative, the program directly goes to step S313 bypassing step S312.
Step S313 is provided to read in a lateral acceleration Xg detected by a lateral acceleration sensor and a yaw rate (ψ over-dot) detected by a yaw rate sensor. Next, step S314 is provided to calculate an in-lane lateral position x of the own vehicle. The second time integral of the lateral acceleration Xg is carried out to give a lateral displacement. Adding to this lateral displacement the initial value x0 of the in-lane lateral set at step S312 gives the current in-lane lateral position x of the own vehicle.
Next, step S315 is provided to calculate a yaw angle ψ. The yaw angle ψ is given by adding a time integral of the yaw rate (ψ over-dot) detected by the yaw rate sensor to the yaw angle initial value ψ0. Step 316 is provided to compare a lateral acceleration Xg of the own vehicle detected by the lateral acceleration sensor and the time rate Sv of the overlapping ratio S that is calculated in the same manner as the first embodiment to predetermined values Xg0 and Sv0, respectively. If the lateral acceleration Xg is not greater than Xg0 (Xg≦Xg0) and the overlapping ratio time rate Sv is not less than Sv0 (Sv≧Sv0), the program goes to step S317 to stop estimating a driving intention by setting a value corresponding to the stopping of driving intention estimation.
If the interrogation at step S316 results in negative, the program goes to step S318 to set a threshold T for estimation of intention for lane-change. Accuracy with which operation of each of imaginary drivers is calculated after calculating the in-lane lateral position x based on the lateral movement of the own vehicle as expressed by the lateral acceleration Xg is considered to be less than accuracy with which the operation of each imaginary driver is calculated based on lane marker detected via the front camera. Accordingly, the threshold T is set at a value larger than the predetermined value T0 in order to lower the frequency in erroneously estimating a driving intention for lane-change. Specifically, the relationship illustrated in
Step S319 is provided to calculate the respective second operation Oid_2 of each of the imaginary drivers of the second type based on the in-lane lateral position x of the own vehicle, which has been calculated at step S314, and the yaw angle ψ, which has been calculated at step S315.
From step S319 or S303, the program goes to step S321. The flow chart of
In addition to the effects provided by the first exemplary embodiment, the third exemplary embodiment provides the following effects:
(1) The second imaginary driver's operation calculator 50 calculates the respective second operation Oid_2 of each of the imaginary drivers of the second type based on the in-lane lateral position x0 upon change for the second operations Oid_2 from the first operations Oid_1 and the lateral movement of the own vehicle. Accordingly, the calculator 50 can calculate the operations Oid_2 of the imaginary drivers from lateral movement of the own vehicle after detection of lane marker has been lost.
(2). The second imaginary driver's operation calculator 50 uses the lateral acceleration Xg of the own vehicle as the lateral movement of the own vehicle, so that it is possible to calculate the respective operation Oid_2 of each of the imaginary drivers of the second type after detection of lane marker has been lost.
Referring to
Laser radar 110 is positioned at a center of a front grill or a front bumper of the vehicle for transmitting infrared pulsed beam horizontally to scan a measurement region in front of the vehicle. The laser radar 10 measures reflected waves of the transmitted infrared beam returning from obstacles, such as, rear ends of the preceding vehicles, inside the measurement region and detects an inter-vehicle distance between the vehicle and each of the preceding vehicles and relative speed between them by analyzing arrival time of the reflected waves. The laser radar 110 provides the detected an inter-vehicle distance and relative speed to a controller 150. In the embodiment, the laser radar 110 can swivel the transmitted infrared pulsed beam horizontally and laterally about 6 degrees to each side of a longitudinal line passing through the center of the vehicle.
A front camera 120, which may be in the form of a small-sized CCD camera or a CMOS camera positioned at an upper portion of a front windshield, to detect image covering a road scene in front of the own vehicle. The front camera 120 provides image signals to an image processor 130. The image signals are processed by the image processor 130 and provided to the controller 150. The front camera 120 covers a region that extends horizontally and laterally about 30 degrees to each side of a longitudinal line passing through the center of the vehicle and captures, as image, road scenery ahead within this region.
A vehicle speed sensor 140 detects a vehicle speed of the own vehicle by measuring a revolution per minute of at least one of road wheels or a revolution per minute of an output member of a transmission, and provides the detected vehicle speed to the controller 150.
Further, the estimated result from the driving intention estimating system 1 and the process of estimating are provided to the controller 150.
The controller 150, which is responsible for information processing within the driver assisting system 100, may contain a microprocessor including a central processing unit (CPU), a read only memory (ROM), and a random access memory (RAM). The controller 150 includes, for example, software implementation of a risk potential (RP) calculator 151, a reaction force instruction value FA calculator 152, and an instruction value FA correcting section 153.
The RP calculator 151 calculates a risk potential (RP) in the surrounding of an own vehicle using a vehicle speed, an inter-vehicle distance and a relative speed to the preceding vehicle, which are given by the laser radar 110, vehicle speed sensor 140, and an image information on the surrounding of the own vehicle, which is given by the image processor 130. The accelerator pedal reaction force instruction value (FA) calculator 152 calculates an instruction value FA for an accelerator pedal reaction force from an accelerator pedal 160 based on the risk potential RP calculated at the risk potential calculator 151.
The instruction value FA correcting section 153 corrects the accelerator pedal reaction force instruction value FA based on the estimated result and the process of estimation from the driving intention estimating system 1. The corrected accelerator pedal reaction force FAcc is provided to an accelerator pedal reaction force control unit 170.
In response to the instruction value from the controller 150, the accelerator pedal reaction force control unit 170 regulates a servo motor 180 of the accelerator pedal 160. As shown in
When the accelerator pedal reaction force control unit 170 is not altering the reaction force, the reaction force increases linearly as the accelerator pedal operation amount AS increases. This ordinary reaction force varying characteristic is accomplished by a spring force provided by a torque spring arranged at the center of rotational movement of the accelerator pedal 160.
The controller 150 regulates accelerator pedal reaction force from the accelerator pedal 160 based on a risk potential RP in the surrounding of the own vehicle, specifically, a risk potential within respect to the preceding vehicle. If the accelerator pedal reaction force increases with an increase in potential that grows as the own vehicle approaches the preceding vehicle, the reaction force might interfere with operation of the accelerator pedal by the driver as the driver approaches the preceding vehicle to change for the adjacent lane. Accordingly, the reaction force from the accelerator pedal 160 is reduced when the driving intention estimating system 1 has estimated a driving intention for lane-change. Moreover, the reaction force is adjusted based on whether or not the estimation of lane-change intention has been made under circumstances where lane marker is not being detected.
As discussed before, the threshold T is set at a value greater than the predetermined value T0 when lane marker is not being detected, thus reducing the frequency of error estimation of lane-change intention while the driver has a lane-keeping intention. However, a timing of estimating a lane-change is delayed. Thus, the accelerator pedal reaction force is adjusted to compensate for this delay in estimating timing of lane-change when lane-change intention has been estimated under condition lane marker is not being detected.
Next, the following description along
In
The TTC is a measure of time from a present or current moment to a future moment when the distance D would become zero if the relative speed Vr (Vr=V2−V1) to the preceding vehicle remains unaltered. The TTC may be expressed as:
TTC=−D/Vr (Eq. 14)
The smaller the value of TTC, the more imminent is the collision and the larger is the value of an extent the vehicle has approached the preceding vehicle. In the traffic scene where the own vehicle is following the preceding vehicle, most vehicle drivers perceived a high degree of risk and initiated deceleration to avoid collision well before the TTC becomes less than 4 seconds. To some extent, the TTC is a good indication for predicting a future behavior the vehicle driver might take. However, when it comes to quantifying the degree of risk, which the vehicle driver actually perceives, there is discrepancy between the TTC and the degree of risk. Thus, the TTC alone is insufficient to quantify the degree of risk.
Such discrepancy may be confirmed by considering a traffic scene where the relative speed Vr is zero. In this case, the TTC is infinite irrespective of how narrow the distance D is. However, the driver perceives an increase in the degree of risk in response to a reduction in the distance D, accounting for an increase in influence on the TTC by an unpredictable drop in a vehicle speed of the preceding vehicle.
To remedy the above-mentioned discrepancy, the notion of time headway THW has been introduced to quantify an increase how in influence on the TTC by an unpredictable drop in the vehicle speed of the preceding vehicle. The THW is a measure of a timer that is set to count up when the preceding vehicle reaches a point on a road and will be reset subsequently when the following vehicle will reach the same point. The THW is expressed as,
THW=D/V1 (Eq. 15)
In the case where the host vehicle is following the preceding vehicle, the vehicle speed V2 of the preceding vehicle may be used instead of the vehicle speed V1 in the above-mentioned equation (Eq. 15).
The relationship between the two notions TTC and THW is such that a change in vehicle speed V2, if any, of the preceding vehicle results in a small change in the TTC when the THW is long, but the same change in vehicle speed V2 of the preceding vehicle results in a large change in the TTC when the THW is short.
In this exemplary implementation, the risk potential RP calculated at step S402 may be expressed as:
RP=a/THW+b/TTC (Eq. 16)
where: b and a (b>a) are parameters weighting 1/TTC and 1/THW, respectively, such that 1/THW is less weighted than 1/TTC. The values of b and a are optimized after accounting for a statistics of values of THW and TTC collected in a traffic scene including the host vehicle is following the preceding vehicle. In this exemplary implementation, b=8 and a=1 (a<b).
At step S403, the controller 150 receives the operation amount AS of the accelerator pedal 160 by reading operation of the output of the accelerator pedal stroke sensor 181. At step S404, the controller 150 calculates an accelerator pedal reaction force instruction value FA based on the risk potential RP. First, the controller 150 calculates a reaction force increment ΔF in response to the risk potential RP by, for example, referring to the characteristic curve shown in
The illustrated curve in
Within a region where the risk potential RP exceeds the minimum value RPmin, the reaction force increment ΔF increases exponentially as the risk potential RP increases. The reaction force increment ΔF within this region may be expressed as:
ΔF=k·RPn (Eq. 17)
where: k and n are constants that are appropriately determined based on results obtained by drive simulator and field drive to provide smooth conversion of the risk potential RP to the reaction force increment ΔF.
The controller 150 calculates the sum of the reaction force increment ΔF and the ordinary reaction force responsive to the operation amount AS to provide an accelerator pedal reaction force instruction value FA.
At step S405, the controller 150 determines whether or not the estimated result is indicative of a lane-change intention. If this is the case, the program goes to step S406.
At step S406, the controller 150 corrects the accelerator pedal reaction force instruction value FA to give a corrected accelerator pedal reaction force instruction value FAc. In this exemplary implementation, the accelerator pedal reaction force instruction value FA is processed by a low-pass filter and decreased. In this case, the corrected accelerator pedal reaction force instruction value FAc may be expressed as:
FAc=gf(FA)=k·{1/(1+a·Tsf)}·FA (Eq. 18)
where: k and a are the appropriately determined constants, and Tsf is the time constant of the low-pass filter.
At the next step S407, the controller 150 determines whether or not detection of lane marker is being lost upon estimating the lane-change intention. If the detection of lane marker is lost and the operations of imaginary drivers have calculated based on the overlapping ratio S between the own vehicle and the preceding vehicle, the program goes to S408 to recorrect the corrected accelerator pedal instruction value FAc.
The recorrected accelerator pedal reaction force FAcc may be expressed as:
FAcc=gf2(FAc,S)=k·{1/(1+Kfdx·a·Tsf)}·FAc (Eq. 19)
The coefficient Kfdx applied to the time constant Tsf is set against the overlapping ratio S as illustrated in
As shown in
At step S407, if it is determined that lane marker is being detected so that the respective operation of each of imaginary drivers is calculated based on information on the lane marker, the program goes to step S409. At step S409, the controller 150 sets the corrected value FAc as the recorrected value FAcc.
If, at step S405, the estimated intention by the driving intention estimating system 1 is a lane-keeping intention, the program goes to step S410. At step S410, the controller 150 sets the accelerator pedal reaction force instruction value FA as the recorrected value FAcc.
At step S411, the controller 150 provides the recorrected value FAcc calculated at step S408 or S409 or S410, as an output, to the accelerator pedal reaction force unit 170.
If the respective operation Oid_2 of each of the imaginary drivers is calculated based on the lateral distance xv when detection of lane marker is being lost, the coefficient Kfdx used in the equation (Eq. 19) is set against the lateral distance xv using the relationship as illustrated in
If the respective operation Oid_2 of each of the imaginary drivers is calculated based on the lateral acceleration Xg when detection of lane marker is being lost, the coefficient Kfdx used in the equation (Eq. 19) is set against the lateral acceleration Xg using the relationship as illustrated in
In addition to the effects provided by the first to third exemplary embodiments, the exemplary embodiment of the driver assisting system 100 provides the effects as follows:
(1) The controller 150 calculates the risk potential RP based on obstacle state within a field around the own vehicle, and carries out regulation of accelerator pedal reaction force based on the calculated risk potential RP. Based on the estimated result provided by the driving intention estimating system 1, the controller 150 corrects the reaction force from the accelerator pedal 160. Accordingly, the controller 150 can regulate the reaction force from the accelerator pedal 160 to meet the driving intention by the driver while keeping transmitting the risk potential RP to the driver by the reaction force via the accelerator pedal 160.
(2) The controller 150 corrects the reaction force from the accelerator pedal 160, that is, the accelerator pedal reaction force instruction value FA, in response to the estimated result of driving intention. Specifically, when the driving intention estimating system 1 estimates lane-change intention, the accelerator pedal reaction force instruction value FA is decreased more than it does when the estimated result is the lane-keeping intention. As the reaction force instruction value FA is decreased when the driver has intention of lane-change, the reaction force from the accelerator pedal 160 will not interfere with the subsequent driver's operation to change for the adjacent lane.
(3) The corrected accelerator pedal reaction force instruction value FAc is recorrected when the respective second operation Oid_2 of each of the imaginary drivers has been calculated and used for estimation of a lane-change driving intention such that the reaction force instruction value FA is smaller than it is when the respective first operation Oid_1 of each of imaginary drivers has been calculated and used for estimation of a lane-change intention. When the estimation is being carried out based on the calculated second operations Oid_2, the threshold T is set at a value greater than the predetermined value T0, causing a delayed timing to estimate a lane-change intention although reducing the frequency of error in estimating the lane-change. To address this problem, the coefficient Kfdx applied to the time constant Tsf is set at a value smaller than 1 as shown in
Referring to
In this exemplary embodiment, the driver assisting system 200 corrects a risk potential RP around an own vehicle upon determination that the driving intention estimating system 1 has estimated a lane-change intention. A controller 150A of the driver assisting system 200 is provided with a software implementation of a risk potential (RP) calculator 151, a risk potential (RP) correcting section 154, and an accelerator pedal reaction force instruction value FA calculator 155.
Next, the following description along
At step S503, the controller 150A determines whether or not the estimated driving intention made by the driving intention estimating system 1 is a lane-change intention. If this is the case, the program goes to step S504. At step S504, the controller 150A corrects the risk potential RP to give a corrected risk potential RPc. In this exemplary implementation, the risk potential RP is processed by a low-pass filter and decreased. In this case, the corrected risk potential RPc may be expressed as:
RPc=gr(RP)=k·{1/(1+a·Tsr)}·RP (Eq. 20)
where: k and a are the appropriately determined constants, and Tsr is the time constant of the low-pass filter.
At step S505, the controller 150A judges whether or not lane marker was lost upon estimating the lane-change intention. The lane marker was lost and the respective operation Oid_2 of each of the imaginary drivers were calculated based on the relative positional relationship between the own vehicle and the preceding vehicle. If, based on the overlapping ratio S between the own vehicle and the preceding vehicle, the respective second operation Oid_2 of each of the imaginary drivers has been calculated, the program goes to step S506 to recorrect the corrected risk potential RPc.
The recorrected risk potential RPcc may be expressed as:
RPcc=gr2(RPc,S)=k·{1/(1+Krdx·a·Tsr)}·RPc (Eq. 21)
The coefficient Krdx applied to the time constant Tsr is set against the overlapping ratio S as illustrated in
As shown in
At step S505, if it is determined that lane marker is being detected so that the respective operation of each of imaginary drivers is calculated based on information on the lane marker, the program goes to step S507. At step S507, the controller 150A sets the corrected value RPc as the recorrected value RPcc.
If, at step S503, the estimated intention by the driving intention estimating system 1 is a lane-keeping intention, the program goes to step S508. At step S508, the controller 150A sets the risk potential RP as the recorrected value RPcc.
At step S509, the controller 150A reads in accelerator pedal operation amount AS detected at the accelerator pedal stroke sensor 181. At step S510, the controller 150A calculates an accelerator pedal reaction force instruction value FA based on the recorrected value RPcc obtained at step S506 or S507 or S508. The manner of converting the recorrected value RPcc to the accelerator pedal reaction force instruction value FA corresponds exactly to the previously described manner of converting the risk potential RP to the accelerator pedal reaction force instruction value FA (see step S404 in
At step S511, the controller 150A provides the accelerator pedal reaction force instruction value FA calculated at step S510, as an output, to the accelerator pedal reaction force unit 170.
If the respective operation Oid_2 of each of the imaginary drivers is calculated based on the lateral distance xv when detection of lane marker is being lost, the coefficient Krdx used in the equation (Eq. 21) is set against the lateral distance xv using the relationship as illustrated in
If the respective operation Oid_2 of each of the imaginary drivers is calculated based on the lateral acceleration Xg when detection of lane marker is being lost, the coefficient Krdx used in the equation (Eq. 21) is set against the lateral acceleration Xg using the relationship as illustrated in
In addition to the effects provided by the fifth exemplary embodiment shown primarily in
(1) The controller 150A corrects the risk potential RP based on the estimated result provided by the driving intention estimating system 1. Particularly, when the estimated result provided by the driving intention estimating system 1 is a lane-change intention, the risk potential RP decreases more that it does when the estimated result is not the lane-change intention. This decreasing the risk potential RP causes reduction in accelerator pedal reaction force instruction value FA, preventing the reaction force from the accelerator pedal 160 from interfering with the driver's operation to change for the adjacent lane.
(2) The controller 150A recorrects the risk potential RP such that, when the estimation by the driving intention estimating system 1 has been carried out based on the respective second operation Oid_2 of each of the imaginary drivers, the risk potential is lower that it is when the estimation by the driving intention estimating system has been carried out based on the respective first operation Oid_1 of each of the imaginary drivers. When the estimation is being carried out based on the calculated second operations Oid_2, the threshold T is set at a value greater than the predetermined value T0, causing a delayed timing to estimate a lane-change intention although reducing the frequency of error in estimating the lane-change. To cope with this problem, the coefficient Krdx applied to the time constant Tsr is set at a value smaller than 1 as shown in
In the before described first to third embodiments, a likelihood-series value Pids has been calculated from the present operation of each of the imaginary drivers and operation of the real driver back to the past operations thereof, and the change-lane intention score Sc as expressed by the equation (Eq. 12) is calculated based on the respective likelihood-series values Pids. The disclosure is not limited to this example. The driving intention may be estimated after calculating the lane-change intention score Sc based on likelihood values Pid of the respective present operation of each of the imaginary drivers with respect to the present operation of the real driver.
Instead of calculating the lane-change intention score Sc, a score of lane-change likelihood may be calculated from a lane-change likelihood Pr(LC) and a lane-keeping likelihood Pr(LK).
In the fourth and fifth exemplary embodiments, the risk potential has been calculated using the time to contact TTC and time threshold THW between the own vehicle and the preceding vehicle. The present disclosure is not limited to this example. For example, the reciprocal of the time to contact TTC may be used as risk potential RP. The relationship between the risk potential RP and the reaction force increment ΔF is not limited to the illustrated relationship in
In the fourth exemplary implementation, the reaction force increment ΔF that is determined in response to the risk potential RP is added to the ordinary reaction force characteristic to give an accelerator pedal reaction force value FA, and this reaction force instruction value FA is corrected and recorrected. The present disclosure is not limited to this example. For example, the reaction force increment ΔF may be corrected and recorrected before adding to the ordinary reaction force characteristic to give the recorrected value FAcc.
In the first to fifth exemplary embodiments, the vehicle's surrounding detector 10 is operative to perform the function of vehicle's surrounding detecting means. The real driver's operation detector 30 is operative to perform the function of driver's operation detecting means. The first imaginary driver's operation calculator 40 is operative to perform the function of second imaginary driver's operation calculating means. The second imaginary driver's operation calculator 50 is operative to perform the function of second imaginary driver's operation calculating means. The selector 60 is operative to perform the function of imaginary driver's operation selecting means. The likelihood calculator 70 is operative to perform the function of driving operation likelihood values calculating means. The driver's driving intention estimator 80 is operative to perform the function of driving intention estimating means. Moreover, the selector 60 is operative to perform also the function of the criterion altering implementation. The vehicle status detector 20 is operative to perform the function of own vehicle movement detecting means. Furthermore, the laser radar 110, the front camera 120 and the vehicle speed sensor 140 constitute the obstacle detecting means. The risk potential 151 is operative to perform the function of risk potential calculating means. The accelerator pedal reaction force instruction value calculators 152 and 155 perform the function of reaction force calculating means. The accelerator pedal reaction force control unit 170 is operative to perform the function of reaction force generating means. The accelerator pedal reaction force instruction value correction section 153 and the risk potential correcting section 154 are operative to perform the function of correcting means. The obstacle detecting means may take the form of radar of the other type, such as, millimeter radar. The reaction force generating means may take the form of a steering reaction force control unit for generation of steering reaction force.
Although the disclosure has been shown and described with respect to the exemplary implementations, it is obvious that equivalent alterations and modifications will occur to those skilled in the art upon reading and understanding of the specification. The present disclosure includes all such equivalent alterations and modifications, and is limited only by the scope of the claims.
Number | Date | Country | Kind |
---|---|---|---|
P2004-341717 | Nov 2004 | JP | national |
Number | Name | Date | Kind |
---|---|---|---|
5485892 | Fujita | Jan 1996 | A |
6092619 | Nishikawa et al. | Jul 2000 | A |
6134491 | Kawagoe et al. | Oct 2000 | A |
6226581 | Reimann et al. | May 2001 | B1 |
6256561 | Asanuma | Jul 2001 | B1 |
6574560 | Abe et al. | Jun 2003 | B2 |
6889161 | Winner et al. | May 2005 | B2 |
7222507 | Wetzel et al. | May 2007 | B2 |
7349767 | Kuge et al. | Mar 2008 | B2 |
7392120 | Matsumoto et al. | Jun 2008 | B2 |
20030038714 | Matsumoto et al. | Feb 2003 | A1 |
20030195684 | Martens | Oct 2003 | A1 |
20040164851 | Crawshaw | Aug 2004 | A1 |
20050065663 | Oyama | Mar 2005 | A1 |
20050107938 | Wetzel et al. | May 2005 | A1 |
20050131590 | Kuge et al. | Jun 2005 | A1 |
20090091435 | Bolourchi | Apr 2009 | A1 |
Number | Date | Country |
---|---|---|
1 065 520 | Jan 2001 | EP |
1 087 360 | Mar 2001 | EP |
1 346 892 | Sep 2003 | EP |
1 375 280 | Jan 2004 | EP |
1 413 500 | Apr 2004 | EP |
1 422 111 | May 2004 | EP |
2002-331850 | Nov 2002 | JP |
Number | Date | Country | |
---|---|---|---|
20060145827 A1 | Jul 2006 | US |