CN104006787B  Spacecraft Attitude motion simulation platform highprecision attitude defining method  Google Patents
Spacecraft Attitude motion simulation platform highprecision attitude defining method Download PDFInfo
 Publication number
 CN104006787B CN104006787B CN201410195936.4A CN201410195936A CN104006787B CN 104006787 B CN104006787 B CN 104006787B CN 201410195936 A CN201410195936 A CN 201410195936A CN 104006787 B CN104006787 B CN 104006787B
 Authority
 CN
 China
 Prior art keywords
 attitude
 coordinate
 laser tracker
 motion simulation
 simulation platform
 Prior art date
Links
 238000004088 simulation Methods 0.000 title claims abstract description 91
 238000001914 filtration Methods 0.000 claims abstract description 48
 238000000034 methods Methods 0.000 claims abstract description 30
 230000004927 fusion Effects 0.000 claims abstract description 12
 239000011159 matrix materials Substances 0.000 claims description 46
 238000006243 chemical reactions Methods 0.000 claims description 25
 239000003570 air Substances 0.000 claims description 24
 238000007667 floating Methods 0.000 claims description 15
 230000001131 transforming Effects 0.000 claims description 6
 238000009434 installation Methods 0.000 claims description 4
 239000000203 mixtures Substances 0.000 claims description 4
 238000007499 fusion processing Methods 0.000 claims description 3
 238000005070 sampling Methods 0.000 claims description 3
 230000037010 Beta Effects 0.000 description 6
 239000003550 marker Substances 0.000 description 5
 238000010586 diagrams Methods 0.000 description 4
 238000005516 engineering processes Methods 0.000 description 3
 281000044456 Leica companies 0.000 description 2
 238000004891 communication Methods 0.000 description 2
 280000189476 Harbin Institute Of Technology companies 0.000 description 1
 280000992371 Prism On companies 0.000 description 1
 239000008186 active pharmaceutical agents Substances 0.000 description 1
 238000010276 construction Methods 0.000 description 1
 230000000694 effects Effects 0.000 description 1
 238000004519 manufacturing process Methods 0.000 description 1
 230000003287 optical Effects 0.000 description 1
 230000000007 visual effect Effects 0.000 description 1
Classifications

 G—PHYSICS
 G01—MEASURING; TESTING
 G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
 G01C1/00—Measuring angles

 G—PHYSICS
 G01—MEASURING; TESTING
 G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
 G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00  G01C19/00
 G01C21/20—Instruments for performing navigational calculations

 G—PHYSICS
 G01—MEASURING; TESTING
 G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
 G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
 G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or startingup of inertial devices
Abstract
Description
Technical field
The present invention relates to measurement technology, be exactly specifically a kind of spacecraft Attitude motion simulation platform highprecision attitude defining method.
Background technology
The air film that spacecraft Attitude motion simulation platform (also referred to as threeaxis airbearing table) is formed between airbearing and bearing block according to pneumatically, simulation stage body is made to float, thus realizing approximate friction free relative motion condition, with spacecrafts such as analog satellites at the only small mechanical environment of disturbance torque suffered by outer space.As the universal simulator of spacecraft Attitude motion, threeaxis airbearing table can carry out the physical simulation experiment checking of aircraft manufacturing technology systematic function and analyze, and is the important means in spacecraft development process and method.
Spacecraft Attitude motion simulation platform requires over attitude measurement system in process of the test and dynamically provides the attitude information such as attitude angle, angular speed, to complete to control closed loop, special construction due to spacecraft Attitude motion simulation platform, the device (such as rotary transformer, inductosyn, photoelectric code disk, grating etc.) in the past measured for turntable is not suitable for the measurement of spacecraft Attitude motion simulation platform, it is necessary to consider new measuring method and device.And in current practice, the height of attitude measurement system precision is directly connected to the effect of lG simulation test.
Find through searching document, Chinese invention patent application number: 201110249979.2, patent name is threeaxis airbearing table highprecision attitude angle measuring devices and methods therefor, this patent surrounding bottom threeaxis airbearing table table top is installed guide rail, windowblind and marker, artificial lighting system and digital CCD camera and is arranged on lifting platform.Digital CCD camera gathers the image of marker and is transferred on the computer of responsible image procossing, by marker carries out subpixel positioning, obtains the accurate coordinates of marker, thus the relative attitude angle calculated between marker and digital CCD camera.But due to the defect on system constructing, certainty of measurement is restricted, thus affecting its actually used scope.
Chinese invention patent application number: 201310134631.8, patent name is: threeaxis airbearing table highprecision attitude angle and angular velocity measurement device, this patent installs intelligence side head, gyroscope and kaleidoscope prism on the platform of threeaxis airbearing table, laser tracker and two photoelectric autocollimators are installed under platform, directly obtain attitude information according to the data of laser tracker, two photoelectric autocollimators and gyroscope.But this patent processes part in data filtering, do not consider that deviation quaternary digitaltoanalogue is the constraints of 1, directly adopt Kalman filtering, it is easy to causing error covariance matrix to occur unusual, cause data scatter, attitude determines failure.This patent does not account for laser tracker and the attitude parameter conversion of photoelectric autocollimator output information, gyroscope measure the processes such as coordinate system demarcation.Carry out additionally, data process is arranged under platform with communications portion, does not meet practical situation.
(it is published in aerospace journal at document " threeaxis airbearing table single frame servo angle measurement systematic research ", 1996,17th volume, 4th phase, the page number: 7174) in, Zhang Xiaoyou, Liu Dun of Harbin Institute of Technology and the Li Jisu etc. of Beijing Control Engineering Inst. propose a kind of single frame servo measurement scheme, this system installs an arc arms that can rotate around air floating table center plumb line on air floating table base, and mounted thereon transportable balladeur train, by the attitude information of the rotation of sensitive arc arms and the traverse measurement air floating table of balladeur train.When this system needs to increase complicated mechanical system and sensor system, mechanism is complicated, and engineer applied is more difficult, and its precision is subject to the restriction of machinery and sensor, is extremely difficult to high accuracy.
Summary of the invention
Attitude for spacecraft Attitude motion simulation platform determines problem, it is an object of the invention to provide a kind of spacecraft Attitude motion simulation platform highprecision attitude defining method, the method is a kind of improved method determined based on the attitude of EKF, by the output information of laser tracker and gyro is carried out Data Fusion Filtering process, obtain the attitude information of spacecraft Attitude motion simulation platform.
The present invention is achieved in that a kind of spacecraft Attitude motion simulation platform highprecision attitude defining method, the equipment adopted includes laser tracker, intelligence gauge head, gyroscope and two industrial control computers, and laser tracker is installed under the platform of spacecraft Attitude motion simulation platform；Before attitude is determined, intelligence gauge head is arranged under platform, coordinate the measurement coordinate system of laser tracker Calibration of Laser tracker, attitude is determined in process, intelligence gauge head is fixed on the platform of spacecraft Attitude motion simulation platform, having target alignment system on intelligence gauge head, laser tracker coordinates intelligence gauge head can follow the tracks of and determine the threedimensional perspective of intelligence gauge head rotation and the threedimensional distance of movement；Gyroscope is fixed on the platform of spacecraft Attitude motion simulation platform, the angular rate information of output spacecraft Attitude motion simulation platform；First industrial control computer is arranged on the platform of spacecraft Attitude motion simulation platform, carries out data processing work；Second industrial control computer is arranged under platform, gathers the output data of laser tracker, and by wireless network, is sent to the first industrial control computer；First industrial control computer receives the attitude data of laser tracker and gyroscope, and carry out Data Fusion Filtering process, the attitude angle information of output spacecraft Attitude motion simulation platform, demarcates the drift of gyroscope simultaneously, revises the output angle speed of gyroscope in real time.
The present invention also has the feature that
1, a kind of spacecraft Attitude motion simulation platform highprecision attitude defining method as above, the method that wherein Data Fusion Filtering processes is as follows:
Step 1: according to attitude parameter conversion formula, adopts 312 turns of sequences, utilize air floating table attitude angle θ that laser tracker exports,ψ calculates the coordinate conversion matrix A obtaining air floating table body coordinate system relative inertness system_{ib}:
Wherein, θ,ψ is the air floating table attitude angle of laser tracker output；
Calculate further and obtain attitude quaternion:
Step 2: the state equation of structure system
Select the vector section Q of deviation quaternary number_{e}State variable X (t) sextuple with gyroscopic drift deviation delta b composition, the state equation of structure system:
Namely
Wherein
F is the state matrix of system, and G is that systematic procedure noise drives matrix, and ω is the angle of rotation speed projection in body coordinate system of the body coordinate system relative inertness system of spacecraft Attitude motion simulation platform,It is the coordinate conversion matrix of the body coordinate system of the measurement coordinate system space attitude of flight vehicle motion simulation platform of gyro, n_{g}It is the measurement noise of gyro, n_{s}It it is the driving noise of the associated drift of gyro；
Slidingmodel control:
X_{k}=Φ_{K, k1}X_{k1}+Γ_{k1}W_{k1}(6)
Wherein
T is sampling time interval, W_{k1}It it is the process noise of system；
Step 3: the measurement equation of structure system
Choose the vector section Q of deviation quaternary number_{e}For measuring value Z_{k}, the measurement equation of structure system:
Wherein
H_{k}=[I_{3×3}0_{3×3}](9)
H_{k}It is measurement matrix, V_{k}It is the measurement noise of laser tracker,It it is the coordinate conversion matrix of the measurement coordinate system relative inertness coordinate system of laser tracker；
Step 4: a step recursion prediction
In the k moment, it is known that the attitude quaternion estimated value in k1 momentThe estimated value of gyroscopic driftThe measurement angular speed u of gyro_{k1}, measure the output quaternary number q obtaining current k moment laser tracker_{k}, the output angle speed u of gyroscope_{k}；
Owing to quaternary number exists the constraints that mould is 1 and the multiplication cross operation relation of deviation quaternary number, process is predicted for a step recursion, it is necessary to the separately performed discussion of the gyroscopic drift in state variable and attitude quaternion:
(4.1) a step recursion predictive value of gyroscopic drift
Due to gyroscopic drift change slowly, the gyroscopic drift in k moment is exactly the estimated value in k1 momentThat is:
(4.2) a step recursion predictive value of attitude quaternion
Kinematical equation according to attitude quaternion, obtains the rate of change of k1 moment attitude quaternion
Wherein,It is the correction value of k1 moment gyro output angle speed, the i.e. estimated value of spacecraft Attitude motion simulation platform angular speed, by utilizing gyroscopic drift to estimateGyro is exported u_{k1}In drift components reject obtain:
UtilizeThe method adopting correlation values integration, can obtain a step recursion predictive value of k moment attitude quaternion
Further, the definition according to deviation quaternary number, utilize a step recursion predictive value of attitude quaternionOutput q with laser tracker_{k}, obtain a step recursion predictive value of deviation quaternary number
Step 5: state updates
Carry out state renewal according to following formula, obtain the filtering estimated value of deviation quaternary number vector sectionFiltering estimated value with gyroscope (3) drift bias
P_{k}=(1K_{k}Hk_{)}P_{k/k1}(16)
Wherein Q_{k}It is process noise statistical matrix,R_{k}It is measurement noise statistical matrix,P_{k/k1}It it is a step recursion prediction matrix of error statistics characteristic；K_{k}It it is filtering gain matrix；P_{k}It it is error covariance matrix；
Step 6: attitude filtering information merges
Owing to quaternary number exists the constraints that mould is 1 and the multiplication cross operation relation of deviation quaternary number, attitude filtering information fusion process is also required to gyroscopic drift and attitude quaternion are separately discussed:
(6.1) the filtering estimated value of gyroscopic drift
Gyroscopic drift deviation filtering estimated valueWith gyroscopic drift one step recursion predictive valueIt is added, obtains the filtering estimated value of gyroscopic drift
(6.2) the filtering estimated value of attitude quaternion
Definition according to deviation quaternary number, obtains the filtering estimated value of attitude quaternion
Step 7: output attitude parameter
(7.1) spacecraft Attitude motion simulation platform angular speed
Utilize the filtering estimated value of gyroscopic driftBy gyro output angle speed u_{k}In drift value exclude, namely obtain spacecraft Attitude motion simulation platform angular speed
(7.2) spacecraft Attitude motion simulation platform attitude angleθ, ψ:
Conversion formula according to attitude parameter, utilizes the filtering estimated value of attitude quaternionThe attitude angle of spacecraft Attitude motion simulation platform current time can be obtained:
2, a kind of spacecraft Attitude motion simulation platform highprecision attitude defining method as above, the wherein coordinate conversion matrix of the measurement coordinate system relative inertness coordinate system of laser trackerScaling method be:
Use laser tracker measurement space attitude of flight vehicle motion simulation platform attitude angle time, it is necessary to the measurement coordinate system of known laser tracker relative to the position relation between inertial coodinate system, i.e. the measurement coordinate system O of Calibration of Laser tracker_{s}X_{s}Y_{s}Z_{s}, concrete grammar is as follows:
Initial point in inertial coodinate system and survey on east northeast both direction axle and place three target balls on measured fixing point respectively, measure three target balls and measure the coordinate in coordinate system at laser tracker, thus calibrating laser tracker to measure the position relation between coordinate system relative inertness coordinate system
First adjust laser tracker and make its level, measure O again through laser tracker_{s}Target ball [0y on point and north orientation axle_{1}0]^{T}Coordinate in laser tracker coordinate system is [abc] respectively^{T}[xyz]^{T}, had by homogeneous coordinate transformation relation:
Thus solve θ_{is}, due to laser tracker level, therefore laser tracker measures coordinate system O_{s}X_{s}Y_{s}Z_{s}Relative inertness coordinate system O_{i}X_{i}Y_{i}Z_{i}Between coordinate conversion matrixFor:
3, a kind of spacecraft Attitude motion simulation platform highprecision attitude defining method as above, gyro measures the coordinate conversion matrix of coordinate system space attitude of flight vehicle motion simulation platform body coordinate systemScaling method, as follows:
Installation according to gyroscope and measurement, show that gyroscope measures coordinate system O_{g}X_{g}Axle forward and platform body coordinate system O_{b}X_{b}Axle, O_{b}Y_{b}Axle, O_{b}Z_{b}Angle α between axle forward_{1}、α_{1}、α_{3}, O_{g}Y_{g}Axle forward and platform body coordinate system O_{b}X_{b}Axle, O_{b}Y_{b}Axle, O_{b}Z_{b}Angle β between axle forward_{1}、β_{2}、β_{3}, O_{g}Z_{g}Axle forward and platform body coordinate system O_{b}X_{b}Axle, O_{b}Y_{b}Axle, O_{b}Z_{b}Angle γ between axle forward_{1}、γ_{2}、γ_{3}, then gyroscope measures coordinate system O_{g}X_{g}Y_{g}Z_{g}Space attitude of flight vehicle motion simulation platform body coordinate system O_{b}X_{b}Y_{b}Z_{b}Rotational transformation matrixFor:
The present invention provides a kind of spacecraft Attitude motion simulation platform highprecision attitude defining method, measurement device is installed simple, certainty of measurement is high, can the dynamically attitude angle of noncontacting measurement spacecraft Attitude motion simulation platform and angular rate information, and demarcate the drift of gyroscope simultaneously, revise the output angle speed of gyroscope in real time.The present invention builds ground physical simulation experiment device, on platform, the output information of laser tracker and gyro is carried out Data Fusion Filtering process, more conforms to real work situation, has higher realtime.The present invention is also used for the accurate measurement of single axle table attitude angle, angular speed.
Accompanying drawing explanation
Fig. 1 is the composition schematic diagram that spacecraft Attitude motion simulation platform highprecision attitude determines device；
Fig. 2 is spacecraft Attitude motion simulation platform attitude angle precision curve chart；
Fig. 3 is spacecraft Attitude motion simulation platform angle speed precision curve chart；
Fig. 4 is the schematic diagram that Calibration of Laser tracker measures coordinate system；
Fig. 5 is each ordinate transform relation schematic diagram；
Fig. 6 is the communication pattern schematic diagram that spacecraft Attitude motion simulation platform highprecision attitude determines device.
Detailed description of the invention
Below in conjunction with accompanying drawing citing, the invention will be further described.
Embodiment 1:
In conjunction with Fig. 1, one spacecraft Attitude motion simulation platform highprecision attitude defining method of the present invention, the equipment adopted includes laser tracker 1, intelligence gauge head 2, gyroscope 3 and two industrial control computers 4.5, and laser tracker 1 is installed under the platform of spacecraft Attitude motion simulation platform；Before attitude is determined, intelligence gauge head 2 is arranged under platform, coordinate the measurement coordinate system of laser tracker 1 Calibration of Laser tracker 1, attitude is determined in process, intelligence gauge head 2 is fixed on the platform of spacecraft Attitude motion simulation platform, having target alignment system on intelligence gauge head 2, laser tracker 1 coordinates intelligence gauge head 2 can follow the tracks of and determine the threedimensional perspective of intelligence gauge head 2 rotation and the threedimensional distance of movement；Gyroscope 3 is fixed on the platform of spacecraft Attitude motion simulation platform, the angular rate information of output spacecraft Attitude motion simulation platform；First industrial control computer 4 is arranged on the platform of spacecraft Attitude motion simulation platform, carries out data processing work；Second industrial control computer 5 is arranged under platform, gathers the output data of laser tracker 1, and by wireless network, is sent to the first industrial control computer 4；First industrial control computer 4 receives laser tracker 1 and the attitude data of gyroscope 3, and carry out Data Fusion Filtering process, the attitude angle information of output spacecraft Attitude motion simulation platform, demarcates the drift of gyroscope 3 simultaneously, revises the output angle speed of gyroscope 3 in real time.
Realize step as follows:
Step one: open device power supply (DPS), carries out next step after each equipment has preheated；
Step 2: the measurement coordinate system of Calibration of Laser tracker 1；
Step 3: demarcate the measurement coordinate system of gyroscope 3；
Step 4: build wireless network, it is achieved the network service of two industrial control computers 4.5 above and below the stage；
Step 5: utilize the output data of laser tracker 1 and gyroscope 3, obtains attitude angle and the angular rate information of air floating table by Data Fusion Filtering software 6.
The present invention utilizes laser tracker 1 and gyroscope 3 to combine the highprecision attitude realizing spacecraft Attitude motion simulation platform to determine, wherein laser tracker 1 can select Leica company of Switzerland AT901 product or the product of API company of the U.S., this sentences Leica company AT901 product is example, the certainty of measurement of its 3 d pose angle is 3, and " (3 σ) measures and ranges up to ± 60 °.During use, laser tracker 1 is arranged on the support under air floating table, intelligence gauge head 2 is arranged on air floating table platform and moves together with stage body, the visual field demand between laser tracker 1 optical axis and intelligence gauge head 2 target ball is ensured during installation, to ensure that test system does not lose measurement degree of freedom in the course of the work, laser tracker 1 calculates the relative attitude information of intelligence gauge head 2 in real time according to measurement data.
The measurement of spacecraft Attitude motion simulation platform angular speed is realized by high accuracy hemispherical resonant gyro.Hemispherical resonant gyro is vertically mounted on the spacecraft Attitude motion simulation platform center after leveling, and its sensitive axes is vertical with spacecraft Attitude motion simulation platform rotating shaft.The output of hemispherical resonant gyro contains the constant value drift of spacecraft Attitude motion simulation platform, associated drift, the drift noises such as measurement noise, when actually used, adopt the attitude information output angle speed through Data Fusion Filtering software correction gyro of laser tracker.
Embodiment 2:
The present invention proposes a kind of spacecraft Attitude motion simulation platform attitude based on EKF and determines improvement project, build ground physical simulation experiment device, by the output information of laser tracker and gyroscope is carried out Data Fusion Filtering process, obtain the attitude information of spacecraft Attitude motion simulation platform, specifically comprise the following steps that
Step 1: according to attitude parameter conversion formula, adopts 312 turns of sequences, utilize air floating table attitude angle θ that laser tracker exports,ψ calculates the coordinate conversion matrix A obtaining air floating table body coordinate system relative inertness system_{ib}:
Wherein, θ,ψ is the air floating table attitude angle of laser tracker output；
Calculate further and obtain attitude quaternion:
Step 2: the state equation of structure system
Select the vector section Q of deviation quaternary number_{e}State variable X (t) sextuple with gyroscopic drift deviation delta b composition, the state equation of structure system:
Namely
Wherein
F is the state matrix of system, and G is that systematic procedure noise drives matrix, and ω is the angle of rotation speed projection in body coordinate system of the body coordinate system relative inertness system of spacecraft Attitude motion simulation platform,It is the coordinate conversion matrix of the body coordinate system of the measurement coordinate system space attitude of flight vehicle motion simulation platform of gyro, n_{g}It is the measurement noise of gyro, n_{s}It it is the driving noise of the associated drift of gyro；
Slidingmodel control:
X_{k}=Φ_{K, k1}X_{k1}+Γ_{k1}W_{k1}(31)
Wherein
T is sampling time interval, W_{k1}It it is the process noise of system；
Step 3: the measurement equation of structure system
Choose the vector section Q of deviation quaternary number_{e}For measuring value Z_{k}, the measurement equation of structure system:
Wherein
H_{k}=[I_{3×3}0_{3×3}](34)
H_{k}It is measurement matrix, V_{k}It is the measurement noise of laser tracker,It it is the coordinate conversion matrix of the measurement coordinate system relative inertness coordinate system of laser tracker；
Step 4: a step recursion prediction
In the k moment, it is known that the attitude quaternion estimated value in k1 momentThe estimated value of gyroscopic driftThe measurement angular speed u of gyro_{k1}, measure the output quaternary number q obtaining current k moment laser tracker_{k}, the output angle speed u of gyroscope_{k}；
Owing to quaternary number exists the constraints that mould is 1 and the multiplication cross operation relation of deviation quaternary number, process is predicted for a step recursion, it is necessary to the separately performed discussion of the gyroscopic drift in state variable and attitude quaternion:
(4.1) a step recursion predictive value of gyroscopic drift
Due to gyroscopic drift change slowly, the gyroscopic drift in k moment is exactly the estimated value in k1 momentThat is:
(4.2) a step recursion predictive value of attitude quaternion
Kinematical equation according to attitude quaternion, obtains the rate of change of k1 moment attitude quaternion
Wherein,It is the correction value of k1 moment gyro output angle speed, the i.e. estimated value of spacecraft Attitude motion simulation platform angular speed, by utilizing gyroscopic drift to estimateGyro is exported u_{k1}In drift components reject obtain:
UtilizeThe method adopting correlation values integration, can obtain a step recursion predictive value of k moment attitude quaternion
Further, the definition according to deviation quaternary number, utilize a step recursion predictive value of attitude quaternionOutput q with laser tracker_{k}, obtain a step recursion predictive value of deviation quaternary number
Step 5: state updates
Carry out state renewal according to following formula, obtain the filtering estimated value of deviation quaternary number vector sectionFiltering estimated value with gyroscope (3) drift bias
P_{k}=(1K_{k}H_{k})P_{k/k1}(41)
Wherein Q_{k}It is process noise statistical matrix,R_{k}It is measurement noise statistical matrix,P_{k/k1}It it is a step recursion prediction matrix of error statistics characteristic；K_{k}It it is filtering gain matrix；P_{k}It it is error covariance matrix；
Step 6: attitude filtering information merges
Owing to quaternary number exists the constraints that mould is 1 and the multiplication cross operation relation of deviation quaternary number, attitude filtering information fusion process is also required to gyroscopic drift and attitude quaternion are separately discussed:
(6.1) the filtering estimated value of gyroscopic drift
Gyroscopic drift deviation filtering estimated valueWith gyroscopic drift one step recursion predictive valueIt is added, obtains the filtering estimated value of gyroscopic drift
(6.2) the filtering estimated value of attitude quaternion
Definition according to deviation quaternary number, obtains the filtering estimated value of attitude quaternion
Step 7: output attitude parameter
(7.1) spacecraft Attitude motion simulation platform angular speed
Utilize the filtering estimated value of gyroscopic driftBy gyro output angle speed u_{k}In drift value exclude, namely obtain spacecraft Attitude motion simulation platform angular speed
(7.2) spacecraft Attitude motion simulation platform attitude angleθ, ψ:
Conversion formula according to attitude parameter, utilizes the filtering estimated value of attitude quaternionThe attitude angle of spacecraft Attitude motion simulation platform current time can be obtained:
In conjunction with Fig. 23, the certainty of measurement of laser tracker is 3 " (3 σ); the constant value drift of gyroscope is 1.5 °/h (3 σ); random drift is 0.003 °/h (3 σ); measurement noise is 10 " (3 σ), through mathematical simulation, spacecraft Attitude motion simulation platform attitude angle precision is 0.05 ", angle speed precision is 0.7 ".
Embodiment 3:
In conjunction with Fig. 4, introduce the measurement coordinate system O of laser tracker_{s}X_{s}Y_{s}Z_{s}Relative inertness coordinate system O_{i}X_{i}Y_{i}Z_{i}Coordinate conversion matrixScaling method.
First adjust laser tracker and make its level, measure O again through laser tracker_{s}Target ball [0y on point and north orientation axle_{1}0]^{T}Coordinate in laser tracker coordinate system is [abc] respectively^{T}[xyz]^{T}, had by homogeneous coordinate transformation relation:
Thus can solve θ_{is}, due to laser tracker level, therefore measured coordinate system O by laser tracker_{s}X_{s}Y_{s}Z_{s}Relative inertness coordinate system O_{i}X_{i}Y_{i}Z_{i}Between coordinate conversion matrixFor:
Embodiment 4:
In conjunction with Fig. 5, introduce gyro and measure coordinate system O_{g}X_{g}Y_{g}Z_{g}Space attitude of flight vehicle motion simulation platform body coordinate system O_{b}X_{b}Y_{b}Z_{b}Coordinate conversion matrixScaling method, as follows
Installation according to gyroscope and measurement, show that gyroscope measures coordinate system O_{g}X_{g}Axle forward and platform body coordinate system O_{b}X_{b}Axle, O_{b}Y_{b}Axle, O_{b}Z_{b}Angle α between axle forward_{1}、α_{2}、α_{3}, O_{g}Y_{g}Axle forward and platform body coordinate system O_{b}X_{b}Axle, O_{b}Y_{b}Axle, O_{b}Z_{b}Angle β between axle forward_{1}、β_{2}、β_{3}, O_{g}Z_{g}Axle forward and platform body coordinate system O_{b}X_{b}Axle, O_{b}Y_{b}Axle, O_{b}Z_{b}Angle γ between axle forward_{1}、γ_{2}、γ_{3}, then gyroscope measures coordinate system O_{g}X_{g}Y_{g}Z_{g}Space attitude of flight vehicle motion simulation platform body coordinate system O_{b}X_{b}Y_{b}Z_{b}Rotational transformation matrixFor:
Embodiment 5:
In conjunction with Fig. 6, introduce spacecraft Attitude motion simulation platform highprecision attitude and determine the communication pattern of device.
Industrial control computer on platform gathers the angular rate data from gyroscope output by data acquisition scale.Industrial control computer under platform gathers the attitude angle data from laser tracker output by data acquisition scale, and is sent to the industrial control computer on platform by wireless network.Industrial control computer on platform utilizes wireless network to receive the data from the industrial control computer under platform, and carry out Data Fusion Filtering process, the attitude angle information of output spacecraft Attitude motion simulation platform, demarcate the drift of gyroscope simultaneously, revise the output angle speed of gyroscope in real time.
Claims (4)
Priority Applications (1)
Application Number  Priority Date  Filing Date  Title 

CN201410195936.4A CN104006787B (en)  20140501  20140501  Spacecraft Attitude motion simulation platform highprecision attitude defining method 
Applications Claiming Priority (1)
Application Number  Priority Date  Filing Date  Title 

CN201410195936.4A CN104006787B (en)  20140501  20140501  Spacecraft Attitude motion simulation platform highprecision attitude defining method 
Publications (2)
Publication Number  Publication Date 

CN104006787A CN104006787A (en)  20140827 
CN104006787B true CN104006787B (en)  20160706 
Family
ID=51367562
Family Applications (1)
Application Number  Title  Priority Date  Filing Date 

CN201410195936.4A CN104006787B (en)  20140501  20140501  Spacecraft Attitude motion simulation platform highprecision attitude defining method 
Country Status (1)
Country  Link 

CN (1)  CN104006787B (en) 
Families Citing this family (12)
Publication number  Priority date  Publication date  Assignee  Title 

CN104298128A (en) *  20140929  20150121  哈尔滨工业大学  Ground simulation method for spacecraft navigation guidance technology 
CN104296908B (en) *  20140929  20160824  哈尔滨工业大学  Three freedom degree air floating platform disturbance torque composition measuring apparatus 
CN104898681B (en) *  20150504  20170728  浙江工业大学  A kind of quadrotor attitude acquisition method for approximately finishing card quaternary number using three ranks 
CN106247988B (en) *  20150611  20180720  北京卫星环境工程研究所  Celestial body posture based on laser tracker and solar wing spreading frame accuracy measurement method 
CN105300597B (en) *  20150804  20180102  上海卫星工程研究所  Threeaxis airbearing table barycenter balancing method and device 
CN105180966B (en) *  20150805  20180330  哈尔滨工业大学  A kind of method optimized based on Kalman filtering to secondary platform line array CCD measurement inclination angle 
CN105312771B (en) *  20151127  20170125  上海新跃仪表厂  Laser equipment for leveling harmonic oscillator with axisymmetric structure and method adopting laser equipment 
CN106197395A (en) *  20160323  20161207  南京航空航天大学  A kind of air floating table position and attitude based on NI CVS determines method 
CN105865432B (en) *  20160331  20170718  北京航空航天大学  A kind of mixed filtering method and test platform for many source noises of gyroscope 
CN105651242B (en) *  20160405  20180824  清华大学深圳研究生院  A method of fusion attitude angle is calculated based on complementary Kalman filtering algorithm 
CN107702710B (en) *  20170817  20201002  上海航天控制技术研究所  Multigyroscope gauge head constant drift realtime estimation method 
CN109724593A (en) *  20171027  20190507  北京精密机电控制设备研究所  A kind of air bearing simulator position and posture tracking measurement method 
Citations (2)
Publication number  Priority date  Publication date  Assignee  Title 

CN102426007A (en) *  20110829  20120425  哈尔滨工业大学  Highprecision method for measuring attitude angle of triaxial air bearing table and measurement device thereof 
CN103234512A (en) *  20130403  20130807  哈尔滨工业大学  Triaxial air bearing table highprecision attitude angle and angular velocity measuring device 

2014
 20140501 CN CN201410195936.4A patent/CN104006787B/en active IP Right Grant
Patent Citations (2)
Publication number  Priority date  Publication date  Assignee  Title 

CN102426007A (en) *  20110829  20120425  哈尔滨工业大学  Highprecision method for measuring attitude angle of triaxial air bearing table and measurement device thereof 
CN103234512A (en) *  20130403  20130807  哈尔滨工业大学  Triaxial air bearing table highprecision attitude angle and angular velocity measuring device 
NonPatent Citations (5)
Title 

"五自由度气浮仿真试验台位置和姿态控制系统研究";王捷冰;《哈尔滨工业大学硕士学位论文》;20110531;全文 * 
"基于半球谐振陀螺与星敏感器的星载姿态测量系统实现";伊国兴等;《中国惯性技术学报》;20120229;第20卷(第1期);5862 * 
"基于半球谐振陀螺的捷联惯性姿态系统的一种粒子滤波方法";沈博昌等;《宇航学报》;20090331;第30卷(第2期);620624 * 
"基于视觉和扩展卡尔曼滤波的位姿和运动估计新方法";伍雪冬;《仪器仪表学报》;20041031;第25卷(第5期);676680 * 
"空间飞行器姿态控制仿真实验平台系统研究与设计";鲁兴举;《国防科技大学硕士学位论文》;20061130;全文 * 
Also Published As
Publication number  Publication date 

CN104006787A (en)  20140827 
Similar Documents
Publication  Publication Date  Title 

US9541392B2 (en)  Surveying system and method  
Li et al.  LIDAR/MEMS IMU integrated navigation (SLAM) method for a small UAV in indoor environments  
Cho et al.  Wind estimation and airspeed calibration using a UAV with a singleantenna GPS receiver and pitot tube  
Syed et al.  A new multiposition calibration method for MEMS inertial navigation systems  
CN103424114B (en)  A kind of full combined method of vision guided navigation/inertial navigation  
US8005635B2 (en)  Selfcalibrated azimuth and attitude accuracy enhancing method and system (SAAAEMS)  
US8151475B2 (en)  North finding device, system and method  
CN101893440B (en)  Celestial autonomous navigation method based on star sensors  
CN101788296B (en)  SINS/CNS deep integrated navigation system and realization method thereof  
CN103033189B (en)  Inertia/vision integrated navigation method for deepspace detection patrolling device  
CN104655131B (en)  Inertial navigation Initial Alignment Method based on ISTSSRCKF  
US8311757B2 (en)  Miniaturized smart selfcalibration electronic pointing method and system  
CN101514900B (en)  Method for initial alignment of a singleaxis rotation strapdown inertial navigation system (SINS)  
Lai et al.  Development of a lowcost attitude and heading reference system using a threeaxis rotating platform  
US5331578A (en)  Procedure for measuring angles and trajectories by means of gyros and inertial systems  
CN103471616B (en)  Initial Alignment Method under a kind of moving base SINS Large azimuth angle condition  
CN103245359B (en)  A kind of inertial sensor fixed error realtime calibration method in inertial navigation system  
CN102809377B (en)  Aircraft inertia/pneumatic model Combinated navigation method  
CN101660914B (en)  Airborne starlight of coupling inertial position error and independent navigation method of inertial composition  
CN106289246B (en)  A kind of flexible link arm measure method based on position and orientation measurement system  
US6876926B2 (en)  Method and system for processing pulse signals within an inertial navigation system  
CN103323026B (en)  The attitude reference estimation of deviation of star sensor and useful load and modification method  
CN100565115C (en)  The scaling method of multiposition strapping northseeking system direction effect  
Barczyk et al.  Integration of a triaxial magnetometer into a helicopter UAV GPSaided INS  
CN103575299B (en)  Utilize dualaxis rotation inertial navigation system alignment and the error correcting method of External Observation information 
Legal Events
Date  Code  Title  Description 

PB01  Publication  
C06  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 