The present invention is directed generally to the field of autonomous or computer-aided navigation, and more particularly to systems and methods for classifying sensor data and inferring ground height for use in generating terrain models that may be used for autonomous or computer-aided navigation.