CN202974288U - Miniature strapdown navigation attitude system - Google Patents

Abstract

The utility model is a miniature strapdown navigation attitude system. The system comprises a data acquisition module, a data processing and resolving module and a peripheral communication interface module, wherein a micro-electromechanical system sensor integrates a three-axis gyroscope, a three-axis accelerometer, a three-axis magnetoresistive sensor and an SPI (Single Program Initiation) interface is used as the data acquisition module; a 32-bit ARM (Asynchronous Response Mode) microcontroller is used as the data processing and resolving module; and the peripheral communication interface module comprises a serial port level converter chip, an RS-232 interface, a CAN (Controlled Area Network) transceiver and a CAN interface. The system has the following work steps of: initialization by powering the system, system self-test, magnetic field self-calibration, initial alignment, attitude determination in a combined state, namely resolving information of different navigation attitudes according to a solution algorithm of an initial three-dimensional attitude angle and attitudes of the strapdown navigation attitude system, simultaneously, resolving a three-dimensional magnetic attitude angle by using compensated magnetic field information and acceleration information, and carrying out a fusion algorithm on the compensated magnetic field information and the acceleration information, thus finally obtaining the stable navigation attitude information; and sending of the navigation attitude information to an application device.

Description

A kind of miniature Strapdown Attitude Heading Reference System

One, technical field

The utility model belongs to inertial technology field, particularly a kind of miniature Strapdown Attitude Heading Reference System.

Two, background technology

All need to measure with boat appearance system the attitude information of carrier in the fields such as attitude control of the navigation of spacecraft, guided missile, vehicle and satellite, robot, platform.Development is Strapdown Attitude Heading Reference System comparatively rapidly at present, and Strapdown Attitude Heading Reference System refers to directly inertial measurement cluster (gyroscope and accelerometer etc.) be connected firmly the system of resolving attitude of carrier information on carrier with mathematical platform.Strapdown Attitude Heading Reference System relies on algorithm to set up navigation coordinate, and namely platform coordinate system exists with the mathematical platform form, has omitted so complicated physical entity platform, therefore uses more and more extensive.But existing Strapdown Attitude Heading Reference System underintegration is high, volume is bigger than normal, the inertial measurement cluster cost that uses is too high, consider how to utilize the earth in the absence that outer signals (as GPS etc.) lost efficacy around intrinsic magnetic field compensate the problem that boat appearance precision makes its long-time steady operation, and disguise is not strong, therefore designs a kind of volume little, and integrated level is high, performance is good, and cost hangs down the trend that becomes boat appearance System Development with adaptable Strapdown Attitude Heading Reference System.

Document 1: Chinese utility model patent " boat appearance combination metering device " (publication number CN 201402140Y, open day on 02 10th, 2010) disclose that a kind of reliability is high, lower-cost boat appearance combination metering device, process and resolve module, inertial sensor combination and magnetic sensor by signal and form, sensor assembly wherein is comprised of inertial sensor combination and two independent sectors of magnetic sensor, and integrated level is not high; And this device peripheral communications interface only has RS422, and efficient is lower, and data transmission is stable not.

Document 2: Chinese invention patent " a kind of victory based on optical fibre gyro connect navigate appearance system " (publication number CN 102135430A, open on 07 27th, 2011 day) the high Miniature AHRS of a kind of integrated level is disclosed, the sensor assembly of this system is comprised of gyroscope and digital double-shaft tilt angle instrument, in the process of resolving boat appearance information, resolving algorithm is integral operation, various errors also can be passed through integral operation, cause the data solver error constantly accumulation in time of system, and constantly shake and disperse, boat appearance precision of information is more and more lower; The gyroscope of its inertia measurement sensor is expensive fibre optic gyroscope, makes boat appearance system cost higher; This device peripheral communications interface only has the CAN bus, and is abundant not, uses limited.

Three, utility model content

The purpose of this utility model is to provide that a kind of volume is little, and integrated level is high, and performance is good, the low and adaptable miniature Strapdown Attitude Heading Reference System of cost.

The technical solution that realizes the utility model purpose is: a kind of miniature Strapdown Attitude Heading Reference System, comprise that data acquisition module, data are processed to resolve module and peripheral communications interface module, wherein:

Data acquisition module adopts three-axis gyroscope, three axis accelerometer, three axle magnetoresistive transducers and the integrated microelectromechanical systems sensor of 1SPI Interface integration, and wherein three-axis gyroscope, three axis accelerometer, three axle magnetoresistive transducers work alone respectively; Data are processed and to be resolved module and adopt 32 ARM microcontrollers, and data that this microcontroller is integrated are processed and resolved unit, CAN controller, UART interface and 2SPI interface; The peripheral communications interface module comprises serial ports level transferring chip, RS_232 interface, CAN transceiver and CAN interface;

Three-axis gyroscope, three axis accelerometer, three axle magnetoresistive transducers are connected with the 2SPI interface by the 1SPI interface respectively; The 2SPI interface resolves the unit with the data processing and is connected; The data processing is resolved the unit and is connected with the serial ports level transferring chip by the UART interface, and the data processing is resolved the unit and also is connected with the CAN transceiver of peripheral communications interface module by the CAN controller; The serial ports level transferring chip is connected with the RS_232 interface, and the CAN transceiver of peripheral communications interface module is connected with the CAN interface;

Be connected by spi bus between 1SPI interface and 2SPI interface, the three-axis gyroscope of data acquisition module, three axis accelerometer, three axle magnetoresistive transducers are processed by spi bus and data respectively and are resolved module communication; Data are processed the three axis angular rate information of module by spi bus reading out data acquisition module of resolving, 3-axis acceleration information and three-axle magnetic field strength information on every side, and be transferred to data and process and to resolve the unit, the boat appearance information exchange that resolves crosses the UART interface or the CAN controller sends to the peripheral communications interface module; The Transistor-Transistor Logic level data that the serial ports level transferring chip of peripheral communications interface module is sent the UART interface are converted to the RS_232 level data, and issue peripheral hardware by the RS_232 interface; The Transistor-Transistor Logic level data that the CAN transceiver of peripheral communications interface module is sent the CAN controller are converted to the differential level data of physical bus, then are transferred to equipment on the CAN bus by the CAN interface.

The utility model compared with prior art, its remarkable advantage is:

1, data acquisition module adopts MEMS (microelectromechanical systems) sensor cheaply, this sensor utilizes MEMS technology and microelectric technique fundamentally to change design philosophy and the manufacture method of traditional IMU system, realized that micromechanical gyro, micro-mechanical accelerometer and magnetometer in the MIMU (Micro Inertial Measurement Unit) system obtain the integrated of measuring-signal, treatment circuit, not only cost is low, integrated level is high, and externally output interface is the SPI mouth, process with data and resolve the module physical connection conveniently, data transmission is efficient, stable.

2, data are processed and are resolved 32 ARM microcontrollers of module employing, aboundresources in sheet, can storage program and ephemeral data when concrete the application, also can realize system extension, and integrated two-way CAN controller can be realized the CAN communication interface by the CAN transceiver, resolving the abundant boat appearance communication that the obtains equipment on other CAN buses, realize stablizing, efficiently data transmission.

3, the peripheral communications interface module is comprised of RS_232 serial ports and CAN communication interface: the RS_232 serial ports can not only be issued peripheral hardware (as computer) to the boat appearance information that processor resolves and monitor, but also can expanding external GPS etc. equipment, realize the more information fusion of the degree of depth; The CAN interface is used for resolving the abundant boat appearance communication that the obtains equipment on other CAN buses, realize stable, data transmission efficiently.

4, not only used pure inertia assembly to resolve boat appearance information, but also calculate the Three-Dimensional Magnetic attitude angle with the information that three axis accelerometer and magnetoresistive transducer obtain, both are through information fusion algorithm, and the boat appearance information of final stable output makes the long-time steady operation of boat appearance system.Each function modoularization, integrated, and externally without any electromagnetic radiation, good concealment is difficult for exposing self target, and adaptive capacity to environment is strong.

Four description of drawings

Fig. 1 is miniature Strapdown Attitude Heading Reference System hardware module block diagram of the present utility model.

Fig. 2 is the workflow diagram of miniature Strapdown Attitude Heading Reference System of the present utility model.

Fig. 3 is the Kalman filtering information fusion algorithm process flow diagram of miniature Strapdown Attitude Heading Reference System of the present utility model.

Five embodiments

Below in conjunction with accompanying drawing, describe embodiment of the present utility model in detail.

In conjunction with Fig. 1, miniature Strapdown Attitude Heading Reference System of the present utility model, data acquisition module adopts three-axis gyroscope, three axis accelerometer, three axle magnetoresistive transducers and the integrated microelectromechanical systems sensor of 1SPI Interface integration, and wherein three-axis gyroscope, three axis accelerometer, three axle magnetoresistive transducers work alone respectively; Data are processed and to be resolved module and adopt 32 ARM microcontrollers, and data that this microcontroller is integrated are processed and resolved unit, CAN controller, UART interface and 2SPI interface; The peripheral communications interface module comprises serial ports level transferring chip, RS_232 interface, CAN transceiver and CAN interface;

Three-axis gyroscope, three axis accelerometer, three axle magnetoresistive transducers are connected with the 2SPI interface by the 1SPI interface respectively; The 2SPI interface resolves the unit with the data processing and is connected; The data processing is resolved the unit and is connected with the serial ports level transferring chip by the UART interface, and the data processing is resolved the unit and also is connected with the CAN transceiver of peripheral communications interface module by the CAN controller; The serial ports level transferring chip is connected with the RS_232 interface, and the CAN transceiver of peripheral communications interface module is connected with the CAN interface;

Be connected by spi bus between 1SPI interface and 2SPI interface, the three-axis gyroscope of data acquisition module, three axis accelerometer, three axle magnetoresistive transducers are processed by spi bus and data respectively and are resolved module communication; Data are processed the three axis angular rate information of module by spi bus reading out data acquisition module of resolving, 3-axis acceleration information and three-axle magnetic field strength information on every side, and be transferred to data and process and to resolve the unit, the boat appearance information exchange that resolves crosses the UART interface or the CAN controller sends to the peripheral communications interface module; The Transistor-Transistor Logic level data that the serial ports level transferring chip of peripheral communications interface module is sent the UART interface are converted to the RS_232 level data, and issue peripheral hardware by the RS_232 interface; The Transistor-Transistor Logic level data that the CAN transceiver of peripheral communications interface module is sent the CAN controller are converted to the differential level data of physical bus, then are transferred to equipment on the CAN bus by the CAN interface.

Miniature Strapdown Attitude Heading Reference System of the present utility model, described microelectromechanical systems sensor adopts ADIS16405, it is 32 8-digit microcontroller LPC2xxx series of core that described microcontroller adopts ARM7, the equipment such as all right expanding external GPS of described RS_232 serial ports.

ADIS16405 inertial sensor product is a complete Inertial Sensor System of cover, comprises three-axis gyroscope, three axis accelerometer and three axle magnetoresistive transducers, and the inertial MEMS technology that industry is leading combines with signal condition, and dynamic property reaches optimization.Calibration before product export has characterized sensitivity, deviation, calibration value, linear acceleration and the gyroscopic drift of each sensor.Therefore, each sensor has its dynamic compensation calibration program, thereby accurate measurement value sensor can be provided at normal temperatures.Magnetoresistive transducer uses self-correcting function to make the deviation of measured value and actual value drop to minimum.

This sensor bulk is only 23mm*23mm*23mm, the angular rate measurement scope of three axles be ± 75 °/s, ± 150 °/s, ± 300 °/(can set), resolution is 14; The acceleration analysis scope of three axles is ± 10g that resolution is 14.Externally output interface is the SPI mouth, and is convenient with the LPC2119 physical connection.During use, only need to its power supply, it will outwards export data with certain frequency.Have that volume is little, lightweight, the life-span is long, reliability is high, cost is low and the advantage such as accommodative ability of environment is strong.

It is that the ARM7 of PHILIPS Co. is 32 8-digit microcontroller LPC2119 of core that data are processed what resolve that module adopts.Resource is abundanter in the LPC2119 sheet, and in sheet, ROM is up to 128K, and ram space has 16K, can storage program and ephemeral data when concrete the application, also can realize system extension.And Flash supports to recognize the IAP function in the sheet of LPC2119, can be used for storing data.LPC2119 is integrated two-way CAN controller, two-way UART and two-way SPI satisfies interface requirement.

Microcontroller LPC2119 in real time by acceleration, angular velocity and the magnetic field intensity information of spi bus reading out data acquisition module, is stored in certain memory headroom with certain frequency, then carries out three-dimension altitude angle and resolves.Due to the intrinsic deficiency of pure inertia assembly resolved data, generally by the external GPS equipment of RS_232 interface, receive GPS information with fixed frequency, boat appearance information is compensated, make the long-time steady operation of boat appearance system.But in the situation that GPS information complete failure, boat appearance system is steady operation for a long time, in order to address this problem, this miniature Strapdown Attitude Heading Reference System has not only used pure inertia assembly to resolve boat appearance information, but also the geomagnetic field information of measuring with three axis accelerometer and magnetoresistive transducer calculates the Three-Dimensional Magnetic attitude angle, both are through information fusion algorithm, and the boat appearance information of final stable output makes the long-time steady operation of boat appearance system.

In practical service environment, due to the impact of ferromagnetic material on every side, inevitably the be interfered impact in magnetic field of terrestrial magnetic field.In this case, the measurement of terrestrial magnetic field can bring certain error, and the magnetic heading angle that calculates also has deviation.For the appearance system of guaranteeing to navigate exports accurate course angle, need compensate magnetic interference.Existing magnetic heading error compensation technique is divided into two classes: a class is the scaling method by means of extraneous factor, as rely on high precision turntable or standard hexahedron to carry out multi-point calibration, although this class methods precision is higher, complicated operation is to most of actual use occasions and inapplicable; Another kind of is that these class methods are easy to operate not by the self-calibrating method of extraneous factor, and operand is little, and compensation effect is remarkable.The utility model adopts self-calibrating method, can use the least square Surface Fitting of oval penalty method, least square curve fitting method or rectangular domain according to concrete occasion, is proven effect remarkable.

The peripheral communications interface module is comprised of RS_232 serial ports and CAN communication interface: LPC2119 carries UART, by the serial ports level transferring chip, Transistor-Transistor Logic level is converted to the RS_232 level, this interface can not only be issued peripheral hardware (as PC) show navigator data to the boat appearance information that processor resolves, but also can the external GPS information of Function Extension, thereby can obtain the velocity location information of carrier and the magnetic declination of current location, and then realize the more information fusion of the degree of depth; LPC2119 is integrated CAN controller, by the CAN transceiver, the Transistor-Transistor Logic level of CAN controller transmitting-receiving pin is converted to the differential level of physical bus, realize the CAN communication interface, resolving the abundant boat appearance communication that obtains equipment such as the image control plate etc. on other CAN buses, realize stablizing, efficiently data transmission.

In conjunction with Fig. 2: miniature Strapdown Attitude Heading Reference System specific works of the present utility model is as follows:

Use the method for described miniature Strapdown Attitude Heading Reference System measurement boat appearance as follows:

1) the boat appearance system rear completion system initial work that powers on, and carry out System self-test by image data, send data, checks that boat appearance system has or not extremely;

2) magnetic field is from demarcating: there is no the environment of magnetic interference, the appearance of navigating system slowly evenly rotates a week at surface level, the data processing is resolved the unit and is passed through spi bus, reading earth magnetic field intensity from three axle magnetoresistive transducers is component on three axles at carrier, compensate from standardization by ellipse, calibrate the field compensation coefficient: carrier is the demarcation factor Xsf of X-axis, the demarcation factor Ysf of Y-axis, and magnetic field intensity is the drift value Xoff on X-axis, the drift value Yoff on Y-axis at carrier;

3) initial alignment state: the field compensation coefficient that calibrates with previous step obtains the real Magnetic Field of carrier, use this Magnetic Field and 3-axis acceleration evaluation to obtain boat appearance system three-dimension altitude angle under static state, calculate simultaneously the drift of gyro, comprise the following steps:

(31) data are processed the data resolve in module and are processed and resolve the unit by spi bus, and reading in real time earth magnetic field intensity from three axle magnetoresistive transducers of data acquisition module is component on three axles at carrier, and they are compensated:

$B_b^{\mathrm{hx}}=B_b^x*\mathrm{Xsf}+\mathrm{Xoff}$

$B_b^{\mathrm{hy}}=B_b^y*\mathrm{Ysf}+\mathrm{Yoff}$

$B_b^{\mathrm{hz}}=B_b^z$

For magnetic field intensity is component on three axles at carrier,

For magnetic field intensity is the component after compensation on three axles at carrier;

(32) data are processed and to be resolved the unit by spi bus, and reading in real time the carrier accekeration from three axis accelerometer is component on three axles at carrier

Obtain the angle of pitch and the roll angle of carrier in conjunction with gravity acceleration g:

${\mathrm{\θ}}_0=\arcsin (-\frac{f_b^x}{g}),$ ${\mathrm{\γ}}_0=\arctan \left(\frac{f_b^y}{f_b^z}\right)$

θ wherein ₀Be the angle of pitch of carrier, γ ₀Roll angle for carrier;

(33) according to the pitching angle theta of carrier ₀, roll angle γ ₀With the magnetic field intensity after compensation can be in the hope of the expression formula of magnetic field levels component:

$B_b^X=B_b^{\mathrm{hx}}\cos {\mathrm{\θ}}_0+B_b^{\mathrm{hz}}\sin {\mathrm{\θ}}_0$

$B_b^Y=B_b^{\mathrm{hx}}\sin {\mathrm{\γ}}_0\sin {\mathrm{\θ}}_0+B_b^{\mathrm{hy}}\cos {\mathrm{\γ}}_0-B_b^{\mathrm{hz}}\sin {\mathrm{\γ}}_0\cos {\mathrm{\θ}}_0$

Wherein Be the component of magnetic field intensity in the surface level X-axis,

Be the component of magnetic field intensity in the surface level Y-axis;

Magnetic heading angle ψ _MFor:

${\mathrm{\ψ}}_M=\arctan \left(\frac{B_b^Y}{B_b^X}\right)$

(34) magnetic north to and geographic north between angle just be referred to as declination D, this is worth for just magnetic north when the north geographic pole east side, this is worth for negative magnetic north when the north geographic pole west side, thereby obtains true heading angle ψ ₀, course angle ψ ₀Expression formula be:

ψ ₀＝ψ _M+D

(35) calculate the drift of gyro: in stationary state, data are processed and to be resolved the unit by spi bus, and reading in real time the carrier magnitude of angular velocity from three-axis gyroscope is component on three axles at carrier Read 100～200 times and average, obtaining three-axis gyroscope is drift ε on three axles at carrier _x, ε _y, ε _z, the drift of three-axis gyroscope is designated as ε=[ε _xε _yε _z] ^T

4) enter combination and survey the appearance state, combination is surveyed appearance and is comprised the following steps:

(41) according to the pitching angle theta of initial alignment state ₀, roll angle γ ₀, course angle ψ ₀, carry out hypercomplex number and be converted to initial hypercomplex number [q ₀₀q ₀₁q ₀₂q ₀₃] ^T

(42) surveying the appearance state in combination, is component on three axles to the magnitude of angular velocity of three-axis gyroscope output at carrier

Compensate: ${\mathrm{\ω}}_{\mathrm{ib}}^{\mathrm{hx}}={\mathrm{\ω}}_{\mathrm{ib}}^{\mathrm{bx}}-{\mathrm{\ϵ}}_x,$ ${\mathrm{\ω}}_{\mathrm{ib}}^{\mathrm{hy}}={\mathrm{\ω}}_{\mathrm{ib}}^{\mathrm{by}}-{\mathrm{\ϵ}}_y,$ ${\mathrm{\ω}}_{\mathrm{ib}}^{\mathrm{hz}}={\mathrm{\ω}}_{\mathrm{ib}}^{\mathrm{bz}}-{\mathrm{\ϵ}}_z,$ According to initial hypercomplex number [q ₀₀q ₀₁q ₀₂q ₀₃] ^TWith

Find the solution quaternion differential equation with quadravalence-runge kutta method, the hypercomplex number [q after being upgraded _b0q _b1q _b2q _b3] ^T, be converted to pitching angle theta _b, roll angle γ _b, course angle ψ _b, be combination and survey the boat appearance information that appearance obtains, should navigating, the appearance information exchange is crossed the UART interface or the CAN controller sends to the peripheral communications interface module;

(43) data are processed and to be resolved the unit and pass through spi bus, reading in real time earth magnetic field intensity from three axle magnetoresistive transducers of data acquisition module is component on three axles at carrier, reading in real time the carrier accekeration from three axis accelerometer is component on three axles at carrier, tries to achieve pitching angle theta according to the method for step (31)～step (34) _a, roll angle γ _a, course angle ψ _a, be converted to hypercomplex number [q _a0q _a1q _a2q _a3] ^T

(44) Kalman filtering and information fusion are specific as follows:

Native system adopts the additive quaternion method error model under large misalignment angle, and attitude error equations is as follows:

$\mathrm{\&delta;}\stackrel{\&CenterDot;}{Q}=\frac{1}{2}<{\mathrm{\&omega;}}_{\mathrm{ib}}^b>\mathrm{\&delta;Q}+\frac{1}{2}U\left(\widehat{Q_b^n}\right)\mathrm{\&delta;}{\mathrm{\&omega;}}_{\mathrm{ib}}^b$

In formula, δ Q is the hypercomplex number error,

Be gyro error,

$<{\mathrm{\&omega;}}_{\mathrm{ib}}^b>=\left[\begin{array}{cccc}0& {-\mathrm{\&omega;}}_{\mathrm{ib}}^{\mathrm{hx}}& {-\mathrm{\&omega;}}_{\mathrm{ib}}^{\mathrm{hy}}& {-\mathrm{\&omega;}}_{\mathrm{ib}}^{\mathrm{hz}}\\ {\mathrm{\&omega;}}_{\mathrm{ib}}^{\mathrm{hx}}& 0& {\mathrm{\&omega;}}_{\mathrm{ib}}^{\mathrm{hz}}& {-\mathrm{\&omega;}}_{\mathrm{ib}}^{\mathrm{hy}}\\ {\mathrm{\&omega;}}_{\mathrm{ib}}^{\mathrm{hy}}& {-\mathrm{\&omega;}}_{\mathrm{ib}}^{\mathrm{hz}}& 0& {\mathrm{\&omega;}}_{\mathrm{ib}}^{\mathrm{hx}}\\ {\mathrm{\&omega;}}_{\mathrm{ib}}^{\mathrm{hz}}& {\mathrm{\&omega;}}_{\mathrm{ib}}^{\mathrm{hy}}& {-\mathrm{\&omega;}}_{\mathrm{ib}}^{\mathrm{hx}}& 0\end{array}\right],$ $U\left(\widehat{Q_b^n}\right)=\left[\begin{array}{ccc}-q_{b1}& -q_{b2}& -q_{b3}\\ q_{b0}& -q_{b3}& q_{b2}\\ q_{b3}& q_{b0}& -q_{b1}\\ -q_{b2}& q_{b1}& q_{b0}\end{array}\right];$

Reference card Kalman Filtering formula, state equation is:

Measurement equation is: Z=HX+V

Wherein, state variable X is X=[δ q ₀δ q ₁δ q ₂δ q ₃ε _xε _yε _z] ^T=[δ Q ε] ^T, namely X comprises δ Q hypercomplex number variable part and ε three-axis gyroscope drift variable part, W is the system incentive white noise; V is for measuring white noise;

$H=\left[\begin{array}{ccccccc}1& 0& 0& 0& 0& 0& 0\\ 0& 1& 0& 0& 0& 0& 0\\ 0& 0& 1& 0& 0& 0& 0\\ 0& 0& 0& 1& 0& 0& 0\end{array}\right];$

State equation and the measurement equation discretize of system are expressed as:

X _k＝Φ _k，k-1X _k-1+Γ _k-1W _k-1

Z _k＝H _kX _k+V _k

Wherein, X _kExpression is by estimated state, Φ _{K, k-1}Be t _k-1Matrix of shifting of a step constantly, Γ _k-1For system noise drives battle array, W _kBe system incentive noise sequence, Z _kBe measurement matrix, H _kFor measuring battle array, V _kBe the measurement noise sequence.Specific as follows according to the Kalman Algorithm of the Kalman filter fundamental equation that is applicable to discrete system:

1. state one-step prediction equation:

X _k/k-1＝φ _k，k-1X _k-1

2. one-step prediction square error equation:

$P_{k/k-1}={\mathrm{\&phi;}}_{k,k-1}{P}_{k-1}{\mathrm{\&phi;}}_{k,k-1}^T+{\mathrm{\&Gamma;}}_{k-1}{Q}_{k-1}{\mathrm{\&Gamma;}}_{k-1}^T$

3. optimal filtering gain equation:

$K_k=P_{k|k-1}{H}_k^T{[H_k{P}_{k|k-1}{H}_k^T+R_k]}^{-1}$

4. state estimation equation:

X _k＝X _k/k-1+K _k(Z _k-H _kX _k/k-1)

5. estimate the square error equation:

$P_k=(I-K_k{H}_k)P_{k/k-1}{(I-K_k{H}_k)}^T+K_k{R}_k{K}_{k-1}^T$

Wherein, Q _kThe systematic procedure noise variance matrix, K _kBe filter gain coefficient, R _kThe systematic observation noise variance matrix, P _kBe the square error battle array.

Through Kalman filtering, with the drift ε of three-axis gyroscope in the three-axis gyroscope drift variable part step of updating (42) of the state variable X after upgrading=[ε _xε _yε _z] ^T

Hypercomplex number [the q that the hypercomplex number variable partial-compensation of state variable X after upgrading is calculated to the middle three-axis gyroscope of step (42) _b0q _b1q _b2q _b3] ^T, with [the q after compensation _b0q _b1q _b2q _b3] ^TAs initial hypercomplex number new in step (42);

Repeating step (42)～step (44) realizes the information fusion of boat appearance system.

Claims (4)

1. a miniature Strapdown Attitude Heading Reference System, is characterized in that, comprise that data acquisition module, data are processed to resolve module and peripheral communications interface module, wherein:

Data acquisition module adopts three-axis gyroscope, three axis accelerometer, three axle magnetoresistive transducers and the integrated microelectromechanical systems sensor of 1SPI Interface integration, and wherein three-axis gyroscope, three axis accelerometer, three axle magnetoresistive transducers work alone respectively; Data are processed and to be resolved module and adopt 32 ARM microcontrollers, and data that this microcontroller is integrated are processed and resolved unit, CAN controller, UART interface and 2SPI interface; The peripheral communications interface module comprises serial ports level transferring chip, RS_232 interface, CAN transceiver and CAN interface;

Three-axis gyroscope, three axis accelerometer, three axle magnetoresistive transducers are connected with the 2SPI interface by the 1SPI interface respectively; The 2SPI interface resolves the unit with the data processing and is connected; The data processing is resolved the unit and is connected with the serial ports level transferring chip by the UART interface, and the data processing is resolved the unit and also is connected with the CAN transceiver of peripheral communications interface module by the CAN controller; The serial ports level transferring chip is connected with the RS_232 interface, and the CAN transceiver of peripheral communications interface module is connected with the CAN interface.

2. miniature Strapdown Attitude Heading Reference System according to claim 1, is characterized in that described microelectromechanical systems sensor adopts ADIS16405.

3. miniature Strapdown Attitude Heading Reference System according to claim 1, is characterized in that it is 32 8-digit microcontroller LPC2xxx series of core that described microcontroller adopts ARM7.

4. miniature Strapdown Attitude Heading Reference System according to claim 1, is characterized in that the equipment such as all right expanding external GPS of described RS_232 serial ports.

Images