A high-precision angle measurement method for formation spacecraft
Through the combination system of BOC signal and pure carrier and Kalman filtering technology, the problem of low angle measurement accuracy of formation spacecraft is solved, high-precision angle measurement is achieved, payload is reduced, and the task is completed accurately.
Patent Information
- Application Number
- CN202211478417.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-11-23
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2042-11-23
AI Technical Summary
The existing fleet spacecraft angle measurement system has low accuracy and increases the system payload volume and weight, making it difficult to accurately measure the angle between spacecraft, affecting the accuracy of mission completion.
The combination system of BOC signal and pure carrier is adopted, and the L-shaped receiving array of 3 antennas and Kalman filtering technology is used to achieve high-precision angle measurement, reduce payload and improve angle measurement accuracy.
Improve the accuracy of angle measurement between spacecraft, reduce the number of antennas and payload, and ensure the accurate completion of the mission.
Smart Images

Figure CN115876153B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to a formation spacecraft, and in particular to a high-precision angle measurement method for a formation spacecraft. Background Art
[0002] In recent years, as various space flight missions have become increasingly difficult and the requirements for spacecraft performance have become increasingly high, if a single spacecraft wants to meet the needs of complex missions, it must increase its size and mass. In order to solve such complex tasks, formation spacecraft has become a key research direction for various countries. Formation spacecraft refers to a system composed of multiple spacecraft that form a formation to complete a certain task in a unified manner. Focusing on the target mission, the mission payload, communication, navigation, computing and other functions of a large spacecraft are decomposed into multiple module-level small spacecraft, and through formation flight, a virtual large spacecraft is formed. Formation spacecraft has many advantages such as flexible structure and ability to complete highly complex tasks. It plays a very important role in navigation, remote sensing, communication and other aspects.
[0003] The key to ensuring the normal operation of formation spacecraft lies in the measurement of the relative attitude and relative position between spacecraft. For formation spacecraft, if the measurement system relies on ground measurement and control stations, it will have the disadvantages of low measurement accuracy and long measurement time. As an autonomous collaborative control system, the spacecraft should use its own navigation and guidance system to complete the measurement task. For the measurement system, the measured parameters are mainly: the distance between the two spacecraft, the relative speed between the two spacecraft, and the azimuth and pitch angles between the two spacecraft. At present, most angle measurement systems use the BPSK / QPSK modulation system and a multi-baseline interferometer angle measurement system. However, these methods increase the payload volume and weight of the system, and also have limitations in angle measurement resolution. For the angle measurement system of formation spacecraft, it is required to be able to accurately measure the angle of the target spacecraft to ensure the accurate completion of the mission. At the same time, the spacecraft should also carry as small a payload as possible. Summary of the invention
[0004] The purpose of the present invention is to overcome the deficiencies of the prior art and provide a high-precision angle measurement method for formation spacecraft.
[0005] The object of the present invention is achieved through the following technical solutions: a high-precision angle measurement method for formation spacecraft, wherein a group of spacecraft flying in formation are provided, each spacecraft is provided with a transmitting end and a receiving end; for any two spacecrafts, the transmitting end of one spacecraft transmits a signal to the receiving end of the other spacecraft to measure the angle between the two spacecrafts, and the angle measurement process includes the following steps:
[0006] S1. The transmitter saves the initial BOC signal in advance and compares the initial BOC signal with f 0MHz pure carrier multiplication, so that the center frequency becomes f 0 MHz, and then add f higher than the center frequency 1 MHz pure carrier wave is transmitted after secondary modulation;
[0007] S2. Assume that the antenna receiving array of the receiving end is an L-shaped antenna receiving array composed of three receiving antennas, and the antenna receiving array adopts a long baseline design; the receiving end first captures the signal of each receiving antenna, and performs signal tracking based on the captured signal;
[0008] The signal capture process includes: for each receiving antenna, a digital intermediate frequency signal is received, a regenerated carrier is generated to down-convert the digital intermediate frequency signal, and the carrier stripping is completed by using the FFT method to obtain a rough estimate of the pseudo code phase of the BOC signal and the carrier Doppler frequency;
[0009] The signal tracking process includes: for each receiving antenna, performing pseudo code phase tracking and carrier tracking based on the captured pseudo code phase and Doppler frequency rough estimation values to obtain the pseudo code phase and carrier Doppler frequency fine estimation values;
[0010] S3. Phase deambiguation of the received signal: The phase measurement difference is calculated based on the Doppler frequency change of the antenna and the pseudo code phase difference, and the integer part is set to a constant value as the parameter of the Kalman filter. Then the non-integer part is accumulated to obtain the observation and state equation of the Kalman filter, and on this basis, the high-precision angle measurement result is solved.
[0011] The beneficial effects of the present invention are:
[0012] 1. The signal system of BOC plus pure carrier is adopted, which combines the measurement advantages of BOC signal and pure carrier.
[0013] 2. An L-shaped receiving channel with three antennas is used, which greatly reduces the number of antennas and the effective load.
[0014] 3. Use Kalman filtering to deambiguate the carrier phase and improve the angle measurement accuracy. BRIEF DESCRIPTION OF THE DRAWINGS
[0015] Figure 1 A flow chart for generating an angle measurement signal of the present invention;
[0016] Figure 2 It is a schematic diagram of the interferometer model of the present invention;
[0017] Figure 3 This is a flow chart of angle measurement signal receiving of the present invention;
[0018] Figure 4 The figure is a flow chart of signal capture of the present invention;
[0019] Figure 5 The signal tracking flow chart of the present invention;
[0020] Figure 6 This is a flow chart of Kalman filtering of the signal of the present invention. DETAILED DESCRIPTION
[0021] The technical solution of the present invention is further described in detail below in conjunction with the accompanying drawings, but the protection scope of the present invention is not limited to the following.
[0022] Assume a group of spacecraft flying in formation, each of which is provided with a transmitting end and a receiving end; for any two of the spacecrafts, the transmitting end of one of the spacecrafts transmits a signal to the receiving end of the other spacecraft to measure the angle between the two spacecrafts. The angle measurement process of the present invention includes the following steps:
[0023] High-precision angle measurement signal generation, such as Figure 1 As shown, including:
[0024] The transmitter saves the initial BOC signal in advance and combines the initial BOC signal with f 0 MHz pure carrier multiplication, so that the center frequency becomes f 0 MHz, and then add f higher than the center frequency 1 MHz pure carrier wave is transmitted after secondary modulation;
[0025] like Figure 2 As shown, the antenna receiving array at the receiving end is an L-shaped antenna receiving array composed of three receiving antennas, and the antenna receiving array adopts a long baseline design; according to the angle relationship, for Figure 2 The designed antenna receiving array, the formula for measuring the angle can be written as
[0026]
[0027] Among them, ΔΨ PN The phase difference between antenna P and antenna N, d PN is the baseline length between antenna P and antenna N. This method adopts a long baseline design.
[0028] Similarly, the angle measurement formula of antenna P and antenna M is:
[0029]
[0030] Among them, ΔΨ PM The phase measurement difference between antenna P and antenna M, d PM is the baseline length between antenna P and antenna M. The long baseline design takes λ is the signal wavelength.
[0031] like Figure 3 The high-precision angle measurement signal receiving process shown includes:
[0032] The receiving end first captures the signal of each receiving antenna and performs signal tracking based on the captured signal;
[0033] The signal capture process includes: for each receiving antenna, a digital intermediate frequency signal is received, a regenerated carrier is generated to down-convert the digital intermediate frequency signal, and the carrier stripping is completed by using the FFT method to obtain a rough estimate of the pseudo code phase of the BOC signal and the carrier Doppler frequency;
[0034] like Figure 4 As shown in the figure, it is a flow chart of signal capture, the received signal is first converted into a digital intermediate frequency signal, a regenerated carrier is generated to down-convert the digital intermediate frequency signal, and the carrier stripping is completed; the FFT method is used to realize the correlation operation; the correlation result is detected and judged; when the capture is completed, the pseudo code phase of the spread spectrum signal and the rough estimate of the carrier Doppler frequency shift are obtained, and they are output to the carrier and code tracking circuit together with the capture status.
[0035] Specifically, signal capture is performed for each of the three antennas M, P, and N, wherein the signal capture process of antenna P includes the following sub-steps:
[0036] A1. Perform FFT on the locally stored pseudo-code data and store the conjugate of the result, denoted as S 0 , the locally stored pseudo code data is the same as the pseudo code data contained in the BOC signal;
[0037] A2. Use the carrier NCO to generate a frequency f I MHz local carrier, and mix it with the received intermediate frequency signal, and then perform FFT operation, recorded as S 1 ;
[0038] A3.S 0 With S 1 After multiplication, perform IFFT transformation and find the maximum correlation peak value;
[0039] If the maximum correlation peak value exceeds the preset capture threshold, the capture is deemed successful, and the capture process ends, and the process proceeds to step A4;
[0040] If the maximum correlation peak does not exceed the preset capture threshold, the carrier NCO frequency f is changed I 'Make the frequency step value step, that is, f I '=f I +f O1 ,f O1is the preset frequency step value; and f I 'As a new f I , return to step A2, and repeat steps A2 to A3 until the capture is successful;
[0041] A4. Get a rough estimate of the pseudo code phase and a rough estimate of the Doppler shift
[0042] Coarse estimate of pseudo code phase That is, when the capture is successful, the frequency f I Corresponding local carrier phase value, rough estimate of Doppler frequency That is, the frequency f when the capture is successful I ;
[0043] The capture process of antennas M and N is the same. Let the pseudo code phase corresponding to antenna M be roughly estimated as A rough estimate of the Doppler frequency is The rough estimate of the pseudo code phase corresponding to antenna N is A rough estimate of the Doppler frequency is
[0044] The signal tracking process includes: for each receiving antenna, performing pseudo code phase tracking and carrier tracking based on the captured pseudo code phase and Doppler frequency rough estimation values to obtain the pseudo code phase and carrier Doppler frequency fine estimation values;
[0045] The signal is tracked as Figure 5 As shown, including:
[0046] After the carrier frequency and code phase prediction work of the FFT capture circuit is completed, the carrier and code tracking loop enters the carrier tracking and code tracking state. The regenerative pseudo code generator uses the pseudo code phase given by the capture circuit as the initial value, and generates a pseudo code sequence according to the results of the code loop filter and carrier assistance. The results of the pseudo code despreading of the orthogonal / in-phase branch of the instantaneous pseudo code path are used for carrier frequency tracking to complete the task of carrier frequency tracking and locking. The Doppler measurement value and pseudo code phase measurement value of the signal are extracted through the pseudo code tracking loop and the carrier tracking loop to assist in signal deambiguation.
[0047] Specifically, in step S2, it is necessary to perform signal tracking for each of the three antennas M, P, and N; the tracking process for antenna P includes the following sub-steps:
[0048] B1. Roughly estimate the Doppler frequency Input carrier NCO to generate local carrier S c , frequency is f c Hz, phase is
[0049] B2. The pseudo code phase is roughly estimated Input the regenerated pseudo code generator to generate local pseudo code R c , the phase is
[0050] B3. The received frequency is f 1 The intermediate frequency signal S of HZ 1 After being divided into two signals, the in-phase and quadrature signals, each signal is sequentially coupled with the local carrier S c , local pseudo code R c After multiplication, the signals I(n) and Q(n) are obtained by modular accumulation and used as the input of the frequency-locked loop, phase-locked loop and pseudo-code phase tracking loop;
[0051] B4. In the frequency-locked loop, first input I(n) and Q(n) into the frequency detector, perform point multiplication and cross multiplication, and obtain
[0052] cross=I(n-1)I(n)+Q(n-1)Q(n)
[0053] dot=I(n-1)Q(n)-Q(n-1)I(n)
[0054] cross is the cross product of the in-phase branch and the orthogonal branch of the input signal, and dot is the dot product of the in-phase branch and the orthogonal branch of the input signal;
[0055] The expression atan2(y,x) is defined as follows:
[0056]
[0057] Then the demodulator calculates the demodulation value e through the demodulation formula fk :
[0058] e fk =atan2(Cross,dot)
[0059] The frequency discriminator outputs an amplitude of e fk The frequency error signal u fk ,u fk is a rectangular wave signal;
[0060] Since the frequency error signal u fk The waveform has abrupt changes, so a filter needs to be added to smooth the signal. The filter formula is as follows:
[0061]
[0062] Among them, K d =1, is the gain of the least squares frequency discriminator, K vis the gain of NCO, K = K d K v is the gain of the loop filter, w n is the natural frequency of the loop; after passing through the filter, a smooth frequency error signal u is obtained fk , the amplitude is e fk ;
[0063] In the phase-locked loop, the two-quadrant inverse tangent phase detection algorithm is used to input the I(n) and Q(n) signals into the phase detector, and the phase detection value e is obtained through the phase detection formula. pk :
[0064] e pk =arctan(I(n) / Q(n))
[0065] The phase detector outputs an amplitude of e pk Phase difference signal u pk ,u pk is a rectangular wave signal;
[0066] Since the phase difference signal u pk The waveform has abrupt changes, so a filter needs to be added to smooth the signal. The filter formula is as follows:
[0067]
[0068] Among them, ω np is the natural frequency of the loop; K d is the phase detector gain (K d =1); K v is the NCO gain. After passing through the filter, a smooth phase difference signal u is obtained. pk , the amplitude is e pk ;
[0069] Then the phase difference signal u pk and the frequency error signal u fk Added to the carrier NCO, the generated frequency is Hz phase is The new local carrier S c ′;
[0070] The pseudo-code phase tracking loop adopts a lead-lag tracking loop. First, the phase is generated according to the I(n) and Q(n) signals. The leading signal I e (n)Q e (n) and the generated phase Hysteresis signal I l (n)Q l(n), the leading and lagging signals only differ in phase and I(n)Q(n), and then the six signals are input into the code ring discriminator to obtain the pseudo code phase difference signal u ck ,u ck is a rectangular wave with an amplitude of e ck , the formula is as follows:
[0071]
[0072] Because the pseudo code phase difference signal u ck It is not a smooth signal, so a second-order filter is designed. The time domain expression of the first-order filter corresponding to the second-order loop is:
[0073]
[0074] Among them, ω n is the natural angular frequency of the loop filter, ω n =1.89B LF , B LF =2 is the loop bandwidth;
[0075] T is the loop filter input sampling time interval, which is equal to the loop update time;
[0076] K=K d K v is the loop filter gain, K d =2 is the phase detector gain, is the NCO gain;
[0077] After filtering, the smooth pseudo code phase difference signal u is obtained ck Input to the regenerated pseudo code generator, the phase is New local pseudocode R c ′,
[0078] B5. Local carrier S c , local pseudo code R c Update: S c ′ is assigned to S c , R c ′ is assigned to R c ; Then based on the updated local carrier S c , local pseudo code R c , repeat steps S3 to S5 until e is satisfied ck Less than the set e ck Threshold, e fk Less than the set e fk Threshold, e pk Less than the set e pk When the thresholds are met at the same time, the local pseudo code R c The phase of That is, the accurate estimate of the pseudo code phase, the local carrier S c The frequency of is taken as the fine estimate of the carrier Doppler frequency, denoted as f Pd ;
[0079] The tracking of antennas M and N is similar. Let the final pseudo code phase estimate corresponding to antenna M be The precise estimate of the Doppler frequency is f Md ; The accurate estimation value of the pseudo code phase corresponding to antenna N is The precise estimate of the Doppler frequency is f Nd .
[0080] S3. Phase deambiguation of the received signal: The phase measurement difference is calculated based on the Doppler frequency change of the antenna and the pseudo code phase difference, and the integer part is set to a constant value as the parameter of the Kalman filter. Then the non-integer part is accumulated to obtain the observation and state equation of the Kalman filter, and on this basis, the high-precision angle measurement result is solved, such as Figure 6 As shown, including:
[0081] S501. For antenna P, while the transmitting end is transmitting a signal, the receiving end is based on a pre-stored initial BOC signal consistent with the transmitting end;
[0082] When the receiving end receives the transmitted signal, it extracts its phase tP The phase of the initial BOC signal rP Do the difference and then add the pseudo code phase offset obtained by the tracking part Get the pseudo code phase difference Ψ of antenna P P
[0083]
[0084] For antennas M and N, the pseudo code phase difference Ψ is obtained in the same way M ,Ψ N ;
[0085] S502. Calculate the phase measurement difference ΔΨ between antenna P and antenna N PN
[0086] ΔΨ PN =Ψ P -Ψ N
[0087] Likewise, ΔΨ PN Also expressed as:
[0088] ΔΨ PN =A PN +Δω PN (1.1)
[0089] Among them, A PN is the integral part of the phase measurement difference, Δω PN is the non-integer part of the phase measurement difference;
[0090] Among them, the integer cycle is the number of phases exceeding one cycle, and the non-integer cycle is the number within one cycle. For example, if the phase of the signal is 2.5π and one cycle of the signal is 2π, then the integer part is 2π and the non-integer part is 0.5π. If the phase of the signal is 9.3π, then the integer part is 8π and the non-integer part is 1.3π.
[0091] S503. The Doppler frequency f of antenna P obtained according to the tracking loop Pd The Doppler frequency f of antenna N Nd , and obtain the Doppler frequency change difference Δf between the antennas PNd =f Pd -f Nd
[0092] Measure the relationship between the Doppler frequency change difference between antenna P and antenna N and the non-integer part of the phase measurement difference:
[0093]
[0094] Formula (1.2) indicates that the phase measurement value at the current moment is equal to the measurement value at the previous moment plus the Doppler frequency change value at the current moment;
[0095] S504. Construct the Kalman filter equation to obtain the observation quantity Z and state quantity X:
[0096]
[0097] S505. Through equation (1.1) to equation (1.4), we get the observation equation and the state equation.
[0098] X(t k )=CX(t k-1 )+Dy(t k-1 )+w(t k-1 ) (1.4)
[0099] Z(t k )=EX(t k )+v(t k ) (1.5)
[0100] in, v is the measurement noise, w is the process noise;
[0101] According to equations (1.1) to (1.5), we get ΔΨ PN , Δω PNFrom equations 1.4 and 1.5, the current value is not only related to the current input, but also to the previous state; that is, through the current input value ΔΨ PN and the ΔΨ obtained at the previous moment PN , we get the precise ΔΨ at the current moment PN ,
[0102] S506. For antenna P and antenna M, according to steps S502 to S505, obtain ΔΨ PM , Δω PM To calculate the exact value of , you only need to replace antenna N with antenna M.
[0103] S507. According to the angle measurement principle:
[0104] (A PN +Δω PN ) / d PN = sinθ
[0105] (A PM +Δω PM ) / d PM = sinθ
[0106] Subtracting the two equations, we get:
[0107] (A PM +Δω PM ) / d PM =(A PN +Δω PN ) / d PN (1.6) For A PM With A PN For example, as long as you satisfy
[0108] -1-floor(d PM / λ)≤A PM ≤floor(d PM / λ)
[0109] -1-floor(d PN / λ)≤A PN ≤floor(d PN / λ)
[0110] floor(·) is rounded down; only need to search A PM All integers in the solution space of , we get the A corresponding to each integer PN The value of A PN The value of is determined, and the determination formula is as follows:
[0111]
[0112] Among them, min represents the minimum value, abs(·) is the absolute value, and round(·) is rounding. PN If equation 1.6 is satisfied and 1.7 is minimized, then A PN is the actual value, and then substitute (A PN +Δω PN ) / d PN = sinθ, and thus the angle θ is obtained, which is the result of the angle measurement.
[0113] Finally, it should be noted that the above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Although the present invention has been described in detail with reference to the above embodiments, it is still possible for a person skilled in the art to modify the methods described in the above embodiments, such as changing the names of the methods, etc. Any modification, equivalent substitution, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.
Claims
1. A high-precision angle measurement method for formation spacecraft, characterized by: Assume that there is a group of spacecraft flying in formation, each of which is equipped with a transmitter and a receiver. For any two of the spacecraft, the angle between the two spacecraft is measured by using the transmitter of one spacecraft to send a signal to the receiver of the other spacecraft. The angle measurement process includes the following steps: S1. The transmitter saves the initial BOC signal in advance, and multiplies the initial BOC signal with the f0 MHz pure carrier to make the center frequency f0 MHz, and then adds a f1 MHz pure carrier higher than the center frequency for secondary modulation before transmitting; S2. Assume that the antenna receiving array of the receiving end is an L-shaped antenna receiving array composed of three receiving antennas, and the antenna receiving array adopts a long baseline design; the receiving end first captures the signal of each receiving antenna, and performs signal tracking based on the captured signal; The signal capture process includes: for each receiving antenna, a digital intermediate frequency signal is received, a regenerated carrier is generated to down-convert the digital intermediate frequency signal, and the carrier stripping is completed by using the FFT method to obtain a rough estimate of the pseudo code phase of the BOC signal and the carrier Doppler frequency; The signal tracking process includes: for each receiving antenna, performing pseudo code phase tracking and carrier tracking based on the captured pseudo code phase and Doppler frequency rough estimation values to obtain the pseudo code phase and carrier Doppler frequency fine estimation values; S3. Phase deambiguation of the received signal: The phase measurement difference is calculated based on the Doppler frequency change of the antenna and the pseudo code phase difference, and the integer part is set to a constant value as the parameter of the Kalman filter. Then the non-integer part is accumulated to obtain the observation and state equation of the Kalman filter, and on this basis, the high-precision angle measurement result is solved; The step S3 comprises: S301. For antenna P, while the transmitting end is transmitting a signal, the receiving end is based on a pre-stored initial BOC signal consistent with the transmitting end; When the receiving end receives the transmitted signal, it extracts its phase tP The phase of the initial BOC signal rP Do the difference and then add the pseudo code phase offset obtained by the tracking part Get the pseudo code phase difference Ψ of antenna P P For antennas M and N, the pseudo code phase difference Ψ is obtained in the same way M ,Ψ N ; S302. Calculate the phase measurement difference ΔΨ between antenna P and antenna N PN DPS PN =Ψ P -P N Likewise, ΔΨ PN Also expressed as: DPS PN =A PN +See PN (1.1) Among them, A PN is the integral part of the phase measurement difference, Δω PN is the non-integer part of the phase measurement difference; S303. The Doppler frequency f of antenna P obtained according to the tracking loop Pd The Doppler frequency f of antenna N Nd , and obtain the Doppler frequency change difference Δf between the antennas PNd =f Pd -f Nd Measure the relationship between the Doppler frequency change difference between antenna P and antenna N and the non-integer part of the phase measurement difference: Formula (1.2) indicates that the phase measurement value at the current moment is equal to the measurement value at the previous moment plus the Doppler frequency change value at the current moment; S304. Construct the Kalman filter equation to obtain the observation quantity Z and state quantity X: S305. Through equation (1.1) to equation (1.4), we get the observation equation and state equation: X(t k )=CX(t k-1 )+Dy(t k-1 )+w(t k-1 )(1.4) Z(t k )=EX(t k )+v(t k )(1.5) in, v is the measurement noise, w is the process noise; According to equations (1.1) to (1.5), we get ΔΨ PN , Δω PN From equations 1.4 and 1.5, the current value is not only related to the current input, but also to the previous state; that is, through the current input value ΔΨ PN and the ΔΨ obtained at the previous moment PN , we get the precise ΔΨ at the current moment PN , S306. For antenna P and antenna M, according to steps S502 to S505, obtain ΔΨ PM , Δω PM To calculate the exact value of , you only need to replace antenna N with antenna M. S307. According to the angle measurement principle: (A PN +See PN ) / d PN =sinθ (A PM +See PM ) / d PM =sinθ Subtracting the two equations, we get: (A PM +See PM ) / d PM =(A PN +See PN ) / d PN (1.6) For A PM With A PN For example, as long as you satisfy -1-floor(d PM / λ)≤A PM ≤floor(d PM / l) -1-floor(d PN / λ)≤A PN ≤floor(d PN / l) floor(·) is rounded down; only need to search A PM All integers in the solution space of , we get the A corresponding to each integer PN The value of A PN The value of is determined, and the determination formula is as follows: Among them, min represents the minimum value, abs(·) is the absolute value, and round(·) is rounding. PN If equation 1.6 is satisfied and 1.7 is minimized, then A PN is the actual value, and then substitute (A PN +Δω PN ) / d PN = sinθ, and thus the angle θ is obtained, which is the result of the angle measurement.
2. The high-precision angle measurement method for formation spacecraft according to claim 1, characterized in that: In the step S2, The three receiving antennas for antenna reception are M, P, and N; The formula for measuring the angle between antenna P and antenna N is: Among them, ΔΨ PN The phase difference between antenna P and antenna N, d PN is the baseline length between antenna P and antenna N. The long baseline design takes λ is the signal wavelength; Similarly, the angle measurement formula of antenna P and antenna M is: Among them, ΔΨ PM The phase difference between antenna P and antenna M, d PM is the baseline length between antenna P and antenna M. The long baseline design takes λ is the signal wavelength.
3. The high-precision angle measurement method for formation spacecraft according to claim 1, characterized in that: In step S2, signal capture is performed for each of the three antennas M, P, and N, wherein the signal capture process of antenna P includes the following sub-steps: A1. Performing FFT on the locally stored pseudo-code data and storing the conjugate of the result, denoted as S0, wherein the locally stored pseudo-code data is the same as the pseudo-code data contained in the BOC signal; A2. Use the carrier NCO to generate a frequency f I MHz local carrier, and mix it with the received intermediate frequency signal, and then perform FFT operation, which is recorded as S1; A3. Multiply S0 and S1, perform IFFT transformation, select the largest modulus, and find the maximum correlation peak; If the maximum correlation peak value exceeds the preset capture threshold, the capture is deemed successful, and the capture process ends, and the process proceeds to step A4; If the maximum correlation peak does not exceed the preset capture threshold, the carrier NCO frequency f is changed I 'Make the frequency step value step, that is, f I '=f I +f O1 ,f O1 is the preset frequency step value; and f I 'As a new f I , return to step A2, and repeat steps A2 to A3 until the capture is successful; A4. Get a rough estimate of the pseudo code phase and a rough estimate of the Doppler shift Coarse estimate of pseudo code phase That is, when the capture is successful, the frequency f I Corresponding local carrier phase value, rough estimate of Doppler frequency That is, the frequency f when the capture is successful I ; The capture process of antennas M and N is the same. Let the pseudo code phase corresponding to antenna M be roughly estimated as A rough estimate of the Doppler frequency is The rough estimate of the pseudo code phase corresponding to antenna N is A rough estimate of the Doppler frequency is 4. The high-precision angle measurement method for formation spacecraft according to claim 3, characterized in that: In step S2, it is necessary to perform signal tracking for each of the three antennas M, P, and N. The tracking process for antenna P includes the following sub-steps: B1. Roughly estimate the Doppler frequency Input carrier NCO to generate local carrier S c , frequency is f c Hz, phase B2. The pseudo code phase is roughly estimated Input the regenerated pseudo code generator to generate local pseudo code R c , the phase is B3. After the received intermediate frequency signal S1 with a frequency of f1HZ is divided into two signals, the in-phase signal and the orthogonal signal, each signal is sequentially connected to the local carrier S c , local pseudo code R c After multiplication, the signals I(n) and Q(n) are obtained by modular accumulation and used as the input of the frequency-locked loop, phase-locked loop and pseudo-code phase tracking loop; B4. In the frequency-locked loop, first input I(n) and Q(n) into the frequency detector, perform point multiplication and cross multiplication, and obtain cross=I(n-1)I(n)+Q(n-1)Q(n) dot=I(n-1)Q(n)-Q(n-1)I(n) cross is the cross product of the in-phase branch and the orthogonal branch of the input signal, and dot is the dot product of the in-phase branch and the orthogonal branch of the input signal; The expression atan2(y,x) is defined as follows: Then the demodulator calculates the demodulation value e through the demodulation formula fk : e fk =atan2(Cross,dot) The frequency discriminator outputs an amplitude of e fk The frequency error signal u fk ,u fk is a rectangular wave signal; Since the frequency error signal u fk The waveform has abrupt changes, so a filter needs to be added to smooth the signal. The filter formula is as follows: Among them, K d =1, is the gain of the least squares frequency discriminator, K v is the gain of NCO, K = K d K v is the gain of the loop filter, w n is the natural frequency of the loop; after passing through the filter, a smooth frequency error signal u is obtained fk , the amplitude is e fk ; In the phase-locked loop, the two-quadrant inverse tangent phase detection algorithm is used to input the I(n) and Q(n) signals into the phase detector, and the phase detection value e is obtained through the phase detection formula. pk : e pk =arctan(I(n) / Q(n)) The phase detector outputs an amplitude of e pk Phase difference signal u pk ,u pk is a rectangular wave signal; Since the phase difference signal u pk The waveform has abrupt changes, so a filter needs to be added to smooth the signal. The filter formula is as follows: Among them, ω np is the natural frequency of the loop; K d is the phase detector gain, K d =1; K v is the NCO gain. After passing through the filter, a smooth phase difference signal u is obtained. pk , the amplitude is e pk ; Then the phase difference signal u pk and the frequency error signal u fk Added to the carrier NCO, the generated frequency is Hz phase is The new local carrier S c ′; The pseudo-code phase tracking loop adopts a lead-lag tracking loop. First, the phase is generated according to the I(n) and Q(n) signals. The leading signal I e (n)Q e (n) and the generated phase Hysteresis signal I l (n)Q l (n), the leading and lagging signals only differ in phase and I(n)Q(n), and then the six signals are input into the code ring discriminator to obtain the pseudo code phase difference signal u ck ,u ck is a rectangular wave with an amplitude of e ck , the formula is as follows: Because the pseudo code phase difference signal u ck It is not a smooth signal, so a second-order filter is designed. The time domain expression of the first-order filter corresponding to the second-order loop is: Among them, ω n is the natural angular frequency of the loop filter, ω n =1.89B LF , B LF =2 is the loop bandwidth; T is the loop filter input sampling time interval, which is equal to the loop update time; K=K d K v is the loop filter gain, K d =2 is the phase detector gain, is the NCO gain; After filtering, the smooth pseudo code phase difference signal u is obtained ck Input to the regenerated pseudo code generator, the phase is New local pseudocode R c ′, B5. Local carrier S c , local pseudo code R c Update: S c ′ is assigned to S c , R c ′ is assigned to R c ; Then based on the updated local carrier S c , local pseudo code R c , repeat steps B3 to B5 until e is satisfied ck Less than the set e ck Threshold, e fk Less than the set e fk Threshold, e pk Less than the set e pk When the thresholds are met at the same time, the local pseudo code R c The phase of That is, the accurate estimate of the pseudo code phase, the local carrier S c The frequency of is taken as the fine estimate of the carrier Doppler frequency, denoted as f Pd ; The tracking of antennas M and N is similar. Let the final pseudo code phase estimate corresponding to antenna M be The precise estimate of the Doppler frequency is f Md ; The accurate estimation value of the pseudo code phase corresponding to antenna N is The precise estimate of the Doppler frequency is f Nd .
