DE102010050804B4 - Durch GPS verbesserte Fahrzeuggeschwindigkeitsschätzung - Google Patents
Durch GPS verbesserte Fahrzeuggeschwindigkeitsschätzung Download PDFInfo
- Publication number
- DE102010050804B4 DE102010050804B4 DE102010050804.7A DE102010050804A DE102010050804B4 DE 102010050804 B4 DE102010050804 B4 DE 102010050804B4 DE 102010050804 A DE102010050804 A DE 102010050804A DE 102010050804 B4 DE102010050804 B4 DE 102010050804B4
- Authority
- DE
- Germany
- Prior art keywords
- vehicle
- time stamp
- longitudinal
- gps
- velocity
- 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.)
- Active
Links
Images
Classifications
-
- 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/52—Determining velocity
-
- 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
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)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
- Gyroscopes (AREA)
Abstract
Verfahren zum Schätzen der Fahrzeuggeschwindigkeit für ein Fahrzeug unter Verwendung eines globalen Positionsbestimmungssystems (GPS) (12) einer einzelnen Antenne, wobei das Verfahren die Schritte umfasst, dass:
eine Absolutgeschwindigkeit und ein Kursfahrtrichtungswinkel des Fahrzeugs unter Verwendung des GPS (12) einer einzelnen Antenne gemessen werden;
Gierraten des Fahrzeugs unabhängig von dem GPS (12) gemessen werden;
eine integrierte Gierrate des Fahrzeugs als Funktion der gemessenen Gierraten über einer Zeitperiode berechnet wird;
ein Gierwinkel als Funktion eines initialisierten Gierwinkels und der integrierten Gierrate ermittelt wird;
ein Seitenschlupfwinkel als Funktion des Gierwinkels und des Kursfahrtrichtungswinkels, der durch das GPS (12) bereitgestellt wird, berechnet wird;
die Fahrzeuggeschwindigkeit als Funktion der Absolutgeschwindigkeit und des Seitenschlupfwinkels ermittelt wird; und
die Fahrzeuggeschwindigkeit für eine Fahrzeugdynamiksteueranwendung bereitgestellt wird,
wobei das Verfahren ferner die Schritte umfasst, dass:
eine Verzögerung der GPS-Messungen als Ergebnis der Verarbeitungszeit eines empfangenen GPS-Signals ermittelt wird;
Sensormessungen gepuffert werden, die durch Fahrzeugsensoren (14) bereitgestellt werden;
den Sensormessungen ein Zeitstempel zugeordnet wird;
eine diskrete Fahrzeuggeschwindigkeit für jeden Zeitstempel über der Periode der Verzögerung ermittelt wird, wobei jede diskrete Fahrzeuggeschwindigkeit als Funktion der berechneten Fahrzeuggeschwindigkeit und der gepufferten Sensormessungen bei jedem Zeitstempel ermittelt wird,
wobei das Puffern der Sensormessungen umfasst, dass bei jedem Zeitstempel eine Beschleunigung des Fahrzeugs gepuffert wird, wobei die Beschleunigung eine Längsbeschleunigung umfasst, wobei die Längsbeschleunigung durch die folgende Formel dargestellt wird:
wobei ax,m die Längsbeschleunigung ist, v̇x,estimate die Längsgeschwindigkeit am Schwerpunkt des Fahrzeugs ist, rm eine Gierrate an einem Sensorort ist, ax,bias der systematische Fehler der Längsbeschleunigung des Sensors ist, g die Schwerkraft ist, θ der Straßengradient ist und wax,m das Längsbeschleunigungsmesserrauschen ist,
wobei eine Fahrzeuglängsgeschwindigkeit bei einem jeweiligen Zeitstempel durch die folgende Formel dargestellt wird:
wobei v̂x(tk+1) die Längsgeschwindigkeit bei Zeitstempel k+1 ist, v̂x(tk) die Längsgeschwindigkeit bei Zeitstempel k ist, Ts der Zeitstempel bei einem jeweiligen k ist, rm die gemessene Gierrate ist, ax,m die Längsgeschwindigkeit bei Zeitstempel k ist, v̂y(tk) die Quergeschwindigkeit bei Zeitstempel k ist, G die Schwerkraft ist und θ der Straßengradient ist,
wobei eine Fahrzeuglängsgeschwindigkeit eines aktuellen Zeitstempels auf einer Synchronisation der gemessenen GPS-Messungen und der Sensormessungsdaten basiert und durch die folgende Formel dargestellt wird:
wobei v̂x(t) die Längsgeschwindigkeit zur Zeit t ist, v̂x(ti) die Längsgeschwindigkeit bei jedem Zeitstempel i ist, Ts die Zeit bei jedem Zeitstempel i ist, rm,i die gemessene Gierrate zum Zeitpunkt i ist, ax,i die Längsbeschleunigung bei jedem Zeitstempel i ist, v̂y(ti) die Quergeschwindigkeit bei jedem Zeitstempel i ist, g die Schwerkraft ist und θ der Straßengradient bei jedem Zeitstempel i ist.
eine Absolutgeschwindigkeit und ein Kursfahrtrichtungswinkel des Fahrzeugs unter Verwendung des GPS (12) einer einzelnen Antenne gemessen werden;
Gierraten des Fahrzeugs unabhängig von dem GPS (12) gemessen werden;
eine integrierte Gierrate des Fahrzeugs als Funktion der gemessenen Gierraten über einer Zeitperiode berechnet wird;
ein Gierwinkel als Funktion eines initialisierten Gierwinkels und der integrierten Gierrate ermittelt wird;
ein Seitenschlupfwinkel als Funktion des Gierwinkels und des Kursfahrtrichtungswinkels, der durch das GPS (12) bereitgestellt wird, berechnet wird;
die Fahrzeuggeschwindigkeit als Funktion der Absolutgeschwindigkeit und des Seitenschlupfwinkels ermittelt wird; und
die Fahrzeuggeschwindigkeit für eine Fahrzeugdynamiksteueranwendung bereitgestellt wird,
wobei das Verfahren ferner die Schritte umfasst, dass:
eine Verzögerung der GPS-Messungen als Ergebnis der Verarbeitungszeit eines empfangenen GPS-Signals ermittelt wird;
Sensormessungen gepuffert werden, die durch Fahrzeugsensoren (14) bereitgestellt werden;
den Sensormessungen ein Zeitstempel zugeordnet wird;
eine diskrete Fahrzeuggeschwindigkeit für jeden Zeitstempel über der Periode der Verzögerung ermittelt wird, wobei jede diskrete Fahrzeuggeschwindigkeit als Funktion der berechneten Fahrzeuggeschwindigkeit und der gepufferten Sensormessungen bei jedem Zeitstempel ermittelt wird,
wobei das Puffern der Sensormessungen umfasst, dass bei jedem Zeitstempel eine Beschleunigung des Fahrzeugs gepuffert wird, wobei die Beschleunigung eine Längsbeschleunigung umfasst, wobei die Längsbeschleunigung durch die folgende Formel dargestellt wird:
wobei ax,m die Längsbeschleunigung ist, v̇x,estimate die Längsgeschwindigkeit am Schwerpunkt des Fahrzeugs ist, rm eine Gierrate an einem Sensorort ist, ax,bias der systematische Fehler der Längsbeschleunigung des Sensors ist, g die Schwerkraft ist, θ der Straßengradient ist und wax,m das Längsbeschleunigungsmesserrauschen ist,
wobei eine Fahrzeuglängsgeschwindigkeit bei einem jeweiligen Zeitstempel durch die folgende Formel dargestellt wird:
wobei v̂x(tk+1) die Längsgeschwindigkeit bei Zeitstempel k+1 ist, v̂x(tk) die Längsgeschwindigkeit bei Zeitstempel k ist, Ts der Zeitstempel bei einem jeweiligen k ist, rm die gemessene Gierrate ist, ax,m die Längsgeschwindigkeit bei Zeitstempel k ist, v̂y(tk) die Quergeschwindigkeit bei Zeitstempel k ist, G die Schwerkraft ist und θ der Straßengradient ist,
wobei eine Fahrzeuglängsgeschwindigkeit eines aktuellen Zeitstempels auf einer Synchronisation der gemessenen GPS-Messungen und der Sensormessungsdaten basiert und durch die folgende Formel dargestellt wird:
wobei v̂x(t) die Längsgeschwindigkeit zur Zeit t ist, v̂x(ti) die Längsgeschwindigkeit bei jedem Zeitstempel i ist, Ts die Zeit bei jedem Zeitstempel i ist, rm,i die gemessene Gierrate zum Zeitpunkt i ist, ax,i die Längsbeschleunigung bei jedem Zeitstempel i ist, v̂y(ti) die Quergeschwindigkeit bei jedem Zeitstempel i ist, g die Schwerkraft ist und θ der Straßengradient bei jedem Zeitstempel i ist.
Description
- HINTERGRUND DER ERFINDUNG
- Eine Ausführungsform bezieht sich allgemein auf eine Fahrzeuggeschwindigkeitsschätzung.
- Von einer Verwendung einer genauen Längs- und/oder Quergeschwindigkeit eines Fahrzeugs profitieren verschiedene Fahrzeugssicherheits- und -steuersysteme. Einrichtungen zum genauen Messen von Längs- und Quergeschwindigkeitsmessungen, wie beispielsweise ein GPS mehrerer Antennen oder optische Sensoren, sind entweder zu teuer oder werden von außen eingebaut. Die Verwendung anderer Typen von Sensoren zum Messen der Längs- und Quergeschwindigkeit, wie beispielsweise Raddrehzahlsensoren oder sogar Querbeschleunigungssensoren, bringt Schwierigkeiten beim Bereitstellen von genauen Messungen mit sich, wenn ein übermäßiger Radschlupf vorliegt oder wenn eine Straße mit Querneigung vorliegt.
-
DE 100 08 550 A1 offenbart ein Verfahren zur Bestimmung eines Bewegungsparameters eines Fahrzeugs, wobei Fahrzeugsensordaten und D-GPS-Daten verwendet werden, um einen Geschwindigkeitsvektor und Schwimmwinkel des Fahrzeugs zu berechnen. -
DE 10 2008 030 071 A1 beschreibt ein Verfahren zur Kalibrierung des Fahrtrichtungsänderungssensors eines Fahrzeugs unter Verwendung von GPS-Signalen. - ZUSAMMENFASSUNG DER ERFINDUNG
- Aufgabe der Erfindung ist es, ein verbessertes Verfahren zur Schätzung der Fahrzeuggeschwindigkeit unter Verwendung von GPS bereitzustellen.
- Zur Lösung der Aufgabe ist ein Verfahren mit den Merkmalen des Anspruchs 1 vorgesehen. Vorteilhafte Ausbildungen der Erfindung sind der Beschreibung und den Zeichnungen zu entnehmen.
- Figurenliste
-
-
1 ist ein Fahrzeuggeschwindigkeitsschätzungssystem für ein Fahrzeug. -
2 ist eine Darstellung eines Geschwindigkeitsvektormodells eines Fahrzeugs. -
3 ist ein Flussdiagramm zum Schätzen von Längsgeschwindigkeiten und Quergeschwindigkeiten. - DETAILLIERTE BESCHREIBUNG
- In
1 ist ein System10 zum Ermitteln einer Längsgeschwindigkeit und einer Quergeschwindigkeit eines Fahrzeugs gezeigt. Das System umfasst ein globales Positionsbestimmungssystem (GPS)12 einer einzelnen Antenne und mindestens einen Sensor, der ohne Einschränkung einen Gierratensensor, einen Beschleunigungsmesser und einen Fahrzeugsensor umfasst. Das System10 umfasst ferner einen Prozessor16 zum Verarbeiten der Daten, die von dem GPS12 einer einzelnen Antenne und dem mindestens einen Sensor14 empfangen werden. Der Prozessor16 ermittelt eine Längsgeschwindigkeit und eine Quergeschwindigkeit auf der Grundlage der Daten, die durch das GPS12 einer einzelnen Antenne und den mindestens einen Sensor14 empfangen werden. Die Längsgeschwindigkeit und die Quergeschwindigkeit, die von dem Prozessor16 erhalten werden, werden an verschiedene Fahrzeugsicherheits- und -steuersysteme geliefert, die von der Kenntnis einer genauen Längsgeschwindigkeit und Quergeschwindigkeit des Fahrzeugs profitieren. - Das GPS
12 einer einzelnen Antenne verwendet nur eine Antenne. Das GPS stellt typischerweise eine sehr gute Geschwindigkeitsmessung bereit, die eine Geschwindigkeitsrichtung (d.h. Kursfahrtrichtung) und einen Betrag (d.h. Absolutgeschwindigkeit) umfasst. Beispielsweise ist die GPS-Geschwindigkeit erheblich genauer als die durch ein GPS bereitgestellten Positionsdaten, mit Fehlern in der Größenordnung von 3 cm/s (1σ, horizontale Geschwindigkeit) und 6 cm/s (vertikale Geschwindigkeit) ohne Differenzkorrekturen. Das GPS mehrerer Antennen, das mehr als zwei GPS-Antennen aufweist, stellt auch genaue Gierwinkel bereit. Durch die Kursfahrtrichtung und den Gierwinkel kann ein Seitenschlupfwinkel β ermittelt werden, der verwendet wird, um die Quer- und Längsgeschwindigkeit zu ermitteln. -
2 zeigt ein Geschwindigkeitsvektormodell eines Fahrzeugs. Mit einer gegebenen Längsgeschwindigkeit vx und einer gegebenen Quergeschwindigkeit vy an einem beliebigen Punkt des Fahrzeugs kann der Seitenschlupfwinkel β ermittelt werden. Der Seitenschlupfwinkel wird durch die folgende Gleichung definiert: - Der Seitenschlupfwinkel β am Schwerpunkt (CG von center of gravity) ist in
2 gezeigt. Wenn die Längs- und Quergeschwindigkeit nicht bekannt sind, kann der Seitenschlupfwinkel β durch die folgende Gleichung ausgedrückt werden: - Sobald der Seitenschlupfwinkel β ermittelt wurde und die Absolutgeschwindigkeit ||V|| (d.h. der Betrag des Geschwindigkeitsvektors des Fahrzeugs) durch das GPS einer einzelnen Antenne erhalten wurde, können die Längsgeschwindigkeit vx und die Quergeschwindigkeit vy durch die folgenden Gleichungen erhalten werden:
- Ein GPS einer einzelnen Antenne liefert eine direkte Messung des Geschwindigkeitsvektors γ und der Absolutgeschwindigkeit ||V||; ein GPS einer einzelnen Antenne liefert jedoch keine direkte Messung des Fahrzeuggierwinkels ψ. Während ein GPS mehrerer Antennen Höhenmessungen, wie beispielsweise Gier, Nicken und Wanken, bereitstellt, ist das GPS einer einzelnen Antenne auf das Bereitstellen der Absolutgeschwindigkeit und des Kursfahrtrichtungswinkels in Bezug auf die Erde zusätzlich zu einer Positionsmessung beschränkt. Der Gierwinkel ψ kann nicht direkt durch das GPS einer einzelnen Antenne gemessen werden. Daher muss der Gierwinkel ψ im Gegensatz zu einer direkten Messung zum Berechnen des Seitenschlupfwinkels β unter Verwendung von GPS-Daten und Fahrzeugsensordaten berechnet werden.
- Um den Gierwinkel ψ zu erhalten, werden Gierratendaten in Kooperation mit GPS-Daten verwendet, um den Gierwinkel ψ zu schätzen. Der Gierwinkel ψ wird durch Integrieren von Gierratensensormessungen über einer Zeitperiode geschätzt. Ein Nachteil des Integrierens von Gierratenmessungen ist, dass eine reine Integration über der Zeit Sensorfehler, wie beispielsweise ein Rauschen und einen systematischen Fehler (bias) der Sensoren akkumuliert. Diese Belastung von Rauschen und systematischem Fehler hängt vollständig von der Qualität eines Gierratensensors ab. Während das der systematische Fehler und das Rauschniveau von typischen Gierratensensoren möglicherweise nicht hoch sind, ergibt sich, dass die Integration der Gierratensensormessungen nur für einige zehn Sekunden gültig ist. Integrationsfehler aufgrund von Rauschen und systematischem Fehler wachsen schnell an, wenn die Zeit weiterläuft. Ein Beispiel des Fehlers einer Gierratenintegration, das nicht als definitive Zeitbegrenzung zu verstehen ist, ist, dass der Fehler in etwa 25 Sekunden größer als 0,5 Grad wird. Daher muss der Integrationsprozess entweder zurückgesetzt und initialisiert oder kontinuierlich aktualisiert werden. Ohne eine genaue Gierwinkelmessung kann der Integrationsprozess nicht kontinuierlich aktualisiert werden. Daher muss die Gierratenintegration nach einer Zeitperiode erneut initialisiert werden.
-
- Als Ergebnis wird, wenn das Fahrzeug geradeaus fährt, der Gierwinkel ψ erneut mit dem Kursfahrtrichtungswinkel γ initialisiert. Die Gierrate wird auch erneut initialisiert, indem die vorherige Gierrate gelöscht wird und Gierraten über einer nächsten Zeitperiode gemessen werden. Es wird eine neue integrierte Gierrate für die nächste Zeitperiode ermittelt und danach zum Aktualisieren des Gierwinkels verwendet. Die Gleichung zum Schätzen des Gierwinkels als Funktion der integrierten Gierrate und des erneut initialisierten Gierwinkels lautet wie folgt:
- Als Ergebnis wird der Seitenschlupfwinkel unter Verwendung des geschätzten Gierwinkels wie in Gleichung (7) ermittelt und des Kursfahrtrichtungswinkels γ wie durch das GPS einer einzelnen Antenne bereitgestellt geschätzt, wie es durch die folgende Gleichung angegeben ist:
- In dem Fall, dass das Fahrzeug weiter entlang einer Kurve (d.h. nicht geradeaus) fährt, in der der Seitenschlupf nicht erneut mit Null initialisiert werden kann, kann der Seitenschlupfwinkel β̂̂ unter Verwendung der Techniken geschätzt werden, die in der ebenfalls anhängigen Anmeldung
US 7 908 112 B2 beschrieben sind, die am 24. November 2008 eingereicht wurde und deren Offenbarungsgehalt hierin durch Bezugnahme vollständig miteingeschlossen ist. - Sobald der geschätzte Seitenschlupfwinkel β̂̂ bekannt ist, können geschätzte Längsgeschwindigkeiten und Quergeschwindigkeiten wie folgt unter Verwendung der Absolutgeschwindigkeit ||V||, die durch das GPS einer einzelnen Antenne ermittelt wird, und des geschätzten Seitenschlupfwinkels β̂̂ ermittelt werden:
- Es kann weiterhin ein Problem aufgrund der Aktualisierungsrate der GPS-Geschwindigkeitsmessung bei einer Verwendung zum Schätzen des Seitenschlupfwinkels, der Quergeschwindigkeit und der Längsgeschwindigkeit für Fahrzeugdynamikanwendungen vorliegen. Das heißt, Fahrzeugdynamikanwendungen profitieren von dem rechtzeitigen Empfangen einer Information und dem dementsprechenden Durchführen von Steuermaßnahmen. Einige GPS-Empfänger weisen üblicherweise eine Aktualisierungsrate von 1-20 Hz auf. Einige Fahrzeugdynamikanwendungen, wie beispielsweise, jedoch ohne Einschränkung, ein Fahrzeugstabilitätssteuersystem, erfordern eine schnellere Aktualisierungsrate. Ferner können Verzögerungen bei Messungen, die ein Ergebnis der Zeit sind, die erforderlich ist, um die Signale von [engl.: „form“] GPS-Satelliten zu verarbeiten, von mehreren zehn Millisekunden bis zu Hunderten von Millisekunden dauern. Diese Verzögerung wird sogar noch signifikanter, wenn die GPS-Messungen mit anderen Fahrzeugsensormessungen, wie beispielsweise den Gierratensensormessungen, verwendet werden. Aufgrund der Übertragungs- und Verarbeitungsverzögerungen des GPS-Systems müssen die verzögerten GPS-Messungen und die anderen Fahrzeugsensormessungen synchronisiert werden. Die Verzögerung kann unter Verwendung des PPS-Signals (Impuls-pro-Sekunde-Signals) von dem GPS-Empfänger synchronisiert werden. Das PPS ist ein Impulssignal, das bei jeder Sekunde der GPS-Zeit entweder eine steigende oder eine fallende Flanke aufweist. Als Ergebnis weist jeder GPS-Messungsabtastwert einen GPS-Zeitstempel auf und können die GPS-Messungen mit anderen Sensormessungen synchronisiert werden, da es keine Verzögerung des PPS über den GPS-Empfänger gibt.
- Um die GPS-Messungen und andere Sensormessungen zu synchronisieren, wird die Verzögerung zuerst unter Verwendung des PPS-Signals von dem GPS-Empfänger ermittelt. Die Sensormessungen werden gepuffert, da es keine Verzögerung in Bezug auf die Verarbeitung der Sensormessungen gibt. Die dem Beginn der Verzögerung zugehörigen gepufferten Daten werden als Startpunkte verwendet, und die geschätzte Quergeschwindigkeit und Längsgeschwindigkeit werden bis zu dem aktuellen Zeitstempel unter Verwendung der gepufferten Daten summiert oder erneut integriert.
-
- Das Ziel ist, v̂x(t) und v̂y(t) zu finden, wobei t den aktuellen Zeitstempel darstellt. Um v̂x(t) und v̂y(t) bei dem aktuellen Zeitstempel t zu ermitteln, werden verschiedene Sensormessungen sowie berechnete Werte, die von der letzten GPS-Aktualisierung k bis zur aktuellen Zeit t erhalten werden, gepuffert. Die verschiedenen Sensormessungen und berechneten Werte umfassen ax,m, ay,m, ψ̇, einen Querneigungswinkel und Gradientenwinkel. Werte, die nicht durch Sensormessungen erhalten werden, können unter Verwendung der folgenden Beziehungen ermittelt werden:
- Für jede diskrete Zeitinstanz über der Periode der Verzögerung (z.B. jeden Schritt k) wird eine neue v̂x(t) und v̂y(t) ermittelt. Die folgende Gleichung stellt die Längsgeschwindigkeit zu einem nächsten Zeitpunkt innerhalb der Verzögerungsperiode dar:
- Die folgende Gleichung stellt die Quergeschwindigkeit bei einer nächsten Zeitinstanz innerhalb der Verzögerung dar:
- Da der systematische Fehler und das Rauschen der Sensoren Teil der Messungsdaten sind, werden die Variablen des systematischen Fehlers und des Rauschens aus der Gleichung fallen gelassen. Nachdem die Längs- und Quergeschwindigkeit für jede Zeitinstanz (d.h. k Schritte) geschätzt wurden, werden die Längs- und Quergeschwindigkeit des Fahrzeugs des aktuellen Zeitstempels auf der Grundlage der Synchronisation der GPS-Messungen und der gepufferten Sensormessungsdaten ermittelt. Die Längsgeschwindigkeit für den aktuellen Zeitstempel wird durch die folgende Formel dargestellt:
- Auf ähnliche Weise kann die Quergeschwindigkeit des aktuellen Zeitstempels durch die folgende Gleichung dargestellt werden:
- Die Längsgeschwindigkeit v̂y(t) des Fahrzeugs und die Quergeschwindigkeit v̂y(tk+1) des Fahrzeugs für den aktuellen Zeitstempel, die aus Gleichung (17) und Gleichung (18) erhalten werden, werden Fahrzeugdynamikanwendungen bereitgestellt, um Steuermaßnahmen auf der Grundlage der aktuellen Betriebsbedingungen des Fahrzeugs zu ermitteln.
-
3 zeigt ein Flussdiagramm zum Ermitteln der Längs- und Quergeschwindigkeit für einen aktuellen Zeitstempel. In Schritt20 werden die Absolutgeschwindigkeit des Fahrzeugs und der Kursfahrtrichtungswinkel von einem GPS einer einzelnen Antenne abgerufen. - In Schritt
21 werden Gierraten von Fahrzeugsensoren unabhängig von einem GPS erhalten. In Schritt22 werden die über einer Zeitperiode gemessenen Gierraten integriert, um einen Gierwinkel zu ermitteln. - In Schritt
23 wird der Gierwinkel als Funktion der integrierten Gierrate und des aktuellen Gierwinkels geschätzt (Gleichung (7 )). Fehler in den Sensormessungsdaten aufgrund der Qualität des Sensors erfordern, dass die integrierte Gierrate und der aktuelle Gierwinkel nach einer Zeitperiode erneut initialisiert werden. Wie zuvor erläutert ist der Gierwinkel gleich dem Kursfahrtrichtungswinkel, wenn das Fahrzeug geradeaus fährt. Daher ermittelt das System, nachdem die Zeitperiode abgelaufen ist, ob das Fahrzeug geradeaus fährt, um den Gierwinkel erneut mit dem des Kursfahrtrichtungswinkels zu initialisieren, oder initialisiert es den Gierwinkel erneut unter Verwendung eines Schätzwertschlupfwinkels gemäß dem Verfahren, das in der ebenfalls anhängigenUS 7 908 112 B2 beschrieben ist. - In Schritt
24 wird der Seitenschlupfwinkel unter Verwendung des in Schritt23 ermittelten geschätzten Gierwinkels und des Kursfahrtrichtungswinkels wie durch das GPS einer einzelnen Antenne gemessen geschätzt (Gleichung (8 )). - In Schritt
25 wird die Fahrzeuggeschwindigkeit als Funktion der Absolutgeschwindigkeit und des Seitenschlupfwinkels unter Verwendung von Gleichung (9) und (10) ermittelt. Aufgrund der Aktualisierungsrate und von Verzögerungen beim Verarbeiten der Daten in dem GPS-Empfänger müssen Schätzwerte für einen aktuellen Zeitstempel erzeugt werden, da die in Gleichung (9) und (10) verarbeiteten Daten vergangene Daten verwenden (d.h. verzögerte Daten). - In Schritt
26 wird eine Verzögerung des GPS-Signals in Relation zu den Fahrzeugsensormessungsdaten unter Verwendung des PPS in dem GPS-Signal ermittelt. - In Schritt
27 werden Sensormessungsdaten zur Synchronisation gepuffert. - In Schritt
28 werden eine Fahrzeuglängs- und -quergeschwindigkeit zu jeder Zeitinstanz der Verzögerung ermittelt, indem die GPS-Messungen mit den Fahrzeugsensormessungen unter Verwendung der Gleichungen synchronisiert werden, die in Gleichung (13) - (16) gezeigt sind. - In Schritt
29 werden eine geschätzte Längsgeschwindigkeit und eine geschätzte Quergeschwindigkeit unter Verwendung jeder der diskreten Geschwindigkeitsberechnungen in Gleichung (15) - (16) ermittelt. Die geschätzte Längs- und Quergeschwindigkeit werden unter Verwendung eines Summierungsprozesses wie in Gleichung (17) - (18) gezeigt ermittelt. Alternativ kann eine Integralfunktion in Gleichung (17) - (18) durch Integrieren jedes Zeitschritts aufgrund der Aktualisierungen, die bei der Längs- und Quergeschwindigkeitsschätzung nach jedem Zeitschritt stattfinden, ersetzt werden. - Es ist zu verstehen, dass der obige Prozess verwendet wird, wenn GPS-Daten vorhanden sind. In jenen Fällen, in denen kein GPS verfügbar ist, kann eine Technik einer nächstbesten Schätzung verwendet werden, um die Längs- und Quergeschwindigkeit zu ermitteln, wie beispielsweise jene, die in der ebenfalls anhängigen
US 7 908 112 B2 beschrieben ist; die hierin beschriebene obige Schätzungstechnik kann jedoch erneut ausgeführt werden, wenn das GPS zur Verfügung steht, da die Verwendung der GPS-Daten eine größere Genauigkeit bereitstellt als Fahrzeugsensoren, die Fehlern und einem systematischen Fehler über der Zeit unterliegen. - Während bestimmte Ausführungsformen der vorliegenden Erfindung ausführlich beschrieben wurden, werden Fachleute, die diese Erfindung betrifft, verschiedene alternative Entwürfe und Ausführungsformen zum Ausführen der Erfindung wie durch die folgenden Ansprüche definiert erkennen.
Claims (1)
- Verfahren zum Schätzen der Fahrzeuggeschwindigkeit für ein Fahrzeug unter Verwendung eines globalen Positionsbestimmungssystems (GPS) (12) einer einzelnen Antenne, wobei das Verfahren die Schritte umfasst, dass: eine Absolutgeschwindigkeit und ein Kursfahrtrichtungswinkel des Fahrzeugs unter Verwendung des GPS (12) einer einzelnen Antenne gemessen werden; Gierraten des Fahrzeugs unabhängig von dem GPS (12) gemessen werden; eine integrierte Gierrate des Fahrzeugs als Funktion der gemessenen Gierraten über einer Zeitperiode berechnet wird; ein Gierwinkel als Funktion eines initialisierten Gierwinkels und der integrierten Gierrate ermittelt wird; ein Seitenschlupfwinkel als Funktion des Gierwinkels und des Kursfahrtrichtungswinkels, der durch das GPS (12) bereitgestellt wird, berechnet wird; die Fahrzeuggeschwindigkeit als Funktion der Absolutgeschwindigkeit und des Seitenschlupfwinkels ermittelt wird; und die Fahrzeuggeschwindigkeit für eine Fahrzeugdynamiksteueranwendung bereitgestellt wird, wobei das Verfahren ferner die Schritte umfasst, dass: eine Verzögerung der GPS-Messungen als Ergebnis der Verarbeitungszeit eines empfangenen GPS-Signals ermittelt wird; Sensormessungen gepuffert werden, die durch Fahrzeugsensoren (14) bereitgestellt werden; den Sensormessungen ein Zeitstempel zugeordnet wird; eine diskrete Fahrzeuggeschwindigkeit für jeden Zeitstempel über der Periode der Verzögerung ermittelt wird, wobei jede diskrete Fahrzeuggeschwindigkeit als Funktion der berechneten Fahrzeuggeschwindigkeit und der gepufferten Sensormessungen bei jedem Zeitstempel ermittelt wird, wobei das Puffern der Sensormessungen umfasst, dass bei jedem Zeitstempel eine Beschleunigung des Fahrzeugs gepuffert wird, wobei die Beschleunigung eine Längsbeschleunigung umfasst, wobei die Längsbeschleunigung durch die folgende Formel dargestellt wird:
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US12/616,933 US9285485B2 (en) | 2009-11-12 | 2009-11-12 | GPS-enhanced vehicle velocity estimation |
US12/616,933 | 2009-11-12 |
Publications (2)
Publication Number | Publication Date |
---|---|
DE102010050804A1 DE102010050804A1 (de) | 2011-07-07 |
DE102010050804B4 true DE102010050804B4 (de) | 2019-05-09 |
Family
ID=43974805
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
DE102010050804.7A Active DE102010050804B4 (de) | 2009-11-12 | 2010-11-09 | Durch GPS verbesserte Fahrzeuggeschwindigkeitsschätzung |
Country Status (3)
Country | Link |
---|---|
US (1) | US9285485B2 (de) |
CN (1) | CN102096087A (de) |
DE (1) | DE102010050804B4 (de) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20220260427A1 (en) * | 2021-02-12 | 2022-08-18 | Qian Chen | Method and System utilizing absolute velocity to improve the performance of electromagnetic devices |
Families Citing this family (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10185455B2 (en) | 2012-10-04 | 2019-01-22 | Zonar Systems, Inc. | Mobile computing device for fleet telematics |
US9563869B2 (en) | 2010-09-14 | 2017-02-07 | Zonar Systems, Inc. | Automatic incorporation of vehicle data into documents captured at a vehicle using a mobile computing device |
US20130164715A1 (en) | 2011-12-24 | 2013-06-27 | Zonar Systems, Inc. | Using social networking to improve driver performance based on industry sharing of driver performance data |
US20130164713A1 (en) | 2011-12-23 | 2013-06-27 | Zonar Systems, Inc. | Method and apparatus for gps based slope determination, real-time vehicle mass determination, and vehicle efficiency analysis |
US10056008B1 (en) | 2006-06-20 | 2018-08-21 | Zonar Systems, Inc. | Using telematics data including position data and vehicle analytics to train drivers to improve efficiency of vehicle use |
US9403415B2 (en) * | 2009-10-12 | 2016-08-02 | Ford Global Technologies | GPS based pitch sensing for an integrated stability control system |
US8509993B2 (en) * | 2010-04-19 | 2013-08-13 | Gm Global Technology Operations, Inc | Systems and methods for controlling a vehicle along a road with a road bank |
US9527515B2 (en) | 2011-12-23 | 2016-12-27 | Zonar Systems, Inc. | Vehicle performance based on analysis of drive data |
US10431020B2 (en) | 2010-12-02 | 2019-10-01 | Zonar Systems, Inc. | Method and apparatus for implementing a vehicle inspection waiver program |
US9139203B2 (en) | 2011-11-04 | 2015-09-22 | GM Global Technology Operations LLC | Lane tracking system |
JP6008509B2 (ja) * | 2012-02-20 | 2016-10-19 | 株式会社小野測器 | 計測装置及び計測方法 |
US10061745B2 (en) | 2012-04-01 | 2018-08-28 | Zonar Sytems, Inc. | Method and apparatus for matching vehicle ECU programming to current vehicle operating conditions |
DE102012104380A1 (de) * | 2012-05-22 | 2013-11-28 | Continental Automotive Gmbh | Verfahren zum Abschätzen einer Verzögerung einer GPS-Messung in einem bewegten Fahrzeug gegenüber zumindest einer erfassten fahrdynamischen Größe des Fahrzeugs |
US9424696B2 (en) | 2012-10-04 | 2016-08-23 | Zonar Systems, Inc. | Virtual trainer for in vehicle driver coaching and to collect metrics to improve driver performance |
KR101417456B1 (ko) * | 2012-12-07 | 2014-07-08 | 현대자동차주식회사 | 차량 요레이트센서의 바이어스 획득방법 |
CN103399330B (zh) * | 2013-07-30 | 2015-07-08 | 清华大学 | 一种车辆实时无滞后定位设备及无滞后位置的计算方法 |
US9650039B2 (en) * | 2015-03-20 | 2017-05-16 | Ford Global Technologies, Llc | Vehicle location accuracy |
JP6373223B2 (ja) * | 2015-04-08 | 2018-08-15 | 三菱電機株式会社 | 車両位置標定装置及び車両位置標定プログラム |
FR3037875B1 (fr) | 2015-06-26 | 2017-07-07 | Ifp Energies Now | Procede de determination d'un indicateur de dangerosite de la conduite d'un vehicule |
GB2550854B (en) | 2016-05-25 | 2019-06-26 | Ge Aviat Systems Ltd | Aircraft time synchronization system |
US10114106B2 (en) * | 2016-07-22 | 2018-10-30 | Delphi Technologies, Inc. | Automated vehicle radar system with auto-alignment for azimuth, elevation, and vehicle speed-scaling-error |
DE102019201222A1 (de) * | 2019-01-31 | 2020-08-06 | Robert Bosch Gmbh | Verfahren zur Bestimmung einer Position eines Fahrzeugs in einer digitalen Karte |
US11648900B2 (en) * | 2020-07-27 | 2023-05-16 | Robert Bosch Gmbh | Off-zone crash detection using lateral accelerations at different positions in a vehicle |
CN112874529B (zh) * | 2021-02-05 | 2022-07-08 | 北京理工大学 | 基于事件触发状态估计的车辆质心侧偏角估计方法及*** |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE10008550A1 (de) | 2000-02-24 | 2001-09-13 | Bosch Gmbh Robert | Verfahren und Vorrichtung zur Bestimmung eines Bewegungsparameters eines Kraftfahrzeuges mit einem D-GPS-System |
DE102008030071A1 (de) | 2007-06-29 | 2009-05-07 | GM Global Technology Operations, Inc., Detroit | GPS-Basierter fahrzeuginterner Sensorkalibrierungsalgorithmus |
US7908112B2 (en) | 2008-11-24 | 2011-03-15 | GM Global Technology Operations LLC | Dynamic observer for the estimation of vehicle lateral velocity |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08314540A (ja) * | 1995-03-14 | 1996-11-29 | Toyota Motor Corp | 車両走行誘導システム |
US6223105B1 (en) * | 1999-10-14 | 2001-04-24 | Seagull Technology, Inc. | System for determining the orientation in space of a moving body relative to the earth |
US20030135327A1 (en) * | 2002-01-11 | 2003-07-17 | Seymour Levine | Low cost inertial navigator |
US6671587B2 (en) | 2002-02-05 | 2003-12-30 | Ford Motor Company | Vehicle dynamics measuring apparatus and method using multiple GPS antennas |
DE10247991A1 (de) * | 2002-10-15 | 2004-04-29 | Robert Bosch Gmbh | Verfahren und Vorrichtung zur Ermittlung des Schwimmwinkels eines Kraftfahrzeugs |
US6847875B2 (en) | 2003-02-26 | 2005-01-25 | Ford Global Technologies, Llc | Method for determining a longitudinal vehicle velocity by compensating individual wheel speeds |
US6915193B2 (en) | 2003-02-26 | 2005-07-05 | Ford Global Technologies, Llc | Method for determining a longitudinal vehicle velocity by compensating individual wheel speeds using pitch attitude |
US7289906B2 (en) * | 2004-04-05 | 2007-10-30 | Oregon Health & Science University | Navigation system applications of sigma-point Kalman filters for nonlinear estimation and sensor fusion |
JP2006044316A (ja) * | 2004-07-30 | 2006-02-16 | Nissan Motor Co Ltd | 車両状態量検出装置 |
CN100415584C (zh) * | 2005-02-04 | 2008-09-03 | 比亚迪股份有限公司 | 机动车制动防抱死的控制***和方法 |
US7590481B2 (en) * | 2005-09-19 | 2009-09-15 | Ford Global Technologies, Llc | Integrated vehicle control system using dynamically determined vehicle conditions |
JP4781300B2 (ja) * | 2007-03-01 | 2011-09-28 | アルパイン株式会社 | 位置検出装置および位置検出方法 |
US20090299546A1 (en) * | 2008-05-28 | 2009-12-03 | Hac Aleksander B | Dynamic-based method of estimating the absolute roll angle of a vehicle body |
-
2009
- 2009-11-12 US US12/616,933 patent/US9285485B2/en not_active Expired - Fee Related
-
2010
- 2010-11-09 DE DE102010050804.7A patent/DE102010050804B4/de active Active
- 2010-11-12 CN CN201010548781XA patent/CN102096087A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE10008550A1 (de) | 2000-02-24 | 2001-09-13 | Bosch Gmbh Robert | Verfahren und Vorrichtung zur Bestimmung eines Bewegungsparameters eines Kraftfahrzeuges mit einem D-GPS-System |
DE102008030071A1 (de) | 2007-06-29 | 2009-05-07 | GM Global Technology Operations, Inc., Detroit | GPS-Basierter fahrzeuginterner Sensorkalibrierungsalgorithmus |
US7908112B2 (en) | 2008-11-24 | 2011-03-15 | GM Global Technology Operations LLC | Dynamic observer for the estimation of vehicle lateral velocity |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20220260427A1 (en) * | 2021-02-12 | 2022-08-18 | Qian Chen | Method and System utilizing absolute velocity to improve the performance of electromagnetic devices |
Also Published As
Publication number | Publication date |
---|---|
CN102096087A (zh) | 2011-06-15 |
US20110112739A1 (en) | 2011-05-12 |
DE102010050804A1 (de) | 2011-07-07 |
US9285485B2 (en) | 2016-03-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
DE102010050804B4 (de) | Durch GPS verbesserte Fahrzeuggeschwindigkeitsschätzung | |
DE102015010340B4 (de) | Positionsbestimmungsvorrichtung | |
DE112009000920B4 (de) | Gierratensensor-Kalibrierungssystem in einem Fahrzeug | |
DE102008030071B4 (de) | System zum Ermitteln der Fahrtrichtung eines Fahrzeugs | |
DE4403190C1 (de) | Verfahren zum Bestimmen der Position eines Flugzeugs aus Beschleunigungsdaten eines Inertialsystems sowie aus Ausgabedaten eines Navigationssystems und Einrichtung zur Durchführung des Verfahrens | |
EP1885586B1 (de) | Bestimmung des aktuellen gierwinkels und des aktuellen schwimmwinkels eines landfahrzeugs | |
DE102007041121B4 (de) | Verfahren und Vorrichtung zum Verarbeiten von Sensordaten für ein Fahrerassistenzsystem eines Fahrzeugs | |
DE102016222272B4 (de) | Schätzen einer Eigenposition | |
DE69732963T2 (de) | Verfahren und vorrichtung zur kalibrierung des differentiellen skalenfaktors in differentiellen gps-integrierten odometersystemen | |
DE102012216211A1 (de) | Verfahren zum Auswählen eines Satelliten | |
DE112012006603T5 (de) | Positionierungsvorrichtung | |
DE112009001322T5 (de) | Neigungsmesser | |
DE112018003443T5 (de) | Positioniervorrichtung | |
DE102020107349A1 (de) | Verfahren und vorrichtung zur dynamischen gierratenabweichungsschätzung | |
DE102012224104A1 (de) | Verfahren zum Bereitstellen eines GNSS-Signals | |
DE10008550A1 (de) | Verfahren und Vorrichtung zur Bestimmung eines Bewegungsparameters eines Kraftfahrzeuges mit einem D-GPS-System | |
DE102014211176A1 (de) | Verfahren und System zur Korrektur von Messdaten und/oder Navigationsdaten eines Sensorbasissystems | |
DE102014211180A1 (de) | Verfahren und System zur verbesserten Erkennung und/oder Kompensation von Fehlerwerten | |
DE60217218T2 (de) | Verfahren und Gerät für GPS, Navigationssystem und Computerprogramm | |
EP3155454B1 (de) | Verfahren und system zur anpassung eines navigationssystems | |
DE102020213320A1 (de) | Verfahren zum Ermitteln mindestens einer Integritätsinformation zu einem Lokalisierungsergebnis einer GNSS-basierten Lokalisierungseinrichtung eines Fahrzeugs, bei sich abrupt und signifikant ändernder GNSS-Empfangssituation | |
DE102015010173B3 (de) | Verfahren zur Schwimmwinkelmessung in Fahrzeugen | |
DE69723296T2 (de) | Verfahren und vorrichtung zum kalibrieren von spurweite | |
DE102018007972A1 (de) | Verfahren zur Kalibrierung eines Gierratensensors eines Fahrassistenzsystems | |
WO2022179794A1 (de) | Verfahren zum ermitteln mindestens eines systemzustands mittels eines kalman-filters |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
R016 | Response to examination communication | ||
R016 | Response to examination communication | ||
R018 | Grant decision by examination section/examining division | ||
R020 | Patent grant now final |