US Patent 9322148 System and method for terrain mapping

A mapping system includes a pose sensor, a mapping sensor, a database defining a work surface, and a controller. The controller is configured to receive pose signals and determine the position and the orientation of the machine and receive mapping signals and determine a plurality of raw data points. The controller further determines a plurality of machine points defining a position of a portion of the machine and filters the plurality of raw data points based upon the plurality of machine points to define a plurality of filtered data points. The database may be updated with the plurality of filtered data points.