A method for enhancing a three dimensional image from frames of flash LIDAR data includes generating a first distance Ri from a first detector i to a first point on a surface Si. After defining a map with a mesh Θ having cells k, a first array S(k), a second array M(k), and a third array D(k) are initialized. The first array corresponds to the surface, the second array corresponds to the elevation map, and the third array D(k) receives an output for the DEM. The surface is projected onto the mesh Θ, so that a second distance Rk from a second point on the mesh Θ to the detector can be found. From this, a height may be calculated, which permits the generation of a digital elevation map. Also, using sequential frames of flash LIDAR data, vehicle control is possible using an offset between successive frames.