Systems and methods for autonomous vehicle navigation
First Claim
1. A system for automatically navigating a vehicle, said system comprising:
- a data storage for storing one or more data sets physically describing one or more areas;
physical sensors to continuously obtain parameters relating to motion of the vehicle;
a first electronic interface for receiving data relating to the one or more areas from external data sources;
a second electronic interface for receiving the parameters relating to motion of the vehicle;
a navigation processor comprising processing circuitry adapted to;
continuously calculate and update, based on the parameters and data, a physical vehicle model, a microenvironment model, a driver safety model and a motion control model;
receive a destination and priorities;
determine based on the calculated models and based on the received destination and priorities an initial optimal route for traversing the vehicle from a given point in the one or more areas to another point in the one or more areas by computationally resolving a constrained minimization problem, wherein;
(iii) constraints of the constrained minimization problem are physical capabilities and limits of the vehicle and a physical space within the one or more areas appropriate for traversing the vehicle; and
(iv) an optimization parameter of the constrained minimization problem is a cost function, which cost function comprises a weighted aggregation of cost values representing each of;
safety of passengers, safety of other people, safety of the vehicle and other property, obedience to traffic regulations, minimizing travel time and minimizing cost;
divide the initial route into the smaller sections for detailed planning based on the continuously undated models; and
until reaching the destination, perform;
during an execution of a current section, continuously check, based on the continuously updated models, for an appearance of an interruption requiring a correction in the planned route;
in case of an interruption, compare a current position to the planned route, calculate reaction to the interruption based on the continuously updated models and executed reaction; and
at an end of the current section, in case the destination is not reached, move to a next section of the route.
4 Assignments
0 Petitions
Accused Products
Abstract
Disclosed is a system for automatically navigating a vehicle, which system comprises:
a data storage containing one or more maps of one or more areas;
electronic interfaces for: (i) receiving data relating to the one or more areas from external data sources; (ii) receiving parameters relating to motion of the vehicle from physical sensors; and (iii) receiving a location of the vehicle from a positioning device;
a navigation processor comprising processing circuitry adapted to determine an initial optimal route for traversing the vehicle from a given point in the one or more areas to another point in the one or more areas by computationally resolving a constrained minimization problem.
25 Citations
19 Claims
-
1. A system for automatically navigating a vehicle, said system comprising:
-
a data storage for storing one or more data sets physically describing one or more areas; physical sensors to continuously obtain parameters relating to motion of the vehicle; a first electronic interface for receiving data relating to the one or more areas from external data sources; a second electronic interface for receiving the parameters relating to motion of the vehicle; a navigation processor comprising processing circuitry adapted to; continuously calculate and update, based on the parameters and data, a physical vehicle model, a microenvironment model, a driver safety model and a motion control model; receive a destination and priorities; determine based on the calculated models and based on the received destination and priorities an initial optimal route for traversing the vehicle from a given point in the one or more areas to another point in the one or more areas by computationally resolving a constrained minimization problem, wherein; (iii) constraints of the constrained minimization problem are physical capabilities and limits of the vehicle and a physical space within the one or more areas appropriate for traversing the vehicle; and (iv) an optimization parameter of the constrained minimization problem is a cost function, which cost function comprises a weighted aggregation of cost values representing each of;
safety of passengers, safety of other people, safety of the vehicle and other property, obedience to traffic regulations, minimizing travel time and minimizing cost;divide the initial route into the smaller sections for detailed planning based on the continuously undated models; and until reaching the destination, perform; during an execution of a current section, continuously check, based on the continuously updated models, for an appearance of an interruption requiring a correction in the planned route; in case of an interruption, compare a current position to the planned route, calculate reaction to the interruption based on the continuously updated models and executed reaction; and at an end of the current section, in case the destination is not reached, move to a next section of the route. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18)
-
-
19. A method for automatically navigating a vehicle, comprising:
-
receiving from a data storage, data sets physically describing one or more areas; receiving from external data sources, data relating to the one or more areas; continuously obtaining by physical sensors parameters relating to motion of the vehicle; continuously calculating and updating, based on the parameters and data, a physical vehicle model, a microenvironment model, a driver safety model and a motion control model; receiving a destination and priorities; determining based on the calculated models and based on the received destination and priorities an initial optimal route for traversing the vehicle from a given point in the one or more areas to another point in the one or more areas by computationally resolving a constrained minimization problem, wherein; (iii) constraints of the constrained minimization problem are physical capabilities and limits of the vehicle and a physical space within the one or more areas appropriate for traversing the vehicle; and (iv) an optimization parameter of the constrained minimization problem is a cost function, which cost function comprises a weighted aggregation of cost values representing each of;
safety of passengers, safety of other people, safety of the vehicle and other property, obedience to traffic regulations, minimizing travel time and minimizing cost;dividing the initial route into the smaller sections for detailed planning based on the continuously updated models; and until reaching the destination, performing; during an execution of a current section, continuously checking, based on the continuously updated models, for an appearance of an interruption requiring a correction in the planned route; in case of an interruption, comparing a current position to the planned route, calculate reaction to the interruption based on the continuously updated models and executing reaction; and at an end of the current section, in case the destination is not reached, moving to a next section of the route.
-
Specification