Granted Patent B2

US 12,197,222 · App. 17/878,220 · Granted Jan 14, 2025

Inventors: Joshua Rands (Westminster, CO); Riley Kenyon (Westminster, CO); Justin Creaby (Westminster, CO)

Assignee: Trimble Inc.

G05D1/0214A01B69/001A01B69/008

Abstract

Claims (95)

1. A method for avoiding collisions with obstacles by a vehicle, comprising:

recording a footprint for the vehicle;

recording stopping times as a function of speed for the vehicle;

determining a current speed of the vehicle;

determining a projected vehicle curved trajectory;

determining a projected path zone corresponding to the projected vehicle curved trajectory and the vehicle footprint;

determining possible path zones on either side of the projected path zone where the vehicle could potentially go with a change in trajectory;

detecting objects in the projected and possible path zones;

determining locations of the objects relative to the footprint of the vehicle;

slowing down or stopping the vehicle if a projected path object is within a stopping distance plus a projected path buffer distance based on the current speed and a corresponding stopping time with the projected vehicle curved trajectory; and

slowing down the vehicle if a possible path object is within the stopping distance plus a possible path buffer distance based on the current speed and the corresponding stopping time of the vehicle, wherein the possible path buffer distance is smaller than the projected path buffer distance.

2. The method of claim 1 further comprising:

recording a preplanned path for the vehicle;

determining a weighted trajectory for the vehicle based on the preplanned path and a current trajectory; and

adjusting the projected path zone to reflect the weighted trajectory.

3. The method of claim 2 further comprising:

assigning weights to positions of the preplanned path and positions of the current trajectory, wherein for positions closer to the vehicle the current trajectory has a higher weight, and for positions farther from the vehicle the preplanned path positions have a higher weight; and

combining the weighted positions for the preplanned path and the current trajectory to provide a weighted trajectory.

4. The method of claim 1 further comprising:

recording a three-dimensional geometry of the vehicle;

determining a height of, or clearance under, an object;

comparing the height of, or clearance under, the object to the three-dimensional geometry of the vehicle plus a clearance buffer; and

limiting the slowing of the vehicle if the comparing shows that the vehicle will pass over or under the object without a collision.

5. The method of claim 1 wherein detecting objects and determining locations of the objects is performed using at least one sensor from the group of radar, lidar and camera sensors.

6. The method of claim 1 further comprising:

determining an X, Y location of an object;

determining the projected and possible path zones using a radius and angle of a current curved trajectory of the vehicle; and

converting the X, Y location of the object into radius and angle polar coordinates.

7. The method of claim 1 further comprising:

detecting movement of an object;

determining a trajectory of the moving object;

calculating a projected future location of the moving object; and

determining whether the projected future location is within the projected or possible path zone.

8. The method of claim 1 wherein the projected and possible trajectory paths are defined by arcs about a center of a circle corresponding to the arc of the projected vehicle curved trajectory.

9. A non-transitory computer-readable medium having stored thereon instructions that, when executed by one or more processors, cause the one or more processors to perform operations for avoiding collisions with obstacles by a vehicle, including:

recording, in a memory, a footprint for the vehicle;

recording, in the memory, stopping times as a function of speed for the vehicle;

determining, by the one or more processors, a current speed of the vehicle;

determining, by the one or more processors, a projected vehicle curved trajectory;

determining, by the one or more processors, a projected path zone corresponding to the projected vehicle curved trajectory and the vehicle footprint;

determining, by the one or more processors, possible path zones on either side of the projected path zone where the vehicle could potentially go with a change in trajectory;

detecting, by one or more sensors, objects in the projected and possible path zones;

determining, by the one or more processors, locations of the objects relative to the footprint of the vehicle;

providing control signals, by the one or more processors, to slow down or stop the vehicle if a projected path object is within a stopping distance plus a projected path buffer distance based on the current speed and a corresponding stopping time with the projected vehicle curved trajectory; and

providing control signals, by the one or more processors, to slow down the vehicle if a possible path object is within the stopping distance plus a possible path buffer distance based on the current speed and the corresponding stopping time of the vehicle, wherein the possible path buffer distance is smaller than the projected path buffer distance.

10. The non-transitory computer-readable medium of claim 9 further comprising instructions stored thereon that, when executed by one or more processors, cause the one or more processors to perform operations including:

recording a preplanned path for the vehicle;

determining a weighted trajectory for the vehicle based on the preplanned path and a current trajectory; and

adjusting the projected path zone to reflect the weighted trajectory.

11. The non-transitory computer-readable medium of claim 10 further comprising instructions stored thereon that, when executed by one or more processors, cause the one or more processors to perform operations including:

assigning weights to positions of the preplanned path and positions of the current trajectory, wherein for positions closer to the vehicle the current trajectory has a higher weight, and for positions farther from the vehicle the preplanned path positions have a higher weight; and

combining the weighted positions for the preplanned path and the current trajectory to provide a weighted trajectory.

12. The non-transitory computer-readable medium of claim 9 further comprising instructions stored thereon that, when executed by one or more processors, cause the one or more processors to perform operations including:

recording a three-dimensional geometry of the vehicle;

determining a height of, or clearance under, an object;

comparing the height of, or clearance under, the object to the three-dimensional geometry of the vehicle plus a clearance buffer; and

limiting the slowing of the vehicle if the comparing shows that the vehicle will pass over or under the object without a collision.

13. The non-transitory computer-readable medium of claim 9 wherein detecting objects and determining locations of the objects is performed using at least one sensor from the group of radar, lidar and camera sensors.

14. The non-transitory computer-readable medium of claim 9 further comprising instructions stored thereon that, when executed by one or more processors, cause the one or more processors to perform operations including:

determining an X, Y location of an object;

determining the projected and possible path zones using a radius and angle of a current curved trajectory of the vehicle; and

converting the X, Y location of the object into radius and angle polar coordinates.

15. The non-transitory computer-readable medium of claim 9 further comprising instructions stored thereon that, when executed by one or more processors, cause the one or more processors to perform operations including:

detecting movement of an object;

determining a trajectory of the moving object;

calculating a projected future location of the moving object; and

determining whether the projected future location is within the projected or possible path zone.

16. The non-transitory computer-readable medium of claim 9 wherein the projected and possible trajectory paths are defined by arcs about a center of a circle corresponding to the arc of the projected vehicle curved trajectory.

17. A system, comprising:

one or more processors;

a memory;

at least one sensor; and

a non-transitory computer-readable medium having stored thereon instructions that, when executed by the processor, cause the processor to perform operations for avoiding collisions with obstacles by a vehicle including:

recording, in the memory, a footprint for the vehicle;

recording, in the memory, stopping times as a function of speed for the vehicle;

determining, by the one or more processors, a current speed of the vehicle;

determining, by the one or more processors, a projected vehicle curved trajectory;

determining, by the one or more processors, a projected path zone corresponding to the projected vehicle curved trajectory and the vehicle footprint;

determining, by the one or more processors, possible path zones on either side of the projected path zone where the vehicle could potentially go with a change in trajectory;

detecting, by the at least one sensor, objects in the projected and possible path zones;

determining, by the one or more processors, locations of the objects relative to the footprint of the vehicle;

providing control signals, by the one or more processors, to slow down or stop the vehicle if a projected path object is within a stopping distance plus a projected path buffer distance based on the current speed and a corresponding stopping time with the projected vehicle curved trajectory; and

providing control signals, by the one or more processors, to slow down the vehicle if a possible path object is within the stopping distance plus a possible path buffer distance based on the current speed and the corresponding stopping time of the vehicle, wherein the possible path buffer distance is smaller than the projected path buffer distance.

18. The system of claim 17 wherein the non-transitory computer-readable medium further comprises instructions stored thereon that, when executed by the one or more processors, cause the one or more processors to perform operations including:

recording a preplanned path for the vehicle;

determining a weighted trajectory for the vehicle based on the preplanned path and a current trajectory; and

adjusting the projected path zone to reflect the weighted trajectory.

19. The system of claim 18 wherein the non-transitory computer-readable medium further comprises instructions stored thereon that, when executed by the one or more processors, cause the one or more processors to perform operations including:

assigning weights to positions of the preplanned path and positions of the current trajectory, wherein for positions closer to the vehicle the current trajectory has a higher weight, and for positions farther from the vehicle the preplanned path positions have a higher weight; and

combining the weighted positions for the preplanned path and the current trajectory to provide a weighted trajectory.

20. The system of claim 17 wherein the non-transitory computer-readable medium further comprises instructions stored thereon that, when executed by the one or more processors, cause the one or more processors to perform operations including:

recording a three-dimensional geometry of the vehicle;

determining a height of, or clearance under, an object;

comparing the height of, or clearance under, the object to the three-dimensional geometry of the vehicle plus a clearance buffer; and

limiting the slowing of the vehicle if the comparing shows that the vehicle will pass over or under the object without a collision.

Assignments (1)

Continuity (1)

References Cited (22)