Measuring method and module for attitude of agriculture machinery vehicle

Abstract

The invention provides a measuring module and method for the attitude of an agriculture machinery vehicle. The measuring module comprises a gyroscope, a magnetometer and an accelerometer, wherein the gyroscope, the magnetometer and the accelerometer are integrated on a circuit board. The gyroscope is used for measuring the angular velocity, the magnetometer is used for measuring the intensity of the earth magnetic field, and the accelerometer is used for measuring the acceleration. The acceleration can be regarded as a component of the acceleration of gravity under the static condition and the low dynamic condition, and the gradient of a plane can be determined; the heading can be obtained through fusion calculation of the gradient and the magnetometer, an attitude error and a gyroscope zero bias error are estimated through the Kalman filtering algorithm and corrected. According to the measuring module and method, the magnetometer, the accelerometer and the gyroscope are integrated on the circuit board at the same time, fusion calculation is carried out by combining the measured data of the gyroscope, the magnetometer and the accelerometer, the small attitude measuring module low in cost and high in accuracy is developed, the module with the complete attitude measuring function can be conveniently integrated into a larger project, and convenience is brought to secondary development.

Description

technical field [0001] The invention belongs to the field of posture measurement, and in particular relates to a method for measuring the posture of an agricultural machinery vehicle and a measurement module. Background technique [0002] The current vehicle attitude detection is mainly divided into two application scenarios, one is abnormal alarm, such as vehicle rollover detection; the other is high-precision navigation assistance, which is the field involved in the present invention. At present, the method to achieve high-precision attitude measurement is to install two satellite antennas side by side on the vehicle, and use the satellite receiver to measure the heading angle when it is stationary and in motion. At the same time, the gyroscope and accelerometer are used to calculate the roll angle and pitch of the vehicle. Angle, the two are combined to achieve the attitude measurement of the vehicle. The above method comes from the patent "Attitude measurement using asi...

AI Technical Summary

Problems solved by technology

[0004] One of the objectives of the present invention is to provide a vehicle attitude measurement module for agricultural machinery, which solves the problems of high cost of current measurement equipment, low measurement accuracy and dependence on satellite signals

Images