An elevation map generator in a mobile agricultural machine generates an elevation map by estimating an elevation value for points in front of a work machine based on a plane derived from a measured elevation point measured by a pose detection system affixed to the work machine. Each elevation value has a corresponding confidence value that varies inversely with a distance of the point from the pose detection system. As the machine moves, additional elevation values are aggregated for each point, based on the confidence values. The machine is controlled based on the aggregated evaluation values.
