CN106403938B - A kind of system filter method for the interference of small drone multi-source complex vibration - Google Patents

A kind of system filter method for the interference of small drone multi-source complex vibration Download PDF

Info

Publication number
CN106403938B
CN106403938B CN201610729794.4A CN201610729794A CN106403938B CN 106403938 B CN106403938 B CN 106403938B CN 201610729794 A CN201610729794 A CN 201610729794A CN 106403938 B CN106403938 B CN 106403938B
Authority
CN
China
Prior art keywords
interference
geography
department
acceleration
vibration
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201610729794.4A
Other languages
Chinese (zh)
Other versions
CN106403938A (en
Inventor
张霄
王悦
郭雷
杜涛
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beihang University
Original Assignee
Beihang University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beihang University filed Critical Beihang University
Priority to CN201610729794.4A priority Critical patent/CN106403938B/en
Publication of CN106403938A publication Critical patent/CN106403938A/en
Application granted granted Critical
Publication of CN106403938B publication Critical patent/CN106403938B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

The present invention relates to the system filter methods for the interference of small drone multi-source complex vibration, firstly, utilizing the acceleration transducer data of vibrated interferenceThe three-dimensional velocity being disturbed under Department of Geography is solved with the speed renewal equation of strapdown inertial navigationSecondly, with three-dimensional velocity under Department of GeographyFor quantity of state, strap down inertial navigation/satellite combined guidance system state model is established, and designs the interference observer for being directed to integrated navigation system vibration interference;Again, willAs the input of interference observer, interference estimate under the Department of Geography of interference observer output is utilizedFeedback compensation disturbing accelerationObtain compensation post-acceleration vectorFinally, utilizing gyroscope output data and accelerationComplete strap down inertial navigation/satellite combined guidance system inertial reference calculation and Kalman combined filter process.The present invention is suitable for navigation of the small drone under engine multi-source complex vibration environment.

Description

A kind of system filter method for the interference of small drone multi-source complex vibration
Technical field
The present invention relates to a kind of system filter methods for the interference of small drone multi-source complex vibration, see by interference Device and Kalman combined filter method are surveyed, it is multiple for multi-source to realize small drone strap down inertial navigation/satellite combined guidance system The combined filter process for closing vibration interference, suitable for navigation of the small drone under engine multi-source complex vibration environment.
Background technique
The small-sized long endurance unmanned aircraft of low-to-medium altitude generally uses the configurations of high aspect ratio, short fuselage, and uses composite wood Material, sufficiently to reduce its own weight.However its power device (generally using four-stroke gasoline piston-mode motor) is but to machine Body brings serious vibration interference.Light, thin feature is presented in the small-sized long endurance unmanned aircraft body of low-to-medium altitude, and structural modal is opposite It is lower, and vibration is difficult to obtain effective attenuation in the conductive process of body.Cause the vibration of body in the superposition of more vibration sources, big vibration Width, broadband, the complex morphology for becoming mean value superposition white Gaussian noise.Since small-sized long endurance unmanned aircraft load-carrying ability has Limit, it is difficult to provide good working environment using complicated vibration reducing measure for integrated navigation system.Therefore, this complex vibration quilt Micro inertial measurement unit (MIMU) capture will be input to Kalman filter with the interference signal for becoming mean value, change standard deviation. Kalman filter method is directed to the interference other than white Gaussian noise without obvious inhibiting effect, therefore engine luggine serious interference shadow The precision for ringing integrated navigation system even causes filter divergence, brings huge safety to the flight of small-sized long endurance unmanned aircraft Hidden danger.
Summary of the invention
Technology of the invention solves the problems, such as: for more vibration source superpositions, large amplitude, broadband, becoming mean value superposition white Gaussian The complex vibration of noise is to integrated navigation system bring multi-source interference problem, using the way of thinking of interference observer, design A kind of integrated navigation filter for the interference of multi-source complex vibration.Traditional Kalman filter is solved under multi-source vibration environment The problem of navigation accuracy decline, improves the precision and anti-interference ability of integrated navigation system Kalman filter.
A kind of technical solution of the invention are as follows: system filter side for the interference of small drone multi-source complex vibration Method is realized through the following steps:
(1) using the accelerometer output data under vibration environmentWith attitude matrixMultiplication obtain under Department of Geography by The specific force of interferenceIt willIt carries out acceleration of gravity and compensates the acceleration information being disturbedIt utilizesIt is used with strapdown It leads speed renewal equation and solves the three-dimensional velocity being disturbed under Department of Geography
(2) with three-dimensional velocity under Department of GeographyFor quantity of state, the strap down inertial navigation/satellite group for considering body vibration interference is established Navigation system state model is closed, in conjunction with the state model of foundation, design is dry for strap down inertial navigation/satellite combined guidance system vibration The interference observer disturbed;
(3) three dimensional velocity vectors that will be disturbedAs the input of interference observer, interference observer exports Department of Geography Lower vibration interference estimated valueThenDisturbing acceleration in feedback compensation step (1)Obtain compensation post-acceleration vector
(4) gyroscope output data is utilizedWith compensation post-accelerationIntegrated navigation system inertial reference calculation is completed, then The combined filter process of inertial navigation and satellite is completed using Kalman integrated navigation filtering method;
(5) it in small drone operational process, constantly repeats (1) and arrives (4), until navigation terminates.
The three-dimensional velocity being disturbed under the Department of Geography being related in the step (1)Calculation method are as follows: use strapdown The speed renewal equation of inertial navigation utilizes the acceleration transducer data of vibrated interferenceIt carries outResolving.
Strap down inertial navigation/satellite combined guidance system state of the considerations of being related in the step (2) body vibration interference Model foundation is as follows:
Select three dimensional velocity vectors under unmanned plane Department of GeographyAs quantity of state x, vibration is considered Interference, state model are expressed asWherein, Respectively The rotational angular velocity that the projection for being rotational-angular velocity of the earth under Department of Geography and Department of Geography feel concerned about relative to ground is under Department of Geography Projection;It is projection of the specific force under carrier Department of Geography;gnIt is projection of the acceleration of gravity under Department of Geography;u0ForWith gn's Vector sum;D is projection of the interference that generates to integrated navigation system of body vibration under Department of Geography, and state model is expressed as follows Formula:
The state model established is combined in the step (2), design is for strap down inertial navigation/satellite combined guidance system vibration The interference observer of interference, specific design procedure are as follows:
According to the state model of foundation, interference volume d is indicated are as follows:
Design Interference Estimation amountMeet equation:
Wherein, L is interference observer gain matrix, and the selection of L influences the estimation performance and stability of observer, is enabled intermediate VariableThen have:
It is obtained in conjunction with above-mentioned formula:
In UAV system, three shaft vibration of body under Department of Geography is interfered without cross-coupling factor, therefore L takes diagonal matrix:
L=diag { L1,L2,L3}
To sum up, interference observer design is as follows:
Interference observer is expressed as a, b formula in detail:
A, the intermediate variable z differential equation:
B, disturbance-observer amountCalculating formula:
In addition, gain matrix L has certain value range for the robust stability for ensuring interference observer.By Li Yapu The provable L of promise husband's stability theoremiWhen > 0 (i=1,2,3), the error differential equation of interference observer keeps global progressive steady It is fixed.In LiMatrix L is adjusted under the constraint of > 0 (i=1,2,3), interference observer can be improved to vibration interference quickly and accurately Observation performance.
Interference observer output valve is utilized in the step (3)Disturbing acceleration in feedback compensation step (1)It obtains Compensate post-acceleration vectorConcrete methods of realizing it is as follows:
The three dimensional velocity vectors that will be disturbedAs the input of interference observer, shake under interference observer output Department of Geography Dynamic interference volumeDisturbing acceleration under Department of GeographyIt is expressed asWherein,It is true acceleration under Department of Geography, D is vibration interference vector under Department of Geography;It utilizesFeedback compensation disturbing accelerationObtain compensation post-acceleration vectoredFor Interference Estimation error;Gain matrix L makes interference estimateClose to very It does solid work and disturbs d, thenIt can level off to true acceleration
The combined filter mistake of inertial navigation and satellite is completed in the step (4) using Kalman integrated navigation filtering method Journey, after low frequency component of the interference observer to vibration interference is estimated and offset, Kalman combined filter method can Inhibited again for system white Gaussian noise.
The principle of the present invention is: the external vibration that engine is generated interferes, caused by system realistic model and nominal mould The difference of type output is as Interference Estimation amountOutput, it is equivalent to arrive control signal u0Realize the compensation and complete inhibition of interference;Benefit Low frequency, Non-zero Mean vibration interference component are estimated and offset with interference observer, utilizes Kalman combined filter method Inhibited for system white Gaussian noise component, to realize to more vibration source superpositions, broadband, become mean value superposition Gauss white noise The counteracting and inhibition of acoustic vibration interference.
The advantages of the present invention over the prior art are that:
(1) present invention uses the thought of interference observer, effectively observes that the low frequency component of system vibration interference is gone forward side by side Feedback compensation is gone.Compared with the conventional filtering method for the interference of small drone engine luggine, interference observer side Method is simple, calculation amount is small, and can effectively improve the robustness and anti-interference ability of system.
(2) the present invention relates to for system vibration interference observation and compensation method, can be generalized to multi-source the external world It is used in the case where interference.For example, being interfered simultaneously by engine luggine, when gust disturbance in unmanned plane, designed is dry The ability that observer can have while observe above-mentioned multi-source interference is disturbed, there is wider application range.
(3) present invention is by interference observer and Kalman combined filter method, realize small drone strap down inertial navigation/ Satellite combined guidance system is directed to the combined filter process of multi-source complex vibration interference.For change mean value interference components and white Gaussian Noise jamming component has carried out common inhibition.
Detailed description of the invention
Fig. 1 is design flow diagram of the invention;
Fig. 2 is the small drone integrated navigation system anti-interference filter block diagram that the present invention designs.
Specific embodiment
Control method (DOBC, Disturbance Observer Based Control) based on interference observer has Method is simple, can effectively improve the features such as system robustness, has to system modelling error, Parameter Perturbation and various external interferences Good estimation effect.For more vibration source superpositions, large amplitude, broadband, the complex vibration pair for becoming mean value superposition white Gaussian noise Integrated navigation system bring multi-source interference problem proposes a kind of small drone strap down inertial navigation/satellite combined guidance system Filtering method.Using the way of thinking of DOBC, as shown in Figure 2 integrated navigation filtering of the design for the interference of multi-source complex vibration Device: firstly, calculating the acceleration that strap down inertial navigation/satellite combined guidance system is disturbed using acceleration measuring magnitudeSecondly, utilizing the system state amount being disturbedIn conjunction with interference observer method, estimates system and exist Vibration interference under Department of GeographyAgain, interference estimate is utilizedFeedback compensation Department of Geography accelerationComplete strapdown Inertia/satellite system inertial reference calculation and Kalman combined filter process improve the precision of integrated navigation system Kalman filter And anti-interference ability.
As shown in Figure 1, of the invention, the specific implementation steps are as follows:
(1) three-dimensional velocity being disturbed under Department of GeographyCalculation method: number is exported using the accelerometer under vibration environment According toWith attitude matrixMultiplication obtains the specific force being disturbed under Department of GeographyIt willAcceleration of gravity is carried out to compensate to obtain The acceleration information being disturbedIt utilizesThe three-dimensional speed being disturbed under Department of Geography is solved with inertial navigation speed renewal equation Degree
(2) consider that strap down inertial navigation/satellite combined guidance system state model of body vibration interference is established:
Select three dimensional velocity vectors under unmanned plane Department of GeographyAs quantity of state x.Consider that vibration is dry It disturbs, state model is represented byWherein, Respectively The rotational angular velocity that the projection for being rotational-angular velocity of the earth under Department of Geography and Department of Geography feel concerned about relative to ground is under Department of Geography Projection;It is projection of the specific force under carrier Department of Geography;gnIt is projection of the acceleration of gravity under Department of Geography;u0ForWith gn's Vector sum;D is projection of the interference that generates to integrated navigation system of body vibration under Department of Geography.Model is expressed as follows in detail Formula:
(3) it is designed for strap down inertial navigation/satellite combined guidance system vibration interference interference observer:
According to the state model established in upper step, interference volume d be may be expressed as:
Design Interference Estimation amountMeet equation:
Wherein, L is interference observer gain matrix, and the selection of L influences the estimation performance and stability of observer.It enables intermediate VariableThen have:
It is obtained in conjunction with above-mentioned formula:
In UAV system, three shaft vibration of body under Department of Geography is interfered without cross-coupling factor, therefore L takes diagonal matrix:
L=diag { L1,L2,L3}
To sum up, interference observer design is as follows:
Interference observer is expressed as a, b formula in detail.
A, the intermediate variable z differential equation:
B, disturbance-observer amountCalculating formula:
In addition, gain matrix L has certain value range for the robust stability for ensuring interference observer.By Li Yapu The provable L of promise husband's stability theoremiWhen > 0 (i=1,2,3), the error differential equation of interference observer keeps global progressive steady It is fixed.In LiMatrix L is adjusted under the constraint of > 0 (i=1,2,3), interference observer can be improved to vibration interference quickly and accurately Observation performance.
(4) interference observer output valve is utilizedFeedback interference accelerationObtain compensation post-acceleration vectorTool Body implementation method is as follows:
The three dimensional velocity vectors that will be disturbedAs the input of interference observer, shake under interference observer output Department of Geography Dynamic interference volumeDisturbing acceleration under Department of GeographyIt is expressed asWherein,It is true acceleration, d under Department of Geography For vibration interference vector under Department of Geography.It utilizesFeedback compensation disturbing accelerationObtain compensation post-acceleration vectoredFor Interference Estimation error.Gain matrix L makes interference estimateClose to very It does solid work and disturbs d, thenIt can level off to true acceleration
(5) it completes strap down inertial navigation/combinations of satellites Navigation algorithm: utilizing gyroscope output dataWith interference compensation Post-acceleration vectorIntegrated navigation system inertial reference calculation is completed, then completes strapdown using Kalman integrated navigation filtering method The combined filter process of inertial navigation and satellite.

Claims (3)

1. a kind of system filter method for the interference of small drone multi-source complex vibration, it is characterised in that including following step It is rapid:
(1) using the accelerometer output data under vibration environmentWith attitude matrixMultiplication obtains being disturbed under Department of Geography Specific forceIt willIt carries out acceleration of gravity and compensates the acceleration information being disturbedIt utilizesWith inertial navigation speed Degree renewal equation solves the three-dimensional velocity being disturbed under Department of Geography
(2) with three-dimensional velocity under Department of GeographyFor quantity of state, establishes and consider that strap down inertial navigation/combinations of satellites of body vibration interference is led System State Model of navigating designs in conjunction with the state model of foundation and is directed to strap down inertial navigation/satellite combined guidance system vibration interference Interference observer;
(3) three dimensional velocity vectors that will be disturbedAs the input of interference observer, shake under interference observer output Department of Geography Dynamic interference estimateThenDisturbing acceleration in feedback compensation step (1)Obtain compensation post-acceleration vector
(4) gyroscope output data is utilizedWith compensation post-accelerationIntegrated navigation system inertial reference calculation is completed, is then used The combined filter process of Kalman integrated navigation filtering method completion inertial navigation and satellite;
(5) it in small drone operational process, constantly repeats (1) and arrives (4), until navigation terminates;
Strap down inertial navigation/satellite combined guidance system state model of the considerations of being related in the step (2) body vibration interference It establishes as follows:
Select three dimensional velocity vectors under unmanned plane Department of GeographyAs quantity of state x, vibration interference is considered, State model is expressed asWherein, Respectively Projection of the rotational angular velocity that projection and Department of Geography of the revolutions angular speed under Department of Geography are felt concerned about relative to ground under Department of Geography;It is projection of the specific force under carrier Department of Geography;gnIt is projection of the acceleration of gravity under Department of Geography;u0ForWith gnVector With;D is projection of the interference that generates to integrated navigation system of body vibration under Department of Geography, and state model is expressed as follows formula:
The state model established is combined in the step (2), design is directed to strap down inertial navigation/satellite combined guidance system vibration interference Interference observer, specific design procedure is as follows:
According to the state model of foundation, interference volume d is indicated are as follows:
Design Interference Estimation amountMeet equation
Wherein, L is interference observer gain matrix, and the selection of L influences the estimation performance and stability of observer, enables intermediate variableThen have:
It is obtained in conjunction with above-mentioned formula:
In UAV system, three shaft vibration of body under Department of Geography is interfered without cross-coupling factor, therefore L takes diagonal matrix:
L=diag { L1,L2,L3};
To sum up, interference observer design is as follows:
Interference observer is expressed as a, b formula in detail:
A, the intermediate variable z differential equation
B, disturbance-observer amountCalculating formula
In LiL is adjusted under the constraint of > 0 (i=1,2,3), interference observer is can be improved and vibration interference is quickly and accurately observed Performance;
Interference observer output valve is utilized in the step (3)Disturbing acceleration in feedback compensation step (1)Obtain compensation Post-acceleration vectorConcrete methods of realizing it is as follows:
The three dimensional velocity vectors that will be disturbedAs the input of interference observer, interference observer is exported to vibrate under Department of Geography and be done The amount of disturbingDisturbing acceleration under Department of GeographyIt is expressed asWherein,It is true acceleration under Department of Geography, d is ground Reason is lower vibration interference vector;It utilizesFeedback compensation disturbing accelerationObtain compensation post-acceleration vectoredFor Interference Estimation error;Gain matrix L makes interference estimateClose to very It does solid work and disturbs d, thenIt can level off to true acceleration
2. a kind of system filter method for the interference of small drone multi-source complex vibration according to claim 1, It is characterized in that: the three-dimensional velocity being disturbed under the Department of Geography being related in the step (1)Calculation method are as follows: use strapdown The speed renewal equation of formula inertial navigation utilizes the acceleration transducer data of vibrated interferenceIt carries outResolving.
3. a kind of system filter method for the interference of small drone multi-source complex vibration according to claim 1, It is characterized in that: completing the combined filter of inertial navigation and satellite in the step (4) using Kalman integrated navigation filtering method Process, after low frequency component of the interference observer to vibration interference is estimated and is offset, Kalman combined filter method energy Enough inhibited again for system white Gaussian noise.
CN201610729794.4A 2016-08-25 2016-08-25 A kind of system filter method for the interference of small drone multi-source complex vibration Active CN106403938B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610729794.4A CN106403938B (en) 2016-08-25 2016-08-25 A kind of system filter method for the interference of small drone multi-source complex vibration

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610729794.4A CN106403938B (en) 2016-08-25 2016-08-25 A kind of system filter method for the interference of small drone multi-source complex vibration

Publications (2)

Publication Number Publication Date
CN106403938A CN106403938A (en) 2017-02-15
CN106403938B true CN106403938B (en) 2019-04-09

Family

ID=58004892

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610729794.4A Active CN106403938B (en) 2016-08-25 2016-08-25 A kind of system filter method for the interference of small drone multi-source complex vibration

Country Status (1)

Country Link
CN (1) CN106403938B (en)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107014386B (en) * 2017-06-02 2019-08-30 武汉云衡智能科技有限公司 A kind of disturbing acceleration measurement method that attitude of flight vehicle resolves
CN111142549B (en) * 2019-12-30 2021-03-02 北京航空航天大学 Anti-interference attack detection and self-healing controller and control method for unmanned aerial vehicle attitude control system
CN112461235B (en) * 2020-11-20 2023-06-30 北京航空航天大学 Anti-interference integrated navigation method based on interference observer
CN113618743B (en) * 2021-08-27 2022-08-23 北京航空航天大学杭州创新研究院 Unmanned aerial vehicle mechanical arm tail end pose control method for multi-source interference
CN114326399B (en) * 2021-12-28 2023-12-05 天津大学 Broadband inertia reference unit finite time anti-interference control method

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103323005A (en) * 2013-03-06 2013-09-25 郭雷 Multi-objective optimization anti-interference filtering method for SINS/GPS/polarized light combined navigation system
CN103414451A (en) * 2013-07-22 2013-11-27 北京理工大学 Extension Kalman filtering method applied to flight vehicle attitude estimation
CN103968843A (en) * 2014-05-21 2014-08-06 哈尔滨工程大学 Self-adaption mixed filtering method of GPS/SINS (Global Positioning System/Strapdown Inertial Navigation System) super-compact integrated navigation system
CN104613984A (en) * 2015-02-06 2015-05-13 东南大学 Robust filtering method of near space aerocraft transfer alignment model uncertainty

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103323005A (en) * 2013-03-06 2013-09-25 郭雷 Multi-objective optimization anti-interference filtering method for SINS/GPS/polarized light combined navigation system
CN103414451A (en) * 2013-07-22 2013-11-27 北京理工大学 Extension Kalman filtering method applied to flight vehicle attitude estimation
CN103968843A (en) * 2014-05-21 2014-08-06 哈尔滨工程大学 Self-adaption mixed filtering method of GPS/SINS (Global Positioning System/Strapdown Inertial Navigation System) super-compact integrated navigation system
CN104613984A (en) * 2015-02-06 2015-05-13 东南大学 Robust filtering method of near space aerocraft transfer alignment model uncertainty

Also Published As

Publication number Publication date
CN106403938A (en) 2017-02-15

Similar Documents

Publication Publication Date Title
CN106403938B (en) A kind of system filter method for the interference of small drone multi-source complex vibration
CN106597017B (en) A kind of unmanned plane Angular Acceleration Estimation and device based on Extended Kalman filter
Lai et al. Attitude estimation based on fusion of gyroscopes and single antenna GPS for small UAVs under the influence of vibration
CN104374388B (en) Flight attitude determining method based on polarized light sensor
Wang et al. Estimation of information sharing error by dynamic deformation between inertial navigation systems
Crocoll et al. Model‐aided navigation for a quadrotor helicopter: A novel navigation system and first experimental results
CN106643737A (en) Four-rotor aircraft attitude calculation method in wind power interference environments
Wang et al. High-order nonlinear differentiator and application to aircraft control
Allibert et al. Estimating body-fixed frame velocity and attitude from inertial measurements for a quadrotor vehicle
Błachuta et al. Data fusion algorithm for the altitude and vertical speed estimation of the VTOL platform
CN110017837A (en) A kind of Combinated navigation method of the diamagnetic interference of posture
CN105806363A (en) Alignment method of an underwater large misalignment angle based on SINS (Strapdown Inertial Navigation System)/DVL (Doppler Velocity Log) of SRQKF (Square-root Quadrature Kalman Filter)
Karmozdi et al. Implementation of translational motion dynamics for INS data fusion in DVL outage in underwater navigation
CN113916226B (en) Minimum variance-based interference rejection filtering method for integrated navigation system
Ascorti An application of the extended Kalman filter to the attitude control of a quadrotor
Hansen et al. Nonlinear observer for INS aided by time-delayed GNSS measurements: Implementation and UAV experiments
CN112327883B (en) Under-actuated surface vessel path tracking control method based on extended state observer
CN104344835B (en) A kind of inertial navigation moving alignment method based on suitching type Self Adaptive Control compass
CN103616026B (en) A kind of AUV control model based on H ∞ filtering is assisted inertial navigation Combinated navigation method
Condomines Nonlinear Kalman Filter for Multi-Sensor Navigation of Unmanned Aerial Vehicles: Application to Guidance and Navigation of Unmanned Aerial Vehicles Flying in a Complex Environment
Ireland et al. Development of navigation algorithms for NAP-of-the-earth UAV flight in a constrained urban environment
Emran et al. A cascaded approach for quadrotor's attitude estimation
RU2487318C1 (en) Platform-free inertial attitude and heading reference system based on sensitive elements of medium accuracy
Crocoll et al. Quadrotor inertial navigation aided by a vehicle dynamics model with in-flight parameter estimation
CN103630134A (en) Mooring alignment method based on two-dimensional hidden markov model/Kalman filtering (2D-HMM/KF) pre-filter

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant