AU672349B2 - Integrated vehicle positioning and navigation system, apparatus and method - Google Patents
Integrated vehicle positioning and navigation system, apparatus and method Download PDFInfo
- Publication number
- AU672349B2 AU672349B2 AU16364/95A AU1636495A AU672349B2 AU 672349 B2 AU672349 B2 AU 672349B2 AU 16364/95 A AU16364/95 A AU 16364/95A AU 1636495 A AU1636495 A AU 1636495A AU 672349 B2 AU672349 B2 AU 672349B2
- Authority
- AU
- Australia
- Prior art keywords
- data
- gps
- satellites
- current
- vehicle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Ceased
Links
Landscapes
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Description
-1- P/00/0011 Rcgulation 32
AUSTRALIA
Patents Act 1990 COMPLETE SPECIFICATION FOR A STANDARD PATENT
ORIGINAL
9 Name of Applicant: Actual Inventois: CATERPILLAR INC.
Adam J. GUDAT, Walter J. BRADBURY, Dana A. CHRISTENSEN, Richard G. CLOW, Lonnie J. DEVIER, Carl A. KEMNER, Karl W. KLEIMENHAGEN, Craig L. KOEHRSEN, Christos N. KYRTSOS, Norman K. LAY, Joel L. PETERSON, Prithvi N. RAO, Larry E. SCHMIDT, James W. SNNOTT, Gary K. SHAFFER, WenFan SHI, Dong Hun SHIN, Sanjiv J. SINGH, Darrell E. STAFFORD, Louis J. WEINBECK, Jay H. WEST, William L. WHITTAKER, BaoXin WU CARTER SMITH BEADLE 2 Railway Parade Camberwell Victoria 3124 Australia Integrated Vehicle Positioning and Navigation System, Apparatus and Method Address for service in Australia: Invention Title: The following statement is a full description of this invention, including the best method of performing it known to us -2- INTEGRATED VEHICLE POSITIONING AND NAVIGATION SYSTEM, APPARATUS AND METHOD BACKGROUND OF THE INVENTION 1. Field of the Invention The present application is a divisional application of Australian Patent No.
46043/93 which was divided from Australian Patent No. 642638. The present application relates to a system for improving the accuracy of a position determination system. Other inventions relating to systems/methods for navigating an autonomous vehicle are disclosed in other co-pending applications e.g. 46045/93.
For an overview of the interrelated navigation and positioning systems/apparatus/methods, the reader should refer to the specification accompanying Australian Patent No. 642638.
2. Related Ar There is presently under development a terrestrial position determining system, referred to as the global positioning system (GPS), designated NAVSTAR by the U.S. Government. In this system, a multitude of orbiting satellites will be used to determine the terrestrial position of receivers on the Earth. In the planned system, there will be eight orbiting satellites in each of three sets of orbits, 21 satellites on line and three spares, for a total of 24 satellites. The three sets of orbits will have mutually orthogonal planes relative to the Earth. The orbits are neither polar orbits nor equatorial orbits, however. The satellites will be in 12-hour orbits.
The position of each satellite at all times will be precisely known. The longitude, latitude, and altitude with respect to the center of the Earth, of a receiver at any point close to Earth at the time of transmission, will be calculated by determining 25 the propagation time of transmissions from at least four of the satellites to the receiver. The more satellites used the better. A current constraint on the number of satellites is that the currently available receiver has only five channels.
SUMMARY OF THE INVENTION In this specification, the term "integrated vehicle positioning and navigation system" as used throughout, means apparatus, method or a combination of both DCC:TlI;TG:#17680.SPC 5 April 1995
__I
-3apparatus and method. The present invention overcomes many of the limitations present in conventional technology in the fields of positioning and navigation, and thereby provides for highly accurate and autonomous positioning and navigation of a vehicle.
As disclosed, the conventional capabilities of the IRU (Inertial Reference Unit) and the GPS (Global Positioning System) have been both combined, and greatly enhanced, in a cost-effective manner to provide autonomous vehicle capability. In doing so, many novel and inventive systems, apparatus, methods and techniques have been developed which allow for a superior positioning capability, and flexible autonomous navigational capability.
The vehicle positioning and navigation system achieves some of its advantages by using a novel and enhanced combination of three independent subsystems to determine position. These are: GPS (Global Positioning System) satellites, an inertial reference system, and the vehicle odometer. These three S: 15 independent subsystems produce positioning data which may then be combined by :I a novel Kalman filter so that an output stream of positioning data of improved accuracy may be produced at a much faster rate (approximately 20 Hz).
Increased positioning accuracy is provided for by providing novel systems for compensating for noise and errors in positioning data.
S 20 The present invention also provides for anti-spoofing, that is detecting and correcting intentionally false positioning data transmitted by the satellite positioning system.
In accordance with a first aspect of the present invention, there is disclosed a system for determining the position of a user using orbiting satellites of a global positioning system and a reference station, the system comprising: first means for computing respective first positions of the satellites in view of a reference antenna at the reference station using previous ephemeris data and responsively determining respective predicted estimated pseudoranges (Oj); second means for computing respective second positions of the satellites in view of said reference antenna at the reference station using current DCC:TJH.TG:#17680.RS I 31 July 1996 -4ephemeris data and responsively determining respective current estimate pseudoranges (Nij); third means responsive to said first and second means, said third means for receiving said respective predicted estimated pseudoranges and said respective current estimated pseadoranges comparing said predicted estimated pseudoranges (Oij) and said respective current estimated pseudoranges (Nij), and responsively determining if said current ephemeris data is corrupt; fourth means responsive to said third means, said fourth means for computing a spatial bias using said current ephemeris data if said current ephemeris data is not corrupt and computing a spatial bias using said previous ephemeris data if said current ephemeris data is corrupt; and fifth means located at the user, for receiving signals from said satellites and said spatial bias and responsively determining an estimate of the position of the *eo user.
In accordance with a second aspect of the present invention, there is disclosed a method for determining the position of a user using orbiting satellites of a global positioning system and reference station, the method comprising the steps of: computing respctive predicted -estimated pseudoranges of the satellites in view of a reference antenna at the reference station using previous ephemeris data; computing current estimated pseudoranges (Nij) of the satellites using current ephemeris data; comparing said predicted estimated pseudoranges and said current estimated pseudoranges and responsively determining if said ephemeris data is corrupt; computing a spatial bias using said current ephemeris data if said current ephemeris data is not corrupt and computing a spatial bias using said previous ephemeris data if said current ephemeris data is corrupt; and receiving, at the user, signals from the satellites and said spatial bias and responsively determining an estimate of the position of the user.
DCC:TJH:TG:# 17680.RS 31 July 1996 4a A better appreciation of these and other advantages and features of the present invention, as well as how the present invention realizes them, will be gained from the following detailed description and drawings of the various embodiments, and from the claims.
BRIEF DESCRIPTION OF THE DRAWINGS The present invention is better understood by reference to the following drawings in conjunction with the accompanying text.
Fig. 1 is a diagrammatic view of the GPS satellites in 6 orbital planes.
Fig. 2 is a diagrammatic view illustrating the GPS navigation equations.
Fig. 3 is a diagrammatic view of a typical autonomous work site in which the present invention is practiced.
Fig. 4 is a diagrammatic representation of the interrelationships between the navigator, the vehicle positioning system (VPS), and the vehicle controls.
S
ft S C S V
C
DCC:TJH:TG:~I17680.RS 31 July 1996 Fig. 5 is a context diagram, illustrating the various elements and their interrelationship in an autonomous control system according to the present invention.
Fig. 6 is a diagrammatic representation of the operation of a Global Positioning System (GPS), including a satellite constellation, A pseudolite, the base station and a vehicle.
Fig. 7 is a block diagram representing the GPS Processing System.
Fig. 8 is a flow diagram illustrating communications in one embodiment of the GPS Processing System of Fig. 7.
Fig. 9 is a block diagram illustrating the Motion Positioning System (MPS) including the Inertial Reference Unit and the Odometer.
Fig. 10 is a block diagram illustrating one embodiment of the VPS System Architecture.
Fig. 11 is a detailed block diagram of the embodiment of the VPS System Architecture of Fig. Fig. 12 is a block diagram of one embodiment of the VPS Main Processor of Fig. 10 showing the VPS Kalman Filter and the Weighted Combiner.
Fig. 13 is a flowchart of the Constellation Effects Method for improving position accuracy.
Fig. 14 is a polar plot illustrating the computed pseudo ranges from a four 20 satellite constellation.
*•go Fig. 15 is a flowchart of the original bias technique for Differential Corrections.
Fig. 16 is a flowchart of the Parabolic Bias Method for Differential Corrections.
25 Fig. 17 is a flowchart of the BASE residuals as BIAS Method for Differential Corrections.
Fig. 18 is a flowchart of the method for Satellite Position Prediction.
Fig. 19 is a flowchart of the Weighted Path History Method.
Fig. 20 is a diagrammatic representation of the Weighted Path History Method.
DCCH:TJIG:I17680.SPC 5 Apil 1995 -6- Fig. 21 is a flowchart of the Anti-Spoofing Method.
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENT TABLE OF CONTENTS
I.
II.
General Overview Vehicle Positioning System (VPS) A. Overview B. Global Positioning System (GPS) 1. GPS Space Segment 2. GPS System Operation C. Motion Positioning System (MPS) D. VPS System Architecture E. Base Station F. Satellite Based Accuracy Improvements 1. Constellation Effects 2. Differential Correction Techniques a. Original Bias Technique b. Parabolic Bias Technique c. base Kesiluals as bias Technique G. Anti-Spoofing 20 I. General Overview In the following description of the present invention, and throughout the specification, the term "system" is used for shorthand purposes to mean apparatus, method, or a combination of both apparatus and method.
Autonomous is used herein in its conventional sense. It indicates operation 25 which is either completely automatic or substantially automatic, that is, without significant human involvement in the operation. An autonomous vehicle will generally be unmanned, that is without a human pilot or co-pilot. However, an autonomous vehicle may be driven or otherwise operated automatically, and have one or more human passengers.
The task of guiding an autonomous vehicle along a prescribed path requires DCC:TII:TG;:#17680.SPC 5 Apil 1995 -7 that one accurately knows the current position of the vehicle. Once the current position is known, one can command the vehicle to proceed to its next destination.
For a truly autonomous vehicle to be practical, very accurate position information is required. In the past, it was not believed possible to obtain this nearly absolute position information without using a prohibitively large number of reference points. All positioning was done relative to the last reference point using inertial navigation or dead reckoning.
Using the systems disclosed herein we are able to obtain the nearly absolute position information required for a truly autonomously navigated vehicle. This led us to the development of simpler, more reliable vehicle controllers and related systems as well.
The development and implementation of the GPS (global positioning system) was a necessary and vital link which allowed us to develop our inventive systems to obtain more accurate position information. The GPS satellite position information, significantly enhanced through our inventive techniques, is combined and filtered with IRU (Inertial Reference Unit) inertial navigation information, and vehicle odometer information, according to one aspect of the present invention, :i resulting in a highly accurate system for determining position and effecting navigation.
Integration of both positioning and navigation systems, apparatus, methods and techniques provide for the highly accurate transportation of unmanned vehicles.
The navigation system more fully disclosed in Australian Patent No. 642638, using the highly accurate position information obtained from the positioning system, is able to provide for accurate navigation between points along pre-established or i" 25 dynamically generated paths.
Use is made of various models or conceptual representations to generate and follows these paths. For example, lines and arcs may be used to establish paths between objective points the vehicle is t. obtain. B-splines or clothoid curves may be used to model the actual path the vehicle is to navigate. Using modelling or representational techniques provides for enhanced data communication, storage and DCC:TJII:TG:#17680.SPC 5 Aprf 1995 -8handling efficiencies. It allows for simplification of supervisory tasks by providing a hierarchy of control and communication such that the higher the level of control, the simpler the task, and the more compact the commands.
At the base station, where GPS positioning data is .dso received from the satellites, a host processing system provides for the highest level of control of the navigation system. The host handles scheduling and dispatching of vehicles with much the same results as a human dispatcher would achieve. The host thereby determines the work cycle of each vehicle.
The host commands each of the vehicles to proceed from a current position to another position taking a specified route in order that they effect their work goals.
The host specifies the routes by name, and not by listing each point along the route.
Each vehicle has an on-board system which looks up the named route and translates the named route into a set of nodes and segments along the route, using, for example, the models or representations d'scussed above to connect the nodes.
The on-board system also provides for controlling the vehicle systems, such as brakes, steering, and engine and transmission, to effect the necessary physical acts required to move, stop, and steer the vehicle. These may be designed to be retro- :I fitted onto existing vehicles, such as the Caterpillar, Inc. 785 off-highway truck, for instance.
The on-board system also checks actual position against desired position and corrects vehicle control to stay on route. The system may run multi-state models to enhance this checking capability. The system also checks for errors or failures of the system and vehicle components. If detected, the system provides for fail-safe shutdown, bringing the vehicle to a stop.
25 The on-board navigation system provides for different modes of control.
These include a fully autonomous mode, where navigation of the vehicle is .eu.
automatically handled by the on-board system; a tele or remote control mode, where a remote human operator may control the direction and motion, and so on, of the vehicle; and a manual mode, where a human operator sitting in the cab can take control of the vehicle and drive it manually.
DCC:TJI I:TG:#17680.SPC S A i 1995 -9- In the autonomous mode, obstacle detection is critical, and is provided for in the navigation system of the present invention. Boulders, animals, people, trees, or other obstructions may enter the path of a vehicle unexpectedly. The on-board system is capable of detecting these, and either stopping, or plotting a path around the obstruction, to return to its original route when it is safe.
Accurately tracking the desired route is another function of the on-board navigational system. System function and architecture has been designed for real time tracking of the path at speeds up to approximately 30 mph. safely.
As an introduction to the next section, "POSITIONING," recall that the vehicle positioning system (VPS) of the present invention is a positioning system based on the incorporation of Inertial Reference Unit (IRU) Data, Odometer Data and Global Positioning System (GPS) Data.
The VPS incorprates these three subsystems with extensive innovative methodology to create a high accurate position determination system for moving or stationary vehicles, or any point on the Earth.
The GPS comprises a space segment and a land or atmospheric based processing system. The space segment includes 24 special purpose satellites (not yet fully implemented) which are being launched and operated by the U.S. Government.
These satellites continually transmit data to the Earth that can be read by a GPS receiver. The GPS receiver is part of a processing system which produces an estimate of the vehicle position based on the transmitted data.
When multiple satellites are in view, the GPS receiver can read each satellite's navigation messages and determine position based on known triangulation methods.
The accuracy of the process is in part dependent on how many satellites are in view.
The IRU comprises laser gyroscopes and accelerometers which produce position, velocity, roll, pitch and yaw data. The IRU combines this information into an estimate of vehicle position. The odometer produces data on distance travel that is incorporated with the IRU data.
A base station provides a geographic proximate reference point and reads the 30 data transmitted by each satellite. Using the transmitted data, the base station makes o c p I)0 DCC:TJtI:TG:#17680.SPC 5 AApr 1995 10 improvements in accuracy on the estimate of the vehicle position.
A method is disclosed to predict the position of any satellite at the current time or any future time. Using that information, the GPS receiver can determine the optimum satellite constellation.
Vehicle "wandering" may be reduced by using the path history of the vehicle to statistically determine the accuracy of future estimates of position.
The present invention also includes numerous methods fr- determining how accurate the data transmitted from the satellite is. Included in these methods are techniques to compensate for data with error.
II Positioning A. Overview Referring now to Figs. 7 through 11, the present invention includes a Vehicle Positioning System (VPS) 1000 which is a highly accurate position determi,?ation system, The VPS incorporates three subsystems and extensive innovative methodology to create an unsurpassed position determination system for moving or stationary vehicles 310.
The VPS includes global positioning system (GPS) 700 and a motion positioning system (MPS) 900 including an inertial reference unit (IRU) 904, and an odometer 902 which have been enhanced and combined to produce a highly effective position determining system. The GPS 700 comprises a space segment and a land or atmospheric (for example, one located on an aircraft) based processing system.
The space segment includes 24 special purpose satellites (not yet fully implemented; see Fig. 1) which are being launched and operated by the U.S. Government. These satellites constantly transmit data to the Earth that is read by a GPS receiver 706.
The GPS receiver 706 is part of a GPS processing system 700 which produces an estimate of the vehicle position based on the transmitted data. The vehicle's estimated position is transmitted to a VPS main processor 1004.
When multiple satellites are in view (see Fig. the GPS receiver 706 can read each of their navigation messages and compute the position of the antenna 702 30 using triangulation methods. The accuracy of the process is in part dependent on o r Je DCC:T1I:TG:17680.SPC 5 Apl 1995 11 how many satellites are in view. Each satellite in view increases the accuracy of the process.
The IRU 904 comprises laser gyroscopes and accelerometers which produce position, velocity, roll, pitch, and yaw data. The IRU 904 combines this information into an estimate of the vehicle position. The odometer 902 produces distance traveled. The data from the IRU 904 and the odometer 902 are also transmitted to the VPS main processor 1004.
The VPS main processor 1004 combines the data from the MPS 900 (the IRU 904 and the odometer 902) with the estimated position from the GPS processing system 700 to produce a more accurate position.
Referring now to Fig. 3, a base station 314 provides a geographic proximate reference point for the VPS 1000. The base station 314 includes its own GPS receiver 706 for reading the data transmitted by the satellites. Using the transmitted data, the base station 314 allows the VPS 1000 to make satellite based accuracy improvements on the estimated of the vehicle position.
The present invention includes a method (as shown in the flowchart of Fig.
18) to predict the position of any satellite at the current time or any future time.
Given an estimate of the position of the GPS antenna 702, the GPS receiver 706 can predict which satellites it will be able to read at any time. Using that information, the GPS receiver 706 can determine the optimum satellite constellation.
The present invention also includes a method for reducing vehicle "wandering" and spurious position computations. In this method, the path history of the vehicle is used to statistically determine the accuracy of future estimates.
The present invention also includes a method for determining if the data 25 received from the satellites is valid. The GPS receiver 706 determines the distance from the satellite to the GPS receiver 706 based on the data being transmitted by each satellite. The GPS receiver 706 compares this determined distance with 'n expected distance based on the time and an estimated position. If the distances are *within a given range, then the data from satellites is assumed to be valid. Otherwise, 30 the data is adjusted such that the determined distance between the satellite and the DCC:TJII:1G:17680.SPC s April 199S 12- GPS receiver is within the given range.
B. Global Positioning System (GPS) 1. GPS Space Segment As shown in Fig. 1, 24 man-made electronic satellites which make up the global positioning system (GPS) are planned for deployment by the early 1990s. As currently envisioned, the satellites will orbit the Earth at an altitude of approximately 10,900 miles and encircle the globe twice a day. With this conventional GPS system, it will be possible to determine terrestrial position within 15 meters in any weather, any time, and most areas of the Earth.
As of the date of the filing of this application, there are known to be seven experimental GPS satellites in orbit, and several manufacturers that are building GPS receivers. Until additional satellites are deployed and operational, there are only two windows each day when three or more satellites are available for position tracking.
The location of these satellites (and all others once deployed) is very predictable and can be plotted in terms of elevation and azimuth.
Reference is again made to Fig. 1 of the drawings wherein the configuration of the fully operational GPS system is schematically illustrated. Twenty-four (twenty-one operational, three spare) medium orbiting satellites in six sets of orbits continuously transmit unique identifying signals on a common carrier frequency.
Each of the 24 satellites transmits a unique navigation signal which can be used to determine the terrestrial position of an Earth antenna sensitive to the signal.
The navigation signal is comprised of a data bit stream which is modulated with a pseudo-random type binary code which biphase modulates the carrier frequency.
In the coarse acquisition mode, each satellite has an established unique 25 pseudo-random code, which is a gold code sequence having a length of 1,023 chips that repeats itself once every millisecond. To facilitate separation of different satellite's signals, the gold code sequence for each satellite has a low correlation with the gold code sequence from the other satellites.
In the carrier mode, the data transmitted by the satellites is encoded on the 30 carrier frequency in a manner similar to the C/A code. In the carrier mode, more D C:TJII:TG:#I17680.SPC 5 Ail 1995 13 data can be encoded and therefore more precise position computations can be made.
A GPS receiver can decode a navigation signal whose gold code sequence highly correlates to an identical gold code sequence generated by the GPS receiver.
The separation of the different satellite's signals from a common carrier is based on cross correlation of the signal with the locally generated gold code sequences, on a chip by chip basis, and then within a chip, until the maximum cross correlation value is obtained; the gold code sequence which maximizes this value can be used to extract the navigation data which is used in determining positin of the receiving antenna.
Turning now to Fig. 2, a diagrammatic representation of the GPS in operation is shown. Four satellites 200, 202, 204, 206 comprise the current group (constellation) of satellites in the view of the EaPih antenna (user 210).
As is shown in the description block 208, each satellite is transmitting a navigation signal that includes timing (GPS time) and ephemeris (satellite position) data. Using the navigation equations 212, which are well-known in the art, and the timing and ephemeris data from the navigation signal, the position of the user 210 can be determined.
2. GPS System Operation Turning now to Fig. 6, a representative GPS system is shown in operation.
Four GPS satellites 200, 202, 204 and 206 are transmitting navigation signals in which satellite position (ephemeris) data and transmission time data are encoded.
Both a vehicle 310 and a base station 314 are receiving these signals from each of oloe these satellites on their respective GPS antennas 312 and 316. In a preferred embodiment, both the C/A code and the carrier frequency are received at GPS antennas 312 and 316 for processing.
In addition to the four GPS satellites shown in the Fig. 6, a radio transmitter 624 is also depicted. This radio transmitter 624 is commonly known as a pseudolite.
These pseudolites, in one embodiment of the present invention, can be strategically placed around the perimeter of a mine pit and emulate the GPS satellites as shown 30 in Fig. 6. This arrangement can be extremely useful in situations such as a mine pit DC:rJH:TG:#17680.SPC 5 Apdl 1995 L 14 or mine shaft, in which mining vehicles may be out of view of one or more of the GPS satellites, because of topographic features such as high mine pit walls. These ground based pseudolites provide additional ranging signals and can thus improve availability and accuracy of the positioning capability in the present invention.
The pseudolites are synchronized to the GPS satellites and have a signal structure that, while possibly different, is compatible with the GPS satellites. Note that when ranging to pseudolites, the ranging error does not include selective availability nor ionospheric errors. However, other errors must be accounted for such as tropospheric, pseudolite clock error and multipath errors.
In a deep pit surface mining operation, the view of the sky is limited by the walls of the mine and an inadeqaate number of satellites may be in view for position determination. In such a case in the present invention, one or more pseudolites would be placed on the rim of the mine and used with a vehicle with the visible satellites to obtain accurate vehicle position.
Transmission channel 618 represents the electromagnetic communications channel linking the base station 314 and the vehicle 310. The transmission channel 618 is used to transfer data between the base station 314 and the vehicle 310. This transmission channel 618 is established by data-radios 620 and 622 which are transmitter/receivers.
The data-radios 620 and 622 are located at the base station 314 and vehicle 310 respectively, and are responsible for transferring various data between the base station 314 and the vehicle 310. The type of data transferred will be discussed further below. No physical medium (for example, copper wire, optical fiber) is necessary to conduct the transmission of data.
25 A radio transmitter/receiver which functions appropriately with the present invention can be found in the art. Such a preferred radio transmitter/ receiver is commercially available from Dataradio Ltd. of Montreal. Canada, Model Number DR-4800BZ.
Turning now to Fig. 7, a preferred embodiment of a GPS processing system 30 700 is shown. The GPS processing system 700 on the vehicle 310 includes a GPS DCC:TJll:TG:#1760.SPC 5 April 1995 L 15 antenna 702. In a preferred embodiment, the GPS antenna 702 is receptive to the radio spectrum of electro-magnetic radiation. However, the present invention contemplates reception of any signal by which GPS satellites might encode the navigation data.
An antenna receptive to the radio spectrum used by GPS satellites which functions satisfactorily with the present invention can be found in the art. Such a preferred antenna is commercially available from Chu Associates Inc. of Littleton, Massachusetts, Model CA3224.
The GPS antenna 702 is coupled to a pre-amplifier 704 so that the signals received at the GPS antenna 702 can be transmitted to the pre-amplifier 704. The present invention contemplates any method by which the GPS antenna 702 can be satisfactorily coupled to the pre-amplifier 704. Further, as will be noted at numerous places below, all devices in the GPS processing system 700, MPS processing system 900 and VPS processing system 1000 are coupled. The present invention contemplates any method by which these devices can be satisfactorily coupled.
Such coupling methods may include for example, electronic, optic, and sound methods as well as any others not expressly described herein. In a preferred embodiment, the coupling method used is electronic and adheres to any one of numerous industry standard interfaces.
The pre-amplifier 704 amplifies the signal received from the GPS antenna 702 so that the signals can be processed (decoded). The present invention contemplates any method by which the received signals can be amplified.
A pre-amplifier which functions satisfactorily with the present invention can 25 be found in the art. Such a preferred pre-amplifier is commercially available from Stanford Telecommunications Inc. (STel) of Santa Clara, California, Model Number 5300, Series GPS RF/IF.
The pre-amplifier 704 is coupled to a GPS receiver 706. The GPS receiver 706 decodes and processes the navigation message sent from the satellites in the 30 view of the GPS antenna 702. During this processing, the GPS receiver 706 ee DCC:TJtI:TG:#17680.SPC 5 April 1995 16computes the latitude, longitude, and altitude of all satellites in the particular constellation being viewed. The GPS receiver 706 also computes pseudoranges, which are estimates of the distances between the satellites in the currently viewed constellation and the GPS antenna 702. In a preferred embodiment, the GPS receiver 706 can process, in parallel, pseudoranges for all satellites in view.
In a preferred embodiment of the present invention, the GPS receiver 706 produces this data when four or more satellites are visible. In a preferred embodiment of the present invention, the GPS processing system 700 can compute a position having an accuracy of approximately 25 meters when an optimal constellation of 4 satellites is in view. In another preferred embodiment of the present invention, the GPS processing system 700 can compute a position having an accuracy of approximately 15 meters when an optimal constellation of 5 satellites is in view. An optimal constellation is one in which the relative positions of the satellites in space affords superior triangulation capability, triangulation technology being well known in the art.
In a preferred embodiment of the present invention, the GPS receiver 706 encodes in the outputted position data the number of satellites currently being viewed for each position computation made. In cases in which the number of satellites viewed for a series of position computations is four, the VPS weighted combiner 1204 (see Fig. 12 and discussion) uses only the first position computation received in the series. All subsequent position computations in the series are ignored by the VPS weighted combiner 1204. The VPS weighted combiner 1204 acts in this manner because position computations derived from four satellites are less accurate than nominally acceptable.
25 A receiver that functions satisfactorily in the present invention can be found in the art. Such a receiver is commercially available from Stanford Telecommunications Inc., Model Number 5305-NSL The GPS receiver 706 is coupled to a GPS inter communication processor 708. The GPS inter communication processor 708 is also coupled to a GPS 30 processor 710 and a GPS Console 1 712. The GPS inter communication processor DCC:TJ1:'.. 17680.SPC 5 April 1995 17- 708 coordinates data exchange between these three devices. Specifically, The GPS inter communication processor 708 receives pseudorange data from the GPS receiver 706 which it passes on to the GPS processor 710. The GPS inter communication processor 708 also relays status information regarding the GPS receiver 706 the GPS processor 710 to the GPS Console 1 712.
An inter communication processor that functions satisfactorily with the present invention can be found in the art. Such a preferred inter communication processor is commercially available from Motorola Computer Inc. of Cupertino, California, Model Number 68000.
The GPS processor 710 is passed the satellite location and pseudorange data from the GPS inter communication processor 708. Turning now to Fig. 8, the operation of the GPS processor is depicted. The GPS processor 710 uses methods to process this data including a GPS Kalman filter 802 (see Fig. 8) which filters out noise buried in the pseudorange data, including ionospheric, clock, and receiver noise. The GPS Kalman filter 802 also reads biases (discussed further below) transmitted by the base station 314 to the GPS processor 710 Processor hardware that functions satisfactorily with liu present invention as the GPS processor 710 can be found in the art. Such hardware is commercially available from Motorola Computer Inc., Model Number 68020. The software in the GPS processor 710, in a prefenred embodiment, functions in the following way.
In a preferred embodiment, this GPS Kalman filter 802 is semi-adaptive and therefore automatically modifies its threshold of acceptable data perturbations, depending on the velocity of the vehicle 310. This optimizes system response and accuracy of the present invention as follows.
25 Generally, when the vehicle 310 increases velocity by a specified amount, the GPS Kalman filter 802 will raise its acceptable noise threshold. Similarly, when the vehicle 310 decreases its velocity by a specified amount the GPS Kalman filter 802 will lower its acceptable noise threshold. This automatic optimization technique of the present invention provides the highest degree of accuracy under both moving and 30 stationery conditions.
*o* DCC:TJIHiTG:1760.SPC 5AriH1995 18 In the best mode of the present invention, the threshold of the GPS Kalman filter 802 does not vary continuously in minute discreet intervals. Rather, the intervals are larger and, therefore, less accurate than a continuously varying filter.
However, the Kalman filter 802 of the present invention is easy to implement, less costly and requires less computation time than a continuously varying filter.
However, such a continuously varying filter could be used.
The GPS Kalman filter 802 must be given an initial value from the user at system start-up. From this value, and data collected by the GPS receiver 706, the GPS Kalman filter 802 extrapolates the current state (which includes position and velocities for northing, easting and to the new "expected' position. This extrapolated position is combined GPS data (an update) to produce the current state. The way the data is util. is dependent on an a priori saved file called a control file (not shown). This f6. ii.ll determine how much noise the system is allowed to have, how fast the system should respond, what are the initial guesses for position and velocity, how fir off the system can be before a system reset occurs, how many bad measurements are allowed, and/or how much time is allotted between measurements.
The GPS processor 710 then computes position, velocity, and time using the filtered data and biases. However, the GPS processor 710 discards the computed velocity datum when the C/A code rather than the carrier is processed by the GPS receiver 706 because experimentation has shown that this datum is not accurate.
Velocity data derived from the carrier frequency is not discarded because it is much more accurate than the C/A code velocity data. The computed position and time data (and velocity data if derived from the carrier frequency) are encoded on 25 GPS Signal 716 and sent on to the VPS main processor 1004 shown on Fig. In a preferred embodiment of the present invention, the GPS processor 710 reads both of these codes depending on the availability of each. Unlike data transmitted using the C/A code, the carrier frequency data transmitted by the satellite is available from the GPS receiver 706 at approximately 50 Hz (rather than 30 approximately 2 Hz.) This increased speed allows the present invention to produce *it DCC:TJII:TG:#17680.SPC 5 April 1995 19 more precise position determinations with less error.
A preferred embodiment of other functions of the GPS processor 710 is shown in Fig. 8. However, the present invention contemplates any method by which data transmitted by GPS satellites can be processed. As shown at a block 816, a console function controls the operation of the GPS console 2. This console function regulates the operation of the GPS Kalman filter 802 by providing the user interface into the filter.
The VPS communications function shown at a block 818, controls the outputs of the GPS Kalman filter 802 which are directed to the VPS system 1000. At a block 806, it is shown that the GPS Kalman filter 802 requests and decodes data from the GPS receiver 706, which data is routed through an IPROTO function shown at a block 804. The IPROTO function is not a function of the GPS processor, as indicated on Fig. 8 by the dashed line. Rather, the IPROTO function resides on the GPS inter communications processor 708 and executes tasks associated with the GPS inter communications processor 708. An IPROTO function that operates satisfactorily with the present invention can be found in the art. One model is commercially available from Xycom Inc., model number XVME-081.
As shown at a block 810 the data transmitted over the transmission channel 618 is decoded and transmitted into the GPS Kalman filter 802. The communications manager function shown at a block 808, coordinates the incoming data from the IPROTO function. The communications manger function 808 also :i coordinates data received from an ICC function which is shown in a block 812. The ICC function 812 exchanges data with the data-radio 714 and the GPS data Scollection device 718 as shown.
25 The GPS console 1 712, is well known in the art. Many types of devices are commercially available which provide the desired function. One such device is commercially available from Digital Equipment Corporation of Maynard, Massachusetts Model Number VT220. The GPS Console 1 712 displays processor activity data regarding GPS inter communication processor 708, and GPS processor 710.
DCC:TJII:TG:#17680.SPC 5 April 1995 20 The GPS processor 710 is coupled to a GPS Console 2 722 and a GPS communications interface processor 720. The GPS console 2 722, is well known in the art. Many types of devices are commercially wailable which provide the desired console function. One such device is commercially available from Digital Equipment Corporation of Maynard, Massachur lodel Number VT220. The GPS console 2 722 provides th-e user interface from 'hich the GPS processor 710 can be activated and monitored.
The GPS communications interface processor 720 is coupled to a data-radio 714 and a GPS data collection device 718. The GPS communications interface processor 720 coordinates data exchange between the GPS processor 710 and both the data-radio 714 and the GPS data collection device 718. A communications interface processor which functions appropriately can be found in the art. A preferred communications interface processor is commercially available from Motorola Computer Inc., Model Number MVME331.
The data-radio 714 communicates information from the GPS processor 710 (through the GPS communications interface processor 720) to a similar data-radio 620 located at the base station 314 (see Fig. In a preferred embodiment, the data-radio 714 communicates synchronously at 9600 baud. These data-radios provide periodic updates on the amount of bias (as detected by the base station 314) are transmitted to the vehicle 310 at a rate of twice a second. Base station 314 computed bias will be discussed further below.
The GPS data collection device 718 can be any of numerous common electronic processing and storage devices such as a desktop computer, The International Business Machines Corporation (IBM) PC available from IBM of Boca 25 Raton, Florida can be used.
C. Motion Positioning System (MPS) In a preferred embodiment, the present invention also includes the combination of inertial reference unit (IRU) 904 and odometer 902 components.
These together with a processing device 906 comprise the motion positioning system 30 (MPS) 900. IRUs and odometers are well known in the field, and are commercially 0*4 5 9 DCC:TJII:TG:#17680.SPC 5 April 1995 21available from Honeywell Inc. of Minneapolis, Minnesota, Model Number H61050- SR01, and from Caterpillar Inc. of Peoria, Illinois, Part Number 7T6337 respectively.
Turning now to Fig. 9, a preferred embodiment of the motion positioning system 900 is depicted. A Vehicle odometer 902 and an IRU 904 are coupled to the MPS inter communications processor 906.
The IRU 904 comprises laser gyroscopes and accelerometers of known design.
An IRU which can satisfactorily be used in the present invention is a replica of the system used by Boeing 767 aircrafts to determine position, except that the system used in the present invention has been modified to account for the lesser dynamics (for example, velocity) that the vehicles of the present invention will be exhibiting compared to that of a 767 aircraft.
In a preferred embodiment, the IRU 904 outputs position, velocity, roll, pitch, and yaw data at rates of 50 Hz (fifty (50) times a second); the vehicle odometer 902 outputs distance traveled at 20 Hz.
The laser gyroscopes of the IRU 904, in order to function properly, must be given an estimate of vehicle latitude, longitude and altitude. Using this data as a baseline position estimate, the gyroscopes then use a predefined calibration in conjunction with forces associated with the rotation of the earth to determine an estimate of the vehicle's current position.
This information is ihen combined by the IRU 904 with data acquired by the IRU 904 accelerometers to produce a more accurate estimate of the current vehicle position. The combined IRU 904 data and the vehicle odometer 902 data are 9 transmitted to the MPS inter communications processor 906.
The MPS inter communications processor 906 forwards the IRU and odometer data on to the VPS I/O processor 1002 (see Fig. 10), as shown at signals 910 and 908, respectively.
An inter communications processor that functions satisfactorily with the present invention can be found in the art. Such a preferred inter communications processor is commercially available from Motorola Computer Inc., Model Number 68000.
DCC:TJII:TG:#17680.SPC 5 Apn1l 1995 22 The present invention contemplates any method by which the signals 716, 908 and 910 can be received by the VPS I/O processor 1002 from the GPS system 700 and MPS sysem 900 and forwarded on to the VPS main processor 1004. An I/O processor which functions satisfactorily with the present invention can be found in the art. Such an I/O processor is commercially available from Motorola Computer Inc., Model Number 68020.
D. Vehicle Positioning System (VPS) Architecture Turning now to Fig. 10, a preferred embodiment of the VPS system architecture 1000 is depicted. Fig. 11 shows a diagram of the same VPS system architecture 1000, with the GPS processing system 700 and MPS processing system 900 in detail.
GPS processing system 700 and MPS processing system 900 are independently coupled to the VPS I/O processor 1002. Because they are independent, the failure of one of the systems will not cause the other to become inoperative. Thus, if the GPS processing system 700 is not operative, data will still be collected and processed by the MPS processing system 900 and the VPS 1000.
GPS processing system 700 and MPS processing system 900 transmit signals 716, 908, 910 to the VPS I/O processor 1002, as shown. These signals contain position, 20 velocity, time, pitch, roll, yaw, and distance data (see Figs. 7 and 9 and associated discussions).
The VPS I/O processor 1002 is coupled to the VPS main processor 1004.
The VPS I/O processor 1002 transmits signals 1006, 1008, and 1010 to the VPS main processor 1004, as shown. These signals contain the GPS, IRU and odometer data noted above.
Turning now to Fig. 12, a preferred embodiment of the operation of the VPS main processor 1004 is depicted. As shown, the GPS signal 1006, and the odometer signal 1008 are transmitted into a weighted combiner 1204. The IRU signal 1010 is transmitted into a VPS Kalman filter 1202. In a preferred emibodiment, the GPS signal 1006 is transmitted at a rate of 2Hz; the Odometer signal 1008 is transmitted DCC:TJI:';:#176S80.SPC 5 April 1995 23 at a rate of 20Hz and; the IRU signal 1010 is transmitted at a rate of The VPS Kalman filter 1202 processes the IRU signal 1010 and filters extraneous noise from the data. The VPS Kalman filter 1202 also receives a signal from the weighted combiner 1204, as shown, which is used to reset the VPS Kalman filter with new position information.
The weighted combiner 1204 processes the signals and gives a predetermined weighing factor to each datum based on the estimated accuracy of data gathering technique used. Thus, in the best mode of the present invention, the position component of the GPS signal 1006 is weighted heavier than the position component of the IRU signal 1010. This is because GPS position determination is inherently more accurate than IRU position determination.
However, velocity can be more accurately determined by the IRU, and therefore the IRU velocity component is weighted heavier than the GPS velocity component in the best mode of the invention.
The weighted combiner 1204 produces two outputs. One output contains all computed data and is sent to two locations: as shown at an arrow 1206, to the VPS Kalman filter 1202; and as shown at the arrow 1016, out of the VPS main processor 1004. The; second output shown at the arrow 1018 contains only velocity data and is sent out of the VPS main processor 1004 to the GPS processing system 700. The 20 output shown at the arrow 1016 contains GPS time, position, velocity, yaw, pitch, and roll data and is transmitted at a rate of 20 Hz.
The present invention contemplates any method by which the signals 1006, 1008, and 1010 can be processed at the VPS main processor 1004 in accordance with the above noted process steps. Processor hardware that functions satisfactorily with the present invention as the VPS main processor can be found in the art. Such hardware is commercially available from Motorola Computer Inc., Model Number 68020. The software in the VPS main processor 1004, in a preferred embodiment, functions as described above.
Referring now back to Fig. 10, the VPS main processor 1004 is coupled to a VPS communications interface processor 1020.
DCC:TJII:TO:rl7680.SPC SApnil 1995 24 A communications interface processor which functions satisfactorily with the present invention can be found in the art. One preferred model is commercially available from Motorola Computer Inc., Model Number MVME331.
In a preferred embodiment, the VPS communications interface processor 1020 is coupled to, and routes the data contained in Output 1016 (at 20 Hz.) to, three different devices: a VPS console 1012, a data collection device 101., and (3) a navigation system 1022.
The VPS console 1012 is well known in the art, and is commercially available from Digital Equipment Corporation, of Minneapolis, Minnesota, Model Number VT220. This VPS console 1012 is used to display the current status of the VPS main processor 1004.
The VPS data collection device 1014 can be any of numerous common electronic processing and storage devices such as a desktop computer. The Macntosh computer available from Apple Computer of Cupertino, California, can be used successfully.
The navigation system 1022 comprises the features associated with the navigational capabilities of the present invention. The VPS system 1000 transmits its final data regarding vehicle position etc. to the navigation system 1022 at this point.
20 E. Base Station Referring back to Fig. 7, the present invention includes GPS components at the base station 314 that are identical to those which comprise the GPS processing system 700 (as shown on Fig. The purpose of the base station 314 is to (1) monitor the operation of the vehicles, provide a known terrestrial reference location from which biases can be produced, and provide information to the vehicles when necessary, over a high-speed data transmission channel 618.
In a preferred embodiment of the present invention, the base station 314 will be located within close proximity to the vehicle 310, preferably within 20 miles.
This will provide for effective radio communication between the base station 314 and the vehicle 310 over the transmission channel 618. It will also provide an ~o o r e
D
oc DCC:TJII:TG:17680.SPC9 5 Apl 1995 accurate reference point for comparing satellite transmissions received by the vehicle 310 with those received by the base station 314.
A geographically proximate reference point is needed in order to compute accurate biases. Biases are, in effect, the common mode noise that exists inherently in the GPS system. Once computed at the base station 314, these biases are then sent to the vehicle 310 using the data-radios 714 (as shown in Fig. The biases are comouted using various methods which are discussed further below.
In a preferred embodiment of the present invention, a host processing system 402 is located at the base station 314 to coordinate the autonomous activities and interface the VPS system 1000 with human supervisors.
F. Satellite Based Accuracy Improvements The present invention improves the position determining accuracy of the vehicle positioning system 1000 capability through a number of differential techniques. These techniques are designed to remove errors (noise) from the pseudoranges that are calculated by the GPS receiver 706. The removal of this noise results in more precise position determination.
In a preferred embodiment, the base station 314 GPS processing system 700 is responsible for executing these differential techniques. The term "differential" is used because the base station 314 and the vehicle 310 use independent but virtually 20 identical GPS Systems 700. Because the base station 314 is stationary and its absolute position is known, it serves as a reference point from to measure electronic interference (noise) and other error inducing phenomena.
1. Constellation Effects Fig. 13 depicts a flowchart which shows the steps required to make the best use of the satellite constellations which are in view of the GPS antenna 702. For a given vehicle 310, there may be numerous satellites in view of which only a subset will form a particular constellation. The constellation effects flowchart 1300, describes how the optimal constellation can be chosen depending on the satellites currently in view, and the desired path that the vehicle 310 is taking.
The beginning of the constellation effects flowchart 1300 is shown at a block DCC:TJIt:TG:#1768.SPCp 5 Apd 199 -26 1302. The first step in the flowchart is shown at block 1304. The positions of each satellite in view of the GPS antenna 702 are computed using almanac data and GPS time. Almanac dat~. refers to previously recorded data which stores GPS satellites' positions at specific times during the day. Because the operators of the GPS sate!',Ies know the course and track across the sky that the satellites take, this information is available.
The positions of the satellites are represented by polar coordinates which correspond to azimuth and elevation from the base station 314. Once these satellite positions have been determined, the satellites are then mapped into a polar map with the estimated vehicle position in the center of the map. This polar map is illustrated in Fig. 14. As shown in Fig. 14, four satellites 200, 202, 204, and 206 are depicted.
As shown in the next block 1308, circles are drawn around each of the satellites so that the circles form an intersection at the center of the polar map as shown in Fig.
14. The error input position determination can be shown as the inner section of the circles, which resemble an ellipsoid.
An important parameter in the ellipsoid representation is the ratio between the semi-major and semi-minor access of the ellipsoid, called the geometric ratio of "access factor (GRAF). This factor is used along with the angle of the major access to compute a weighing factor, which in effect assists the GPS system 700 to compute a more accurate position. This is done by modifying the GPS Kalman filter 802 in the vehicle GPS processing system 700 to accommodate the shape of the estimated ellipsoid and the computed northing-easting coordinates of the vehicle, as shown at a block 1313 and Fig. 14.
As shown at a block 1312, these steps are taken with respect to all possible constellations in view of the GPS antenna 702. After all possible satellite constellations have been computed and plotted, the optimal satellite constellation for the desired vehicle path is determined as shown at a block 1312. The optimal constellation will be one that gives the least error perpendicular to the desired vehicle path as shown at a block 1312. As shown at a block 1314, the optimal satellite constellation data is transmitted to the vehicle 310 over the data radio 714.
DCC:TJII:TG:#17680.SPC 5 Aril 1995 27 2. Differential Correction Techniques a. Original Bias Technique Referring now to Fig. 15, an original bias flowchart 1500 is depicted. As shown at a block 1502, the original bias flowchart computation begins. As shown at a block 1504, the pseudorange (PSR) for each satellite in view of the GPS antenna 702 is computed. The pseudoranges are computed by the GPS receiver 706 located at the base station 314. The Lock 1504 also shows that the positions of each satellite (SV where SV indicates position, and indicates a particular satellite for which this data is being computed, is determined.
The satellite positions are determined independently of the pseudorange computations made by the GPS receiver 706. The satellite positions are determined by decoding the GPS time data which is encoded in the navigation signal transmitted from each satellite. This time of transmission is the time the satellite actually transmitted the navigation sequence which was received by the GPS receiver 706.
Because the path of the satellites is known and recorded in the almanac as described above, the position of the satellite can be determined by correlating the GPS transmission time with the almanac data. Thus, for time TI the polar coordinates of the satellite can be determined through a correlation table in the almanac.
20 After the steps in the block 1504 have been completed, the known base station 314 position is subtracted from each satellite position as shown in a block 1506. Because the position of the satellites and base station 314 are in polar coordinate form, a polar coordinate equation using the euclidian norm, which is well known in the art, must be used to make this subtraction. The actual equation subtracts the polar coordinates of the base station 314 from the polar coordinates of the satellite of which difference the euclidian norm is computed. The square root of the euclidian norm is then computed.
The steps shown in the block 1506 produce the actual range of the satellite from the GPS antenna 702 located on the base station 314. As shown in a block 1508, the pseudorange for each satellite (computed by the GPS receiver 706 using DCC:TJII:TG:#17680.SPC 5 April 1995 28the GPS time) and the satellite's clock bias are subtracted from the actual range determined in the block 1506. This step produces the actual bias (error) of the pseudorange computation made by the GPS receiver 706. This error is caused by many different effects, such as atmospheric conditions, receiver error, etc.
Because the vehicle 310 is in close proximity to the base station 314, the error in pseudorange computation is assumed to be identical. Therefore, the pseudorange error which has been determined as shown in the blocks 1504, 1506 and 1508 can be used to modify the position estimates produced by the vehicle 310 GPS processing system 700. Of course, this error calculation could not be made at the vehicle 310 GPS processing system 700, because the actual position of the vehicle is not known, whereas the actual position of the base station 314 is known.
As shown at a block 1510, the base station 314 GPS Kalman filter 802 is updated with the bias information. Finally, as shown as a block 1512, the base station 314 computed biases are transmitted to the vehicle 310 using the data radios 620 and 622.
The biases are then used by the vehicle 310 GPS processing system 700 to provide more accurate position determination by updating the vehicle 310 GPS Kalman filter 802.
b. Parabolic Bias Technique 20 As the GPS satellites rise and fall in the sky, the path formed by each satellite follows a parabola. Therefore, a parabolic function can be computed which represents the path of each satellite in the sky. Turning now to Fig. 16, part of the flowchart 1600 shown describes a method in which such a parabolic function (model) is computed for each satellite in the view of the base station 314 GPS antenna 702.
Referring now to Fig. 16, a block 1602 shows that the flowchart begins. As shown at a block 1604, at a time pseudoranges are determined for each satellite in view of the base station 314 GPS antenna 702, using the GPS receiver 706, as described above. As shown at a block 1606, the pseudoranges (for each satellite) are incorporated into parabolic best fit models for each satellite. Thus, one point on DCC:TJII:TG:#17680.SPC 5 April 1995 -29 the parabolic model for each satellite is added.
As shown at a block 1608, a test is made as to whether enough points on the parabolic model have been determined to estimate a parabolic function which the satellite would conform to along the rest of its path. The number of points that have been collected will determine a particular statistical R squared value. As shown at the block 1608, if this R squared value is greater than 0.98, then the parabolic model is deemed to be accurate enough to estimate the future path of the satellite. If the R squared value is less than or equal to 0.98, then more points on the parabolic model must be computed. These points are computed by incorporating the pseudorange data which is continually being computed by the GPS receiver 706.
As shown at a block 1610, the N value increments to show that the time at which the pseudorange is computed, as shown in the block 1604, has increased.
Because the GPS receiver 706 outputs pseudorange data for each satellite twice a second, each N increment should represent approximately one half second.
If enough data points have been collected such that the R squared value is greater than 0.98, then, as shown in a block 1612, the parabolic model is deemed accurate enough to represent each satellite's orbital path. As shown in the block 1612, the parabolic model represents points on the past and future satellite path.
Now that the parabolic model is complete, future points on the model can be 20 calculated as shown at a box 1614. As shown at the block 1614, for the time T(n) the locus point on the parabolic model is computed. Here the locus point is the expected location of the satellite at time Once this locus point is computed, the range for the locus point (distance between the GPS antenna 702 and the satellite) is computed, as shown at a block 1616 As shown at a block 1618, the pseudorange is then computed for time T(n+l) (the current time). The pseudorange is computed by the GPS receiver 706 as described elsewhere in this application. This pseudorange is also incorporated into the parabolic best fit model, as indicated at an arrow 1626. As shown at a block 1620, the pseudorange computed at time T(n+l) and the base station 314 clock bias are subtracted from the parabolic locus point range to get the bias. The bias data are DCC:TJII:TG:N17680.SPC 5 Ap'il 1995 30 then smoothed in accordance with methods well known in the art, as shown at a block 1622. This bias is then transmitted to the vehicle 310 using the data radio 714, as shown at a block 1624.
c. Base Residuals as Bias Technique Fig. 17 uses base residuals to compute the bias. A base residual is the difference in the actual polar coordinate position of the base station 314 and the position which is computed by the GPS processing system 700 on the base station 314. To illustrate how this functions, assume the base station 314 is at the corner of Elm and Maple streets. Also assume the base station 314 GPS processing system 700 estimates the position of the base station 314 to be four miles due south of the actual known position of the base station (the corner of Elm and Maple). Then it is obvious that the bias is a distance equal to four miles in a due south direction.
Because the GPS processing system 700 on the vehicle 310 is identical to the GPS processing system 700 on the base station 314, the four mile error in computation can be deemed to be occurring at the vehicle 310 as well as the base station 314. The vehicle 310 can then use this information in its GPS processor 710.
In effect, the GPS processor on the vehicle 310 will modify its position computations to account for a four mile due south error in the data. Thus, the position computed o. by the vehicle 310 GPS processor 710 will reflect a position which is four miles 20 north of the position computed by the vehicle 310 GPS processor 710 which used the pseudorange computed by the vehicle 310 GPS receiver 706.
Turning now to Pig. 17, a block 1704 shows that the exact polar coordinates xO, yO, zO of the base station must be obtained. The pseudoranges for the satellites which are in view of the GPS antenna 702 are then computed. If the GPS receiver 706 on the vehicle 310 is configured to read data from a particular constellation of satellites (not necessarily all which are in view), then the GPS receiver 706 at the base station 314 must also be configured to use the same constellatio,,.
The location of the base station 314 is then computed by the GPS processor 710 located at the base station 314. If there is a difference in this computed base station 314 location and the actual known base station 314 location, (such as the four DCC:TJII:TG:#17680.SPC 5 Aprl 1995 31 miles in the above example), then these differences, called residuals, as shown at a block 1710 represent the new biases for the vehicle 310. As shown at a block 1712, the residuals are then outputted to the vehicle 310 over the data radio 714 to be processed at the GPS processor 710.
G. Anti-Spoofing It is believed that the U.S. government (the operator of the GPS satellites) may at certain times introduce errors into the navigation data being transmitted from the GPS satellites by changing clock and ephemeris parameters. For example, during a national emergency such an action might take place. The government would still be able to use the GPS because the government uses a distinct type of pseudo randcom code transmission, called the P-code. Thus, the government could debilitate the C/A code and carrier transmissions, causing earth receivers to compute incorrect pseudoranges, and thus incorrect position determinations. The present invention includes methods to detect and compensate for such misleading data.
Turning now to Fig. 21, a flowchart of the anti-spoofing technique is depicted. The beginning of the flowchart is shown at a block 2102. At a block 2104 it is shown that the current position of satellites in view of the GPS antenna 702 is predicted by old almanac data. Old almanac data is data that has been previously recorded by the GPS receiver 706. The current position of the satellite 20 is also computed using the current ephemeris data being transmitted by the GPS satellites. At a block 2106, the predicted position (using the almanac) and the computed position (using the latest ephemeris) are compared. As is shown in the block 2106, the euclidian norm of the two parameters is computed and tested against a preset threshold. If this value is larger than the threshold, then the ephemeris data would appear to be corrupted and the latest valid almanac data will be used instead, as is shown at a block 2108. Because the latest valid almanac data will be older than the new ephemeris data, it is always the preference to use the latest ephemeris data.
The position of the base station 314 is then computed based on the good almanac data and the GPS time sent by the satellites. This good almanac data will DCCH:I:TG:#17680.SPC s5 April 1995 32 either consist of the latest valid almanac data in the case where the ephemeris data is corrupted, or the ephemeris data itself when the ephemeris data is not corrupted.
As shown at a block 2112, the computed base position is tested against expected values Because the location of the base station 314 is known, the accuracy of the computation using the almanac data is readily determined. If the accuracy is within an expected range, then the results are sent to the vehicle 310 as shown at a block 2116.
If the computed base station 314 is not within expected values, then clock time and/or biases at the base are manipulated so that the estimated base position is as expected, as is shown at a block 2114. These results are then sent to the vehicle as shown at the block 2116.
*II 1 *0 *O oe DCC!TJH:TG:#17680.SPC 5 Apil 1995
Claims (3)
1. A system for determining the position of a user using orbiting satellites of a global positioning system and a reference station, the system comprising: first means for computing respective first positions of the satellites in view of a reference antenna at the riference station using previous ephemeris data and responsively determining respective predicted estimated pseudoranges second means for computing respective second positions of the satellites in view of said reference antenna at the reference station using current ephemeris data and responsively determining respective current estimate pLudoranges third means responsive to said first and second means, said third means for receiving said respective predicted estimated pseudoranges and said respective current estimated pseudoranges comparing said predicted estimated pseudoranges (Oj) and said respective current estimated pseudoranges and 15 responsively determining if said current ephemeris data is corrupt; fourth means responsive to said third means, said fourth means for computing a spatial bias using said current ephemeris data if said current ephemeris data is not corrupt and computing a spatial bias using said previous ephemeris data S S if said current ephemeris data is corrupt; and fifth means located at the user, for receiving signals from said satellites and said spatial bias and responsively determining an estimate of the position of the user.
2. The system of claim 1, wherein said GPS processor comprises software said software implementing: a Kalman filter function; a communications manager function; an ICC function; a GPS raw data output function; a radio link data decoder function; a console function; and DCC:TJH:TG:# 1768G1.SI 31 July 1996 LI L
34- a VPS communications function. 3. A method for determining the position of a user using orbiting satellites of a global positioning system and reference station, the method comprising the steps of: computing respective predicted estimated pseudoranges of the satellites in view of a reference antenna at the reference station using previous ephemeris data; computing current estimated pseudoranges (Nj) of the satellites using current ephemeris data; comparing said predicted estimated pseudoranges and said current estimated pseudoranges and responsively determining if said ephemeris data is corrupt; computing a spatial bias using said current ephemeris data if said !ill current ephemeris data is not corrupt and computing a sptial bias using said S 15 previous ephemeris data if said current ephemeris data is corrupt; and receiving, at the user, signals from the satellites and said spatial bias and responsively determining an estimate of the position of the user. 4. The system as claimed in claim 1 substantially as hereinbefore described with reference to the accompanying fgures. 5. The method as claimed in claim 5 substantially as hereinbefore described with reference to the accompanying figures. DATED: 31 July 1996 CARTER SMITH BEADLE Patent Attorneys for the Applicant: CATERPILLAR INC. DCCTJH TG #17680 RSI 31 July 1996 ABSTRACT An anti-spoofing technique is disclosed whereby corrupted data from orbiting satellites in a global positioning system may be detected. The system comprises a first means (2104) for computing satellite positions in view of a reference antenna (702) by almanac data. The current position of the satellites is also computed by second means using ephemeris data transmitted from the satellites. At third means (2106) the predicted position (using the almanac) and the computed position (using the latest ephemeris) are compared against a threshold. If this value is larger than the threshold then the ephemeric data would appear to be corrupted and a fourth means (2108) adopts the latest almanac data instead. DCC:TJH:TG.176MS0.PC 5 April 1995
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
AU16364/95A AU672349B2 (en) | 1989-12-11 | 1995-04-06 | Integrated vehicle positioning and navigation system, apparatus and method |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
AU642638 | 1989-12-11 | ||
AU16364/95A AU672349B2 (en) | 1989-12-11 | 1995-04-06 | Integrated vehicle positioning and navigation system, apparatus and method |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
AU46043/93A Division AU666033B2 (en) | 1989-12-11 | 1993-09-02 | Integrated vehicle positioning and navigation system apparatus and method |
Publications (2)
Publication Number | Publication Date |
---|---|
AU1636495A AU1636495A (en) | 1995-06-22 |
AU672349B2 true AU672349B2 (en) | 1996-09-26 |
Family
ID=3706274
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
AU16364/95A Ceased AU672349B2 (en) | 1989-12-11 | 1995-04-06 | Integrated vehicle positioning and navigation system, apparatus and method |
Country Status (1)
Country | Link |
---|---|
AU (1) | AU672349B2 (en) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0522862A1 (en) * | 1991-07-10 | 1993-01-13 | Pioneer Electronic Corporation | GPS Navigation system with selective position offset correction |
WO1993012439A1 (en) * | 1991-12-16 | 1993-06-24 | Pinranger (Australia) Pty Limited | A distance measuring system |
EP0566390A1 (en) * | 1992-04-15 | 1993-10-20 | Sumitomo Electric Industries, Limited | Apparatus for detecting the position of a vehicle |
-
1995
- 1995-04-06 AU AU16364/95A patent/AU672349B2/en not_active Ceased
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0522862A1 (en) * | 1991-07-10 | 1993-01-13 | Pioneer Electronic Corporation | GPS Navigation system with selective position offset correction |
WO1993012439A1 (en) * | 1991-12-16 | 1993-06-24 | Pinranger (Australia) Pty Limited | A distance measuring system |
EP0566390A1 (en) * | 1992-04-15 | 1993-10-20 | Sumitomo Electric Industries, Limited | Apparatus for detecting the position of a vehicle |
Also Published As
Publication number | Publication date |
---|---|
AU1636495A (en) | 1995-06-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP0604404B1 (en) | Integrated vehicle positioning and navigation system, apparatus and method | |
US5680313A (en) | System and method for detecting obstacles in a road | |
US5452211A (en) | Method and system for determining vehicle position | |
US5610815A (en) | Integrated vehicle positioning and navigation system, apparatus and method | |
US5442558A (en) | Method and system for determining vehicle position based on a projected position of a satellite | |
AU697799B2 (en) | Precision navigation system | |
AU672349B2 (en) | Integrated vehicle positioning and navigation system, apparatus and method | |
AU672348B2 (en) | Integrated vehicle positioning and navigation system, apparatus and method | |
AU672347B2 (en) | Integrated vehicle positioning and navigation system, apparatus and method | |
AU666033B2 (en) | Integrated vehicle positioning and navigation system apparatus and method | |
AU651769B2 (en) | Integrated vehicle positioning and navigation system, apparatus and method | |
AU736792B2 (en) | Apparatus and method for surface based vehicle control system | |
Henzler et al. | Using pseudolites as a flightlanding system | |
AU687634B2 (en) | Integrated vehicle positioning and navigation system, apparatus and method | |
Lachapelle et al. | Navigation user requirements and emerging technologies for the Canadian transportation sector |