Attitude angle measurement fusion system and method based on gyroscope and accelerometer
An accelerometer and angle measurement technology, which is used in navigation, attitude control, and control/adjustment systems through speed/acceleration measurement. It can solve problems such as noise interference, reduce measurement errors, improve calculation accuracy, and be robust. sexual effect
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
specific Embodiment 1
[0044] according to figure 1 As shown, the present invention provides a kind of attitude angle measurement fusion system based on gyroscope and accelerometer, and described system comprises: accelerometer 3, gyroscope 1, microprocessor 4, filter circuit 2, electronic regulator 5 and brushless Motor 6;
[0045] The data signal output end of the gyroscope 1 is connected to the data signal input end of the filter circuit 2, the data signal output end of the filter circuit 2 is connected to the data signal input end of the microprocessor 4, and the data signal output end of the accelerometer 3 is connected to the microprocessor The data signal input terminal of the controller 4, the control signal output terminal of the microprocessor 4 is connected to the control signal input terminal of the electronic regulator 5, and the control signal output terminal of the electronic regulator 5 is connected to the control signal input terminal of the brushless motor 6 end.
[0046] The sys...
specific Embodiment 2
[0048] according to figure 1 As shown, the present invention provides a kind of attitude angle measurement fusion method based on gyroscope and accelerometer, comprises the following steps:
[0049] Step 1: The angular velocity signal of the object measured by the gyroscope and the linear acceleration signal of the object measured by the accelerometer are used as input signals, and the microprocessor performs high-speed A / D sampling on the sensor group composed of the gyroscope, filter circuit and accelerometer;
[0050] Step 2: Establish the state equation and measurement equation of the attitude angle measurement fusion system, and use the attitude angle of the gyroscope and accelerometer to measure the true tilt angle of the fusion system As the state vector, the accelerometer is used to estimate the constant value deviation b of the gyroscope, and the state equation and observation equation of the attitude angle measurement fusion system are obtained according to b as the s...
PUM
Login to View More Abstract
Description
Claims
Application Information
Login to View More 


