Determining optimal vehicle behavior at intersection
Determine the stop line and signal phase of the intersection through vehicle sensors and controllers, calculate the best vehicle behavior, solves the problem of failure to consider the impact of additional vehicles and intersection geometric complexity in the prior art, and improves the vehicle's passage through the intersection Safety and efficiency.
Patent Information
- Application Number
- CN202311354978.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Priority Date
- 2023-05-12
- Filing Date
- 2023-10-18
- Publication Date
- 2024-11-12
AI Technical Summary
The existing Green Light Optimal Speed Recommendation (GLOSA) system fails to fully consider the impact of additional vehicles and complex intersection geometry on vehicle behavior at the intersection, resulting in poor occupant experience.
Through vehicle sensors and controllers, determine the inlet and exit stop line positions of the intersection, the current signal phase of the traffic signal, and the position of the far vehicle, calculate and perform the best vehicle behavior, including speed and stop position, in response to different signal phases and Distance relationship.
It improves the safety and efficiency of vehicles passing through intersections, adapts to changing traffic scenarios and vehicle locations, and enhances the occupant experience.
Smart Images

Figure CN118928398A_ABST
Abstract
Description
Technical Field
[0001] The present disclosure relates to systems and methods for determining optimal vehicle behavior at an intersection. Background Art
[0002] To improve occupant attention and convenience, vehicles may be equipped with a Green Light Optimal Speed Advisory (GLOSA) system that is configured to provide information about optimal vehicle speeds in order to reduce wait times at traffic signal controlled intersections. The GLOSA system may use data from infrastructure, such as traffic signal controllers, to determine the signal phase and timing of traffic signals. In order to safely cross an intersection when the light is green, the GLOSA system may calculate an optimal speed based on the vehicle's position. However, current GLOSA systems may not take into account additional factors that may affect the occupant experience, such as additional vehicles at the intersection that may affect the optimal speed. Furthermore, complex intersection geometries and / or traffic scenarios may require additional actions in addition to adjusting vehicle speed.
[0003] Therefore, while the GLOSA system and method achieve their intended purposes, a new and improved system and method for determining optimal vehicle behavior at an intersection is needed. Summary of the invention
[0004] According to several aspects, a system for determining an optimal behavior of a vehicle is provided. The system includes at least one vehicle sensor, and a controller in electrical communication with the at least one vehicle sensor. The controller is programmed to determine an entry stop line position and an exit stop line position of an intersection in the path of the vehicle by using the at least one vehicle sensor. The intersection is controlled by a traffic signal. The controller is also programmed to determine a current signal phase of the traffic signal by using the at least one vehicle sensor. The controller is also programmed to determine a position of a first remote vehicle by using the at least one vehicle sensor. The controller is also programmed to determine the optimal behavior of the vehicle based at least in part on the entry stop line position, the exit stop line position, the current signal phase, and the position of the first remote vehicle.
[0005] In another aspect of the present disclosure, the at least one vehicle sensor may further include a vehicle communication system. To determine the entry stop line position and the exit stop line position, the controller is further programmed to receive a map data message using the vehicle communication system. The map data message includes the entry stop line position and the exit stop line position.
[0006] In another aspect of the present disclosure, the at least one vehicle sensor may further include a vehicle communication system. To determine the current signal phase of the traffic signal, the controller is further programmed to receive a signal phase and time (SPaT) message using the vehicle communication system. The SPaT message includes the current signal phase of the traffic signal.
[0007] In another aspect of the present disclosure, the at least one vehicle sensor may further include a vehicle communication system. To determine the location of the first remote vehicle, the controller is further programmed to receive a basic safety message (BSM) from the first remote vehicle using the vehicle communication system. The BSM includes the location of the first remote vehicle.
[0008] In another aspect of the present disclosure, the at least one vehicle sensor may further include a vehicle communication system. In order to determine the position of the first remote vehicle, the controller is further programmed to receive an intersection queue message by using the vehicle communication system. The intersection queue message includes the position of the first remote vehicle.
[0009] In another aspect of the present disclosure, the at least one vehicle sensor may further include a vehicle perception sensor. To determine the position of the first remote vehicle, the controller is further programmed to detect the first remote vehicle by using the vehicle perception sensor. To determine the position of the first remote vehicle, the controller is further programmed to perform a plurality of measurements of the first remote vehicle by using the vehicle perception sensor. To determine the position of the first remote vehicle, the controller is further programmed to determine the position of the first remote vehicle based at least in part on the plurality of measurements of the first remote vehicle.
[0010] In another aspect of the present disclosure, to determine the optimal behavior of the vehicle, the controller is further programmed to: in response to determining that the current signal phase is red, perform a first action. To determine the optimal behavior of the vehicle, the controller is further programmed to: in response to determining that the current signal phase is green, perform a second action. To determine the optimal behavior of the vehicle, the controller is further programmed to: in response to determining that the current signal phase is yellow, perform a third action. To perform the third action, the controller is further programmed to: determine a stop position. To perform the third action, the controller is further programmed to: determine that the optimal behavior is to stop at the stop position.
[0011] In another aspect of the present disclosure, to perform the first action, the controller is further programmed to: determine a stop position. To perform the first action, the controller is further programmed to: determine a stop position, calculate an optimal speed based at least in part on the position of the vehicle and the stop position. To perform the first action, the controller is further programmed to: determine a stop position, compare the optimal speed to a minimum speed limit. To perform the first action, the controller is further programmed to: determine a stop position, and in response to determining that the optimal speed is less than the minimum speed limit, determine that the optimal behavior is to stop at the stop position. To perform the first action, the controller is further programmed to: determine a stop position, and in response to determining that the optimal speed is greater than or equal to the minimum speed limit, determine that the optimal behavior is to travel at the optimal speed.
[0012] In another aspect of the disclosure, to perform the second action, the controller is further programmed to: determine a first distance between the vehicle and the location of the first remote vehicle. To perform the second action, the controller is further programmed to: determine a second distance between the vehicle and the exit stop line location. To perform the second action, the controller is further programmed to: in response to determining that the first distance is greater than the second distance, determine that the best action is to travel at the current vehicle speed. To perform the second action, the controller is further programmed to: in response to determining that the first distance is less than the second distance, determine that the best action is to reduce the current vehicle speed.
[0013] In another aspect of the present disclosure, to determine the stop position, the controller is further programmed to: determine a third distance between the vehicle and the entry stop line position. To determine the stop position, the controller is further programmed to: in response to determining that the first distance is greater than the third distance, determine that the stop position is the entry stop line position. To determine the stop position, the controller is further programmed to: in response to determining that the first distance is less than or equal to the third distance, determine that the stop position is behind the first distant vehicle.
[0014] According to several aspects, a method for determining an optimal behavior for a vehicle is provided. The method includes determining an entry stop line position of an intersection in the path of the vehicle by using at least one vehicle sensor. The intersection is controlled by a traffic signal. The method also includes determining an exit stop line position of the intersection in the path of the vehicle by using the at least one vehicle sensor. The method also includes determining a current signal phase of the traffic signal by using the at least one vehicle sensor. The method also includes determining a position of a first distant vehicle by using the at least one vehicle sensor. The method also includes determining the optimal behavior of the vehicle based at least in part on the entry stop line position, the exit stop line position, the current signal phase, and the position of the first distant vehicle.
[0015] In another aspect of the present disclosure, determining the optimal behavior of the vehicle may further include: in response to determining that the current signal phase is red, performing a first action. Determining the optimal behavior of the vehicle may further include: in response to determining that the current signal phase is green, performing a second action. Determining the optimal behavior of the vehicle may further include: in response to determining that the current signal phase is yellow, performing a third action. Performing the third action may further include: determining a stop position. Performing the third action may further include: determining that the optimal behavior is to stop at the stop position.
[0016] In another aspect of the present disclosure, performing the first action may further include: determining a stop position. Performing the first action may further include: calculating an optimal speed based at least in part on the position of the vehicle and the stop position. Performing the first action may further include: comparing the optimal speed with a minimum speed limit and a maximum speed limit. Performing the first action may further include: in response to determining that the optimal speed is less than the minimum speed limit, determining that the optimal behavior is to stop at the stop position. Performing the first action may further include: in response to determining that the optimal speed is greater than or equal to the minimum speed limit and less than or equal to the maximum speed limit, determining that the optimal behavior is to travel at the optimal speed. Performing the first action may further include: in response to determining that the optimal speed is greater than the maximum speed limit, determining that the optimal behavior is to travel at the maximum speed limit.
[0017] In another aspect of the present disclosure, performing the second action may further include: determining a first distance between the vehicle and the position of the first distant vehicle. Performing the second action may further include: determining a second distance between the vehicle and the exit stop line position. Performing the second action may further include: in response to determining that the first distance is greater than the second distance, determining that the best behavior is to travel at the current vehicle speed. Performing the second action may further include: in response to determining that the first distance is less than the second distance, determining that the best behavior is to reduce the current vehicle speed.
[0018] In another aspect of the present disclosure, reducing the current vehicle speed may further include: reducing the current vehicle speed by a predetermined amount. Reducing the current vehicle speed may further include: comparing the current vehicle speed to a minimum speed limit. Reducing the current vehicle speed may further include: in response to determining that the current vehicle speed is less than the minimum speed limit, determining a stop position. Reducing the current vehicle speed may further include: in response to determining that the current vehicle speed is less than the minimum speed limit, determining that the best behavior is to stop at the stop position.
[0019] In another aspect of the present disclosure, determining the stop position may further include: determining a third distance between the vehicle and the entry stop line position. Determining the stop position may further include: in response to determining that the first distance is greater than the third distance, determining that the stop position is the entry stop line position. Determining the stop position may further include: in response to determining that the first distance is less than or equal to the third distance, determining that the stop position is behind the first distant vehicle.
[0020] In another aspect of the present disclosure, determining the stop position may further include: determining the speed of the first distant vehicle by using the at least one vehicle sensor. Determining the stop position may further include: comparing the speed of the first distant vehicle with a predetermined minimum speed. Determining the stop position may further include: determining the position of the second distant vehicle in response to determining that the first distance is less than or equal to the third distance and the speed of the first distant vehicle is greater than the predetermined minimum speed. The distance between the position of the vehicle and the second distant vehicle is greater than the first distance. Determining the stop position may further include: determining that the stop position of the first distant vehicle is rearward of the position of the second distant vehicle. Determining the stop position may further include: determining that the stop position is rearward of the stop position of the first distant vehicle.
[0021] According to several aspects, a system for determining an optimal behavior of a vehicle is provided. The system includes: a vehicle communication system, and a controller in electrical communication with the vehicle communication system. The controller is programmed to: receive a map data message by using the vehicle communication system. The map data message includes: an entry stop line position and an exit stop line position of an intersection in the path of the vehicle. The intersection is controlled by a traffic signal. The controller is also programmed to: receive a signal phase and time (SPaT) message by using the vehicle communication system. The SPaT message includes the current signal phase of the traffic signal. The controller is also programmed to: receive a basic safety message (BSM) from a first remote vehicle by using the vehicle communication system. The BSM includes the position of the first remote vehicle. The controller is also programmed to: determine the optimal behavior of the vehicle based at least in part on the entry stop line position, the exit stop line position, the current signal phase, and the position of the first remote vehicle.
[0022] In another aspect of the disclosure, to determine the optimal behavior of the vehicle, the controller is further programmed to: in response to determining that the current signal phase is red, perform a first action. To perform the first action, the controller is further programmed to: determine a stop position. To perform the first action, the controller is further programmed to: calculate an optimal speed based at least in part on the position of the vehicle and the stop position. To perform the first action, the controller is further programmed to: compare the optimal speed with a minimum speed limit. To perform the first action, the controller is further programmed to: in response to determining that the optimal speed is less than the minimum speed limit, determine that the optimal behavior is to stop at the stop position. To perform the first action, the controller is further programmed to: in response to determining that the optimal speed is greater than or equal to the minimum speed limit, determine that the optimal behavior is to travel at the optimal speed. To determine the optimal behavior of the vehicle, the controller is further programmed to: in response to determining that the current signal phase is green, perform a second action. To perform the second action, the controller is further programmed to: determine a first distance between the vehicle and the position of the first distant vehicle. To perform the second action, the controller is further programmed to determine a second distance between the vehicle and the exit stop line location. To perform the second action, the controller is further programmed to determine that the best behavior is to travel at the current vehicle speed in response to determining that the first distance is greater than the second distance. To perform the second action, the controller is further programmed to determine that the best behavior is to reduce the current vehicle speed in response to determining that the first distance is less than the second distance. To determine the best behavior for the vehicle, the controller is further programmed to perform a third action in response to determining that the current signal phase is yellow. To perform the third action, the controller is further programmed to determine the stop position, and determine that the best behavior is to stop at the stop position.
[0023] In another aspect of the present disclosure, to determine the stop position, the controller is further programmed to determine the speed of the first remote vehicle by using the vehicle communication system. To determine the stop position, the controller is further programmed to compare the speed of the first remote vehicle with a predetermined minimum speed. To determine the stop position, the controller is further programmed to determine a third distance between the vehicle and the entry stop line position. To determine the stop position, the controller is further programmed to determine that the stop position is the entry stop line position in response to determining that the first distance is greater than the third distance. To determine the stop position, the controller is further programmed to determine that the stop position is behind the first remote vehicle in response to determining that the first distance is less than or equal to the third distance and the speed of the first remote vehicle is greater than the predetermined minimum speed. To determine the stop position, the controller is further programmed to determine the position of the second remote vehicle in response to determining that the first distance is less than or equal to the third distance and the speed of the first remote vehicle is greater than the predetermined minimum speed, wherein the distance between the position of the vehicle and the second remote vehicle is greater than the first distance. In order to determine this stopping position, this controller is also programmed to: determine that the stopping position of this first distant vehicle is behind the position of this second distant vehicle. In order to determine this stopping position, this controller is also programmed to: determine that this stopping position is behind the stopping position of this first distant vehicle.
[0024] Further areas of applicability will become apparent from the description provided herein.It should be understood that the description and specific examples are intended for purposes of illustration only and are not intended to limit the scope of the present disclosure. BRIEF DESCRIPTION OF THE DRAWINGS
[0025] The drawings described herein are for illustration purposes only and are not intended to limit the scope of the present disclosure in any way.
[0026] Figure 1 is a schematic diagram of a system for determining optimal behavior of a vehicle according to an exemplary embodiment;
[0027] Figure 2A is a first schematic diagram of an intersection according to an exemplary embodiment;
[0028] Figure 2B is a second schematic diagram of an intersection according to an exemplary embodiment;
[0029] Figure 2C is a third schematic diagram of an intersection according to an exemplary embodiment;
[0030] Figure 3 is a flow chart of a method for determining an optimal behavior for a vehicle according to an exemplary embodiment;
[0031] Figure 4 is a flow chart of a method for performing a first action according to an exemplary embodiment;
[0032] Figure 5 is a flowchart of a method for performing a second action according to an exemplary embodiment;
[0033] Figure 6 is a flow chart of a method for performing a third action according to an exemplary embodiment;
[0034] Figure 7 is a flow chart of a method for determining a stop position according to an exemplary embodiment;
[0035] Figure 8 is a fourth schematic diagram of an intersection according to an exemplary embodiment; and
[0036] Fig. 9 is a flowchart of a method for reducing a current vehicle speed according to an exemplary embodiment. DETAILED DESCRIPTION
[0037] The following description is merely exemplary in nature and is not intended to limit the present disclosure, application, or uses.
[0038] Vehicles may be equipped with a Green Light Optimal Speed Advisory (GLOSA) system to help passengers safely and efficiently navigate intersections controlled by traffic signals. The GLOSA system may assume that the stopping position of the vehicle is at the stop line location of the intersection. However, due to changes in intersection geometry, and / or the presence and movement of distant vehicles, the stopping position may change. Therefore, the present disclosure provides a new and improved system and method for determining the optimal behavior of a vehicle at an intersection that takes into account the presence of distant vehicles.
[0039] refer to Figure 1 , a system for determining optimal behavior of a vehicle is shown and is generally indicated by reference numeral 10. The system 10 is shown with an exemplary vehicle 12. Although a passenger vehicle is shown, it should be understood that the vehicle 12 may be any type of vehicle without departing from the scope of the present disclosure. The system 10 generally includes a controller 14 and a plurality of vehicle sensors 16.
[0040] The controller 14 is used to implement a method 100 for determining optimal behavior of a vehicle as will be described below. The controller 14 includes at least one processor 18 and a non-transitory computer-readable storage device or medium 20. The processor 18 can be a custom or commercially available processor, a central processing unit (CPU), a graphics processing unit (GPU), an auxiliary processor of several processors associated with the controller 14, a semiconductor-based microprocessor (in the form of a microchip or chipset), a macroprocessor, a combination thereof, or generally a device for executing instructions. The computer-readable storage device or medium 20 may include volatile and non-volatile storage devices - such as read-only memory (ROM), random access memory (RAM), and keep-alive memory (KAM). KAM is a persistent or non-volatile memory that can be used to store various operating variables when the processor 18 is powered off. The computer readable storage device or medium 20 may be implemented using a plurality of storage devices, such as a PROM (Programmable Read Only Memory), an EPROM (Electrical PROM), an EEPROM (Electrically Erasable PROM), flash memory, or other electrical, magnetic, optical, or combination storage devices capable of storing data, some of which represent executable instructions that are used by the controller 14 to control various systems of the vehicle 12. The controller 14 may also be comprised of multiple controllers that are in electrical communication with each other. The controller 14 may be interconnected with additional systems and / or controllers of the vehicle 12, thereby allowing the controller 14 to access data, such as the speed, acceleration, braking, and steering angle of the vehicle 12.
[0041] The controller 14 is in electrical communication with a plurality of vehicle sensors 16. In an exemplary embodiment, the electrical communication is established using, for example, a CAN network, a FLEXRAY network, a local area network (e.g., WiFi, Ethernet, etc.), or a serial peripheral interface (SPI) network, etc. It should be understood that various additional wired and wireless technologies and communication protocols for communicating with the controller 14 are within the scope of the present disclosure.
[0042] The plurality of vehicle sensors 16 are used to determine information about the environment surrounding the vehicle 12. In the exemplary embodiment, the plurality of vehicle sensors 16 include a vehicle perception sensor 22, a global navigation satellite system (GNSS) 24, a vehicle communication system 26, and a plurality of additional vehicle sensors 28. As described above, the plurality of vehicle sensors 16 are in electrical communication with the controller 14.
[0043] The vehicle perception sensor 22 is used to collect information about the environment around the vehicle 12. In an exemplary embodiment, the perception sensor includes at least one of the following sensors: a range perception sensor and / or a visual perception sensor. In a non-limiting example, the range perception sensor includes, for example, a laser radar (LiDAR) sensor, an ultrasonic range sensor, a radar sensor, and / or a time-of-flight sensor. In a non-limiting example, the visual perception sensor includes, for example, an external camera, a surround view camera system, and / or a stereo camera. Figure 1 In the exemplary embodiment shown, the vehicle perception sensor 22 is a surround view camera system. The surround view camera system includes a plurality of cameras (also referred to as satellite cameras) arranged to provide views of the environment adjacent to all sides of the vehicle 12. In a non-limiting example, the surround view camera system includes a front camera (e.g., mounted in the front grille of the vehicle 12), a rear camera (e.g., mounted on the rear tailgate of the vehicle 12), and two side cameras (e.g., mounted below each of the two side view reflectors of the vehicle 12). In another non-limiting example, the surround view camera system also includes an additional rear view camera mounted near the center high mounted brake light of the vehicle 12.
[0044] It should be understood that surround view camera systems with additional cameras and / or additional mounting locations are within the scope of the present disclosure. It should also be understood that cameras with various sensor types (including, for example, charge coupled device (CCD) sensors, complementary metal oxide semiconductor (CMOS) sensors, and / or high dynamic range (HDR) sensors) are within the scope of the present disclosure. In addition, cameras with various lens types including, for example, wide angle lenses and / or narrow angle lenses are also within the scope of the present disclosure. As described above, the vehicle perception sensor 22 is in electrical communication with the controller 14.
[0045] GNSS24 is used to determine the geographic location of vehicle 12. In an exemplary embodiment, GNSS24 is a global positioning system (GPS). In a non-limiting example, GPS includes: a GPS receiver antenna (not shown), and a GPS controller (not shown) in electrical communication with the GPS receiver antenna. The GPS receiver antenna receives signals from multiple satellites, and the GPS controller calculates the geographic location of vehicle 12 based on the signals received by the GPS receiver antenna. In addition, in an exemplary embodiment, GNSS24 also includes a map. The map includes information about infrastructure, such as municipal boundaries, roads, railways, sidewalks, and buildings. Therefore, the map information is used as background information for the geographic location of vehicle 12. In a non-limiting example, the map is retrieved from a remote source using a wireless connection. In another non-limiting example, the map is stored in a database of GNSS24. It should be understood that various additional types of satellite-based radio navigation systems, such as global positioning system (GPS), Galileo, GLONASS, and Beidou navigation satellite system (BDS) are within the scope of the present disclosure. It should be understood that the GNSS 24 may be integrated with the controller 14 (eg, on the same circuit board as the controller 14 or otherwise as part of the controller 14) without departing from the scope of the present disclosure. As described above, the GNSS 24 is in electrical communication with the controller 14.
[0046] The controller 14 uses the vehicle communication system 26 to communicate with other systems external to the vehicle 12. For example, the vehicle communication system 26 includes the ability to communicate with vehicle communications ("V2V" communications), infrastructure ("V2I" communications), remote systems at a remote call center (e.g., General Motors' ON-STAR), and / or personal devices. In general, the term vehicle-to-everything communications ("V2X" communications) refers to communications between the vehicle 12 and any remote system (e.g., vehicle, infrastructure, and / or remote system). In certain embodiments, the vehicle communication system 26 is a wireless communication system that is configured to communicate via a wireless local area network (WLAN) using IEEE 802.11 standards or using cellular data communications (e.g., using GSMA standards such as, for example, SGP.02, SGP.22, SGP.32, etc.). Therefore, the vehicle communication system 26 may also include an embedded universal integrated circuit card (eUICC) that is configured to store a profile of at least one cellular connection configuration, such as an embedded subscriber identity module (eSIM) profile. The vehicle communication system 26 is also configured to communicate via a personal area network (e.g., Bluetooth) and / or near field communication (NFC). However, additional or alternative communication methods such as dedicated short range communication (DSRC) channels and / or mobile telecommunication protocols based on the third generation partnership project (3GPP) standards are also considered to be within the scope of the present disclosure. DSRC channels refer to short-range to medium-range wireless communication channels designed for automotive use, either unidirectional or bidirectional, and a set of corresponding protocols and standards. 3GPP refers to a partnership between several standards organizations that develop protocols and standards for mobile telecommunications. 3GPP standards are structured into "releases". Therefore, communication methods based on 3GPP releases 14, 15, 16 and / or future 3GPP releases are considered to be within the scope of the present disclosure. Therefore, the vehicle communication system 26 may include one or more antennas and / or communication transceivers for receiving and / or sending signals such as collaborative sensor messages (CSM). The vehicle communication system 26 is configured to wirelessly communicate information between the vehicle 12 and another vehicle. In addition, the vehicle communication system 26 is configured to wirelessly communicate information between the vehicle 12 and infrastructure or other vehicles. It should be understood that the vehicle communication system 26 can be integrated with the controller 14 (e.g., integrated on the same circuit board as the controller 14, or otherwise integrated as a part of the controller 14) without departing from the scope of the present disclosure. As described above, the communication system 26 is in electrical communication with the controller 14.
[0047] The plurality of additional vehicle sensors 28 are used to determine performance data about the vehicle 12. In an exemplary embodiment, the plurality of additional vehicle sensors 28 include at least one of a motor speed sensor, a motor torque sensor, an electric drive motor voltage and / or current sensor, an accelerator pedal position sensor, a brake pedal position sensor, a steering angle sensor, a seat occupancy sensor, a coolant temperature sensor, a cooling fan speed sensor, and a transmission oil temperature sensor. In another exemplary embodiment, the plurality of vehicle sensors also include sensors for determining information about the environment surrounding the vehicle 12, such as an ambient air temperature sensor and / or an atmospheric pressure sensor. As described above, the plurality of additional vehicle sensors 28 are in electrical communication with the controller 14.
[0048] refer to Figure 2A , a first schematic diagram of an intersection 30 is shown. The intersection 30 includes an entry stop line 32, an exit stop line 34, and a traffic signal 36. Within the scope of the present disclosure, the entry stop line 32 defines: a position in the path of the vehicle 12 where the vehicle 12 intends to stop before entering the intersection 30. In some examples, the entry stop line 32 can be represented by a line drawn on the road surface of the intersection 30. Within the scope of the present disclosure, the exit stop line 34 defines: a position in the path of the vehicle 12 that defines the exit of the intersection 30. In other words, if the vehicle 12 has crossed the exit stop line 34, the vehicle 12 is considered to have left the intersection 30 and is not obstructing the flow of traffic in the intersection 30. In some examples, such as Figure 2A As shown, the exit stop line 34 is parallel to the entry stop line 32 and is located on the opposite side of the intersection 30 from the entry stop line 32 .
[0049] The first schematic diagram of the intersection 30 also includes the vehicle 12 and the first distant vehicle 38a. In the exemplary embodiment, as depicted in the first schematic diagram of the intersection 30, the first distant vehicle 38a is the vehicle directly in front of the vehicle 12. A first distance 40 is defined between the position of the vehicle 12 and the first distant vehicle 38a. A second distance 42 is defined between the vehicle 12 and the exit stop line 34. A third distance 44 is defined between the vehicle 12 and the entrance stop line 32. As will be discussed in more detail below, the first schematic diagram shows a situation where the first distance 40 is not greater than the third distance 44.
[0050] refer to Figure 2B , shows a second schematic diagram of the intersection 30. As will be discussed in more detail below, the second schematic diagram shows a situation where the first distance 40 is greater than the second distance 42.
[0051] refer to Figure 2C, shows a third schematic diagram of the intersection 30. As will be discussed in more detail below, the third schematic diagram shows a situation where the first distance 40 is greater than the third distance 44, and is not greater than the second distance 42.
[0052] Figure 3 A flow chart of a method 100 for determining an optimal behavior of a vehicle is shown. Figure 3 And continue to refer to Figure 2A , the method 100 starts at box 102 and proceeds to boxes 104, 106 and 108. At box 104, the controller 14 determines the entry stop line position and the exit stop line position. The entry stop line position is the position of the entry stop line 32. The exit stop line position is the position of the exit stop line 34. In the first exemplary embodiment, in order to determine the entry stop line position and the exit stop line position, the controller 14 receives a map data message by using the vehicle communication system 26. In a non-limiting example, the map data message contains: such as, for example, intersection geometry (e.g., the number and layout of lanes, and the positions of the entry stop line 32 and the exit stop line 34, etc.), lane information (e.g., width, direction, and allowed maneuvers, etc.), minimum speed limit and maximum speed limit, etc.
[0053] Map data messages are V2I messages that may be sent by traffic control infrastructure. For example, traffic control infrastructure that sends map data messages may include: a traffic management center (i.e., a centralized facility that monitors and manages traffic flow), a roadside unit (i.e., a device installed near the intersection 30 that is configured to send map data messages about the intersection 30), and / or a traffic signal controller (i.e., a device installed near the intersection 30 that is primarily configured to control the timing and sequencing of traffic signals 36 and may also be configured to send map data messages about the intersection 30).
[0054] In a second exemplary embodiment, to determine the entry stop bar location and the exit stop bar location, the controller 14 may use the vehicle perception sensor 22 to perform a plurality of measurements of the intersection 30. In a third exemplary embodiment, the controller 14 may use the GNSS 24 to retrieve information about the intersection 30, including, for example, the entry stop bar location and the exit stop bar location. After block 104, as will be discussed in more detail below, the method 100 proceeds to block 110.
[0055] At box 106, the controller 14 determines the current signal phase of the traffic signal 36. Within the scope of the present disclosure, the current signal phase defines: the color of the traffic signal 36 (i.e., red, green, or yellow) and the remaining time before the color of the traffic signal 36 will change. In a first exemplary embodiment, to determine the current signal phase of the traffic signal 36, the controller 14 receives a signal phase and time (SPaT) message using the vehicle communication system 26. In a non-limiting example, the SPaT message contains information about the traffic signal 36, such as, for example, the current signal phase, the remaining time to the next phase (i.e., the remaining time until the next signal phase changes), the future signal phase timing (i.e., the timing and duration of the upcoming signal phase), and / or the pedestrian crossing signal phase, etc.
[0056] The SPaT message is a V2I message that can be sent by a traffic control infrastructure. For example, the traffic control infrastructure that sends the SPaT message can include: a traffic management center (i.e., a centralized facility that monitors and manages traffic flow), a roadside unit (i.e., a device installed near the intersection 30 that is configured to send SPaT messages about the traffic signal 36), and / or a traffic signal controller (i.e., a device installed near the intersection 30 that is primarily configured to control the timing and sequencing of the traffic signal 36, and which can also be configured to send SPaT messages about traffic). In a second exemplary embodiment, in order to determine the current signal phase of the traffic signal 36, the controller 14 can use the vehicle perception sensor 22 to perform multiple measurements of the traffic signal 36. After box 106, as will be discussed in more detail below, the method 100 proceeds to box 110.
[0057] At box 108, the controller 14 determines the location of the first remote vehicle 38a. In the first exemplary embodiment, to determine the location of the first remote vehicle 38a, the controller 14 uses the vehicle communication system 26 to receive a basic safety message (BSM) from the first remote vehicle 38a. In a non-limiting example, the BSM contains information about the first remote vehicle 38a, such as, for example, the location of the first remote vehicle 38a, the speed of the first remote vehicle 38a, and / or the direction of the first remote vehicle 38a. The BSM is a V2V message sent by the communication system of the first remote vehicle 38a. It should be understood that the vehicle communication system 26 can receive multiple BSMs sent by multiple vehicles. The controller 14 can identify the first remote vehicle 38a based on the location of the first remote vehicle 38a relative to the location of the vehicle 12 contained in the BSM.
[0058] In a second exemplary embodiment, the controller 14 receives an intersection queue message using the vehicle communication system 26. Within the scope of the present disclosure, the intersection queue message includes information about traffic conditions at the intersection 30, including the location of the first remote vehicle 38a and the locations of other vehicles near the intersection 30. In an exemplary embodiment, the traffic control infrastructure (e.g., a traffic management center, a roadside unit, and / or a traffic signal controller) at the intersection 30 performs a plurality of measurements of vehicles near the intersection 30 and sends the intersection queue message to the vehicle communication system 26 of the vehicle 12.
[0059] In the third exemplary embodiment, to determine the position of the first remote vehicle 38a, the controller 14 uses the vehicle perception sensor 22 to perform a plurality of measurements of the first remote vehicle 38a. In a non-limiting example, the controller 14 uses the vehicle perception sensor 22 to detect the first remote vehicle 38a (i.e., recognize the presence of an object in the path of the vehicle 12 and determine that the object is the first remote vehicle 38a) by using the vehicle perception sensor 22. The controller 14 then uses the vehicle perception sensor 22 to perform a plurality of measurements of the first remote vehicle 38a. The controller 14 then determines the position of the first remote vehicle 38a based on the plurality of measurements. After box 108, the method 100 proceeds to box 110.
[0060] At box 110, if the current signal phase of the traffic signal 36 determined at box 106 is red, the method 100 proceeds to box 112. At box 112, the controller 14 performs a first action, as will be discussed in more detail below. If the current signal phase of the traffic signal 36 determined at box 106 is not red, the method 100 proceeds to box 114.
[0061] At box 114, if the current signal phase of the traffic signal 36 determined at box 106 is green, the method 100 proceeds to box 116. At box 116, the controller 14 performs a second action, as will be discussed in more detail below. If the current signal phase of the traffic signal 36 determined at box 106 is not green (i.e., the current signal phase of the traffic signal 36 determined at box 106 is yellow), the method 100 proceeds to box 118. At box 118, the controller 14 performs a third action, as will be discussed in more detail below.
[0062] refer to Figure 4, a flow chart of an exemplary embodiment of box 112 (i.e., the first action) is shown. When the current signal phase of the traffic signal 36 is red, the exemplary embodiment of box 112 is performed. The exemplary embodiment of box 112 begins at box 402. At box 402, as will be discussed in more detail below, the controller 14 determines the stopping position of the vehicle 12. After box 402, the exemplary embodiment of box 112 proceeds to box 404. At box 404, the controller 14 calculates the optimal speed. Within the scope of the present disclosure, the optimal speed is the speed of the vehicle 12 that will cause the vehicle 12 to reach the stopping position when the traffic signal 36 turns green. In an exemplary embodiment, to calculate the optimal speed, the controller 14 determines the distance between the position of the vehicle 12 and the stopping position determined at box 402. The controller 14 also determines the time remaining before the traffic signal 36 will turn green based on the current signal phase determined at box 106. In a non-limiting example, the optimal speed is equal to the distance between the location of the vehicle 12 and the stop location divided by the time remaining before the traffic signal 36 will turn green. After block 404 , the exemplary embodiment of block 112 proceeds to block 406 .
[0063] At block 406, the controller 14 compares the optimal speed determined at block 404 to a minimum speed limit and a maximum speed limit (e.g., as determined from the map data message at block 104). Following block 406, the exemplary embodiment of block 112 proceeds to block 408. At block 408, if the optimal speed is less than the minimum speed limit, the exemplary embodiment of block 112 proceeds to block 410. If the optimal speed is not less than the minimum speed limit, the exemplary embodiment of block 112 proceeds to block 412.
[0064] At box 410, the controller 14 determines that the best behavior or operation for the vehicle 12 is to stop at the stop location determined at box 402. Within the scope of the present disclosure, the best behavior is the behavior that is most likely to improve the efficiency, comfort, and / or convenience of the vehicle 12, such as by reducing the waiting time at the traffic signal 36. In an exemplary embodiment, the best behavior can be communicated to the occupants of the vehicle 12, such as using a human-machine interface (e.g., an infotainment system and / or a head-up display, etc.). In another exemplary embodiment, where the vehicle 12 is partially or fully autonomously controlled, the best behavior can be used, at least in part, to determine the action taken by the vehicle 12.
[0065] At box 412, if the optimal speed is greater than the maximum speed limit, the exemplary embodiment of box 112 proceeds to box 414. If the optimal speed is not greater than the maximum speed limit, the exemplary embodiment of box 112 proceeds to box 416. At box 414, the controller 14 determines that the optimal behavior of the vehicle 12 is to travel at the maximum speed limit. Therefore, the optimal behavior of the vehicle 12 does not include exceeding the maximum speed limit. At box 416, the controller 14 determines that the optimal behavior of the vehicle 12 is to travel at the optimal speed determined at box 404.
[0066] refer to Figure 5 , a flow chart of an exemplary embodiment of block 116 (ie, the second action) is shown. When the current signal phase of the traffic signal 36 is green, the exemplary embodiment of block 116 is performed. Figure 5 And continue to refer to Figure 2A , the exemplary embodiment of block 116 begins at block 502. At block 502, the controller 14 determines a first distance 40 between the vehicle 12 and the position of the first remote vehicle 38a based on the position of the first remote vehicle 38a determined at block 108. In the exemplary embodiment, the position of the first remote vehicle 38a determined at block 108 is compared to the position of the vehicle 12 determined using the GNSS 24 to determine the first distance 40. After block 502, the exemplary embodiment of block 116 proceeds to block 504.
[0067] At block 504, the controller 14 determines a second distance 42 between the vehicle 12 and the exit stop line 34. In an exemplary embodiment, the second distance 42 is determined based on the location of the vehicle 12 (e.g., determined using the GNSS 24) and the exit stop line location determined at block 104. After block 504, the exemplary embodiment of block 116 proceeds to block 506.
[0068] At block 506, if the first distance 40 is greater than the second distance 42, the exemplary embodiment of block 116 proceeds to block 508. If the first distance 40 is not greater than the second distance 42, the exemplary embodiment of block 116 proceeds to block 510.
[0069] At box 508 , the controller 14 determines that the best behavior for the vehicle 12 is to travel at the current vehicle speed. In other words, the best behavior for the vehicle 12 is not to change the speed of the vehicle 12 .
[0070] refer to Figure 2B, the second schematic diagram illustrates the situation described above, where the first distance 40 is greater than the second distance 42. As discussed above with reference to block 508, the best behavior for vehicle 12 is to travel at the current vehicle speed because the first distant vehicle 38a has passed the exit stop line 34, and therefore vehicle 12 can safely pass through intersection 30 without blocking the intersection.
[0071] Reference again Figure 5 As will be discussed in more detail below, at block 510 , the controller 14 determines that the best action for the vehicle 12 is to reduce the current vehicle speed.
[0072] refer to Figure 2C , the third schematic diagram shows the situation described above, wherein the first distance 40 is greater than the third distance 44, and not greater than the second distance 42. As discussed above with reference to block 510, the best behavior for vehicle 12 is to reduce the current vehicle speed because the first distant vehicle 38a has not yet passed the exit stop line 34, and therefore, to increase the chance that the first distant vehicle 38a has passed the exit stop line 34 before vehicle 12 reaches intersection 30, the speed of vehicle 12 is to be reduced. In other words, to provide more time for the first distant vehicle 38a to pass the exit stop line 34, the current vehicle speed is to be reduced.
[0073] refer to Figure 6 , a flow chart of an exemplary embodiment of box 118 (i.e., the third action) is shown. The exemplary embodiment of box 118 is performed when the current signal phase of the traffic signal 36 is yellow. The exemplary embodiment of box 118 begins at box 402. At box 402, as will be discussed in more detail below, the controller 14 determines the stopping position of the vehicle 12. After box 402, the exemplary embodiment of box 118 proceeds to box 604. At box 604, the controller 14 determines that the best behavior for the vehicle 12 is to stop at the stopping position determined at box 402.
[0074] refer to Figure 7 , a flow chart of an exemplary embodiment of block 402 (i.e., determining a stop position) is shown. The exemplary embodiment of block 402 begins at blocks 702 and 704. At block 702, the controller 14 determines a third distance 44 between the vehicle 12 and the entry stop line 32. In an exemplary embodiment, the third distance 44 is determined based on the position of the vehicle 12 (e.g., determined by using GNSS 24) and the entry stop line position determined at block 104. After block 702, the exemplary embodiment of block 402 proceeds to block 706.
[0075] At box 704, the controller 14 determines the speed of the first remote vehicle 38a. In an exemplary embodiment, as discussed above, the speed of the first remote vehicle 38a is included in the BSM received by using the vehicle communication system 26. In another exemplary embodiment, the controller 14 uses the vehicle perception sensor 22 to perform multiple measurements of the first remote vehicle 38a to determine the speed of the first remote vehicle 38a. In some embodiments, the controller 14 also determines the acceleration of the first remote vehicle 38. In an exemplary embodiment, as discussed above, the acceleration of the first remote vehicle 38a is included in the BSM received by using the vehicle communication system 26. In another exemplary embodiment, the controller 14 uses the vehicle perception sensor 22 to perform multiple measurements of the first remote vehicle 38a to determine the acceleration of the first remote vehicle 38a. After box 704, the exemplary embodiment of box 402 proceeds to box 706.
[0076] At box 706, in the first exemplary embodiment, if the speed of the first remote vehicle 38a determined at box 704 is greater than a predetermined minimum speed and the first distance 40 is less than or equal to the third distance 44, the exemplary embodiment of box 402 proceeds to box 708. In the second exemplary embodiment, if the fifth distance 48 (i.e., the distance between the vehicle 12 and the potential stopping position 50 of the first remote vehicle 38a) is less than or equal to the third distance 44, the exemplary embodiment of box 402 proceeds to box 708. Within the scope of the present disclosure, the potential stopping position 50 of the first remote vehicle 38a is determined based on the speed of the first remote vehicle 38 (as determined at box 704) and the acceleration of the first remote vehicle 38. If the speed of the first remote vehicle 38a determined at box 704 is not greater than the predetermined minimum speed, or the first distance 40 is not less than or equal to the third distance 44, the exemplary embodiment of box 402 proceeds to box 710. In the scope of the present disclosure, the predetermined minimum speed is such a speed, that is, below which the first remote vehicle 38a is determined to be completely stationary. Therefore, the predetermined minimum speed can be, for example, 1 mile per hour.
[0077] refer to Figure 8, a fourth schematic diagram of the intersection 30 is shown. The fourth schematic diagram shows a scenario in which the first distant vehicle 38a is in motion (i.e., the speed of the first distant vehicle 38a is greater than the predetermined minimum speed as determined at box 706), and therefore the position of the first distant vehicle 38a is changing and cannot be directly used to determine the stopping position of the vehicle 12. The fourth schematic diagram also includes a second distant vehicle 38b, and a fourth distance 46 between the vehicle 12 and the second distant vehicle 38b is defined. The second distant vehicle 38b is located between the first distant vehicle 38a and the entry stop line 32. In other words, the fourth distance 46 is greater than the first distance 40 and less than the third distance 44. In addition, the second distant vehicle 38b is at a complete standstill. In other words, the speed of the second distant vehicle 38b is not greater than the predetermined minimum speed.
[0078] Reference again Figure 7 At box 708, the controller 14 determines the position of the second remote vehicle 38b. In an exemplary embodiment, the position of the second remote vehicle 38b is determined in a manner similar to the position of the first remote vehicle 38a, as discussed above. After box 708, the exemplary embodiment of box 402 proceeds to box 712.
[0079] At box 712, the controller 14 determines that the stopping position of the first remote vehicle 38a is located behind the position of the second remote vehicle 38b determined at box 708. Within the scope of the present disclosure, "behind the position" means a predetermined buffer distance (e.g., 1 meter) behind the position. In some embodiments, the stopping position of the first remote vehicle 38a is determined based at least in part on the speed of the first remote vehicle 38a and the acceleration of the first remote vehicle 38a (as determined at box 704). After box 712, the exemplary embodiment of box 402 proceeds to box 714.
[0080] At block 714 , the controller 14 determines that the stopping position of the vehicle 12 is located behind the stopping position of the first remote vehicle 38 a determined at block 712 .
[0081] At box 710, if the first distance 40 is greater than the third distance 44, the exemplary embodiment of box 402 proceeds to box 716. If the first distance 40 is not greater than the third distance 44, the exemplary embodiment of box 402 proceeds to box 718. At box 716, the controller 14 determines that the stopping position of the vehicle 12 is the entry stop line position. At box 718, the controller 14 determines that the stopping position of the vehicle 12 is located behind the position of the first distant vehicle 38a (as determined at box 108).
[0082] refer to Fig. 9, a flow chart of an exemplary embodiment of box 510 (i.e., reducing the current vehicle speed) is shown. The exemplary embodiment of box 510 begins at box 902. At box 902, the controller 14 reduces the current vehicle speed (i.e., the current speed of the vehicle 12) by a predetermined amount (e.g., ten percent of the current vehicle speed). After box 902, the exemplary embodiment of box 510 proceeds to box 904.
[0083] At block 904, the controller 14 compares the current vehicle speed (after reducing the current vehicle speed at block 902) to the minimum speed limit. If the current vehicle speed is less than or equal to the minimum speed limit, the exemplary embodiment of block 510 proceeds to block 402. If the current vehicle speed is not less than or equal to the minimum speed limit, the exemplary embodiment of block 510 ends.
[0084] At block 402, as discussed in more detail above, the controller 14 determines the stopping location of the vehicle 12. After block 402, the exemplary embodiment of block 510 proceeds to block 908. At block 908, the controller 14 determines that the best behavior for the vehicle 12 is to stop at the stopping location determined at block 402. After block 908, the exemplary embodiment of block 510 ends.
[0085] In an exemplary embodiment, the controller 14 repeatedly executes the method 100. In a non-limiting example, the controller 14 repeats the method 100 on a timer (e.g., every three hundred milliseconds). By repeatedly executing the method 100, the optimal behavior of the vehicle 12 is updated based on changes to the position and speed of the first remote vehicle 38a and the second remote vehicle 38b, changes to the signal phase of the traffic signal 36, and / or other environmental factors.
[0086] The system 10 and method 100 of the present disclosure provide several advantages. By taking into account the positions of the first remote vehicle 38a and the second remote vehicle 38b, the optimal behavior of the vehicle 12 can be accurately determined. This is because the remote vehicles at the intersection 30 may change the stopping position of the vehicle 12. Therefore, using the system 10 and method 100 of the present disclosure, the optimal speed and behavior of the vehicle 12 can be determined even in a high-density traffic environment with multiple remote vehicles. In addition, other features, such as red light violation warnings (RLVW), can be optimized. For example, by using the system 10 and method 100 of the present disclosure, when the RLVW notification is less relevant due to the traffic conditions at the intersection 30, the RLVW notification can be disabled and / or suppressed.
[0087] The description of the present disclosure is merely exemplary in nature, and variations that do not depart from the gist of the present disclosure are intended to fall within the scope of the present disclosure. These variations should not be regarded as departing from the spirit and scope of the present disclosure.
Claims
1. A system for determining an optimal behavior of a vehicle, the system comprising: at least one vehicle sensor; a controller in electrical communication with the at least one vehicle sensor, wherein the controller is programmed to: determining an entry stop line location and an exit stop line location of an intersection in a path of the vehicle by using the at least one vehicle sensor, wherein the intersection is controlled by a traffic signal; determining a current signal phase of the traffic signal by using the at least one vehicle sensor; determining a position of a first remote vehicle by using the at least one vehicle sensor; and An optimal behavior for the vehicle is determined based at least in part on the entry stop line position, the exit stop line position, the current signal phase, and the position of the first remote vehicle.
2. The system according to claim 1, wherein: The at least one vehicle sensor further comprises: a vehicle communication system, and wherein, to determine the entry stop line position and the exit stop line position, the controller is further programmed to: A map data message is received using the vehicle communication system, wherein the map data message includes the entry stop bar location and the exit stop bar location.
3. The system according to claim 1, wherein: The at least one vehicle sensor further comprises a vehicle communication system, and wherein, to determine a current signal phase of the traffic signal, the controller is further programmed to: A signal phase and time (SPaT) message is received using the vehicle communication system, wherein the SPaT message includes: a current signal phase of the traffic signal.
4. The system according to claim 1, wherein: The at least one vehicle sensor further comprises a vehicle communication system, and wherein, to determine the position of the first remote vehicle, the controller is further programmed to: A basic safety message (BSM) is received from the first remote vehicle using the vehicle communication system, wherein the BSM includes a location of the first remote vehicle.
5. The system according to claim 1, wherein: The at least one vehicle sensor further comprises a vehicle communication system, and wherein, to determine the position of the first remote vehicle, the controller is further programmed to: An intersection queue message is received by using the vehicle communication system, wherein the intersection queue message includes: a position of the first remote vehicle.
6. The system according to claim 1, wherein: The at least one vehicle sensor further comprises a vehicle perception sensor, and wherein, to determine the position of the first remote vehicle, the controller is further programmed to: detecting the first distant vehicle by using the vehicle perception sensor; performing a plurality of measurements of the first remote vehicle using the vehicle perception sensor; and A position of the first remote vehicle is determined based at least in part on the plurality of measurements of the first remote vehicle.
7. The system according to claim 1, wherein: In order to determine the optimal behavior of the vehicle, the controller is also programmed to: In response to determining that the current signal phase is red, performing a first action; In response to determining that the current signal phase is green, performing a second action; and In response to determining that the current signal phase is yellow, performing a third action, wherein, in order to perform the third action, the controller is further programmed to: Determine the stopping position; and It is determined that the best behavior is to stop at the stop position.
8. The system of claim 7, wherein to perform the first action, the controller is further programmed to: Determine the stopping position; calculating an optimal speed based at least in part on the position of the vehicle and the stopping position; comparing the optimal speed to a minimum speed limit; In response to determining that the optimal speed is less than the minimum speed limit, determining that the optimal action is to stop at a stop position; and In response to determining that the optimal speed is greater than or equal to the minimum speed limit, it is determined that the optimal action is to travel at the optimal speed.
9. The system according to claim 7, wherein: To perform the second action, the controller is further programmed to: determining a first distance between the vehicle and the position of the first remote vehicle; determining a second distance between the vehicle and the exit stop line location; In response to determining that the first distance is greater than the second distance, determining that the best action is to travel at a current vehicle speed; as well as In response to determining that the first distance is less than the second distance, it is determined that the optimal action is to reduce the current vehicle speed.
10. The system according to claim 9, wherein: To determine the stop position, the controller is also programmed to: determining a third distance between the vehicle and the entry stop line location; In response to determining that the first distance is greater than the third distance, determining that the stop position is the entry stop line position; as well as In response to determining that the first distance is less than or equal to the third distance, the stop position is determined to be located behind the first distant vehicle.
