Autonomous navigation through obstacles
First Claim
1. A computer-implemented method for navigating a mobile automated system through obstacles, the method comprising:
- receiving image sensor data from one or more sensors, the image sensor data including left image sensor data related to a left portion of a field of view of the one or more sensors and right image sensor data related to a right portion of the field of view of the one or more sensors;
prior to determining a left obstacle image density, estimating one or more left obstacle parameters describing obstacles on the left portion of the field of view based at least in part on the left image sensor data, the one or more left obstacle parameters including a first number of obstacles on the left portion of the field of view;
prior to determining a right obstacle image density, estimating one or more right obstacle parameters describing obstacles on the right portion of the field of view based at least in part on the right image sensor data, the one or more right obstacle parameters including a second number of obstacles on the right portion of the field of view;
determining the left obstacle image density describing a density of the obstacles on the left portion of the field of view for a path from a start point to a navigating destination based at least in part on one or more values associated with the one or more left obstacle parameters, the left obstacle image density being a first vector having a vector length proportional to the first number of obstacles on the left portion of the field of view;
determining the right obstacle image density describing a density of the obstacles on the right portion of the field of view for the path from the start point to the navigating destination based at least in part on one or more values associated with the one or more right obstacle parameters, the right obstacle image density being a second vector having a vector length proportional to the second number of obstacles on the right portion of the field of view;
generating a net density based on the left obstacle image density and the right obstacle image density, the net density being a vector sum of the first vector having the vector length proportional to the first number of obstacles on the left portion of the field of view and the second vector having the vector length proportional to the second number of obstacles on the right portion of the field of view;
generating a direction vector based on the net density, the direction vector indicating a navigating direction for navigating the mobile automated system to the navigating destination;
determining a first navigating velocity for navigating the mobile automated system to the navigating destination based at least in part on the navigating direction; and
generating one or more first navigating commands to navigate the mobile automated system to the navigating destination based at least in part on the first navigating velocity.
2 Assignments
0 Petitions
Accused Products
Abstract
A system and method for navigating a mobile automated system through obstacles is disclosed. The system includes a communication module, an estimation module, a density module, a vector module, a navigating module and a command module. The communication module receives image sensor data from one or more sensors. The estimation module estimates one or more obstacle parameters. The density module determines a left obstacle image density and a right obstacle image density for a path from a start point to a navigating destination based on the one or more obstacle parameters. The vector module generates a vector model to determine a navigating direction based on the left obstacle image density and the right obstacle image density. The navigating module determines a navigating velocity for navigating the mobile automated system to the navigating destination. The command module generates one or more navigating commands based on the navigating velocity.
31 Citations
30 Claims
-
1. A computer-implemented method for navigating a mobile automated system through obstacles, the method comprising:
-
receiving image sensor data from one or more sensors, the image sensor data including left image sensor data related to a left portion of a field of view of the one or more sensors and right image sensor data related to a right portion of the field of view of the one or more sensors; prior to determining a left obstacle image density, estimating one or more left obstacle parameters describing obstacles on the left portion of the field of view based at least in part on the left image sensor data, the one or more left obstacle parameters including a first number of obstacles on the left portion of the field of view; prior to determining a right obstacle image density, estimating one or more right obstacle parameters describing obstacles on the right portion of the field of view based at least in part on the right image sensor data, the one or more right obstacle parameters including a second number of obstacles on the right portion of the field of view; determining the left obstacle image density describing a density of the obstacles on the left portion of the field of view for a path from a start point to a navigating destination based at least in part on one or more values associated with the one or more left obstacle parameters, the left obstacle image density being a first vector having a vector length proportional to the first number of obstacles on the left portion of the field of view; determining the right obstacle image density describing a density of the obstacles on the right portion of the field of view for the path from the start point to the navigating destination based at least in part on one or more values associated with the one or more right obstacle parameters, the right obstacle image density being a second vector having a vector length proportional to the second number of obstacles on the right portion of the field of view; generating a net density based on the left obstacle image density and the right obstacle image density, the net density being a vector sum of the first vector having the vector length proportional to the first number of obstacles on the left portion of the field of view and the second vector having the vector length proportional to the second number of obstacles on the right portion of the field of view; generating a direction vector based on the net density, the direction vector indicating a navigating direction for navigating the mobile automated system to the navigating destination; determining a first navigating velocity for navigating the mobile automated system to the navigating destination based at least in part on the navigating direction; and generating one or more first navigating commands to navigate the mobile automated system to the navigating destination based at least in part on the first navigating velocity. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 28)
-
-
10. A computer program product comprising a non-transitory computer readable medium encoding instructions that, in response to execution by a computing device, cause the computing device to perform operations comprising:
-
receiving image sensor data from one or more sensors, the image sensor data including left image sensor data related to a left portion of a field of view of the one or more sensors and right image sensor data related to a right portion of the field of view of the one or more sensors; prior to determining a left obstacle image density, estimating one or more left obstacle parameters describing obstacles on the left portion of the field of view based at least in part on the left image sensor data, the one or more left obstacle parameters including a first number of obstacles on the left portion of the field of view; prior to determining a right obstacle image density, estimating one or more right obstacle parameters describing obstacles on the right portion of the field of view based at least in part on the right image sensor data, the one or more right obstacle parameters including a second number of obstacles on the right portion of the field of view; determining the left obstacle image density describing a density of the obstacles on the left portion of the field of view for a path from a start point to a navigating destination based at least in part on one or more values associated with the one or more left obstacle parameters, the left obstacle image density being a first vector having a vector length proportional to the first number of obstacles on the left portion of the field of view; determining the right obstacle image density describing a density of the obstacles on the right portion of the field of view for the path from the start point to the navigating destination based at least in part on one or more values associated with the one or more right obstacle parameters, the right obstacle image density being a second vector having a vector length proportional to the second number of obstacles on the right portion of the field of view; generating a net density based on the left obstacle image density and the right obstacle image density, the net density being a vector sum of the first vector having the vector length proportional to the first number of obstacles on the left portion of the field of view and the second vector having the vector length proportional to the second number of obstacles on the right portion of the field of view; generating a direction vector based on the net density, the direction vector indicating a navigation direction for navigating a mobile automated system to the navigating destination; determining a first navigating velocity for navigating the mobile automated system to the navigating destination based at least in part on the navigating direction; and generating one or more first navigating commands to navigate the mobile automated system to the navigating destination based at least in part on the first navigating velocity. - View Dependent Claims (11, 12, 13, 14, 15, 16, 17, 18, 29)
-
-
19. A system for navigating a mobile automated system through obstacles, the system comprising:
-
a communication module for receiving image sensor data from one or more sensors, the image sensor data including left image sensor data related to a left portion of a field of view of the one or more sensors and right image sensor data related to a right portion of the field of view of the one or more sensors; an estimation module communicatively coupled to the communication module, the estimation module estimating, prior to determining a left obstacle image density, one or more left obstacle parameters describing obstacles on the left portion of the field of view based at least in part on the left image sensor data, the one or more left obstacle parameters including a first number of obstacles on the left portion of the field of view, the estimation module further estimating, prior to determining a right obstacle image density, one or more right obstacle parameters describing obstacles on the right portion of the field of view based at least in part on the right image sensor data, the one or more right obstacle parameters including a second number of obstacles on the right portion of the field of view; a density module communicatively coupled to the estimation module, the density module determining the left obstacle image density describing a density of the obstacles on the left portion of the field of view for a path from a start point to a navigating destination based at least in part on one or more values associated with the one or more left obstacle parameters, the left obstacle image density being a first vector having a vector length proportional to the first number of obstacles on the left portion of the field of view, the density module further determining a right obstacle image density describing a density of the obstacles on the right portion of the field of view for the path from the start point to the navigating destination based at least in part on one or more values associated with the one or more right obstacle parameters, the right obstacle image density being a second vector having a vector length proportional to the second number of obstacles on the right portion of the field of view; a vector module communicatively coupled to the density module, the vector module generating a net density based on the left obstacle image density and the right obstacle image density, the net density being a vector sum of the first vector having the vector length proportional to the first number of obstacles on the left portion of the field of view and the second vector having the vector length proportional to the second number of obstacles on the right portion of the field of view, the vector module further generating a direction vector based on the net density, the direction vector indicating a navigating direction for navigating a mobile automated system to the navigating destination; a navigating module communicatively coupled to the vector module, the navigating module determining a first navigating velocity for navigating the mobile automated system to the navigating destination based at least in part on the navigating direction; and a command module communicatively coupled to the navigating module, the command module generating one or more first navigating commands to navigate the mobile automated system to the navigating destination based at least in part on the first navigating velocity. - View Dependent Claims (20, 21, 22, 23, 24, 25, 26, 27, 30)
-
Specification