A method for using multi-star sensor priorities based on mission planning

Calculating the effectiveness and priority of the star sensor through the task planning method, solving the problem of star sensor switching of satellite ontology during the mission, improving stability and task success rate.

CN118565488BActive Publication Date: 2024-11-26CHANGGUANG SATELLITE TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411037790.0
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-07-31
Publication Date
2024-11-26
Estimated Expiration
2044-07-31

AI Technical Summary

Technical Problem

During the mission, satellite body is prone to star-sensitive switch or switching of posture components, resulting in reduced stability and mission failure.

Method used

Through the priority usage method of multi-star sensor based on task planning, we calculate the position velocity and attitude quaternions of the satellite body, judge the effectiveness of the star sensor, and determine the priority based on the included angle to avoid stars caused by sunlight influence Sensor switch.

Benefits of technology

It effectively avoids the stability reduction or mission failure caused by the star sensor due to light during the mission, and improves the stability of the satellite body and the task execution effect.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118565488B_ABST
    Figure CN118565488B_ABST
Patent Text Reader

Abstract

A method for using multiple star sensors based on mission planning belongs to the field of aviation control technology. Calculate the position and speed of the satellite body in the WGS-84 coordinate system; calculate the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system; determine the attitude of the satellite body relative to the orbital coordinate system; calculate the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system; calculate the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system; calculate the Z-axis vector direction of the star sensor measurement coordinate system; calculate the direction of the sun vector in the J2000 inertial coordinate system; calculate the angle between the Z-axis vector direction of multiple star sensor measurement coordinate systems and the direction of the sun vector in the J2000 inertial coordinate system, and judge whether multiple star sensors are valid according to the angle; determine the priority of multiple star sensors.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the field of aviation control technology, and in particular to a method for using multi-star sensor priorities based on mission planning. Background Art

[0002] In order to accurately measure the true attitude of the satellite body in orbit, the satellite body is usually equipped with multiple high-precision star sensors, and the angle between the optical axes of the star sensors is as close to 90° as possible to achieve high-precision attitude determination of the satellite body, and to avoid the simultaneous failure of multiple star sensors due to sunlight. During the on-orbit mission of the satellite body, there is usually a default priority order for the use of star sensors. When multiple star sensors are valid, the measurement information of 1 to 2 star sensors is automatically selected to introduce into the attitude control; if the selected star sensor fails during the mission, it will automatically switch to other valid star sensors or reduce the number of star sensors used; if all star sensors fail and cannot output valid measurement information, other measurement components installed on the satellite body platform, such as fiber optic gyroscopes, solar sensors, and magnetometers, are used to determine the attitude.

[0003] In the prior art, Chinese patent CN113932802A discloses a "method and system for changing the priority of multiple star sensors", which judges the performance of multiple star sensors according to the priority test results provided by the ground, sorts the multiple star sensors from high to low according to the performance to form a first sequence, and obtains the information of the multiple star sensors. According to the actual on-orbit performance of the multiple star sensors, the priority selection matrix of the multiple star sensors is determined, and the priority selection matrix is ​​added to the ground measurement and control station to configure the priorities of the multiple star sensors, and the priority change is completed. According to the changed priorities, the working status of the multiple star sensors is determined according to the star-sensitive and the sky-sensitive magnetometer discrimination process, and the arbitration results of the multiple star sensors are obtained, the priority change is cancelled, and the real working status determination of the multiple star sensors is output. The arbitration results can significantly reduce the influence introduced by the difference between the actual performance of the star sensors on the satellite and the expected performance on the ground, and improve the attitude determination accuracy of the satellite.

[0004] Therefore, there are three situations that may cause attitude changes in existing satellite bodies during missions: 1) star sensor switching; 2) changes in the number of star sensors; 3) changes in attitude components. Changes in attitude components can easily cause the satellite body to become less stable, affecting mission execution results and even leading to mission failure.

[0005] In summary, the existing satellite bodies are prone to switching star sensors or attitude fixing components during mission execution. Summary of the invention

[0006] The invention solves the problem that the existing satellite body is prone to switching of star sensors or switching of attitude fixing components during mission execution.

[0007] The method for using the priority of multiple star sensors based on mission planning described in the present invention comprises the following steps:

[0008] Step S1, based on the current information of the satellite body, calculate the position speed of the satellite body in the WGS-84 coordinate system during the mission time period;

[0009] Step S2, based on the mission time period and the position velocity of the satellite body in the WGS-84 coordinate system during the mission time period calculated in step S1, calculate the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system during the mission time period;

[0010] Step S3, determining the attitude of the satellite body relative to the orbital coordinate system during the mission time period based on the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system during the mission time period calculated in step S2;

[0011] Step S4, based on the attitude of the satellite body relative to the orbital coordinate system during the mission time period determined in step S3, calculate the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system;

[0012] Step S5, based on the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system and the attitude quaternion of the star sensor relative to the orbital coordinate system calculated in step S4, calculate the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period;

[0013] Step S6, calculating the Z-axis vector orientation of the star sensor measurement coordinate system based on the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period calculated in step S5;

[0014] Step S7, when there are multiple star sensors, repeat steps S5 to S6 until the Z-axis vector directions of the measurement coordinate systems of multiple star sensors are calculated, then execute step S8;

[0015] Step S8, calculating the direction of the sun vector in the J2000 inertial coordinate system during the mission time period;

[0016] Step S9, respectively calculating the angles between the Z-axis vectors of the measurement coordinate systems of the multiple star sensors and the directions of the sun vectors in the J2000 inertial coordinate system during the mission time period, and judging whether the multiple star sensors are effective according to the angles;

[0017] Step S10: determining the priorities of the multiple star sensors according to the effectiveness of the multiple star sensors.

[0018] Further, in one embodiment of the present invention, in the step S4, the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system is calculated based on the attitude of the satellite body relative to the orbital coordinate system during the mission time period determined in step S3, specifically:

[0019] If the satellite body has an attitude relative to the orbital coordinate system during the mission time period, then ;

[0020] If the satellite body does not have any attitude relative to the orbital coordinate system during the mission period, then ;

[0021] in, is the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system, is the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system, is the attitude quaternion of the satellite body relative to the orbital coordinate system.

[0022] Further, in one embodiment of the present invention, in the step S5, based on the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system and the attitude quaternion of the star sensor relative to the orbital coordinate system calculated in step S4, the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period is calculated, specifically:

[0023] ;

[0024] in, is the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system, is the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system, is the attitude quaternion of the satellite body relative to the orbital coordinate system, is the attitude quaternion of the star sensor relative to the orbital coordinate system.

[0025] Further, in one embodiment of the present invention, in the step S6, the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period calculated in step S5 is used to calculate the Z-axis vector orientation of the star sensor measurement coordinate system, specifically:

[0026] Step S601, converting the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system within the mission time period calculated in step S5 into a matrix of the star sensor relative to the J2000 inertial coordinate system within the mission time period;

[0027] Step S602, based on the matrix of the star sensor relative to the J2000 inertial coordinate system during the mission time period converted in step S601, calculate the direction of the Z axis of the star sensor measurement coordinate system in the J2000 inertial coordinate system;

[0028] Step S603, based on the Z-axis orientation of the star sensor measurement coordinate system in the J2000 inertial coordinate system calculated in step S602, obtain the orientation of the Z-axis vector of the star sensor measurement coordinate system.

[0029] Further, in one embodiment of the present invention, in step S601, the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period calculated in step S5 is converted into a matrix of the star sensor relative to the J2000 inertial coordinate system during the mission time period, specifically:

[0030] ;

[0031] in, is the matrix of the star sensor relative to the J2000 inertial coordinate system, is the angle between the X-axis of the star sensor coordinate system and the X-axis of the J2000 inertial coordinate system, is the angle between the Y axis of the star sensor coordinate system and the X axis of the J2000 inertial coordinate system, is the angle between the Z axis of the star sensor coordinate system and the X axis of the J2000 inertial coordinate system, is the angle between the X-axis of the star sensor coordinate system and the Y-axis of the J2000 inertial coordinate system, is the angle between the Y axis of the star sensor coordinate system and the Y axis of the J2000 inertial coordinate system, is the angle between the Z axis of the star sensor coordinate system and the Y axis of the J2000 inertial coordinate system, is the angle between the X-axis of the star sensor coordinate system and the Z-axis of the J2000 inertial coordinate system, is the angle between the Y axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system, is the angle between the Z axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system.

[0032] Further, in one embodiment of the present invention, in step S602, the calculation of the direction of the Z axis of the star sensor measurement coordinate system in the J2000 inertial coordinate system is specifically:

[0033] ;

[0034] in, is the direction of the Z axis of the star sensor measurement coordinate system in the J2000 inertial coordinate system, zx is the angle between the X axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system, zy is the angle between the Y axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system, and zz is the angle between the Z axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system.

[0035] Further, in one embodiment of the present invention, in the step S8, the direction of the sun vector in the J2000 inertial coordinate system during the mission time period is calculated as follows:

[0036] ;

[0037] in, is the direction of the sun vector in the J2000 inertial coordinate system, is the mean anomaly angle, It is the angle between the ecliptic and the obliquity of the ecliptic.

[0038] Further, in one embodiment of the present invention, in step S9, the step of determining whether a plurality of star sensors are effective according to the included angles comprises the following steps:

[0039] Step S901, if the included angle is greater than the star sensor avoidance angle, the star sensor is valid; if the included angle is less than the star sensor avoidance angle, the star sensor is invalid;

[0040] Step S902, repeating step S901 until the determination of multiple star sensors is completed.

[0041] Further, in one embodiment of the present invention, in the step S10, the priorities of the multiple star sensors are determined according to the effectiveness of the multiple star sensors, specifically:

[0042] The continuously effective star sensor is defined as the highest level star sensor, and the effective-ineffective switching star sensor is defined as the shielded star sensor;

[0043] When multiple star sensors are judged to be invalid, attitude determination is performed without star sensors.

[0044] The present invention solves the problem that the existing satellite body is prone to switching star sensors or attitude components during mission execution. Specific beneficial effects include:

[0045] The present invention discloses a method for using multiple star sensors based on mission planning. Since the existing satellite body is prone to switching star sensors or attitude components during the mission, the stability of the satellite body is reduced, which affects the mission execution effect. In order to solve the above technical problems, the present invention determines the priority of star sensor use by predicting the effectiveness of star sensors during the mission in advance, thereby avoiding the problem of reduced satellite body stability or mission failure caused by switching star sensors due to the influence of light during the mission;

[0046] The method for using the priority of multiple satellite sensors based on mission planning described in the present invention has certain engineering significance for on-orbit testing of satellite bodies and mission planning. BRIEF DESCRIPTION OF THE DRAWINGS

[0047] The above and / or additional aspects and advantages of the present invention will become apparent and easily understood from the following description of the embodiments in conjunction with the accompanying drawings, in which:

[0048] Figure 1 It is a diagram of the angles between the three star sensors and the sun of the satellite body in an orbit of 86° and 880km in altitude as described in the specific implementation manner;

[0049] Figure 2 is a diagram of the angle between the optical axis of the star sensor A and the sun as described in the specific implementation manner;

[0050] Figure 3 is a diagram of the angle between the optical axis of the star sensor B and the sun as described in the specific implementation manner;

[0051] Figure 4 is a diagram of the angle between the optical axis C of the star sensor and the sun as described in the specific implementation manner;

[0052] Figure 5 is a star sensor A effectiveness diagram described in the specific implementation mode;

[0053] Figure 6 is a star sensor B effectiveness diagram described in the specific implementation mode;

[0054] Figure 7 1 is a star sensor C effectiveness diagram described in a specific implementation manner. DETAILED DESCRIPTION

[0055] The following will clearly and completely describe various embodiments of the present invention in conjunction with the accompanying drawings. The embodiments described with reference to the accompanying drawings are exemplary and intended to be used to explain the present invention, but should not be understood as limiting the present invention.

[0056] The method for using the priority of multiple star sensors based on mission planning described in this embodiment is characterized by comprising the following steps:

[0057] Step S1, based on the current information of the satellite body, calculate the position speed of the satellite body in the WGS-84 coordinate system during the mission time period;

[0058] Step S2, based on the mission time period and the position velocity of the satellite body in the WGS-84 coordinate system during the mission time period calculated in step S1, calculate the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system during the mission time period;

[0059] Step S3, determining the attitude of the satellite body relative to the orbital coordinate system during the mission time period based on the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system during the mission time period calculated in step S2;

[0060] Step S4, based on the attitude of the satellite body relative to the orbital coordinate system during the mission time period determined in step S3, calculate the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system;

[0061] Step S5, based on the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system and the attitude quaternion of the star sensor relative to the orbital coordinate system calculated in step S4, calculate the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period;

[0062] Step S6, calculating the Z-axis vector orientation of the star sensor measurement coordinate system based on the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period calculated in step S5;

[0063] Step S7, when there are multiple star sensors, repeat steps S5 to S6 until the Z-axis vector directions of the measurement coordinate systems of multiple star sensors are calculated, then execute step S8;

[0064] Step S8, calculating the direction of the sun vector in the J2000 inertial coordinate system during the mission time period;

[0065] Step S9, respectively calculating the angles between the Z-axis vectors of the measurement coordinate systems of the multiple star sensors and the directions of the sun vectors in the J2000 inertial coordinate system during the mission time period, and judging whether the multiple star sensors are effective according to the angles;

[0066] Step S10: determining the priorities of the multiple star sensors according to the effectiveness of the multiple star sensors.

[0067] In this embodiment, in step S4, the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system is calculated based on the attitude of the satellite body relative to the orbital coordinate system during the mission time period determined in step S3, specifically:

[0068] If the satellite body has an attitude relative to the orbital coordinate system during the mission time period, then ;

[0069] If the satellite body does not have any attitude relative to the orbital coordinate system during the mission period, then ;

[0070] in, is the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system, is the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system, is the attitude quaternion of the satellite body relative to the orbital coordinate system.

[0071] In this implementation manner, in the step S5, the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system and the attitude quaternion of the star sensor relative to the orbital coordinate system calculated in step S4 are used to calculate the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period, specifically:

[0072] ;

[0073] in, is the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system, is the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system, is the attitude quaternion of the satellite body relative to the orbital coordinate system, is the attitude quaternion of the star sensor relative to the orbital coordinate system.

[0074] In this embodiment, in the step S6, the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period calculated in step S5 is used to calculate the Z-axis vector orientation of the star sensor measurement coordinate system, specifically:

[0075] Step S601, converting the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system within the mission time period calculated in step S5 into a matrix of the star sensor relative to the J2000 inertial coordinate system within the mission time period;

[0076] Step S602, based on the matrix of the star sensor relative to the J2000 inertial coordinate system during the mission time period converted in step S601, calculate the direction of the Z axis of the star sensor measurement coordinate system in the J2000 inertial coordinate system;

[0077] Step S603, based on the Z-axis orientation of the star sensor measurement coordinate system in the J2000 inertial coordinate system calculated in step S602, obtain the orientation of the Z-axis vector of the star sensor measurement coordinate system.

[0078] In the present embodiment, in the step S601, the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system in the mission time period calculated in step S5 is converted into a matrix of the star sensor relative to the J2000 inertial coordinate system in the mission time period, specifically:

[0079] ;

[0080] in, is the matrix of the star sensor relative to the J2000 inertial coordinate system, is the angle between the X-axis of the star sensor coordinate system and the X-axis of the J2000 inertial coordinate system, is the angle between the Y axis of the star sensor coordinate system and the X axis of the J2000 inertial coordinate system, is the angle between the Z axis of the star sensor coordinate system and the X axis of the J2000 inertial coordinate system, is the angle between the X-axis of the star sensor coordinate system and the Y-axis of the J2000 inertial coordinate system, is the angle between the Y axis of the star sensor coordinate system and the Y axis of the J2000 inertial coordinate system, is the angle between the Z axis of the star sensor coordinate system and the Y axis of the J2000 inertial coordinate system, is the angle between the X-axis of the star sensor coordinate system and the Z-axis of the J2000 inertial coordinate system, is the angle between the Y axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system, is the angle between the Z axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system.

[0081] In this embodiment, in step S602, the calculation of the direction of the Z axis of the star sensor measurement coordinate system in the J2000 inertial coordinate system is specifically:

[0082] ;

[0083] in, is the direction of the Z axis of the star sensor measurement coordinate system in the J2000 inertial coordinate system, zx is the angle between the X axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system, zy is the angle between the Y axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system, and zz is the angle between the Z axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system.

[0084] In this embodiment, in step S8, the direction of the sun vector in the J2000 inertial coordinate system during the mission time period is calculated as follows:

[0085] ;

[0086] in, is the direction of the sun vector in the J2000 inertial coordinate system, is the mean anomaly angle, It is the angle between the ecliptic and the obliquity of the ecliptic.

[0087] In this embodiment, in step S9, judging whether a plurality of star sensors are effective according to the included angles respectively includes the following steps:

[0088] Step S901, if the included angle is greater than the star sensor avoidance angle, the star sensor is valid; if the included angle is less than the star sensor avoidance angle, the star sensor is invalid;

[0089] Step S902, repeating step S901 until the determination of multiple star sensors is completed.

[0090] In this embodiment, in step S10, the priorities of the multiple star sensors are determined according to the effectiveness of the multiple star sensors, specifically:

[0091] The continuously effective star sensor is defined as the highest level star sensor, and the effective-ineffective switching star sensor is defined as the shielded star sensor;

[0092] When multiple star sensors are judged to be invalid, attitude determination is performed without star sensors.

[0093] In the prior art, star sensors may fail during a mission on a satellite body, which may result in the switching of star sensors or positioning components, causing a decrease in the stability of the satellite body platform or mission failure. The main reason for the switching of star sensors or positioning components is the influence of sunlight, that is, the angle between sunlight and the optical axis of the star sensor is smaller than the star sensor avoidance angle. At this time, the strong light interferes with the star sensor's detection of stars, rendering the star sensor invalid.

[0094] In order to solve the above technical problems, this embodiment proposes a method for using the priority of multiple star sensors based on mission planning, comprising the following steps:

[0095] Step S1, determining the satellite body at the current time T0 and the information output by the navigation receiver at the current time T0, that is, the position speed of the satellite body in the WGS-84 coordinate system at the current time T0;

[0096] Navigation Receiver:

[0097] The satellite body is equipped with a navigation receiver, which outputs the satellite body time. And the position and velocity information of the satellite body in the WGS-84 coordinate system, the format is: ,in, is the component of the satellite body position in the X-axis direction of the WGS-84 coordinate system, is the component of the satellite body position in the Y-axis direction of the WGS-84 coordinate system, is the component of the satellite body position in the Z-axis direction of the WGS-84 coordinate system, is the component of the satellite body velocity in the X-axis direction of the WGS-84 coordinate system, is the component of the satellite body velocity in the Y-axis direction of the WGS-84 coordinate system, It is the component of the satellite body velocity in the Z-axis direction of the WGS-84 coordinate system. Through this information, the orbit recursion model (for example, the Hpop model (high-precision orbit prediction model)) can be used to recursively deduce the position and velocity of the satellite body in the WGS-84 coordinate system at subsequent times;

[0098] WGS-84 Coordinate System:

[0099] The origin of the WGS-84 coordinate system is the center of mass of the earth. The Z axis of its geocentric rectangular coordinate system points to the CTP (Conventional Terrestrial Pole) direction defined by BIH (International Time Bureau) 1984.0, and the X axis points to the intersection of the BIH1984.0 agreement meridian plane and the CTP equator. The Y axis is perpendicular to the Z axis and the X axis to form a right-handed coordinate system.

[0100] Step S2, determining the mission time period T1-T2, performing orbit recursion based on the information output by the navigation receiver at the current time T0, and calculating the position and velocity of the satellite body in the WGS-84 coordinate system during the mission time period T1-T2;

[0101] Step S3, based on the mission time period T1-T2 and the position and velocity of the satellite body in the WGS-84 coordinate system during the mission time period T1-T2, calculate the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system during the mission time period T1-T2 ;

[0102] J2000 Inertial Coordinate System:

[0103] J2000 Inertial Coordinate System (Earth Inertial Coordinate System) , the origin of the coordinate system is the center of the earth C, the X axis points to the mean vernal equinox (12:00 on January 1, 2000), the Z axis points to the mean North Pole (12:00 on January 1, 2000, JD=2451545.0), and the Y axis, X axis, and Z axis form a right-hand rectangular coordinate system;

[0104] Step S4, calculate the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system during the mission time period T1 to T2 , determine the attitude of the satellite body relative to the orbital coordinate system during the mission time period T1 to T2. If the satellite body has an attitude relative to the orbital coordinate system, then the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system is If the satellite body does not have an attitude relative to the orbital coordinate system, the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system is ,in, is the attitude quaternion of the satellite body relative to the orbital coordinate system;

[0105] Satellite body coordinate system:

[0106] The satellite body coordinate system refers to the Rectangular coordinate system, also known as control coordinate system, coordinate origin At the center of mass of the satellite, when there is no attitude deviation in the earth orientation, it is consistent with the orbital coordinate system of the satellite body. When there is a deviation, the attitude quaternion of the satellite body relative to the orbital coordinate system is used. express;

[0107] Step S5: the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system And the attitude quaternion of the star sensor relative to the orbital coordinate system , calculate the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period T1 to T2 ,Will Convert to the matrix of the star sensor relative to the J2000 inertial coordinate system , it can be known that the direction of the Z axis of the star sensor measurement coordinate system in the J2000 inertial coordinate system is represented by the vector , when there are multiple star sensors, the Z-axis vector directions of the measurement coordinate systems of multiple star sensors are calculated simultaneously;

[0108] Star sensor installation coordinate system:

[0109] The star sensor is installed on the satellite body, and the relationship between the star sensor and the satellite body is expressed by quaternion , through the general quaternion-to-matrix algorithm, we can get the matrix ,in, The format is:

[0110] ;

[0111] in, is the X axis of the star sensor coordinate system, is the Y axis of the star sensor coordinate system, is the Z axis of the star sensor coordinate system, is the X axis of the J2000 inertial coordinate system, is the Y axis of the J2000 inertial coordinate system, It is the Z axis of the J2000 inertial coordinate system;

[0112] ;

[0113] in, is the angle between the X-axis of the star sensor coordinate system and the X-axis of the J2000 inertial coordinate system, is the angle between the Y axis of the star sensor coordinate system and the X axis of the J2000 inertial coordinate system, is the angle between the Z axis of the star sensor coordinate system and the X axis of the J2000 inertial coordinate system, is the angle between the X-axis of the star sensor coordinate system and the Y-axis of the J2000 inertial coordinate system, is the angle between the Y axis of the star sensor coordinate system and the Y axis of the J2000 inertial coordinate system, is the angle between the Z axis of the star sensor coordinate system and the Y axis of the J2000 inertial coordinate system, is the angle between the X-axis of the star sensor coordinate system and the Z-axis of the J2000 inertial coordinate system, is the angle between the Y axis of the star sensor coordinate system and the Z axis of the J2000 coordinate system, is the angle between the Z axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system;

[0114] According to the above formula, we can know that the Z axis of the star sensor measurement coordinate system points to the J2000 inertial coordinate system. for:

[0115] ;

[0116] in, is the angle between the X-axis of the star sensor coordinate system and the Z-axis of the J2000 inertial coordinate system, is the angle between the Y axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system, is the angle between the Z axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system.

[0117] Step S6, calculate the solar vector in the mission time period T1 to T2 Orientation in the J2000 inertial coordinate system;

[0118] Sun Vector:

[0119] According to the time on the satellite, the solar vector is calculated using the solar vector model. The orientation in the J2000 inertial coordinate system is defined as:

[0120] ;

[0121] in, is the mean anomaly angle, using the data model of the solar equatorial coordinates, according to the formula, is the obliquity of the ecliptic, which can also be obtained using the data model of the solar equatorial coordinates;

[0122] Step S7, calculate the solar vector Measuring the Z-axis vector pointing direction of the coordinate system with multiple star sensors The angle between the vectors , if the angle Greater than the star sensor avoidance angle , then the star sensor is effective, if the angle Smaller than the star sensor avoidance angle , then the star sensor is invalid;

[0123] Star sensor avoidance angle:

[0124] Define the star sensor avoidance angle as , generally 35° to 40°. In this embodiment, the star sensor avoidance angle is 35°. When the sun vector Measuring the Z-axis vector pointing direction of the coordinate system with multiple star sensors The angle between the vectors Smaller than the star sensor avoidance angle When , the star sensor is invalid;

[0125] Step S8, outputs the priorities of multiple star sensors, and determines the use strategy of multiple star sensors, specifically: the installation matrix of the continuously effective star sensors in the mission time period T1~T2 is defined as the highest level; if the star sensor has effective-invalid switching in the mission time period T1~T2, the star sensor is shielded from use at the mission start time T1; if multiple star sensors are judged invalid, attitude determination without star sensors is changed; generally, the probability of multiple star sensors being invalid is extremely low, and generally at least one star sensor is judged valid.

[0126] Therefore, this embodiment adopts a sailboard control strategy, which can effectively predict the effectiveness of the star sensor during the mission and autonomously change the priority of the star sensor to ensure that the star sensor remains effective during the mission time period, effectively avoiding the technical problem of mission failure caused by star sensor switching during the mission time period. The method is simple in principle, easy to implement, and can be applied to engineering practice.

[0127] In order to better illustrate the method for using the priority of multiple star sensors based on mission planning described in this embodiment, a detailed description is given through the following examples:

[0128] Taking a circular orbit with an inclination of 86° and an orbital altitude of 880km as an example, the satellite body is equipped with three star sensors, namely star sensor A, star sensor B and star sensor C;

[0129] Input conditions: The position and velocity at the current time T0 and in the WGS-84 coordinate system are:

[0130] [2024 / 6 / 10 3:20:00

[0131] 6549.795062km-1730.175145km2605.231529km

[0132] -2.549373km / s0.735004 km / s6.897489km / s]

[0133] The theoretical value of the angle between the Z-axis vector direction of the coordinate system measured by multiple star sensors and the direction of the sun vector in the J2000 inertial coordinate system is predicted to be 2024 / 6 / 10 5:20:01---7:00:00 within 6000s. Figure 1 As shown, the ordinate is the angle, the abscissa is the time, and the unit is s.

[0134] The calculated value obtained by the method described in this embodiment is compared with the theoretical value. The comparison results are as follows: Figure 2 to Figure 4 As shown, the ordinate is the angle, the abscissa is the time, and the unit is s. By comparing the results, it can be seen that since the calculated value is consistent with the theoretical value, the calculated value obtained by the method described in this embodiment is valid.

[0135] The method for using the priority of multiple star sensors based on mission planning described in this embodiment is as follows: by calculating the angle between the Z-axis vector pointing of the measurement coordinate system of multiple star sensors and the direction of the sun vector in the J2000 inertial coordinate system, the range is clarified, and the calculated value is compared with the star sensor avoidance angle of 35°. It can be seen that in the time period of 2024 / 6 / 10 5:20:01---7:00:00, the effectiveness of the three satellite star sensors is as follows: Figure 5 to Figure 7 As shown, Figure 5 to Figure 7 The following are the effective graphs of star sensors A\B\C. The horizontal axis is time, and the vertical axis uses 1 and 0 to represent the effective and invalid states respectively. From the graph, we can judge the use strategy of multiple star sensors, which is as follows:

[0136] 1) During the time period of 5:20:01 to 5:33:20, star sensors A\B\C are all valid, and the system outputs star sensor A and star sensor B according to the default priority;

[0137] 2) During the time period of 5:33:21 to 5:52:30, star sensors B\C are valid, star sensor A is invalid, and the system outputs star sensors B and C according to priority;

[0138] 3) During the time period of 5:52:31 to 5:59:44, star sensors A\B\C are all valid, and the system outputs star sensor A and star sensor B according to the default priority;

[0139] 4) During the time period of 5:59:45 to 6:20:23, star sensors A\B are valid, star sensor C is invalid, and the system outputs star sensor A and star sensor B according to priority;

[0140] 5) During the time period of 6:20:24 to 6:59:59, star sensors A\B\C are all valid, and the system outputs star sensor A and star sensor B according to the default priority;

[0141] Therefore, according to the current time of 3:20:00, we can determine the specific time of the task in the subsequent time period 1) to 5), and select the best star sensor, thus avoiding the problem of mission failure caused by the switching of star sensors, which reduces the stability of the platform.

[0142] In summary, the method for using multiple star sensors based on mission planning can predict the effectiveness of star sensors in the future, provide a theoretical basis for mission planning and successful execution, and has certain engineering significance.

[0143] The above is a detailed introduction to a method for using the priority of a multi-star sensor based on mission planning proposed in the present invention. In this article, specific examples are used to illustrate the principle and implementation mode of the present invention. The description of the above embodiment is only used to help understand the method and core idea of ​​the present invention. At the same time, for those skilled in the art, according to the idea of ​​the present invention, there will be changes in the specific implementation mode and application scope. In summary, the content of this specification should not be understood as limiting the present invention.

Claims

1. A method for using multi-star sensor priorities based on mission planning, characterized in that: The following steps are involved: Step S1, based on the current information of the satellite body, calculate the position speed of the satellite body in the WGS-84 coordinate system during the mission time period; Step S2, based on the mission time period and the position velocity of the satellite body in the WGS-84 coordinate system during the mission time period calculated in step S1, calculate the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system during the mission time period; Step S3, determining the attitude of the satellite body relative to the orbital coordinate system during the mission time period based on the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system during the mission time period calculated in step S2; Step S4, based on the attitude of the satellite body relative to the orbital coordinate system during the mission time period determined in step S3, calculate the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system; Step S5, based on the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system and the attitude quaternion of the star sensor relative to the orbital coordinate system calculated in step S4, calculate the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period; Step S6, calculating the Z-axis vector orientation of the star sensor measurement coordinate system based on the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period calculated in step S5; Step S7, when there are multiple star sensors, repeat steps S5 to S6 until the Z-axis vector directions of the measurement coordinate systems of multiple star sensors are calculated, then execute step S8; Step S8, calculating the direction of the sun vector in the J2000 inertial coordinate system during the mission time period; Step S9, respectively calculating the angles between the Z-axis vectors of the measurement coordinate systems of the multiple star sensors and the directions of the sun vectors in the J2000 inertial coordinate system during the mission time period, and judging whether the multiple star sensors are effective according to the angles; Step S10, determining the priorities of the multiple star sensors according to the effectiveness of the multiple star sensors respectively; In step S6, the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period calculated in step S5 is used to calculate the Z-axis vector orientation of the star sensor measurement coordinate system, specifically: Step S601, converting the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system within the mission time period calculated in step S5 into a matrix of the star sensor relative to the J2000 inertial coordinate system within the mission time period; Step S602, based on the matrix of the star sensor relative to the J2000 inertial coordinate system during the mission time period converted in step S601, calculate the direction of the Z axis of the star sensor measurement coordinate system in the J2000 inertial coordinate system; Step S603, based on the Z-axis orientation of the star sensor measurement coordinate system in the J2000 inertial coordinate system calculated in step S602, obtain the orientation of the Z-axis vector of the star sensor measurement coordinate system.

2. The method for using multiple star sensors based on mission planning according to claim 1, characterized in that: In the step S4, based on the attitude of the satellite body relative to the orbital coordinate system during the mission time period determined in step S3, the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system is calculated, which is specifically: If the satellite body has an attitude relative to the orbital coordinate system during the mission time period, then If the satellite itself does not have any attitude relative to the orbital coordinate system during the mission period, then in, is the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system, is the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system, is the attitude quaternion of the satellite body relative to the orbital coordinate system.

3. The method for using multiple star sensors based on mission planning according to claim 1, characterized in that: In the step S5, based on the attitude quaternion of the satellite body relative to the J2000 inertial coordinate system and the attitude quaternion of the star sensor relative to the orbital coordinate system calculated in step S4, the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system during the mission time period is calculated, specifically: in, is the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system, is the attitude quaternion of the orbital coordinate system relative to the J2000 inertial coordinate system, is the attitude quaternion of the satellite body relative to the orbital coordinate system, is the attitude quaternion of the star sensor relative to the orbital coordinate system.

4. The method for using multiple star sensors based on mission planning according to claim 1, characterized in that: In the step S601, the attitude quaternion of the star sensor relative to the J2000 inertial coordinate system in the mission time period calculated in step S5 is converted into a matrix of the star sensor relative to the J2000 inertial coordinate system in the mission time period, specifically: Among them, DCM J2000←star is the matrix of the star sensor relative to the J2000 inertial coordinate system, xx is the angle between the X-axis of the star sensor coordinate system and the X-axis of the J2000 inertial coordinate system, xy is the angle between the Y-axis of the star sensor coordinate system and the X-axis of the J2000 inertial coordinate system, xz is the angle between the Z-axis of the star sensor coordinate system and the X-axis of the J2000 inertial coordinate system, yx is the angle between the X-axis of the star sensor coordinate system and the Y-axis of the J2000 inertial coordinate system, yy is the angle between the Y-axis of the star sensor coordinate system and the Y-axis of the J2000 inertial coordinate system, yz is the angle between the Z-axis of the star sensor coordinate system and the Y-axis of the J2000 inertial coordinate system, zx is the angle between the X-axis of the star sensor coordinate system and the Z-axis of the J2000 inertial coordinate system, zy is the angle between the Y-axis of the star sensor coordinate system and the Z-axis of the J2000 inertial coordinate system, and zz is the angle between the Z-axis of the star sensor coordinate system and the Z-axis of the J2000 inertial coordinate system.

5. The method for using multiple star sensors based on mission planning according to claim 1, characterized in that: In step S602, the calculation of the direction of the Z axis of the star sensor measurement coordinate system in the J2000 inertial coordinate system is specifically: in, is the direction of the Z axis of the star sensor measurement coordinate system in the J2000 inertial coordinate system, zx is the angle between the X axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system, zy is the angle between the Y axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system, and zz is the angle between the Z axis of the star sensor coordinate system and the Z axis of the J2000 inertial coordinate system.

6. The method for using multiple star sensors based on mission planning according to claim 1, characterized in that: In the step S8, the direction of the sun vector in the J2000 inertial coordinate system during the mission period is calculated as follows: in, is the direction of the solar vector in the J2000 inertial coordinate system, α is the mean anomaly, and β is the obliquity of the ecliptic.

7. The method for using multiple star sensors based on mission planning according to claim 1, characterized in that: In the step S9, judging whether the plurality of star sensors are effective according to the included angles respectively comprises the following steps: Step S901, if the included angle is greater than the star sensor avoidance angle, the star sensor is valid; if the included angle is less than the star sensor avoidance angle, the star sensor is invalid; Step S902, repeating step S901 until the determination of multiple star sensors is completed.

8. The method for using multiple star sensors based on mission planning according to claim 1, characterized in that: In the step S10, the priorities of the multiple star sensors are determined according to the effectiveness of the multiple star sensors, specifically: The continuously effective star sensor is defined as the highest level star sensor, and the effective-ineffective switching star sensor is defined as the shielded star sensor; When multiple star sensors are judged to be invalid, attitude determination is performed without star sensors.