-
Technisches Gebiet
-
Die vorliegende Erfindung bezieht sich auf eine Positioniervorrichtung eines Bewegtkörpers und genauer gesagt bezieht sich auf eine Positioniervorrichtung, die Sendesignale aus GPS-(Globales Positionierungssystem)Satelliten verwendet.
-
Hintergrund
-
Derzeit sind Navigationsvorrichtungen von Bewegtkörpern, wie etwa Fahrzeugen, bekannt. Diese Navigationsvorrichtung zeigt eine Fahrzeugposition auf einer Karte an und gibt eine Führung zu einem Ziel. Wenn eine Fahrzeugposition auf einer Straße auf einer Karte angezeigt wird, werden eine GPS-Positioniervorrichtung, die GPS-Satelliten-Positionierungsergebnisse ermittelt, und verschiedene Sensoren, wie ein Geschwindigkeitssensor, ein Winkelgeschwindigkeitssensor und ein Beschleunigungssensor verwendet, um eine Fahrzeugbewegung zu beobachten und zu messen und dann wird eine Verarbeitung durchgeführt, die Kartenabgleich (map matching) genannt wird, um die Fahrzeugposition auf einer Straßenverbindung von Kartendaten zu identifizieren.
-
Jedoch unterscheidet sich ein Skalierungsfaktor zum Berechnen einer Bewegtdistanz und einer Geschwindigkeit, basierend auf Ausgangsimpulsen eines Geschwindigkeitssensors von Fahrzeug zu Fahrzeug. Weiter fluktuieren (driften) Nullspannungen eines Winkelgeschwindigkeitssensors und eines Beschleunigungssensors und daher müssen verschiedene Sensoren optional korrigiert werden. Um verschiedene Sensoren zu korrigieren, werden allgemein Positionierergebnisse, die aus GPS-Satelliten gesendet werden, für einen Korrektur-Referenzwert oder für Korrekturbedingungen verwendet.
-
Beispielsweise offenbart Patentdokument 1 eine Technik des Berechnens einer Fahrzeuggeschwindigkeit in einer horizontalen Richtung (einer Richtung auf einer horizontalen Ebene vertikal zu einer vertikalen Richtung), basierend auf Signalen (Positionierergebnissen) aus GPS-Satelliten und Korrigieren eines Skalierungsfaktors, basierend auf der berechneten Fahrzeuggeschwindigkeit. Weiterhin offenbaren Patentdokument 2 und Patentdokument 3 Techniken des Berechnens eines Neigungswinkels (eines Winkels, der zwischen einer Fahrtrichtung eines Fahrzeugs und der horizontalen Ebene gebildet ist), basierend auf Signalen aus GPS-Satelliten und Berechnen einer Beschleunigung des Fahrzeugs in einer Fahrtrichtung, eine Gravitations-Beschleunigung und eine Fluktuation einer Nullspannung des Beschleunigungssensors, basierend auf dem berechneten Neigungswinkel.
-
Stand-der-Technik-Dokumente
-
Patentdokumente
-
- Patentdokument 1: Japanisches Patent JP 4 370 565 B2
- Patentdokument 2: Japanisches Patent JP 4 776 570 B2
- Patentdokument 3: Japanische Patentoffenlegungsschrift JP 2003-307 524 A
-
Zusammenfassung der Erfindung
-
Durch die Erfindung zu lösende Probleme
-
Jedoch weist die obige Positioniervorrichtung, das heißt eine Positioniervorrichtung, welche eine Position eines Fahrzeugs basierend auf Positionierergebnissen aus GPS-Satelliten und Messergebnissen aus verschiedenen Sensoren misst, die folgenden Probleme auf.
- (1) Ein Ausgangsimpuls eines Geschwindigkeitssensors wird anhand von Rotationen von Reifen auf einer Straßenoberfläche ausgegeben. Damit gibt es ein Problem, dass beim Fahren auf einer geneigten Straße, auf welcher eine zweidimensionale Fahrzeuggeschwindigkeit auf einer horizontalen Ebene, die als Positionierergebnisse aus GPS-Satelliten erhalten wird, und eine tatsächliche dreidimensionale Fahrzeuggeschwindigkeit nicht zueinander passen, eine Distanz (= Impulsanzahl × Skalierungsfaktor) länger als eine durch Kartendaten auf der horizontalen Ebene angegebene Straßenverknüpfungslänge gemessen wird.
- (2) Um eine Fahrzeuggeschwindigkeit eines dreidimensionalen ENU-Koordinatensystems (ein orthogonales System, in welchem die Ostrichtung als eine x-Achse definiert ist, die Nordrichtung als eine y-Achse definiert ist und eine vertikale Richtung als eine Z-Achse definiert ist und eine xy-Ebene als eine horizontale Ebene definiert ist), basierend auf Positionierergebnissen aus GPS-Satelliten zuerst eine Distanzänderungsrate mit derselben Einheit ([m/s]) wie eine Zeitänderung bei Pseudo-Distanzen aus einem Änderungsbetrag (Dopplerverschiebung) einer Trägerfrequenz einer GPS-Satelliten-Funkwelle berechnet wird. Zusätzlich zur Berechnung wird die Distanzänderungsrate in einem Fall, bei dem ein Fahrzeug gestoppt ist, abgeschätzt und wird eine Fahrzeuggeschwindigkeit aus einer Differenz zwischen beiden Distanzänderungsraten berechnet. Jedoch gibt es das Problem, dass bei Fahren in niedriger Geschwindigkeit, welches eine Differenz zwischen einer berechneten Distanzänderungsrate und einer geschätzten Distanzänderungsrate kleiner macht, ein Fahrzeuggeschwindigkeitsfehler groß wird.
- (3) Eine Positioniervorrichtung führt Positionierung unter der Annahme durch, dass Zeiten von eingebauten Uhren von GPS-Satelliten und eine Zeit einer eingebauten Uhr eines Fahrzeugs mit einer gemeinsamen Zeitsequenz synchronisieren (GPS-Zeit). Eingebaute Uhren sowohl in den GPS-Satelliten als auch im Fahrzeug, driften und daher ist es notwendig, optimal die entsprechenden Uhren zu modifizieren. Generell werden teure Atomuhren mit geringer Gangabweichung als eingebaute Uhren der GPS-Satellit verwendet und wird eine preisgünstige Kristalluhr mit signifikanter Abweichung als eine eingebaute Uhr eines Fahrzeugs verwendet. Drift-Korrektur-Parameter von Atomuhren werden aus GPS-Satelliten an ein Fahrzeug gesendet und das Fahrzeug kann eine Drift der eingebauten Uhr des Fahrzeugs durch Empfangen von Signalen aus den GPS-Satelliten modifizieren. Jedoch gibt es ein Problem damit, dass, selbst wenn die Modifikation auf diese Weise durchgeführt wird, ein Fehler gleich oder kleiner 1 μs in der eingebauten Uhr im Fahrzeug verbleibt, dieser eingebaute Uhrfehler ein Messfehler einer Distanzänderungsrate ist, die allen GPS-Satelliten gemein ist, welche Signale an das Fahrzeug senden, und die Genauigkeit zum Messen beispielsweise einer Fahrzeuggeschwindigkeit beeinträchtigt.
-
Die vorliegende Erfindung ist im Hinblick auf die obigen Probleme gemacht worden. Eine Aufgabe der vorliegenden Erfindung ist es, in einer Positioniervorrichtung eines Bewegtkörpers, wie etwa eines Fahrzeugs, eine Technik bereitzustellen, welche Fehler der eingebauten Uhr eines Bewegtkörpers modifizieren und die Genauigkeit einer Geschwindigkeit verbessern kann.
-
US 7 987 047 B2 betrifft ein Navigationsgerät mit einer Verarbeitungseinheit für ein GPS-Signal, die eine Entfernungsänderungsrate auf der Basis von Dopplerverschiebungen der Trägerfrequenz des GPS-Signals ermittelt. Durch Bestimmung der Position des Fahrzeugs wird unter Einbeziehung der Entfernungsänderungsrate der Fehler einer fahrzeugseitigen Uhr abgeschätzt und korrigiert.
-
DE 196 45 528 A1 beschreibt ein Satelliten-Navigationsverfahren für eine Mobilstation in einem Fahrzeug, das eine erhöhte Genauigkeit der Positionsbestimmung mittels Korrektur der Entfernungsrate errechnet. Dazu werden gemessene Entfernungsänderungen über die Pseudo-Distanzen, über Dopplerverschiebungen und über die Fahrzeuggeschwindigkeit bestimmt. Ein Uhrenfehler des Empfängers wird ebenfalls abgeschätzt und berücksichtigt.
-
Mittel zum Lösen der Probleme
-
Eine Positioniervorrichtung gemäß der vorliegenden Erfindung ist eine Positioniervorrichtung mit den Merkmalen gemäß Patentanspruch 1. Vorteilhafte Ausgestaltungen ergeben sich aus den Unteransprüchen.
-
Effekte der Erfindung
-
Die vorliegende Erfindung berechnet einen Einbauuhr-Fehler, basierend auf einer Differenz zwischen einer Delta-Distanz-Rate (Delta-Bereich) und einer ersten Distanzänderungsrate (Bereichsrate), und modifiziert einen Fehler der ersten Distanzänderungsrate, indem sie den Einbauuhr-Fehler verwendet. Folglich ist es möglich, einen Fehler der ersten Geschwindigkeit, der durch den Einbauuhr-Fehler verursacht wird, zu reduzieren und die Genauigkeit der ersten Geschwindigkeit zu vergrößern.
-
Kurze Beschreibung der Zeichnungen
-
1 ist ein Blockdiagramm, das eine Konfiguration einer Navigationsvorrichtung gemäß einer ersten Ausführungsform zeigt.
-
2 ist ein Flussdiagramm, das einen Betrieb der Navigationsvorrichtung gemäß der ersten Ausführungsform zeigt.
-
3 ist eine Ansicht, die eine Delta-Distanzänderungsrate und eine berechnete Distanzänderungsrate zeigt.
-
4 ist eine Ansicht, die einen Einbauuhr-Fehler zeigt.
-
5 ist eine Ansicht, die eine Fahrzeugstopp-Distanzänderungsrate, eine modifizierte Distanzänderungsrate und eine Delta-Distanzänderungsrate zeigt.
-
6 ist eine Ansicht, die Mehrfachpfade zeigt.
-
7 ist eine Ansicht, die eine durch einen Geschwindigkeitssensor gemessene Eigenfahrzeug-Geschwindigkeit zeigt.
-
8 ist ein Blockdiagramm, das eine Konfiguration einer Navigationsvorrichtung gemäß einer zweiten Ausführungsform zeigt.
-
9 ist ein Flussdiagramm, das einen Betrieb der Navigationsvorrichtung gemäß der zweiten Ausführungsform zeigt.
-
10 ist ein Blockdiagramm, das eine Konfiguration einer Navigationsvorrichtung gemäß einer dritten Ausführungsform zeigt.
-
11 ist ein Flussdiagramm, das einen Betrieb der Navigationsvorrichtung gemäß der dritten Ausführungsform zeigt.
-
12 ist eine Ansicht, die ein durch die Navigationsvorrichtung gemäß der dritten Ausführungsform erhaltenes Ergebnis zeigt.
-
13 ist eine Ansicht, die ein durch die Navigationsvorrichtung gemäß der dritten Ausführungsform erhaltenes Ergebnis zeigt.
-
14 ist eine Ansicht, die ein durch die Navigationsvorrichtung gemäß der dritten Ausführungsform erhaltenes Ergebnis zeigt.
-
15 ist ein Blockdiagramm, das eine Konfiguration der Navigationsvorrichtung gemäß einer vierten Ausführungsform zeigt.
-
16 ist ein Flussdiagramm, das einen Betrieb der Navigationsvorrichtung gemäß der vierten Ausführungsform zeigt.
-
17 ist ein Flussdiagramm, das den Betrieb der Navigationsvorrichtung gemäß der vierten Ausführungsform zeigt.
-
18 ist eine Ansicht, die einen gemessenen Neigungswinkel zeigt, der durch eine Neigungswinkel-Messeinheit gemessen wird.
-
Beschreibung von Ausführungsformen
-
Erste Ausführungsform
-
Eine Navigationsvorrichtung mit einer Positioniervorrichtung eines Bewegtkörpers, wie etwa ein Fahrzeug, wird unten beschrieben. 1 ist ein Blockdiagramm, das eine Konfiguration zeigt, die zum Messen einer Position des Fahrzeugs (auch als ein ”Eigenfahrzeug” bezeichnet) in einer Konfiguration der Navigationsvorrichtung gemäß der ersten Ausführungsform der vorliegenden Erfindung nötig ist.
-
Die in 1 gezeigte Navigationsvorrichtung weist einen GPS-Empfänger 11 auf, der Sendesignale von GPS-Satelliten empfängt, um Rohdaten (Daten wie etwa Pseudo-Distanzen, Dopplerverschiebungen, Navigationsnachrichten und GPS-Zeiten, die für die Positionierberechnung erforderlich sind) basierend auf den Sendesignalen zu erhalten, und eine Positioniereinheit 12, die eine Eigenfahrzeugposition (z. B. eine Position auf einem Breitengrad und einem Längengrad), eine Eigenfahrzeug-Geschwindigkeit und einen Eigenfahrzeug-Azimut misst, basierend auf den durch den GPS-Empfänger 11 erhaltenen Rohdaten.
-
Weiter weist diese Navigationsvorrichtung einen Kartenspeicher 13 auf, der Kartendaten einschließlich Daten speichert, die lineare Formen und durch Koordinatenpunkte repräsentierte Straßenverbindungen angibt, und eine Straßen-Abgleichseinheit 14, die eine Straßenverbindung aus dem Kartenspeicher 13 liest, basierend auf der Eigenfahrzeugposition, der Eigenfahrzeug-Geschwindigkeit und dem Eigenfahrzeug-Azimut, die durch die Positioniereinheit 12 gemessen sind, um die Eigenfahrzeugposition auf der Straßenverbindung zu identifizieren.
-
Als Nächstes werden im Detail der GPS-Empfänger 11 und die Positioniereinheit 12 beschrieben.
-
Der GPS-Empfänger 11 weist eine GPS-Antenne, die Sendesignale (Funkwellen) empfängt, die als eine Mehrzahl von GPS-Satelliten über dem Eigenfahrzeug gesendet werden, empfängt. Der GPS-Empfänger 11 ermittelt Rohdaten, basierend auf einem an der GPS-Antenne empfangenen und aus jedem GPS-Satelliten ausgegebenen Sendesignal, um die Rohdaten an die Positioniereinheit 12 auszugeben.
-
Die Positioniereinheit 12 weist eine GPS-Ausgangsdaten-Berechnungseinheit 121, eine Pseudo-Distanz-Modifiziereinheit 122, eine Einbauuhr-Fehler-Schätzeinheit 123, eine GPS-Satelliten-Verhaltensabschätzeinheit 124, eine Distanzänderungsraten-Schätzeinheit 125, eine Eigenfahrzeugpositions-Berechnungseinheit 126 und eine Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit (Bewegtkörper-Geschwindigkeits-Berechnungseinheit) 127 auf.
-
Wie im Detail weiter unten beschrieben, berechnet die GPS-Ausgangsdaten-Berechnungseinheit 121 eine Differenz zwischen Pseudo-Distanzen an aufeinanderfolgenden Zeitpunkten bezogen auf eine Zeitspanne als eine Delta-Distanz-Rate ΔρCr(ti), basierend auf der Pseudo-Distanz ρCr(ti) (im Wesentlichen eines Sendesignals eines GPS-Satelliten) aus dem GPS-Empfänger 11. Zusätzlich gibt ti eine Zeit der Positionierverarbeitung der Positioniereinheit 12 an, die in einem Prozesszyklus ΔT wiederholt wird, und gibt ein tiefgestelltes i eine Anzahl an, die pro Verarbeitungszyklus ΔT um Eins ansteigt.
-
Weiter berechnet die GPS-Ausgangsdaten-Berechnungseinheit 121 eine erste Distanzänderungsrate Δρrate(ti) mit derselben Einheit ([m/s]) wie eine Delta-Distan-Rate ΔρCr(ti), basierend auf einer Dopplerverschiebung fdop(ti) (im Wesentlichen eine Dopplerverschiebung eines Sendesignals aus dem GPS-Satelliten) aus dem GPS-Empfänger 11. Die GPS-Ausgangsdaten-Berechnungseinheit 121 berechnet die Delta-Distanz-Rate ΔρCr(ti) und die erste Distanzänderungsrate Δρrate(ti) jedes GPS-Satelliten (auch als ein ”Empfangssatellit” bezeichnet), dessen Sendesignal durch den GPS-Empfänger 11 empfangen wird.
-
Zusätzlich erscheint eine Mehrzahl von Typen von Distanzänderungsraten in der nachfolgenden Beschreibung. Daher wird die erste Distanzänderungsrate Δρrate(ti), berechnet durch die GPS-Ausgangsdaten-Berechnungseinheit 121, aus Gründen der Bequemlichkeit als eine ”berechnete Distanzänderungsrate Δρrate(ti)” bezeichnet.
-
Die Pseudo-Distanz-Modifiziereinheit 122 berechnet einen Satelliten-montierten Uhr-Fehler dTsat, einen Ionosphären-Funkwellenausbreitungs-Verzögerungsfehler diono, und einen Troposphären-Funkwellenausbreitungs-Verzögerungsfehler dtrop, die in der aus dem GPS-Empfänger 11 ausgegebenen Pseudo-Distanz ρCr(ti) enthalten sind, unter Verwendung der aus dem GPS-Empfänger 11 ausgegebenen Navigationsnachricht, und berechnet eine modifizierte Pseudo-Distanz (auch als eine ”modifizierte Pseudo-Distanz ρCr'(ti)” bezeichnet), um diese Fehler auszuschließen.
-
Die Einbauuhr-Fehler-Schätzeinheit 123 empfängt eine Eingabe der Delta-Distanz-Raten ΔρCr(ti) und der berechneten Distanzänderungsraten Δρrate(ti) aller Empfangs-Satelliten, berechnet durch die GPS-Ausgangsdaten-Berechnungseinheit 121. Die Einbauuhr-Fehler-Schätzeinheit 123 schätzt einen Fehler einer im Eigenfahrzeug vorgesehenen Einbauuhr als ein Einbauuhr-Fehler εtcar(ti) basierend auf der Differenz (in diesem Fall Delta) zwischen der Delta-Distanz-Rate ΔρCτ(ti) und der berechneten Distanzänderungsrate Δρrate(ti), ab.
-
Zusätzlich kann die Einbauuhr-Fehler-Schätzeinheit 123 einen Einbauuhr-Fehler εtcar(ti) aus der Delta-Distanz-Rate ΔρCτ(ti) und der berechneten Distanz-Rate Δρrate(ti) eines Empfangs-Satelliten abschätzen. Wenn jedoch eine Eingabe von Delta-Distanz-Raten ΔρCτ(ti) und berechneten Distanzänderungsraten Δρrate(ti) einer Mehrzahl von Empfangs-Satelliten empfangen wird, schätzt die Einbauuhr-Fehler-Schätzeinheit 123 einen Durchschnittswert einer Mehrzahl von Einbauuhr-Fehlern εtcar(ti) ab als einen Einbauuhr-Fehler εtcar(ti).
-
Die GPS-Satelliten-Verhaltensabschätzeinheit 124 schätzt eine Position PS und eine Geschwindigkeit VS eines GPS-Satelliten in einer GPS-Zeit ab, basierend auf der aus dem GPS-Empfänger 11 ausgegebenen Navigationsnachricht. Die GPS-Satelliten-Verhaltensabschätzeinheit 124 schätzt die Positionen PS und die Geschwindigkeiten VS aller Empfangs-Satelliten mehrmals während der Umwandlungsberechnung pro Verarbeitungszyklus der Positioniereinheit 12 ab.
-
Die Distanzänderungsraten-Schätzeinheit 125 empfängt eine Eingabe der berechneten Distanzänderungsraten Δρrate(ti) aus der GPS-Ausgangsdaten-Berechnungseinheit 121, dem Einbauuhr-Fehler εtcar(ti) aus der Einbauuhr-Fehler-Schätzeinheit 123, der Positionen PS und der Geschwindigkeiten VS aller Empfangs-Satelliten aus der GPS-Satelliten-Verhaltensabschätzeinheit 124 und einer Eigenfahrzeugposition PO (neu berechnete GPS-Position), berechnet durch die unten beschriebene Eigenfahrzeugpositions-Berechnungseinheit 126.
-
Die Distanzänderungsraten-Schätzeinheit 125 schätzt eine zweite Distanzänderungsrate Δρrate-s(ti) in einem Fall ab, in dem ein Fahrzeug als anhaltend angenommen wird, basierend auf den Positionen PS, den Geschwindigkeiten VS aller Empfangs-Satelliten und der Eigenfahrzeugpositionen PO. Zusätzlich wird die durch die Distanzänderungsraten-Schätzeinheit 125 in einem Fall, bei dem das Fahrzeug als gestoppt angenommen wird, abgeschätzte zweite Distanzänderungsrate Δρrate-s(ti) als eine ”Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti)” unten bezeichnet. Weiter, zusätzlich zur Schätzung der Fahrzeugstopp-Distanzänderungsrate modifiziert die Distanzänderungsraten-Schätzeinheit 125 die berechnete Distanzänderungsrate Δρrate(ti), berechnet durch die GPS-Ausgangsdaten-Berechnungseinheit 121, basierend auf den durch die Einbauuhr-Fehler-Schätzeinheit 123 abgeschätzten Einbauuhr-Fehler εtcar(ti).
-
Die Eigenfahrzeugpositions-Berechnungseinheit 126 führt Numerikwert-Berechnung durch, basierend auf den modifizierten Pseudo-Distanzen ρCτ'(ti) aus der Pseudo-Distanz-Modifiziereinheit 122 und den Positionen PS und den Geschwindigkeiten VS aller Empfangs-Satelliten aus der GPS-Satelliten-Verhaltensabschätzeinheit 124, um die Eigenfahrzeugposition PO zu berechnen, und gibt die Eigenfahrzeugposition PO an die Distanzänderungsraten-Schätzeinheit 125 und die Straßen-Abgleichseinheit 14 aus. Weiter erzeugt die Eigenfahrzeugpositions-Berechnungseinheit 126 eine Navigationsmatrix A, welche die Positionen PS aller Empfangs-Satelliten aus der GPS-Satelliten-Verhaltensabschätzeinheit 124 beinhaltet, und die durch die Eigenfahrzeugpositions-Berechnungseinheit 126 berechnete Eigenfahrzeugposition PO beinhaltet, und gibt die Navigationsmatrix A an die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 aus.
-
Die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 berechnet Eigenfahrzeug-Geschwindigkeiten VO (erste Geschwindigkeiten VO), die sich auf drei Achsenrichtungen beziehen, die ein ENU-Koordinatensystem bilden (ein orthogonales Koordinatensystem, in welchem die Ostrichtung als eine x-Achse definiert ist, die Nordrichtung als eine y-Achse definiert ist, die Vertikalrichtung als eine Z-Achse definiert ist und die xy-Ebene als eine Horizontalebene definiert ist), das heißt neu berechnete GPS-Geschwindigkeiten, basierend auf der Navigationsmatrix A aus der Eigenfahrzeugpositions-Berechnungseinheit 126, der durch die Distanzänderungsraten-Schätzeinheit 125 geschätzten Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti) und der durch die Distanzänderungsraten-Schätzeinheit 125 modifizierten berechneten Distanzänderungsrate Δρrate(ti). Zusätzlich kann die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 auch einen Eigenfahrzeug-Azimut berechnen, durch Berechnen dieser Eigenfahrzeug-Geschwindigkeit VO.
-
Als Nächstes wird ein Betrieb der Navigationsvorrichtung in 1 unter Bezugnahme auf das Flussdiagramm in 2 beschrieben, das durch die Positioniereinheit 12 durchgeführte Positionierverarbeitung pro Verarbeitungszyklus zeigt.
-
Zuerst initialisiert im in 2 gezeigten Schritt S1 die Navigationsvorrichtung die Verarbeitung der Positioniereinheit 12.
-
Im Schritt S2 bestimmt die Positioniereinheit 12, ob die Anzahl von Empfangs-Satelliten eins oder mehr ist, das heißt ob aus einem oder mehr GPS-Satelliten gesendete Signale empfangen werden oder nicht. Wenn festgestellt wird, dass die Sendesignale empfangen werden, bewegt sich der Schritt zu Schritt S3 und wenn festgestellt wird, dass kein Sendesignal empfangen wird, wird die aktuelle Positionierverarbeitung ohne Durchführen irgendwelcher Verarbeitung beendet.
-
Im Schritt S3 berechnet die GPS-Ausgangsdaten-Berechnungseinheit 121 einen Zeitdifferenzwert zwischen der Pseudo-Distanz vorheriger Positionierverarbeitung und vorheriger Pseudo-Distanz aktueller Positionierverarbeitung als eine Delta-Distanz-Rate ΔρCτ(ti) durch Anwenden auf die nachfolgende Gleichung (1) der Pseudo-Distanz ρCτ(ti-1) von vorherigen Positionierverarbeitung und der Pseudo-Distanz ρCτ(ti) der aus dem GPS-Empfänger 11 ausgegebenen aktuellen Positionierverarbeitung.
-
[Gleichung 1]
-
- ΔρCτ(ti) = (ρCτ(ti) – ρCτ(ti-1))/Δt (1) wobei,
- ΔρCτ(ti):
- Delta-Distanzänderungsrate [m/s]
- ρCτ(ti):
- Pseudo-Distanz, die bei aktueller Positionierverarbeitung aus GPS-Empfänger ausgegeben wird [m]
- ρCτ(ti-1):
- Aus GPS-Empfänger bei vorheriger Positionierverarbeitung ausgegebene Pseudo-Distanz [m]
- Δt:
- Verarbeitungszyklus [s]
-
Weiter berechnet im selben Schritt S3 die GPS-Ausgangsdaten-Berechnungseinheit 121 die berechnete Distanzänderungsrate Δρrate(ti) durch Anwenden, auf die nachfolgende Gleichung (2), der aus dem GPS-Empfänger 11 ausgegebenen Dopplerverschiebung fdop(ti)
-
[Gleichung 2]
-
-
Δρrate(ti) = fdop(ti)·C/fL1 (2)
- Δρrate(ti):
- Berechnete Distanzänderungsrate [m/s]
- fLI:
- Trägerfrequenz von Satelliten-Funkwelle [Hz]
- C:
- Geschwindigkeit von Licht [m/s]
-
Im Schritt S4 berechnet die Pseudo-Distanz-Modifiziereinheit 122 den Satelliten-montierten Uhr-Fehler dTsat und den Ionosphären-Funkwellenausbreitungs-Verzögerungsfehler diono, in der Pseudo-Distanz ρCτ(ti-1) enthalten, basierend auf der aus dem GPS-Empfänger 11 ausgegebenen Navigationsnachricht und berechnet den Troposphären-Funkwellenausbreitungs-Verzögerungsfehler dtrop, der in der Pseudo-Distanz ρCτ(ti) enthalten ist, basierend auf einem Fehlermodell. Weiter berechnet die Pseudo-Distanz-Modifiziereinheit 122 eine modifizierte Pseudo-Distanz ΔρCτ'(ti) durch Modifizieren der Pseudo-Distanz ρCτ(ti) durch Anwenden der nachfolgenden Gleichung (3), der Pseudo-Distanz ρCτ(ti) und dieser Fehler.
-
[Gleichung 3]
-
- ρCτ'(ti) = ρCτ(ti) + dTsat – diono – dtrop (3) Wobei
- ΔρCτ'(ti):
- Modifizierte Pseudo-Distanz [m]
- dTsat:
- Satelliten-montierter Uhr-Fehler [m]
- diono:
- Ionosphären-Funkwellenausbreitungs-Verzögerungsfehler [m]
- dtrop:
- Troposphären-Funkwellenausbreitungs-Verzögerungsfehler [m]
-
Im Schritt S5 wendet die Einbauuhr-Fehler-Schätzeinheit 123 die Delta-Distanz-Raten ΔρCτ(ti) und die berechneten Distanzänderungsraten Δρrate(ti) aller im Schritt S3 ermittelten Empfangs-Satelliten auf die nachfolgende Gleichung (4) an, welche diese Deltas enthält, um einen Einbauuhr-Fehler εtcar(ti) abzuschätzen. Wenn die Anzahl von Empfangs-Satelliten mehrere ist, das heißt eine Mehrzahl von Einbauuhr-Fehlern εtcar(ti) ermittelt werden kann, ist der Durchschnittswert der Einbauuhr-Fehler ein Einbauuhr-Fehler εtcar(ti).
-
[Gleichung 4]
-
- εtcar(ti) = (Δρrate(ti) – ΔρCτ(ti))·Δt/C (4) Wobei:
- Etcar(ti):
- Einbauuhr-Fehler [2]
- Δρrate(ti):
- berechnete Distanzänderungsrate [m/s]
- ΔρCτ(ti):
- Delta-Distanz-Rate [m/s]
- Δt:
- Prozesszyklus [s]
- C:
- Lichtgeschwindigkeit [m/s]
-
3 ist eine Ansicht, die ein tatsächliches Berechnungsergebnis der Delta-Distanz-Rate ρCτ(ti) und der berechneten Distanzänderungsrate Δρrate(ti) zeigt. 3 zeigt die Delta-Distanz-Rate ρCτ(ti) als eine durchgezogene Linie und die berechnete Distanzänderungsrate Δρrate(ti) als eine unterbrochene Linie.
-
4 zeigt eine Ansicht, die den Einbauuhr-Fehler εtcar(ti) zeigt, der durch Anwenden des in 3 gezeigten Berechnungsergebnisses auf Gleichung (4) erhalten wird. Wie in dieser Figur gezeigt, kann der Einbauuhr-Fehler εtcar(ti), das heißt eine Drift der Einbauuhr nicht in einem linearen Format ausgedrückt werden, und daher ist die Frequenz zum Abschätzen des Einbauuhr-Fehlers εtcar(ti) vorzugsweise hoch.
-
Zurück zu 2, führt nach Schritt S5 die Positioniereinheit 12 eine Konvergenzberechnung an der Eigenfahrzeugposition PO, basierend auf den Rohdaten, das heißt den Sendesignalen aus den GPS-Satelliten) durch, indem sie eine Schleifen..? in Schritt S6 bis Schritt S13 in einer Positionierverarbeitung durchführt. Wenn beispielsweise eine Differenz zwischen der Eigenfahrzeugposition PO, die durch vorherige Schleifen-Verarbeitung erhalten wird, und der durch die aktuelle Schleifen-Verarbeitung erhaltenen Eigenfahrzeugposition PO gleich oder kleiner einem vorbestimmten Wert ist, beendet die Positioniereinheit 12 die Schleifen-Verarbeitung. Die in diesem Fall erhaltene Eigenfahrzeugposition wird als eine durch aktuelle Positionierverarbeitung ermittelte Eigenfahrzeugposition ausgegeben.
-
Als Nächstes wird ein Betrieb jedes Schrittes von Schritt S6 bis Schritt S11 im Detail beschrieben.
-
Zuerst schätzt in Schritt S6 die GPS-Satelliten-Verhaltensabschätzeinheit 124 die Positionen PS (xs, ys, zs) und die Geschwindigkeiten VS (VSx, VSy, VSz) aller Empfangs-Satelliten in der GPS-Zeit unter Verwendung einer Ephemeride, die in der Navigationsnachricht aus dem GPS-Empfänger 11 enthalten ist, ab, und gibt Positionen der GPS-Satelliten auf einer Trajektorie an. Nachdem die GPS-Zeit durch die GPS-Zeit aus dem GPS-Empfänger 11 initialisiert ist, ändert sich ein Wert der GPS-Zeit während der Konvergenzberechnung und dieser Änderung folgend, ändern sich auch die Positionen PS und die Geschwindigkeiten VS der GPS-Satelliten auf einer Satelliten-Trajektorie.
-
In Schritt S7 schätzt die Distanzänderungsraten-Schätzeinheit
125 die Fahrzeugstopp-Distanzänderungsrate Δρ
rate-s(t
i) durch Anwenden auf nachfolgende Gleichung (5) der Positionen P
S (x
s, y
s, z
s) und der Geschwindigkeiten V
S (V
sx, V
sy, V
sz) aller Empfangs-Satelliten, welche durch die GPS-Satelliten-Verhaltensabschätzeinheit
124 geschätzt sind, und die durch die Eigenfahrzeugpositions-Berechnungseinheit
126 geschätzte Eigenfahrzeugposition P
O (x
o, y
o, z
o) ab. Zusätzlich wird für die Eigenfahrzeugposition P
O die Eigenfahrzeugposition P
O, die in Schritt S9 in der vorherigen Schleifen-Verarbeitung oder vorherigen Positionsverarbeitung berechnet ist, verwendet. [Gleichung 5]
Wobei:
- ρrate-s(ti):
- Fahrzeugstopp-Distanzänderungsrate [m/s]
- PS:
- Positionen (xs, ys, zs) eines GPS-Satelliten, die aus der Navigationsnachricht berechnet sind [m]
- VS:
- Geschwindigkeiten (VSx, VSy, VSz) eines GPS-Satelliten, berechnet aus der Navigationsnachricht [m/s]
- PO:
- Eigenfahrzeugposition (xo, yo, zo) [m]
- ||PS – PO||:
- Distanz zwischen GPS-Satellitenposition und Eigenfahrzeugposition [m]
- LOS:
- Linie von Ortsvektor, der von Eigenfahrzeug auf GPS-Satellit blickt
-
Weiter, zusätzlich zur Abschätzung der Fahrzeugstopp-Distanzänderungsrate, wendet die Distanzänderungsraten-Schätzeinheit 125 auf nachfolgende Gleichung (6) die berechnete Distanzänderungsrate Δρrate(ti), die im Schritt S3 durch die GPS-Ausgangsdaten-Berechnungseinheit 121 berechnet ist, und den εtcar(ti), der in Schritt S5 durch die Einbauuhr-Fehler-Schätzeinheit 123 abgeschätzt ist, an. Das heißt, dass die Distanzänderungsraten-Schätzeinheit 125 die berechnete Distanzänderungsrate Δρrate(ti), basierend auf dem Einbauuhr-Fehler εtcar(ti) modifiziert. Zusätzlich wird die durch die Distanzänderungsraten-Schatzeinheit 125 modifizierte berechnete Distanzänderungsrate auch als ”modifizierte Distanzänderungsrate Δρrate'(ti)” bezeichnet.
-
[Gleichung 6]
-
- Δρrate'(ti) = Δρrate(ti) – εtcar(ti)/Δt·C (6) Wobei:
- Δρrate'(ti):
- Modifizierte Distanzänderungsrate [m/s]
- Δρrate(ti):
- Berechnete Distanzänderungsrate [m/s]
- εtcar(ti):
- Einbauuhr-Fehler [s]
- Δt:
- Verarbeitungszyklus [s]
- C:
- Lichtgeschwindigkeit [m/s]
-
In dieser Hinsicht, um es leichter zu machen, eine Beziehung zwischen der Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti), die aus Gleichung (5) ermittelt wird, der modifizierten Δρrate'(ti), die aus Gleichung (6) erhalten wird, und der Delta-Distanz-Rate ΔρCτ(ti), der aus Gleichung (1) erhalten wird, zu verstehen, illustriert 5 Zeitübergänge der Fahrzeugstopp-Distanzänderungsrate, der modifizierten Distanzänderungsrate und der Delta-Distanzänderungsrate, ermittelt aus den in 3 gezeigten Daten. Zusätzlich wird in 5 die Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti) durch eine unterbrochene Linie angegeben, wird die modifizierte Distanzänderungsrate Δρrate'(ti) durch eine dicke durchgezogene Linie angegeben und wird die Delta-Distanzänderungsrate ΔρCτ(ti) durch eine dünne durchgezogene Linie angegeben.
-
6 zeigt eine Ansicht, die Mehrfachpfade zeigt, einschließlich Pfaden einer Satelliten-Funkwelle (reflektierte Welle), welche durch eine Architektur oder dergleichen reflektiert wird, und einer Satelliten-Funkwelle (Direktwelle), die nicht reflektiert wird. Eine abrupte Änderung, die in der durch die dünne durchgezogene Linie in 5 angegebenen Delta-Distanz-Rate ΔρCτ(ti) erscheint, gibt einen Hinweis auf einem Mehrfachpfadeinfluss. Zusätzlich illustriert 5 ein Datenergebnis, welches erhalten wird, wenn das eigene Fahrzeug aus einem Parkplatz heraus fährt, um den herum es eine kleine Anzahl von Gebäuden gibt. Selbst in diesem Fall tritt zeitweilig ein kleiner Mehrfachpfadeinfluss in der Delta-Distanz-Rate ΔρCτ(ti) auf.
-
Derweil, wie in 5 gezeigt, beinhaltet die durch obige Gleichung (6) ermittelte modifizierte Distanzänderungsrate Δρrate'(ti) den unterdrückten Mehrfachpfadeinfluss (abrupte Änderung), anders als die Delta-Distanz-Rate ΔρCτ(ti), und passt im Wesentlichen zur Delta-Distanz-Rate ΔρCτ(ti) außer dem Einfluss. Weiter passt diese modifizierte Distanzänderungsrate Δρrate'(ti) im Wesentlichen zur Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti) bei Fahrzeugstopp.
-
Als Nächstes zeigt 7 eine durch einen Geschwindigkeitssensor gemessene Eigenfahrzeug-Geschwindigkeit in derselben Situation wie derjenigen in 5. Eine Differenz zwischen der modifizierten Distanzänderungsrate Δρrate'(ti) und der Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti), die in 5 gezeigt ist, bezieht sich auf die durch den in 7 gezeigten Geschwindigkeitssensor gemessene Eigenfahrzeug-Geschwindigkeit. Somit ist es möglich, die Eigenfahrzeug-Geschwindigkeit durch Berechnen der Differenz zwischen der modifizierten Distanzänderungsrate Δρrate'(ti) und der Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti) zu berechnen. Folglich ist das Modifizieren der berechneten Distanzänderungsrate Δρrate(ti) basierend auf dem Einbauuhr-Fehler εtcar(ti), das heißt Berechnen der modifizierten Distanzänderungsrate Δρrate'(ti), wichtig.
-
Zurück zu 2, prüft in Schritt S8 die Positioniereinheit 12, ob die Anzahl von GPS-Satelliten, für welche eine Positionier-Berechnung durchgeführt werden kann, das heißt die Anzahl aller Empfangs-Satelliten, drei oder mehr beträgt. Wenn die Anzahl aller Empfangs-Satelliten drei oder mehr beträgt, bewegt sich der Schritt zum nächsten Schritt S9. Wenn die Anzahl aller Empfangs-Satelliten kleiner als drei ist, wird die aktuelle Positionierverarbeitung beendet.
-
Im Schritt S9 berechnet die Eigenfahrzeugpositions-Berechnungseinheit
126 die Eigenfahrzeugposition P
O der aktuellen Schleifen-Verarbeitung durch Anwenden auf eine rechte Seite der nachfolgenden Gleichung (7) der modifizierten Pseudo-Distanzen ρ
Cτ'(t
i), berechnet in Schritt S4, der Positionen P
S und der Geschwindigkeiten V
S aller in Schritt S6 abgeschätzten Empfangs-Satelliten und der Eigenfahrzeugposition P
O, die in der vorherigen Schleifen-Verarbeitung oder vorherigen Positionierverarbeitung berechnet ist, durch die Eigenfahrzeugpositions-Berechnungseinheit
126. In diesem Fall erzeugt die Eigenfahrzeugpositions-Berechnungseinheit
126 die Navigationsmatrix A, die Positionen P
S aller im Schritt S6 geschätzten Empfangs-Satelliten und die durch die Eigenfahrzeugpositions-Berechnungseinheit
126 berechnete Eigenfahrzeugposition P
O beinhaltet. [Gleichung 7]
Wobei:
- PO:
- Eigenfahrzeugposition (xo, yo, zo) [m]
- δPO:
- Änderungsbetrag der Eigenfahrzeugposition (δxo, δyo, δzo) [m]
- A:
- Navigationsmatrix
- W:
- Gewichtete Matrix
- n:
- Anzahl von Empfangs-Satelliten
- σδρ:
- Standardabweichung, die sich auf Pseudo-Distanzfehler bezieht [m]
-
Zusätzlich wird eine Standardabweichung σδρ der Pseudo-Distanzfehler in Gleichung (7) pro Satellit eingeschlossen und wird daher aus einem Verlauf jedes Prozesszyklus berechnet. Weiter wird die Beschreibung von ”(ti)” in Gleichung (7) aus Gründen der einfachen Beschreibung weggelassen.
-
Im Schritt S10 berechnet die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit
127 die V
O (v
ox, v
oy, v
oz), die sich auf die drei Achsenrichtungen beziehen, welche das ENU-Koordinatensystem bilden, durch Anwenden, auf die folgende Formel (8) der Navigationsmatrix A aus der Eigenfahrzeugpositions-Berechnungseinheit
126, der Fahrzeugstopp-Distanzänderungsrate Δρ
rate-s(t
i), die durch die Distanzänderungsraten-Schätzeinheit
125 abgeschätzt wird, und der modifizierten Distanzänderungsrate Δρ
rate'(t
i). Die Differenz zwischen der Fahrzeugstopp-Distanzänderungsrate Δρ
rate-s(t
i) und der modifizierten Distanzänderungsrate Δρ
rate'(t
i), die in dieser Gleichung (8) beinhaltet ist, entspricht der Eigenfahrzeug-Geschwindigkeit, wie oben unter Bezugnahme auf
5 und
7 beschrieben. Weiter, ähnlich zu Gleichung (7), wird die Beschreibung von ”(t
i)” aus Gründen der einfachen Beschreibung in Gleichung (8) weggelassen. [Gleichung 8]
Wobei,
- VO:
- Eigenfahrzeug-Geschwindigkeit (vox, voy, voz) [m/s]
-
In Schritt S11 bestimmt die Positioniereinheit 12, ob die Eigenfahrzeugposition PO in der aktuellen Positionierverarbeitung konvergiert. Spezifischer, wenn ein Änderungsbetrag δPO der Eigenfahrzeugposition PO in der obigen Gleichung (7) kleiner als ein vorbestimmter Wert ist, wird festgestellt, dass die Eigenfahrzeugposition PO konvergiert und endet die Verarbeitung der Positioniereinheit 12 normal.
-
Derweil, wenn der Änderungsbetrag δPO gleich oder größer dem vorbestimmten Wert ist und die Anzahl von Malen der Berechnung der Eigenfahrzeugposition PO kleiner als eine vorbestimmte Anzahl ist, wird festgestellt, dass die Eigenfahrzeugposition PO nicht konvergiert, der Schritt kehrt zu Schritt S6 zurück und die Konvergenzberechnung wird wieder durchgeführt. Weiter, wenn der Änderungsbetrag δPO gleich oder größer dem vorbestimmten Wert ist und die Anzahl von Malen der Berechnung der Eigenfahrzeugposition PO die vorgegebene Anzahl ist, wird festgestellt, dass die Eigenfahrzeugposition nicht konvergieren kann und die Verarbeitung der Positioniereinheit 12 endet abnormal. Zusätzlich kann die Positioniereinheit 12 die Eigenfahrzeugposition, die Eigenfahrzeug-Geschwindigkeit und den Eigenfahrzeug-Azimut, der durch den GPS-Empfänger 11 berechnet wird, als Positionierergebnisse der Positioniereinheit 12 verwendet.
-
Die obige Navigationsvorrichtung gemäß der ersten Ausführungsform berechnet den Einbauuhr-Fehler εtcar(ti) basierend auf der Delta-Distanz-Rate ΔρCτ(ti), der als eine Zeitdifferenzwert zwischen Pseudo-Distanzen berechnet wird, die gegenüber einem Mehrfachpfadeinfluss empfindlich sind, und der berechneten Änderungsrate Δρrate(ti), die aus einer Dopplerverschiebung berechnet wird, die kaum durch einen Mehrfachpfad beeinflusst ist, und modifiziert einen Versatzfehler der berechneten Distanzänderungsrate Δρrate(ti) unter Verwendung des Einbauuhr-Fehlers. Folglich ist es möglich, einen Fehler der Eigenfahrzeug-Geschwindigkeit VO zu reduzieren, der durch den Einbauuhr-Fehler εtcar(ti) verursacht wird, und die Genauigkeit der Eigenfahrzeug-Geschwindigkeit VO (der Eigenfahrzeug-Geschwindigkeit VO bei Niedriggeschwindigkeitsfahrt) zu vergrößern. Weiter ist es auch möglich, die Genauigkeit eines Eigenfahrzeug-Azimut nachfolgend einem Anstieg bei der Genauigkeit der Eigenfahrzeug-Geschwindigkeit VO zu vergrößern.
-
Weiter, in der ersten Ausführungsform, wenn die Anzahl von Empfangs-Satelliten eins oder mehr beträgt, ist es möglich, den Einbauuhr-Fehler εtcar(ti) zu schätzen. Folglich ist es möglich, eine Änderungssituation des Einbauuhr-Fehlers εtcar(ti), welcher die Positionierungsgenauigkeit beeinflusst, über eine lange Zeit zu überwachen. Zusätzlich ist bei der ersten Ausführungsform ein Fall beschrieben worden, bei dem eine Eigenfahrzeugposition und eine Eigenfahrzeug-Geschwindigkeit unter Verwendung des Verfahrens gewichteter kleinster Quadrate berechnet werden. Jedoch kann eine Eigenfahrzeugposition und eine Eigenfahrzeug-Geschwindigkeit unter Verwendung sequentieller Berechnung oder eines Kalman-Filters berechnet werden.
-
Zweite Ausführungsform
-
8 ist ein Blockdiagramm, das eine Konfiguration zeigt, die benötigt wird, um eine Eigenfahrzeugposition in einer Konfiguration einer Navigationsvorrichtung gemäß einer zweiten Ausführungsform der vorliegenden Erfindung zu messen. Die zweite Ausführungsform ist gegenüber der ersten Ausführungsform erweitert und daher werden gleiche Teile wie jene in der ersten Ausführungsform nicht beschrieben und es werden hauptsächlich Differenzen beschrieben.
-
Die in 8 gezeigte Navigationsvorrichtung verwendet eine Konfiguration, bei der eine Auftritts-Mehrfachpfad-Evaluierungseinheit 128 zur Positioniereinheit 12 der in 1 gezeigten Navigationsvorrichtung hinzugefügt ist. Die Auftritts-Mehrfachpfad-Evaluierungseinheit 128 bestimmt, dass es einen Mehrfachpfadeinfluss gibt, wenn eine Änderung bei einem Einbauuhr-Fehler εtcar(ti), der durch die Einbauuhr-Fehler-Schätzeinheit 123 geschätzt wird, größer als ein vorbestimmter Wert ist. Die Auftritts-Mehrfachpfad-Evaluierungseinheit 128 bestimmt, dass es keinen Mehrfachpfadeinfluss gibt, wenn die Änderung beim Einbauuhr-Fehler εtcar(ti) gleich oder kleiner dem vorbestimmten Wert ist. Die Auftritts-Mehrfachpfad-Evaluierungseinheit 128 führt diese Bestimmung an jedem Empfangs-Satelliten durch.
-
Als Nächstes wird ein Betrieb der Navigationsvorrichtung in 8 unter Bezugnahme auf das Flussdiagramm in 9 beschrieben, das eine Positionierverarbeitung zeigt, welche durch die Positioniereinheit 12 pro Prozesszyklus durchgeführt wird. Zusätzlich werden in der nachfolgenden Beschreibung des Betriebs dieselben Teile wie jene in der ersten Ausführungsform nicht im Detail beschrieben und es werden Unterschiede beschrieben.
-
Zuerst werden dieselben Operationen wie jene in den obigen Schritten S1 bis Schritt S4 (siehe 2) in Schritt S21 bis Schritt S24 durchgeführt. Weiter führt nach Schritt S24 die Positioniereinheit 12 eine Konvergenzberechnung an der Eigenfahrzeugposition PO durch, basierend auf den Rohdaten, durch Durchführen einer Schleifen-Verarbeitung in Schritt S25 bis Schritt S31 in einer Positionierverarbeitung ähnlich zur ersten Ausführungsform. Als Nächstes wird ein Betrieb jedes Schrittes dieser Schleifen-Verarbeitung beschrieben.
-
Im Schritt S25 wendet die Einbauuhr-Fehler-Schätzeinheit 123 die Delta-Distanz-Raten ρCτ(ti) und die berechneten Distanzänderungsraten Δρrate(ti) aller Empfangs-Satelliten auf obige Gleichung (4) an und berechnet einen Einbauuhr-Fehler εtcar(ti) pro Empfangs-Satellit.
-
Weiter erzeugt im selben Schritt S25 die Auftritts-Mehrfachpfad-Evaluierungseinheit 128 pro Empfangs-Satelliten einen Verlauf des Einbauuhr-Fehlers εtcar(ti), berechnet durch die Einbauuhr-Fehler-Schätzeinheit 123 und bestimmt pro Empfangs-Satellit, ob die Änderung beim Einbauuhr-Fehler εtcar(ti) (eine Standardabweichung oder eine Differenz zwischen vorheriger Positionierverarbeitung und aktueller Positionierverarbeitung) größer als ein vorbestimmter Wert ist, oder nicht. Weiter bestimmt die Auftritts-Mehrfachpfad-Evaluierungseinheit 128, dass es einen Mehrfachpfadeinfluss auf einen Empfangs-Satelliten gibt, an welchem die Bestimmung durchgeführt wird, wenn diese Änderung (die Standardabweichung oder die Differenz) größer als der vorbestimmte Wert ist. Die Auftritts-Mehrfachpfad-Evaluierungseinheit 128 bestimmt, dass es keinen Mehrfachpfadeinfluss auf einen Empfangs-Satelliten gibt, an welchem die Bestimmung durchgeführt wird, wenn die Änderung gleich oder kleiner dem vorbestimmten Wert ist.
-
Weiter schließt im selben Schritt S25 die Einbauuhr-Fehler-Schätzeinheit 123 den Einbauuhr-Fehler εtcar(ti), der durch die Auftritts-Mehrfachpfad-Evaluierungseinheit 128 als durch einen Mehrfachpfad beeinflusst bestimmt wird, von den Einbauuhr-Fehlern εtcar(ti) aller Empfangs-Satelliten aus und schätzt einen Durchschnittswert der Einbauuhr-Fehler εtcar(ti) des Rests der Empfangs-Satelliten als den Einbauuhr-Fehler εtcar(ti) ab, der durch eine Distanzänderungsraten-Schätzeinheit 125 verwendet wird.
-
Im Schritt S26 führt die GPS-Satelliten-Verhaltensabschätzeinheit 124 dieselbe Verarbeitung wie diejenige im oben Schritt S6 am Empfangs-Satelliten durch, der durch die Auftritts-Mehrfachpfad-Evaluierungseinheit 128 bestimmt wird, nicht durch einen Mehrfachpfad beeinflusst zu sein. Im Schritt S27 führt die Distanzänderungsraten-Schätzeinheit 125 dieselbe Verarbeitung wie diejenige im obigen Schritt S7 an einem Empfangs-Satelliten durch, der durch die Auftritts-Mehrfachpfad-Evaluierungseinheit 128 als nicht durch einen Mehrfachpfad beeinflusst bestimmt wird.
-
Im Schritt S28 prüft die Positioniereinheit 12, ob die Anzahl von Empfangs-Satelliten, welche durch die Auftritts-Mehrfachpfad-Evaluierungseinheit 128 als nicht durch einen Mehrfachpfad beeinflusst bestimmt sind, drei oder mehr beträgt. Wenn die Anzahl von Empfangs-Satelliten drei oder mehr ist, bewegt sich der Schritt zum nächsten Schritt S29. Wenn die Anzahl von Empfangs-Satelliten kleiner als drei ist, wird die aktuelle Positionierverarbeitung beendet.
-
Im Schritt S29 führt die Eigenfahrzeugpositions-Berechnungseinheit 126 dieselbe Verarbeitung wie jene im obigen Schritt S9 an einem Empfangs-Satelliten durch, welcher durch die Auftritts-Mehrfachpfad-Evaluierungseinheit 128 als nicht durch einen Mehrfachpfad zu beeinflussen festgestellt wird. Im Schritt S30 führt eine Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 dieselbe Verarbeitung wie diejenige im obigen Schritt S10 am Empfangs-Satelliten durch, welcher durch die Auftritts-Mehrfachpfad-Evaluierungseinheit 128 als nicht durch einen Mehrfachpfad zu beeinflussen festgestellt ist.
-
Im Schritt S31 bestimmt die Positioniereinheit 12, ob die Eigenfahrzeugposition PO in der aktuellen Positionierverarbeitung konvergiert, ähnlich zum obigen Schritt S11. Spezifischer, wenn ein Änderungsbetrag δPO der Eigenfahrzeugposition PO in der obigen Gleichung (7) kleiner als ein vorbestimmter Wert ist, wird festgestellt, dass die Eigenfahrzeugposition PO konvergiert und die Verarbeitung der Positioniereinheit 12 endet normal.
-
Derweil, wenn der Ladebetrag δPO gleich oder größer als der vorbestimmte Wert ist und die Anzahl von Malen der Berechnung der Eigenfahrzeugposition PO kleiner als die vorbestimmte Anzahl ist, wird festgestellt, dass die Eigenfahrzeugposition PO nicht konvergiert, der Schritt kehrt zum Schritt S25 zurück und die Konvergenzberechnung wird wieder durchgeführt. Wenn der Ladebetrag δPO gleich oder größer als der vorbestimmte Wert ist und die Anzahl von Malen der Berechnung der Eigenfahrzeugposition PO die vorbestimmte Anzahl von Malen ist, wird festgestellt, dass die Eigenfahrzeugposition nicht konvergieren kann und die Verarbeitung der Positioniereinheit 12 endet abnormal. Zusätzlich kann die Positioniereinheit 12 die Eigenfahrzeugposition, die Eigenfahrzeug-Geschwindigkeit und den Eigenfahrzeug-Azimut verwenden, die durch den GPS-Empfänger 11 berechnet sind, als Positionierungsergebnisse der Positioniereinheit 12.
-
Die obige Navigationsvorrichtung gemäß der zweiten Ausführungsform schätzt einen durch die Distanzänderungsraten-Schätzeinheit 125 verwendeten Einbauuhr-Fehler durch Ausschließen von Einbauuhr-Fehlern, die als größer bestimmt werden als ein vorgegebener Wert, von den Einbauuhr-Fehlern εtcar(ti) einer Mehrzahl von Empfangs-Satelliten und Mitteln einer Mehrzahl von dadurch erhaltenen Einbauuhr-Fehlern ab. Folglich, selbst wenn einige Empfangs-Satelliten durch einen Mehrfachpfad beeinflusst werden, ist es möglich, die Einbauuhr-Fehler εtcar(ti) genau zu berechnen und als Ergebnis die Genauigkeit der Eigenfahrzeug-Geschwindigkeit VO zuverlässig zu verbessern. Weiter ist es möglich, eine Konfiguration des Bestimmens der Zuverlässigkeit der Eigenfahrzeug-Geschwindigkeit VO, basierend auf einer Rate von Empfangs-Satelliten, welche durch einen Mehrfachpfad beeinflusst sind, zu realisieren.
-
Zusätzlich schließt die Einbauuhr-Fehler-Schätzeinheit 123 die Einbauuhr-Fehler εtcar(ti) von Empfangs-Satelliten, welche als durch einen Mehrfachpfad beeinflusst festgestellt werden, aus den Einbauuhr-Fehlern εtcar(ti) eine Mehrzahl von Empfangs-Satelliten und schätzt einen Einbauuhr-Fehler ab, der durch die Distanzänderungsraten-Schätzeinheit 125 verwendet wird.
-
Jedoch ist die Einbauuhr-Fehler-Schätzeinheit 123 nicht darauf beschränkt und kann einen Mehrpfadeinfluss einer Mehrzahl von Stufen evaluieren und den obigen Ausschluss basierend auf schrittweisen Evaluierungsergebnissen durchführen. Alternativ kann anstelle des Durchführens des Ausschließens die Einbauuhr-Fehler-Schätzeinheit 123 einen Einbauuhr-Fehler schätzen, welcher durch die Distanzänderungsraten-Schätzeinheit 125 verwendet wird, durch Absenken der Gewichtungen von Einbauuhr-Fehlern, die als größer als ein vorbestimmter Wert festgestellt werden, aus den Einbauuhr-Fehlern εtcar(ti) einer Mehrzahl von Empfangs-Satelliten, und Mitteln der dadurch erhaltenen Einbauuhr-Fehler.
-
Weiter wird ein durch die Distanzänderungsraten-Schätzeinheit 125 verwendeter Einbauuhr-Fehler aus den Einbauuhr-Fehlern εtcar(ti) eine Mehrzahl von Empfangs-Satelliten wie oben beschrieben abgeschätzt. Jedoch ist das Abschätzen einer eingebauten Uhr nicht darauf beschränkt und es kann ein durch die Distanzänderungsraten-Schätzeinheit 125 verwendeter Einbauuhr-Fehler aus dem Einbauuhr-Fehler εtcar(ti) eines Empfangs-Satelliten geschätzt werden.
-
Das heißt, dass die Einbauuhr-Fehler-Schätzeinheit einen durch die Distanzänderungsraten-Schätzeinheit 125 verwendeten Einbauuhr-Fehler abschätzen kann, indem sie die Einbauuhr-Fehler εtcar(ti), welche durch die Auftritts-Mehrfachpfad-Evaluierungseinheit 128 festgestellt werden, größer als ein vorbestimmter Wert zu sein, ausschließt, oder die Gewichtungen der Einbauuhr-Fehler εtcar(ti) für einen Empfangs-Satelliten senkt. Wenn diese Konfiguration verwendet wird, ist es möglich, den Einbauuhr-Fehler εtcar(ti) aus einem Empfangs-Satelliten zu überwachen und folglich eine Driftsituation einer Einbauuhr für lange Zeit zu überwachen und Zuverlässigkeit, die sich auf ein Positionierungsergebnis bezieht, wie etwa die Eigenfahrzeug-Geschwindigkeit VO, früh zu bestimmen, wenn die Positionierung wieder aufgenommen wird.
-
Zusätzlich, wenn der Eigenfahrzeug εtcar(ti), der wie oben beschrieben zu mitteln ist, als Ergebnis des Ausschließens der Einbauuhr-Fehler εtcar(ti) in der oben beschriebenen Navigationsvorrichtung nicht übrig gelassen sind, kann die in 9 gezeigte Verarbeitung der Positioniereinheit 12 beendet werden.
-
Dritte Ausführungsform
-
10 ist ein Blockdiagramm, das eine Konfiguration zeigt, die benötigt wird, um eine eigene Fahrzeugposition in einer Konfiguration einer Navigationsvorrichtung gemäß einer dritten Ausführungsform der vorliegenden Erfindung zu messen. Die dritte Ausführungsform ist gegenüber der zweiten Ausführungsform erweitert und daher werden dieselben Teile wie jene in der zweiten Ausführungsform nicht beschrieben und es werden hauptsächlich Unterschiede beschrieben.
-
Die in 10 gezeigte Navigationsvorrichtung verwendet eine Konfiguration, bei der ein Geschwindigkeitssensor 15 und ein Winkelsensor 16 außerhalb einer Positioniereinheit 12 der in 8 gezeigten Navigationsvorrichtung hinzugefügt sind, und eine Skalierungsfaktor-Berechnungseinheit 129, eine Distanzmesseinheit 130, eine Gier-Winkel-Messeinheit 131 und eine Eigenfahrzeugpositions-Schätzeinheit 132 innerhalb der Positioniereinheit 12 hinzugefügt sind.
-
Der Geschwindigkeitssensor 15 gibt ein Impulssignal entsprechend einer Bewegungsdistanz eines Fahrzeugs aus. Die Skalierungsfaktor-Berechnungseinheit 129 berechnet einen Skalierungsfaktor, basierend auf den Eigenfahrzeug-Geschwindigkeiten VO (vox, voy, voz), welche durch die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 berechnet sind, und dem aus dem Geschwindigkeitssensor 15 ausgegebenen Impulssignal. Die Distanzmesseinheit 130 misst eine Bewegungsdistanz, eine Geschwindigkeit (zweite Geschwindigkeit) und eine Beschleunigung (erste Beschleunigung) längs einer Fahrtrichtung eines Fahrzeugs, basierend auf einer Impulsanzahl des Impulssignals, das pro vorbestimmtem Timing gemessen wird, und aus dem Geschwindigkeitssensor 15 ausgegeben wird, und dem Skalierungsfaktor aus der Skalierungsfaktor-Berechnungseinheit 129. Zusätzlich sind die durch die obige Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 berechnete Eigenfahrzeug-Geschwindigkeit VO und die durch die Distanzmesseinheit 130 gemessene Eigenfahrzeug-Geschwindigkeit gleich, im Hinblick darauf, dass Berechnungsziele (Messziele) die Eigenfahrzeug-Geschwindigkeiten sind. Jedoch bezieht sich die Erstere auf die Eigenfahrzeug-Geschwindigkeit VO wie sie vorliegt und bezieht sich die Letztere auf eine ”Sensor-Eigenfahrzeug-Geschwindigkeit Vosen”, um wie unten beschrieben zu unterscheiden.
-
Der Winkelgeschwindigkeitssensor 16 gibt eine Spannung entsprechend einer Gier-Rate (Gier-Winkelgeschwindigkeit) der Navigationsvorrichtung aus. Die Gier-Winkel-Messeinheit 131 misst einen Gier-Winkel (z. B. einen Rotationswinkel in linker und rechter Richtung, basierend auf der Fahrtrichtung des Fahrzeugs), basierend auf der pro vorbestimmtem Timing gemessenen Spannung und aus dem Winkelgeschwindigkeitssensor 16 ausgegeben. Die Eigenfahrzeugpositions-Schätzeinheit 132 schätzt eine Eigenfahrzeugposition und einen Eigenfahrzeug-Azimut, basierend auf der durch die Distanzmesseinheit 130 gemessenen Bewegungsdistanz und dem durch die Gier-Winkel-Messeinheit 131 gemessenen Gier-Winkel ab.
-
Zusätzlich sind die durch die obige Eigenfahrzeugpositions-Berechnungseinheit 126 berechnete Eigenfahrzeugposition PO und die durch die Eigenfahrzeugpositions-Schätzeinheit 132 abgeschätzte Eigenfahrzeugposition gleich, im Hinblick darauf, dass Berechnungsziele (Schätzziele) die Eigenfahrzeugpositionen sind. Jedoch bezieht sich die Erstere auf die Eigenfahrzeugposition PO, wie sie ist, und bezieht sich die Letztere auf eine ”Sensor-Eigenfahrzeugposition”, um wie unten beschrieben zu unterscheiden.
-
Zusätzlich sind der durch die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 berechnete Eigenfahrzeug-Azimut und der durch die Eigenfahrzeugpositions-Schätzeinheit 132 abgeschätzte Eigenfahrzeug-Azimut gleich, im Hinblick darauf, dass Berechnungsziele (Messziele) die Eigenfahrzeug-Azimute sind. Jedoch bezieht sich das Erstere auf eine Eigenfahrzeug-Azimut, so wie er vorliegt, und bezieht sich das Letztere auf einen ”Sensor-Eigenfahrzeug-Azimut”, um wie unten beschrieben zu unterscheiden.
-
Als Nächstes wird ein Betrieb der Navigationsvorrichtung in 10 unter Bezugnahme auf das Flussdiagramm in 11 beschrieben, das eine Positionierverarbeitung zeigt, welche durch die Positioniereinheit 12 pro Verarbeitungszyklus durchgeführt wird. Zusätzlich werden in der nachfolgenden Beschreibung des Betriebs dieselben Teile wie jene in der zweiten Ausführungsform nicht im Detail beschrieben und es werden die Differenzen beschrieben.
-
In Schritt S41 initialisiert die Navigationsvorrichtung Information, die für die aktuelle Positionierverarbeitung initialisiert werden muss, aus Informationen, welche durch die vorige Positionierverarbeitung erhalten werden. Zusätzlich kann diese Initialisierung optional durchgeführt werden, wenn eine Initialisierung erforderlich ist, unmittelbar nachdem eine Stromquelle aktiviert wird.
-
Im Schritt S42 multipliziert die Distanzmesseinheit 130 einen Skalierungsfaktor zur Impulsanzahl des Geschwindigkeitssensors 15, gemessen pro vorbestimmtem Timing, zum Messen einer Bewegungsdistanz pro vorbestimmtem Timing. Zusätzlich wird eine im Schritt S56 in der vorherigen Positionierverarbeitung ermitteltes Skalierungsfaktor als ein Skalierungsfaktor verwendet.
-
Weiter bringt in demselben Schritt S42 die Distanzmesseinheit 130 die Impulszahl jedes vorbestimmten Timings dazu, einen Tiefpassfilter zu passieren, und misst dies Sensor-Eigenfahrzeug-Geschwindigkeit Vosen und Beschleunigung längs der dadurch pro vorbestimmtem Timing ermittelten Fahrtrichtung des Fahrzeugs.
-
Im Schritt S43 misst die Gier-Winkel-Messeinheit 131 einen Gier-Winkel, basierend auf der Ausgangsspannung, einer Nullspannung und einer Sensitivität des Winkelgeschwindigkeitssensors 16, gemessen pro vorbestimmtem Timing.
-
Im Schritt S44 berechnet die Eigenfahrzeugpositions-Schätzeinheit 132 einen Bewegungsbetrag des eigenen Fahrzeugs (den Änderungsbetrag der Eigenfahrzeugposition) in horizontaler Richtung (eine Richtung auf einer xy-Ebene), basierend auf der im Schritt S42 durch die Distanzmesseinheit 130 gemessenen Bewegungsdistanz und dem im Schritt S43 durch die Gier-Winkel-Messeinheit 131 gemessenen Gier-Winkel. Weiter addiert die Eigenfahrzeugpositions-Schätzeinheit 132 den Bewegungsbetrag zu der in der vorherigen Positionierverarbeitung berechneten Sensor-Eigenfahrzeugposition, um die Sensor-Eigenfahrzeugposition der aktuellen Positionierverarbeitung abzuschätzen. Weiterhin aktualisiert die Eigenfahrzeugpositions-Schätzeinheit 132 die aktuell abgeschätzte Sensor-Eigenfahrzeugposition als eine Sensor-Eigenfahrzeugposition, zu welcher der Bewegungsbetrag bei der nächsten Positionierverarbeitung hinzu zu addieren ist. Zusätzlich wird die durch die Eigenfahrzeugpositions-Schätzeinheit 132 abgeschätzte Sensor-Eigenfahrzeugposition modifiziert (im unten beschriebenen Schritt S55 in diesem Fall), basierend auf der durch die Eigenfahrzeugpositions-Berechnungseinheit 126 berechneten Eigenfahrzeugposition PO.
-
Nach Schritt S44 werden dieselben Operationen wie jene im obigen Schritt S22 bis Schritt S24 (siehe 9) im Schritt S45 bis Schritt S47 durchgeführt. Weiter führt nach Schritt S47 die Positioniereinheit 12 eine Konvergenzberechnung der Eigenfahrzeugposition durch, basierend auf den Rohdaten, durch Durchführen einer Schleifen-Verarbeitung im Schritt S48 bis Schritt S54 in einer Positionierverarbeitung ähnlich zur zweiten Ausführungsform. Als Nächstes wird ein Betrieb jedes Schrittes dieser Schleifen-Verarbeitung beschrieben.
-
Im Schritt S48 führen eine Einbauuhr-Fehler-Schätzeinheit 123 und eine Auftritts-Mehrfachpfad-Evaluierungseinheit 128 dieselbe Verarbeitung wie diejenige im obigen Schritt S25 durch. Weiter führt in Schritt S49 eine GPS-Satelliten-Verhaltensabschätzeinheit 124 dieselbe Verarbeitung wie diejenige im obigen Schritt S26 durch.
-
Im Schritt S50 schätzt die Distanzänderungsraten-Schätzeinheit 125 eine Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti) ab. Derweil schätzt in der dritten Ausführungsform die Distanzänderungsraten-Schätzeinheit 125 die Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti) unter Verwendung der Sensor-Eigenfahrzeugposition und des Sensor-Eigenfahrzeug-Azimuts ab, abgeschätzt durch die Eigenfahrzeugpositions-Schätzeinheit 132, statt die durch die Eigenfahrzeugpositions-Berechnungseinheit 126 berechnete Eigenfahrzeugposition PO (der Eigenfahrzeugposition PO, basierend auf einem Sendesignal) zu verwenden.
-
Spezifischer schätzt für alle Empfangs-Satelliten die Distanzänderungsraten-Schätzeinheit 125 die Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti) durch Anwenden, auf die obige Gleichung (5), der Positionen PS und der Geschwindigkeiten VS (der Positionen PS und der Geschwindigkeiten VS von GPS-Satelliten, basierend auf Sendesignalen) von GPS-Satelliten, abgeschätzt durch die GPS-Satelliten-Verhaltensabschätzeinheit 124 und die Sensor-Eigenfahrzeugposition und den Sensor-Eigenfahrzeug-Azimut, abgeschätzt durch die Eigenfahrzeugpositions-Schätzeinheit 132, ab.
-
Weiter schätzt für einen GPS-Satelliten, der als nicht durch einen Mehrfachpfad beeinflusst festgestellt wird (eine Änderung in einem Einbauuhr-Fehler ist gleich oder kleiner einem vorbestimmten Wert) im obigen Schritt S48, die Distanzänderungsraten-Schätzeinheit 125 die obige Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti) ab und modifiziert die berechnete Distanzänderungsrate Δρrate(ti), um die modifizierte Distanzänderungsrate Δρrate'(ti) ähnlich wie bei der ersten Ausführungsform zu ermitteln.
-
Derweil schätzt für einen GPS-Satelliten, der als durch einen Mehrfachpfad beeinflusst festgestellt wird, im obigen Schritt S48 (eine Änderung bei einem Einbauuhr-Fehler ist größer als ein vorbestimmter Wert), die Distanzänderungsraten-Schätzeinheit 125 die obige Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti) ab und schätzt eine dritte Distanzänderungsrate Δρrate-m(ti) in dem Fall ab, bei dem das Fahrzeug als fahrend angenommen wird, anders als in der ersten Ausführungsform.
-
Das heißt, dass für einen GPS-Satelliten, der als durch einen Mehrfachpfad im obigen Schritt S48 beeinflusst festgestellt wird, die Distanzänderungsraten-Schätzeinheit 125 die dritte Distanzänderungsrate Δρrate-m(ti) (bezeichnet als ”Antriebsdistanzänderungsrate Δρrate-m(ti)” unten) durch Anwenden auf die nachfolgende Gleichung (9) der Position PS und der Geschwindigkeit VS, abgeschätzt durch die GPS-Satelliten-Verhaltensabschätzeinheit 124, die Sensor-Eigenfahrzeugposition und den Sensor-Eigenfahrzeug-Azimut, abgeschätzt durch die Eigenfahrzeugpositions-Schätzeinheit 132, und die Sensor-Eigenfahrzeug-Geschwindigkeit Vosen, gemessen durch die Distanzmesseinheit 130, ab. Zusätzlich, wie bei Vergleich mit obiger Gleichung (5) klar ist, ist diese Gleichung (9) dieselbe wie Gleichung (5), außer dass Komponenten von Sensor-Eigenfahrzeug-Geschwindigkeiten Vosen (Vosenx, Voseny, Vosenz) enthalten sind.
-
[Gleichung 9]
-
- Δρrate-m(ti) = LOSx·(vsx – vosenx) + LOSy·(vsy – voseny) + LOSz·(vsz – vosenz) (9) Wobei
- Δρrate-m(ti):
- Antriebsdistanzänderungsrate [m/s]
- Vosen:
- Sensor-Eigenfahrzeug-Geschwindigkeit (Vosenx, Voseny, Vosenz) [m/s]
-
Nach Schritt S50 werden dieselben Operationen wie jene im obigen Schritt S28 und Schritt S29 (siehe 9) im Schritt S51 und Schritt S52 durchgeführt.
-
Im Schritt S53 berechnet die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 die Eigenfahrzeug-Geschwindigkeiten VO (vox, voy, voz), basierend auf der modifizierten Distanzänderungsrate Δρrate'(ti) und der Antriebsdistanzänderungsrate Δρrate-m(ti) und der Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti).
-
Spezifischer, für einen GPS-Satelliten, der als nicht durch einen Mehrfachpfad in Schritt S48 beeinflusst festgestellt wird, berechnet die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 die Eigenfahrzeug-Geschwindigkeiten VO (vox, voy, voz) durch Anwenden, auf obige Gleichung (8), der obigen Navigationsmatrix A, der Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti) und der modifizierten Distanzänderungsrate Δρrate'(ti), ähnlich zur ersten Ausführungsform.
-
Derweil berechnet für einen GPS-Satelliten, der als durch einen Mehrfachpfad im Schritt S48 beeinflusst festgestellt wird, die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit
127 die Eigenfahrzeug-Geschwindigkeiten V
O (v
ox, v
oy, v
oz) unter Verwendung der Antriebsdistanzänderungsrate Δρ
rate-m(t
i), abgeschätzt durch die Distanzänderungsraten-Schätzeinheit
125, anstelle der modifizierten Distanzänderungsrate Δρ
rate'(t
i), anders als in der ersten Ausführungsform. Spezifischer berechnet die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit
127 die Eigenfahrzeug-Geschwindigkeiten V
O (v
ox, v
oy, v
oz) durch Anwenden, auf die nachfolgende Gleichung (10), der obigen Navigationsmatrix A, der Fahrzeugstopp-Distanzänderungsrate Δρ
rate-s(t
i) und der Antriebsdistanzänderungsrate Δρ
rate-m(t
i). [Gleichung 10]
Wobei,
- VO:
- Eigenfahrzeug-Geschwindigkeit (vox, voy, voz) [m/s]
-
Zusätzlich, obwohl in Gleichung (8) und Gleichung (10) nicht ausgedrückt, wenn die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 wie oben beschrieben konfiguriert ist, werden Gleichungen, welche die Antriebsdistanzänderungsrate Δρrate-m(ti) und modifizierte Distanzänderungsrate Δρrate'(ti) in gemischter Weise in Gleichung (8) und Gleichung (10) einschließen, in Schritt S48 verwendet.
-
Die 12 bis 14 sind Ansichten, die Beispiele von Ergebnissen zeigen, welche durch die Navigationsvorrichtung gemäß der dritten Ausführungsform erhalten werden. 12 ist eine Ansicht, die eine GPS-Höhe zeigt, die in einem Kurs beobachtet wird, der an einer flachen Straße startet, eine Neigung hinauf geht, um die Spitze eines Hügels kreist, den Hügel abwärts geht und zur Ausgangsstraße zurückkehrt. 13 ist eine Ansicht, die eine durch den Geschwindigkeitssensor 15 gemessene Geschwindigkeit als eine dicke durchgezogene Linie zeigt und eine horizontale Komponente (ein synthetischer Vektor von vOx und vOy) der durch die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 berechneten Eigenfahrzeug-Geschwindigkeiten VO als eine dünne durchgezogene Linie im selben Verlauf wie demjenigen in 12 zeigt. 14 ist eine Ansicht, welche die Geschwindigkeit VOz in einer vertikalen Richtung aus den Eigenfahrzeug-Geschwindigkeiten VO zeigt, welche durch die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 im selben Verlauf wie demjenigen in 12 berechnet werden. Wie in 13 gezeigt, wenn eine Änderung bei der GPS-Höhe klein ist, passen die Geschwindigkeit (dicke durchgezogene Linie) des Geschwindigkeitssensors 15 und die Horizontalkomponente (dünne durchgezogene Linie) der Eigenfahrzeug-Geschwindigkeiten VO, berechnet durch die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127, im Wesentlichen zueinander.
-
Im Schritt S54 (11) bestimmt die Positioniereinheit 12, ob die Eigenfahrzeugposition PO in der aktuellen Positionierverarbeitung ähnlich zum obigen Schritt S31 konvergiert (9).
-
Im Schritt S55 (d. h., wenn die Anzahl von Empfangssatelliten, von denen im Schritt S51 bestimmt wird, nicht durch einen Mehrfachpfad beeinflusst zu sein, drei oder mehr ist, und nachdem in Schritt S54 festgestellt wird, dass die Eigenfahrzeugpositionen P
O konvergieren), modifiziert die Eigenfahrzeugpositions-Schätzeinheit
132 die Sensor-Eigenfahrzeugposition, die im Schritt S44 abgeschätzt wurde, durch die Eigenfahrzeugpositions-Schätzeinheit
132, basierend auf den Eigenfahrzeugpositionen P
O, die im Schritt S52 durch die Eigenfahrzeugpositions-Berechnungseinheit
126 abgeschätzt worden sind. Details jeder solchen Eigenfahrzeugpositions-Abschätzverarbeitung sind beispielsweise im
japanischen Patent 3321096 offenbart und können in der vorliegenden Erfindung verwendet werden.
-
Dann berechnet im Schritt S56 (d. h., nachdem im Schritt S51 festgestellt worden ist, dass es keinen Mehrfachpfadeinfluss gibt), die Skalierungsfaktor-Berechnungseinheit 129 einen Skalierungsfaktor, basierend auf Größenordnungen der Eigenfahrzeug-Geschwindigkeiten VO (eine Größe eines synthetischen Vektors von vox, voy, und voz), berechnet durch die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127, und die Impulsanzahl der Impulssignale, die aus dem Geschwindigkeitssensor 15 ausgegeben werden.
-
In dieser Hinsicht bestimmt die Skalierungsfaktor-Berechnungseinheit
129 gemäß der dritten Ausführungsform, ob das eigene Fahrzeug ein vorbestimmtes Fahren durchführt oder nicht (ob das Fahrzeug auf einer geneigten Straße fährt und bei einer niedrigen Geschwindigkeit fährt oder nicht), basierend auf den durch die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit
127 berechneten Eigenfahrzeug-Geschwindigkeiten V
O. Beispielsweise bestimmt die Skalierungsfaktor-Berechnungseinheit
129, dass das Eigenfahrzeug auf der geneigten Straße fährt, wenn ein Absolutwert der Geschwindigkeit v
oz in der Vertikalrichtung von den Eigenfahrzeug-Geschwindigkeiten V
O, welche durch die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit
127 berechnet werden, gleich oder größer einem vorbestimmten Wert ist. Weiter, zusätzlich zu dieser Bestimmung, bestimmt die Skalierungsfaktor-Berechnungseinheit
129, dass das eigene Fahrzeug bei einer niedrigen Geschwindigkeit fährt, wenn die Größen der Eigenfahrzeug-Geschwindigkeiten V
O (ein synthetischer Vektor von v
ox, v
oy, und v
oz) gleich oder kleiner einem vorbestimmten Wert sind. Weiterhin berechnet die Skalierungsfaktor-Berechnungseinheit
129 den obigen Skalierungsfaktor beim Bestimmen, dass das eigene Fahrzeug nicht auf einer geneigten Straße fährt oder das eigene Fahrzeug nicht bei einer niedrigen Geschwindigkeit fährt. Zusätzlich werden Details der Verarbeitung des Berechnens eines Skalierungsfaktors beispielsweise in dem
japanischen Patent Nr. 3321096 offenbart und können in der vorliegenden Erfindung verwendet werden.
-
Wenn der Schritt S56 beendet ist, wird die aktuelle Positionierverarbeitung beendet.
-
Die Navigationsvorrichtung gemäß der obigen dritten Ausführungsform schätzt die Fahrzeugstopp-Distanzänderungsrate Δρrate-s(ti) unter Verwendung der Sensor-Eigenfahrzeugposition und des Sensor-Eigenfahrzeug-Azimuts ab, der durch die Eigenfahrzeugpositions-Schätzeinheit 132 abgeschätzt wird, anstelle der Verwendung der Eigenfahrzeugpositionen PO, welche durch die Eigenfahrzeugpositions-Berechnungseinheit 126 bestimmt sind. Folglich ist es möglich, die Genauigkeit der Eigenfahrzeug-Geschwindigkeit VO zu vergrößern. Weiter, selbst wenn Funkwellen aus GPS-Satelliten durch Architektur um das Fahrzeug herum abgeschirmt werden und nur intermittent empfangen werden können, ist es möglich, die Eigenfahrzeug-Geschwindigkeit VO zu berechnen.
-
Weiter wird in der dritten Ausführungsform die Fahrdistanzänderungsrate Δρrate-m(ti) anstelle der modifizierten Distanzänderungsrate Δρrate'(ti) verwendet, die mehr oder weniger durch einen Mehrfachpfad für Empfangs-Satelliten beeinflusst ist, die als durch einen Mehrfachpfad beeinflusst festgestellt werden (eine Änderung bei dem Einbauuhr-Fehler ist größer als ein vorbestimmter Wert), aus der Mehrzahl von Empfangs-Satelliten. Folglich, selbst wenn ein Einbauuhr-Fehler unzureichend in einer Umgebung eines starken Mehrfachpfadeinflusses modifiziert ist, ist es möglich, die Eigenfahrzeug-Geschwindigkeit VO genau zu berechnen. Zusätzlich, obwohl ein Fall, bei dem die Anzahl von Empfangs-Satelliten mehrere beträgt, oben beschrieben worden ist, ist die Anzahl von Empfangs-Satelliten nicht darauf beschränkt und dasselbe kann für einen Empfangs-Satelliten gelten. Das heißt, dass die Antriebsdistanzänderungsrate Δρrate-m(ti) anstelle der modifizierten Distanzänderungsrate Δρrate'(ti) verwendet werden kann, die mehr oder weniger durch einen Mehrfachpfad beeinflusst ist, wenn ein Empfangs-Satellit als durch einen Mehrfachpfad beeinflusst festgestellt wird.
-
Weiter, in der dritten Ausführungsform, wenn die Anzahl von GPS-Satelliten, die als nicht durch einen Mehrfachpfad beeinflusst festgestellt werden (eine Änderung beim Einbauuhr-Fehler ist gleich oder kleiner einem vorbestimmten Wert) gleich oder größer als eine vorbestimmte Anzahl ist (in diesem Fall drei) wird ein Skalierungsfaktor basierend auf der Eigenfahrzeug-Geschwindigkeit VO berechnet, berechnet durch die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 und das aus dem Geschwindigkeitssensor 15 ausgegebene Impulssignal. Folglich ist es möglich, einen Mehrfachpfadeinfluss bei Berechnung eines Skalierungsfaktors zu unterdrücken. Daher ist es möglich, die Genauigkeit zum Berechnen eines Skalierungsfaktors zu vergrößern und schließlich die Genauigkeit zum Berechnen einer Beschleunigung der Distanzmesseinheit 130 zu vergrößern. Zusätzlich, obwohl oben ein Fall, bei dem die Anzahl von Empfangs-Satelliten mehrere ist, beschrieben worden ist, ist die Anzahl von Empfangs-Satelliten nicht darauf beschränkt und dasselbe kann auf einen Empfangs-Satelliten angewendet werden. Das heißt, wenn ein Empfangs-Satellit als nicht durch einen Mehrfachpfad beeinflusst festgestellt wird, kann ein Skalierungsfaktor basierend auf der durch die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127 berechneten Eigenfahrzeug-Geschwindigkeit VO und das aus dem Geschwindigkeitssensor 15 ausgegebene Impulssignal berechnet werden.
-
Weiter wird in der dritten Ausführungsform festgestellt, ob das eigene Fahrzeug auf einer geneigten Straße und bei einer niedrigen Geschwindigkeit fährt, was die Genauigkeit zum Berechnen eines Skalierungsfaktors, basierend auf der Eigenfahrzeug-Geschwindigkeit VO senkt, und wenn festgestellt wird, dass das eigene Fahrzeug nicht auf einer geneigten Straße und bei einer niedrigen Geschwindigkeit fährt, wird der Skalierungsfaktor berechnet. Es ist möglich, die Genauigkeit zum Berechnen eines Skalierungsfaktors zu vergrößern und schließlich die Genauigkeit zum Messen einer Beschleunigung der Distanzmesseinheit 130 zu vergrößern.
-
Zusätzlich kann der Skalierungsfaktor-Berechnungseinheit 129 einen Skalierungsfaktor unter bestimmten Bedingungen berechnen, selbst wenn das Fahrzeug auf einer geneigten Straße und bei einer niedrigen Geschwindigkeit fährt. Beispielsweise führt die Skalierungsfaktor-Berechnungseinheit 129 eine gewichtete Mittelung durch, abhängig von einem konvergierten Zustand eines berechneten Wertes des Skalierungsfaktors und ändert einen Korrekturpegel gemäß dem konvergierten Zustand des Skalierungsfaktors. Weiter, selbst wenn das eigene Fahrzeug auf einer geneigten Straße und bei einer niedrigen Geschwindigkeit fährt, falls der Korrekturpegel gleich oder größer einem vorbestimmten Pegel ist (der Skalierungsfaktor konvergiert sehr wahrscheinlich), kann die Skalierungsfaktor-Berechnungseinheit 129 eine Gewichtung des Skalierungsfaktors zum Berechnen des Skalierungsfaktors verändern.
-
Obwohl die Skalierungsfaktor-Berechnungseinheit 129 in der obigen Beschreibung feststellt, dass das eigene Fahrzeug auf einer geneigten Straße fährt, wenn ein Absolutwert der Geschwindigkeit voz in der vertikalen Richtung aus den Eigenfahrzeug-Geschwindigkeiten VO gleich oder größer einem vorbestimmten Wert ist, ist die Skalierungsfaktor-Berechnungseinheit 129 nicht darauf beschränkt. Beispielsweise kann die Skalierungsfaktor-Berechnungseinheit 129 feststellen, dass das eigene Fahrzeug auf der geneigten Straße fährt, wenn der Absolutwert eines Neigungswinkels (ein zwischen der Fahrtrichtung des Fahrzeugs und der xy-Ebene gebildeter Winkel), der basierend auf der Geschwindigkeit in der horizontalen Richtung von den Eigenfahrzeug-Geschwindigkeiten VO (der Größe des synthetischen Vektors vox und voy) und der Geschwindigkeit voz in der Vertikalrichtung berechnet wird, gleich oder größer einem vorbestimmten Wert ist.
-
Weiter, obwohl die Skalierungsfaktor-Berechnungseinheit 129 feststellt, dass das eigene Fahrzeug bei einer niedrigen Geschwindigkeit fährt, wenn die Größe der Geschwindigkeit VO gleich oder kleiner einem vorbestimmten Wert ist, ist die Skalierungsfaktor-Berechnungseinheit 129 nicht darauf beschränkt. Beispielsweise kann die Skalierungsfaktor-Berechnungseinheit 129 feststellen, dass das eigene Fahrzeug bei einer niedrigen Geschwindigkeit fährt, wenn die Sensor-Eigenfahrzeug-Geschwindigkeit Vosen, gemessen durch die Distanzmesseinheit 130, gleich oder kleiner einem vorbestimmten Wert ist.
-
Vierte Ausführungsform
-
15 ist ein Blockdiagramm, das eine Konfiguration zeigt, welche erforderlich ist, um eine Eigenfahrzeugposition in einer Konfiguration einer Navigationsvorrichtung gemäß einer vierten Ausführungsform der vorliegenden Erfindung zu messen. Die vierte Ausführungsform ist gegenüber der dritten Ausführungsform erweitert und daher werden dieselben Teile wie jene in der dritten Ausführungsform nicht beschrieben, und es werden hauptsächlich die Differenzen beschrieben.
-
Die in 15 gezeigte Navigationsvorrichtung verwendet eine Konfiguration, bei der ein Beschleunigungssensor 17 außerhalb einer Positioniereinheit 12 der Navigationsvorrichtung, die in 10 gezeigt ist, hinzugefügt ist, und eine Neigungswinkel-Berechnungseinheit 133, eine Beschleunigungssensor-Korrektureinheit 134 und eine Neigungswinkel-Messeinheit 135 innerhalb der Positioniereinheit 12 hinzugefügt sind.
-
Der Beschleunigungssensor 17, der mit einer Sensordetektionsachse in einer Fahrtrichtung eines eigenen Fahrzeugs versehen ist, gibt eine Spannung entsprechend einer Beschleunigung (zweite Beschleunigung) längs der Fahrtrichtung der Navigationsvorrichtung an die Beschleunigungssensor-Korrektureinheit 134 pro vorbestimmtem Timing aus. Zusätzlich, streng genommen, werden nicht nur eine Spannung entsprechend der Beschleunigung längs der Fahrtrichtung, sondern auch eine Spannung entsprechend einer Gravitationsbeschleunigung und eine Nullspannung entsprechend einem Anbringfehler des Beschleunigungssensors 17 am Fahrzeug zur aus dem Beschleunigungssensor 17 ausgegebenen Spannung hinzu addiert.
-
Die Neigungswinkel-Berechnungseinheit 133 berechnet einen ersten Neigungswinkel, der sich auf das Fahrzeug bezieht, pro vorbestimmten Timing, basierend auf den Eigenfahrzeug-Geschwindigkeiten VO (vox, voy, voz), berechnet durch die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit 127, und gibt den ersten Neigungswinkel pro vorbestimmten Timing an die Beschleunigungssensor-Korrektureinheit 134 aus. Der durch die Neigungswinkel-Berechnungseinheit 133 berechnete erste Neigungswinkel wird unten als ein ”berechneter Neigungswinkel” bezeichnet.
-
Die Beschleunigungssensor-Korrektureinheit 134 korrigiert die Nullspannung des Beschleunigungssensors 17, basierend auf der Beschleunigung aus der Distanzmesseinheit 130, der Ausgangsspannung aus dem Beschleunigungssensor 17 und dem berechneten Neigungswinkel aus der Neigungswinkel-Berechnungseinheit 133 und berechnet eine Sensor-Anbringwinkel in Bezug auf die Fahrtrichtung des Fahrzeugs, basierend auf der Nullspannung. Weiter gibt die Beschleunigungssensor-Korrektureinheit 134 die korrigierte Nullspannung an die Neigungswinkel-Messeinheit 135 pro vorbestimmtem Timing aus und gibt den Sensoranbringwinkel pro vorbestimmtem Timing an die Eigenfahrzeugpositions-Schätzeinheit 132 aus.
-
In dieser Hinsicht, wie unter Bezugnahme auf Schritt S42 (11) in der dritten Ausführungsform beschrieben, misst die Distanzmesseinheit 130 eine Beschleunigung (erste Beschleunigung) längs der Fahrtrichtung des Fahrzeugs pro vorbestimmtem Timing und die Beschleunigung wird durch Anwenden eines Tiefpassfilters auf diese Beschleunigung ermittelt. Daher trat eine Verzögerungszeit aufgrund des Tiefpassfilters in der durch die Distanzmesseinheit 130 gemessenen Beschleunigung auf. Daher wird die Zeitachse der durch die Distanzmesseinheit 130 gemessenen Beschleunigung mehr oder weniger gegenüber der Zeitachse des berechneten Neigungswinkels, berechnet durch die Neigungswinkel-Berechnungseinheit 133, und der Zeitachse der durch den Beschleunigungssensor 17 ausgegebenen Ausgangsspannung verzögert. Als Ergebnis gibt es das Problem, das die Korrekturgenauigkeit der Beschleunigungssensor-Korrektureinheit 134 mehr oder weniger degradiert.
-
Dann bringt die Beschleunigungssensor-Korrektureinheit 134 gemäß der vierten Ausführungsform die Ausgangsspannung des Beschleunigungssensors 17 und den berechneten Neigungswinkel aus der Neigungswinkel-Berechnungseinheit 133 dazu, den Tiefpassfilter (nicht gezeigt) so zu passieren, dass die Zeitachse der Ausgangsspannung aus dem Beschleunigungssensor 17 und die Zeitachse des berechneten Neigungswinkels aus der Distanzmesseinheit 130 mit der Zeitachse (verzögerte Zeitachse) der Beschleunigung aus der Distanzmesseinheit 130 ausgerichtet werden. Weiter korrigiert die Beschleunigungssensor-Korrektureinheit 134 die Nullspannung des Beschleunigungssensors 17, basierend auf der Beschleunigung aus der Distanzmesseinheit 130, der Ausgangsspannung aus dem Beschleunigungssensor 17 und dem berechneten Neigungswinkel aus der Neigungswinkel-Berechnungseinheit 133, mit den Zeitachsen der Beschleunigung, der Ausgangsspannung und des berechneten Neigungswinkels, ausgerichtet durch den Tiefpassfilter.
-
Die Neigungswinkel-Messeinheit 135 misst den zweiten Neigungswinkel, der sich auf ein Fahrzeug bezieht, basierend auf der Beschleunigung aus der Distanzmesseinheit 130, der Ausgangsspannung aus dem Beschleunigungssensor 17 und der Nullspannung aus der Beschleunigungssensor-Korrektureinheit 134. Der durch die Neigungswinkel-Messeinheit 135 berechnete zweite Neigungswinkel wird unten als ein ”gemessener Neigungswinkel” bezeichnet.
-
In dieser Hinsicht wird die obige Nullspannung basierend auf beispielsweise der Ausgangsspannung korrigiert, welche dazu gebracht wird, den Tiefpassfilter zu passieren, wie oben beschrieben. Folglich werden die durch die Beschleunigungssensor-Korrektureinheit 134 korrigierte Zeitachse der Nullspannung und die Zeitachse der durch die Distanzmesseinheit 130 gemessenen Beschleunigung ausgerichtet. Jedoch sind diese Zeitachsen immer noch gegenüber einer Zeitachse der Ausgangsspannung aus dem Beschleunigungssensor 17 verzögert. Als ein Ergebnis, ähnlich zum Obigen, gibt es ein Problem, dass die Messgenauigkeit der Neigungswinkel-Messeinheit 135 mehr oder weniger abnimmt.
-
Dann bringt die Neigungswinkel-Messeinheit 135 gemäß der vierten Ausführungsform die Ausgangsspannung des Beschleunigungssensors 17 dazu, den Tiefpassfilter (nicht gezeigt) so zu passieren, dass die Zeitachse der Ausgangsspannung aus dem Beschleunigungssensor 17 sich zur Zeitachse (verzögerte Zeitachse) der Beschleunigung aus der Distanzmesseinheit 130 und der Zeitachse (verzögerte Zeitachse) der Nullspannung aus der Beschleunigungssensor-Korrektureinheit 134 ausrichtet. Weiter misst die Neigungswinkel-Messeinheit 135 den gemessenen Neigungswinkel, basierend auf der Beschleunigung aus der Distanzmesseinheit 130, der Ausgangsspannung aus dem Beschleunigungssensor 17 und der Nullspannung aus der Beschleunigungssensor-Korrektureinheit 134, mit den Zeitachsen der Beschleunigung, der Ausgangsspannung und der Nullspannung, ausgerichtet durch den Tiefpassfilter.
-
Als Nächstes wird ein Betrieb der Navigationsvorrichtung in 15 unter Bezugnahme auf die Flussdiagramme in 16 und 17 beschrieben, welche Positionierverarbeitung zeigen, welche durch die Positioniereinheit 12 pro Verarbeitungszyklus durchgeführt wird. Zusätzlich werden in der nachfolgenden Beschreibung des Betriebs dieselben Teile wie jene in der dritten Ausführungsform nicht beschrieben, und es werden Differenzen beschrieben.
-
Zuerst werden dieselben Operationen wie jene im obigen Schritt S41 bis Schritt S43 (siehe 11) in Schritt S61 bis Schritt S63 durchgeführt. In dieser Hinsicht gibt in Schritt S62, zusätzlich zum Betrieb in Schritt S42, d. h. Messung einer Bewegungsdistanz, einer Sensor-Eigenfahrzeug-Geschwindigkeit Vosen und einer Beschleunigung durch die Distanzmesseinheit 130, der Beschleunigungssensor 17 eine Spannung entsprechend einer Beschleunigung längs der Fahrtrichtung der Navigationsvorrichtung aus.
-
In Schritt S64 bringt die Neigungswinkel-Messeinheit 135 die im Schritt S62 durch den Beschleunigungssensor 17 ausgegebene Spannung dazu, den obigen Tiefpassfilter zu passieren. Weiter misst im selben Schritt S64 die Neigungswinkel-Messeinheit 135 den gemessenen Neigungswinkel pro vorbestimmtem Timing, basierend auf der Beschleunigung aus der Distanzmesseinheit 130, der Ausgangsspannung aus dem Beschleunigungssensor 17 und der Nullspannung aus der Beschleunigungssensor-Korrektureinheit 134 (z. B. die im Schritt S79 in der vorherigen Positionierverarbeitung korrigierte Nullspannung) mit den Zeitachsen der Beschleunigung, der Ausgangsspannung und der Nullspannung ausgerichtet.
-
Eine Gleichung zum Berechnen eines gemessenen Neigungswinkels wird beispielsweise im
japanischen Patent Nr. 4443621 offenbart und kann in der vorliegenden Erfindung verwendet werden.
18 zeigt ein Beispiel eines durch die Neigungswinkel-Messeinheit
135 gemessenen Messneigungswinkels für dieselben Daten wie jene in den
12 bis
14, die zum Beschreiben der dritten Ausführungsform verwendet werden.
-
Nach Schritt S64 korrigiert in Schritt S65 (
16) die Eigenfahrzeugpositions-Schätzeinheit
132 einen Abfall bei der Sensitivität des Gier-Winkels der Gier-Winkel-Messeinheit
131, der mit einer Neigung der Detektionsachse des Winkelgeschwindigkeitssensors
16 einhergeht, basierend auf dem gemessenen Neigungswinkel, der pro vorbestimmtem Timing gemessen und aus der Neigungswinkel-Messeinheit
135 ausgegeben wird, und einem Sensoranbringwinkel aus der Beschleunigungssensor-Korrektureinheit
134. Zusätzlich zur Korrektur berechnet die Eigenfahrzeugpositions-Schätzeinheit
132 einen Bewegungsbetrag des eigenen Fahrzeugs (der Änderungsbetrag der Eigenfahrzeugposition) in horizontaler Richtung (einer Richtung auf einer xy-Ebene), basierend auf der im Schritt S62 gemessenen Bewegungsdistanz und einem im Schritt S63 gemessenen Gier-Winkel, ähnlich zum obigen Schritt S44 (
11) und schätzt die Sensor-Eigenfahrzeugposition ab. Zusätzlich sind das Korrigieren eines mit einer Neigung einer Detektionsachse eines Winkelgeschwindigkeitssensors einhergehender Gier-Winkel und Berechnen einer Bewegungsdistanz in der horizontalen Richtung beispielsweise im
japanischen Patent Nr. 4443621 offenbart und können in der vorliegenden Erfindung verwendet werden.
-
Nach Schritt S65 werden dieselben Operationen wie jene im obigen Schritt S45 bis Schritt S56 (siehe 11) im Schritt S66 bis Schritt S77, gezeigt in 17, durchgeführt.
-
Im Schritt S78 (d. h. wenn die Anzahl von Empfangs-Satelliten, die im Schritt S72 als nicht durch einen Mehrfachpfad beeinflusst festgestellt werden, drei oder mehr ist, und nachdem im Schritt S75 festgestellt wird, dass die Eigenfahrzeugpositionen P
O konvergieren), berechnet die Neigungswinkel-Berechnungseinheit
133 einen berechneten Neigungswinkel θ
pit-g, ausgedrückt durch die nachfolgende Gleichung (11), basierend auf einer Horizontalgeschwindigkeit (einer Größe eines synthetischen Vektors von v
ox und v
oy) und der Geschwindigkeit v
oz in vertikaler Richtung der Eigenfahrzeug-Geschwindigkeiten V
O, berechnet durch die Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit
127. [Gleichung 11]
Wobei,
- θpit-g:
- Berechneter Neigungswinkel [rad]
-
In Schritt S79 bestimmt die Beschleunigungssensor-Korrektureinheit 134, dass ein eigenes Fahrzeug bei einer niedrigen Geschwindigkeit fährt, in dem Fall, dass die Größe der Sensor-Eigenfahrzeug-Geschwindigkeit Vosen aus der Distanzmesseinheit 130 (alternativ die Größe der Eigenfahrzeug-Geschwindigkeiten VO) gleich oder kleiner einem vorbestimmten Wert ist, und bestimmt, dass das eigene Fahrzeug auf einer geneigten Straße fährt, wenn ein Absolutwert des berechneten Neigungswinkels θpit-g aus der Neigungswinkel-Berechnungseinheit 133 gleich oder größer einem vorbestimmten Wert ist.
-
Weiter, im selben Schritt S79 (d. h. nachdem im Schritt S72 festgestellt wird, dass es keinen Mehrfachpfadeinfluss gibt), wenn festgestellt wird, dass das eigene Fahrzeug nicht bei einer niedrigen Geschwindigkeit fährt und nicht auf einer Standspur fährt, bringt die Beschleunigungssensor-Korrektureinheit 134 die Ausgangsspannung aus dem Beschleunigungssensor 17 und den berechneten Neigungswinkel θpit-g aus der Neigungswinkel-Berechnungseinheit 133 dazu, den obigen Tiefpassfilter zu passieren. Weiterhin korrigiert die Beschleunigungssensor-Korrektureinheit 134 die Nullspannung des Beschleunigungssensors 17, basierend auf der Beschleunigung aus der Distanzmesseinheit 130, der Ausgangsspannung aus dem Beschleunigungssensor 17 und dem berechneten Neigungswinkel θpit-g aus der Neigungswinkel-Berechnungseinheit 133, mit den Zeitachsen der Beschleunigung, der Ausgangsspannung und dem berechneten Neigungswinkel ausgerichtet.
-
Zusätzlich ist die Beschleunigungssensor-Korrektureinheit
134 gemäß der vierten Ausführungsform konfiguriert, eine Nullspannung in einem Zyklus kürzer als einen Zyklus zum Beobachten von GPS-Satelliten zu korrigieren. Spezifischer erkennt die Beschleunigungssensor-Korrektureinheit
134, dass eine geneigte Straße eine feste Neigung aufweist, in einem GPS-Beobachtungszyklus und korrigiert die Nullspannung des Beschleunigungssensors
17 zu einem Sensormesszeitpunkt, der ein kürzerer Zyklus als der GPS-Beobachtungszyklus ist. Zusätzlich berechnet die Beschleunigungssensor-Korrektureinheit
134 den obigen Sensoranbringwinkel aus der Nullspannung des Beschleunigungssensors
17. Jedoch ist dieses Berechnungsverfahren beispielsweise in dem
japanischen Patent Nr. 4443621 offenbart und kann in der vorliegenden Erfindung verwendet werden.
-
Wenn Schritt S79 beendet ist, wird die aktuelle Positionierverarbeitung beendet.
-
Die obige Navigationsvorrichtung gemäß der vierten Ausführungsform richtet Zeitachsen von Information, die zum Korrigieren der Nullspannung in der Beschleunigungssensor-Korrektureinheit 134 erforderlich sind, aus. Folglich ist es möglich, stabil und genauer eine Nullspannung zu korrigieren.
-
Zusätzlich ist die Beschleunigungssensor-Korrektureinheit 134 gemäß der vierten Ausführungsform konfiguriert, eine Nullspannung beim Fahren auf einer geneigten Straße und bei Niedriggeschwindigkeitsfahren nicht zu korrigieren, ähnlich zur Berechnung des in der dritten Ausführungsform beschriebenen Skalierungsfaktors. Folglich ist es möglich, einen Abfall bei der Genauigkeit zum Korrigieren einer Nullspannung zu verhindern und die Genauigkeit eines Neigungswinkels zu vergrößern. Weiter, wenn ein Absolutwert des berechneten Neigungswinkels θpit-g gleich oder größer einem vorbestimmten Wert ist, wird festgestellt, dass ein Eigenfahrzeug auf einer geneigten Straße fährt, wie oben beschrieben. Jedoch ist das Durchführen der Bestimmung nicht darauf beschränkt und wenn der Absolutwert der Geschwindigkeit voz in der vertikalen Richtung aus den Eigenfahrzeug-Geschwindigkeiten VO gleich oder größer einem vorbestimmten Wert ist, kann festgestellt werden, dass das eigene Fahrzeug auf einer geneigten Straße fährt.
-
Weiter werden in der vierten Ausführungsform Zeitachsen von Information, die zum Messen des gemessenen Neigungswinkels in der Neigungswinkel-Messeinheit 135 erforderlich sind, ausgerichtet. Folglich ist es möglich, stabil und genauer einen gemessenen Neigungswinkel zu messen.
-
Weiter ist es in der vierten Ausführungsform möglich, eine Nullspannung zu einem Sensormess-Timing zu korrigieren und eine für diese Korrektur erforderliche Zeit zu reduzieren.
-
Zusätzlich können die Ausführungsformen der vorliegenden Erfindung frei innerhalb des Schutzumfangs der Erfindung kombiniert werden oder optional modifiziert oder weggelassen werden.
-
Bezugszeichenliste
-
- 15
- Geschwindigkeitssensor
- 16
- Winkelgeschwindigkeitssensor
- 17
- Beschleunigungssensor
- 121
- GPS-Ausgabedaten-Berechnungseinheit
- 123
- Einbauuhr-Fehler-Schätzeinheit
- 125
- Distanzänderungsraten-Schätzeinheit
- 127
- Eigenfahrzeug-Geschwindigkeits-Berechnungseinheit
- 128
- Auftritts-Mehrfachpfad-Evaluierungseinheit
- 129
- Skalierungsfaktor-Berechnungseinheit
- 130
- Distanzmesseinheit
- 131
- Gier-Winkel-Messeinheit
- 132
- Eigenfahrzeugpositions-Schätzeinheit
- 133
- Neigungswinkel-Berechnungseinheit
- 134
- Beschleunigungssensor-Korrektureinheit
- 135
- Neigungswinkel-Messeinheit