Small unmanned aerial vehicle MARG heading and attitude estimation method based on adaptive EKF algorithm

A small unmanned aerial vehicle, self-adaptive technology, applied in the field of integrated navigation, can solve problems such as slow error convergence speed, decreased attitude angle accuracy, and spin

Active Publication Date: 2021-01-22
TIANJIN JINHANG COMP TECH RES INST
View PDF8 Cites 4 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

The first two algorithms are relatively easy to implement, and do not need special modeling for the system. In most cases, they can meet the flight requirements. However, in the case of large maneuvering flight or magnet

Method used

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
View more

Image

Smart Image Click on the blue labels to locate them in the text.
Viewing Examples
Smart Image
  • Small unmanned aerial vehicle MARG heading and attitude estimation method based on adaptive EKF algorithm
  • Small unmanned aerial vehicle MARG heading and attitude estimation method based on adaptive EKF algorithm
  • Small unmanned aerial vehicle MARG heading and attitude estimation method based on adaptive EKF algorithm

Examples

Experimental program
Comparison scheme
Effect test

Embodiment Construction

[0079] In order to make the purpose, content, and advantages of the present invention clearer, the specific implementation manners of the present invention will be further described in detail below in conjunction with the accompanying drawings and embodiments.

[0080] The invention provides a method for estimating the attitude of a small unmanned aerial vehicle (MARG) based on an adaptive EKF algorithm, and the attitude estimation is performed based on a sensor measurement model of the MARG. The extended Kalman filter algorithm (QuaternionExtended Kalman Filter, Q-EKF) of quaternion is adopted, and the Q-EKF filter is improved. First, the magnetometer and accelerometer measurement updates are performed separately, and the magnetometer error evaluation is added. When the magnetometer error is large, the magnetometer error can be isolated to avoid interference to the horizontal attitude estimation. Secondly, the present invention proposes an adaptive filtering algorithm for ext...

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

PUM

No PUM Login to view more

Abstract

The invention relates to a small unmanned aerial vehicle MARG heading and attitude estimation method based on an adaptive EKF algorithm, and belongs to the technical field of integrated navigation. According to the method, firstly, measurement updating of a magnetometer and an acceleration meter are carried out separately, magnetometer error evaluation is added, when the magnetometer error is large, the magnetometer error can be isolated, and interference on horizontal attitude estimation is avoided; secondly, the invention further provides an adaptive filtering algorithm for the external acceleration, in order to improve the estimation precision, a triaxial acceleration module value is not directly judged, a triaxial residual error is analyzed, and then corresponding measurement noise issubjected to self-adaptive adjustment, so that useful acceleration information is prevented from being lost, and the attitude estimation precision is improved.

Description

technical field [0001] The invention belongs to the technical field of integrated navigation, and in particular relates to a method for estimating the MARG attitude of a small unmanned aerial vehicle based on an adaptive EKF algorithm. Background technique [0002] Due to its size and cost constraints, small UAVs usually use low-cost MEMS inertial devices as the main sensor of their navigation system, combined with magnetometer and GPS satellite positioning system for integrated navigation. When the number of satellites is insufficient during flight or when flying indoors, it is necessary to switch to the heading and attitude mode (AHRS) to provide attitude information. Commonly used AHRS attitude algorithms include complementary filter method, gradient descent method, and Kalman filter, etc., all of which are based on the MARG (magnetic, angular rate, and gravity) sensor measurement model for attitude estimation. The first two algorithms are relatively easy to implement an...

Claims

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

Application Information

Patent Timeline
no application Login to view more
IPC IPC(8): G01C21/16G01C21/08G06F17/16
CPCG01C21/165G01C21/08G06F17/16Y02T90/00
Inventor 姜鑫
Owner TIANJIN JINHANG COMP TECH RES INST
Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Try Eureka
PatSnap group products