Systems and methods for controlling a machine implement

A method of controlling an implement of a machine comprising:

• receiving at a controller an implement pitch signal indicative of an angle of the implement with respect to the chassis, a chassis pitch signal indicative of an angle of the chassis with respect to gravity, and a speed signal indicative of a speed of the machine;
• adjusting a low pass filter based on the speed signal;
• filtering the chassis pitch signal through the low pass filter to produce a filtered chassis pitch angle;
• determining a target mainfall angle based on the implement pitch signal and the filtered chassis pitch angle;
• determining a difference angle based on the target mainfall angle, the implement pitch signal, and the chassis pitch signal;
• changing a position of the implement based on the difference angle.

A method for controlling an implement of a machine comprising:

• receiving at a controller an operator command signal and a chassis pitch signal;
• determining an operator desired implement mainfall angle rate based on the operator command signal;
• filtering the chassis pitch signal using a high pass filter to produce a filtered chassis pitch rate;
• determining a target implement mainfall angle based on the operator desired implement mainfall angle rate and the filtered chassis pitch rate;
• determining an augmented operator command signal based on the target implement mainfall angle rate;
• and
• changing a position of the implement based on the augmented operator command signal.