Autonomous navigation method of high-altitude long-flight UAV based on space target directional observation
By combining inertial navigation with space target orientation observation, and utilizing a directional observation satellite camera and inertial measurement unit, the problem of high-precision autonomous navigation for high-altitude long-endurance UAVs in GNSS signal rejection environments was solved, achieving high-precision and highly autonomous navigation results.
Patent Information
- Application Number
- CN202211018029.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-08-24
- Publication Date
- 2024-11-05
- Estimated Expiration
- 2042-08-24
AI Technical Summary
Existing technologies struggle to achieve high-precision autonomous navigation for high-altitude, long-endurance UAVs in environments where GNSS signals are denied, and traditional inertial/astronomical combined navigation cannot effectively address the problem of navigation and positioning errors increasing over time.
By combining inertial navigation with a navigation method based on directional observation of space targets, the system acquires the line-of-sight direction information of space targets through a directional observation satellite camera, and then iteratively corrects the position, velocity, and attitude information of the carrier using an inertial measurement unit.
It achieves high-precision, autonomous navigation in GNSS signal denial environments, with strong stealth capabilities, immunity to electromagnetic interference, and navigation accuracy at the hundred-meter level, meeting the autonomous navigation requirements of high-altitude long-endurance UAVs.
Smart Images

Figure CN115479605B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to an autonomous navigation method for a high-altitude, long-flight UAV based on directional observation of space targets, and belongs to the technical field of navigation and guidance. Background Art
[0002] High-altitude, long-flight UAVs require that the navigation system be able to work effectively and reliably for more than 8 hours a day at an altitude of 20km, determine the platform's position and attitude information, and solve the problem of long-flight autonomous navigation of UAVs in GNSS (Global Navigation Satellite System) denied environments. In addition, the system must have the advantages of high precision, high reliability, miniaturization, and low power consumption.
[0003] In the modern informationized combat environment, navigation information plays a vital role in whether combat intentions can be realized. At present, satellite navigation systems with GNSS satellites as information nodes have become an important source of navigation information. However, the existing satellite navigation systems have poor anti-interference capabilities and autonomy. On the one hand, radio signals are easily interfered with or deceived. On the other hand, there is a risk that ground facilities, transmission channels and space systems are vulnerable to attacks, which limits their application under specific conditions. In particular, the high-precision navigation capabilities in adversarial environments are greatly restricted. Once the service cannot be provided due to system failure, signal interference and other reasons, it will have a significant impact on the execution of UAV missions.
[0004] Traditional navigation methods used to replace or assist GNSS include inertial navigation system (INS), celestial navigation system (CNS) and map / scene matching navigation. Despite years of development, they still have limitations under conditions such as long-term navigation, signal obstruction or the absence of typical landmark features.
[0005] The inertial navigation system (INS) works according to the basic properties of mass bodies, does not rely on external information, and does not radiate information outward. It can autonomously and covertly perform continuous three-dimensional spatial positioning and three-dimensional spatial orientation under all-weather conditions on a global scale by itself, and can timely reflect the maneuvering movement of the carrier. It is an indispensable navigation device for important carriers. However, the error of the inertial navigation system accumulates over time. For long-endurance aircraft, the accumulated error needs to be corrected with the help of other navigation information sources. The celestial navigation system (CNS) achieves navigation and positioning by measuring the vector direction of natural celestial bodies relative to the carrier. The inertial reference system composed of stars has high accuracy and reliability. The celestial navigation system has the advantages of high measurement accuracy, strong anti-interference ability, relatively low cost, and navigation errors do not accumulate over time, which makes it occupy an important position. Combining inertial navigation with celestial navigation methods, using star sensors to directly sense stars as drift-free gyroscopes to achieve aircraft attitude error calibration, is a typical technical means to implement autonomous navigation of long-range and long-endurance aircraft. However, due to the influence of accelerometer zero bias and other error factors, traditional inertial / astronomical combined navigation still cannot change the trend of navigation positioning error gradually increasing over time. Map matching and scene navigation methods are difficult to play an effective role in environments without typical landmark features, such as when the carrier is flying over the sea or desert areas. Summary of the invention
[0006] The technical problem solved by the present invention is: in view of the problem that traditional autonomous navigation methods, such as inertial navigation and astronomical navigation, often cannot meet the high-precision autonomous navigation requirements of long-flight UAVs in a GNSS signal denial environment, a high-altitude long-flight UAV autonomous navigation method based on space target directional observation is proposed. The method takes space targets with known spatial positions and known motion laws as a reference, and is combined with inertial navigation technology. The position, speed and attitude information of the carrier can be determined through combined navigation solution. The method has broad application prospects in various aircraft platforms and is of great value.
[0007] The technical solution adopted by the present invention is:
[0008] A high-altitude long-flight UAV autonomous navigation method based on space target directional observation, the steps are as follows:
[0009] (1) Initializing the carrier attitude estimator and position and speed estimator, and setting the initial value of the state vector representing the carrier position, speed and attitude information;
[0010] (2) Using a directional observation star camera equipped on a high-altitude long-flight UAV to perform imaging observations of stars, obtain the star line-of-sight direction observations in the carrier coordinate system, and construct the observations of the carrier attitude estimator;
[0011] (3) Predict the attitude of the carrier based on the observation data of the gyroscope in the inertial measurement unit configured on the high-altitude, long-flight UAV;
[0012] (4) When the star line-of-sight direction observation quantity of the directional observation star camera is available, the observation quantity obtained in step (2) is processed by the carrier attitude estimator, and the carrier attitude prediction value obtained in step (3) is corrected;
[0013] (5) Using a directional observation star camera equipped on a high-altitude long-flight UAV, the space target and background stars are simultaneously photographed and observed. Based on the geometric position relationship between the image of the space target in the directional observation star camera and the image of the background stars, the line of sight direction observation quantity of the space target in the inertial coordinate system is obtained;
[0014] (6) Predict the position and velocity of the carrier based on the observation data of the accelerometer in the inertial measurement unit configured on the high-altitude long-flight UAV and the Earth's gravitational field model;
[0015] (7) When the observation of the line of sight direction of the space target is available, the observation obtained in step (5) is processed by the position and velocity estimator to correct the predicted values of the position and velocity of the carrier obtained in step (6);
[0016] (8) Steps (2) to (7) are iterated repeatedly to obtain estimated values of the carrier's position, velocity, and attitude, thereby completing autonomous navigation of a high-altitude, long-flight UAV based on directional observation of space targets.
[0017] Furthermore, the method for initializing the carrier attitude estimator in step (1) is: setting the estimated values of the carrier attitude quaternion and the gyroscope drift at the initial moment (k=0) to be and Said and According to the prior knowledge about the carrier attitude and the gyroscope, the method for initializing the position and velocity estimator is as follows: the initial filter estimate of the position and velocity estimator is set to:
[0018]
[0019] in, and They represent the estimated values of the position and velocity vector of the carrier in the inertial coordinate system at the initial moment, Represents the estimated value of the accelerometer zero bias at the initial moment, Obtained from prior knowledge about the carrier's position, velocity, and accelerometers.
[0020] Furthermore, the observation quantity of the carrier attitude estimator constructed in step (2) is:
[0021]
[0022] in, and They represent the observed and estimated values of the line of sight direction of the jth star in the carrier coordinate system at time k (k = 1, 2, ...), Measured by a directional star observation camera, It is calculated based on a previously established star catalog and the carrier attitude quaternion estimate.
[0023] Furthermore, the method for predicting the attitude of the carrier in step (3) is as follows: the quaternion prediction value of the carrier attitude at time k is calculated according to the following formula:
[0024]
[0025] in,
[0026]
[0027]
[0028] It represents the three-axis attitude angular velocity observation of the carrier after gyroscope drift compensation. The method of compensating gyroscope drift is:
[0029]
[0030] represents the carrier attitude angular velocity measured by the gyroscope in the inertial measurement unit at time k-1, represents the estimated value of the gyroscope drift at time k-1; τ A Represents the time step of one-step prediction in the carrier pose estimator.
[0031] Furthermore, the method for correcting the predicted value of the carrier posture in step (4) is:
[0032]
[0033]
[0034] and They represent the estimated values of the carrier attitude quaternion and gyroscope drift at time k, It represents the estimated value of the carrier attitude error quaternion at time k, which can be written as Represents the estimated value of the vector part of the carrier attitude error quaternion at time k, element The value of satisfies the normalization condition symbol Represents quaternion multiplication. The vector part of the carrier attitude error quaternion estimate and gyroscope drift error estimate The calculation formula is
[0035]
[0036] K A,k The filter gain matrix representing the carrier attitude estimator can be calculated according to a carrier attitude estimation system model established in advance.
[0037] Furthermore, the observed value of the line of sight direction of the space target in the inertial coordinate system in step (5) is
[0038]
[0039] in, It represents the line-of-sight direction observation of the i-th space target in the inertial coordinate system, which is measured by a directional observation star camera. The space target can be selected as an Earth-orbiting satellite with known ephemeris, such as a GNSS (Global Navigation Satellite System) satellite or a Starlink satellite.
[0040] Furthermore, the method for predicting the position and speed of the carrier in step (6) is as follows: the predicted value of the position and speed estimator at time k is calculated according to the following formula:
[0041]
[0042] State transfer function The form is
[0043]
[0044] Among them, f I,k It represents the specific force in the inertial coordinate system, and its calculation formula is
[0045]
[0046] f B,k is the specific force in the carrier coordinate system measured by the accelerometer, and the matrix Represents the attitude transformation matrix from the inertial coordinate system to the carrier coordinate system, which can be estimated based on the carrier attitude quaternion Calculated
[0047]
[0048] in,
[0049]
[0050]
[0051] Represents the acceleration of gravity, which can be calculated based on the earth's gravitational field model, τ P Represents the time step of one-step prediction in the position and velocity estimator.
[0052] Furthermore, the method for correcting the predicted values of the position and speed of the carrier in step (7) is:
[0053]
[0054] in, represents the filtered estimate of the position and velocity estimator at time k, K P,k It represents the filter gain matrix of the position and velocity estimator, which can be calculated based on the position and velocity estimation system model established in advance. The observation function The form is
[0055]
[0056] in, is the position vector of the i-th space target, which can be calculated based on the known space target ephemeris. for The predicted value of the vector position in .
[0057] The beneficial effects of the present invention compared with the prior art are:
[0058] (1) The present invention integrates the functions of positioning and attitude determination based on the directional observation star camera. It can determine the position of the carrier by relying on the measurement information of the line of sight direction of the space target and determine the attitude of the carrier by measuring the starlight. Any space target on the celestial sphere whose motion law is known and meets the sensitivity requirements can be used as an observation target.
[0059] (2) The precise measurement of the line of sight direction of the space target of the present invention is easy to achieve with existing technology: compared with the large field of view camera used for sensitive horizon, it is easy to improve the measurement accuracy through the design technology of small field of view and long focal length optical system; compared with navigation methods such as earth landmark measurement, it is relatively less affected by factors such as weather, clouds, terrain, etc., and star point information is easier to detect and identify than earth landmarks.
[0060] (3) The autonomous navigation method based on directional observation of space targets of the present invention has the characteristics of strong concealment, no influence of electromagnetic interference, safety and reliability, etc. It can achieve a navigation accuracy of hundreds of meters, which helps to solve the problems caused by the inherent vulnerability of GNSS and astronomical navigation systems and provide users with robust navigation and positioning services. BRIEF DESCRIPTION OF THE DRAWINGS
[0061] Figure 1is a flow chart of the present invention;
[0062] Figure 2 is a curve diagram of carrier position estimation error based on space target directional observation;
[0063] Figure 3 is a curve diagram of carrier velocity estimation error based on space target directional observation;
[0064] Figure 4 This is a curve diagram of the carrier attitude estimation error based on space target directional observation. DETAILED DESCRIPTION
[0065] The specific embodiments of the present invention are further described in detail below with reference to the accompanying drawings.
[0066] Aiming at the problem that high-altitude long-flight UAVs lack high-precision fully autonomous navigation means, the present invention proposes a high-altitude long-flight UAV autonomous navigation method based on directional observation of space targets. In an environment where GNSS signals are denied, the position, speed and attitude of the carrier are determined by combining the known space target sight direction measurement information provided by the directional observation star camera with the inertial measurement unit (IMU). Compared with the traditional GNSS and other navigation methods based on radio beacons, it has the advantages of passive detection, good concealment, no electromagnetic interference, and autonomous operation, and can achieve long-flight, high-precision, global autonomous navigation, and enhance the autonomous GNC capability of high-altitude long-flight UAV platforms.
[0067] The present invention proposes a high-altitude long-flight UAV autonomous navigation method based on space target directional observation, such as Figure 1 As shown, the steps are as follows:
[0068] (1) Initializing the carrier attitude estimator and the position and velocity estimator, and setting the initial value of the state vector representing the carrier position, velocity and attitude information; the method for initializing the carrier attitude estimator is: setting the estimated values of the carrier attitude quaternion and gyroscope drift at the initial time (k = 0) to be and Said and According to the prior knowledge about the carrier attitude and the gyroscope, the method for initializing the position and velocity estimator is as follows: the initial filter estimate of the position and velocity estimator is set to:
[0069]
[0070] in, and They represent the estimated values of the position and velocity vector of the carrier in the inertial coordinate system at the initial moment, Represents the estimated value of the accelerometer zero bias at the initial moment, Obtained from prior knowledge about the carrier's position, velocity, and accelerometers.
[0071] (2) The stars are imaged and observed by a directional observation star camera configured on a high-altitude long-flight UAV, the observation quantity of the star line of sight direction in the carrier coordinate system is obtained, and the observation quantity of the carrier attitude estimator is constructed; the observation quantity of the constructed carrier attitude estimator is:
[0072]
[0073] in, and They represent the observed and estimated values of the line of sight direction of the jth star in the carrier coordinate system at time k (k = 1, 2, ...), Measured by a directional star observation camera, It is calculated based on a previously established star catalog and the carrier attitude quaternion estimate.
[0074] (3) The attitude of the carrier is predicted based on the observation data of the gyroscope in the inertial measurement unit configured on the high-altitude long-flight UAV; the method for predicting the attitude of the carrier is: the quaternion prediction value of the carrier attitude at time k is calculated according to the following formula
[0075]
[0076] in,
[0077]
[0078]
[0079] It represents the three-axis attitude angular velocity observation of the carrier after gyroscope drift compensation. The method of compensating gyroscope drift is:
[0080]
[0081] represents the carrier attitude angular velocity measured by the gyroscope in the inertial measurement unit at time k-1, represents the estimated value of the gyroscope drift at time k-1; τ A Represents the time step of one-step prediction in the carrier pose estimator.
[0082] (4) When the star line-of-sight direction observation quantity of the directional observation star camera is available, the observation quantity obtained in step (2) is processed by the carrier attitude estimator, and the carrier attitude prediction value obtained in step (3) is corrected; the method for correcting the carrier attitude prediction value is as follows:
[0083]
[0084]
[0085] and They represent the estimated values of the carrier attitude quaternion and gyroscope drift at time k, It represents the estimated value of the carrier attitude error quaternion at time k, which can be written as Represents the estimated value of the vector part of the carrier attitude error quaternion at time k, element The value of satisfies the normalization condition symbol Represents quaternion multiplication. The vector part of the carrier attitude error quaternion estimate and gyroscope drift error estimate The calculation formula is
[0086]
[0087] K A,k The filter gain matrix representing the carrier attitude estimator can be calculated according to a carrier attitude estimation system model established in advance.
[0088] (5) The directional observation star camera configured on the high-altitude long-flight UAV simultaneously photographically observes the space target and the background stars. According to the geometric position relationship between the image of the space target in the directional observation star camera and the image of the background stars, the line-of-sight direction observation quantity of the space target in the inertial coordinate system is obtained; the line-of-sight direction observation quantity of the space target in the inertial coordinate system is
[0089]
[0090] in, It represents the line-of-sight direction observation of the i-th space target in the inertial coordinate system, which is measured by a directional observation star camera. The space target can be selected as an Earth-orbiting satellite with known ephemeris, such as a GNSS (Global Navigation Satellite System) satellite or a Starlink satellite.
[0091] (6) The position and velocity of the carrier are predicted based on the observation data of the accelerometer in the inertial measurement unit configured on the high-altitude long-flight UAV and the earth's gravitational field model; the method for predicting the position and velocity of the carrier is: the predicted value of the position and velocity estimator at time k is calculated according to the following formula
[0092]
[0093] State transfer function The form is
[0094]
[0095] Among them, f I,k It represents the specific force in the inertial coordinate system, and its calculation formula is
[0096]
[0097] f B,k is the specific force in the carrier coordinate system measured by the accelerometer, and the matrix Represents the attitude transformation matrix from the inertial coordinate system to the carrier coordinate system, which can be estimated based on the carrier attitude quaternion Calculated
[0098]
[0099] in,
[0100]
[0101]
[0102] Represents the acceleration of gravity, which can be calculated based on the earth's gravitational field model, τ P Represents the time step of one-step prediction in the position and velocity estimator.
[0103] (7) When the observation of the line of sight direction of the space target is available, the observation obtained in step (5) is processed by the position and velocity estimator, and the predicted values of the position and velocity of the carrier obtained in step (6) are corrected; the method for correcting the predicted values of the position and velocity of the carrier is as follows:
[0104]
[0105] in, represents the filtered estimate of the position and velocity estimator at time k, K P,k It represents the filter gain matrix of the position and velocity estimator, which can be calculated based on the position and velocity estimation system model established in advance. The observation function The form is
[0106]
[0107] in, is the position vector of the i-th space target, which can be calculated based on the known space target ephemeris. for The predicted value of the vector position in .
[0108] (8) Steps (2) to (7) are iterated repeatedly to obtain estimated values of the carrier's position, velocity, and attitude, thereby completing autonomous navigation of a high-altitude, long-flight UAV based on directional observation of space targets.
[0109] Furthermore, the present invention also proposes a high-altitude, long-flight UAV autonomous navigation system based on space target directional observation, comprising:
[0110] Initialization module: initializes the carrier attitude estimator and position and speed estimator, and sets the initial value of the state vector representing the carrier position, speed and attitude information;
[0111] The observation quantity construction module of the carrier attitude estimator: the directional observation star camera configured on the high-altitude long-flight UAV is used to perform imaging observations of stars, obtain the observation quantity of the star line of sight direction in the carrier coordinate system, and construct the observation quantity of the carrier attitude estimator;
[0112] Carrier attitude prediction module: predicts the carrier's attitude based on the observation data of the gyroscope in the inertial measurement unit configured on the high-altitude long-flight UAV;
[0113] Carrier attitude prediction value correction module: When the star line of sight direction observation quantity of the directional observation star camera is available, the carrier attitude estimator processes the observation quantity and corrects the carrier attitude prediction value;
[0114] Space target line of sight direction observation calculation module: The directional observation star camera configured on the high-altitude long-flight UAV simultaneously observes the space target and the background stars, and obtains the space target line of sight direction observation quantity in the inertial coordinate system according to the geometric position relationship between the image of the space target in the directional observation star camera and the image of the background stars;
[0115] Carrier position and velocity prediction module: predicts the position and velocity of the carrier based on the observation data of the accelerometer in the inertial measurement unit configured on the high-altitude long-flight UAV and the earth's gravitational field model;
[0116] Position and velocity prediction value correction module: When the space target line of sight direction observation is available, the observation is processed by the position and velocity estimator to correct the predicted values of the carrier's position and velocity.
[0117] Next, taking the navigation and positioning of high-altitude long-flight UAV as an example, the effectiveness of the method described in the present invention is verified through a simulation example. Assume that the carrier is flying over the earth and its attitude remains stable relative to the earth. A directional observation star camera with the ability to measure the line of sight of stars and space targets, as well as a gyroscope and an accelerometer are installed on the carrier. The line of sight direction measurement of space targets based on the directional observation star camera can achieve an accuracy level of arc seconds. In the autonomous navigation system of UAVs based on directional observation of space targets, the carrier position estimation and attitude determination can be achieved through the same set of sensor equipment. Assume that the standard deviation of the random error of the gyroscope is 0.02° / h, and the standard deviation of the random error of the accelerometer is 1×10 -5 g, the standard deviation of the random error of the line of sight direction measurement of the directional observation star camera is 1″. In the mathematical simulation process, the predicted values obtained by the gyroscope and accelerometer are corrected by the line of sight direction measurement data of the stars and space targets provided by the directional observation star camera to determine the position, speed and attitude of the carrier. The position, speed and attitude estimation error curves of the high-altitude long-flight UAV obtained by the method of the present invention are respectively as follows: Figure 2 , Figure 3 and Figure 4 As shown. The solid line in the figure represents the state estimation error curve, and the dotted line represents the 3σ error bound calculated based on the corresponding diagonal elements of the carrier attitude estimator and the position and velocity estimator estimation error variance matrix. Mathematical simulation studies have shown that the method of the present invention is used for autonomous navigation of high-altitude long-endurance unmanned aerial vehicles. When the angular measurement accuracy of the directional observation star camera reaches the arc second level, the positioning accuracy level of the order of hundreds of meters can be achieved.
[0118] The main technical content of the present invention can open up a new way for the autonomous navigation of high-altitude and long-flight UAVs, can meet the military needs of "high precision, long time, and autonomy", and has high application value in the future information battlefield.
[0119] The contents not described in detail in the specification of the present invention belong to the common knowledge of the professionals in this field.
Claims
1. A high-altitude, long-flight UAV autonomous navigation method based on space target directional observation, characterized in that: Here are the steps: (1) Initializing the carrier attitude estimator and position and speed estimator, and setting the initial value of the state vector representing the carrier position, speed and attitude information; (2) Using a directional observation star camera equipped on a high-altitude long-flight UAV to perform imaging observations of stars, obtain the star line-of-sight direction observations in the carrier coordinate system, and construct the observations of the carrier attitude estimator; (3) Predict the attitude of the carrier based on the observation data of the gyroscope in the inertial measurement unit configured on the high-altitude, long-flight UAV; (4) When the star line-of-sight direction observation quantity of the directional observation star camera is available, the observation quantity of the carrier attitude estimator obtained in step (2) is processed by the carrier attitude estimator, and the carrier attitude prediction value obtained in step (3) is corrected; (5) Using a directional observation star camera equipped on a high-altitude long-flight UAV, the space target and background stars are simultaneously photographed and observed. Based on the geometric position relationship between the image of the space target in the directional observation star camera and the image of the background stars, the line of sight direction observation quantity of the space target in the inertial coordinate system is obtained; (6) Predict the position and velocity of the carrier based on the observation data of the accelerometer in the inertial measurement unit configured on the high-altitude long-flight UAV and the Earth's gravitational field model; (7) When the observation of the line of sight direction of the space target is available, the observation obtained in step (5) is processed by the position and velocity estimator to correct the predicted values of the position and velocity of the carrier obtained in step (6); (8) Steps (2) to (7) are iterated repeatedly to obtain estimated values of the carrier's position, velocity, and attitude, thereby completing autonomous navigation of a high-altitude, long-flight UAV based on directional observation of space targets.
2. The high-altitude long-flight UAV autonomous navigation method based on space target directional observation according to claim 1 is characterized by: The method for initializing the carrier attitude estimator in step (1) is: setting the estimated values of the carrier attitude quaternion and the gyroscope drift at the initial time k=0 to be respectively and Said and Obtained based on prior knowledge about the carrier attitude and gyroscope; The method for initializing the position and speed estimator is to set the initial filter estimate of the position and speed estimator to: in, and They represent the estimated values of the position and velocity vector of the carrier in the inertial coordinate system at the initial moment, Represents the estimated value of the accelerometer zero bias at the initial moment, Obtained from prior knowledge about the carrier's position, velocity, and accelerometers.
3. The high-altitude long-flight UAV autonomous navigation method based on space target directional observation according to claim 2 is characterized in that: The observation quantity of the carrier attitude estimator constructed in step (2) is: in, and They represent the observed and estimated values of the line of sight direction of the jth star in the carrier coordinate system at time k, j = 1, 2, ..., N, Measured by a directional star observation camera, It is calculated based on a previously established star catalog and the carrier attitude quaternion estimate.
4. The high-altitude long-flight UAV autonomous navigation method based on space target directional observation according to claim 3 is characterized by: The method for predicting the attitude of the carrier in step (3) is as follows: the predicted value of the carrier attitude quaternion at time k is calculated according to the following formula: in, It represents the three-axis attitude angular velocity observation of the carrier after gyroscope drift compensation. The method of compensating gyroscope drift is: represents the carrier attitude angular velocity measured by the gyroscope in the inertial measurement unit at time k-1, represents the estimated value of the gyroscope drift at time k-1; τ A represents the time step of one-step prediction in the carrier pose estimator, I 4×4 is a unit matrix.
5. The high-altitude long-flight UAV autonomous navigation method based on space target directional observation according to claim 4 is characterized by: The method for correcting the carrier posture prediction value in step (4) is: and They represent the estimated values of the carrier attitude quaternion and gyroscope drift at time k, Represents the estimated value of the carrier attitude error quaternion at time k, written as Represents the estimated value of the vector part of the carrier attitude error quaternion at time k, element The value of satisfies the normalization condition symbol Represents quaternion multiplication; vector portion of the carrier attitude error quaternion estimate and gyroscope drift error estimate The calculation formula is K A,k represents the filter gain matrix of the carrier attitude estimator, which is calculated based on the previously established carrier attitude estimation system model, y A,k is the observation of the carrier attitude estimator.
6. The high-altitude, long-flight UAV autonomous navigation method based on space target directional observation according to claim 5 is characterized by: The observed value of the line of sight direction of the space target in the inertial coordinate system in step (5) is: in, It represents the line-of-sight direction observation of the i-th space target in the inertial coordinate system, i = 1, 2, …, M, which is measured by a directional observation star camera. The space target is selected as an earth-orbiting satellite with known ephemeris.
7. The high-altitude, long-flight UAV autonomous navigation method based on space target directional observation according to claim 6 is characterized by: The method for predicting the position and speed of the carrier in step (6) is as follows: the predicted value of the position and speed estimator at time k is calculated according to the following formula: State transfer function The form is Among them, f I,k It represents the specific force in the inertial coordinate system, and its calculation formula is f B,k is the specific force in the carrier coordinate system measured by the accelerometer, and the matrix Represents the attitude transformation matrix from the inertial coordinate system to the carrier coordinate system, based on the carrier attitude quaternion estimate Calculated in, Represents the acceleration of gravity, which is calculated based on the Earth's gravitational field model, τ P represents the time step of one-step prediction in the position and velocity estimator, The quaternion estimate of the carrier attitude The 4 elements in .
8. The high-altitude, long-flight UAV autonomous navigation method based on space target directional observation according to claim 7 is characterized by: The method for correcting the predicted values of the position and speed of the carrier in step (7) is as follows: in, represents the filtered estimate of the position and velocity estimator at time k, K P,k Represents the filter gain matrix of the position and velocity estimator, which is calculated based on the previously established position and velocity estimation system model. The observation function The form is in, is the position vector of the i-th space target, i = 1, 2, ..., M, calculated based on the known space target ephemeris, for The predicted value of the vector position in .
9. A high-altitude, long-flight UAV autonomous navigation system based on space target directional observation, characterized in that: include: Initialization module: Initialize the carrier attitude estimator and position and speed estimator, and set the initial value of the state vector representing the carrier position, speed and attitude information; The observation quantity construction module of the carrier attitude estimator: the directional observation star camera configured on the high-altitude long-flight UAV is used to perform imaging observations of stars, obtain the observation quantity of the star line of sight direction in the carrier coordinate system, and construct the observation quantity of the carrier attitude estimator; Carrier attitude prediction module: predicts the carrier's attitude based on the observation data of the gyroscope in the inertial measurement unit configured on the high-altitude long-flight UAV; Carrier attitude prediction value correction module: when the star line of sight direction observation quantity of the directional observation star camera is available, the carrier attitude estimator processes the observation quantity of the carrier attitude estimator and corrects the carrier attitude prediction value; Space target line of sight direction observation calculation module: The directional observation star camera configured on the high-altitude long-flight UAV simultaneously observes the space target and the background stars, and obtains the space target line of sight direction observation quantity in the inertial coordinate system according to the geometric position relationship between the image of the space target in the directional observation star camera and the image of the background stars; Carrier position and velocity prediction module: predicts the position and velocity of the carrier based on the observation data of the accelerometer in the inertial measurement unit configured on the high-altitude long-flight UAV and the earth's gravitational field model; Position and velocity prediction value correction module: When the space target line of sight direction observation is available, the space target line of sight direction observation in the inertial coordinate system is processed by the position and velocity estimator to correct the predicted values of the carrier's position and velocity.
10. The high-altitude, long-flight UAV autonomous navigation system based on space target directional observation according to claim 9, characterized in that: The method for initializing the carrier attitude estimator is: setting the estimated values of the carrier attitude quaternion and the gyroscope drift at the initial time k=0 to be respectively and Said and Obtained based on prior knowledge about the carrier attitude and gyroscope; The method for initializing the position and speed estimator is to set the initial filter estimate of the position and speed estimator to: in, and They represent the estimated values of the position and velocity vector of the carrier in the inertial coordinate system at the initial moment, Represents the estimated value of the accelerometer zero bias at the initial moment, obtained from a priori knowledge about the carrier's position, velocity, and accelerometer; The observation quantity of the constructed carrier attitude estimator is: in, and They represent the observed and estimated values of the line of sight direction of the jth star in the carrier coordinate system at time k, j = 1, 2, ..., N, Measured by a directional star observation camera, Calculated based on the previously established star catalog and the carrier attitude quaternion estimate; The method for predicting the attitude of the carrier is as follows: the predicted value of the carrier attitude quaternion at time k is calculated according to the following formula: in, It represents the three-axis attitude angular velocity observation of the carrier after gyroscope drift compensation. The method of compensating gyroscope drift is: represents the carrier attitude angular velocity measured by the gyroscope in the inertial measurement unit at time k-1, represents the estimated value of the gyroscope drift at time k-1; τ A represents the time step of one-step prediction in the carrier pose estimator, I 4×4 is the unit matrix; The method for correcting the predicted value of the carrier posture is as follows: and They represent the estimated values of the carrier attitude quaternion and gyroscope drift at time k, Represents the estimated value of the carrier attitude error quaternion at time k, written as Represents the estimated value of the vector part of the carrier attitude error quaternion at time k, element The value of satisfies the normalization condition symbol Represents quaternion multiplication; vector portion of the carrier attitude error quaternion estimate and gyro drift error estimate The calculation formula is K A,k represents the filter gain matrix of the carrier attitude estimator, which is calculated based on the previously established carrier attitude estimation system model, y A,k is the observation of the carrier attitude estimator; The observed direction of the space target in the inertial coordinate system is: in, It represents the line of sight direction observation of the i-th space target in the inertial coordinate system, i = 1, 2, ..., M, which is measured by a directional observation star camera. The space target can be selected as an earth orbit satellite with known ephemeris; The method for predicting the position and speed of the carrier is as follows: The predicted value of the position and speed estimator at time k is calculated according to the following formula State transfer function The form is Among them, f I,k It represents the specific force in the inertial coordinate system, and its calculation formula is f B,k is the specific force in the carrier coordinate system measured by the accelerometer, and the matrix Represents the attitude transformation matrix from the inertial coordinate system to the carrier coordinate system, based on the carrier attitude quaternion estimate Calculated in, Represents the acceleration of gravity, which is calculated based on the Earth's gravitational field model, τ P represents the time step of one-step prediction in the position and velocity estimator, The quaternion estimate of the carrier attitude The 4 elements in; The method for correcting the predicted values of the position and velocity of the carrier is as follows: in, represents the filtered estimate of the position and velocity estimator at time k, K P,k Represents the filter gain matrix of the position and velocity estimator, which is calculated based on the previously established position and velocity estimation system model. The observation function The form is in, is the position vector of the i-th space target, i = 1, 2, 3, ..., M, calculated based on the known space target ephemeris, for The predicted value of the vector position in .
Citation Information
Patent Citations
Joint attitude determination method of gravity gradiometer and star sensor
CN108871312A
Navigation observation target selection method based on Q learning
CN111637895A
Spacecraft autonomous attitude determination system based on combination of gravity gradiometer and gyroscope
CN112325886A
Spacecraft autonomous navigation method based on fixed star sight relativistic effect
CN113091731A
Spacecraft inertia / fixed star starlight vector / starlight refraction combined navigation method
CN113551668A
