# US 2023/0054145 A1 · Methods and systems for monitoring vehicle motion with driver safety alerts

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2023/0054145 A1
- Document ID: US20230054145A1
- Status: Published application
- Kind: A1
- Application number: 17/976,582
- Filed: 2022-10-28
- Published: 2023-02-23
- Earliest claimed: 2021-01-08
- Assignees: Argo AI, LLC
- Applicants: Argo AI, LLC
- Inventors: Colen McAlister; David Breeden; Thomas Petroff; Christopher Cunningham; Patrick Barone; Arek Sredzki; Neal Seegmiller; Xi Cai
- Web page: https://patentgrep.com/patent/US20230054145A1

## CPC

- B60W 50/14: Means for informing the driver, warning the driver or prompting a driver intervention
- G06V 10/25: Determination of region of interest [ROI] or a volume of interest [VOI]
- G06V 20/588: {Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road}
- G08G 1/0145: {for active traffic flow control}
- G08G 1/097: Supervising of traffic control systems, e.g. by giving an alarm if two crossing streets have green light simultaneously
- G08G 1/167: {Driving aids for lane monitoring, lane changing, e.g. blind spot detection}
- B60W 2050/143: {Alarm means}
- B60W 2520/06: Direction of travel
- B60W 2556/50: of positioning data, e.g. GPS [Global Positioning System] data
- B60W: CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- G06V: IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G08G: TRAFFIC CONTROL SYSTEMS (guiding railway traffic, ensuring the safety of railway traffic B61L; arrangement of road signs or traffic signals E01F9/00; radar or analogous systems, sonar systems, lidar systems specially adapted for traffic control G01S13/91, G01S15/88, G01S17/88; {radar or analogous systems, sonar systems, lidar systems specially adapted for anti-collision purposes G01S13/93, G01S15/93, G01S17/93})

## 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.

## Claims

### Claim 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.

### Claim 2 (depends on 1)

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.

### Claim 3 (depends on 1)

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.

### Claim 4 (depends on 3)

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.

### Claim 5 (depends on 1)

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.

### Claim 6 (depends on 5)

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.

### Claim 7 (depends on 5)

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.

### Claim 8 (depends on 1)

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.

### Claim 9 (depends on 8)

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.

### Claim 10 (depends on 8)

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.

### Claim 11 (depends on 1)

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.

### Claim 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.

### Claim 13 (depends on 12)

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.

### Claim 14 (depends on 12)

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, a speed controller, and a brake controller of the vehicle.

### Claim 15 (depends on 14)

The system of claim 14, 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.

### Claim 16 (depends on 12)

The system of claim 12, 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
the instructions to determine whether the motion of the vehicle satisfies the condition comprise instructions to:
(a) determine 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) determine 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) determine 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 determine that the motion of the vehicle satisfies the condition.

### Claim 17 (depends on 12)

The system of claim 12, 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
the instructions to determine whether the motion of the vehicle satisfies the condition comprise instructions to:
determine a speed of travel of the vehicle,
determine 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
use the speed and the current location to determine whether the vehicle can stop within the minimum stopping distance by:
compute 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.

### Claim 18 (depends on 17)

The system of claim 17, further comprising programming instructions that, when executed by the processor, will cause the processor to: in response to determining that the motion does not satisfy the condition, cause the vehicle to perform the motion correction that comprises changing a speed of the vehicle.

### Claim 19 (depends on 12)

The system of claim 12, wherein the instructions to determine whether the motion of the vehicle satisfies the condition further comprise instructions to:
detect a plurality of candidate traffic control measures ahead of the vehicle in a direction corresponding to the heading of the vehicle;
detect 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;
rank 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
select the imminent traffic control measure based on one or both of the distance and the vehicle turning signal state.

### Claim 20

A comprising a memory a memory containing programming instructions that are configured to, when executed, cause a 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 a 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.
