WO2003017018A1 - Satellite navigation system and attitude determination method of object using the same - Google Patents
Satellite navigation system and attitude determination method of object using the same Download PDFInfo
- Publication number
- WO2003017018A1 WO2003017018A1 PCT/KR2002/001285 KR0201285W WO03017018A1 WO 2003017018 A1 WO2003017018 A1 WO 2003017018A1 KR 0201285 W KR0201285 W KR 0201285W WO 03017018 A1 WO03017018 A1 WO 03017018A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- integer ambiguity
- satellite
- attitude
- vehicle
- baseline
- Prior art date
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/53—Determining attitude
- G01S19/54—Determining attitude using carrier phase measurements; using long or short baseline interferometry
- G01S19/55—Carrier phase ambiguity resolution; Floating ambiguity; LAMBDA [Least-squares AMBiguity Decorrelation Adjustment] method
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
Definitions
- the present invention relates to a satellite navigation system using satellite vehicles and an attitude determination method of a vehicle by using the satellite navigation system, more particularly, to a satellite navigation system and a method for performing a fast and precise determination of 2 or 3-dimensional attitude of a vehicle by performing of three-stage processes.
- Inertial measurement systems such as a gyroscope or an inertial measurement unit (IMU) have been widely utilized for determining an attitude of a vehicle.
- the inertial measurement system bears certain disadvantages that the system is vulnerable to trouble or been breakdown due to the complexity of the system. Further, analysis and processing of data are very complicated since a drift-rate error is prone to be accumulated as time passes, and finally the system is too expensive.
- the GPS has been widely used in determining a position of a vehicle on the ground thanks to precision ' and convenience.
- the GPS is used generally in the area that absolute position is sought by using a coarse acquisition code (C/A code) or a precision code (P code) in condition that one GPS receiver involves one antenna.
- Positioning results by means of the C/A code may have error of about 100 meters (2dRMS: Root Mean Square) , affected by a selective . availability.
- DGPS differential global positioning system
- the GPS system utilizes a phase signal of a carrier rather than a code signal and determines the position with high precision.
- Positioning result using the C/A code has a resolution of about 3 meters when the GPS receiver processes GPS signals with 1 percent of resolution since bit interval i.e., a chip of the C/A code has wavelength of 300 meters.
- bit interval i.e., a chip of the C/A code has wavelength of 300 meters.
- the wavelength of the carrier wave is 19 centimeters
- positioning result using the carrier has a precision of 1.9 millimeter by means of signal process ' with 1 percent resolution, and thus more precise position determination can be achieved.
- Information on attitude of a vehicle can be obtained by using carrier phase measurement for carrier wave of the GPS signals.
- a 2-dimensional attitude of the vehicle can be determined as a pitch (or roll) and a yaw.
- a 3-dimensional attitude of the vehicle can be determined with three antennas deployed on the vehicle.
- attitude of a vehicle In order to determine an attitude of a vehicle by means of the DGPS or an attitude determination GPS with more than two antennas, precise carrier phase measurements of carrier obtained by a plurality of the antennas are required in addition to pseudorange and satellite position information.
- An integer ambiguity included in a double- differenced carrier wave should first be resolved to determine the attitude of the vehicle by using the carrier phase measurements obtained.
- the attitude of the vehicle can be determined by obtaining a baseline vector by means of the carrier phase measurements with resolved integer ambiguity, and by transforming the baseline vector into a navigation coordinate system and comparing the baseline vector with a body coordinate system.
- the baseline vector is a relative position vector directing from a reference antenna to a target antenna or an auxiliary antenna.
- the carrier phase measurements received from at least ' three antennas are utilized ' to determine 3-dimensional attitude of the vehicle by using the GPS.
- Antennas comprise one reference antenna (Antenna REF) and a few auxiliary antennas (Antenna USER) . Measurements from the reference antenna may be used for obtaining a user position and a user attitude, and measurements from the auxiliary antennas are used for determining the baseline vector. Satellite tracking process should be independently performed for each antenna since each antenna should track identical satellite. Furthermore, a high-performance carrier tracking loop should be configured to acquire precise carrier phase measurements, thereby acquiring precise 3- dimensional attitude.
- An integer ambiguity resolution process in the precise carrier phase measurement should be implemented in real time.
- a baseline vector determination process for determining the baseline vectors between the reference antenna and the auxiliary antennas and a coordinate transformation process for transforming the baseline vector into the navigation coordinate system are also required.
- ambiguity resolution with constraint equation (ARCE) method is used as an integer ambiguity resolution algorithm which may easily be applied to a real time implementation involving less calculation volume and employing smaller memory.
- An object of the present invention is to design a vehicle-attitude determination system and method by classifying the GPS receiver software into three parts to the processing time and function.
- Another object of the present invention is to provide a combined frequency lock loop(FLL) with a phase lock loop(PLL) so that the carrier tracking performance is enhanced for determining the attitude of vehicle.
- Another object of the present invention is to provide a method for ' validating a vehicle-attitude by means of vehicle velocity information and time variation, information of a vehicle pitch (elevation) and/or yaw (azimuth) .
- a satellite navigation system in accordance with the present invention comprises: a satellite signal receiving antenna section including a reference antenna and 2 or more auxiliary . antennas; 3 or more .
- RF/IF (radio frequency/intermediate frequency) sections for converting satellite signals that are respectively received at the antennas of the receiving antenna section into IF signals and digitizing IF signals; 3 or more correlator sections, each including 5 or more tracking modules, for generating correlation values at the tracking modules by using the digitized IF signals and for tracking the satellite signals; a central processing unit for obtaining navigation solution and determining attitude of a navigating vehicle by using code and carrier phase measurements obtained at the correlator sections; and an input/output section for data communication between external devices and the central processing unit.
- RF/IF radio frequency/intermediate frequency
- the attitude determining method using the satellite navigation system comprises: a first process performed by using interrupt signals within 1 ms generated at the correlator sections for reading and storing of the correlation values generated at the correlator sections, synchronizing data bit and frame of the satellite signals, and tracking the code and the carrier; a second process performed in a period longer than that of the first process •with a priority lower than that of -the first process for allocating satellites to channels of the respective correlator sections and acquiring the code and carrier phase information and the number of carrier cycles generated at the correlator sections; and a third process performed in a .period longer than tha.t of the second process with a priority lower than that of the second process for acquiring satellite information, communicating with the external devices, calculating navigation solution, and determining vehicle attitude through integer ambiguity resolution.
- the execution period of the second and the third process are preferably 100 milliseconds and 1 second respectively.
- the first process is preferably performed by correcting error calculated at the central processing unit by using the correlation values obtained from the correlator sections, and a carrier tracking loop adopts a mixed structure of a FLL and a PLL; the PLL being operated only if frequency error is less than a threshold during FLL operation, the FLL being operated again if the frequency error is greater than the threshold.
- Characteristic of a tracking loop is determined depending on the order of the loop filter, signal integration time, and bandwidth of the filter.
- the carrier tracking loop used in the present invention employs a second-order loop filter as the FLL and a third-order loop filter as the PLL. The signal integration time and the loop filter bandwidth are adjusted according to experiment. Satellite allocation in the second process includes the steps of:
- the respective antennas can track the same satellite group since satellite allocation process is made at the respective antennas, independently.
- a satellite allocation process in accordance with the present invention will be described in detail referring to Fig. 4 .
- Vehicle attitude determination in the third process includes the steps of: (3-1) determining an independent integer ambiguity search range for a first baseline between a reference antenna and a first auxiliary antenna, resolving a true integer ambiguity by searching candidates within the independent integer ambiguity search range, and obtaining a first baseline vector by using the true integer ambiguity;
- (3-4) determining 3-dimensional attitude of the vehicle by using any set of at least two baseline vectors.
- An integer ambiguity resolution method in accordance with the present invention is performed by using an ambiguity resolution with constraint equation (hereinafter "ARCE") method, and therefore, searching for only independent integer number suffices for the integer ambiguity resolution.
- ARCE ambiguity resolution with constraint equation
- the ARCE method it is performed by first determining a search range for independent integer ambiguity, determining candidate integers within the search range, the candidate integers making the .value of an objective function to the minimum, as true independent integer ambiguity, and resolving dependent integer ambiguity by means of the true independent integer ambiguity. Furthermore ' the true independent integer ambiguity can be resolved by a ratio- test for candidate integers making the value of an objective function below the threshold.
- the search range determination of the independent integer ambiguity for each baseline vector may be performed by each of the several methods : a first method using a error covariance of code measurements of satellite signals; a second method using the code measurement error covariance of the satellite signals, carrier phase measurement error covariance, and the length of the first baseline, each obtained at the second process; a third method using attitude information from an IMU (inertial measurement unit) installed on a vehicle, and a fourth method using velocity information of the vehicle obtained by the GPS.
- a search range according to the first method is the largest, and thus searching time thereby is the longest.
- the third method can provide relatively small search range. Provided that the vehicle moves with high and constant velocity, however, the fourth method may provide small search range. Details of the first and second method are disclosed in Korean patent applications Nos. 1997-057696 and 2001-21788 respectively. The third and fourth methods will be sketched here.
- the present invention provides methods for validating the integer ambiguity by exploiting at least one information .on a . length of the. baseline vector obtained by using independent integer ambiguity, an objective function obtained by using dependent integer ambiguity, a velocity information (velocity error) of the vehicle, a length of the baseline vector and angle information between the baseline vectors, and output information of an inertial measuring unit.
- the vehicle attitude can be validated on the basis of a first feature that a yaw (or azimuth) and a pitch (or elevation) can be determined by using only velocity vector if a vehicle moves with high speed, and a second feature that the yaw and the pitch of the vehicle cannot be abruptly changed.
- Fig. 1 shows ' a schematic diagram for a hardware structure of the GPS in accordance with the present invention
- Fig. 2 shows a software structure of the GPS in accordance with the present invention
- Fig. 3 shows a function module diagram for a software structure of the GPS in accordance with the present invention
- . . . Fig. 4 is a diagram for explaining a satellite allocation process of the GPS in accordance with the present invention
- Fig. 5 is a flow chart illustrating a satellite signal tracking process in accordance with the present invention
- Fig. 6 shows a structure of the correlator section in accordance with the present invention
- Figs. 7 and 8 illustrate carrier phase measurement principle and measurement process
- Figs. 9 and 10 provide overall flow and detailed flow of integer ambiguity resolution process and algorithm
- Fig. 11 offers a flow chart for illustrating integer ambiguity validation process used in the present invention
- Fig. 12 shows a process for validating the integer ambiguity using angle information between baseline vectors
- Fig. 13 illustrates attitude determination and validation process used in the present invention. Detailed Description of the Invention
- Fig. 1 shows a schematic diagram for configuration of the GPS receiving system for use in attitude determination in accordance with the present invention.
- the GPS receiving system in accordance with the present invention is largely divided into a hardware part and a software part.
- the hardware part comprises RF sections, correlator sections, and a central processing unit (CPU) .
- the software part comprises a satellite allocation unit, a signal processing section, a measurement acquisition and processing unit, an attitude determination unit, and a position and velocity determination unit.
- the hardware part of the GPS receiving system is configured to include four antennas, four RF/IF (radio frequency/intermediate frequency) sections, four correlator sections, each including a DSP unit, the CPU, a memory section, and an input/output (I/O) section.
- I/O input/output
- Each of the RF/IF sections converts a RF satellite signal received at its corresponding antenna into an IF signal and then digitizes the IF signal.
- GP2010 circuitry chip distributed from "Zarlink” may be used.
- TCXO Tempoture Compensated Crystal Oscillator
- Each of -the RF/IF sections supplies an operating frequency of 40 MHz to its corresponding one of the correlator sections DSPl, DSP2, DSP3, DSP4 in differential form and receives the GPS satellite signal from its corresponding one of the four antennas to down-convert it three times so as to form the IF signal.
- the each of the RF/IF sections transmits the digitized signals MAG, SIGN digitized by using a sample clock of 5.714 MHz that is supplied from its corresponding correlator section.
- Each of the correlator sections includes a tracking module having 12 channels to generate correlation values at the tracking module by using the digitalized signal from its corresponding RF/IF section for use in tracking the satellite signal.
- the correlator sections are configured with four GP2021 chips.
- the GP2021 chip includes the tracking module having 12 channels and generates correlation values at the tracking module by using the digitalized signal from its corresponding RF/IF sections for use in tracking the satellite signal. Employment of four DSPs makes it possible to track signals and acquire code and carrier measurements in 48 channels at a time.
- the CPU calculates navigation solution including position, velocity of a vehicle and time of a vehicle by using the code and the carrier phase measurements that are acquired at the correlator sections, and determines attitude of the vehicle.
- StrongARM model name: SA-1100
- StrongARM includes a DUART unit, a MMU (Memory Management Unit) and a cache therein and has processing speed of about 268MIPS when a crystal oscillator of 220 MHz is used.
- the memory section is configured with ROM/RAM, .
- ROM part having 512 Kbyte capacity using four 1 Mbit ROMs
- RAM part having 2 Mbyte capacity using four 4 Mbit RAMs .
- the I/O section for data communication between external devices and the CPU includes two asynchronous communication ports and a synchronous communication port.
- the asynchronous communication port contributes to transferring receiver monitor and commands and receiving DGPS signals.
- the synchronous communication port contributes to communicating with other sensors such as an IMU.
- Fig. 2 shows a software structure of the GPS receiving system for use in attitude determinations in accordance with the present invention, which comprises an interrupt processing routine (1 ms Task) for a first process as a signal processing section executed by an interrupt signal within 1 ms, a satellite allocation and measurement acquisition routine (100 ms Task) for a second process executed at every 100 ms, and navigation solution (position and velocity) calculation and attitude determination routine (1 sec Task) for third process executed at every 1 sec.
- an interrupt processing routine (1 ms Task) for a first process as a signal processing section executed by an interrupt signal within 1 ms
- a satellite allocation and measurement acquisition routine 100 ms Task
- navigation solution position and velocity
- the interrupt processing routine (the first process) as the signal processing section has its priority over other routines (100 ms and 1 sec Tasks) and executed by the interrupt signal that is generated at every 505 ⁇ s at the correlator sections.
- the interrupt processing routine performs reading and storing of correlation values that are generated . at the correlator sections, synchronizing data bit and frame, and tracking of the code and carrier. Among them, detailed description will be omitted for correlation value reading and storing and data bit and frame synchronization because they are commonly practiced in the art using conventional GPS receiving system.
- Code and carrier tracking employs a carrier tracking loop having a combined structure with FLL (Frequency Lacked Loop) and PLL (Phase Locked Loop) , of which, detailed description will be provided with reference to Fig. 5 below.
- the satellite allocation and measurement acquisition routine (100 ms Task) as the second process includes tasks for measurement acquisition and satellite allocation to channels.
- the measurement includes code, carrier phase information and the number of carrier cycles generated at the correlator sections.
- This routine may be divided into a satellite allocation section and measurement acquisition and processing section, each of which will be described in detail in the following.
- the navigation solution calculation and attitude determination routine (1 sec Task) as the third process is classified into acquisition of satellite information, communication with external devices, calculation of the navigation .solution including the position, the velocity and the time of the vehicle, and determination of 2-dimensional or 3-dimensional attitude of the vehicle.
- the navigation solution calculation and attitude determination routine (1 sec Task) as the third process is classified into acquisition of satellite information, communication with external devices, calculation of the navigation .solution including the position, the velocity and the time of the vehicle, and determination of 2-dimensional or 3-dimensional attitude of the vehicle.
- attitude determination in the following.
- Fig. 3 shows a block diagram for illustrating a software structure of the GPS receiving system for attitude determination with functional modules in accordance with the present invention.
- the software structure comprises a satellite allocation section, a signal processing section, a measurement acquisition and processing unit, a navigation solution calculation unit and an attitude determination unit. Further, a pseudorange filter is provided in order to obtain navigation solution including the position, the velocity, and the time. Further, an integer ambiguity resolution unit is further provided in order to resolve the integer ambiguity.
- the functional modules illustrated in Fig. 3 will now be described in detail. 1)
- the satellite allocation section 100 ms Task
- the satellite allocation section is configured to manage allocation of the satellite to the correlator sections by confirming visible satellites and satellite allocation status.
- the four antennas include one reference antenna (Antenna REF) and three auxiliary antennas (Antenna USERs) .
- Measurements at the reference antenna are utilized as a reference for obtaining position and attitude of the vehicle and measurements at the auxiliary antennas are utilized to generate a baseline vector for determining the attitude of the vehicle.
- Fig. 4 shows a satellite allocation process in accordance with the present invention. First, after resetting all of the channels as idle state, it is determined whether all of the visible satellites are allocated to the 12 channels of the DSPl of the correlator section. If there is found any visible satellite that is not allocated, a visible satellite is allocated to an idle channel in case that there is any idle channel after checking whether there is any idle channel in the DSPl.
- each in same visible satellite group can be allocated to corresponding channel of all the DSPs .
- the satellites are allocated to the channels of the DSPs in order of their numbers when there is, initially, no information about positions of the satellite and the user. But, after the positions of the satellite and the user are obtained during the satellite signal processing, visible satellites are first allocated and unpredicted satellite vehicles are allocated next.
- the signal processing section tracks the satellite signal by using correlation values that are processed at the correlator sections and consists of a code tracking unit and a carrier tracking unit.
- the signal processing section determines noise characteristics of the code and carrier phase measurements and dynamic characteristic of the receiver as well as acquires and tracks the satellite signal.
- configuration of a precise, carrier tracking loop is considered as of highest importance because precise carrier phase measurements should be used for attitude determination.
- a satellite signal tracking loop filter dualy having a FLL and a PLL is used for precise acquisition of the carrier phase measurement. Characteristics of the satellite signal tracking loop is determined depending on the order of the loop filter, signal integration time, and bandwidth of the filter.
- the satellite signal tracking loop adopted in this embodiment employs a second-order loop filter as the FLL and a third- order loop filter as the PLL. The signal integration time and the loop filter bandwidth are adjusted according to experiment .
- Fig. 5 is a flow chart illustrating a satellite signal tracking process that is performed at the signal processing section of the present invention.
- a lock indicator is calculated.
- a DLL Delay Lock Loop
- the DLL is a module employed in the receiver for making coincidence between PRN codes of the satellite and the receiver, which make the PRN codes that are generated at the receiver coincide with the PRN code of the satellite by shifting the PRN codes of the receiver.
- a code tracking loop is performed. If the lock state is in a carrier frequency lock without a bit synchronization, a carrier tracking loop is performed by using the FLL. When frequency error is determined to be lower than a threshold value after completion of the bit synchronization ⁇ the carrier phase is regarded as locked and the carrier tracking loop is performed by using the PLL.
- the frequency error should be kept low prior to performing the PLL loop for the PLL to duly operate, and therefore, the FLL is used for initial signal tracking and the PLL is operated when it is determined that the frequency error is sufficiently small. Further, a dual or combined structure is implemented so that if the frequency error becomes larger than the threshold, the FLL is used again.
- GPS solely can measure only the phase by measuring LI or L2.
- precise range calculation requires the number of the carrier cycles between the satellite and the receiver as well as the phase. This unknown number of the carriers is termed an integer ambiguity, of which determination is the key to obtain the position and the attitude of the vehicle by using the carrier phase measurement.
- the precise pseudorange can be obtained by continuously calculating variation of the carrier until the satellite signal gets lost. That is, assuming that the integer ambiguity N is resolved at a certain time to, the precise pseudorange can be continuously obtained by calculating variation ⁇ of the carrier phase measurement.
- table 1 can be generated from the correlator sections while the structure of the correlator sections is shown in Fig. 6.
- the received signal is multiplied by the carrier and the code and then the correlation value is passed to the central processing unit at 1 kHz periods. Further, the number of carrier cycles and the carrier phase that are generated during carrier tracking are stored in a register. The number of carrier cycles are calculated at CARRIER_CYCLE_COUNTER (E in Fig. . 6) and are stored in two . registers CHx_CARRIER_CYCLE_HIGH and CHx_CARRIER_CYCLE_LOW, and then the value of CARRIER_CYCLE_COUNTER is reset.
- the carrier phase is constructed with upper 10 bits from CARRIER_DCO
- the TIC period is an adjustable value and set to 100 ms in this embodiment.
- the carrier phase measurement is calculated based on these values.
- the carrier phase measurement is obtained by integrating continuous carrier Doppler, i. e., obtaining the amount of psuedorange variation from a starting point for calculation of Doppler to the current point. Equations for computing Doppler and the carrier phase measurement value are given in Eqs . (1) and (2)
- f D is the Doppler frequency
- v is the pseudorange variation
- Li is the carrier frequency
- c is the light speed
- f DC o is the frequency that is measured during signal tracking
- f N 0M is the frequency when there is no Doppler.
- Eq. (3) is integrated ten times per 1 second and then passed to a navigation solution calculation task and the attitude determination unit.
- Such a carrier phase measurement process is shown in Fig. 8. • 4)
- the attitude determination unit and integer ambiguity resolution unit 1 sec Task
- each antenna disposed on the vehicle constitute 3 baseline vectors.
- integer ambiguity for at least 2 baseline vectors should be resolved.
- double-differenced carrier phase measurement is used and ARCE is used as the algorithm therefor.
- the integer ambiguity resolution by using ARCE is disclosed in detail in another Korean patent application
- the ARCE for resolving the integer ambiguity uses the code measurement for initial integer ambiguity resolution and further uses known baseline vector length information as well as the code measurement for search range determination.
- the overall flow of integer ambiguity resolution process and algorithm are shown in Figs. 9 and 10.
- the method including determining search range for integer ambiguity by using error covariance of the code measurement, error covariance of the carrier phase measurement and satellite position (line-of-light vector) , and determining a candidate that minimizes an objective function among candidates within the search range or passes the ratio-test among the candidates that generate the objective functions smaller than a threshold as a true integer ambiguity is disclosed in Korean patent application no. 1997-057696 and no further description will be made herein.
- a method in case of an vehicle having a IMU( Inertial Measurement Unit), for resolving a true integer ambiguity by determining reduced integer ambiguity search range with information from the IMU and obtaining the true integer ambiguity through search using the objective function, and a method for resolving a true independent integer ambiguity ' within a search range having 27 candidates when the speed of the vehicle is greater than a threshold (6 m/s) and velocity error due to acceleration is less than a threshold (10%) .
- the resolved integer ambiguity is not always correct. Even if . the resolved integer ambiguity is . correct, the integer ambiguity tends to change if a cycle slip occurs or satellite signals are blocked.
- the integer ambiguity validation is a process for re-calculating a dependent integer ambiguity by using the independent integer ambiguity that has been already resolved and comparing it with a threshold. During this process, when the cycle slip occurs or measurement noise abruptly increases, it is determined that the measurement is not valid and the integer ambiguity is resolved again. At this time, removal of the troublesome measurement is needed since it takes long time to resolve the integer ambiguity again.
- integer ambiguity validation can be performed by using information from ' an IMU (a step of an integer ambiguity validation using the IMU) .
- the integer ambiguity validation should be performed for all of the baseline vectors.
- the validation can be performed by using the angle information between the baseline vectors (a step of an integer ambiguity validation using the angle information between baseline vectors) .
- Fig. 11 shows a process for integer ambiguity validation using the independent integer ambiguities, information from the IMU, and the velocity error and another process for troublesome case.
- Fig. 12 shows a process for integer ambiguity validation using angle information between baseline vectors.
- an integer ambiguity validation step using the independent integer ambiguity comprising obtaining the length of the baseline vector with the independent integer ambiguity, comparing the obtained length value with the known length of the baseline vector, and checking whether the difference between them is greater than a threshold.
- the process goes to a step of the integer ambiguity validation using the IMU and/or a step of the integer ambiguity validation using the velocity error.
- the dependent integer ambiguity is resolved by using the independent integer ambiguity (with ARCE) and it is checked whether the objective function calculated by using the dependent integer ambiguity is greater than a threshold.
- the objective function is less than the threshold, it is determined that the integer ambiguity is valid and attitude determination is performed.
- the dependent integer ambiguity is re-resolved with the current position of the satellite for next validation process and it is checked again whether the difference between the baseline lengths that are obtained by using all of the integer ambiguity and the known baseline length is greater than the threshold. If the difference of the baseline lengths is less than the threshold, it is determined that the integer ambiguity is valid and attitude determination is performed. If the difference is greater than the threshold, it is determined that the integer ambiguity is not valid.
- the present invention is not limited to the above-described order, but any combination of the integer ambiguity validation methods can be used depending on required attitude determination precision or processing time.
- a validation method only using the independent integer ambiguity for rapid precise validation and a validation method using the angle between two baseline vectors in case of three or more antennas are further involved.
- a method for resolving a true integer ambiguity within a reduced integer ambiguity search range by using information from the IMU and a method for resolving the true integer ambiguity by search through 27 integer ambiguity candidates when speed and velocity error satisfy a certain condition (faster than 6 m/s, less than 10%) are used for processing after validation.
- Eq. (4) is used in the step of integer ambiguity validation using the independent integer ambiguity.
- I is a double-differenced carrier phase measurement
- H is a line-of-sight vector
- ⁇ is a carrier wavelength
- N AB I is a double-differenced independent integer ambiguity
- w is a measurement noise.
- 1, H, and w are measured values and the baseline vector can be obtained by substituting the resolved independent integer ambiguity, accordingly, the length of the baseline can be obtained. Because the actual length of the baseline is already known, the obtained baseline ' length is compared with the actual ' length to check whether the difference between the is greater than a prescribed threshold.
- the prescribed threshold may be determined depending on required degree of precision. For example, when the length of the baseline is about 1 m, the threshold may be defined as about 2 to 3 cm.
- the step for validation and processing using the IMU may be comprising : determining whether the IMU is installed in the vehicle, obtaining the 3-dimensional attitude of the vehicle using the information from the IMU, converting it to a relative position vector and resolving the integer ambiguity, more particularly, determining the integer ambiguity search range.
- the baseline vector r" in rectangular coordinate is converted to one in polar coordinate as Eq. (5) .
- b, ⁇ , .and ⁇ . indicate the length, the yaw (azimuth) and the pitch [elevation) of the baseline vector, respectively.
- Eqs. (6) and (7) b 0 , ⁇ o . , and ⁇ 0 can be obtained from IMU data and ⁇ b, ⁇ ., and ⁇ can be estimated based on experience or characteristics of the used IMU. From this result, integer ambiguity resolution reference value N and error ⁇ N can be expressed as Eqs. (8) and (9) ..
- integer ambiguity error variance can be represented as Eq. (10) and this is used as the estimated integer ambiguity search range.
- ⁇ E[ ⁇ N ⁇ N ⁇ ]
- time required for resolving the integer ambiguity can be reduced because the integer ambiguity search range can be reduced and the integer ambiguity search can be performed within the reduced range by using the objective function.
- the method for resolving the true integer ' ambiguity among the integer candidates within the search range by using the objective function is disclosed in Korean patent application no. 1997- 057696 and further detailed description will not provided herein.
- Eq. (12) represents double- differenced carrier phase measurement.
- l- ⁇ N Er' +w
- Eq. (12) where 1 is the double-differenced carrier phase measurement, ⁇ is a GPS carrier wavelength, N is the integer ambiguity, H is a matrix consisting of line-of-sight vectors, r e is a relative position vector of the baseline, and w is a double- differenced carrier phase measurement noise.
- Eq. (13) where BL is the length of the baseline vector, v e is the velocity vector that is obtained at the GPS. Eq. (13) can be divided into two terms of a true component and an error component as presented in Eq. (14) .
- the integer ambiguity search range can be determined as in Eq. (14) by using the velocity information that is obtained at the GPS and an integer making the objective function minimum among the integers within the search range is resolved as the true integer ambiguity.
- the time required for integer ambiguity resolution can be reduced because the integer ambiguity search range determined by using the velocity information is very narrow when the vehicle is at a steady velocity.
- the error component can be represented as Eq. (15) .
- hi is a line-of-sight directional vector between the antenna and the satellite i and ⁇ v is a respective directional component of the velocity vector error.
- the estimated integer ambiguity error is proportional to the velocity error and inverse- proportional to the speed, and the velocity error can be divided into an error due to measurement and an error due to acceleration.
- the magnitude of the velocity error due to the GPS measurement is about 0.5 m/s in steady .velocity cruise. Further, error occurs between the actual velocity and the estimated velocity due to movement of a car. Particularly, when the acceleration is high, difference between the actual velocity vector and the estimated velocity vector increases because the velocity vector error increases . As found from experiment, when the speed of the vehicle is greater than 6 m/s, the integer ambiguity error is less than 1, and when the magnitude of the velocity error due to acceleration is less than 10% of the speed, the integer ambiguity error is less than 1.
- the number of the search candidates is reduced to 27 so as to enable rapid integer ambiguity search.
- the number 27 is determined as 3 x 3 x 3 because the range is determined as 3 (n ⁇ 1) that is wide enough for respective directional components for the 3 independent integers .
- the magnitudes of the speed and the velocity error obtained at the GPS are compared with the threshold, i.e., it is checked whether the speed is greater than 6 m/s and the velocity error due to acceleration is less than 10% of the speed. If the velocity error is greater than the threshold, it is regarded that the integer ambiguity is not valid. If the velocity error is less than the -threshold, the true integer ambiguity is resolved by performing integer ambiguity search for 27 candidates.
- the .integer ambiguity validation may be performed by using the angle information between the two vectors, called x a step for validating the integer ambiguity using an angle information between baseline vectors' .
- Fig. 12 is a flow chart of the step for validating the integer ambiguity using an angle information between baseline vectors, in which a first baseline vector and a second baseline vector are sequentially determined by using the integer ambiguity, the carrier phase measurement and the satellite position (line-of-sight directional vector). Because the lengths of the two vectors are known, the angle information can be calculated by performing inner product of the two vectors'. The calculated angle information is compared with the known actual angle to determine whether their difference is greater than a certain threshold. If the calculated angle information is greater than the actual angle, it is determined that the integer ambiguity is ' not valid. If the difference is less than the threshold, it is determined that the . integer ambiguity is valid.
- The. threshold may be selected depending on required determination precision.
- 3 baseline vectors are formed by using 4 antennas to determine the 3- dimensional attitude of the vehicle.
- the 3-dimensional attitude can be determined, and when only 1 baseline vector is determined, the 2-dimensional attitude can be determined.
- the carrier phase measurement is used for attitude determination, it is possible to perform attitude determination only after correct integer ambiguity is resolved.
- the baseline vectors between the antennas are determined by using the carrier phase measurements, the satellite position information and the resolved integer ambiguity and, accordingly, the 2-dimensional or the 3-dimensional attitude of the vehicle can be determined by using the baseline vectors. Accordingly, the integer ambiguity should be resolved within a short time and it should be checked whether the resolved integer ambiguity is correct.
- the attitude validation may be performed considering the fact that the yaw (or azimuth) and the pitch (or elevation) of the vehicle can be obtained by using only the velocity vectors if the vehicle moves fast and the fact that the pitch (elevation) and the roll angle of the vehicle cannot have large values if the vehicle does not move.
- any one of the following 3 methods may be used to validate the vehicle attitude: a first attitude validation method determining that the determined attitude is valid only if variation in time of pitch (elevation) of the vehicle between current epoch and previous epoch is less than a threshold; a second attitude validation method determining that the determined attitude is valid only if variation in time of vehicle yaw between current epoch and previous epoch is less than a threshold; and a third attitude validation method determining that the determined attitude is valid only if the difference between the vehicle yaw obtained from the velocity vector of the vehicle when the speed of the vehicle is greater than a threshold and the vehicle yaw obtained from the baseline vectors is less than a threshold.
- a first attitude validation method determining that the determined attitude is valid only if variation in time of pitch (elevation) of the vehicle between current epoch and previous epoch is less than a threshold
- a second attitude validation method determining that the determined attitude is valid only if variation in time of vehicle ya
- Fig. 13 illustrates the attitude determination and the attitude validation process.
- the process goes through the integer ambiguity search routine as shown in Fig. 10.
- the baseline vectors are determined based on the resolved integer ambiguity and, accordingly, the 3-dimensional attitude of the vehicle represented by yaw (or azimuth) , pitch (or elevation) and roll is determined.
- the baseline vector is determined based on the resolved integer ambiguity and the 2-dimensional attitude of the vehicle represented by the yaw and the pitch is determined.
- the validation for the vehicle attitude is performed by using the yaw and the pitch, and the velocity (speed) information of the vehicle.
- attitude validation process it is checked whether time variation of the pitch between the current epoch and the previous epoch or time variation of the pitch (elevation) is greater than a certain threshold. If it is greater than the threshold, the determined attitude is determined to be not valid. If the time variation of the pitch (or elevation) is less than the threshold, .it is further checked whether the speed is greater than a certain threshold. If the speed is less than the threshold, the attitude is determined to be valid and the process is finished. If the speed is greater than the threshold, it is checked whether an yaw error (difference) between the yaw obtained from the velocity vector and the yaw obtained from the baseline vector is larger than a certain threshold.
- yaw error difference
- the attitude is determined not to be valid; and, if otherwise, the attitude is determined to be valid.
- the threshold for the time variation of the pitch, the threshold for the speed, and the threshold for the time variation of the yaw may be selected depending on required degree of reliability or precision of the validation.
- the 2-dimensional or 3-dimensional attitude of the vehicle can be determined fast and precisely with a GPS system having 3 or more antennas basically.
- the combined carrier tracking loop having a FLL and a PLL satellite signal tracking performance is improved and search range for the integer ambiguity is reduced in various ways to, accordingly, reduce time required for integer ambiguity resolution.
- an invalid integer ambiguity that is generated due to cycle slip and the like can be readily found and processed by validating the resolved integer ambiguity. Further, the degree of precision of the attitude determination is improved by validating finally again the determined attitude of the vehicle, .
Abstract
Description
Claims
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR2001/40223 | 2001-07-06 | ||
KR10-2001-0040223A KR100387136B1 (en) | 2001-07-06 | 2001-07-06 | Satellite Navigation System and Attitude Determination Method of Object using the same |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2003017018A1 true WO2003017018A1 (en) | 2003-02-27 |
Family
ID=19711823
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/KR2002/001285 WO2003017018A1 (en) | 2001-07-06 | 2002-07-06 | Satellite navigation system and attitude determination method of object using the same |
Country Status (2)
Country | Link |
---|---|
KR (1) | KR100387136B1 (en) |
WO (1) | WO2003017018A1 (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108802789A (en) * | 2018-06-20 | 2018-11-13 | 北京华力创通科技股份有限公司 | Attitude of carrier data measuring method, device and electronic equipment |
US11536854B2 (en) * | 2020-04-24 | 2022-12-27 | Honeywell International Inc. | Multiple faulty global navigation satellite system signal detecting system |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2993370B1 (en) * | 2012-07-11 | 2014-08-01 | Centre Nat Etd Spatiales | GNSS RADIO SIGNAL WITH ENHANCED NAVIGATION MESSAGE |
US10996345B2 (en) * | 2018-06-11 | 2021-05-04 | Honeywell International Inc. | Signal fault detection for global navigation satellite system using multiple antennas |
US11821980B2 (en) * | 2019-08-23 | 2023-11-21 | Spacety Co., Ltd. (Changsha) | Satellite-formation-based remote sensing system and constellation system |
CN110765593B (en) * | 2019-10-09 | 2023-08-29 | 上海机电工程研究所 | Evaluation method and system suitable for portable missile-borne equipment |
CN111948464B (en) * | 2020-07-30 | 2023-06-13 | 西南电子技术研究所(中国电子科技集团公司第十研究所) | Offset-fed wireless closed-loop self-tracking phase correction system |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5420593A (en) * | 1993-04-09 | 1995-05-30 | Trimble Navigation Limited | Method and apparatus for accelerating code correlation searches in initial acquisition and doppler and code phase in re-acquisition of GPS satellite signals |
US5592173A (en) * | 1994-07-18 | 1997-01-07 | Trimble Navigation, Ltd | GPS receiver having a low power standby mode |
US5884214A (en) * | 1996-09-06 | 1999-03-16 | Snaptrack, Inc. | GPS receiver and method for processing GPS signals |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5548293A (en) * | 1993-03-24 | 1996-08-20 | Leland Stanford Junior University | System and method for generating attitude determinations using GPS |
US5543804A (en) * | 1994-09-13 | 1996-08-06 | Litton Systems, Inc. | Navagation apparatus with improved attitude determination |
JP2936537B2 (en) * | 1996-12-13 | 1999-08-23 | 太洋無線株式会社 | Azimuth and attitude measurement method using GPS signals |
US6052647A (en) * | 1997-06-20 | 2000-04-18 | Stanford University | Method and system for automatic control of vehicles based on carrier phase differential GPS |
US6166683A (en) * | 1998-02-19 | 2000-12-26 | Rockwell International Corporation | System and method for high-integrity detection and correction of cycle slip in a carrier phase-related system |
-
2001
- 2001-07-06 KR KR10-2001-0040223A patent/KR100387136B1/en active IP Right Grant
-
2002
- 2002-07-06 WO PCT/KR2002/001285 patent/WO2003017018A1/en not_active Application Discontinuation
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5420593A (en) * | 1993-04-09 | 1995-05-30 | Trimble Navigation Limited | Method and apparatus for accelerating code correlation searches in initial acquisition and doppler and code phase in re-acquisition of GPS satellite signals |
US5592173A (en) * | 1994-07-18 | 1997-01-07 | Trimble Navigation, Ltd | GPS receiver having a low power standby mode |
US5884214A (en) * | 1996-09-06 | 1999-03-16 | Snaptrack, Inc. | GPS receiver and method for processing GPS signals |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108802789A (en) * | 2018-06-20 | 2018-11-13 | 北京华力创通科技股份有限公司 | Attitude of carrier data measuring method, device and electronic equipment |
US11536854B2 (en) * | 2020-04-24 | 2022-12-27 | Honeywell International Inc. | Multiple faulty global navigation satellite system signal detecting system |
Also Published As
Publication number | Publication date |
---|---|
KR100387136B1 (en) | 2003-06-12 |
KR20030004643A (en) | 2003-01-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3904908A1 (en) | Method and system for map improvement using feedback from positioning based on radar and motion sensors | |
US10648816B2 (en) | Device and method for integrated navigation based on wireless fingerprints and MEMS sensors | |
US7978127B2 (en) | Mobile unit positioning device | |
US7171303B1 (en) | Navigation method and apparatus | |
US7292185B2 (en) | Attitude determination exploiting geometry constraints | |
CN103744096B (en) | A kind of localization method of many information fusion and device | |
US7797105B2 (en) | System and method for GPS acquisition using advanced tight coupling | |
US7498980B2 (en) | Carrier phase GPS positioning device and method | |
CN100507594C (en) | Method and system for determining position according to computing time | |
US8825397B2 (en) | Vehicle navigation system with dead reckoning | |
JP2002541436A (en) | Integrated adaptive INS / GPS navigator with extended range code tracking | |
JP5078082B2 (en) | POSITIONING DEVICE, POSITIONING SYSTEM, COMPUTER PROGRAM, AND POSITIONING METHOD | |
KR970012260A (en) | An integrated satellite positioning system / inertial navigation system provided for improved radar direction estimation | |
CN106199667A (en) | Fast relocation method in GPS/SINS hypercompact combination navigation system | |
Groves et al. | Combining inertially-aided extended coherent integration (supercorrelation) with 3D-mapping-aided GNSS | |
US7298323B2 (en) | Apparatus and method for locating user equipment using global positioning system and dead reckoning | |
KR100443550B1 (en) | IMU-GPS Integrated System including error correction system, Method for reducing search space of integer ambiguity, Method for detecting Cycle slip, and position, velocity, attitude determination Method using the same | |
WO1999023505A1 (en) | Method for determining the attitude of a vehicle using gps signals | |
WO2009115899A2 (en) | Moving body positioning device and moving body positioning method | |
WO2003017018A1 (en) | Satellite navigation system and attitude determination method of object using the same | |
US7546217B2 (en) | Method for determining the orientation of an antenna array | |
JP2010223684A (en) | Positioning apparatus for moving body | |
US20130076564A1 (en) | Method and apparatus of gnss receiver heading determination | |
KR100376657B1 (en) | Half Cycle Ambiguity Resolution Method for GPS, and GPS Attitude Determination System and Method using the same | |
JP3528097B2 (en) | Movement information output device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
AK | Designated states |
Kind code of ref document: A1 Designated state(s): AE AG AL AM AT AU AZ BA BB BG BY BZ CA CH CN CO CR CU CZ DE DM DZ EC EE ES FI GB GD GE GH HR HU ID IL IN IS JP KE KG KP KZ LK LR LS LT LU LV MA MD MG MK MW MX MZ NO NZ OM PH PL PT RO SD SE SG SI SK SL TJ TM TN TR TT UA UG US UZ VN YU ZA ZM Kind code of ref document: A1 Designated state(s): AE AG AL AM AT AU AZ BA BB BG BR BY BZ CA CH CN CO CR CU CZ DE DK DM DZ EC EE ES FI GB GD GE GH GM HR HU ID IL IN IS JP KE KG KP KZ LC LK LR LS LT LU LV MA MD MG MK MN MW MX MZ NO NZ OM PH PL PT RO RU SD SE SG SI SK SL TJ TM TN TR TT TZ UA UG US UZ VN YU ZA ZM ZW |
|
AL | Designated countries for regional patents |
Kind code of ref document: A1 Designated state(s): GH GM KE LS MW MZ SD SL SZ UG ZM ZW AM AZ BY KG KZ RU TJ TM AT BE BG CH CY CZ DK EE ES FI FR GB GR IE IT LU MC PT SE SK TR BF BJ CF CG CI GA GN GQ GW ML MR NE SN TD TG Kind code of ref document: A1 Designated state(s): GH GM KE LS MW MZ SD SL SZ TZ UG ZM ZW AM AZ BY KG KZ MD RU TJ TM AT BE BG CH CY CZ DE DK EE ES FI FR GB GR IE IT LU MC NL PT SE SK TR BF BJ CF CG CI CM GA GN GQ GW ML MR NE SN TD TG |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application | ||
DFPE | Request for preliminary examination filed prior to expiration of 19th month from priority date (pct application filed before 20040101) | ||
REG | Reference to national code |
Ref country code: DE Ref legal event code: 8642 |
|
32PN | Ep: public notification in the ep bulletin as address of the adressee cannot be established |
Free format text: NOTING OF LOSS OF RIGHTS PURSUANT TO RULE 69(1) EPC |
|
122 | Ep: pct application non-entry in european phase | ||
NENP | Non-entry into the national phase |
Ref country code: JP |
|
WWW | Wipo information: withdrawn in national office |
Country of ref document: JP |