Autonomous navigation system and method for a maneuverable platform
An autonomous navigation system and method for a maneuverable platform are provided herein. The method may include: obtaining a plurality of objectives relating to a maneuverable platform; determining a plurality of options of direction and speed for the platform; autonomously selecting, one option of the plurality of options, in order to achieve said objectives, by calculating a weighted grade of each option based on the weights of the objectives and said grading scheme; and periodically repeating: the receiving with updated platform and obstacles data and the autonomously selecting with the updated platform and obstacles data, wherein the autonomously selecting is executed by a computer processor and includes, for each obstacle, calculating projected positions of the platform and of that obstacle to determine the distance between the platform and the obstacle at the closest point of approach and estimated time to arrive to the closest point of approach.
1. A method comprising:
obtaining a plurality of objectives relating to a maneuverable platform;
receiving maneuverable platform and obstacles data relating to at least one of: position, speed, and direction of the maneuverable platform and of obstacles;
determining, using a computer processor, a plurality of options for completing said plurality of objectives, wherein each of the plurality of options defines a distinct combination of course and speed;
calculating, for each of the plurality of options, projected positions of the maneuverable platform and of each obstacle and therefrom determining the distance between the maneuverable platform and each obstacle at the closest point of approach and the estimated time to arrive at the closest point of approach;
weighing each of the options in accordance with a grading scheme, wherein said grading scheme includes an assessment of the estimated time to arrive at the closest point of approach with each obstacle; and, the distance between the maneuverable platform and each obstacle at the closest point of approach;
autonomously selecting, using a computer processor, one option of the plurality of options in accordance with said grading scheme and whether a projected collision may be avoided; and,
maneuvering the maneuverable platform and commanding drive controls of the maneuverable platform to apply the autonomously selected course and speed of the option for the maneuverable platform.
2. The method according to claim 1 , wherein the grading scheme is generated so that at least some options are graded, for at least part of the time so that other options are neglected in the autonomous selection stage.
3. A system comprising:
a situation awareness module configured to receive maneuverable platform and obstacles data relating to at least one of: position, speed, and direction of said platform and of obstacles;
a decision module, executed by at least one processor, configured to:
obtain a plurality of objectives relating to a maneuverable platform;
determine a plurality of options for completing said plurality of objectives, wherein each of the plurality of options defines a distinct combination of course and speed;
calculate, for each of the plurality of options, projected positions of the maneuverable platform and of each obstacle and therefrom determine the distance between the maneuverable platform and each obstacle at the closest point of approach and the estimated time to arrive to the closest point of approach;
weigh each of the options in accordance with a grading scheme, wherein said grading scheme includes: assessing the estimated time to arrive at the closest point of approach with each obstacle; and, the distance between the maneuverable platform and each obstacle at the closest point of approach;
autonomously select, one option of the plurality of options, in accordance with said grading scheme and whether a projected collision may be avoided; and,
a control module configured to maneuver the maneuverable platform and commanding drive controls of the maneuverable platform to apply the autonomously selected course and speed of the option for the maneuverable platform.
4. The system according to claim 3 , wherein the grading scheme is generated so that at least some options are graded, for at least part of the time so that other options are neglected in the autonomous selection stage.