Motion steering under kino dynamic constraints
Motion steering under kino dynamic constraints is provided. A system can receive an indication to return to a route generated for autonomous navigation by the aircraft to a destination. The system can generate a vector field formed of a plurality of vectors that merge into the route. The vector field can be generated responsive to the indication to return to the route. The system can provide instructions to steer the aircraft toward the destination along the route via one or more vectors of the plurality of vectors in the vector field. The instructions can be based on a cost function applied to the vector field.
1. A system, comprising:
a data processing system of an aircraft, the data processing system comprising one or more processors coupled with memory to:
receive an indication to return to a route generated for autonomous navigation by the aircraft to a destination;
generate, responsive to the indication to return to the route, a vector field formed of a plurality of vectors that merge into the route;
provide, based on a cost function applied to the vector field, instructions to steer the aircraft toward the destination along the route via one or more vectors of the plurality of vectors in the vector field; and
cause the aircraft to navigate in accordance with the instructions.
2. The system of claim 1 , wherein the data processing system is further configured to:
generate the instructions for the one or more vectors based on kino dynamic constraints of the aircraft.
3. The system of claim 1 , wherein each vector of the plurality of vectors comprises a respective direction for each respective point in an environment surrounding the aircraft configured to steer the aircraft towards the destination via the route.
4. The system of claim 1 , wherein the data processing system is further configured to:
generate the vector field for an environment having a radius surrounding the aircraft.
5. The system of claim 1 , wherein the data processing system is further configured to:
generate the instructions to steer the aircraft via the one or more vectors to minimize the cost function.
6. The system of claim 1 , wherein the data processing system is further configured to:
generate the instructions to steer the aircraft via the one or more vectors to reduce the cost function below a threshold.
7. The system of claim 1 , wherein the data processing system is further configured to:
generate the instructions for the one or more vectors with a closed loop rapidly exploring random technique configured with constraints for the aircraft.
8. The system of claim 1 , wherein the data processing system is further configured to:
generate the instructions to steer the aircraft via the one or more vectors that avoid an obstacle in an environment centered around the aircraft.
9. The system of claim 1 , wherein the data processing system is further configured to:
enter a manual mode in which an operator of the aircraft navigates the aircraft via one or more inceptors; and
detect the indication to transition from the manual mode to an autonomous mode in which the aircraft autonomously navigates along the route.
10. The system of claim 9 , wherein the data processing system is further configured to:
detect the indication responsive to release by the operator of the one or more inceptors for a predetermined duration.
11. The system of claim 1 , wherein the data processing system is further configured to:
detect the indication responsive to an input via a user interface of the aircraft.
12. A method, comprising:
receiving, by a data processing system of an aircraft comprising one or more processors coupled with memory, an indication to return to a route generated for autonomous navigation by the aircraft to a destination;
generating, by the data processing system, responsive to the indication to return to the route, a vector field formed of a plurality of vectors that merge into the route;
providing, by the data processing system based on a cost function applied to the vector field, instructions to steer the aircraft toward the destination along the route via one or more vectors of the plurality of vectors in the vector field; and
causing, by the data processing system, the aircraft to navigate in accordance with the instructions.
13. The method of claim 12 , comprising:
generating, by the data processing system, the instructions for the one or more vectors based on kino dynamic constraints of the aircraft.
14. The method of claim 12 , wherein each vector of the plurality of vectors comprises a respective direction for each respective point in an environment surrounding the aircraft configured to steer the aircraft towards the destination via the route.
15. The method of claim 12 , comprising:
generating, by the data processing system, the vector field for an environment having a radius surrounding the aircraft.
16. The method of claim 12 , comprising:
generating, by the data processing system, the instructions to steer the aircraft via the one or more vectors to minimize the cost function.
17. An aircraft, comprising:
a data processing system comprising one or more processors coupled with memory to: receive an indication to return to a route generated for autonomous navigation by the aircraft to a destination;
generate, responsive to the indication to return to the route, a vector field formed of a plurality of vectors that merge into the route;
provide, based on a cost function applied to the vector field, instructions to steer the aircraft toward the destination along the route via one or more vectors of the plurality of vectors in the vector field; and
cause the aircraft to navigate in accordance with the instructions.
18. The aircraft of claim 17 , wherein the data processing system is further configured to:
generate the instructions for the one or more vectors based on kino dynamic constraints of the aircraft.