Method and apparatus for determining location of objects based on range readings from multiple sensors

The invention is a method and apparatus for determining the locations of a plurality of actual objects based on the output of a plurality of range sensors. A multiplicity of range measurements are obtained from a plurality of sensors, each sensor capable of providing a multiplicity of range measurements. The range measurements from the plurality of sensors are correlated with each other to generate a list of potential objects and to order that list of potential objects from highest to lowest likelihood of being an actual object. The order may be based upon a cumulative error of the individual sensor measurements upon which the potential object is based. The ordered list of potential objects is then pared down to a smaller list of actual objects by assuming that the potential object highest in the ordered list as an actual object, and then removing from the list all other lower-ordered potential objects that are based on any of the range measurements upon which the selected object is based. The process is repeated for the next highest potential object remaining on the list until all potential objects on the list have either been selected as an actual object or removed from the list.