The present invention generally relates to a system for determining a lane for a vehicle. More specifically, the present invention relates to a system for determining a lane for a vehicle based on host vehicle location.
Recently, vehicles are being equipped with a variety of warning and prevention systems such as lane departure and prevention systems, cross traffic alerts, adaptive cruise control, and the like. Further, various informational vehicle-to-vehicle systems have been proposed that use wireless communications between vehicles, and further between vehicle and infrastructures such as roadside units. These wireless communications have a wide range of applications ranging from safety applications to entertainment applications. Also vehicles are sometimes equipped with various types of systems, such as global positioning systems (GPS), which are capable of determining the location of the vehicle and identifying the location of the vehicle on a map for reference by the driver. The type of wireless communications to be used depends on the particular application. Some examples of wireless technologies that are currently available include digital cellular systems, Bluetooth systems, wireless LAN systems and dedicated short range communications (DSRC) systems.
It has been discovered that to improve vehicle and vehicle occupant safety, an improved system to determining a lane for a vehicle is desired.
In view of the state of the known technology, one aspect of the present disclosure is to provide a system for determining a lane for a vehicle, the system comprising a receiver and an electronic controller. The receiver is configured to receive information related to a remote vehicle, the information including a remote vehicle location, a remote vehicle speed and a remote vehicle travel path. The electronic controller is configured to determine a host vehicle location, a host vehicle speed and a host vehicle travel path, compare the host vehicle location with the remote vehicle location, compare the host vehicle speed with the remote vehicle speed and compare the host vehicle travel path with the remote vehicle travel path, and cause the host vehicle to perform a mitigation operation when the electronic controller determines that the remote vehicle location, the remote vehicle speed and the remote vehicle travel path indicate that the remote vehicle must pass or has passed the host vehicle on a right side.
Another aspect of the present disclosure is to provide a method for determining a lane for a vehicle. The method comprises operating a receiver to receive information related to a remote vehicle, the information including a remote vehicle location, a remote vehicle speed and a remote vehicle travel path, determining by an electronic controller a host vehicle location, a host vehicle speed and a host vehicle travel path, comparing with the electronic controller the host vehicle location with the remote vehicle location, comparing the host vehicle speed with the remote vehicle speed and comparing the host vehicle travel path with the remote vehicle travel path, and causing with the controller the host vehicle to perform a mitigation operation when the electronic controller determines that the remote vehicle location, the remote vehicle speed and the remote vehicle travel path indicate that the remote vehicle must pass or has passed the host vehicle on a right side.
Referring now to the attached drawings which form a part of this original disclosure:
Referring initially to
As can be understood, a host vehicle 10 can be traveling along a multilane road 16. When not in the right most lane 16R of the road 16, remote vehicles 14 may undertake (i.e., pass on the right) the host vehicle 10. Depending on the jurisdiction in which the host vehicle 10 is traveling the host vehicle 10 may be required to move to the right (i.e., from the left lane 16L to the right lane 16R) to allow remote vehicles 14 to pass on the left. As one of ordinary skill would understand different states or jurisdictions have different laws and rules. For example, some jurisdictions allow travel in other than the right lane 16R of a multi-lane road 16 any time while others require a vehicle to move to the right lane 16R if they are traveling slower than surrounding traffic. Still others require a vehicle to move to the right lane 16R any time a vehicle is not passing a slower moving vehicle. Alternatively, even when not required by the jurisdiction it may be desirous for the host vehicle 10 to allow remote vehicles 14 to pass on the left.
As one of ordinary skill can understand occupants of the host vehicle 10 may have a limited field of view to discern whether a remote vehicle 14 is approaching. Further, in some situations the remote vehicle 14 may not be visible due to turns in the road, hills along the road, obstacles along the road or any other reasons. The system 12 for determining a lane for a vehicle improves the host vehicle's 10 determination of location, direction and speed of a remote vehicle 14. The system 12 for determining a lane for a vehicle enables the host vehicle 10 or the operator of the host vehicle 10 to determine which lane is the appropriate travel lane.
The system 12 for determining a lane for a vehicle 10 and the remote vehicle 14 communicate with the two-way wireless communications network. As seen in FIG. 1, for example, the two-way wireless communications network can include one or more global positioning satellites 18 (only one shown), and one or more roadside (terrestrial) units 20 (only one shown), and a base station or external server 22. The global positioning satellites 18 and the roadside units 20 send and receive signals to and from the system 12 for determining the number of remote vehicles following a host vehicle of the host vehicle 10 and the remote vehicles 14. The base station 22 sends and receives signals to and from the system 12 for determining the number of remote vehicles following a host vehicle of the host vehicle 10 and the remote vehicles 14 via a network of the roadside units 20, or any other suitable two-way wireless communications network.
Referring to
The controller 24 is preferably and electronic controller and includes a microcomputer with a control program that controls the system 12 as discussed below. The controller 24 can also include other conventional components such as an input interface circuit, an output interface circuit, and storage device(s) (data storage 34) such as a ROM (Read Only Memory) device and a RAM (Random Access Memory) device. The microcomputer of the controller 24 is programmed to control one or more of the sensor system (sensors 26a-26d), a positioning system 28, a warning indicator 30 or system, a tactile vibration system 32, data storage 34, and the receiver/transmitter system 36, and to make determinations or decisions, as discussed herein. The memory circuit stores processing results and control programs, such as ones for the sensor system (sensors 26a-26d), a positioning system 28, a warning indicator 30 or system, a tactile vibration system 32, data storage 34 and receiver/transmitter system 36 operation that are run by the processor circuit. The controller 24 is operatively coupled to the sensor system (sensors 26a-26d), a positioning system 28, a warning indicator 30 or system, a tactile vibration system 32, data storage 34, and receiver/transmitter system 36 in a conventional manner, as well as other electrical systems in the vehicle 10, such the turn signals, windshield wipers, lights and any other suitable systems. Such a connection enables the controller 24 to monitor and control any of these systems as desired. The internal RAM of the controller 24 stores statuses of operational flags and various control data. The internal ROM of the controller 24 stores the information for various operations. The controller 24 is capable of selectively controlling any of the components of the sensor system (sensors 26a-26d) in accordance with the control program. It will be apparent to those skilled in the art from this disclosure that the precise structure and algorithms for the controller 24 can be any combination of hardware and software that will carry out the functions of the present invention.
As shown in
In one embodiment, the sensor system (sensors 26a-26d) can include proximity sensors and optical sensors. In one embodiment, the proximity sensors include a plurality of sensors (sensors 26a-26d), and are configured to detect the boundaries 42L and 42R and the center line 42C of the road 16 or other stationary or moving objects (e.g., remote vehicles 14) in proximity to the sensor system (sensors 26a-26d). For example, as illustrated in
The sensor system (sensors 26a-26d) is preferably configured to be capable of detecting the boundaries 42L and 42R and the center line 42C of the road 16 or other stationary or moving objects (e.g., remote vehicles 14). However, the sensor system (sensors 26a-26d) can be any type of system desirable. For example, the front sensors 26a and 26b and rear sensors 26c and 26d in the sensor system (sensors 26a-26d) can include a long-range radar device for detection of a remote vehicle 14 that is located at a distance from the front or the rear of the host vehicle 10. Thus, the radar sensors may be configured to detect objects at a predetermined distance (e.g., distances up to 200 m), and thus may have a narrow field of view angle (e.g., around 15°). Due to the narrow field of view angle, the long-range radar may not detect all objects in the front of in the rear of the host vehicle 10. Thus, if desired, the front sensors 26a and 26b and rear sensors 26c and 26d can include short-range radar devices to assist in monitoring the region in front of or to the rear of the host vehicle 10. However, the sensors in the sensor system (sensors 26a-26d) can be disposed in any position of the host vehicle 10 and may include any type and/or combination of sensors to enable detection of a remote vehicle 14. In addition, the sensor system (sensors 26a-26d) may include cameras (e.g., mounted on the mirrors 46 or any other suitable place), radar sensors, photo sensors or any combination thereof. Although
Although the sensor system (sensors 26a-26d) can be electronic detection devices that transmit either electronic electromagnetic waves (e.g., radar), the sensors 26a-26d can be any suitable sensors that, for example, take computer-processed images with a digital camera and analyzes the images or emit lasers, as is known in the art. The sensor system (sensors 26a-26d) may be capable of detecting at least the speed, direction, yaw, acceleration and distance of the host vehicle 10 relative to the boundaries 42L and 42R and the center line 42C of the road 16 or other stationary or moving objects. Further, the sensor system (sensors 26a-26d) may include object-locating sensing devices including range sensors, such as FM-CW (Frequency Modulated Continuous Wave) radars, pulse and FSK (Frequency Shift Keying) radars, sonar and Lidar (Light Detection and Ranging) devices, and ultrasonic devices which rely upon effects such as Doppler-effect measurements to locate forward objects. Object-locating devices may include charged-coupled devices (CCD) or complementary metal oxide semi-conductor (CMOS) video image sensors, and other known camera/video image processors which utilize digital photographic methods to “view” forward objects including one or more remote vehicles 14. The sensor system (sensors 26a-26d) is in communication with the controller 24, and is capable of transmitting information to the controller 24.
The sensor system (sensors 26a-26d) is further capable of detecting remote vehicles 14 both in front of and behind the host vehicle 10. Thus, the sensor system can transmit information relating to the speed and location of a following remote vehicle 14, a leading remote vehicle, a remote vehicle 14 that is traveling in an adjacent lane and traveling in an opposite direction of the host vehicle 10 and any other moving and or stationary remote vehicle 14.
The warning indicator 30 may include warning lights and/or a warning audio output and is in communication with the controller 24. For example, the warning indicator 30 may include a visual display or light indicator that flashes or illuminates the instrument cluster on the instrument panel IP of the host vehicle 10, activates a heads-up display is a visual readout in the display 40, is an audible noise emitted from speaker, or any other suitable visual display or audio or sound indicator or combination thereof that notifies the operator or interior occupant of the host vehicle 10 should transition to a different lane (e.g., the right lane 16R).
As shown in
Additionally, the system 12 may also be connected to the steering system of the vehicle 10, such that the controller 24 can control the steering system of the vehicle 10 based on a predetermined set of criteria. The controller 24 can be connected to the steering wheel SW or any other suitable portion of the steering system. That is, the controller 24 can apply an assist force to a portion of the steering system of the vehicle 10 to cause movement of the vehicle 10 towards the right lane 16R. In one embodiment, the controller 24 is capable of performing a lane change operation, such that based upon predetermined criteria, the system 12 performs a mitigation operation which results in the host vehicle 10 changing lanes, for example, the lane to the right of the host vehicle or the right most lane on the road (from lane 16L to lane 16R).
The system 12 may include a positioning system 28, such as a GPS. In one embodiment the vehicle 10 receives a GPS satellite signal. As is understood, the GPS processes the GPS satellite signal to determine positional information (such as location, speed, acceleration, yaw, and direction, just to name a few) of the vehicle 10. The positioning system 28 can provide information to the controller that enables the controller to determine the host vehicle speed, location and travel path. As noted herein, the positioning system 28 is in communication with the controller 24, and is capable of transmitting such positional information regarding the host vehicle 10 to the controller 24. Moreover, the controller can cause host vehicle information (e.g., location, speed, acceleration, yaw, and direction, just to name a few) to remote vehicles 14 via the receiver/transmitter system 36, and receive information (e.g., location, speed, acceleration, yaw, and direction, just to name a few) from remote vehicles 14 via the receiver/transmitter system 36.
The positioning system 28 also can also include or be in communication with the data storage 34 that stores map data. Thus, in determining the position of the host vehicle 10 using any of the herein described methods, devices or systems, the positioning host of the vehicle 10 may be compared to the known data stored in the data storage 34. Thus, the system 12 may accurately determine the location of the host vehicle 10 on an electronic map. For example, the position system can determine the lane in which the host vehicle 10 is located and whether the host vehicle 10 is positioned in the appropriate lane on the road 16. The storage device 34 may also store any additional information including the current or predicted vehicle position and any past vehicle 10 position or any other suitable information.
The receiver/transmitter system 36 is preferably the system that communicates with the two-way wireless communication network discussed above. The receiver/transmitter system 36 is configured to send information to the external server 22, the cloud C or internet. The receiver/transmitter system 36 can send and receive information in any suitable manner, such as data packets. The receiver/transmitter system 36 can send and receive information to and from the two-way wireless communication network, directly to other vehicles (e.g., remote vehicles 14) or in a suitable manner. When communication with other vehicles, the information can be sent directly to the remote vehicle 14, when in range, or through blockchain. Blockchain communication could be encrypted information that is sent from the host vehicle 10 to the remote vehicle 14 through other remote vehicles 14 or portable devices. The electronic controllers of the other vehicles or portable devices would serve as the blocks of the chain between the host vehicle 10 and the remote vehicle 14.
The receiver/transmitter system 36 includes, for example, a receiver and a transmitter configured as individual components or as a transceiver, and any other type of equipment for wireless communication. For example, the receiver/transmitter system 36 is configured to communicate wirelessly over one or more communication paths. Examples of communication paths include a cellular telephone network, a wireless network (Wi-Fi or a WiMAX), a DSRC (Dedicated Short-Range Communications) network, a power line communication network, etc. The receiver/transmitter system 36 is configured to receive information from external sources and to transmit such information to the controller 24. For example, the receiver/transmitter system 36 can communicate with another vehicle, or any other suitable entity via a communication network, direct communication, or in any suitable manner as understood in the art.
As shown in
The host vehicle 10 receives or determines remote vehicle information, such as, location, speed, and trajectory (travel path), of the remote vehicle 14 and a lateral distance of the remote vehicle 14 relative to the host vehicle 10, e.g., through vehicle to vehicle communications, the sensor system 26 on the host vehicle 10, or any other suitable or combination of suitable methods of gathering and receiving information. In this embodiment, the system 12 has determined that the remote vehicle 14 is traveling in the right lane 16R and at a specific speed and trajectory. Based on the remote vehicle information and the host vehicle information, the host vehicle 10 determines that the remote vehicle 14 started behind the host vehicle 10 at a predetermined distance, has reduced the distance, and has passed (see e.g.,
As discussed in more detail below, if the first and second remote vehicles 14 undertake the host vehicle 10 within a predetermined time, the system 12 can determine that a mitigation operation is necessary or warranted. In one embodiment, the mitigation operation is notifying the operator of the host vehicle 10 to move to the right lane 16R or manipulating the steering system to move the host vehicle 10 to the right lane 16R, see for example
In one embodiment, the controller 24 is configured to determine the travel path of the remote vehicle 14 based on a plurality of position coordinates 301, 302, 303, etc. received by the transmitter/receiver 28 within a predetermined amount of time. That is, the remote vehicle 14 can transmit a position coordinates at predetermine intervals. Based on the position coordinates, the controller 24 can determine the travel path, speed and location of the remote vehicle. Moreover, the system 12, using the positioning system 28 (or any other suitable system) can determine the travel path of the host vehicle 10 based on a plurality of position coordinates 101, 102, 103, etc. within a predetermined amount of time. The controller 24 can then compare the plurality of position coordinates 301, 302, 303, etc. received by the transmitter/receiver 28 with host vehicle position coordinates 101, 102, 103, etc. to determine whether the travel path of the host vehicle 10 and the travel path of the remote vehicle 14 are the same.
As shown in
Based on the information (e.g., remote vehicle speed, location and travel path) received from the remote vehicle 14, e.g., through vehicle to vehicle communications, the sensors 26 on the host vehicle 10, or any other suitable or combination of suitable methods of gathering and receiving information, as described herein, the system 12 compares the host vehicle information (speed, location and travel path) with the remote vehicle information to determine that the remote vehicle 14 has passed (see e.g.,
As discussed in more detail below, if the first and second remote vehicles 14 undertake the host vehicle within a predetermined time, the system 12 can determine that a mitigation operation is necessary or warranted. In one embodiment, the mitigation operation is notifying the operator of the host vehicle 10 to move to the right most lane or manipulating the steering system to move the host vehicle 10 to the right lane 16R, see for example
In one embodiment, the controller 24 has programmed parameters to determine whether a mitigation operation is warranted. For example, the controller can include a timer that determines whether a predetermined time has elapsed between multiple remote vehicles 14 undertaking the host vehicle 10. In other words, in some embodiments, it may be acceptable for a single remote vehicle 14 to undertake a host vehicle 10, or a single remote vehicle to undertake the host vehicle within a predetermined time frame or range (e.g., 3 minutes). Thus, if a predetermined number of remote vehicles (e.g., 2 remote vehicles) undertake the host vehicle 10 within a predetermined number of seconds or minutes, the host vehicle 10 will perform a mitigation operation.
Q1: remote vehicle 14 is to the Northeast of the host vehicle 10
If the remote vehicle 14 is northeast of the host vehicle 10, as shown in
The remote vehicle 14 is ahead (XW=00) of the host vehicle 10 if:
0≤δHV<A1 or A2≤δHV<2π
Where:
A1=β1+π/2−φ1
A4=β1+3π/2+φ1
φ1 is a threshold value that defines the angular range in which the remote vehicle 14 is defined to be adjacent to the host vehicle 10
This region is identified as the horizontal cross hatching area in
The remote vehicle 14 is adjacent (XW=01) to the host vehicle 10 if:
A
1≤δHV<A2 or A3≤δHV<A4
Where:
A1=β1+π/2−φ1
A2=β1+π/2+φ1
A3−β1+3π/2−φ1
A4=β1+3π/2+φ1
These two specific angular ranges are identified as the interface between the vertical cross hatching area and horizontal cross hatching area in
The remote vehicle 14 is behind (XW=10) the host vehicle 10 if:
A
2≤δHV<A3
Where:
A2=β1+π/2+φ1
A3=β1+3π/2−φ1
This region is identified as the vertical cross hatching area in
The remote vehicle 14 is in lane (VU=00) with the host vehicle 10 if:
A
5≤δHV<A6 or A7≤δHV<A8
Where:
A5=β1−φ2
A6=β1+φ2
A7=β1+π−φ2
A8=β1+π+φ2
φ2 is a threshold value that defines the angular range in which the remote vehicle 14 is defined to be in the same lane with the host vehicle 10.
These two specific angular ranges are identified as the interface between the horizontal cross-sectional area and vertical cross-sectional area in
The remote vehicle 14 is to the left (VU=01) of the host vehicle 10 if:
A
6≤δHV<A7
Where:
A6=β1+φ2
A7=β1+π−φ2
This region is identified as the vertical cross-sectional area in
The remote vehicle 14 is to the right (VU=10) of the host vehicle 10 if:
0≤δHV<A5 or A8≤δHV<2π
Where:
A5=β1−φ2
A8=β1+π−φ2
This region is identified as the horizontal cross-sectional area in
The expressions are then consolidated in Table 1 for the case when the remote vehicle 14 is to the northeast of the host vehicle 10.
If the remote vehicle 14 is northwest of the Host vehicle 10 as shown in
The remote vehicle 14 is ahead (XW=00) of the host vehicle 10 if:
0≤δHV<A9 or A12≤δHV<2π
Where:
A9=β1−3π/2−φ1
A12=β1−π/2+φ1
φ1 is a threshold value that defines the angular range in which the remote vehicle 14 is defined to be adjacent to the host vehicle 10.
This region is identified as the diagonal (from upper right to lower left) sectional area in
The remote vehicle 14 is adjacent (XW=01) to the host vehicle 10 if:
A
9≤δHV<A10 or A11≤δHV<A12
Where:
A9=β1−3π/2−φ1
A10=β1−3π/2+φ1
A11=β1−π/2−φ1
A12=β1−π/2+φ1
These two specific angular ranges are identified as the interface between the vertical cross-sectional area and the diagonal (from upper right to lower left) cross sectional area in
The remote vehicle 14 is behind (XW=10) the host vehicle 10 if:
A
10≤δHV<A11
Where:
A10=β1−3π/2+φ1
A11=β1−π/2−φ1
This region is identified as the vertical cross-sectional area in
The remote vehicle 14 is in lane (VU=00) with the host vehicle 10 if:
A
13≤δHV<A14 or A15≤δHV<A16
Where:
A13=β1−π−φ2
A14=β1−π+φ2
A15=β1−φ2
A16=β1+φ2
φ2 is a threshold value that defines the angular range in which the remote vehicle 14 is defined to be in the same lane with the host vehicle 10.
These two specific angular ranges are identified as the interface between the horizontal cross sectional area and the diagonal (from upper left to lower right) sectional area in
The remote vehicle 14 is to the left (VU=01) of the host vehicle 10 if:
0≤δHV<A13 or A16≤δHV<2π
Where:
A13=β1−π−φ2
A16=β1+φ2
This region is identified as the blue shaded area in the illustration on the right side of
The remote vehicle 14 is to the right (VU=10) of the host vehicle 10 if:
A
14≤δHV<A15
Where:
A14=)81+T2
A15=β1−β2
This region is identified as the diagonal (from upper left to lower right) sectional area in
The expressions are then consolidated in Table 2 for the case when the remote vehicle 14 is to the northwest of the host vehicle 10.
If the remote vehicle 14 is southwest of the host vehicle 10 as shown in
The remote vehicle 14 is ahead (XW=00) of the host vehicle 10 if:
A
12≤δHV<A1
Where:
A12=β1−π/2+φ1
A1=β1+π/2−φ1
φ1 is a threshold value that defines the angular range in which the remote vehicle 14 is defined to be adjacent to the host vehicle 10
This region is identified as the diagonal (upper right to lower left) cross sectional area in
The remote vehicle 14 is adjacent (XW=01) to the host vehicle 10 if:
A
1≤δHV<A2 or A11≤δHV<A12
Where:
A1=β1+π/2−φ1
A2=β1+π/2+φ1
A11=β1−π/2−φ1
A12=β1−π/2+φ1
These two specific angular ranges are identified as the interface between the vertical cross-sectional area and the diagonal (upper right to lower left) cross sectional area in
The remote vehicle 14 is behind (XW=10) the host vehicle 10 if:
0≤δHV<A11 or A2≤δHV<2π
Where:
A2=β1+π/2+φ1
A11=β1−π/2−φ1
This region is identified as the vertical cross-sectional area in
The remote vehicle 14 is in lane (VU=00) with the host vehicle 10 if:
A
13≤δHV<A14 or A15≤δHV<A16
Where:
A13=β1−π−φ2
A14=β1−π+φ2
A15=β1−φ2
A16=β1+φ2
φ2 is a threshold value that defines the angular range in which the remote vehicle 14 is defined to be in the same lane with the host vehicle 10
These two specific angular ranges are identified as the interface between the diagonal (upper left to lower right) cross sectional area and the horizontal area in
The remote vehicle 14 is to the left (VU=01) of the host vehicle 10 if:
0≤δHV<A13 or A16≤δHV<2π
A13=β1−π−φ2
A16=β1+φ2
This region is identified as the horizontal area in
The remote vehicle 14 is to the right (VU=10) of the host vehicle 10 if:
A
14≤δHV<A15
Where:
A14=β1−π+φ2
A15=β1−φ2
This region is identified as the diagonal (upper left to lower right) cross sectional area in
The expressions are then consolidated in Table 3 for the case when the remote vehicle 14 is to the southwest of the host vehicle 10.
If the remote vehicle 14 is southeast of the Host vehicle 10 as shown in
The remote vehicle 14 is ahead (XW=00) of the host vehicle 10 if:
A
12≤δHV<A1
Where:
A1+β1+π/2−φ1
A12+β1−π/2+φ1
φ1 is a threshold value that defines the angular range in which the remote vehicle 14 is defined to be adjacent to the host vehicle 10
This region is identified as the diagonal (from upper right to lower left) cross sectional area in
The remote vehicle 14 is adjacent (XW=01) to the host vehicle 10 if:
A
1≤δHVA2 or A11≤δHV<A12
Where:
A1=β1+π/2−φ1
A2=β1+π/2+φ1
A11=β1−π/2−φ1
A12=β1−π/2+φ1
These two specific angular ranges are identified as the interface between the vertical cross-sectional area and the diagonal (from upper right to lower left) cross sectional area in
The remote vehicle 14 is behind (XW=10) the host vehicle 10 if:
A
2≤δHV<2π or 0≤δHV<A11
Where:
A2=β1+π/2+φ1
A11=β1−π/2−φ1
This region is identified as the vertical cross-sectional area in
The remote vehicle 14 is in lane (VU=00) with the host vehicle 10 if:
A
5≤δHV<A6 or A7≤δHV<A8
A5=β1−φ2
A6=β1+φ2
A7=β1+π−φ2
A8=β1+π+φ2
φ2 is a threshold value that defines the angular range in which the remote vehicle 14 is defined to be in the same lane with the host vehicle 10
These two specific angular ranges are identified as the interface between the horizontal cross-sectional area and the diagonal (form upper left to lower right) cross sectional area in
The remote vehicle 14 is to the left (VU=01) of the host vehicle 10 if:
A
6≤δHV<A7
A6=β1+φ2
A7=β1+π−φ2
This region is identified as the diagonal (form upper left to lower right) cross sectional area in
The remote vehicle 14 is to the right (VU=10) of the host vehicle 10 if:
0≤δHV<A5 or A8≤δHV<2π
A5=β1−φ2
A8=β1+π+φ2
This region is identified as the horizontal cross-sectional area in
The expressions are then consolidated in Table 4 for the case when the remote vehicle 14 is to the southwest of the host vehicle 10.
The longitudinal and lateral relative position bits for the relative position code are defined in Table 6:
Bits X through U are generated using the array of expressions shown in Table 7
The elevation component of relative position is easily provided by the following three expressions.
If the host vehicle 10 and remote vehicle 14 are at the same elevation,
If the host vehicle 10 is lower,
If the host vehicle 10 is higher,
where:
Zhost vehicle=host vehicle 10 elevation
Zremote vehicle=remote vehicle 14 elevation
£=a defined threshold value of distance such as 4 m.
Bits T and S U are generated using the array of expressions shown in Table 8.
When the host vehicle 10 and the remote vehicle 14 traveling in same direction, (RQ=01). The remote vehicle 14 heading angle as a function of the host vehicle 10 heading angle for the case of following vehicles can be defined as follows: δRV=δHV
However, narrowly defining δremote vehicle to be exactly the same as δhost vehicle would result in a condition where the two vehicles would almost never be classified as heading in the same direction when in reality this condition is a very common occurrence. In order to account for small differences in heading angles, a variable φ2 is used to define a range of heading angles for the remote vehicle 14 in which the remote vehicle 14 would be considered to be heading in the same direction as the host vehicle 10. To define this range, the following expressions are defined.
Minimum Remote Vehicle Heading Angle
If δRV−φ2 then δRV
If δRV−φ2≥0 then δRV
These conditions can be combined into one mathematical expression as:
δRV
These expressions have two values, 0 or 1 depending on the value of δremote vehicle and can be thought of as filtering functions that ensure the appropriate expression is used to calculate the value of δRV
If δRV+φ<2π then δRV
If δRV+φ≥2π then δRV
These conditions can be combined into one mathematical expression as:
δRV
These expressions have two values, 0 or 1 depending on the value of δremote vehicle and can be thought of as filtering functions that ensure the appropriate expression is used to calculate the value of δRV
The remote vehicle 14 is considered to be traveling in the same direction as the host vehicle 10 when the heading angle of the remote vehicle 14, δremote vehicle falls within the range δRV
However, because of the fixed reference used where North=0°, there are cases where δhost vehicle will be less than or equal to δRV
Consider the following expressions for H1 and H2.
H
1=δHV−δRV
H
2=δHV−δRV
For any value of δhost vehicle, the values for H1 and H2 fall within three distinct categories:
1: H1 is negative, H2 is negative and H1<H2 (δHV<δRV
2: H1 is positive, H2 is negative and H1>H2 (δHV>δRV
3: H1 is positive, H2 is positive and H1<H2 (δHV>δRV
From these three conditions, it can be shown that for any combination of δhost vehicle and δremote vehicle, where 0≤δHV<2π and 0≤δRV<2π the following expressions can be used to identify if the host vehicle 10 and remote vehicle 14 are traveling in the same direction.
If H1<H2, δRV≤δRV
If H1>H2 and δRV
If H1<H2 and δRV
Also, it is advantageous to define the difference of H1 and H2 as follows:
H
1
−H
2=δHV−δRV
H
1
−H
2=δHV−δRV
H
1
−H
2=δHV−δRV
H
1
−H
2=δRV
Then the previous expressions can be expressed as:
If the sum of these three expressions is equal to 1, the host vehicle 10 and remote vehicle 14 are traveling in the same direction. This condition is expressed mathematically as:
host vehicle 10 and remote vehicle 14 approaching either other from opposite directions (RQ=10):
Remote vehicle 14 Heading angle as a function of Host vehicle 10 heading angle for the case of on-coming vehicles can be defined as follows:
However, narrowly defining δremote vehicle to be exactly opposite of δhost vehicle would result in a condition where the two vehicles would almost never be classified as heading in opposite direction when in reality this condition is a very common occurrence. In order to account for small differences in heading angles, the variable φ2 is used to define a range of heading angles for the remote vehicle 14 in which the remote vehicle 14 would be considered to be heading in the opposite direction of the host vehicle 10. To define this range, the following expressions are defined:
If δRV−φ2<0 then δRV
If δRV−φ2≥0 then δRV
δRV
These expressions have two values, 0 or 1 depending on the value of δremote vehicle and can be thought of as filtering functions that ensure the appropriate expression is used to calculate the value of δRV
If δRV+φ2<2π then δRV
If δRV+φ2≥2π then δRV
These conditions can be combined into one mathematical expression as:
δRV
where:
These expressions have two values, 0 or 1 depending on the value of δremote vehicle and can be thought of as filtering functions that ensure the appropriate expression is used to calculate the value of δRV
The remote vehicle 14 is considered to be traveling in the direction opposite of the host vehicle 10 when the heading angle of the remote vehicle 14, δremote vehicle falls within the range δRV
There also exist cases where δhost vehicle will be greater than δRV
However, because of the fixed reference used where North=0°, there are cases where δhost vehicle will be less than δRV
Consider the following expressions for H1 and H2.
H
1=δHV−δRV
H
2=δHV−δRV
For any value of δhost vehicle, the values for H1 and H2 fall within three distinct categories:
1: H1 is negative, H2 is negative and H1>H2 (δHV<δRV
2: H1 is negative, H2 is positive and H1<H2 (δHV<δRV
3: H1 is positive, this positive and H1>H2 (δHV>δRV
From these three conditions, it can be shown that for any combination of δhost vehicle and δremote vehicle, where 0≤δHV<2π and 0≤RRV<2π the following expressions can be used to identify if the host vehicle 10 and remote vehicle 14 are traveling in opposite directions.
If H1>H2 and δRV
If H1<H2, δRV
If H1<H2, δRV≤δRV
Also, it is advantageous to define the difference of H1 and H2 as follows:
H
1
−H
2=δHV−βRV
H
1
−H
2=δHV−βRV
H
1
−H
2=δHV−βRV
H
1
−H
2=δRV
Then the previous expressions can be expressed as:
By summing these three expressions, it can be determined that the host vehicle 10 and remote vehicle 14 are approaching each other from opposite directions if:
host vehicle 10 and remote vehicle 14 approaching from crossing directions (RQ=11) When the remote vehicle 14 and host vehicle 10 approach each other from directions that result in a crossing path, the remote vehicle 14 heading angle, δremote vehicle can be defined as a function of host vehicle 10 heading angle, δhost vehicle according to the following expressions. Since a crossing path can occur if the remote vehicle 14 approaches from the left or right, a total of four angles must be defined; minimum and maximum angles for the left and minimum and maximum angle for the right. If δremote vehicle falls within the two ranges, a crossing path exists.
Remote vehicle 14 Heading angle as a function of Host vehicle 10 heading angle for the case of vehicles crossing paths can be defined as follows:
φ3=π/2−φL
φ4=π/2+φL
φ5=3π/2−φR
φ6=3π/2+φR
φL and φR are threshold values that defines the angular range in which the remote vehicle 14 is defined to be in a crossing path with the host vehicle 10.
These variables define the minimum and maximum boundaries for the range of δremote vehicle with respect to δhost vehicle for crossing paths values of S, emote vehicle that fall outside these ranges are considered to be another condition such as in-path, opposite path or diverging path. The direction, left or right, from which the remote vehicle 14 is approaching is immaterial but a single equation for δRV
And:
A5=β1−φ2
A6=β1+φ2
A7=β1+π−φ2
A8=β1+π+φ2
A13=β1−π−φ2
A14=β1−π+φ2
A15=β1−φ2
A16=β1+β2
The remote vehicle 14 is considered to be in a crossing path with the host vehicle 10 when the heading angle of the remote vehicle 14, δremote vehicle falls within the range δRV
These regions are illustrated in
Similarly, when the remote vehicle 14 is approaching from the right, there are three regions that need to be considered:
These regions are illustrated in
Consider the following expressions for H1 and H2.
H
1=δHV−δRV
H
2=δHV−δRV
For any value of δhost vehicle, the values for H1 and H2 fall within three distinct categories:
1: H1 is negative, H2 is negative and H1>H2
2: H1 is negative, H2 is positive and H1<H2
3: H1 is positive, H2 is positive and H1>H2
From these three conditions, it can be shown that for any combination of δhost vehicle and δremote vehicle, where 0≤2π and 0≤δRV<2π the following expressions can be used to identify if the host vehicle 10 and remote vehicle 14 are crossing paths.
If H1>H2, δRV
If H1<H2, δRV
If H1<H2, δRV
Also, it is advantageous to define the difference of H1 and H2 as follows:
H
1
−H
2=δHV−δRV
H
1
−H
2=δHV−δRV
H
1
−H
2=δHV−δRV
H
1
−H
2=δRV
Then the expressions above can be expressed as:
By summing these three expressions, it can be determined that the host vehicle 10 and remote vehicle 14 are crossing paths if:
If R=Q=0 the paths of the remote vehicle 14 and host vehicle 10 are considered to be diverging away from each other.
That is, the controller searches for the following series of relative position codes from a particular remote vehicle 14. If such a series of codes exists, the host vehicle 10 is being undertaken by the remote vehicle 14. Table 9 illustrates the relative position codes for identifying the host vehicle being undertaken.
The controller 24 first determines the jurisdictional requirements for the host vehicle 10 to determine if a warning or mitigation operation is appropriate. Once the laws of the current jurisdiction are determined, the controller 24 determines if a mitigation operation should be performed. When the system 12 determines that a remote vehicle 14 with a position code of 10100001 that is within a predetermined time, such as 3 seconds, from the host vehicle 10, the system 12 calculates the lateral distance of the remote vehicle 14 from the host vehicle 10. If the lateral distance is within 5.4 meters, the system 12 starts a timer 25 that is set to a predetermined value, such as 3 minutes. The system 12 uses the timer 25 to determine if a threshold number of remote vehicles 14, such as 3, undertakes the host vehicle 10 before the timer 25 times out. When the position code of a remote vehicle 14 undertaking the host vehicle 10 transitions from 10100001 to 00100001, the system 12 increments a counter 27, as long as the timer 25 has not run out. If the counter 27 value reaches a predetermined value, such as 3, before the timer 25 times out, the system 12 performs a mitigation operation, such as transitioning to a right lane or a lane to the right of the host vehicle 10. If the timer 25 runs out before the counter 27 reaches its predetermined value, the system 12 resets both timer 25 and counter 27 and does not perform a mitigation operation.
When the controller 24 detects a remote vehicle 14 with a position code of 10100001 that is within a predetermined time, such as 3 seconds, from the host vehicle 10, the system 12 determines the lateral distance of the remote vehicle 14 from the host vehicle 10. If the lateral distance is within 5.4 meters, the system 12 starts the timer 25, that is set to some predetermined value, such as 3 minutes. The system 12 uses the timer 25 to determine if a predetermined number of remote vehicles, such as 3, undertakes the host vehicle 10 before the timer 25 times out. When the position code of a remote vehicle 14 undertaking the host vehicle 10 transitions from 10100001 to 00100001, the system 12 increments the counter 27, as long as the timer 25 has not run out. If the counter value reaches a predetermined value, such as 3, before the timer 25 times out, the system 12 performs a mitigation operation, such as transitioning to a right lane or a lane to the right of the host vehicle 10. If the timer 25 runs out before the counter 27 reaches its predetermined value, the system 12 resets both timer 25 and counter 27 and does not perform a mitigation operation.
If travel is allowed in the left lane or non-right most lane, the controller 24 determines whether code 1010001 is present in step S140. If code 1010001 is not present, the controller 24 determines whether the timer 25 is running in step S150. If the timer 25 is not running, the controller 24 returns to start. If the timer 25 is running, the controller 24 determines whether the timer 25 has runout in step S160. If the timer 24 has not run out, the controller 24 returns to start. If the timer 25 has runout, the controller 24 resets the timer 25 and the counter 27 in step S170 and returns to start.
Turning back to step S140, if code 1010001 is present, the controller 24 determines whether the timer 25 has started in step S180. If the timer 25 has started, the controller 24 determines whether the timer 25 has runout in step S190. If the timer 25 has runout, the controller 24 resets the timer 25 and the counter 270 in step S170 and returns to start. If the timer 25 has not run out, the controller 24 determines whether the remote vehicles 14 have transitioned to code 0010001 in step S200. If the remote vehicles 14 have not transitioned to code 0010001, the controller 24 returns to start. If the controller 24 determines that the remote vehicles 14 have transitioned to code 00100001, the controller 24 determines whether the counter 27 has reached a predetermined number of maximum remote vehicles 14 in step S210. If the counter 27 has reached a predetermined number of maximum remote vehicles 14, the controller 24 instructs the system 24 to perform a mitigation operation in step S130.
If the counter 27 has not reached a predetermined number of maximum remote vehicles 14, the controller 24 determines whether the timer 25 has run out in step S220. If the timer 25 has runout, the controller 24 resets the timer 25 and the counter 27 in step S170 and returns to start. If the controller 24 determines that the timer 25 has not runout, the controller 24 increments the counter 27 in step S230 and returns to start.
Turning back to step S180, if the timer 25 has not started, the controller 24 starts the timer in S240. The controller 24 then determines whether the remote vehicles 14 have transitioned to code 0010001 in step S200. If the remote vehicles 14 have not transitioned to code 0010001, the controller 24 returns to start. If the controller 24 determines that the remote vehicles 14 have transitioned to code 00100001, the controller 24 determines whether the counter 27 has reached a predetermined number of maximum remote vehicles 14 in step S210. If the counter 27 has reached a predetermined number of maximum remote vehicles 14, the controller 24 instructs the system 12 to perform a mitigation operation in step S130.
If the counter 27 has not reached a predetermined number of maximum remote vehicles 14, the controller 24 determines whether the timer 25 has run out in step S220. If the timer 25 has runout, the controller 24 resets the timer 25 and the counter 27 in step S170 and returns to start. If the controller 24 determines that the timer 25 has not runout, the controller 24 increments the counter 27 in step S230 and returns to start.
It has been found that the present system improve vehicles and vehicle occupant safety, improves compliance with local jurisdictional laws and rules by performing a mitigation operation when determining the appropriate a lane for a vehicle.
In understanding the scope of the present invention, the term “comprising” and its derivatives, as used herein, are intended to be open ended terms that specify the presence of the stated features, elements, components, groups, integers, and/or steps, but do not exclude the presence of other unstated features, elements, components, groups, integers and/or steps. The foregoing also applies to words having similar meanings such as the terms, “including”, “having” and their derivatives. Also, the terms “section,” “portion,” or “element” when used in the singular can have the dual meaning of a single part or a plurality of parts. Also as used herein to describe the above embodiment(s), the following directional terms “forward”, “rear”, “vertical” and “horizontal”, as well as any other similar directional terms refer to those directions of a vehicle equipped with the system for determining a lane for a vehicle. Accordingly, these terms, as utilized to describe the present invention should be interpreted relative to a vehicle equipped with the system for determining a lane for a vehicle.
The term “detect” as used herein to describe an operation or function carried out by a component, a section, a device or the like includes a component, a section, a device or the like that does not require physical detection, but rather includes determining, measuring, modeling, predicting or computing or the like to carry out the operation or function.
The term “configured” as used herein to describe a component, section or part of a device includes hardware and/or software that is constructed and/or programmed to carry out the desired function.
While only selected embodiments have been chosen to illustrate the present invention, it will be apparent to those skilled in the art from this disclosure that various changes and modifications can be made herein without departing from the scope of the invention as defined in the appended claims. For example, the size, shape, location or orientation of the various components can be changed as needed and/or desired. Components that are shown directly connected or contacting each other can have intermediate structures disposed between them. The functions of one element can be performed by two, and vice versa. The structures and functions of one embodiment can be adopted in another embodiment. It is not necessary for all advantages to be present in a particular embodiment at the same time. Every feature which is unique from the prior art, alone or in combination with other features, also should be considered a separate description of further inventions by the applicant, including the structural and/or functional concepts embodied by such feature(s). Thus, the foregoing descriptions of the embodiments according to the present invention are provided for illustration only, and not for the purpose of limiting the invention as defined by the appended claims and their equivalents.