A method for estimating an attitude in a plurality of attitudes of an implement operably coupled to a vehicle body, the implement having an implement acceleration and the vehicle body having a body acceleration, wherein each attitude in the plurality of attitudes corresponds to a time instant in a plurality of time instants, the method comprising the steps of:
- receiving a body acceleration measurement from a body accelerometer mounted on the vehicle body;
- receiving an implement acceleration measurement from an implement accelerometer mounted on the implement;
- calculating a first state vector estimate corresponding to a first time instant in the plurality of time instants, wherein:
- the first state vector estimate is based at least in part on the body acceleration measurement and the implement acceleration measurement;
- and
- the first state vector estimate comprises a representation of a first attitude of the implement relative to the vehicle body.