Estimation of the relative attitude and position between a vehicle body and an implement operably coupled to the vehicle body
First Claim
1. 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 is calculated by calculating a measurement vector based at least in part on the body acceleration measurement and the implement acceleration measurement and performing an extended Kalman filter procedure on the measurement vector; and
the first state vector estimate comprises a representation of a first attitude of the implement relative to the vehicle body, the representation being a rotation quaternion q given by;
q=[q0,q1,q2,q3],(q02+q12+q22+q32=1).
1 Assignment
0 Petitions
Accused Products
Abstract
An implement having an implement acceleration is operably coupled to a vehicle body having a body acceleration. An attitude of the implement is estimated by receiving acceleration measurements from an accelerometer mounted on the vehicle body and an accelerometer mounted on the implement. A state vector estimate is calculated based at least in part on the body acceleration measurement and the implement acceleration measurement. The state vector estimate includes a representation of the attitude of the implement relative to the vehicle body. In addition to the accelerometer measurements, angular velocity measurements can be received from a gyro mounted on the vehicle body and a gyro mounted on the implement. The state vector estimate is then calculated based at least in part on the body acceleration measurement, the implement acceleration measurement, the body angular velocity measurement, and the implement angular velocity measurement.
-
Citations
39 Claims
-
1. 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 is calculated by calculating a measurement vector based at least in part on the body acceleration measurement and the implement acceleration measurement and performing an extended Kalman filter procedure on the measurement vector; and the first state vector estimate comprises a representation of a first attitude of the implement relative to the vehicle body, the representation being a rotation quaternion q given by;
q=[q0,q1,q2,q3],(q02+q12+q22+q32=1). - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13)
-
-
14. An apparatus 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 apparatus comprising:
-
means for receiving a body acceleration measurement from a body accelerometer mounted on the vehicle body; means for receiving an implement acceleration measurement from an implement accelerometer mounted on the implement; means for 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 is calculated by calculating a measurement vector based at least in part on the body acceleration measurement and the implement acceleration measurement and performing an extended Kalman filter procedure on the measurement vector; and the first state vector estimate comprises a representation of a first attitude of the implement relative to the vehicle body, the representation being a rotation quaternion q given by;
q=[q0,q1,q2,q3],(q02+q12+q22+q32=1). - View Dependent Claims (15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26)
-
-
27. A computer readable medium storing computer program instructions 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 computer program instructions defining 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 is calculated by calculating a measurement vector based at least in part on the body acceleration measurement and the implement acceleration measurement and performing an extended Kalman filter procedure on the measurement vector; and the first state vector estimate comprises a representation of a first attitude of the implement relative to the vehicle body, the representation being a rotation quaternion q given by;
q=[q0,q1,q2,q3],(q02+q12+q22+q32=1). - View Dependent Claims (28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39)
-
Specification