US Patent 10407872 System and method for controlling earthmoving machines

A control system for controlling an earthmoving machine operating at a worksite is disclosed. The control system includes a receiving unit to receive a first input indicative of a terrain profile of the worksite, a second input indicative of a target terrain profile for the worksite, and a third input indicative of machine characteristics. The control system also includes a mission planning controller to generate an excavation plan based on the first input, the second input, and the third input. The controller controls operation of the machine, based on the generated excavation plan, to obtain an excavated terrain profile. Further, the controller determines whether the excavated terrain profile matches with the target terrain profile, and operates the machine based on inputs indicative of the excavated terrain profile, the second input, the third input, and an extent of match between the excavated terrain profile and the target terrain profile.