MULTIDIMENSIONAL EVIDENCE GRIDS AND SYSTEM AND METHODS FOR APPLYING SAME

A method of generating an evidence grid representing an environment comprises the steps of collecting a set of stereo images at multiple locations within the environment using stereo sensors, and processing the set of stereo images to determine occupancy and distance data associated with each point in space represented in the set of stereo images; applying a sensor model to each point in space to determine a probability of occupancy of each voxel representing each point in space; and generating an evidence grid of the environment by combining the probabilities for each voxel.