Earthmoving machine comprising weighted state estimator

Abstract

Earthmoving machines are provided comprising a translational chassis movement indicator, an earthmoving implement inclinometer, and an implement state estimator. The translational chassis movement indicator provides a measurement indicative of movement of the machine chassis in one or more translational degrees of freedom. The implement inclinometer comprises (i) an implement accelerometer, which provides a measurement indicative of acceleration of the earthmoving implement in one or more translational or rotational degrees of freedom and (ii) an implement angular rate sensor, which provides a measurement of a rate at which the earthmoving implement is rotating in one or more degrees of rotational freedom. The implement state estimator generates an implement state estimate that is based at least partially on (i) implement position signals from an implement angular rate sensor and an implement accelerometer, (ii) signals from the translational chassis movement indicator and the implement inclinometer, and (iii) one or more weighting factors representative of noise in the signals from the translational chassis movement indicator and the implement inclinometer.