Systems and methods for adjusting a height of an implement mounted on a body of a vehicle as the vehicle travels over a terrain are provided. Sensor data is received from a set of sensors disposed on the vehicle. A trajectory associated with the vehicle is determined based on the received sensor data. A profile of the terrain is estimated based on the determined trajectory associated with the vehicle. A ditch is detected in the terrain and compensation values for adjusting the height of the implement are determined based on the estimated profile of the terrain to compensate for the detected ditch. One or more control signals are transmitted to one or more actuators for adjusting the height of the implement based on the determined compensation values.