Environment map generation program and three-dimensional sensor control device

Abstract

A three-dimensional sensor control device performs processes of acquiring orthogonal coordinates of data points found in a plurality of photograph frames photographed by at least one three-dimensional sensor with a fixed photographing range and converting the orthogonal coordinates of the data points into polar coordinates using a first formula for conversion from orthogonal coordinates to polar coordinates The device then performs searching each sub-region of the photographing range to locate a set of polar coordinates representing a farthest data point that is located farthest in distance from the three-dimensional sensor in a respective sub-region and converting the polar coordinates of a collection of the farthest data points back into orthogonal coordinates using a second formula for conversion from the polar coordinates to the orthogonal coordinates, The device outputs environment map data of the photographing range using the orthogonal coordinates of the collection of the farthest data points.