Methods and systems for monitoring vehicle motion with driver safety alerts

Patent metadata

Field	Value
Publication number	US-11679780-B2
Application number	US-202217976582-A
Country	US
Kind code	B2
Filing date	Oct 28, 2022
Priority date	Jan 8, 2021
Publication date	Jun 20, 2023
Grant date	Jun 20, 2023

Abstract

Methods, systems, and computer program products for navigating a vehicle are disclosed. The methods include extracting lane segment data associated with lane segments of a vector map that are within a region of interest, and analyzing the lane segment data and a heading of the vehicle to determine whether motion of the vehicle satisfies a condition. The condition can be associated with (i) an association between the heading of the vehicle and a direction of travel of a lane that corresponds to the current location of the vehicle and/or (ii) a minimum stopping distance to an imminent traffic control measure in the lane that corresponds to the current location of the vehicle. When the motion does not satisfy the condition, the methods include causing the vehicle to perform a motion correction.

First claim

The invention claimed is:

1. A method of navigating a vehicle, the method comprising, by a processor:
extracting lane segment data associated with lane segments of a vector map that are within a region of interest;
analyzing the lane segment data and a heading of the vehicle to determine whether motion of the vehicle satisfies a condition associated with one or more of the following:
an association between the heading of the vehicle and a direction of travel of a lane that corresponds to a current location of the vehicle, or
a minimum stopping distance to an imminent traffic control measure in the lane that corresponds to the current location of the vehicle; and

when the motion does not satisfy the condition, causing the vehicle to perform a motion correction.

2. The method of claim 1 , further comprising controlling a driver warning system of the vehicle to generate and output a driver alert of non-valid motion.

3. The method of claim 1 , wherein causing the vehicle to perform the motion correction comprises generating a control signal to control at least one of the following: a steering controller, a speed controller, or a brake controller of the vehicle.

4. The method of claim 3 , wherein the motion correction comprises at least one of the following with respect to the motion of the vehicle: decelerating, stopping, or veering to a lane that is different from the lane that corresponds to the current location of the vehicle.

5. The method of claim 1 , wherein:
the lane segment data includes a lane heading for each lane segment in the region of interest, wherein the lane heading corresponds to the direction of travel of the lane that corresponds to the current location of the vehicle;
the condition is associated with the direction of travel of the lane that corresponds to the current location of the vehicle; and
determining whether the motion of the vehicle satisfies the condition comprises:
(a) determining whether any of the lane segments within the region of interest has a lane heading that is within an opposing-heading tolerance range and that is opposing the heading of the vehicle,
(b) determining whether any of the lane segments within the region of interest has a lane heading that is within a similar-heading tolerance range and that is similar to the heading of the vehicle, and
(c) determining that the motion does not satisfy the condition, and that the heading of the vehicle is in a wrong-way direction, when both:
(i) at least one of the lane segments is determined at (a) to have the lane heading opposing the heading of the vehicle, and
(ii) none of the lane segments in the region of interest is determined at (b) have the lane heading that is similar to the heading of the vehicle,

otherwise determining that the motion of the vehicle satisfies the condition.

6. The method of claim 5 , further comprising in response to determining that the motion does not satisfy the condition, causing the vehicle to perform the motion correction that comprises preventing the vehicle from performing a veering motion.

7. The method of claim 5 , wherein determining whether any of the lane segments within the region of interest has the lane heading that is within the similar-heading tolerance range and that is similar to the heading of the vehicle further comprises determining whether any of the lane segments are within a tolerance distance from the lane that corresponds to the current location of the vehicle.

8. The method of claim 1 , wherein:
the lane segment data includes a heading and length for each lane segment;
the condition is associated with the minimum stopping distance to the imminent traffic control measure in the lane that corresponds to the current location of the vehicle; and
determining whether the motion of the vehicle satisfies the condition comprises:
determining a speed of travel of the vehicle,
determining a minimum stopping distance representing a distance from the current location of the vehicle and a location within a stop zone that is within the lane of travel before the location of the imminent traffic control measure, and
using the speed and the current location to determine whether the vehicle can stop within the minimum stopping distance by:
computing a rate of deceleration required to stop the vehicle at the location within the stop zone,
determining if the computed rate of deceleration meets a deceleration threshold, and

if the computed rate of deceleration is more than the deceleration threshold, determining that the motion does not satisfy the condition, otherwise determining that the motion satisfies the condition.

9. The method of claim 8 , further comprising in response to determining that the motion does not satisfy the condition, causing the vehicle to perform the motion correction that comprises changing a speed of the vehicle.

10. The method of claim 8 , wherein the determining whether the motion of the vehicle satisfied the condition, further comprises:
prior to determining the minimum stopping distance,
calculating a stopping zone polygon for the imminent traffic control measure; and
calculating an end threshold polyline for the imminent traffic control measure that is at an end of the stopping zone polygon,

wherein the location within the stop zone corresponds to the end threshold polyline, and the minimum stopping distance is determined through the stopping zone polygon and up to the end threshold polyline.

11. The method of claim 1 , wherein determining whether the motion of the vehicle satisfies the condition further comprises:
detecting a plurality of candidate traffic control measures ahead of the vehicle in a direction corresponding to the heading of the vehicle;
detecting that a traffic signal activation command has been initiated in the vehicle before the vehicle reaches a first one of the candidate traffic control measures;
ranking the candidate traffic control measures based on distances from the vehicle to each of the candidate control measures or remaining lane segments in the region of interest between the vehicle and the candidate traffic control measures; and
selecting the imminent traffic control measure based on one or both of the distance and the vehicle turning signal state.

12. A system for navigating a vehicle, the system comprising
a vehicle having one or more sensors and an onboard computing system that comprises a processor, and a memory portion containing programming instructions that, when executed, will cause the processor to:
extract lane segment data associated with lane segments of a vector map that are within a region of interest,
analyze the lane segment data and a heading of the vehicle to determine whether motion of the vehicle satisfies a condition associated with one or more of the following:
an association between the heading of the vehicle and a direction of travel of a lane that corresponds to a current location of the vehicle, or
a minimum stopping distance to an imminent traffic control measure in the lane that corresponds to the current location of the vehicle, and

when the motion does not satisfy the condition, cause the vehicle to perform a motion correction.

13. The system of claim 12 , further comprising programming instructions to control a driver warning system of the vehicle to generate and output a driver alert of non-valid motion.

14. The system of claim 12 , wherein the programming instructions, when executed, will cause the processor to cause the vehicle to perform the motion correction comprise instructions to generate a control signal to control at least one of the following: a steering controller,

Assignees

• Argo Ai Llc

Inventors

• Mcalister Colen
• Breeden David
• Petroff Thomas
• Cunningham Christopher
• Barone Patrick
• Sredzki Arek
• Seegmiller Neal
• Cai Xi

Classifications

• G08G1/097

  Supervising of traffic control systems, e.g. by giving an alarm if two crossing streets have green light simultaneously · CPC title

• G08G1/0145

  for active traffic flow control · CPC title

• G06V20/588 Primary

  Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road · CPC title

• B60W50/14 Primary

  Means for informing the driver, warning the driver or prompting a driver intervention · CPC title

• B60W2050/143

  Alarm means · CPC title