CN101712381A - Multi-sensor-based attitude determination system - Google Patents
Multi-sensor-based attitude determination system Download PDFInfo
- Publication number
- CN101712381A CN101712381A CN200910237658A CN200910237658A CN101712381A CN 101712381 A CN101712381 A CN 101712381A CN 200910237658 A CN200910237658 A CN 200910237658A CN 200910237658 A CN200910237658 A CN 200910237658A CN 101712381 A CN101712381 A CN 101712381A
- Authority
- CN
- China
- Prior art keywords
- information
- particle
- subsystem
- ant
- attitude determination
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Navigation (AREA)
Abstract
The invention provides a multi-sensor-based attitude determination system, which comprises a sensitive subsystem, a signal acquisition and preprocessing subsystem and an integrated processing subsystem, wherein the sensitive subsystem integrates four classes of sensitive parts such as star sensitive probes, sun sensitive probes, fiber optic gyros and magnetic field probes; the signal acquisition and preprocessing subsystem is realized by an FPGA chip and a peripheral circuit thereof, parallelly receives output data of the four classes of sensitive probes and completes the smoothing and preprocessing of the data; and finally, the integrated processing subsystem taking a DSP (or ARM) chip as a core is utilized to realize the high-precision attitude determination of the system by an ant colony particle filter-based combined attitude determination method according to sunlight information, starlight information, inertial information and geomagnetic information after smoothing and preprocessing. The multi-sensor-based attitude determination system with high precision, integration level and reliability is realized, and has important practical significance for high-resolution earth observation of new-generation earth observation satellites.
Description
Technical field
The present invention relates to a kind of attitude determination system of the multi-sensor based on star sensor/sun sensor/fiber optic gyro/magnetometer, be applicable to that the fine resolution earth observation of earth observation satellite of new generation and space environment distributed networking are surveyed with the High Performance of microsatellite and decide appearance.
Background technology
Along with development and national economy, urgent need utilizes the large-scale fine resolution earth observation satellite of wide cut that resources such as ocean, environment, agricultural are carried out high-resolution earth observation and monitoring, but also all is to utilize the large-scale satellite that fabric width is narrow, cost is high to realize both at home and abroad at present.And along with the develop rapidly of satellite technology, microsatellite is low, in light weight, flexible with its cost, the lead time is short and characteristics such as the networking that is easy to form into columns, and becomes an important development direction that leads following spatially distributed Detection Techniques; It can be by the formation networking, realizes big fabric width, distributed fine resolution earth observation task cheaply.
At present mostly adopt heavenly body sensors such as star sensor, sun sensor, horizon instrument with the combined mode of inertia angular rate sensor spacecraft to be carried out deciding appearance both at home and abroad, this not only can make volume, weight big, and integrated level is low and the disposal system redundancy.U.S.'s Draper laboratory development in 2004 gone out that a kind of volume is less, power consumption is lower, in light weight, accuracy of attitude determination is higher, be applicable to microsatellite, and (weight is about 10～100kg, and the energy that carries is less) decides the integrated attitude determination system of appearance---inertia fixed star compass; It is integrated star sensor, MEMS inertia angular rate gyroscope and three parts of disposal system, continual attitude information can be provided, but its inertia information process unit all is to separate to exist with the quick information process unit of star, thereby integrated level is not high, and then causes volume and power consumption to be difficult to satisfy High Performance deciding the appearance requirement.Patent ZL200610165166.4 has proposed a kind of micro nano spacecraft microminiature, low power consumption inertial fixed star compass, though solved inertia information process unit and the integrated problem of the quick information process unit of star, but decide appearance for the high precision of fine resolution earth observation satellite is highly reliable, but exist because the quick information of star is easy to lose under the quick maneuvering condition of attitude, make the inertia device error can't revise and then cause accuracy of attitude determination to reduce, and adopt the situation that is only applicable to Gaussian noise based on the integrated attitude determination method of optimum REQUEST algorithm and UKF filtering.
Summary of the invention
Technology of the present invention is dealt with problems and is: overcome the deficiencies in the prior art, a kind of small size, high integration, high precision, high reliability are provided, be applicable to the performance-oriented attitude determination system based on multi-sensor of fine resolution earth observation maneuvering satellite.
Technical solution of the present invention is: a kind of attitude determination system based on multi-sensor comprises responsive subsystem, acquisition of signal and preprocessing subsystem, comprehensive treatment subsystem; Described responsive subsystem is integrated star sensing probe, sun sensing probe, fiber optic gyro and three-axle magnetic field this four classes sensing unit of popping one's head in, its culminant star sensing probe and sun sensing probe are realized the sensitivity to starlight information and sunshine information respectively, starlight information is become corresponding electric signal with the sunshine information translation and follow and amplify; During installation, the responsive optical axis included angle of star sensing probe and sun sensing probe is 90 degree; Fiber optic gyro is finished the sensitivity to inertia information on three mutually perpendicular directions, and converts thereof into corresponding electric signal; Three-axle magnetic field probe finish on three mutually perpendicular directions the sensitivity of magnetic information, and convert thereof into corresponding electric signal; Starlight information, sunshine information, magnetic information and inertia information send into acquisition of signal and preprocessing subsystem together; Acquisition of signal and preprocessing subsystem control are sent into the comprehensive treatment subsystem after above-mentioned four kinds of information are carried out level and smooth and pretreatment; Level and smooth and the pretreated starlight information of the warp that the comprehensive treatment subsystem will receive, sunshine information, magnetic information and inertia information carry out synchronous processing, adopt integrated attitude determination method based on ant group particle filter algorithm, realize that the attitude of system is determined.
Acquisition of signal and preprocessing subsystem comprise A/D modular converter, fpga chip, configuring chip, SRAM or SDRAM memory device, clock circuit and power module, wherein the A/D modular converter will become digital signal from the starlight information translation that responsive subsystem transmits with fpga chip, finish the pretreatment operation such as star chart denoising, distortion correction, barycenter extraction of star chart data, and to sunshine information, magnetic information and inertia information level and smooth, and the result after will handling sends in the comprehensive treatment subsystem; Clock circuit provides clock signal for fpga chip, and configuring chip is a fpga chip storing software program, and SRAM or SDRAM memory device provide storage space for fpga chip, and power module provides power supply for acquisition of signal and preprocessing subsystem.
The comprehensive treatment subsystem comprises level shifter interface circuit, DSP or arm processor chip, extends out the Flash memory device, SRAM or SDRAM memory device, power module, clock circuit and serial ports expansion module, wherein level shifter interface circuit, DSP or ARM chip and serial ports expansion module receive the data from acquisition of signal and preprocessing subsystem, finish importance in star map recognition and starlight information is resolved, and associating sunshine information, magnetic information and inertia information realize that the fusion of integrated attitude determination system decides appearance; Clock circuit provides clock signal for DSP or ARM chip, and extending out the Flash memory device is DSP or ARM chip-stored software program, and SRAM or SDRAM memory device provide data space for DSP or ARM chip, and power module provides power supply for the comprehensive treatment subsystem.
Integrated attitude determination method based on ant group particle filter algorithm, be the starlight information that CM0S star sensing probe sensitivity is arrived, sunshine information in conjunction with the observation of sun sensing probe, the responsive ground magnetic information of three-axle magnetic field probe, and the inertia information that provides of the fiber optic gyro after error compensation, adopt optimum REQUEST algorithm, resolve and obtain the observation information of q battle array as ant group particle filter; This observation information is further combined with the inertia information through error compensation, by ant group particle filter algorithm, the attitude and the gyro wander that obtain integrated attitude determination system are estimated, output with the compensation gyro, resolve the attitude parameter of integrated attitude determination system at last by attitude quaternion, finish the integrated attitude determination of integrated attitude determination system.
Principle of the present invention is: utilize star sensor, sun sensor, three axis magnetometer and fiber optic gyro respectively responsive starlight information, sunshine information, magnetic information and inertia information, carry out pretreatment through A/D conversion and fpga chip, pretreated quantitative data input is arrived the comprehensive treatment subsystem.Pretreated content comprises sunshine information, level and smooth, the star chart denoising of ground magnetic information and inertia information, distortion correction and barycenter extraction etc.; The comprehensive treatment subsystem, by the Flash memory device that performance-oriented DSP or ARM chip are aided with the SRAM that extends out or SDRAM memory device and extend out, importance in star map recognition, the starlight information of carrying out star sensor resolve and based on the sunshine information of ant group particle filter algorithm, magnetic information and inertia information fusion decide appearance.
The present invention's advantage compared with prior art is:
(1) introduces sunshine information and ground magnetic information, overcome the star sensor problem that information dropout causes accuracy of attitude determination to reduce when big attitude maneuver, be applicable to the integrated attitude determination of fine resolution earth observation maneuvering satellite of new generation;
(2) based on the disposal system of DSP or ARM chip+FPGA, introduced ant group particle filter algorithm, inertia information, starlight information, sunshine information and ground magnetic information are carried out information fusion, be applicable to the situation of non-Gaussian noise, improved accuracy of attitude determination;
(3) the processing unit height of star sensor, sun sensor, fiber optic gyro and microsensor is integrated, significantly improved the integrated level of system, reduced the volume and the power consumption of system.
Description of drawings
Fig. 1 forms scheme drawing for structure of the present invention;
Fig. 2 is acquisition of signal of the present invention and preprocessing subsystem structural representation;
Fig. 3 is a comprehensive treatment subsystem structure scheme drawing of the present invention;
Fig. 4 is an overall signal diagram of circuit of the present invention;
Fig. 5 is the integrated attitude determination system integrated attitude determination diagram of circuit that the present invention is based on ant group particle filter algorithm.
The specific embodiment
As shown in Figure 1, the present invention is made up of responsive subsystem 1, acquisition of signal and preprocessing subsystem 2, comprehensive treatment subsystem 3.Responsive subsystem 1 mainly comprises CMOS star sensing probe 11, sun sensing probe 12, fiber optic gyro 13 and three-axle magnetic field probe 14, wherein CMOS star sensing probe 11 and 12 realizations of sun sensing probe are to the sensitivity of starlight information and sunshine information, the processing that converts thereof into corresponding electric signal and follow and amplify.For fear of sunshine to the interference of star sensor with make things convenient for the calculating of orbital coordinate system, the responsive optical axis stagger angle of CMOS star sensing probe 11 and sun sensing probe 12 is set to 90 degree, suppose that initial body coordinate system overlaps with orbital coordinate system, the quick optical axis direction of clock star is installed is overlapped with Z axle reversing sense, the responsive optical axis direction of the sun overlaps and points to solar direction with Y-axis; Fiber optic gyro 13 is finished the sensitivity to inertia information on three mutually perpendicular directions, and converts thereof into corresponding electric signal, three-axle magnetic field probe 14 finish on three mutually perpendicular directions the sensitivity of magnetic information, and convert thereof into corresponding electric signal.
As shown in Figure 2, be acquisition of signal of the present invention and preprocessing subsystem 2 structural representations, this subsystem comprises A/D modular converter 21, fpga chip 22, configuring chip 23, SRAM or SDRAM memory device 24, clock circuit 25 and power module 26, wherein 21 receptions of A/D modular converter are from the starlight information of responsive subsystem 1, it is carried out importing in the fpga chip 22 after the A/D conversion, wherein fpga chip 22 and supporting application configuration chip 23 thereof adopt Spartan 3 XC3S400 and the XCF02SV020C of Cypress company respectively, belong to the series matching product, avoided the appearance of compatibling problem.Extended out SRAM memory device 24 in the periphery of fpga chip 22, in order to sunshine information from responsive subsystem 1, inertia information, magnetic information and carry out buffer memory through the starlight information of A/D conversion.25 pairs of these subsystems of clock circuit provide independently clock signal, and power module 26 provides required 1.2V, 2.5V and 3.3V voltage for fpga chip 22, and provide 3.3V voltage for configuring chip 23.In the present embodiment, the starlight information that is received by 21 pairs of A/D converters is carried out analogue to digital conversion earlier, the starlight information after will changing then, and inertia information, and ground magnetic information and sunshine information transfer are in fpga chip 22.Around fpga chip 22, be provided with the SRAM memory device 24 that capacity is 2MByte, can store temporarily, play good buffer action handling forward and backward data; In configuring chip 23, packed in advance and realized comprising that star chart denoising, distortion correction, barycenter extract, and the ground magnetic information, function such as inertia information is level and smooth, when fpga chip 22 received the data that responsive subsystem 1 transmits, program was just started working.After treated, can be by starlight information and sunshine information, ground magnetic information and inertia information through ant group particle filter, obtain the attitude output of integrated attitude determination system.
Owing to be subjected to the influence of parasitic light and star sensor chip thermal noise and fixed pattern noise, cause the star map image of star sensor to be subjected to noise emission.Therefore, carry out the accurate extraction of celestial body barycenter, must carry out image denoising to star chart and handle.The design adopts the many small wave converting methods that obtain widespread use in the image denoising field, star chart is carried out the many wavelet transformations of CL, most energy centralizations of star chart in the subimage of lowest resolution, are carried out the many inverse wavelet transforms of CL to the image after the conversion, obtain the star chart after the denoising.
Because the installation error of camera lens distortion and star sensor, and the big visual field of star sensor, the characteristics of relative aperture greatly, all can cause the distortion of star map image, the displacement that shows as the image slices vegetarian refreshments causes object image-forming to deform.Distortion correction is divided into following steps: at first the spatial coordinates at ideal image place is carried out conversion, make the ideal image pixel corresponding with the locus of actual fault image pixel, obtain corresponding distortion parameter, then according to the image slices vegetarian refreshments of reality, carry out interpolation, obtain the ideal image gray values of pixel points.
In the design of star sensor, in order to obtain high-precision barycenter, generally camera lens to be carried out out of focus and handle, a star imaging has several continuous points and forms, the star chart barycenter extracts and exactly the point of this plurality of continuous is merged into same celestial body, and obtains the center of this celestial body.The method of relatively using always on the engineering is based on the star chart barycenter extraction algorithm of first moment at present, and as weights, the two-dimensional coordinate of pixel is a coefficient with gray value, obtains the centroid position of each celestial body.
The sampling frequency of inertia information and ground magnetic information is higher, should not directly send into filter and directly carry out attitude algorithm, so earlier inertia information and ground magnetic information are carried out smothing filtering,, the information behind the smothing filtering are sent into filter finish attitude algorithm to reach the purpose of frequency reducing.
As shown in Figure 3, be comprehensive treatment subsystem 3 structural representations of the present invention, this subsystem comprises level shifter interface circuit 31, DSP or ARM chip 32, extend out Flash memory device 33, SRAM or SDRAM memory device 34, power module 35, clock circuit 36 and serial ports expansion module 37, wherein level shifter interface circuit 31 is with the asterism of acquisition of signal and preprocessing subsystem 2 outputs, centroid position information and level and smooth after inertia information, sunshine information, ground magnetic information carry out sending into dsp chip (TMS320C6711) or ARM chip (AT91RM9200) 32 after the level conversion.Required software program is solidificated in the Flash memory device 33 that extends out in advance in DSP or ARM chip 32 treating processs, has also extended out SDRAM memory device 34 in addition in order to the data before and after the stores processor.36 pairs of these subsystems of clock circuit provide independently clock signal, and power module 35 provides required 1.8V core voltage and the required 3.3V voltage of peripheral circuit for DSP or ARM chip 32.Utilize fast, the operational precision advantages of higher of DSP or ARM chip 32 processing speeds, finish the function of importance in star map recognition, and then in conjunction with sunshine information, ground magnetic information and inertia information realize integrated attitude determination.In the peripheral expansion of DSP or ARM chip 32 Flash memory device 33 and equipment such as SDRAM memory device 34 and serial ports expansion module 37, wherein DSP or ARM chip 32 can directly be realized transceive data by serial ports expansion module 37, Flash memory device 33 is used to load the algorithm routine of realizing various functions, and SDRAM memory device 34 is used for the data before and after the stores processor.
As shown in Figure 4, be overall signal diagram of circuit of the present invention, starlight information is by CMOS star sensing probe 11, through behind the analogue to digital conversion, send into fpga chip 22 and carry out pretreatment, sunshine information, inertia information and ground magnetic information pass through sun sensing probe 12, fiber optic gyro 13 respectively, pop one's head in three-axle magnetic field, enter fpga chip 22 and carry out pretreatment, fpga chip 22 also can feed back simultaneously, and CMOS star sensing probe 11 is sent control signal, its exposure time of origin and concluding time are controlled, the control sun sensor, magnetometer, fiber optic gyro sends data frequency etc.Information after fpga chip 22 pretreatments just enters DSP or ARM chip 32 after the voltage transitions buffering, finish last attitude algorithm, integrated attitude determination etc. here, thereby obtains the integrated attitude determination result etc. of integrated attitude determination system.
As shown in Figure 5, integrated attitude determination system integrated attitude determination diagram of circuit based on ant group particle filter algorithm of the present invention, after the initialization, the starlight information that star sensing probe 11 sensitivities are arrived, the pop one's head in ground magnetic information of 14 sensitivities of the sunshine information of sun sensing probe 12 observation, three-axle magnetic field, and the inertia information that provides of the fiber optic gyro after error compensation 13, adopt optimum REQUEST algorithm, resolve and obtain the observation information of quaternion q battle array as ant group particle filter; This observation information is further combined with the inertia information through error compensation, by ant group particle filter, obtain the attitude quaternion of integrated attitude determination system on the one hand, obtaining gyro wander on the other hand estimates, output with the compensation gyro, resolve the attitude parameter of integrated attitude determination system at last by attitude quaternion, end of program.Wherein, ant group particle filter algorithm key step is:
(1) with the input of the quaternion q battle array that calculates and the inertia information after error compensation as ant group particle filter; On the basis of standard particle filtering algorithm,, and serve as with reference to produce N-1 particle according to standard normal distribution with it with the center particle of quaternion q battle array as standard particle filtering; Introduce ant group algorithm, carry out initialization: ant group algorithm maximum cycle Cmax, the heuristic factor-alpha of information, expect heuristic factor-beta, pheromones intensity Q, pheromones volatility coefficient ρ, ant number m and number of particles N (q, q
1, q
2..., q
N-1);
(2) m ant placed on N the particle, make the weights θ of i particle
iInitialization information amount τ
i(0) be constant, and initial time Δ τ
i(0)=0; τ
i(t) expression t moment weights θ
iQuantity of information, Δ τ
i(t) represent that all ants stay weights θ constantly at t
iOn quantity of information and, t=1,2
(3) cycle number Count=Count+1, (the Count initial value is made as 0), the taboo table tabu of ant
kCall number k=1, wherein tabu
kThe current particle of passing by of expression ant k;
(4) ant number k=k+1, the probability that the ant individuality is calculated according to following state transition probability formula is selected particle i and is advanced;
Wherein, p
i k(t) be state transition probability, η
i(t) be heuristic function, the expression ant is selected the expected degree of particle i, η
i(t)=1/ θ
i, θ
iThe weights of expression particle i;
(5) ant is moved on the new particle after choosing, and this particle is recorded in the taboo table of this ant individuality; If k＜m, then jumped to for (4) step, otherwise upgrade quantity of information on each particle according to following formula:
τ
i(t+N)=(1-ρ) τ
i(t)+Δ τ
i(t), cross weights θ when k ant
iThe time,
Wherein, L
kRepresent the total number of k ant at this circulation particle of passing by;
(6) if Count＜Cmax promptly less than the ant group algorithm maximum cycle, empties the taboo table and forwarded for (3) step to; Otherwise at this moment loop ends is optimized and screens current particle, duplicates excellent particle, and keeping weights and be more greatly the many particles of quantity of information and eliminating weights little is the little particle of quantity of information; The less particle of weights is exchanged and makes a variation, avoid the particle tcam-exhaustion; Utilize the particle that duplicates, exchanges and make a variation then, and carry out particle filter in conjunction with inertia information and finish attitude and gyro wander estimation, and gyro wander is fed back to inertia information, error compensation.
The content that is not described in detail in the specification sheets of the present invention belongs to this area professional and technical personnel's known prior art.
Claims (5)
1. the attitude determination system based on multi-sensor is characterized in that: comprise responsive subsystem (1), acquisition of signal and preprocessing subsystem (2), comprehensive treatment subsystem (3); Described responsive subsystem (1) is integrated star sensing probe (11), sun sensing probe (12), fiber optic gyro (13) and three-axle magnetic field probe (14) this four classes sensing unit, its culminant star sensing probe (11) and sun sensing probe (12) are realized the sensitivity to starlight information and sunshine information respectively, starlight information is become corresponding electric signal with the sunshine information translation and follow and amplify; During installation, the responsive optical axis included angle of star sensing probe (11) and sun sensing probe (12) is 90 degree; Fiber optic gyro (13) is finished the sensitivity to inertia information on three mutually perpendicular directions, and converts thereof into corresponding electric signal; Three-axle magnetic field probe (14) finish on three mutually perpendicular directions the sensitivity of magnetic information, and convert thereof into corresponding electric signal; Starlight information, sunshine information, magnetic information and inertia information send into acquisition of signal and preprocessing subsystem (2) together; Acquisition of signal and preprocessing subsystem control (2) are sent into comprehensive treatment subsystem (3) after above-mentioned four kinds of information are carried out level and smooth and pretreatment; Level and smooth and the pretreated starlight information of the warp that comprehensive treatment subsystem (3) will receive, sunshine information, magnetic information and inertia information carry out synchronous processing, adopt integrated attitude determination method based on ant group particle filter algorithm, realize that the attitude of system is determined.
2. a kind of attitude determination system according to claim 1 based on multi-sensor, it is characterized in that: described acquisition of signal and preprocessing subsystem (2) comprise A/D modular converter (21), fpga chip (22), configuring chip (23), SRAM or SDRAM memory device (24), clock circuit (25) and power module (26), wherein A/D modular converter (21) will become digital signal from the starlight information translation that responsive subsystem (1) is transmitted with fpga chip (22), finish the pretreatment of star chart data, and to sunshine information, ground magnetic information and inertia information level and smooth, and the result after will handling sends in the comprehensive treatment subsystem (3); Clock circuit (25) provides clock signal for fpga chip (22), configuring chip (23) is fpga chip (a 22) storing software program, SRAM or SDRAM memory device (24) provide storage space for fpga chip (22), and power module (26) provides power supply for acquisition of signal and preprocessing subsystem (2).
3. a kind of attitude determination system according to claim 1 based on multi-sensor, it is characterized in that: described comprehensive treatment subsystem (3) comprises level shifter interface circuit (31), DSP or arm processor chip (32), extend out Flash memory device (33), SRAM or SDRAM memory device (34), power module (35), clock circuit (36) and serial ports expansion module (37), level shifter interface circuit (31) wherein, DSP or ARM chip (32) and serial ports expansion module (37) receive the data from acquisition of signal and preprocessing subsystem (2), finish importance in star map recognition and starlight information is resolved, and associating sunshine information, ground magnetic information and inertia information realize that the fusion of integrated attitude determination system decides appearance; Clock circuit (36) provides clock signal for DSP or ARM chip (32), extend out Flash memory device (33) and be DSP or ARM chip (32) storing software program, SRAM or SDRAM memory device (34) are for DSP or ARM chip (32) provide data space, and power module (35) provides power supply for comprehensive treatment subsystem (3).
4. a kind of attitude determination system according to claim 1 based on multi-sensor, it is characterized in that: described integrated attitude determination method based on ant group particle filter algorithm, be the starlight information that CMOS star sensing probe (11) sensitivity is arrived, sunshine information in conjunction with sun sensing probe (12) observation, the ground magnetic information that three-axle magnetic field probe (14) is responsive, and the inertia information that provides of the fiber optic gyro after error compensation (13), adopt optimum REQUEST algorithm, resolve and obtain the observation information of quaternion q battle array as ant group particle filter; This observation information is further combined with the inertia information through error compensation, by ant group particle filter algorithm, the attitude and the gyro wander that obtain integrated attitude determination system are estimated, output with the compensation gyro, resolve the attitude parameter of integrated attitude determination system at last by attitude quaternion, finish the integrated attitude determination of integrated attitude determination system.
5. a kind of attitude determination system based on multi-sensor according to claim 4 is characterized in that: the step of described ant group particle filter algorithm is:
(1) with the input of the quaternion q battle array that calculates and the inertia information after error compensation as ant group particle filter; On the basis of standard particle filtering algorithm,, and serve as with reference to produce N-1 particle according to standard normal distribution with it with the center particle of quaternion q battle array as standard particle filtering; Introduce ant group algorithm, carry out initialization, initial method is: ant group algorithm maximum cycle Cmax, the heuristic factor-alpha of information, expect heuristic factor-beta, pheromones intensity Q, pheromones volatility coefficient ρ, ant number m and number of particles N (q, q
1, q
2..., q
N-1);
(2) m ant placed on N the particle, make the weights θ of i particle
iInitialization information amount τ
i(0) be constant, and initial time Δ τ
i(0)=0; τ
i(t) expression t moment weights θ
iQuantity of information, Δ τ
i(t) represent that all ants stay weights θ constantly at t
iOn quantity of information and, t=1,2
(3) cycle number Count=Count+1, the Count initial value is made as 0, the taboo table tabu of ant
kCall number k=1, wherein tabu
kThe current particle of passing by of expression ant k;
(4) ant number k=k+1, the probability that the ant individuality is calculated according to following state transition probability formula is selected particle i and is advanced;
Wherein, p
i k(t) be state transition probability, η
i(t) be heuristic function, the expression ant is selected the expected degree of particle i, η
i(t)=1/ θ
i, θ
iThe weights of expression particle i;
(5) ant is moved on the new particle after choosing, and this particle is recorded in the taboo table of this ant individuality; If k＜m, then jumped to for (4) step, otherwise upgrade quantity of information on each particle according to following formula:
τ
i(t+N)=(1-ρ) τ
i(t)+Δ τ
i(t), cross weights θ when k ant
iThe time,
Wherein, L
kRepresent the total number of k ant at this circulation particle of passing by;
(6) if Count＜Cmax promptly less than the ant group algorithm maximum cycle, then empties the taboo table and forwarded for (3) step to; Otherwise at this moment loop ends is optimized and screens current particle, duplicates excellent particle, keeps weights and be more greatly the many particles of quantity of information, and superseded weights little be the little particle of quantity of information; The less particle of weights is exchanged and makes a variation, avoid the particle tcam-exhaustion; Utilize the particle that duplicates, exchanges and make a variation then, and carry out particle filter in conjunction with inertia information and finish attitude and gyro wander estimation, and gyro wander is fed back to inertia information, realize error compensation.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN 200910237658 CN101712381B (en) | 2009-11-13 | 2009-11-13 | Multi-sensor-based attitude determination system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN 200910237658 CN101712381B (en) | 2009-11-13 | 2009-11-13 | Multi-sensor-based attitude determination system |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN101712381A true CN101712381A (en) | 2010-05-26 |
| CN101712381B CN101712381B (en) | 2013-01-02 |
Family
ID=42416472
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN 200910237658 Expired - Fee Related CN101712381B (en) | 2009-11-13 | 2009-11-13 | Multi-sensor-based attitude determination system |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN101712381B (en) |
Cited By (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102156478A (en) * | 2010-12-28 | 2011-08-17 | 北京航空航天大学 | Integrated attitude determination method based on ant colony unscented particle filter algorithm |
| CN102494687A (en) * | 2011-10-19 | 2012-06-13 | 清华大学 | High-precision posture/track integrated measurement device |
| CN103324583A (en) * | 2013-07-02 | 2013-09-25 | 浙江大学 | Offline high-speed fiber-optic gyroscope data acquisition method |
| CN103438879A (en) * | 2013-09-02 | 2013-12-11 | 北京航空航天大学 | Atomic spin gyroscope and magnetometer tightly-integrated attitude determination method based on ant colony PF (Particle Filter) algorithm |
| CN104118578A (en) * | 2014-06-24 | 2014-10-29 | 上海微小卫星工程中心 | Micro-satellite platform multi-sensor data dynamic fusing system and method |
| CN104765667A (en) * | 2015-04-17 | 2015-07-08 | 西安电子科技大学 | FPGA program fragile branch obtaining method based on ant colony optimization |
| CN104977941A (en) * | 2014-04-02 | 2015-10-14 | 波音公司 | Localization within an environment using sensor fusion |
| CN108313329A (en) * | 2018-04-03 | 2018-07-24 | 上海微小卫星工程中心 | A kind of satellite platform data dynamic fusion system and method |
| CN109186588A (en) * | 2018-10-10 | 2019-01-11 | 上海航天控制技术研究所 | A kind of miniature multimode star sensor |
| CN109598718A (en) * | 2018-12-06 | 2019-04-09 | 余姚市华耀工具科技有限公司 | Equipment replacement demand analysis mechanism |
| CN109945854A (en) * | 2019-03-26 | 2019-06-28 | 上海微小卫星工程中心 | A method of star sensor data is merged based on quaternary number difference |
| CN111156992A (en) * | 2019-12-31 | 2020-05-15 | 中国船舶重工集团公司第七一七研究所 | Miniature satellite-borne star sensor and working process time sequence thereof |
| CN111332501A (en) * | 2020-02-26 | 2020-06-26 | 上海航天控制技术研究所 | Multi-control and multi-reference design method of satellite attitude control system |
| CN111895993A (en) * | 2020-08-04 | 2020-11-06 | 上海航天控制技术研究所 | Miniature star sensor circuit system |
| CN113607155A (en) * | 2021-07-12 | 2021-11-05 | 上海卫星工程研究所 | Intelligent multiplexing method and system for sensors under multi-star assembly |
| CN113710579A (en) * | 2019-03-25 | 2021-11-26 | 空客防务与空间有限公司 | Device and method for determining the attitude of a satellite equipped with a gyroscopic actuator and satellite carrying such a device |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE4129630A1 (en) * | 1991-09-06 | 1993-05-06 | Deutsche Aerospace Ag, 8000 Muenchen, De | MEASURING ARRANGEMENT AND CONTROL SYSTEM FOR THE POSITION CONTROL OF A THREE-AXIS-STABILIZED SATELLITE AND RELATED MEASURING AND CONTROL PROCEDURES |
| US6272432B1 (en) * | 1999-05-10 | 2001-08-07 | Hughes Electronics Corporation | System and method for correcting star tracker low spatial frequency error in stellar-inertial attitude determination systems |
| US6702234B1 (en) * | 2002-03-29 | 2004-03-09 | Lockheed Martin Corporation | Fault tolerant attitude control system for zero momentum spacecraft |
| CN100356139C (en) * | 2005-01-21 | 2007-12-19 | 清华大学 | Miniature assembled gesture measuring system for mini-satellite |
| CN100348461C (en) * | 2006-08-01 | 2007-11-14 | 北京航空航天大学 | High precision APS sun sensor |
| CN100487618C (en) * | 2007-06-08 | 2009-05-13 | 北京航空航天大学 | High precision combined posture-determining method based on optimally genetic REQUEST and GUPF |
| CN100538276C (en) * | 2007-11-16 | 2009-09-09 | 北京航空航天大学 | A kind of MEMS gyroscopes error compensation method for micro satellite based on integrated neural network |
| CN101513939B (en) * | 2009-04-03 | 2011-01-05 | 北京航空航天大学 | Two dimentional attitude control system of synthetic aperture radar satellite |
-
2009
- 2009-11-13 CN CN 200910237658 patent/CN101712381B/en not_active Expired - Fee Related
Cited By (26)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102156478A (en) * | 2010-12-28 | 2011-08-17 | 北京航空航天大学 | Integrated attitude determination method based on ant colony unscented particle filter algorithm |
| CN102156478B (en) * | 2010-12-28 | 2013-11-06 | 北京航空航天大学 | Integrated attitude determination method based on ant colony unscented particle filter algorithm |
| CN102494687A (en) * | 2011-10-19 | 2012-06-13 | 清华大学 | High-precision posture/track integrated measurement device |
| CN102494687B (en) * | 2011-10-19 | 2013-09-04 | 清华大学 | High-precision posture/track integrated measurement device |
| CN103324583A (en) * | 2013-07-02 | 2013-09-25 | 浙江大学 | Offline high-speed fiber-optic gyroscope data acquisition method |
| CN103324583B (en) * | 2013-07-02 | 2016-03-02 | 浙江大学 | A kind of optical fibre gyro off-line High Speed Data Collection Method |
| CN103438879A (en) * | 2013-09-02 | 2013-12-11 | 北京航空航天大学 | Atomic spin gyroscope and magnetometer tightly-integrated attitude determination method based on ant colony PF (Particle Filter) algorithm |
| CN104977941B (en) * | 2014-04-02 | 2019-04-30 | 波音公司 | The device and method of mobile platform are guided in environment |
| CN104977941A (en) * | 2014-04-02 | 2015-10-14 | 波音公司 | Localization within an environment using sensor fusion |
| CN104118578A (en) * | 2014-06-24 | 2014-10-29 | 上海微小卫星工程中心 | Micro-satellite platform multi-sensor data dynamic fusing system and method |
| CN104118578B (en) * | 2014-06-24 | 2016-02-03 | 上海微小卫星工程中心 | A kind of microsatellite platform multiple sensor data dynamic fusion system and method |
| CN104765667B (en) * | 2015-04-17 | 2018-09-28 | 西安电子科技大学 | A kind of FPGA program fragility branch acquiring methods based on ant group algorithm |
| CN104765667A (en) * | 2015-04-17 | 2015-07-08 | 西安电子科技大学 | FPGA program fragile branch obtaining method based on ant colony optimization |
| CN108313329A (en) * | 2018-04-03 | 2018-07-24 | 上海微小卫星工程中心 | A kind of satellite platform data dynamic fusion system and method |
| CN109186588A (en) * | 2018-10-10 | 2019-01-11 | 上海航天控制技术研究所 | A kind of miniature multimode star sensor |
| CN109598718B (en) * | 2018-12-06 | 2020-12-04 | 安徽省华腾农业科技有限公司经开区分公司 | Equipment replacement demand analysis mechanism |
| CN109598718A (en) * | 2018-12-06 | 2019-04-09 | 余姚市华耀工具科技有限公司 | Equipment replacement demand analysis mechanism |
| CN113710579A (en) * | 2019-03-25 | 2021-11-26 | 空客防务与空间有限公司 | Device and method for determining the attitude of a satellite equipped with a gyroscopic actuator and satellite carrying such a device |
| CN109945854A (en) * | 2019-03-26 | 2019-06-28 | 上海微小卫星工程中心 | A method of star sensor data is merged based on quaternary number difference |
| CN111156992A (en) * | 2019-12-31 | 2020-05-15 | 中国船舶重工集团公司第七一七研究所 | Miniature satellite-borne star sensor and working process time sequence thereof |
| CN111332501A (en) * | 2020-02-26 | 2020-06-26 | 上海航天控制技术研究所 | Multi-control and multi-reference design method of satellite attitude control system |
| CN111332501B (en) * | 2020-02-26 | 2021-08-10 | 上海航天控制技术研究所 | Multi-control and multi-reference design method of satellite attitude control system |
| CN111895993A (en) * | 2020-08-04 | 2020-11-06 | 上海航天控制技术研究所 | Miniature star sensor circuit system |
| CN111895993B (en) * | 2020-08-04 | 2023-02-03 | 上海航天控制技术研究所 | Miniature star sensor circuit system |
| CN113607155A (en) * | 2021-07-12 | 2021-11-05 | 上海卫星工程研究所 | Intelligent multiplexing method and system for sensors under multi-star assembly |
| CN113607155B (en) * | 2021-07-12 | 2023-10-10 | 上海卫星工程研究所 | Intelligent multiplexing method and system for sensors under multi-star combination |
Also Published As
| Publication number | Publication date |
|---|---|
| CN101712381B (en) | 2013-01-02 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN101712381B (en) | Multi-sensor-based attitude determination system | |
| CN108225370B (en) | Data fusion and calculation method of motion attitude sensor | |
| CN111688952B (en) | Satellite attitude control system | |
| CN103591963B (en) | A kind of Miniature star sensor and its implementation | |
| CN100398992C (en) | Micro low power consumption inertial stellar compass for micro nano spacecraft | |
| CN112926208B (en) | Method and system for calculating passive month-to-month calibration opportunity of low orbit satellite | |
| SG154353A1 (en) | Method and apparatus for automatic tracking of the sun | |
| CN102157790A (en) | Antenna tracking system used for mobile satellite communication system | |
| CN1869589A (en) | Strapdown intertial/celestial combined navigation semi-material emulation system | |
| CN106679676A (en) | Single-viewing-field multifunctional optical sensor and realization method | |
| CN109631911A (en) | A kind of attitude of satellite rotation information based on deep learning Target Recognition Algorithms determines method | |
| CN106828976A (en) | Cube star satellite platform based on mobile phone | |
| CN206074000U (en) | A kind of underwater hiding-machine inertial navigation system aided in based on gravity | |
| CN102706327B (en) | Multifunctional visible light sensor system and design method thereof | |
| CN110803304B (en) | Satellite attitude control system | |
| CN110209182A (en) | A kind of quadrotor based on AVR single chip | |
| CN111207773B (en) | Attitude unconstrained optimization solving method for bionic polarized light navigation | |
| CN103148856A (en) | Swing-by probe autonomous celestial navigation method based on adaptive scale change | |
| Liang et al. | Design and development of ground control system for tethered uav | |
| CN110162069A (en) | Desired posture Analytical Solution method is stared in a kind of reflection of LEO spacecraft sunlight | |
| CN113203981A (en) | Method for determining satellite attitude by utilizing radiation source to position load | |
| CN1122173C (en) | Combined geomagnetism aided navigation equipment | |
| CN209623719U (en) | Autonomous underwater submariner device pose path planning apparatus | |
| CN111156992A (en) | Miniature satellite-borne star sensor and working process time sequence thereof | |
| Peng et al. | A new dynamic 2D fusion model and output characteristic analysis of floating photovoltaic modules considering motion and environmental factors |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C53 | Correction of patent of invention or patent application | ||
| CB03 | Change of inventor or designer information |
Inventor after: Quan Wei Inventor after: Guo Lei Inventor after: Fang Jiancheng Inventor after: Xu Liang Inventor after: Liu Bingli Inventor after: Yang Zhaohua Inventor before: Guo Lei Inventor before: Quan Wei Inventor before: Liu Bingli Inventor before: Yang Zhaohua |
|
| COR | Change of bibliographic data |
Free format text: CORRECT: INVENTOR; FROM: GUO LEI QUAN WEI LIU BINGLI YANG ZHAOHUA TO: QUAN WEI GUO LEI FANG JIANCHENG XU LIANG LIU BINGLI YANG ZHAOHUA |
|
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20130102 Termination date: 20211113 |