Obstacle detecting apparatus and method, and storage medium which stores program for implementing the method

An obstacle detecting apparatus comprising:

• a distance image obtaining section having a distance sensor, for measuring the distance of each measurement point of objects existing in a visual field in front of the distance sensor and obtaining a three-dimensional coordinate value for each measurement point, and generating a distance image based on the three-dimensional coordinate values of the measurement points;
• a histogram generating section for:
• projecting each measurement point of the objects onto at least one of predetermined horizontal and vertical planes, where each plane is divided into grid cells, and the resolution of the divided grid cells is lower than the measurement resolution of the distance sensor;
• and
• calculating the number of the measurement points projected onto each grid cell in the relevant plane, and generating a three-dimensional histogram indicating the distribution of the measurement points in the grid cells;
• a binary converting section for converting the histogram to binary data by comparing the histogram with a predetermined threshold value;
• and
• an obstacle map generating section for extracting one or more obstacles by performing a clustering operation on the binary data obtained by the binary converting section, and generating an obstacle map by which the positional relationship between the distance sensor and each obstacle is determined.

An obstacle detecting method comprising:

• a distance image obtaining step of measuring the distance of each measurement point of objects existing in a visual field in front of a distance sensor and obtaining a three-dimensional coordinate value for each measurement point, and generating a distance image based on the three-dimensional coordinate values of the measurement points;
• a histogram generating step of:
• projecting each measurement point of the objects onto a predetermined plane which is divided into grid cells;
• and
• calculating the number of the measurement points projected onto each grid cell in the plane, and generating a three-dimensional histogram indicating the distribution of the measurement points in the grid cells;
• and
• an obstacle map generating step of extracting one or more obstacles and generating an obstacle map based on the histogram, where the positional relationship between the distance sensor and each obstacle is determined by the obstacle map.

An obstacle detecting method comprising:

• a distance image obtaining step of measuring the distance of each measurement point of objects existing in a visual field in front of a distance sensor and obtaining a three-dimensional coordinate value for each measurement point, and generating a distance image based on the three-dimensional coordinate values of the measurement points;
• a histogram generating step of:
• projecting each measurement point of the objects onto at least one of predetermined horizontal and vertical planes, where each plane is divided into grid cells, and the resolution of the divided grid cells is lower than the measurement resolution of the distance sensor;
• and
• calculating the number of the measurement points projected onto each grid cell in the relevant plane, and generating a three-dimensional histogram indicating the distribution of the measurement points in the grid cells;
• a binary converting step of converting the histogram to binary data by comparing the histogram with a predetermined threshold value;
• and
• an obstacle map generating step of extracting one or more obstacles by performing the clustering operation of the binary data obtained in the binary converting step, and generating an obstacle map by which the positional relationship between the distance sensor and each obstacle is determined.

A computer readable storage medium storing a program for making a computer execute an operation of detecting obstacles existing in a visual field of a distance sensor, the operation comprising:

• a distance image obtaining step of measuring the distance of each measurement point of objects existing in a visual field in front of a distance sensor and obtaining a three-dimensional coordinate value for each measurement point, and generating a distance image based on the three-dimensional coordinate values of the measurement points;
• a histogram generating step of:
• projecting each measurement point of the objects onto a predetermined plane which is divided into grid cells;
• and
• calculating the number of the measurement points projected onto each grid cell in the plane, and generating a three-dimensional histogram indicating the distribution of the measurement points in the grid cells;
• and
• an obstacle map generating step of extracting one or more obstacles and generating an obstacle map based on the histogram, where the positional relationship between the distance sensor and each obstacle is determined by the obstacle map.

A computer readable storage medium storing a program for making a computer execute an operation of detecting obstacles existing in a visual field of a distance sensor, the operation comprising:

• a distance image obtaining step of measuring the distance of each measurement point of objects existing in a visual field in front of a distance sensor and obtaining a three-dimensional coordinate value for each measurement point, and generating a distance image based on the three-dimensional coordinate values of the measurement points;
• a histogram generating step of:
• projecting each measurement point of the objects onto at least one of predetermined horizontal and vertical planes, where each plane is divided into grid cells, and the resolution of the divided grid cells is lower than the measurement resolution of the distance sensor;
• and
• calculating the number of the measurement points projected onto each grid cell in the relevant plane, and generating a three-dimensional histogram indicating the distribution of the measurement points in the grid cells;
• a binary converting step of converting the histogram to binary data by comparing the histogram with a predetermined threshold value;
• and
• an obstacle map generating step of extracting one or more obstacles by performing a clustering operation on the binary data obtained in the binary converting step, and generating an obstacle map by which the positional relationship between the distance sensor and each obstacle is determined.