ESTIMATION WITH GYROS OF THE RELATIVE ATTITUDE BETWEEN A VEHICLE BODY AND AN IMPLEMENT OPERABLY COUPLED TO THE VEHICLE BODY

An estimate of the relative attitude between an implement and a vehicle body is computed from a body angular velocity measurement received from at least one body gyro mounted on the vehicle body and from an implement angular velocity measurement received from at least one implement gyro mounted on the implement. A first system state vector estimate corresponding to a first time instant includes a representation of a first relative attitude estimate. An updated system state vector is computed based at least in part on the first system state vector estimate, the body angular velocity vector measurement, and the implement angular velocity vector measurement. A second system state vector estimate corresponding to a second time instant is predicted based at least in part on the updated system state vector and a time-dependent system model. The second system state vector estimate includes a representation of a second relative attitude estimate.