IP Library Granted Patent US 11,397,434
Granted Patent B2
US 11,397,434 · App. 16/539,878 · Granted Jul 26, 2022

Consistency validation for vehicle trajectory selection

Inventors: Sy Kelly Olson (Oakland, CA); Collin MacGregor (Foster City, CA); Jefferson Bradfield Packer (San Francisco, CA); Janek Hudecek (Redwood City, CA)
Assignee: Zoox, Inc.
G05D1/0088B60W30/00B60W40/114G05D1/0212B60W2520/14G05D2201/0213
View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 11,397,434
App. No.
16/539,878
Granted
Jul 26, 2022
Kind
B2
Abstract

The present disclosure is directed to performing one or more validity checks on potential trajectories for a device, such as an autonomous vehicle, to navigate. In some examples, a potential trajectory may be validated based on whether it is consistent with a current trajectory the vehicle is navigating such that the potential and current trajectories are not too different, whether the vehicle can feasibly or kinematically navigate to the potential trajectory from a current state, whether the potential trajectory was punctual or received within a time period of a prior trajectory, and/or whether the potential trajectory passes a staleness check, such that it was created within a certain time period. In some examples, determining whether a potential trajectory is feasibly may include updating a set of feasibility limits based on one or more operational characteristics of statuses of subsystems of the vehicle.

Claims (52)

1. A collision avoid system comprising:

one or more processors; and

memory that stores instructions which, when executed by the one or more processors, cause the system to:

receive a first set of values indicating a current state of an autonomous vehicle, the first set of values comprising one or more of a first position, a first orientation, a first yaw rate, or a first velocity;

receive a potential trajectory for the autonomous vehicle;

determine a second set of values indicating a potential state of the autonomous vehicle on the potential trajectory, the second set of values comprising one or more of a second position, a second orientation, a second yaw rate, or a second velocity;

determine, as a validity signal, whether the second set of values differs from the first set of values by a set of corresponding threshold amounts, wherein the set of corresponding threshold amounts comprises at least two of a distance threshold, a time threshold, a steering threshold, a yaw threshold, a velocity deviation threshold, or a collinearity threshold; and

cause the autonomous vehicle to operate according to the potential trajectory based at least in part on the validity signal.

2. The system of claim 1 , wherein determining the validity value further comprises:

performing a comparison of the first set of values to the second set of values to determine a set of deviation values; and

determining the validity signal based at least in part on performing a second comparison of the set of deviation values to the set of threshold amounts.

3. The system of claim 1 , wherein determining the second set of values comprises determining the second position based on proximity to the first position.

4. The system of claim 1 , wherein the instructions, when executed by the one or more processors, further cause the system to:

receive a second potential trajectory for the autonomous vehicle;

determine a third set of values indicating a second potential state of the autonomous vehicle to follow the second potential trajectory, the third set of values comprising one or more of a third position, a third orientation, a third yaw rate, or a third velocity;

determine, as a second validity signal, whether the autonomous vehicle is capable of occupying the second potential state based at least in part on the current state;

select one of the potential trajectory or the second potential trajectory to result in a selected trajectory based on the validity signal and the second validity signal; and

cause the autonomous vehicle to operate according to the selected trajectory.

5. A method, comprising:

obtaining a current state of a device on a current trajectory;

obtaining a potential state of the device to follow a potential trajectory;

determining a validity value indicating whether the potential state differs from the current state by at least two threshold amounts to indicate whether the potential trajectory is consistent with the current trajectory, wherein the at least two threshold amounts comprises at least two of a distance difference, a time difference, a steering threshold, a yaw threshold, a velocity deviation threshold, or a collinearity threshold; and

causing the device to operate according to the potential trajectory based at least in part on the validity value.

6. The method of claim 5 , wherein the current state of the device comprises one or more of a first position, a first orientation, a first yaw rate, or a first velocity, and

wherein the potential state of the device comprises one or more of a second position, a second orientation, a second yaw rate, or a second velocity.

7. The method of claim 5 , wherein determining the validity value further comprises:

performing a comparison of the current state and the potential state to determine a set of deviation values; and

determining the validity signal based at least in part on performing a second comparison of the set of deviation values to the at least two threshold amounts.

8. The method of claim 5 , wherein the current state comprises a first position, and

wherein obtaining the potential state of the device further comprises:

determining a second location on the potential trajectory that is the shortest distance away from the first position.

9. The method of claim 5 , wherein determining the validity value further comprises determining whether the potential trajectory is collinear with the current trajectory.

10. The method of claim 5 , wherein the at least two threshold amounts are determined independent of an operating condition of the device.

11. The method of claim 5 , wherein determining the validity value indicating is further based at least in part on a temporal difference between a first time the potential trajectory was created and a current time.

12. The method of claim 5 , further comprising:

obtaining a third set of values indicating a second potential state of the device to follow a second potential trajectory;

determining a second validity value indicating whether the device is capable of occupying the second potential state based at least in part on the current state;

selecting one of the potential trajectory or the second potential trajectory to result in a selected trajectory based on the validity value and the second validity value; and

cause the device to operate according to the selected trajectory.

13. A non-transitory computer-readable storage medium having stored thereon executable instructions that, when executed by one or more processors of a computer system, cause the computer system to at least:

receive a first state of a device navigating first trajectory, the first state comprising at least one of a first position and a first velocity;

receive a potential state of the device to follow a potential trajectory, the potential state comprising at least one of a second position and a second velocity;

determine a validity value indicating whether first state is within at least one threshold value of the second state, wherein the at least one threshold value comprises at least two of a distance difference, a time difference, a steering threshold, a yaw threshold, a velocity difference, or a collinearity threshold; and

cause the device to operate according to the potential trajectory based at least in part on the validity value.

14. The non-transitory computer-readable storage medium of claim 13 , wherein determining the validity value further comprises:

determining a distance between the first position and the second position;

comparing the distance to the distance difference of the at least one threshold value;

determining a velocity difference between the first velocity and the second velocity; and

comparing the velocity difference to the velocity threshold of the at least one threshold value.

15. The non-transitory computer-readable storage medium of claim 13 , wherein the first state of the device further comprises at least one of a first orientation, or a first yaw rate, and

wherein the potential state of the device comprises one or more of a second orientation or a second yaw rate.

16. The non-transitory computer-readable storage medium of claim 13 , wherein determining the validity value is further based at least in part on a temporal difference between a first time the potential trajectory was created and a current time.

Assignments (1)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Jan 24, 2020
From: OLSON, SY KELLY; MACGREGOR, COLLIN; PACKER, JEFFERSON BRADFIELD; HUDECEK, JANEK
To: ZOOX, INC.
Reel/Frame 051696/0609 →
Continuity (1)
Related Publication 20210048817A1 · Feb 18, 2021