Breadth first search-depth first search three dimensional rapid exploring random tree search with physical constraints
An example operation includes one or more of, determining an initial position and at least one vehicle constraint, predetermining a distance to a new position, determining a minimum turn radius based on the at least one vehicle constraint, selecting a vehicle turn radius that is at least as large as the minimum turn radius, determining a candidate position based on the at least one vehicle constraint and the vehicle turn radius, verifying whether the candidate position is valid with respect to the new position and converting the new position to the candidate position.
1. A method of path planning, comprising:
determining an initial position and at least one vehicle constraint;
predetermining a distance to a new position;
determining a minimum turn radius based on the at least one vehicle constraint;
selecting a vehicle turn radius that is at least as large as the minimum turn radius, wherein the vehicle turn radius is selected based on a breadth first search of a known valid turn radius and extended with a depth first search farther away from the known valid turn radius;
determining a candidate position based on the at least one vehicle constraint and the vehicle turn radius;
verifying whether the candidate position is valid with respect to the new position; and
converting the new position to the candidate position.
2. The method of claim 1 , further comprising modifying the at least one vehicle constraint when the new position is not verified as valid.
3. The method of claim 1 , wherein the at least one vehicle constraint is a vehicle speed and wherein the minimum turn radius is based on the vehicle speed.
4. The method of claim 1 , wherein the at least one vehicle constraint comprises at least one of a maximum velocity and an acceleration limit.
5. The method of claim 1 , wherein the selection of the vehicle turn radius is randomly larger than the minimum turn radius.
6. The method of claim 1 , wherein the selection of the vehicle turn radius is weighted towards larger turn radii.
7. The method of claim 1 , further comprising reducing a vehicle acceleration to reduce a vehicle speed when the candidate position is not valid.
8. The method of claim 7 , further comprising determining a new candidate position based on the reduced vehicle speed.
9. The method of claim 8 , further comprising verifying whether the new candidate position is valid with respect to the new position.
10. The method of claim 9 , further comprising converting the new position to the new candidate position.
11. A non-transitory computer readable medium comprising instructions, that when read by a processor, cause the processor to perform:
determining an initial position and at least one vehicle constraint;
predetermining a distance to a new position;
determining a minimum turn radius based on the at least one vehicle constraint;
selecting a vehicle turn radius that is at least as large as the minimum turn radius, wherein the vehicle turn radius is selected based on a breadth first search of a known valid turn radius and extended with a depth first search farther away from the known valid turn radius;
determining a candidate position based on the at least one vehicle constraint and the vehicle turn radius;
verifying whether the candidate position is valid with respect to the new position; and
converting the new position to the candidate position.
12. The non-transitory computer readable medium of claim 11 , further comprising
instructions that cause the processor to reduce the at least one vehicle constraint when the new position is not verified as valid.
13. The non-transitory computer readable medium of claim 11 , wherein the at least one vehicle constraint is a vehicle speed and wherein the minimum turn radius is based on the vehicle speed.
14. The non-transitory computer readable medium of claim 11 , wherein the at least one vehicle constraint comprises at least one of a maximum velocity and an acceleration limit.
15. The non-transitory computer readable medium of claim 11 , wherein the selection of the vehicle turn radius is randomly larger than the minimum turn radius.
16. The non-transitory computer readable medium of claim 11 , wherein the selection of the vehicle turn radius is weighted towards larger turn radii.
17. The non-transitory computer readable medium of claim 11 , further comprising instructions that cause the processor to reduce a vehicle acceleration to reduce a vehicle speed when the candidate position is not valid.
18. The non-transitory computer readable medium of claim 17 , further comprising instructions that cause the processor to determine a new candidate position based on the reduced vehicle speed.
19. The non-transitory computer readable medium of claim 18 , further comprising instructions that cause the processor to verify whether the new candidate position is valid with respect to the new position.
20. The non-transitory computer readable medium of claim 19 , further comprising instructions that cause the processor to convert the new position to the new candidate position.