APPARATUS, METHOD AND PROGRAM FOR GENERATING OCCUPANCY GRID MAP

• US 20170116487A1
• Filed: 09/08/2016
• Published: 04/27/2017
• Est. Priority Date: 10/22/2015
• Status: Active Grant

• Current Assignee: Kabushiki Kaisha Toshiba (Toshiba Corporation)
• Original Assignee: Kabushiki Kaisha Toshiba (Toshiba Corporation)
• Inventors: TASAKI, Tsuyoshi, KATSUKI, Rie, WATANABE, Tomoki, SEKINE, Masahiro, YAMAZAKI, Masaki, NISHIYAMA, Manabu
• Granted Patent: US 10,354,150 B2
• Time in Patent Office: Days
• CPC Class Codes: G05D 1/024 in combination with a laser lasers per se H01S
• CPC Class Codes: G05D 1/0248 in combination with a laser lasers per se H01S
• CPC Class Codes: G05D 1/0251 extracting 3D information from a plurality of images taken from different locations, e.g. stereo vision stereoscopic image analysis H04N13/00; depth recovery from images G06T7/593
• CPC Class Codes: G05D 1/0257 using a radar radar systems designed for anti-collision purposes between land vehicles or between land vehicle and fixed obstacles G01S13/931
• CPC Class Codes: G05D 1/0274 using mapping information stored in a memory device navigation using map-matching G01C21/30
• CPC Class Codes: G06T 2207/10028 Range image; Depth image; 3D point clouds
• CPC Class Codes: G06T 2207/30261 Obstacle
• CPC Class Codes: G06T 7/285 using a sequence of stereo image pairs
• CPC Class Codes: G06T 7/593 from stereo images
• CPC Class Codes: G06V 10/44 Local feature extraction by analysis of parts of the pattern, e.g. by detecting edges, contours, loops, corners, strokes or intersections; Connectivity analysis, e.g. of connected components
• CPC Class Codes: G06V 20/58 Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
• CPC Class Codes: H04N 13/239 using two 2D image sensors having a relative position equal to or related to the interocular distance H04N13/243 takes precedence
• CPC Class Codes: H04N 13/246 Calibration of cameras
• CPC Class Codes: H04N 13/25 using two or more image sensors with different characteristics other than in their location or field of view, e.g. having different resolutions or colour pickup characteristics; using image signals from one sensor to control the characteristics of another sensor
• CPC Class Codes: H04N 13/254 in combination with electromagnetic radiation sources for illuminating objects
• CPC Class Codes: H04N 13/271 wherein the generated image signals comprise depth maps or disparity maps
• CPC Class Codes: H04N 2013/0085 Motion estimation from stereoscopic image signals

Abstract

According to one embodiment, an apparatus for generating an occupancy grid map constituted with a two-dimensional grid around a first moving body includes processing circuitry configured to acquire data of a distance from the first moving body to an obstacle lying in surroundings of the first moving body; acquire first information indicating the movement status of the first moving body at current time and determine an operation mode of the first moving body; set a range of interest in a grid of a resolution higher than a resolution of the grid of the occupancy grid map, from the operation mode; and align the occupancy grid map to the range of interest and generate the occupancy grid map in such a manner that the obstacle exists in the grid of the occupancy grid map and the grid of the range of interest with respect to a position corresponding to the distance data.

Claims

1. An apparatus for generating an occupancy grid map constituted with, a two-dimensional grid around a first moving body, the apparatus comprising;

processing circuitry configured to;

acquire data of a distance from the first moving body to an obstacle lying in surroundings of the first moving body;

acquire first information indicating a movement status of the first moving body at current time and determine an operation mode of the first moving body;

set a range of interest, which is a movement range of the first moving body at next time, in a grid of a resolution higher than a resolution of the grid of the occupancy grid map, from the operation mode; and

align the occupancy grid map to the range of interest and generate the occupancy grid map in such a manner that the obstacle exists in the grid of the occupancy grid map and the grid of the range of interest with respect to a position corresponding to the distance data.

2. The apparatus according to claim 1, wherein the processing circuitry is further configured to:

calculate a motion of the first moving body at the current time; and

update the occupancy grid map and the range of interest at the current time to the occupancy grid map and the range of interest at the next time, based on the motion of the first moving body.

3. The apparatus according to claim 1, wherein the processing circuitry is further configured to:

acquire environment information of a path of the first moving body; and

generate an environment object indicated by the environment information in the grid of the occupancy grid map and the grid of the range of interest, in addition to the obstacle represented by the distance data.

4. The apparatus according to claim 1, wherein the processing circuitry is further configured to:

predict a movement destination of a second moving body at the next time, the second moving body moving around the first moving body; and

generate the occupancy grid map in such a manner that the movement, destination of the second moving body exists as the obstacle in the grid of the occupancy grid map and the grid of the range of interest in addition to the obstacle represented by the distance data.

5. The apparatus according to claim 1, wherein the determined operation mode is one of an operation mode of a stop state of the first moving body, an operation mode of a stop state for right turn, an operation mode of a stop state for left turn, an operation mode of forward straight, an operation mode of forward straight for right turn, an operation mode of forward straight for left turn, and an operation mode of backward straight.

6. The apparatus according to claim 5, wherein the processing circuitry is further configured to:

generate a path candidate, which is a candidate of a range of movement of the first moving body, using the operation mode; and

set the range of interest to include an environment object indicated by environment information in the path candidate.

7. The apparatus according to claim 5, wherein the processing circuitry is further configured to:

generate a path candidate, which is a candidate of a range of movement of the first moving body, using the operation mode; and

set the range of interest to include a movement destination in the path candidate.

8. A method for generating an occupancy grid map constituted with a two-dimensional grid around a first moving body, the method comprising:

acquiring data of a distance from the first moving body to an obstacle lying in surroundings of the first moving body;

acquiring first information indicating a movement status of the first moving body at current time and determining an operation mode of the first moving body;

setting a range of interest, which is a movement range of the first moving body at next time, in a grid of a resolution higher than a resolution of the grid of the occupancy grid map, from the operation mode; and

aligning the occupancy grid map to the range of interest and generating the occupancy grid map in such a manner that the obstacle exists in the grid of the occupancy grid map and the grid of the range of interest with respect to a position corresponding to the distance data.

9. A non-transitory program stored in a computer readable medium, causing a computer to perform a method for generating an occupancy grid map composed of a two-dimensional grid around a first moving body, the method comprising:

acquiring data of a distance from the first moving body to an obstacle lying in surroundings of the first moving body;

acquiring first information indicating a movement status of the first moving body at current time and determining an operation mode of the first moving body;

setting a range of interest, which is a movement range of the first moving body at next time, in a grid of a resolution higher than a resolution of the grid of the occupancy grid map, from the operation mode; and

aligning the occupancy grid map to the range of interest and generating the occupancy grid map in such a manner that the obstacle exists in the grid of the occupancy grid map and the grid of the range of interest with respect to a position corresponding to the distance data.

10. An apparatus for generating an occupancy grid map constituted with a three-dimensional grid around a first moving body, the apparatus comprising:

processing circuitry configured to;

acquire data of a distance from the first moving body to an obstacle lying in surroundings of the first moving body;

acquire first information indicating a movement status of the first moving body at current time and determine a three-dimensional movement vector of the first moving body;

set a range of interest, which is a movement range of the first moving body at next time, in a grid of a resolution higher than a resolution of the grid of the occupancy grid map, from the three-dimensional movement vector; and

align the occupancy grid map to the range of interest and generate the occupancy grid map in such a manner that the obstacle exists in the grid of the occupancy grid map and the grid of the range of interest with respect to a position corresponding to the distance data.

11. A method for generating an occupancy grid map constituted with a three-dimensional grid around a first moving body, the method comprising:

acquiring data of a distance from the first moving body to an obstacle lying in surroundings of the first moving body;

acquiring first information indicating a movement status of the first moving body at current time and determining a three-dimensional movement vector of the first moving body;

setting a range of interest, which is a movement range of the first moving body at next time, in a grid of a resolution higher than a resolution of the grid of the occupancy grid map, from the three-dimensional movement vector; and

aligning the occupancy grid map to the range of interest and generating the occupancy grid map in such a manner that the obstacle exists in the grid of the occupancy grid map and the grid of the range of interest with respect to a position corresponding to the distance data.

12. A non-transitory program stored in a computer readable medium, causing a computer to perform a method for generating an occupancy grid map constituted with a three-dimensional grid around a first moving body, the method comprising:

acquiring data of a distance from the first moving body to an obstacle lying in surroundings of the first moving body;

acquiring first information indicating a movement status of the first moving body at current time and determining a three-dimensional movement vector of the first moving body;

setting a range of interest, which is a movement range of the first moving body at next time, in a grid of a resolution higher than a resolution of the grid of the occupancy grid map, from the three-dimensional movement vector; and

aligning the occupancy grid map to the range of interest and genera ting the occupancy grid map in such a manner that the obstacle exists in the grid of the occupancy grid map and the grid of the range of interest with respect to a position corresponding to the distance data.