CN101788296B  SINS/CNS deep integrated navigation system and realization method thereof  Google Patents
SINS/CNS deep integrated navigation system and realization method thereof Download PDFInfo
 Publication number
 CN101788296B CN101788296B CN2010101014291A CN201010101429A CN101788296B CN 101788296 B CN101788296 B CN 101788296B CN 2010101014291 A CN2010101014291 A CN 2010101014291A CN 201010101429 A CN201010101429 A CN 201010101429A CN 101788296 B CN101788296 B CN 101788296B
 Authority
 CN
 China
 Prior art keywords
 navigation
 sins
 inertial
 information
 error
 Prior art date
Links
 239000011159 matrix material Substances 0.000 claims abstract description 80
 241000287181 Sturnus vulgaris Species 0.000 claims description 103
 239000000969 carriers Substances 0.000 claims description 80
 238000004364 calculation methods Methods 0.000 claims description 55
 280000392959 Starlight companies 0.000 claims description 26
 230000000007 visual effect Effects 0.000 claims description 25
 280000867207 Lambda companies 0.000 claims description 16
 230000005540 biological transmission Effects 0.000 claims description 10
 238000000034 methods Methods 0.000 claims description 8
 230000000875 corresponding Effects 0.000 claims description 7
 230000004927 fusion Effects 0.000 claims description 5
 238000009434 installation Methods 0.000 claims description 4
 238000001914 filtration Methods 0.000 claims description 3
 230000000295 complement Effects 0.000 claims description 2
 239000010950 nickel Substances 0.000 claims description 2
 230000001915 proofreading Effects 0.000 claims description 2
 230000036544 posture Effects 0.000 abstract 3
 238000005259 measurement Methods 0.000 abstract 2
 239000000203 mixtures Substances 0.000 description 9
 239000000306 components Substances 0.000 description 3
 238000010586 diagrams Methods 0.000 description 3
 FUSGACRLAFQQRLUHFFFAOYSAN NEthylNnitrosourea Chemical compound data:image/svg+xml;base64,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 data:image/svg+xml;base64,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 CCN(N=O)C(N)=O FUSGACRLAFQQRLUHFFFAOYSAN 0.000 description 1
 230000001133 acceleration Effects 0.000 description 1
 238000009825 accumulation Methods 0.000 description 1
 238000006243 chemical reactions Methods 0.000 description 1
 239000008358 core components Substances 0.000 description 1
 230000000694 effects Effects 0.000 description 1
 238000003379 elimination reactions Methods 0.000 description 1
 239000010955 niobium Substances 0.000 description 1
 239000004576 sand Substances 0.000 description 1
 230000001360 synchronised Effects 0.000 description 1
Abstract
The invention discloses a SINS/CNS deep integrated navigation system and a realization method thereof. Wherein the navigation system comprises a strapdown inertial navigation system (SINS), a celestial navigation system (CNS), an integrated navigation filter, a inertial navigation posture measurement information structure unit; the realization unit comprises the following steps: 1. a large viewing field star sensor assists the strapdown inertial navigation system to obtain a highprecision mathematic horizontal reference; 2. CNS positioning is carried out based on the mathematic horizontal reference; 3. SINS/CNS deep integrated system model and measurement mode are established; 4. integrated navigation system information is fused; 5. the SINS and the CNS assists each other to realize highprecision positioning. In the invention, the star sensor highprecision posture information is employed to assist SINS to obtain highprecision SINS strapdown matrix which serves as the mathematic horizontal reference for CNS positioning, and on the basis, positions and postures of the CNS are employed to comprehensively calibrate the SINS, thus realizing SINS/CNS deep integration and finally achieving highprecision positioning and navigation.
Description
Technical field
The present invention relates to a kind of SINS/CNS deep integrated navigation system and its implementation, belong to the integrated navigation technical field.
Background technology
Celestial navigation system (CNS) good concealment, independence be strong, carrier positions and highaccuracy posture information can be provided, but output information is discontinuous, and can be subjected to the influence of external environment in some cases, when using separately, be difficult to satisfy high precision, high performance navigator fix requirement.
The bearing accuracy of tradition celestial navigation system depends primarily on the measuring accuracy of horizontal reference precision and heavenly body sensor.Because heavenly body sensor can more easily reach 1 rad observation precision at present, the precision of Horizon becomes the main factor that influences the celestial navigation precision.Inertial platform horizontal reference error is subjected to the error effect of its core component gyro at present, and list is extremely difficult from the precision that the improvement instrument design improves the inertia horizontal reference, and cost performance reduces; Direct responsive Horizon precision such as employing infrared horizon are lower; Employing based on starlight refraction the quadratic method precision is higher sensitively indirectly, but the uncertainty of atmospheric refraction model has directly influenced the precision and the reliability of horizontal reference.High level of accuracy benchmark technology has become the celestial navigation of realization high precision and has needed one of gordian technique of capturing badly.
And strapdown inertial navigation system (SINS) have navigational parameter comprehensively, output in time continuously, outstanding advantage such as good concealment, antijamming capability be strong, but because the existence of initial alignment error and inertia device error, the SINS error increases in time, be difficult to work alone for a long time, need to increase other metric informations, utilize the method for combination to improve the integrated navigation performance.Both have the characteristics of mutual supplement with each other's advantages SINS, CNS, and both combinations can be given full play to separately advantage, and along with the intensification of combined level, the overall performance of SINS/CNS combined system will be far superior to each autonomous system.
20th century, because detecting, celestial body is only limited to the detection of under the difference moment, different attitude, finishing different celestial bodies, astronomy/inertia combination can only be adopted systemlevel simple combination navigation mode, celestial navigation system receives the position and the attitude information of inertial navigation system output, regularly the drift of inertial navigation system is proofreaied and correct.This simple combination pattern can damping inertial navigation site error disperse, but its navigation accuracy is subjected to the restriction of the horizontal attitude precision of inertial navigation, and the horizontal attitude precision of inertial navigation depends on the precision of inertial sensor error, therefore this combined method corrective action and little.
To the middle and later periods nineties 20th century, because the development of big visual field celestial body Fast Detection Technique, celestial navigation system can be finished many stars synchronous detection in a certain moment, and the attitude information of under the outside initial information prerequisite of (comprising horizontal reference), determining carrier coordinate relative inertness coordinate (identical with the attitude information of gyro output).Therefore, be that the astronomy/inertia optimum combination pattern of core all can realize on theoretical and engineering fully with compensation inertial navigation gyroscopic drift, but this integrated mode is merely able to compensate the navigation error that causes because of gyroscopic drift in the inertial navigation.
At present, celestial navigation system adopts starlight to reflect the flat method of indirect geodetic and obtains the highprecision independent horizontal reference, can carry out highprecision independent and determine position (threedimensional coordinate), course and attitude, thereby inertial navigation system is realized thoroughly optimum comprehensively the correction.This astronomy/inertia optimum combination pattern not only can compensate the random drift of gyro, and can the compensated acceleration meter etc. the error that causes of other factors, but the method can only be used on the highaltitude sail body more than the 30km at present, can not realize FR application.
In sum, utilize many stars synchro measure and instantaneous definite carrier inertia attitude principle, solve this gordian technique of celestial navigation high level of accuracy benchmark, and develop high precision astronomy applied widely/inertia deep integrated navigation pattern to replace traditional systemlevel, rough astronomy/inertia integrated mode, thereby realizing the hiFix navigation, is the main direction of studying of astronomy/inertia best of breed navigational system.
Summary of the invention
The objective of the invention is to determine the deficiency of scheme in order to overcome the existing level benchmark, utilize the characteristics of SINS/CNS combination sensor, a kind of SINS/CNS deep integrated navigation system and its implementation are proposed, this method has made full use of the navigation information of each subsystem, has improved the precision of SINS/CNS integrated navigation system.
The dark combination implementing method of a kind of SINS/CNS specifically may further comprise the steps:
Step 1: the auxiliary SINS of star sensor obtains highprecision mathematics horizontal reference;
Step 2: carry out the CNS location based on the mathematics horizontal reference;
Step 3: set up dark combined system state equation of SINS/CNS and measurement equation;
A. make up the dark combined system state model of SINS/CNS;
B. make up the dark combined system of SINS/CNS and measure model;
Step 4: integrated navigation system information fusion;
The auxiliary mutually hiFix of realizing of step 5: SINS and CNS.
A kind of SINS/CNS deep integrated navigation system comprises strapdown inertial navitation system (SINS), celestial navigation system, integrated navigation wave filter, inertial navigation attitude measurement information tectonic element;
Strapdown inertial navigation system comprises inertial measurement cluster and navigation calculation unit; Inertial measurement cluster records angular velocity and the specific force of carrier with respect to inertial space, send the navigation calculation unit to the carrier angular velocity that obtains with than force information, the navigation calculation unit calculates the positional information latitude L of carrier in real time by mechanics layout algorithm according to the inertial measurement cluster information transmitted
_{I}And longitude λ
_{I}, speed and attitude; The navigation calculation unit is with the positional information L of carrier simultaneously
_{I}, λ
_{I}Be input in the integrated navigation wave filter, the SINS navigational parameter is input in the inertial navigation attitude measurement information tectonic element, described navigational parameter is the position L of current navigation time t, carrier
_{I}, λ
_{I}And attitude, the navigation calculation unit also inputs to celestial navigation system with SINS strapdown matrix as the mathematics horizontal reference and measures the elevation angle computing unit, with the positional information L of carrier
_{I}, λ
_{I}Be input to celestial navigation system analytic Height difference locating module;
Celestial navigation system comprises that big visual field star sensor, many vectors decide the appearance unit, measure the elevation angle computing unit and resolve the difference in height locating module;
Big visual field star sensor synchronization can be observed the starlight Vector Message that obtains three and three above fixed stars, and the observation information that obtains is offered many vectors respectively decide appearance unit and measurement elevation angle computing unit; Many vectors are decided the appearance unit starlight Vector Message that receives are handled, and obtain the attitude information in carrier relative inertness space
And with the carrier inertia attitude information of determining
Be input in the integrated navigation wave filter; Measure the elevation angle computing unit and utilize the starlight Vector Message of star sensor transmission and the mathematics horizontal reference that the navigation calculation unit provides, obtain the fixed star measurement elevation angle H on plane relatively
_{0}, and the elevation angle measurement information inputed to analytic Height difference locating module; The carrier positions information L that analytic Height difference locating module provides according to the fixed star elevation angle information that measures the transmission of elevation angle computing unit and navigation calculation unit
_{I}, λ
_{I}, obtain the carrier latitude L of astronomical fixation
_{C}, longitude λ
_{C}, and with astronomical fixation L as a result
_{C}, λ
_{C}Be input to the integrated navigation wave filter as measurement information;
Inertial navigation attitude measurement information tectonic element is according to the navigational parameter of navigation calculation unit transmission, obtain inertial navigation attitude measurement information, described inertial navigation attitude measurement information be strapdown inertial navigation system determine be transformed into the direction cosine matrix of carrier coordinate system from equator, the earth's core inertial coordinates system
Inertial navigation attitude measurement information tectonic element is with the inertial navigation attitude measurement information that obtains
Offer the integrated navigation wave filter;
The integrated navigation wave filter is decided the SINS positional information L that appearance unit, analytic Height difference locating module, inertial navigation attitude measurement information tectonic element provide respectively according to navigation calculation unit, many vectors
_{I}, λ
_{I}, CNS attitude measurement information
, CNS positioning result L
_{C}, λ
_{C}With inertial navigation attitude measurement information
Handle by Kalman filtering, the navigational parameter of strapdown inertial navigation system and the error of inertial measurement cluster are estimated, and it is fed back in the SINS navigation calculation unit, corresponding error is proofreaied and correct and compensated.
The invention has the advantages that:
(1) the present invention utilizes star sensor highaccuracy posture information to assist SINS, and realtime monitored also compensates mathematical platform misalignment and the gyroscopic drift of SINS, from obtaining highprecision SINS strapdown matrix as the mathematics horizontal reference, is used for the CNS location;
(2) the analytic Height difference method based on the mathematics horizontal reference is positioned error modeling, and survey the probabilistic influence of deduction mathematics horizontal reference in the equation, thereby eliminated the correlativity between CNS positioning error and the SINS attitude error in the position margin of error;
(3) utilize big visual field many stars of star sensor synchro measure and instantaneous definite carrier inertia attitude principle, auxiliary SINS obtains highprecision mathematics horizontal reference by star sensor, CNS can provide high precision position and attitude information simultaneously, SINS is realized comprehensively optimum the correction, further improved the precision of mathematics horizontal reference and astronomical fixation precision on this basis;
(4) SINS/CNS deep integrated navigation pattern of the present invention is auxiliary mutually by SINS, CNS, has given full play to the advantage of each subsystem, finally can realize highprecision location navigation.
Description of drawings
Fig. 1 is the structural representation of a kind of SINS/CNS deep integrated navigation system of the present invention;
Fig. 2 is a kind of process flow diagram of SINS/CNS deep integrated navigation system implementation method;
Fig. 3 is the synoptic diagram that the auxiliary SINS of star sensor of the present invention obtains high precision mathematics horizontal reference;
Among the figure:
1strapdown inertial navigation system 2celestial navigation system 3integrated navigation wave filter 4inertial navigation attitude measurement information
Tectonic element
The many vectors of 101inertial measurement cluster 102navigation calculation unit 201big visual field star sensor 202are decided the appearance unit
It is fixed that 203measures elevation angle calculating 204analytic Height difference
Position, unit module
Embodiment
The present invention is described in further detail below in conjunction with drawings and Examples.
A kind of SINS/CNS deep integrated navigation system of the present invention as shown in Figure 1, comprises strapdown inertial navitation system (SINS) 1, celestial navigation system 2, integrated navigation wave filter 3, inertial navigation attitude measurement information tectonic element 4;
Strapdown inertial navigation system (SINS) 1 comprises inertial measurement cluster (IMU) 101 and navigation calculation unit 102.Inertial measurement cluster 101 (IMU) records angular velocity and the specific force of carrier with respect to inertial space, send navigation calculation unit 102 to the carrier angular velocity that obtains with than force information, navigation calculation unit 102 calculates the positional information latitude L of carrier in real time by mechanics layout algorithm according to inertial measurement cluster 101 information transmitted
_{I}And longitude λ
_{I}, speed and attitude.Navigation calculation unit 102 is with the positional information L of carrier
_{I}, λ
_{I}Be input in the integrated navigation wave filter 3, the SINS navigational parameter is input in the inertial navigation attitude measurement information tectonic element 4, described navigational parameter is the position L of current navigation time t, carrier
_{I}, λ
_{I}And attitude, navigation calculation unit 102 also inputs to measurement elevation angle computing unit 203 in the celestial navigation system 2 with SINS strapdown matrix as the mathematics horizontal reference, with the positional information L of carrier
_{I}, λ
_{I}Be input to the analytic Height difference locating module 204 in the celestial navigation system;
Celestial navigation system (CNS) 2 comprises that big visual field star sensor 201, many vectors decide appearance unit 202, measure elevation angle computing unit 203 and resolve difference in height locating module 204;
Big visual field star sensor 201 synchronizations can be observed the starlight Vector Message that obtains three and three above fixed stars, and the observation information that obtains is offered many vectors respectively decide appearance unit 202 and measurement elevation angle computing unit 203.Many vectors are decided the starlight Vector Message that 202 pairs of appearance unit receive and are handled, and obtain the attitude information in carrier relative inertness space
And with the carrier inertia attitude information of determining
Be input in the integrated navigation wave filter 3.Measure elevation angle computing unit 203 and utilize the starlight Vector Message of star sensor 201 transmission and the mathematics horizontal reference that navigation calculation unit 102 provides, obtain the fixed star measurement elevation angle H on plane relatively
_{0}, and the elevation angle measurement information inputed to analytic Height difference locating module 204.The carrier positions information L that analytic Height difference locating module 204 provides according to the fixed star elevation angle information that measures 203 transmission of elevation angle computing unit and navigation calculation unit 102
_{I}, λ
_{I}, obtain the carrier latitude L of astronomical fixation
_{C}, longitude λ
_{C}, and with astronomical fixation L as a result
_{C}, λ
_{C}Be input to integrated navigation wave filter 3 as measurement information;
Inertial navigation attitude measurement information tectonic element 4 is according to the navigational parameter of navigation calculation unit 102 transmission, obtain inertial navigation attitude measurement information, described inertial navigation attitude measurement information be strapdown inertial navigation system 1 determine be transformed into the direction cosine matrix of carrier coordinate system from equator, the earth's core inertial coordinates system
, inertial navigation attitude measurement information tectonic element 4 is with the inertial navigation attitude measurement information that obtains
Offer integrated navigation wave filter 3;
Integrated navigation wave filter 3 is decided the SINS positional information L that appearance unit 202, analytic Height difference locating module 204, inertial navigation attitude measurement information tectonic element 4 provide respectively according to navigation calculation unit 102, many vectors
_{I}, λ
_{I}, CNS attitude measurement information
CNS positioning result L
_{C}, λ
_{C}With inertial navigation attitude measurement information
Handle by Kalman filtering, the navigational parameter of strapdown inertial navigation system 1 and the error of inertial measurement cluster are estimated, and it is fed back in the SINS navigation calculation unit 102, corresponding error is proofreaied and correct and compensated;
In whole SINS/CNS deep integrated navigation system,, finally realize highprecision location navigation by assisting mutually between strapdown inertial navigation system 1, the celestial navigation system 2.
A kind of SINS/CNS deep integrated navigation system implementation method of the present invention, flow process specifically may further comprise the steps as shown in Figure 2:
Step 1: star sensor 201 auxiliary strapdown inertial navigation systems 1 in big visual field obtain highprecision mathematics horizontal reference;
Owing to utilize the strapdown matrix of SINS can realize that carrier coordinate system arrives the coordinate conversion of platform coordinate system, obtain the expression of measurement vector at platform coordinate system, therefore the strapdown matrix that resolves is equivalent to set up mathematical platform, and the angle of rotation speed of geographic coordinate system is input in the calculation procedure of " mathematical platform ", but the surface level of platform realtime followup carrier loca.But the horizontal attitude information of SINS is drifted about in time, directly utilizes the strapdown matrix as horizontal reference, can cause the astronomical fixation error to be dispersed.And star sensor is equivalent to not have the gyro of drift, therefore utilize star sensor observation celestial body orientation to proofread and correct the drift of mathematical platform, the pure SINS mathematics horizontal reference that overcomes long time continuous working improves the precision of mathematics horizontal reference owing to the error that gyroscopic drift etc. causes.
The synoptic diagram of big visual field star sensor 201 auxiliary SINS acquisition high precision mathematics horizontal references as shown in Figure 3, big visual field star sensor 201 obtains the multidimensional starlight Vector Message of three or three above fixed stars in synchronization observation, many then vectors are decided appearance unit 202 pairs of multidimensional starlight Vector Message and are handled, and obtain the direction cosine matrix of the relative the earth's core of measurement coordinate system s equator inertial system I of big visual field star sensor 201
In conjunction with the installation Matrix C of big visual field star sensor 201 on carrier
_{b} ^{s}, obtaining carrier is the direction cosine matrix of b with respect to equator, the earth's core inertial system I
It is the direction cosine matrix of the relative the earth's core of b equator inertial system I that the navigation information that inertial navigation attitude measurement information tectonic element 4 is exported by navigation calculation unit 102 constructs the definite carrier of SINS
Attitude information with 201 outputs of big visual field star sensor
Be complementary, described navigation information is the locating information L of current navigation time t, SINS
_{I}, λ
_{I}And mathematics horizontal reference
Described direction cosine matrix
Concrete computing method be:
Utilize the locating information L of SINS
_{I}, λ
_{I}Construct the location matrix of SINS
Limit obtains being transformed into the be connected direction cosine matrix C of coordinate system e of the earth from equator, the earth's core inertial system I according to current navigation time t
_{I} ^{e}Strapdown matrix in conjunction with SINS
And location matrix
Obtain:
Consider the influence of factors such as alignment error and gyroscopic drift, the SINS mathematical platform is that n ' and navigation coordinate are to have mathematical platform misalignment vector between the n
φ
_{E}, φ
_{N}, φ
_{U}For east, north, day to misalignment, thereby SINS strapdown matrix
Error relevant with misalignment; And because the latitude error δ L of SINS location
_{I}, longitude error δ λ
_{I}Existence, to be nc do not overlap with the actual n of Department of Geography in the calculating of SINS, and position error vector δ P=[δ L is arranged
_{I}δ λ
_{I}Cos L
_{I}δ λ
_{I}Sin L
_{I}]
^{T}, the navigation that must cause SINS to determine is n with respect to the be connected direction cosine matrix of coordinate system e of the earth
Position deviation δ L with SINS
_{I}, δ λ
_{I}Close.Then there is following relation:
Wherein, C
_{n} ^{b}, C
_{e} ^{n}Navigation system, navigation are the be connected direction cosine matrix of coordinate system of the relative earth relatively to be respectively real carrier system.
Ignore the above error term of secondary and secondary, then the definite carrier of SINS is the direction cosine matrix of equator, relative the earth's core inertial system
Can be expressed as
Suppose that desirable free from error carrier is that the direction cosine battle array of the relative the earth's core of b equator inertial system I is C
_{I} ^{b}Because the measuring accuracy of star sensor is very high, can think that the carrier system of star sensor output is with respect to the direction cosine matrix of equator, the earth's core inertial system
Be real direction cosine matrix C
_{I} ^{b}Measure white noise acoustic matrix V with star sensor
_{s}Stack, that is:
With the carrier of being determined by SINS, star sensor respectively is the direction cosine matrix of equator, relative the earth's core inertial system
Between difference note make Z
_{s}, then have
Because platform misalignment and gyroscope constant value drift have coupled relation, be the direction cosine battle array of equator, relative the earth's core inertial system with star sensor with the carrier that SINS determines respectively by integrated navigation wave filter 3
Carry out information fusion, can estimate SINS mathematical platform misalignment and gyroscopic drift in real time, then SINS mathematical platform misalignment and gyroscopic drift are revised, to improve the mathematics horizontal reference
Precision, concrete grammar is as follows:
Gyroscope among the IMU101 and accelerometer are exported the specific force of carrier in real time
And angular velocity
And send navigation calculation unit 102 to.In navigation calculation unit 102, the ratio force information of carrier
After the mathematics horizontal reference is handled, be directly inputted into the northern bit platform formula inertial reference calculation process of finger and carry out navigation calculation, obtain the position L of carrier
_{I}, λ
_{I}, navigation information such as speed, attitude; Utilize the estimated value of misalignment
Can calculate the attitude error rectification Matrix C
_{N '} ^{n}, pass through formula
To the strapdown matrix
Carry out the misalignment correction, can improve the mathematics horizontal reference
Precision; And from gyrostatic output
In the error delta of deduction gyroscopic drift in real time ω
_{Ib} ^{b}, carry out gyroscopic drift error compensation, can access the angular velocity vector information in carrier relative inertness space more accurately
${\stackrel{~}{\mathrm{\ω}}}_{\mathrm{ib}}^{b}={\hat{\mathrm{\ω}}}_{\mathrm{ib}}^{b}\mathrm{\δ}{\mathrm{\ω}}_{\mathrm{ib}}^{b},$ And then in conjunction with the mathematics horizontal reference and refer to that it is the angular velocity of equator, relative the earth's core inertial system that northern bit platform formula inertial reference calculation obtains navigating
Calculate the attitude speed of relative navigation system of highprecision carrier system
And the direction of passage cosine matrix differential equation
${\stackrel{\·}{C}}_{b}^{n}{=C}_{b}^{n}{\mathrm{\Ω}}_{\mathrm{nb}}^{n}$ Carry out the strapdown matrix update, can further improve the precision of strapdown matrix (mathematics horizontal reference), wherein Ω
_{Nb} ^{b}Be angular velocity vector
Multiplication cross matrix in carrier coordinate system.
Last strapdown inertial navigation system 1 obtains highprecision strapdown matrix
It is the mathematics horizontal reference.
Step 2: carry out the CNS location based on the mathematics horizontal reference;
Measure the high precision mathematics horizontal reference that elevation angle computing unit 203 utilizes the auxiliary SINS of star sensor to obtain
In conjunction with the multidimensional starlight Vector Message that star sensor 201 observations in big visual field obtain, can obtain the elevation angle H of many observation astrologies for ground level
_{0}, realize the celestial navigation location by analytic Height difference locating module 204 then.Concrete steps are as follows:
A. utilize star sensor 201 auxiliary strapdown inertial navitation system (SINS) 1 to obtain highprecision SINS strapdown matrix
It is transferred to celestial navigation system 2 as the mathematics horizontal reference is used for the CNS location; And navigation calculation unit 102 output positional information L
_{I}, λ
_{I}The latitude initial value Lat of iteration is provided for analytic Height difference method location
_{AP}, longitude initial value Lon
_{AP}
B. big visual field star sensor 201 synchronizations can be observed the expression of starlight vector in star sensor measurement coordinate system s and equator, the earth's core inertial system I of three or three above fixed stars that obtain.Consider star sensor measurement noise V
_{i} ^{s}Existence, actual measurement obtains the position vector of fixed star i in star sensor measurement coordinate system s system and is:
In the formula, X
_{i} ^{s}Be fixed star i real position vector in star sensor measurement coordinate system s.
At navigation time t, the auxiliary SINS of star sensor obtains highprecision mathematics horizontal reference
Installation Matrix C in conjunction with star sensor
_{b} ^{s}, the starlight vector that can obtain fixed star i is expression among the n (ENU Department of Geography) at navigation coordinate
With the starlight position vector that calculates
With being defined in navigation is celestial body elevation angle among the n
And position angle
Expression can be described as:
The starlight vector that then can obtain fixed star i is a elevation angle among the n in navigation
And position angle
Because to choose sky, northeast Department of Geography is n as navigation coordinate, the fixed star i starlight vector that obtains is a elevation angle among the n in navigation
The measurement elevation angle H of the relative surface level of fixed star just
_{0}, can be directly used in analytic Height difference method location.
C. analytic Height difference locating module 204 receives the carrier positions information L that SINS determines
_{I}, λ
_{I}As iteration initial value Lat
_{AP}, Lon
_{AP}, and in conjunction with the elevation angle H that measures many relative surface levels of fixed star that elevation angle computing unit 203 provides
_{0}, use analytic Height difference method can directly obtain the carrier longitude and latitude that is similar to, can rapidly converge to higher precision by the iterative resolution altitude difference method, finally obtain the latitude information L of CNS location
_{C}, longitude information λ
_{C}
Step 3: set up the dark combined system state model of SINS/CNS and measure model;
Measure the mathematics horizontal reference that elevation angle computing unit 203 provides according to SINS navigation calculation unit 102
Determine the measurement elevation angle H of observation fixed star
_{0}, and offer analytic Height difference locating module 204; And analytic Height difference locating module 204 utilizes the fixed star elevation angle measurement information H that obtains
_{0}, and navigation resolves the carrier positions L of unit 102 transmission
_{I}, λ
_{I}As iterative initial value, it is definite that utilization analytic Height difference method is carried out the CNS position, thereby the CNS positioning error is relevant with SINS horizontal attitude error.If ignored the relation between measurement information and the state variable, can influence the estimated accuracy of Kalman filter, and may cause system's instability.Therefore set up CNS Model of locating error based on the mathematics horizontal reference, and the influence of elimination of level fiducial error in the measurement equation of the position of integrated navigation wave filter 3.
The error model of SINS/CNS deep integrated navigation system is made up of SINS, CNS error model.
A. make up the dark combined system state model of SINS/CNS;
Dark combined system state equation is taken as the error equation of SINS, and as the error state variable, the state equation of model is with the error of zero of platform misalignment, velocity error, site error and inertia device:
Wherein, X is the error state vector of SINS; The error state of SINS comprises that east, north, sky are to misalignment φ
_{E}, φ
_{N}, φ
_{U}, velocity error δ V
_{E}, δ V
_{N}, δ V
_{U}, latitude, longitude and height error δ L
_{I}, δ λ
_{I}, δ h, gyro zero drift ε
_{Bx}, ε
_{By}, ε
_{Bz}Accelerometer zerobit biasing ▽
_{Bx}, ▽
_{By}, ▽
_{Bz}F is the system state matrix, W=[ω
_{Gx}, ω
_{Gy}, ω
_{Gz}, ω
_{Dx}, ω
_{Dy}, ω
_{Dz}]
^{T}Be system noise sequence, ω
_{Gi}(i=x, y, z), ω
_{Dt}(i=x, y z) are respectively gyroscope, accelerometer random white noise, C
_{b} ^{n}Be SINS strapdown matrix, G is a noise matrix, F
_{N}State matrix for SINS.F, F
_{S}And G (t) is respectively
B. make up the dark combined system of SINS/CNS and measure model;
1) will be the direction cosine matrix of the relative the earth's core of b equator inertial system I by SINS with the definite carrier of star sensor respectively
Between the difference note measurement amount Z that gestures
_{s}, then obtain formula (6).
With Z
_{S (3 * 3)}Be launched into column vector Z
_{1 (9 * 1)}, in conjunction with the state vector X of integrated navigation system, can be listed as and write out measurement equation and be:
Z
_{1}＝H
_{1}X+V
_{1} (13)
Wherein, H
_{1}For measuring matrix, V
_{1}Measurement white noise sequence for star sensor.
2) the carrier latitude L that SINS is resolved
_{I}, longitude λ
_{I}, the latitude L that resolves of CNS
_{C}, longitude λ
_{C}Difference as the position detection amount, obtain:
Wherein, δ Lat and δ Lon are respectively difference of latitude, the difference of longitude of SINS, CNS location, δ L
_{I}With δ λ
_{I}Be the positioning error of SINS, δ L
_{C}With δ λ
_{C}Be the CNS positioning error that mathematics horizontal reference error causes, N
_{L}, N
_{λ}Be the white Gaussian noise component in the CNS positioning error.Obtain;
Z
_{2}＝H
_{2}X+V
_{2} (15)
In the formula, the position detection vector
${Z}_{2}=\left[\begin{array}{c}\mathrm{\δLat}\\ \mathrm{\δLon}\end{array}\right]=\left[\begin{array}{c}{L}_{I}{L}_{C}\\ {\mathrm{\λ}}_{I}{\mathrm{\λ}}_{C}\end{array}\right];$ The white noise component of CNS positioning error
${V}_{2}=\left[\begin{array}{c}{N}_{L}\\ {N}_{\mathrm{\λ}}\end{array}\right];$ Measure matrix H
_{2}=[H
_{c}0
_{2 * 3}I
_{2 * 2}0
_{2 * 7}], H wherein
_{c}=M (A
^{T}A)
^{1}A
^{T}B,
$M=\left[\begin{array}{cc}1& 0\\ 0& 1/\mathrm{cos}\left({L}_{I}\right)\end{array}\right],$ Suppose that n (n 〉=3) the fixed star true azimuth that the star sensor observation of big visual field obtains is A
_{XNi}(i=1,2 ... n), the position vector in star sensor measurement coordinate system s is X
_{i} ^{s}=[a
_{1i}a
_{2i}a
_{3i}]
^{T}, as the direction cosine matrix of mathematics horizontal reference be
${\stackrel{~}{C}}_{b}^{n}=\left[\begin{array}{ccc}{T}_{11}& {T}_{12}& {T}_{13}\\ {T}_{21}& {T}_{22}& {T}_{23}\\ {T}_{31}& {T}_{32}& {T}_{33}\end{array}\right],$ Then obtain easily
3) when dark combined system is started working, because SINS has certain accumulation of error, at first utilize the auxiliary SINS of star sensor to obtain high precision mathematics horizontal reference information, this moment, Z was measured in the observation of integrated navigation system
_{SINS/CNS}=Z
_{1}, corresponding measurement model is formula (13).
Auxiliary SINS obtains on the basis of high level of accuracy benchmark at star sensor, can carry out the celestial navigation location, obtains astronomical fixation latitude and longitude information L
_{C}, λ
_{C}This moment, the observation of SINS/CNS deep integrated navigation system was measured:
This moment, corresponding measurement model was
Step 4: integrated navigation system information fusion;
The carrier positions L that integrated navigation wave filter 3 utilizes strapdown inertial navitation system (SINS) 1 and celestial navigation system 2 to determine respectively
_{I}, λ
_{I}, L
_{C}, λ
_{C}, the attitude measurement information
Error state to SINS is estimated, obtains the estimation of error information of combined system navigational parameter and inertia device, and these control informations are fed back in the navigation calculation unit 102, and navigational parameter and component error are proofreaied and correct.
The auxiliary mutually hiFix of realizing of step 5: SINS and CNS;
Navigation calculation unit 102 obtains highprecision SINS strapdown matrix according to the SINS navigational parameter after proofreading and correct
And it is offered as the mathematics horizontal reference measure elevation angle computing unit 203, obtain the more accurate fixed star elevation angle measurement information on plane relatively, be transferred to analytic Height difference locating module 204 then and be used for CNS and locate, can improve the CNS bearing accuracy.Integrated navigation wave filter 3 receives the more accurate position quantity measurement information that analytic Height difference locating module 204 provides, realization is estimated more accurately to the SINS error state, and these error estimates are fed back to navigation calculation unit 102, can further improve the navigation accuracy of SINS, finally make up deeply and realize the precise navigation location by SINS/CNS.
Claims (2)
1. a SINS/CNS deep integrated navigation system is characterized in that, comprises strapdown inertial navitation system (SINS), celestial navigation system, integrated navigation wave filter, inertial navigation attitude measurement information tectonic element;
Strapdown inertial navigation system comprises inertial measurement cluster and navigation calculation unit; Inertial measurement cluster records angular velocity and the specific force of carrier with respect to inertial space, send the navigation calculation unit to the carrier angular velocity that obtains with than force information, the navigation calculation unit calculates the positional information latitude L of carrier in real time by mechanics layout algorithm according to the inertial measurement cluster information transmitted
_{I}And longitude λ
_{I}, speed and attitude; The navigation calculation unit is with the positional information L of carrier
_{I}, λ
_{I}Be input in the integrated navigation wave filter, with the position L of current navigation time t, carrier
_{I}, λ
_{I}Be input in the inertial navigation attitude measurement information tectonic element with attitude, the navigation calculation unit also inputs to measurement elevation angle computing unit in the celestial navigation system with SINS strapdown matrix as the mathematics horizontal reference, with the positional information L of carrier
_{I}, λ
_{I}Be input to the analytic Height difference locating module in the celestial navigation system;
Celestial navigation system comprises that big visual field star sensor, many vectors decide the appearance unit, measure the elevation angle computing unit and resolve the difference in height locating module;
Big visual field star sensor synchronization can be observed the starlight Vector Message that obtains three and three above fixed stars, and the observation information that obtains is offered many vectors respectively decide appearance unit and measurement elevation angle computing unit; Many vectors are decided the appearance unit starlight Vector Message that receives are handled, and obtain the attitude information in carrier relative inertness space
And with the carrier inertia attitude information of determining
Be input in the integrated navigation wave filter; Measure the elevation angle computing unit and utilize the starlight Vector Message of star sensor transmission and the mathematics horizontal reference that the navigation calculation unit provides, obtain the fixed star measurement elevation angle H on plane relatively
_{0}, and the elevation angle measurement information inputed to analytic Height difference locating module; The carrier positions information L that analytic Height difference locating module provides according to the fixed star elevation angle information that measures the transmission of elevation angle computing unit and navigation calculation unit
_{I}, λ
_{I}, obtain the carrier latitude L of astronomical fixation
_{C}, longitude λ
_{C}, and with astronomical fixation L as a result
_{C}, λ
_{C}Be input to the integrated navigation wave filter as measurement information;
Inertial navigation attitude measurement information tectonic element is according to the navigational parameter of navigation calculation unit transmission, obtain inertial navigation attitude measurement information, described inertial navigation attitude measurement information be strapdown inertial navigation system determine be transformed into the direction cosine matrix of carrier coordinate system from equator, the earth's core inertial coordinates system
Inertial navigation attitude measurement information tectonic element is with the inertial navigation attitude measurement information that obtains
Offer the integrated navigation wave filter;
The integrated navigation wave filter is decided the SINS positional information L that appearance unit, analytic Height difference locating module, inertial navigation attitude measurement information tectonic element provide respectively according to navigation calculation unit, many vectors
_{I}, λ
_{I}, CNS attitude measurement information
CNS positioning result L
_{C}, λ
_{C}With inertial navigation attitude measurement information
Handle by Kalman filtering, the navigational parameter of strapdown inertial navigation system and the error of inertial measurement cluster are estimated, and it is fed back in the SINS navigation calculation unit, corresponding error is proofreaied and correct and compensated.
2. the implementation method of a SINS/CNS deep integrated navigation system is characterized in that, comprises following step:
Step 1: star sensor auxiliary strapdown inertial navigation system in big visual field obtains highprecision mathematics horizontal reference;
Big visual field star sensor obtains the multidimensional starlight Vector Message of three or three above fixed stars in synchronization observation, many then vectors are decided the appearance unit multidimensional starlight Vector Message are handled, and obtain the direction cosine matrix of the relative the earth's core of measurement coordinate system s equator inertial system I of big visual field star sensor
In conjunction with the big installation matrix of visual field star sensor on carrier
Obtaining carrier is the direction cosine matrix of b with respect to equator, the earth's core inertial system I
It is the direction cosine matrix of the relative the earth's core of b equator inertial system I that the navigation information that inertial navigation attitude measurement information tectonic element is exported by the navigation calculation unit constructs the definite carrier of SINS
Attitude information with the output of big visual field star sensor
Be complementary, described navigation information is the locating information L of current navigation time t, SINS
_{I}, λ
_{I}And mathematics horizontal reference
Described direction cosine matrix
Concrete computing method be:
Utilize the locating information L of SINS
_{I}, λ
_{I}Construct the location matrix of SINS
Obtain being transformed into the be connected direction cosine matrix of coordinate system e of the earth according to current navigation time t from equator, the earth's core inertial system I
Strapdown matrix in conjunction with SINS
And location matrix
Obtain:
The SINS mathematical platform is that n ' and navigation coordinate are to have mathematical platform misalignment vector between the n
φ
_{E}, φ
_{N}, φ
_{U}For east, north, day to misalignment, SINS strapdown matrix
Error relevant with misalignment; Because the latitude error δ L of SINS location
_{I}, longitude error δ λ
_{I}Existence, to be nc do not overlap with the actual n of Department of Geography in the calculating of SINS, and position error vector δ P=[δ L is arranged
_{I}δ λ
_{I}CosL
_{I}δ λ
_{I}SinL
_{I}]
^{T}, the navigation coordinate that causes SINS to determine is n with respect to the be connected direction cosine matrix of coordinate system e of the earth
Position deviation δ L with SINS
_{I}, δ λ
_{I}Relevant, then there is following relation:
Wherein,
Navigation system, navigation are the be connected direction cosine matrix of coordinate system of the relative earth relatively to be respectively real carrier system;
Ignore the above error term of secondary and secondary, then the definite carrier of SINS is the direction cosine matrix of equator, relative the earth's core inertial system
Be expressed as
Suppose that desirable free from error carrier is that the direction cosine battle array of the relative the earth's core of b equator inertial system I is
Think that the carrier system of star sensor output is with respect to the direction cosine matrix of equator, the earth's core inertial system
It is real direction cosine matrix
Measure white noise acoustic matrix V with star sensor
_{s}Stack, that is:
With the carrier of being determined by SINS, star sensor respectively is the direction cosine matrix of equator, relative the earth's core inertial system
Between difference note make Z
_{s}, then have
Platform misalignment and gyroscope constant value drift have coupled relation, are the direction cosine battle array of relative the earth's core equator inertial system with star sensor with the carrier that SINS determines respectively by the integrated navigation wave filter
Carry out information fusion, estimate SINS mathematical platform misalignment and gyroscopic drift in real time, then SINS mathematical platform misalignment and gyroscopic drift are revised, to improve the mathematics horizontal reference
Precision, concrete grammar is as follows:
Gyroscope in the inertial measurement cluster and accelerometer are exported the specific force of carrier in real time
And angular velocity
Send the navigation calculation unit to; In the navigation calculation unit, the ratio force information of carrier
After the mathematics horizontal reference is handled, be directly inputted into the northern bit platform formula inertial reference calculation process of finger and carry out navigation calculation, obtain the position L of carrier
_{I}, λ
_{I}, speed, attitude navigation information; Utilize the estimated value of misalignment
Calculate the attitude error rectification matrix
Pass through formula
To the strapdown matrix
Carry out the misalignment correction, improve the mathematics horizontal reference
Precision; From gyrostatic output
In the error of deduction gyroscopic drift in real time
Carry out gyroscopic drift error compensation, obtain the angular velocity vector information in carrier relative inertness space accurately
In conjunction with the mathematics horizontal reference and refer to that it is the angular velocity of equator, relative the earth's core inertial system that northern bit platform formula inertial reference calculation obtains navigating
Calculate the attitude speed of relative navigation system of highprecision carrier system
And the direction of passage cosine matrix differential equation
Carry out the strapdown matrix update, wherein
Be angular velocity vector
Multiplication cross matrix in carrier coordinate system;
Last strapdown inertial navigation system obtains highprecision strapdown matrix
It is the mathematics horizontal reference;
Step 2: carry out the CNS location based on the mathematics horizontal reference;
A. utilize the auxiliary strapdown inertial navitation system (SINS) of star sensor to obtain highprecision SINS strapdown matrix
It is transferred to celestial navigation system as the mathematics horizontal reference; And navigation calculation unit output positional information L
_{I}, λ
_{I}The latitude initial value Lat of iteration is provided for analytic Height difference method location
_{AP}, longitude initial value Lon
_{AP}
The expression of starlight vector in star sensor measurement coordinate system s and equator, the earth's core inertial system I of three or three the above fixed stars that the star sensor synchronization observation of b. big visual field obtains; Because star sensor measurement noise
Existence, actual measurement obtains the position vector of fixed star i in star sensor measurement coordinate system s system and is:
In the formula,
Be fixed star i real position vector in star sensor measurement coordinate system s;
At navigation time t, the auxiliary SINS of star sensor obtains highprecision mathematics horizontal reference
Installation matrix in conjunction with star sensor
The starlight vector that obtains fixed star i is expression among the n at navigation coordinate
With the starlight position vector that calculates
With being defined in navigation is celestial body elevation angle among the n
And position angle
Expression:
The starlight vector that then obtains fixed star i is a elevation angle among the n in navigation
And position angle
Because to choose sky, northeast Department of Geography is n as navigation coordinate, the fixed star i starlight vector that obtains is a elevation angle among the n in navigation
Measurement elevation angle H for the relative surface level of fixed star
_{0}
C. analytic Height difference locating module receives the carrier positions information L that SINS determines
_{I}, λ
_{I}As iteration initial value Lat
_{AP}, Lon
_{AP}, and in conjunction with the measuring height angle H that measures many relative surface levels of fixed star that the elevation angle computing unit provides
_{0}, use analytic Height difference method directly to obtain the carrier longitude and latitude that is similar to, rapidly converge to higher precision by the iterative resolution altitude difference method, obtain the latitude information L of CNS location
_{C}, longitude information λ
_{C}
Step 3: set up the dark combined system state model of SINS/CNS and measure model;
The error model of SINS/CNS deep integrated navigation system comprises SINS, CNS error model;
A. make up the dark combined system state model of SINS/CNS;
Dark combined system state equation is taken as the error equation of SINS, and as the error state variable, the state equation of model is with the error of zero of platform misalignment, velocity error, site error and inertia device:
Wherein, X is the error state vector of SINS; The error state of SINS comprises that east, north, sky are to misalignment φ
_{E}, φ
_{N}, φ
_{U}, velocity error δ V
_{E}, δ V
_{N}, δ V
_{U}, latitude, longitude and height error δ L
_{I}, δ λ
_{I}, δ h, gyro zero drift ε
_{Bx}, ε
_{By}, ε
_{Bz}The biasing of accelerometer zerobit
F is the system state matrix, W=[ω
_{Gx}, ω
_{Gy}, ω
_{Gz}, ω
_{Dx}, ω
_{Dy}, ω
_{Dz}]
^{T}Be system noise sequence, ω
_{Gi}(i=x, y, z), ω
_{Di}(i=x, y z) are respectively gyroscope, accelerometer random white noise,
Be SINS strapdown matrix, G is a noise matrix, F
_{N}State matrix for SINS; F, F
_{S}Be respectively with G
B. make up the dark combined system of SINS/CNS and measure model;
1) will be the direction cosine matrix of the relative the earth's core of b equator inertial system I by SINS with the definite carrier of star sensor respectively
Between the difference note measurement amount Z that gestures
_{s}, then obtain formula (6);
With Z
_{S (3 * 3)}Be launched into column vector Z
_{1 (9 * 1)}, in conjunction with the state vector X of integrated navigation system, row write out measurement equation and are:
Z
_{1}＝H
_{1}X+V
_{1} (13)
Wherein, H
_{1}For measuring matrix, V
_{1}Measurement white noise sequence for star sensor;
2) the carrier latitude L that SINS is resolved
_{I}, longitude λ
_{I}, the latitude L that resolves of CNS
_{C}, longitude λ
_{C}Difference as the position detection amount, obtain:
Wherein, δ Lat and δ Lon are respectively difference of latitude, the difference of longitude of SINS, CNS location, δ L
_{I}With δ λ
_{I}Be the positioning error of SINS, δ L
_{C}With δ λ
_{C}Be the CNS positioning error that mathematics horizontal reference error causes, N
_{L}, N
_{λ}Be the white Gaussian noise component in the CNS positioning error; Obtain;
Z
_{2}＝H
_{2}X+V
_{2} (15)
In the formula, the position detection vector
${Z}_{2}=\left[\begin{array}{c}\mathrm{\δLat}\\ \mathrm{\δLon}\end{array}\right]=\left[\begin{array}{c}{L}_{I}{L}_{C}\\ {\mathrm{\λ}}_{I}{\mathrm{\λ}}_{C}\end{array}\right];$ The white noise component of CNS positioning error
${V}_{2}=\left[\begin{array}{c}{N}_{L}\\ {N}_{\mathrm{\λ}}\end{array}\right];$ Measure matrix H
_{2}=[H
_{c}0
_{2 * 3}I
_{2 * 2}0
_{2 * 7}], H wherein
_{c}=M (A
^{T}A)
^{1}A
^{T}B,
$M=\left[\begin{array}{cc}1& 0\\ 0& 1/\mathrm{cos}\left({L}_{I}\right)\end{array}\right],$ Suppose that n (n 〉=3) the fixed star true azimuth that the star sensor observation of big visual field obtains is A
_{ZNi}(i=1,2 ... n), the position vector in star sensor measurement coordinate system s is
${X}_{i}^{s}={\left[\begin{array}{ccc}{a}_{1i}& {a}_{2i}& {a}_{3i}\end{array}\right]}^{T},$ Direction cosine matrix as the mathematics horizontal reference is
${\stackrel{~}{C}}_{b}^{n}=\left[\begin{array}{ccc}{T}_{11}& {T}_{12}& {T}_{13}\\ {T}_{21}& {T}_{22}& {T}_{23}\\ {T}_{31}& {T}_{32}& {T}_{33}\end{array}\right],$ Then obtain:
3) when dark combined system is started working, at first utilize the auxiliary SINS of star sensor to obtain high precision mathematics horizontal reference information, this moment, Z was measured in the observation of integrated navigation system
_{SINS/CNS}=Z
_{1}, corresponding measurement model is formula (13);
Auxiliary SINS obtains on the basis of high level of accuracy benchmark at star sensor, carries out the celestial navigation location, obtains astronomical fixation latitude and longitude information L
_{C}, λ
_{C}This moment, the observation of SINS/CNS deep integrated navigation system was measured:
This moment, corresponding measurement model was
Step 4: integrated navigation system information fusion;
The carrier positions L that the integrated navigation wave filter utilizes strapdown inertial navitation system (SINS) and celestial navigation system to determine respectively
_{I}, λ
_{I}, L
_{C}, λ
_{C}, the attitude measurement information
Error state to SINS is estimated, obtains the estimation of error information of combined system navigational parameter and inertia device, and these control informations are fed back in the navigation calculation unit, and navigational parameter and component error are proofreaied and correct;
The auxiliary mutually hiFix of realizing of step 5: SINS and CNS;
The navigation calculation unit obtains highprecision SINS strapdown matrix according to the SINS navigational parameter after proofreading and correct
It is offered measurement elevation angle computing unit as the mathematics horizontal reference, obtain the more accurate fixed star elevation angle measurement information on plane relatively, be transferred to analytic Height difference locating module and be used for the CNS location; The integrated navigation wave filter receives the more accurate position quantity measurement information that analytic Height difference locating module provides, realization is estimated more accurately to the SINS error state, error estimate is fed back to the navigation calculation unit, further improve the navigation accuracy of SINS, finally make up deeply and realize the precise navigation location by SINS/CNS.
Priority Applications (1)
Application Number  Priority Date  Filing Date  Title 

CN2010101014291A CN101788296B (en)  20100126  20100126  SINS/CNS deep integrated navigation system and realization method thereof 
Applications Claiming Priority (1)
Application Number  Priority Date  Filing Date  Title 

CN2010101014291A CN101788296B (en)  20100126  20100126  SINS/CNS deep integrated navigation system and realization method thereof 
Publications (2)
Publication Number  Publication Date 

CN101788296A CN101788296A (en)  20100728 
CN101788296B true CN101788296B (en)  20111116 
Family
ID=42531605
Family Applications (1)
Application Number  Title  Priority Date  Filing Date 

CN2010101014291A CN101788296B (en)  20100126  20100126  SINS/CNS deep integrated navigation system and realization method thereof 
Country Status (1)
Country  Link 

CN (1)  CN101788296B (en) 
Families Citing this family (29)
Publication number  Priority date  Publication date  Assignee  Title 

CN102353970B (en) *  20110610  20130612  北京航空航天大学  GPS/SINS (global positioning system/strapdown inertial navigation system) combined navigating system with high antiinterference performance and realizing method thereof 
CN102261921B (en) *  20110614  20130130  哈尔滨工业大学  Method for correcting influence of atmospheric refraction on precision of star sensor 
CN102279002B (en) *  20110627  20130605  哈尔滨工业大学  Calibration method of transformation matrix of star sensor measuring coordinate system and carrier coordinate system 
CN102288200B (en) *  20110706  20120718  清华大学  Accuracy measurement system for star sensor 
CN102997908B (en) *  20110915  20150225  北京自动化控制设备研究所  Forward direction combination navigation result and reverse direction combination navigation result fused POS posttreatment method 
CN102393204B (en) *  20111021  20130508  哈尔滨工程大学  Combined navigation information fusion method based on SINS (Ship's Inertial Navigation System)/CNS (Communication Network System) 
CN102519470B (en) *  20111209  20140507  南京航空航天大学  Multilevel embedded integrated navigation system and navigation method 
CN102607564B (en) *  20120309  20141217  北京航空航天大学  Small satellite autonomous navigation system based on starlight/ geomagnetism integrated information and navigation method thereof 
CN103076015B (en) *  20130104  20151028  北京航空航天大学  A kind of SINS/CNS integrated navigation system based on optimum correction comprehensively and air navigation aid thereof 
CN103063216B (en) *  20130106  20150812  南京航空航天大学  A kind of inertia based on star image coordinates modeling and celestial combined navigation method 
CN103398713A (en) *  20130426  20131120  哈尔滨工程大学  Method for synchronizing measured data of star sensor/optical fiber inertial equipment 
CN103256928B (en) *  20130428  20150520  南京航空航天大学  Distributed inertial navigation system and posture transfer alignment method thereof 
CN104251701B (en) *  20130626  20170829  上海新跃仪表厂  Martian atmosphere braking orbit determines method 
CN103389115A (en) *  20130726  20131113  哈尔滨工程大学  Integrated error calibrating method of SINS/DVL (strapdown inertial navigation system/doppler velocity sonar) combined navigation system 
CN103438879B (en) *  20130902  20160622  北京航空航天大学  A kind of atomic spin gyroscope based on ant colony PF algorithm and gaussmeter tight integration method for determining posture 
CN103575277B (en) *  20131119  20160217  浙江大学  A kind of boat of the light inertial navigation for highaltitude unmanned vehicle integrated apparatus 
CN103913169B (en) *  20140312  20170125  哈尔滨工程大学  Strapdown inertial/starlight refraction combined navigation method of aircrafts 
CN103852079B (en) *  20140321  20160817  哈尔滨商业大学  A kind of boats and ships astronomical navigation method based on the subdivision radian set fuzzy matching of double star summit 
CN103994763B (en) *  20140521  20161102  北京航空航天大学  The SINS/CNS deep integrated navigation system of a kind of Marsokhod and its implementation 
DE102014211177A1 (en) *  20140611  20151217  Continental Teves Ag & Co. Ohg  Method and system for the realtime provision of dynamic error values of dynamic measured values 
CN105321315A (en) *  20140730  20160210  芯讯通无线科技（上海）有限公司  Aircraft system and communication method thereof 
CN105241451B (en) *  20151030  20180105  中国电子科技集团公司第二十研究所  A kind of small field of view star tracker astronomical observation Information abnormity detection method 
CN105371844B (en) *  20151202  20180216  南京航空航天大学  A kind of inertial navigation system initial method based on inertia/astronomical mutual assistance 
CN105911575B (en) *  20160407  20180626  南京航空航天大学  A kind of tandem type inertia/satellite deep integrated navigation wave filter observed quantity extracting method 
CN107270888B (en) *  20170620  20201117  歌尔科技有限公司  Method and device for measuring longitude and latitude and camera 
CN107621264B (en) *  20170930  20210119  华南理工大学  Selfadaptive Kalman filtering method of vehiclemounted microinertia/satellite integrated navigation system 
CN108132060A (en) *  20171117  20180608  北京计算机技术及应用研究所  A kind of systematic calibration method of Strapdown Inertial Navigation System without benchmark 
CN109059904A (en) *  20180601  20181221  浙江亚特电器有限公司  Combinated navigation method for mobile carrier 
CN110887478A (en) *  20191209  20200317  北京航空航天大学  Autonomous navigation positioning method based on polarization/astronomical assistance 
Citations (1)
Publication number  Priority date  Publication date  Assignee  Title 

CN1869589A (en) *  20060627  20061129  北京航空航天大学  Strapdown intertial/celestial combined navigation semimaterial emulation system 

2010
 20100126 CN CN2010101014291A patent/CN101788296B/en not_active IP Right Cessation
Patent Citations (1)
Publication number  Priority date  Publication date  Assignee  Title 

CN1869589A (en) *  20060627  20061129  北京航空航天大学  Strapdown intertial/celestial combined navigation semimaterial emulation system 
NonPatent Citations (1)
Title 

全伟等.SINS/CNS组合导航半实物仿真系统及其实验研究.《系统仿真学报》.2007,(第15期), * 
Also Published As
Publication number  Publication date 

CN101788296A (en)  20100728 
Similar Documents
Publication  Publication Date  Title 

Van Sickle  Basic GIS coordinates  
Chatfield  Fundamentals of high accuracy inertial navigation  
CN105737823B (en)  A kind of GPS/SINS/CNS Combinated navigation methods based on five rank CKF  
CN103913181B (en)  A kind of airborne distributed POS Transfer Alignments based on parameter identification  
CN103759730B (en)  The collaborative navigation system of a kind of pedestrian based on navigation information twoway fusion and intelligent mobile carrier and air navigation aid thereof  
US6876926B2 (en)  Method and system for processing pulse signals within an inertial navigation system  
CN101319902B (en)  Lowcost combination type positioning and orienting device and combined positioning method  
CN104655152B (en)  A kind of realtime Transfer Alignments of airborne distributed POS based on federated filter  
CN102508275B (en)  Multipleantenna GPS(Global Positioning System)/GFINS (GyroscopeFreeInertial Navigation System) depth combination attitude determining method  
CN101858748B (en)  Faulttolerance autonomous navigation method of multisensor of highaltitude longendurance unmanned plane  
CN102809377B (en)  Aircraft inertia/pneumatic model Combinated navigation method  
CN201266089Y (en)  INS/GPS combined navigation system  
CN106289246B (en)  A kind of flexible link arm measure method based on position and orientation measurement system  
CN104655131B (en)  Inertial navigation Initial Alignment Method based on ISTSSRCKF  
CN102486377B (en)  Method for acquiring initial course attitude of fiber optic gyro strapdown inertial navigation system  
CN104457754B (en)  SINS/LBL (strapdown inertial navigation systems/long base line) tight combination based AUV (autonomous underwater vehicle) underwater navigation positioning method  
CN103323026B (en)  The attitude reference estimation of deviation of star sensor and useful load and modification method  
CN103575299B (en)  Utilize dualaxis rotation inertial navigation system alignment and the error correcting method of External Observation information  
US6459990B1 (en)  Selfcontained positioning method and system thereof for water and land vehicles  
Bevly et al.  GNSS for vehicle control  
CN100487618C (en)  High precision combined posturedetermining method based on optimally genetic REQUEST and GUPF  
CN101893440B (en)  Celestial autonomous navigation method based on star sensors  
CN103196448B (en)  A kind of airborne distributed inertia surveys appearance system and Transfer Alignment thereof  
CN103033189B (en)  Inertia/vision integrated navigation method for deepspace detection patrolling device  
CN102175241B (en)  Autonomous astronomical navigation method of Mars probe in cruise section 
Legal Events
Date  Code  Title  Description 

C06  Publication  
PB01  Publication  
SE01  Entry into force of request for substantive examination  
C10  Entry into substantive examination  
GR01  Patent grant  
C14  Grant of patent or utility model  
CF01  Termination of patent right due to nonpayment of annual fee 
Granted publication date: 20111116 Termination date: 20130126 