Method for improving star sensor-gyro federated filtering

A technology of joint filtering and star sensor, applied in the direction of integrated navigator, etc., can solve the problem of re-convergence of quaternion estimated value, and achieve rigorous and reliable judgment method, low requirements, low probability of misjudgment and missed judgment Effect

Active Publication Date: 2017-10-03
SHANGHAI AEROSPACE CONTROL TECH INST
View PDF3 Cites 12 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0004] The purpose of the present invention is to provide an improved method for the combined filtering of star sensors and gyroscopes to solve the problem that the quaternion estimated value needs to re-converge when the quaternion measured value of the existing extended Kalman filter algorithm jumps

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
  • Method for improving star sensor-gyro federated filtering
  • Method for improving star sensor-gyro federated filtering
  • Method for improving star sensor-gyro federated filtering

Examples

Experimental program
Comparison scheme
Effect test

Embodiment Construction

[0041] The technical solutions of the present invention will be further described below in conjunction with the examples.

[0042] 1. Construct an extended Kalman filter

[0043] The projection ω of the three-axis angular velocity of the satellite body coordinate system relative to the inertial coordinate system in the satellite body coordinate system calculated according to the gyro measurement value s Can be expressed as follows:

[0044] ω s =ω+b+v g

[0045] In the above formula, b, v g are the constant drift and white noise of the gyro, respectively, and ω is the real three-axis angular velocity.

[0046] Calculate the measurement quaternion q of the inertial coordinate system relative to the satellite body coordinate system according to the measurement value of the star sensor s , which is the quaternion measurement of the extended Kalman filter algorithm. the q s with ω s are the two input quantities of the extended Kalman filter.

[0047] Estimation of attitu...

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 discloses a method for improving star sensor-gyro federated filtering. The method comprises the following steps: step 1, constructing an extended Kalman filter and implementing an extended Kalman filtering algorithm; step 2, determining the jumping time of a measured quaternion value q<s>, i.e., an input of the xtended Kalman filtering algorithm, wherein the scalar part of the measured quaternion value is smaller than a threshold, and the current beat and the previous beat of a vector part with a greatest absolute value in the measured quaternion value have opposite signs; step 3, resetting a reference quaternion value q<^><R> at the jumping time so as to obtain a reference quaternion value fitting with the measured quaternion value at the jumping time; and step 4, continuing implementation of the extended Kalman filtering algorithm by using the reset q<^><R>. According to the invention, the reference quaternion value at the jumping time is reset so as to overcome the problem that an estimated quaternion value needs convergence anew caused by jumping of the measured quaternion value, so stable continuous high-precision attitude information is provided for an attitude determination system; and the method is simple in the algorithm, can be easily implemented by spaceborne software and has high reliability.

Description

technical field [0001] The present invention relates to an improved method of extended Kalman filtering for star sensors and gyroscopes, specifically a method for resetting the quaternion reference value when the quaternion measurement value of the filtering algorithm jumps, which belongs to satellite attitude Identify technical areas. Background technique [0002] Both the star sensor and the gyroscope are the most important sensor stand-alone in the satellite attitude control system. The measurement value of the star sensor is the quaternion of the star sensor measurement coordinate system relative to the inertial coordinate system, and the quaternion of the satellite body coordinate system relative to the inertial coordinate system can be obtained from the star sensor installation matrix; the measurement value of the gyro is The projection of the angular velocity of the gyro measurement coordinate system relative to the inertial coordinate system in the gyro measurement ...

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
Patent Type & Authority Applications(China)
IPC IPC(8): G01C21/24
CPCG01C21/24
Inventor 杨真李利亮刘川郑梦兴张艳召
Owner SHANGHAI AEROSPACE CONTROL TECH 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