DE102008026746A1 - Vehicle i.e. aircraft, navigating method, involves repeatedly consolidating measured absolute positions and determined current position, storing results of integration and consolidating stored result of integration - Google Patents
Vehicle i.e. aircraft, navigating method, involves repeatedly consolidating measured absolute positions and determined current position, storing results of integration and consolidating stored result of integration Download PDFInfo
- Publication number
- DE102008026746A1 DE102008026746A1 DE102008026746A DE102008026746A DE102008026746A1 DE 102008026746 A1 DE102008026746 A1 DE 102008026746A1 DE 102008026746 A DE102008026746 A DE 102008026746A DE 102008026746 A DE102008026746 A DE 102008026746A DE 102008026746 A1 DE102008026746 A1 DE 102008026746A1
- Authority
- DE
- Germany
- Prior art keywords
- vehicle
- integration
- measured
- time
- accelerations
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- 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
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Navigation (AREA)
Abstract
Description
Die Erfindung betrifft ein Verfahren zur Navigation eines Fahrzeuges.The The invention relates to a method for navigating a vehicle.
Als Fahrzeug im Sinne der Erfindung werden vorzugsweise Luft- oder Raumfahrzeuge verstanden. Die Erfindung kann jedoch auch auf anders geartete Fahrzeuge, beispielsweise Landfahrzeuge oder Wasserfahrzeuge Anwendung finden.When Vehicle according to the invention are preferably aircraft or spacecraft Understood. However, the invention may also apply to other types of vehicles, For example, land vehicles or watercraft application.
Bei der Navigation von Luft- und Raumfahrzeugen ist es bekannt, inertiale Messeeinheiten (IMU) mit GPS oder anderen Sensoren zu koppeln. Die inertiale Messeinheit erfasst hierbei Beschleunigungen und/oder Drehraten des Fahrzeuges, die anschließend numerisch integriert werden. Mit bekanntem Anfangszustand, nämlich bei bekannter Position, Geschwindigkeit und Lage des Fahrzeuges, kann über die Integration der Messwerte der inertialen Messeinheit, die Position, Geschwindigkeit und Lage für die folgenden Zeitpunkte bestimmt werden. Das berechnete Ergebnis divergiert mit der Zeit von der korrekten Lösung weil stochastische und systematische Fehler aufintegriert werden. Zur Korrektur der berechneten Werte werden daher weitere Sensoren, wie beispielsweise das Global Positioning System (GPS) verwendet. Hierzu wird in regelmäßigen Abständen eine GPS-Messung durchgeführt. Der durch die Integration der durch die inertiale Messeinheit gemessenen Größen bestimmte Wert wird durch den Wert, der über das GPS gemessen wurde, korrigiert. Dies wird üblicherweise mit einem Kalman-Filter-Algorithmus durchgeführt.at The navigation of aircraft and spacecraft is known to be inertial Coupling of measurement units (IMU) with GPS or other sensors. The inertial measuring unit detects accelerations and / or rotation rates of the vehicle, which subsequently numerically integrated. With known initial state, namely at known position, speed and position of the vehicle, can over the Integration of the measured values of the inertial measuring unit, the position, Speed and location for the following times are determined. The calculated result diverges over time from the correct solution because stochastic and systematic errors are integrated. To correct the calculated Values therefore become more sensors, such as the Global Positioning System (GPS) used. For this purpose, a regular GPS measurement performed. The measured by the integration of the inertial measuring unit Certain sizes Value is determined by the value over the GPS was measured, corrected. This is usually done with a Kalman filter algorithm.
Nachteilig hierbei ist, dass vom Zeitpunkt der Messung, beispielsweise des GPS, bis zu dem Zeitpunkt, an dem der Messwert dem Korrektur-Algorithmus zur Verfügung steht, eine Verzögerungszeit entsteht. Während dieser Zeit fallen weitere Messwerte der inertialen Messeinheit an, die weiter integriert werden. Somit entspricht das Ergebnis der Integration der Messwerte der inertialen Messeinheit einem anderem Zeitpunkt, als dem der Korrekturmessung, zum Beispiel durch GPS: das Ergebnis der Integration der IMU-Messwerte entspricht einem späterem Zeitpunkt, als das der Korrekturmessung durch das GPS.adversely Here is that from the time of measurement, for example, the GPS, until the time the reading reaches the correction algorithm to disposal stands, a delay time arises. While During this time, further measured values of the inertial measuring unit fall which will be further integrated. Thus, the result corresponds the integration of the measured values of the inertial measuring unit to another Time, as that of the correction measurement, for example by GPS: the result of the integration of the IMU measured values corresponds to one later Time, than that of the correction measurement by the GPS.
In
Es ist aus dem Stand der Technik bekannt, den Fehler durch die Verzögerungszeit durch mathematische Methoden zu kompensieren. Eine Möglichkeit hierzu ist die Extrapolation der Position um die Verzögerungszeit mit Hilfe der aktuellen Geschwindigkeit. Dieser Ansatz bietet jedoch nur dann eine Verbesserung, wenn sich die Geschwindigkeit nur wenig ändert. Bei großen Beschleunigungen, wie sie beispielsweise bei hochdynamischen Systemen auftreten, würde dennoch ein großer Fehler auftreten.It is known from the prior art, the error by the delay time to compensate by mathematical methods. A possibility this is the extrapolation of the position by the delay time using the current speed. However, this approach offers only an improvement if the speed changes only slightly. at huge Accelerations, as for example in highly dynamic systems would occur nevertheless a big one Errors occur.
Aufgabe der Erfindung ist es, ein Verfahren zur Navigation eines Fahrzeuges zu schaffen, das die Genauigkeit der Navigation verbessert.task The invention is a method for navigation of a vehicle to create that improves the accuracy of navigation.
Im erfindungsgemäßen Verfahren erfolgt zunächst ein sich wiederholendes Messen der absoluten Position des Fahrzeuges durch eine Positionsbestimmungsvorrichtung in einem ersten Zeitabstand. Bei der Positionsbestimmungsvorrichtung kann es sich beispielsweise um eine GPS-Einheit handeln. Unter einem Messen der absoluten Position des Fahrzeuges wird im Sinne der Erfindung verstanden, dass die tatsächliche Position des Fahrzeuges, zum Beispiel durch einen Sensor, wie ein GPS erfasst wird. Es findet somit ein direktes Erfassen, nämlich ein Messen der tatsächlichen Position des Fahrzeuges statt. Die Genauigkeit des gemessenen Wertes für die absolute Position des Fahrzeuges hängt vorzugsweise lediglich von der Genauigkeit der verwendeten Positionsbestimmungsvorrichtung ab. Das Messen der absoluten Positionen des Fahrzeuges durch die Positionsbestimmungsvorrichtung kann beispielsweise mit einer Frequenz von 10 Hz erfolgen. Andere Frequenzen sind ebenfalls möglich.in the inventive method takes place first a repetitive measurement of the absolute position of the vehicle by a position determining device at a first time interval. The position determining device may be, for example to a GPS unit act. Taking a measurement of the absolute position of the vehicle For the purposes of the invention, it is understood that the actual Position of the vehicle, for example by a sensor, such as a GPS is detected. It thus finds a direct detection, namely a Measuring the actual Position of the vehicle instead. The accuracy of the measured value for the absolute position of the vehicle preferably depends only on the accuracy of the position-determining device used from. Measuring the absolute positions of the vehicle by the Positioning device, for example, with a frequency of 10 Hz. Other frequencies are also possible.
Erfindungsgemäß erfolgt weiterhin ein sich wiederholendes Messen von Beschleunigungen des Fahrzeuges durch eine inertiale Messeinheit in einem zweiten Zeitabstand. Der erste Zeitabstand ist größer als der zweite Zeitabstand. Beispielsweise können die Beschleunigungen des Fahrzeuges mit einer Frequenz von 1000 Hz durch die inertiale Messeinheit gemessen werden. Andere Frequenzen sind ebenfalls möglich.According to the invention furthermore a repetitive measurement of accelerations of the Vehicle through an inertial measuring unit in a second time interval. The first time interval is greater than the second time interval. For example, the accelerations of the Vehicle with a frequency of 1000 Hz through the inertial measuring unit be measured. Other frequencies are also possible.
Die gemessenen Beschleunigungen des Fahrzeuges werden zur Ermittlung einer aktuellen Position des Fahrzeuges zwischen den Positionen, die durch die Positionsbestimmungsvorrichtung gemessen wurden, numerisch integriert. Hierdurch ist es möglich, die Zwischenräume, zwischen den beispielsweise zehn Messungen, durch die Positionsbestimmungsvorrichtung pro Sekunde mit errechneten Werten für die aktuelle Position des Fahrzeuges zu füllen.The Measured accelerations of the vehicle become the determination a current position of the vehicle between positions, measured by the position determining device, numerically integrated. This makes it possible the gaps, between the ten measurements, for example, by the position determining device per second with calculated values for the current position of the Vehicle to fill.
Zur Korrektur der durch die Integration der Beschleunigungen ermittelten aktuellen Positionen des Fahrzeuges, findet ein sich wiederholendes Fusionieren der über die Integration berechneten aktuellen Positionen des Fahrzeuges mit den gemessenen absoluten Positionen des Fahrzeuges, die durch die Positionsbestimmungsvorrichtung gemessen werden, statt. Hierdurch können stochastische und/oder systematische Fehler bei der Navigation ausgeglichen werden.to Correction of the determined by the integration of the accelerations current positions of the vehicle, finds a repetitive merging the over the integration calculated current positions of the vehicle with the measured absolute positions of the vehicle passing through the position determining device are measured instead. hereby can balanced stochastic and / or systematic navigation errors become.
Erfindungsgemäß erfolgt ein Speichern des Ergebnisses der Integration der gemessenen Beschleunigungen zum Zeitpunkt des Messens der absoluten Position des Fahrzeuges durch die Positionsbestimmungsvorrichtung. Beispielsweise kann ein Triggersignal zum Zeitpunkt des Messens oder zum Beginn der Messung der absoluten Position des Fahrzeuges ausgegeben werden. Durch das Triggersignal kann das Messen der absoluten Position des Fahrzeuges ausgelöst werden. Alternativ kann das Triggersignal von der Positionsbestimmungsvorrichtung zum Zeitpunkt des Messens ausgebeben werden. Bei Ausgabe dieses Triggersignals erfolgt vorzugsweise das Speichern des Ergebnisses der Integration der gemessenen Beschleunigungen.According to the invention storing the result of the integration of the measured accelerations at the time of measuring the absolute position of the vehicle by the position determination device. For example, a Trigger signal at the time of measurement or to start measuring the absolute position of the vehicle are issued. Through the trigger signal the measurement of the absolute position of the vehicle can be triggered. Alternatively, the trigger signal from the position determining device at the time of measuring. When this issue Trigger signal is preferably carried out storing the result the integration of the measured accelerations.
Das gespeicherte Ergebnis der Integration wird erfindungsgemäß mit der durch die Positionsbestimmungsvorrichtung gemessenen absoluten Position des Fahrzeuges fusioniert. Der Wert für die absolute Position des Fahrzeuges, der durch die Positionsbestimmungsvorrichtung gemessen wird, wird somit erfindungsgemäß mit einem nicht-aktuellen, gespeicherten Ergebnis der Integration fusioniert, das vorzugsweise dem Zeitpunkt entspricht, in dem die Messung der absoluten Position des Fahrzeuges durch die Positionsbestimmungsvorrichtung angestoßen bzw. durchgeführt wurde. Der Zustand zum Zeitpunkt der Durchführung der Messung der absoluten Position oder des genannten Triggersignals kann mit dem dazugehörenden Messwert der Positionsbestimmungsvorrichtung korrigiert werden, sobald dieser vorliegt. Hierdurch ist es möglich, den aktuellen Zustand des Fahrzeuges ohne die Fehler, die durch eine Verzögerung der Korrektur hervorgerufen werden, zu ermitteln.The stored result of the integration is inventively with the absolute position measured by the position determining device of the vehicle merged. The value for the absolute position of the Vehicle measured by the position determining device is thus, according to the invention with a non-current, stored result of integration merged, which preferably corresponds to the time at which the measurement of absolute position of the vehicle by the position determining device initiated or performed has been. The state at the time of performing the measurement of the absolute Position or the said trigger signal can with the associated measured value of the Positioning device to be corrected as soon as this is present. This makes it possible the current state of the vehicle without the errors caused by a delay the correction caused to be determined.
Vorzugsweise erfolgt das Fusionieren des gespeicherten Ergebnisses der Integration mit der gemessenen absoluten Position des Fahrzeuges zeitversetzt zur Messung der absoluten Position des Fahrzeuges. Weiterhin können zwischen dem Speichern des Ergebnisses der Integration und seinem Fusionieren mit der absoluten Position des Fahrzeuges die gemessenen Beschleunigungen des Fahrzeuges weiter integriert werden. Sobald der Messwert der Positionsbestimmungsvorrichtung für die tatsächliche absolute Position des Fahrzeuges vorliegt und der gespeicherte Wert, der durch die Integration berechnet wurde, durch den Korrekturwert korrigiert wurde, kann das Ergebnis der in der Zwischenzeit erfolgten Integration rückwirkend auf den Wert für die korrigierte Position des Fahrzeuges aufaddiert werden.Preferably the merging of the stored result of the integration takes place delayed with the measured absolute position of the vehicle for measuring the absolute position of the vehicle. Furthermore, between storing the result of the integration and its merging with the absolute position of the vehicle the measured accelerations of the vehicle are further integrated. As soon as the reading of the Position determining device for the actual absolute position of the vehicle and the stored value calculated by the integration was corrected by the correction value, the result can be the integration that has taken place in the meantime retroactively to the value for the corrected Position of the vehicle are added up.
Vorzugsweise ergibt die Integration der gemessenen Beschleunigungen zwischen dem Zeitpunkt des Speicherns des Ergebnisses der Integration und dem Zeitpunkt der Fusion dieses Ergebnisses mit der absoluten Position des Fahrzeuges eine Differenz der Position des Fahrzeuges zwischen den genannten Zeitpunkten. Diese Differenz wird auf den korrigierten Positionswert des Fahrzeuges aufaddiert.Preferably gives the integration of the measured accelerations between the time of saving the result of the integration and the date of the merger of this result with the absolute position of the vehicle, a difference in the position of the vehicle between the mentioned times. This difference is corrected to the Position value of the vehicle added up.
Vorzugsweise erfolgt ein Abspalten der verwendeten Navigationsgleichungen in einen konstanten, von der Positionsbestimmungsvorrichtung zu korrigierenden Anteil und einen Anteil zu Integration der gemessenen Beschleunigungen, wobei eine Integration relativ zum Zustand zum Zeitpunkt des Messens oder bei Ausgabe des Triggersignals zum Messen der absoluten Position des Fahrzeuges erfolgt. Durch die genannten Verfahrensschritte kann eine genaue Synchronisation der gemessenen Daten erreicht werden. Mit dieser Synchronisation wird es ermöglicht, dass die Zustände durch den Messwert der Positionsbestimmungsvorrichtung zu dem Zeitpunkt korrigiert werden, an dem dieser Messwert vorliegt. Es findet somit eine zeitverzögerte Korrektur von zum Triggerzeitpunkt gültigen Zuständen mit Messwerten statt, wobei die Korrektur zu einem späteren Zeitpunkt erfolgt. Besonders vorteilhaft ist es, dass der Anteil der Navigationsgleichungen, der die Integration der Zustände relativ zum Triggerzeitpunkt enthält, weniger mathematische Operationen erfordert, und deshalb schneller und einfacher ausgeführt werden kann, als die Integration der vollen Bewegungsgleichungen.Preferably a separation of the used navigation equations takes place in a constant, to be corrected by the position determining device Proportion and proportion to integration of the measured accelerations, wherein an integration relative to the state at the time of measuring or when the trigger signal is output to measure the absolute position of the vehicle takes place. By the mentioned method steps can an exact synchronization of the measured data can be achieved. With this synchronization, it allows the states through the measured value of the position determining device at the time be corrected, where this measured value is present. It thus finds a time-delayed Correction of states valid at trigger time with measured values instead, the correction being at a later date he follows. It is particularly advantageous that the proportion of navigation equations, the integration of the states relative to the trigger time, less mathematical operations requires, and therefore faster and easier to run can, as the integration of the full equations of motion.
Vorzugsweise wird der korrigierte Wert für die aktuelle Position des Fahrzeuges als Ausgangswert für die Ermittlung der folgenden aktuellen Positionen des Fahrzeuges durch die Integration der gemessenen Beschleunigungen verwendet.Preferably will be the corrected value for the current position of the vehicle as the initial value for the determination the following current positions of the vehicle through the integration used the measured accelerations.
Durch die inertiale Messeinheit können neben Beschleunigungen auch Drehraten des Fahrzeuges ermittelt werden. Die gemessenen Drehraten des Fahrzeuges werden vorzugsweise zur Bestimmung seiner aktuellen Lage integriert. Über die Verknüpfung von Bahn und Lage ist eine Korrektur der Lage durch mehrere aufeinanderfolgende GPS-Messungen möglich, wenn sich während dieser Messungen die Lage ändert und eine messbare Beschleunigung vorliegt.By the inertial measuring unit can In addition to accelerations and yaw rates of the vehicle can be determined. The measured rotation rates of the vehicle are preferably for Determination of its current situation integrated. About the link of Track and location is a correction of the situation by several consecutive GPS measurements possible, when during these measurements changes the situation and there is a measurable acceleration.
Zur Bestimmung der aktuellen Position des Fahrzeuges erfolgt vorzugsweise eine Integration seiner Geschwindigkeit.to Determining the current position of the vehicle is preferably carried out an integration of his speed.
Vorzugsweise erfolgt zwischen dem Zeitpunkt des Messens der absoluten Position des Fahrzeuges und der Fusion dieses Wertes mit der durch Integration ermittelten aktuellen Position des Fahrzeuges ausschließlich eine Integration sich zeitlich ändernder Größen.Preferably occurs between the time of measuring the absolute position of the vehicle and the merger of that value with that through integration Determined current position of the vehicle exclusively one Integration is changing over time Sizes.
Im Folgenden werden bevorzugte Ausführungsformen der Erfindung anhand von Figuren erläutert.in the The following are preferred embodiments the invention explained with reference to figures.
Es zeigen:It demonstrate:
Die Navigationsgleichungen für gekoppelte Inertialsysteme können in verschiedenen Koordinatensystemen beschrieben werden. Die im hier beschriebenen Verfahren verwendete Beschreibung basiert auf dem Geozentrischen Inertialen Koordinatensystem (Earth Centered Inertial Frame). Die Gleichungen lauten dann: The navigation equations for coupled inertial systems can be described in different coordinate systems. The description used in the method described here is based on the Geocentric Inertial Coordinate System (Earth Centered Inertial Frame). The equations are then:
Dabei
sind ν i, r i,
Die Integration der Gleichungen kann in folgender Weise geschrieben werden. Die Zustände zum Zeitpunkt tc ergeben sich zu: mitals Quaterniondarstellung der Drehraten und ⊙ als Operator der Quaternionen-Multiplikation.The integration of the equations can be written in the following way. The states at time t c result in: With as a quaternion representation of the rotation rates and ⊙ as an operator of the quaternion multiplication.
Die vorgeschlagene Methode legt zum oben beschriebenen Triggerzeitpunkt ein neues Koordinatensystem fest, das als t0-Koordinatensystem bezeichnet wird und welches durch die aktuelle Position und Lage zum Triggerzeitpunkt beschrieben wird. D. h. die Transformation vom ECI-Koordinatensystem in dieses t0-Koordinatensystem ist festgelegt. Diese Koordinatensystem ist auch ein inertiales Koordinatensystem, so dass die Bewegungsgleichungen lediglich transformiert werden müssen, ohne zusätzliche Terme durch Scheinbeschleunigungen zu erhalten, die bei Bewegungsgleichungen in nicht inertialen Koordinatensystemen auftreten.The proposed method sets to the trigger time described above a new coordinate system called t0 coordinate system is and which by the current position and location at the trigger time is described. Ie. the transformation from the ECI coordinate system in this t0 coordinate system is set. This coordinate system is also an inertial coordinate system, so the equations of motion merely need to be transformed without additional To obtain terms by apparent accelerations, which in equations of motion occur in non-inertial coordinate systems.
Mit
der Einführung
des t0-Koordinatensystems kann für
die Zustände
zum Zeitpunkt tc geschrieben werden:
Dabei
sind ν i(t0), r i(t0),
Eingesetzt in die Gleichungen für Position und Geschwindigkeit erhält man: und Substituted in the equations for position and speed you get: and
Unter
den folgenden Annahmen können
die jeweils letzten Terme evaluiert werden:
Das Fahrzeug bewegt
sich mit maximal 10 km/s.Under the following assumptions the last terms can be evaluated:
The vehicle moves with a maximum of 10 km / s.
Der Zeitschritt zwischen t0 und tc ist nicht größer als 1 Sekunde.Of the Time step between t0 and tc is not greater than 1 second.
Der Gravitationsgradient ist auf Höhe der Erdoberfläche maximal. Mit diesen Annahmen kann für die jeweils im letzten Term enthaltenen Größen folgendes abgeschätzt werden: The gravitational gradient is maximal at the height of the earth's surface. With these assumptions, the following can be estimated for the variables contained in the last term:
Diese ergeben dann folgende Größen: These then give the following sizes:
Diese Terme können vernachlässigt werden, wenn diese Werte unter der angestrebten Genauigkeit für die Navigation liegen. Dann erhält man für die Berechnung der Änderung von Geschwindigkeit und Position gegenüber dem Triggerzeitpunkt folgende Gleichungen: These terms can be neglected if these values are below the target accuracy for navigation. Then one obtains the following equations for the calculation of the change of velocity and position with respect to the trigger time:
Ist eine Vernachlässigung der Terme in Gleichung (4) nicht möglich, so muss in diese Terme die Gleichung für Δr i(tc) eingesetzt werden. Damit erhält man Folgendes: Is a neglect of the terms in equation (4) is not possible, in these terms, the equation for Δ r i must (t c) can be used. This gives you the following:
Dabei können die Terme mit Quadraten von G(r i(t0)) vernachlässigt werden.In this case, the terms with squares of G ( r i (t 0 )) can be neglected.
Die Größe dieser Terme ist mit den oben getroffenen Annahmen: The size of these terms is with the assumptions made above:
Der durch die Vernachlässigung entstandene Fehler liegt somit für die meisten Anwendungen weit unter der mit dem Navigationssystem erreichbaren Genauigkeit. Damit erhält man für die Berechnung der Änderung von Geschwindigkeit und Position folgende Gleichungen: The error caused by the neglect is thus for most applications far below the achievable with the navigation system accuracy. This gives the following equations for calculating the change of velocity and position:
Zum Nachweis der Genauigkeit der Näherung der Navigationsgleichungen werden die Ergebnisse der Gleichung (1) mit denen der Näherungslösungen aus Gleichung (5) und (6) verglichen. Dabei wird für die Integration der Lage die Gleichung (2) verwendet, die eine exakte Lösung darstellt.To the Proof of the accuracy of the approximation the navigation equations become the results of equation (1) with those of the approximate solutions out Equations (5) and (6) compared. It is for the integration of the situation uses equation (2), which is an exact solution.
Im
folgenden Beispiel werden die Messwerte der IMU mit einer Frequenz
von 1000 Hz aufgenommen und integriert. Mit einer Frequenz von 10
Hz wird ein neuer Triggerzeitpunkt t0 gesetzt. Zu diesem Zeitpunkt werden
die Gleichungen (5) und (6) gelöst
und die Zustände ν i, r i,
Die
in den Abbildungen dargestellten Ergebnisse müssen mit den Leistungen eines
modernen Inertialen Navigationssystems z. B. der Honeywell H764G
(Embedded GPS INS) verglichen werden. Die INS-Lösung der EGI hat nach einer
Stunde einen Fehler in der Geschwindigkeit von 0,76 m/s und in der
Position von 3500 m. Dabei kann angenommen werden, dass sich der
Geschwindigkeitsfehler linear entwickelt. Dann würde nach 100 s ein Fehler von
0,211 m/s auftreten. Verglichen mit den in den
Zum
Vergleich sind in den
Damit konnte nachgewiesen werden, dass durch die Einführung des Algorithmus keine zusätzlichen Fehler entstehen. Mit dem Algorithmus können aber die Fehler aufgrund der Verarbeitung verzögerter Messwerte im Kalman-Filter wie bereits gezeigt deutlich reduziert werden.In order to could be proved that by the introduction of the algorithm no additional error arise. With the algorithm you can but the errors due to the processing of delayed readings in the Kalman filter as already be shown significantly reduced.
Generell ist das erfindungsgegmäße Verfahren übertragbar auf alle Zustandsbestimmungssysteme von dynamischen Systemen, bei denen Messwerte verschiedener Sensoren zusammengeführt werden müssen, die zum einen Teil als Systeminputs und zum anderen Teil als Systemoutputs behandelt werden. Dies ist dann möglich, wenn ebenfalls eine Aufspaltung der Zustandsgleichungen für die Veränderung der Zustände, beispielsweise nach einem Triggerzeitpunkt gefunden werden können.In general, the method according to the invention can be applied to all condition determination systems of dynamic systems in which measured values of various sensors must be brought together, which are treated as system inputs and partly as system outputs. This is possible if a splitting of the state equations for the change of the states, For example, after a trigger time can be found.
Claims (15)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102008026746A DE102008026746A1 (en) | 2008-06-04 | 2008-06-04 | Vehicle i.e. aircraft, navigating method, involves repeatedly consolidating measured absolute positions and determined current position, storing results of integration and consolidating stored result of integration |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102008026746A DE102008026746A1 (en) | 2008-06-04 | 2008-06-04 | Vehicle i.e. aircraft, navigating method, involves repeatedly consolidating measured absolute positions and determined current position, storing results of integration and consolidating stored result of integration |
Publications (1)
Publication Number | Publication Date |
---|---|
DE102008026746A1 true DE102008026746A1 (en) | 2009-12-10 |
Family
ID=41268717
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
DE102008026746A Ceased DE102008026746A1 (en) | 2008-06-04 | 2008-06-04 | Vehicle i.e. aircraft, navigating method, involves repeatedly consolidating measured absolute positions and determined current position, storing results of integration and consolidating stored result of integration |
Country Status (1)
Country | Link |
---|---|
DE (1) | DE102008026746A1 (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102016209805A1 (en) * | 2016-06-03 | 2017-12-07 | Siemens Aktiengesellschaft | Method and position determination unit for determining a current position of a receiver |
EP3287811A4 (en) * | 2015-04-23 | 2018-12-26 | Unicore Communications. Inc | Method and device for gnss point positioning |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19651543C1 (en) * | 1996-12-11 | 1998-07-09 | Litef Gmbh | Inertial course / position reference with GPS course / position angle support |
EP0875731A2 (en) * | 1997-05-02 | 1998-11-04 | Pioneer Electronic Corporation | Navigation apparatus |
US6721657B2 (en) * | 2001-06-04 | 2004-04-13 | Novatel, Inc. | Inertial GPS navigation system |
US20070118286A1 (en) * | 2005-11-23 | 2007-05-24 | The Boeing Company | Ultra-tightly coupled GPS and inertial navigation system for agile platforms |
-
2008
- 2008-06-04 DE DE102008026746A patent/DE102008026746A1/en not_active Ceased
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19651543C1 (en) * | 1996-12-11 | 1998-07-09 | Litef Gmbh | Inertial course / position reference with GPS course / position angle support |
EP0875731A2 (en) * | 1997-05-02 | 1998-11-04 | Pioneer Electronic Corporation | Navigation apparatus |
US6721657B2 (en) * | 2001-06-04 | 2004-04-13 | Novatel, Inc. | Inertial GPS navigation system |
US20070118286A1 (en) * | 2005-11-23 | 2007-05-24 | The Boeing Company | Ultra-tightly coupled GPS and inertial navigation system for agile platforms |
Non-Patent Citations (1)
Title |
---|
Weidong Ding et al.: "Time Synchronization Error and Calibration in Integrated GPS/INS Systems". ETRI Journal 30, pp. 59-67 (Feb. 2008) * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3287811A4 (en) * | 2015-04-23 | 2018-12-26 | Unicore Communications. Inc | Method and device for gnss point positioning |
DE102016209805A1 (en) * | 2016-06-03 | 2017-12-07 | Siemens Aktiengesellschaft | Method and position determination unit for determining a current position of a receiver |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
DE69107586T2 (en) | Device for correcting drift errors of a yaw rate sensor. | |
DE102006029148B4 (en) | Method for checking an inertial measuring unit of vehicles, in particular of aircraft, in the stationary state | |
DE60017569T2 (en) | VIBRATION COMPENSATION FOR SENSORS | |
EP2755876B1 (en) | Method for estimating tire parameters for a vehicle | |
DE102013201014A1 (en) | Method and device for height determination | |
DE102014211166A1 (en) | Method, fusion filter and system for fusion of sensor signals with different temporal signal output distortions to a fusion data set | |
DE102012216215A1 (en) | Time-corrected sensor system | |
DE10312154B4 (en) | Method and apparatus for performing object tracking | |
DE102014211176A1 (en) | Method and system for correcting measurement data and / or navigation data of a sensor-based system | |
EP2936205A2 (en) | Method for providing a gnss signal | |
DE102014212703A1 (en) | M2XPro monitoring by integrity measure storage | |
DE69117896T2 (en) | Method and device for improving the reliability of aircraft flight data | |
DE102008041451A1 (en) | Navigation system for vehicle, has evaluation device for combining actual calibration value and actual dispersion value with calibration value stored in storage device and associated stored dispersion value | |
DE102014211178A1 (en) | Method and system for correcting measurement data of a first sensor system | |
EP3155380A1 (en) | Method and system for providing dynamic error values of dynamic measured values in real time | |
DE102014211172A1 (en) | Method and system for correcting output data of a sensor-based system | |
EP2678207B1 (en) | Method and device for determining the inclined position of a vehicle | |
DE60100168T2 (en) | Procedure for aligning an inertial measurement unit in the presence of unknown aircraft measurement delays | |
DE102013218043B4 (en) | Method for providing relative measurement data for a fusion sensor | |
DE102008026746A1 (en) | Vehicle i.e. aircraft, navigating method, involves repeatedly consolidating measured absolute positions and determined current position, storing results of integration and consolidating stored result of integration | |
DE19651543C1 (en) | Inertial course / position reference with GPS course / position angle support | |
DE102011054379B4 (en) | Method and device for determining position information | |
DE112018003550T5 (en) | AZIMUT ESTIMATE DEVICE | |
DE102015007518A1 (en) | Method for predicting a position of a vehicle | |
WO2022179794A1 (en) | Method for determining at least one system state by means of a kalman filter |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
OP8 | Request for examination as to paragraph 44 patent law | ||
8131 | Rejection |