DE69209330T2 - Fahrzeughaltungkorrekturvorrichtung - Google Patents

Fahrzeughaltungkorrekturvorrichtung

Info

Publication number
DE69209330T2
DE69209330T2 DE69209330T DE69209330T DE69209330T2 DE 69209330 T2 DE69209330 T2 DE 69209330T2 DE 69209330 T DE69209330 T DE 69209330T DE 69209330 T DE69209330 T DE 69209330T DE 69209330 T2 DE69209330 T2 DE 69209330T2
Authority
DE
Germany
Prior art keywords
vehicle
location
estimated
course
data
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.)
Expired - Fee Related
Application number
DE69209330T
Other languages
English (en)
Other versions
DE69209330D1 (de
Inventor
Shin-Ichi Matsuzaki
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sumitomo Electric Industries Ltd
Original Assignee
Sumitomo Electric Industries Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Sumitomo Electric Industries Ltd filed Critical Sumitomo Electric Industries Ltd
Publication of DE69209330D1 publication Critical patent/DE69209330D1/de
Application granted granted Critical
Publication of DE69209330T2 publication Critical patent/DE69209330T2/de
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining 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/53Determining attitude
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0259Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/027Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0272Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising means for registering the travel distance, e.g. revolutions of wheels
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Navigation (AREA)

Description

    Gebiet der Erfindung
  • Die vorliegende Erfindung bezieht sich auf eine Fahrzeug- Kurskorrekturvorrichtung, die bei einer Vorrichtung zur Erfassung des Standortes eines Fahrzeuges für die Erfassung des Standortes eines über Straßen fahrenden Fahrzeuges verwendet wird.
  • Beschreibung des Standes der Technik
  • Als ein Verfahren zur Bereitstellung von Informationen über den tatsächlichen Standort eines über Straßen fahrenden Fahrzeuges ist die sog. "Gissung" bekannt, bei welcher ein Entfernungssensor, ein Kurssensor (magnetischer Sensor oder Kreiselkompaß) und eine Datenverarbeitungseinheit zur Verarbeitung der Entfernungs- und Kursdaten verwendet werden, die von den Entfernungs- und Kurssensoren erhalten werden, wobei die gegenwärtigen Standortdaten eines Fahrzeuges durch die Integration einer Änderung δ1 der Entfernungsstrecke und einer Änderung δ der Kursgröße erhalten wird. Bei dem Verfahren der Gissung werden die Ostwest-Richtungskornponente δx (=δ1 x cos ) und die Süd- Nord-Richtungskomponente δy (=δ1 x sin ) der Änderung δ1 der Entfernungsstrecke, die bei der Bewegung des Fahrzeuges über eine Straße auftritt, berechnet und werden die Ausgangsdaten(Px, Py) eines gegenwartigen Standortes durch die Hinzufügung der berechneten Komponenten δx und δy zu den vorhergehenden Standort-Ausgangsdaten (Px', Py') erhalten.
  • Bei dem vorbeschriebenen Verfahren werden die vorhergehenden Standortdaten für eine Berechnung der gegenwärtigen Standortdaten benötigt und werden die noch früher vorhergehenden Standortdaten für die Berechnung der vorhergehenden Standortdaten benötigt. Als eine Folge davon werden die Standortdaten und die Kursdaten des Fahrzeuges zu dem Zeitpunkt der Abfahrt benötigt. Wenn die Standortdaten und die Kursdaten des Fahrzeuges zu dem Zeitpunkt der Abfahrt Fehler enthalten, dann bleiben die Fehler erhalten. Aus diesem Grund müssen die Standortdaten und die Kursdaten des Fahrzeuges zum Zeitpunkt der Abfahrt genau sein.
  • Als ein Verfahren zur Bereitstellung der Kursdaten zum Zeitpunkt der Abfahrt ist gegenwärtig ein Verfahren bekannt, bei dem ein magnetischer Sensor zur Erfassung eines Absolutkurses verwendet wird, oder ein Verfahren, bei welchem der Kurs eines Fahrzeuges durch den Fahrer eines Fahrzeuges auf der Basis einer Straßenkarte, geographischen Umgebungsbesonderheiten, usw. eingegeben wird. Der mit dem magnetischen Sensor erfaßte Kurs enthält jedoch normal den folgenden Fehler. Der magnetische Sensor ist ein solcher, der die Intensität des schwachen Erdmagnetfeldes erfaßt, und wenn ein sich bewegender Körper magnetisiert wird, ergeben sich Fehler bei den Ausgangsdaten des magnetischen Sensors. Um diese Fehler zu kompensieren, kann eine Initialisierung des magnetischen Sensors vorgenommen werden. Wenn der sich bewegende Körper durch Bereiche hindurchgeht, die eine magnetische Störung aufweisen, wie bspw. Kreuzungen von Eisenbahnschienen, Orte, wo Stromkabel vergraben sind, Eisenbrücken, Hochstraßen mit Geräusche isolierenden Wänden und Hochhäuser, dann wird der sich bewegende Körper dem Einfluß des starken elektromagnetischen Feldes unterworfen, sodaß sich der Grad der Magnetisierung des sich bewegenden Körpers verändert. Aus diesem Grund ergeben sich wieder Fehler bei den Ausgangsdaten des magnetischen Sensors während der Fahrt.
  • Wenn die Richtung einer mit einer Straßenkarte spezifizierten Straße als der Anfangskurs eines Fahrzeuges angegeben wird, dann ergeben sich ebenfalls Fehler, wenn sich das Fahrzeug nicht parallel zu der Straße befindet.
  • Andererseits ist in einem Fahrzeug manchmal ein GPS (globales Positionierung-System) montiert. Das GPS ist eine Technik, bei welcher der Standort des Fahrzeuges durch die Verwendung von Wellen von GPS Satelliten gemessen wird, und die Prinzipien sind die Messung der zweidimensionalen oder dreidimensionalen Positionen des Fahrzeuges durch eine Messung der Verzögerungszeit bei der Ausbreitung der Wellen, die durch eine Vielzahl von künstlichen Satelliten erzeugt werden, welche in einem vorbestimmten Umlauf die Erde umkreisen. Um den Kurs eines Fahrzeuges durch die Verwendung des GPS Empfängers zu erhalten, ist es erforderlich, den Doppler-Versatz zu messen, der bei dem Empfang der Wellen von dem GPS Satelliten während der Fahrt empfangen wird. Um den Doppler-Versatz zu messen, ist es nötig, daß das Fahrzeug bei relativ hohen Geschwindigkeiten fährt. Da der Kurs des Fahrzeuges somit nur gemessen werden kann, wenn es auf Schnellstraßen fährt, konnte das GPS nicht immer bei der Korrektur des Fahrzeugkurses verwendet werden.
  • Das Dokument US 4 924 402 beschreibt ein Verfahren der Identifizierung der aktuellen Position eines Fahrzeuges durch Verwendung eines magnetischen Sensors, eines Winkelgeschwindigkeitssensors, eines Fahrentfernungssensors und eines globalen Positionierungssystems. Ein Verfahren der Korrektur oder Umwandlung eines Azimuth des Fahrzeuges, erhalten von dem Ausgang eines Erdmagnetismussensors als Folge eines Fehlers, der durch die Differenz des aufgezeichneten Azimuth und der Kartendaten verursacht wird, ist in diesem Dokument beschrieben. Das in diesem Dokument beschriebene Verfahren hat den Nachteil, daß der Azimuth- Korrekturkoeffizient nur erhalten werden muß, wenn sich das Fahrzeug zwischen zwei bekannten Punkten bewegt.
  • Es ist daher eine wichtige Aufgabe der vorliegenden Erfindung, eine Vorrichtung zur Korrektur eines Fahrzeugkurses bereitzustellen, die zur Erlangung des genauen Kurses, des Standortes und der Fahrstrecke eines Fahrzeuges durch die Korrektur des Kurses fähig ist, der bei der Erfassung eines Fahrzeugstandortes benutzt wird.
  • Zusammenfassung der Erfindung
  • Gemäß einem wichtigen Aspekt der vorliegenden Erfindung ist eine Fahrzeug-Kurskorrekturvorrichtung bereitgestellt, bestehend aus:
  • einem Entfernungssensor (1a, 1b) zum Erfassen einer durch ein Fahrzeug zurückgelegten Entfernung;
  • einer einen geschätzten Kurs erfassenden Einrichtung (2, 3 und 5) zum Erfassen eines geschätzten Kurses des Fahrzeuges;
  • einer einen anfänglichen Standort bestimmenden Einrichtung (8 und 10, 4) zum Erfassen eines anfänglichen Standortes des Fahrzeuges;
  • einer einen geschätzten Standort berechnenden Einrichtung (6) zum Errechnen eines geschätzten Fahrzeugstandortes auf der Basis des anfänglichen Fahrzeugstandortes, bestimmt durch die einen anfänglichen Standort bestimmte Einrichtung, die durch den Entfernungssensor erfaßte Entfernung und den geschätzten Fahrzeugkurs, der durch die einen geschätzten Kurs erfaßende Einrichtung erfaßt wurde; und
  • einer Standort-Erwerbeinrichtung (4) zum Erwerb von Fahrzeug- Standortdaten, die von außen angeliefert werden, dadurch gekennzeichnet, daß sie weiterhin besteht aus:
  • einer ersten Rechnereinrichtung (7) zum Berechnen der Bewegungsrichtung (α) des Fahrzeuges auf der Basis von zwei Fahrzeug-Standortdaten, die von der Standortdaten-Erwerbeinrichtung (4) erworben wurden;
  • einer zweiten Rechnereinrichtung (7) zum Berechnen einer geschätzten Bewegungsrichtung (β) des Fahrzeuges auf der Basis von zwei geschätzten Fahrzeugstandorten, die von der einen geschätzten Standort berechnenden Einrichtung zu dem Zeitpunkt berechnet wurden, wenn die beiden Fahrzeug- Standortdaten von der Standort-Erwerbeinrichtung erworben wurden;
  • einer Korrektureinrichtung (7) für eine Korrektur des geschätzten Fahrzeugkurses mittels eines Unterschiedes (α-β) zwischen der durch die erste Rechnereinrichtung berechneten Bewegungsrichtung (α) und der durch die zweite Rechnereinrichtung berechneten geschätzten Bewegungsrichtung (β);
  • wobei der geschätzte Fahrzeugstandort durch die einen geschätzten Standort berechnete Einrichtung (6) erneut berechnet wird auf der Basis des korrigierten geschätzten Fahrzeugkurses.
  • Die Standort-Erwerbeinrichtung kann einen Empfänger (4) für ein globales Positionierungssystem aufweisen.
  • Bei der Fahrzeug-Kurskorrekturvorrichtung der vorliegenden Erfindung wird durch die Verwendung der ersten Rechnereinrichtung die Bewegungsrichtung des Fahrzeuges aus den Daten der beiden Fahrzeugstandorte berechnet, die von außen erworben wurden. Mit der zweiten Rechnereinrichtung wird dann die geschätzte Bewegungsrichtung des Fahrzeuges während der Zeit, in welcher die beiden Fahrzeugstandortdaten erworben wurden, berechnet. Durch eine Berücksichtigung einer Differenz zwischen den beiden Bewegungsrichtungen, die eine Art Fehler ergibt, kann der absolute Kurs des Fahrzeuges korrigiert werden.
  • Das Korrekturverfahren ist in Fig. 1 gezeigt. Der Fahrzeugstandort, der bei dem Erwerb der ersten Fahrzeugstandortdaten durch die Erwerbeinrichtung der Standortdaten erworben und erhalten wurde durch die Einrichtung zu Erfassung eines geschätzten Standortes wird als ein "geschätzter Standort des Fahrzeuges" bezeichnet und wird mit dem Bezugspunkt O angegeben. Der Fahrzeugstandort, der bei dem Erwerb der zweiten Fahrzeug-Standortdaten eingenommen wird, die durch die Erfassungseinrichtung des geschätzten Standortes erhalten werden, ist mit dem Bezugspunkt P angegeben, und die Fahrstrecke zwischen O und P ist mit dem Bezugsbuchstaben L angegeben.
  • Der Fahrzeugstandort, der aus den Standortdaten berechnet wird, die als die ersten Standortdaten erhalten werden als ein Erwerb von der Standortdaten-Erwerbeinrichtung, wird als ein "erworbener Fahrzeugstandort" bezeichnet und ist mit dem Bezugspunkt O1 angegeben. Der erworbene Fahrzeugstandort, der aus den Fahrzeugdaten errechnet wird, die bei dem Erwerb der zweiten Standortdaten erhalten wurden, ist mit dem Bezugspunkt P1 angegeben.
  • Der erworbene Fahrzeugstandort O1 und der geschätzte Fahrzeugstandort O sind manchmal unterschiedlich oder gleich. Sie sind gleich, wenn der erworbene Fahrzeugstandort O1 als der anfängliche Standort des Fahrzeuges verwendet wird zu dem Zeitpunkt, in welchem der erworbene Fahrzeugstandort O1 durch die Einrichtung zur Erfassung des geschätzten Standortes erworben wurde. Weil das Ziel der vorliegenden Erfindung die Korrektur des Kurses eines Fahrzeuges ist, ist es jedoch nicht immer nötig, daß die Standorte O1 und O gleich sind. In Fig. 1 sind O und O1 jedoch überlappt, um eine einfacherer Erklärung zu ermöglichen.
  • Es wird nun angenommen, daß die Koordinaten des geschätzten Fahrzeugstandortes P (x, y) sind und die Koordinaten des erworbenen Fahrzeugstandortes P1 (x1, y1) sind. Es wird auch angenommen, daß bei der Erfassung des geschätzten Fahrzeugstandortes P die Einrichtung zur Erfassung des geschätzten Standortes einen anfänglichen Kurs o an dem Urspung O der Koordinatenachsen verwendet.
  • Auf der Basis der Koodinaten (x1, y1) des erworbenen Fahrzeugstandortes P1 kann andererseits die Richtung eines Vektors OP1 an dem Ursprung O durch die folgende Gleichung (a) ausgedrückt werden:
  • α = tan&supmin;¹ (y1/x1) (a)
  • Die durch die Gleichung (a) erhaltene Richtung α kann als genau bezeichnet werden, weil angenommen werden kann, daß der Fehler in dem erworbenen Fahrzeugstandort P1 kleiner ist als in dem geschätzten Fahrzeugstandort P, der durch eine Gissung erhalten ist.
  • Auf der Basis der Koordinaten (x, y) des geschätzten Fahrzeugstandortes P kann weiterhin die Richtung β eines Vektors OP an dem Ursprung O durch die folgende Gleichung (b) angegeben werden:
  • β = tan&supmin;¹ (y/x) (b)
  • Wenn angenommen wird, daß die Differenz zwischen der Richtung β und der Richtung α die Größe δ ist, dann kann der Absolutkurs des Fahrzeuges unter Verwendung von δ korrigiert werden. Wenn "X" ein Vektorprodukt darstellt und "." ein skalares Produkt ist, dann ergibt sich die Gleichung
  • tanδ = tan(α-β)
  • = sin(α-β)/cos(α-β)
  • = OP OP1/OP OP1
  • = (x y1-x1 y)/(x x1+y y1)
  • Daher kann δ wie folgt berechnet werden:
  • δ = tan&supmin;¹ (x y1-x1 y)/(x x1+y y1) (c)
  • + = δ = ' (d)
  • Durch die Gleichung (d) kann der Kurs ' als ein neuer absoluter Kurs des Fahrzeuges erhalten werden.
  • Wenn ein anfänglicher Kurs o korrigiert ist, dann kann ein Korrekturkurs durch die folgende Gleichung erhalten werden:
  • o + δ = ' (e)
  • Auf der Basis des korrigierten Kurses o' kann wieder die von dem Ursprung O zurückgelegte Strecke berechnet werden. Auf diese Weise kann eine genauere Bewegungsstrecke L' erhalten werden.
  • Kurze Beschreibung der Zeichnungen
  • Die vorstehenden und weitere Ziele und Vorteile werden aus der folgenden detaillierten Beschreibung in Verbindung mit den beigefügten Zeichnungen ersichtlich, in welchen
  • Fig. 1 ein Diagramm einer Fahrstrecke eines Fahrzeuges ist, das zur Erläuterung eines Korrekturverfahrens des Fahrzeugkurses in Übereinstimmung mit der vorliegenden Erfindung benutzt wird, und
  • Fig. 2 ist ein Blockdiagramm zur Darstellung einer Fahrzeugstandort-Erfassungsvorrichtung zur Durchführung des Fahrzeugkurs-Korrekturverfahrens.
  • Beschreibung der bevorzugten Ausführungsformen
  • Fig. 2 zeigt einen Fahrzeugstandort-Erfassungsvorrichtung zur Durchführung eines Fahrzeugkurs-Korrekturverfahrens gemäß der vorliegenden Erfindung. Die Fahrzeugstandort- Erfassungsvorrichtung besteht aus Radsensoren 1a und 1b, welche die Drehzahl der linken und rechten Räder eines Fahrzeuges erfaßt, einem Kreiselkompaß 2 zur Erfassung einer Wende- oder Lenkwinkelgeschwindigkeit, einem Magnetsensor 3 zur Erfassung eines absoluten Kurses eines Fahrzeuges auf der Basis des Erdmagnetismus und einem Empfänger 4 für ein GPS (Globales Positionierung-System). Der Kreiselkompaß 2 ist ausgewählt unter einem Kreiselkompaß mit einer optischen Faser, der eine Lenkwinkelgeschwindigkeit als einen Phasenwechsel des Interferenzlichtes ausschließt, einem Vibration-Kreiselkompaß, der eine Lenkwinkelgeschwindigkeit mittels der Technik einer Auslegervibration eines piezoelektrischen Elements erfaßt, und einem Kreiselkompaß des mechanischen Typs. Eine Korrektureinheit 7 des anfänglichen Kurses ist mit den Radsensoren 1a und 1b verbunden. Eine Schätzeinheit 5 für den Kurs ist mit dem Kreiselkompaß 2, dem Magnetsensor 3 und der Korrektureinheit 7 für den anfänglichen Kurs verbunden und schätzt den gegenwärtigen Kurs eines Fahrzeuges auf der Basis eines Anfangskurses, der von dem Magnetsensor 3 oder der Korrektureinheit 7 des Anfangskurses eingegeben ist,sowie von den Daten über ein Kursänderungsausmaß, wie erfaßt durch den Kreiselkompaß 2. Eine Standort-Erfassungseinheit 6 berechnet die Daten der Entfernung, die von einem anfänglichen Standort (der über eine Tastatur 10 eingestellt oder von dem GPS Empfänger 4 eingegeben wird) auf der Basis der Drehzahl der Räder, die von den Radsensoren 1a und 1b erfaßt wurde. Die Standorterfassungseinheit 6 liest auch die Kursdaten aus, die von der Kursschätzeinheit 5 ausgegeben wurden, und berechnet dann eine Fahrstrecke, bei welcher der anfängliche Standort durch eine Gissung erhalten wurde. Die durch die Erfassungseinheit 6 des Standortes berechnete Fahrstrecke wird an ein Navigation-Steuergerät 8 eingegeben. Ein Display 9 ist für eine Abbildung des Fahrzeugstandortes, des Kurses und der Fahrstrecke zusammen mit der Straßenkarte vorgesehen, die in einem Straßenkartenspeicher 11 gespeichert ist.
  • Der Straßenkartenspeicher 11 nutzt ein Speichermedium, wie bspw. einen Halbleiterspeicher, ein Kassettenband, CD-ROM, einen IC Speicher und DAT, und er speichert die Daten über das Straßennetzwerk eines vorbestimmten Bereichs, Kreuzungen, ein Eisenbahnnetzwert u.dgl. in der Form der Kombination eines Knotenpunktes und einer Verbindungsstrecke.
  • Das vorbeschriebene Navigation-Steuergerät 8 besteht aus einem Figurenprozessor, einem Bildprozessorspeicher od.dgl. und führt die Freigabe der Karte aus, die auf dem Display 9 abgebildet wird, die Eingabe eines anfänglichen Standortes, einen Wechsel des Maßstabes, ein Abrollen usw.
  • Auf der Basis von zwei Standortdaten, die von dem GPS Empfänger 4 erhalten wurden, berechnet die Korrektureinheit 7 des anfänglichen Kurses die Bewegungsrichtung α (Fig. 1) des Fahrzeuges während der zwei Empfänge. Ebenfalls auf der Basis der Fahrzeugstandortdaten, die von der Standorterfassungseinheit 6 ausgegeben wurden, berechnet die Korrektureinheit 7 des Anfangskurses auch die Bewegungsrichtung β (Fig. 1) des Fahrzeuges während der beiden vorbeschriebenen Empfänge. Auf der Basis der Differenz δ zwischen den Bewegungsrichtungen α und β wird dann der absolute Kurs des Fahrzeuges korrigiert.
  • Die Betriebsweise der Fahrzeugstandort-Erfassungsvorrichtung wird nachfolgend im Detail beschrieben.
  • Vor der Fahrt wählt der Fahrer des Fahrzeuges aus dem Straßenkartenspeicher 11 durch eine Manipulation der Tastatur 10 die Straßenkarte eines vorbestimmten Bereichs aus, welche den gegenwärtigen Standort des Fahrzeuges enthält. Die ausgewählte Straßenkarte wird auf dem Display 9 abgebildet. Als nächstes wird der anfängliche Standort des Fahrzeuges durch die Manipulation der Tastatur 10 eingestellt. Diese Einstellung wird durch die Bewegung eines Kursors bewirkt, der den Fahrzeugstandort auf der Straßenkarte angibt. An dieser Stelle wird der anfängliche Kurs des Fahrzeuges durch ein Auslesen des Ausganges des Magnetsensors 3 eingestellt. Auf diese Weise werden die Daten, welche den anfänglichen Standort und den anfänglichen Kurs des Fahrzeuges angeben, an die Kursschätzeinheit 5 und an die Standorterfassungseinheit 6 angeliefert.
  • Nach der vorstehend beschriebenen Initialisierung wird das Fahrzeug bewegt und werden in der Standorterfassungseinheit 6 die Entfernungsdaten berechnet, die von dem anfänglichen Standort zurückgelegt wurden, und zwar auf der Basis der Raddrehzahlsignale von den Radsensoren 1a und 1b. In der Kursschätzeinheit 5 wird weiterhin der gegenwärtige Kurs des Fahrzeuges integriert auf der Basis der Daten über die Winkelgeschwindigkeit von dem Kreiselkompaß 2. Es werden dann die Daten über die Fahrstrecke in der Standorterfassungseinheit 6 berechnet auf der Basis der Entfernungsdaten der Fahrt und der gegenwärtigen Kursdaten, und sie werden an das Navigation-Steuergerät 8 geliefert. Das Navigation- Steuergerät 8 bildet den Fahrzeugstandort, den Kurs und die Fahrstrecke auf dem Bildschirm des Display 9 ab zusammen mit der Straßenkarte.
  • Wenn Daten über den Fahrzeugstandort von dem GPS Empfänger 4 eingegeben werden, dann berechnet die Korrektureinheit 7 des anfänglichen Kurses einen korrigierten Anfangskurs auf der Basis von zwei beliebig eingegebenen Fahrzeugstandortdaten, und der korrigierte anfängliche Kurs wird an die Kursschätzeinheit 5 angeliefert.
  • Die Korrektur eines anfänglichen Kurses in der Korrektureinheit 7 des anfänglichen Kurses wird wie folgt durchgeführt.
  • Wenn die ersten Fahrzeugstandortdaten (Xo, Yo) von dem GPS Empfänger 4 während der Fahrt eingegeben werden, dann erwirbt die Korrektureinheit 7 des anfänglichen Kurses einen Kurs o zu diesem Zeitpunkt von der Kursschätzeinheit 5 und speichert den Kurs o in deren Speicher zusammen mit den Fahrzeugstandortdaten (Xo, Yo). Die Fahrzeugstandortdaten (Xo, Yo) zu diesem Zeitpunkt werden ebenfalls in die Standorterfassungseinheit 6 als die Daten eines anfanglichen Standortes eingegeben, sodaß die Standorterfassungseinheit 6 den gegenwärtigen Standort wiederholt auf (Xo, Yo) einstellt und einen Fahrzeugstandort mit diesem gegenwärtigen Standort (Xo, Yo) als den Startpunkt berechnet.
  • Wenn die zweiten Fahrzeugstandortdaten (X1, Y1) von dem GPS Empfänger 4 als nächstes eingegeben werden, dann erwirbt die Korrektureinheit 7 des anfänglichen Kurses die gegenwärtigen Kursdaten zu diesem Zeitpunkt von der Kursschätzeinheit 5 und auch die geschätzten Fahrzeugstandortdaten (X, Y) zu diesem Zeitpunkt von der Standorterfassungseinheit 6. Auf der Basis dieser Daten wird die geschätzte Bewegungsstrecke des Fahrzeuges während dieser beiden Empfänge wie folgt berechnet:
  • (x, y) = (X, Y) - (Xo, Yo)
  • Auf der Basis der GPS Empfangsdaten wird auch die Bewegungsstrecke des Fahrzeuges während der beiden vorbeschriebenen Empfänge wie folgt berechnet:
  • (x1, y1) = (X1, Y1) - (Xo, Yo)
  • Es wird dann durch die oben beschriebene Gleichung (c) ein geschätzter Kursfehler δ erworben und zu dem anfänglichen Kurs o addiert, um den anfänglichen Kurs zu korrigieren.
  • Der so korrigierte anfängliche Kurs o' wird der Kursschätzeinheit 5 angeliefert, welche die Kursdaten des Fahrzeuges wieder auf der Basis dieses anfänglichen Kurses o' berechnet, und die Standorterfassungseinheit 6 berechnet auch wieder die Fahrstrecke auf der Basis der wiederberechneten Kursdaten. Bei diesen Berechnungen werden die Kursdaten und die Fahrentfernungsdaten, die in einem vorbestimmten Speicher gespeichert wurden, verwendet. Die so wieder durch die Standorterfassungseinheit 6 berechneten Fahrstreckendaten werden an das Navigation-Steuergerät 8 eingegeben und auf dem Display 9 abgebildet. Die auf dem Display 9 abgebildete Spur wird daher zu einer genauen Spur oder Strecke korrigiert immer dann, wenn die GPS Daten empfangen werden.
  • Während beschrieben wurde, daß der GPS Empfänger 4 als eine Erwerbseinrichtung für die Standortdaten zum Erwerb von Standortdaten benutzt wird, die von außen angeliefert werden, wird angemerkt, daß anstelle des GPS Empfängers auch ein Empfänger eines Leitstrahlsenders benutzt werden kann. Die Information über den Standort eines Fahrzeuges kann schließlich auch durch den Fahrer auf der Basis einer Straßenkarte eingegeben werden.

Claims (2)

1. Fahrzeug-Kurskorrekturvorrichtung, bestehend aus:
einem Entfernungssensor (1a, 1b) zum Erfassen einer durch ein Fahrzeug zurückgelegten Entfernung;
einer einen geschätzten Kurs erfassenden Einrichtung (2, 3 und 5) zum Erfassen eines geschätzten Kurses des Fahrzeuges;
einer einen anfänglichen Standort bestimmenden Einrichtung (8 und 10, 4) zum Erfassen eines anfänglichen Standortes des Fahrzeuges;
einer einen geschätzten Standort berechnenden Einrichtung (6) zum Errechnen eines geschätzten Fahrzeugstandortes auf der Basis des anfänglichen Fahrzeugstandortes, bestimmt durch die einen anfänglichen Standort bestimmende Einrichtung, die durch den Entfernungssensor erfaßte Entfernung und den geschätzten Fahrzeugkurs, der durch die einen geschätzten Kurs erfassende Einrichtung erfaßt wurde; und
einer Standort-Erwerbeinrichtung (4) zum Erwerb von Fahrzeug-Standortdaten, die von außen angeliefert werden,
dadurch gekennzeichnet, daß sie weiterhin besteht aus:
einer ersten Rechnereinrichtung (7) zum Berechnen der Bewegungsrichtung (α) des Fahrzeuges auf der Basis von zwei Fahrzeug-Standortdaten, die von der Standortdaten- Erwerbeinrichtung (4) erworben wurden;
einer zweiten Rechnereinrichtung (7) zum Berechnen einer geschätzten Bewegungsrichtung (β) des Fahrzeuges auf der Basis von zwei geschätzten Fahrzeugstandorten, die von der einen geschätzten Standort berechnenden Einrichtung zu dem Zeitpunkt berechnet wurden, wenn die beiden Fahrzeug-Standortdaten von der Standort-Erwerbeinrichtung erworben werden;
einer Korrektureinrichtung (7) für eine Korrektur des geschätzten Fahrzeugkurses mittels eines Unterschiedes (α-β) zwischen der durch die erste Rechnereinrichtung berechneten Bewegungsrichtung (α) und der durch die zweite Rechnereinrichtung berechneten geschätzten Bewegungsrichtung (β);
wobei der geschätzte Fahrzeugstandort durch die einen geschätzten Standort berechnende Einrichtung (6) erneut berechnet wird auf der Basis des korrigierten geschätzten Fahrzeugkurses.
2. Fahrzeug-Kurskorrekturvorrichtung nach Anspruch 1, bei welcher die Standortdaten-Erwerbeinrichtung einen Empfänger (4) fur ein globales Positionierungssystem aufweist.
DE69209330T 1991-01-23 1992-01-17 Fahrzeughaltungkorrekturvorrichtung Expired - Fee Related DE69209330T2 (de)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP3006600A JPH04238220A (ja) 1991-01-23 1991-01-23 車両方位修正装置

Publications (2)

Publication Number Publication Date
DE69209330D1 DE69209330D1 (de) 1996-05-02
DE69209330T2 true DE69209330T2 (de) 1996-11-28

Family

ID=11642830

Family Applications (1)

Application Number Title Priority Date Filing Date
DE69209330T Expired - Fee Related DE69209330T2 (de) 1991-01-23 1992-01-17 Fahrzeughaltungkorrekturvorrichtung

Country Status (4)

Country Link
US (1) US5317515A (de)
EP (1) EP0496538B1 (de)
JP (1) JPH04238220A (de)
DE (1) DE69209330T2 (de)

Families Citing this family (44)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5646843A (en) * 1990-02-05 1997-07-08 Caterpillar Inc. Apparatus and method for surface based vehicle control system
US5483457A (en) * 1991-10-25 1996-01-09 Matsushita Electric Industrial Co., Ltd. Vehicle navigation system using GPS including correction of coefficients for velocity sensor
DE69314219T2 (de) * 1992-04-20 1998-03-12 Sumitomo Electric Industries Vorrichtung zur Detektion des Fahrzeugkurses
DE69333916T2 (de) * 1992-07-23 2006-07-06 Aisin AW Co., Ltd., Anjo Navigationsgerät für Fahrzeuge zur Bestimmung eines neuen Leitwegs, wenn ein Fahrzeug von seinem Leitweg abweicht
US5606506A (en) * 1993-04-05 1997-02-25 Caterpillar Inc. Method and apparatus for improving the accuracy of position estimates in a satellite based navigation system using velocity data from an inertial reference unit
US5517419A (en) * 1993-07-22 1996-05-14 Synectics Corporation Advanced terrain mapping system
US5983161A (en) 1993-08-11 1999-11-09 Lemelson; Jerome H. GPS vehicle collision avoidance warning and control system and method
DE4332945A1 (de) * 1993-09-28 1995-03-30 Bosch Gmbh Robert Ortungs- und Navigationsgerät mit Satellitenstützung
US5559696A (en) * 1994-02-14 1996-09-24 The Regents Of The University Of Michigan Mobile robot internal position error correction system
FI942218A0 (fi) * 1994-05-13 1994-05-13 Modulaire Oy Automatiskt styrningssystem foer obemannat fordon
US5512904A (en) * 1994-06-13 1996-04-30 Andrew Corporation Method and apparatus of establishing a vehicle azimuth
JP3423418B2 (ja) * 1994-06-30 2003-07-07 松下電器産業株式会社 移動体旋回角度算出装置
DE69526410T2 (de) * 1994-07-04 2003-01-16 Siemens Ag Verfahren zur bestimmung einer richtungsänderung während der fahrzeugnavigation, vorrichtung zur durchführung dieses verfahrens und fahrzeug mit einer solchen vorrichtung
US5617317A (en) * 1995-01-24 1997-04-01 Honeywell Inc. True north heading estimator utilizing GPS output information and inertial sensor system output information
US5906653A (en) * 1995-12-01 1999-05-25 Fujitsu Ten Limited Navigation system and gyroscopic device
US5745868A (en) * 1995-12-26 1998-04-28 Motorola, Inc. Method for rapid recovery from dead reckoning system heading loss
US5862511A (en) * 1995-12-28 1999-01-19 Magellan Dis, Inc. Vehicle navigation system and method
US6029111A (en) * 1995-12-28 2000-02-22 Magellan Dis, Inc. Vehicle navigation system and method using GPS velocities
US5991692A (en) * 1995-12-28 1999-11-23 Magellan Dis, Inc. Zero motion detection system for improved vehicle navigation system
GB2309320B (en) * 1996-01-18 1999-09-08 Heckett Multiserv Plc Manufacturing installation and processing operations
DE19645209B4 (de) * 1996-11-02 2005-07-28 Robert Bosch Gmbh Ortungsvorrichtung für ein Kraftfahrzeug mit einem Satellitenempfänger und Ortungsverfahren
US6308134B1 (en) 1996-12-27 2001-10-23 Magellan Dis, Inc. Vehicle navigation system and method using multiple axes accelerometer
US5828585A (en) * 1997-01-17 1998-10-27 Delco Electronics Corporation Vehicle speed signal calibration
US6230100B1 (en) * 1997-01-31 2001-05-08 Motorola, Inc. Method and apparatus for differential scale factor calibration in differential odometry systems integrated with GPS
WO1998048292A2 (en) * 1997-01-31 1998-10-29 Greenfield Enterprises, Inc. Navigation system and method
US5897603A (en) * 1997-06-23 1999-04-27 Caterpillar Inc. Method for determining the relationship between the heading of a machine and the course of machine travel
US6166698A (en) * 1999-02-16 2000-12-26 Gentex Corporation Rearview mirror with integrated microwave receiver
US6536123B2 (en) 2000-10-16 2003-03-25 Sensation, Inc. Three-axis magnetic sensor, an omnidirectional magnetic sensor and an azimuth measuring method using the same
US6550151B2 (en) * 2001-01-19 2003-04-22 Donald R. Airey Contour measuring device and method
US6725553B2 (en) * 2001-01-19 2004-04-27 Donald R. Airey Contour measuring device and method
US7109920B2 (en) * 2003-07-16 2006-09-19 General Electric Company Moving platform position determination system and method
KR100560966B1 (ko) 2004-10-12 2006-03-15 삼성광주전자 주식회사 로봇 청소기의 자이로 센서 보정방법
US7522998B2 (en) * 2004-11-05 2009-04-21 Johnson Controls Technology Company System and method for displaying vehicle location information
JP4466705B2 (ja) * 2007-09-21 2010-05-26 ヤマハ株式会社 ナビゲーション装置
JP5609073B2 (ja) * 2009-06-16 2014-10-22 カシオ計算機株式会社 測位装置、測位方法およびプログラム
JP2011007736A (ja) * 2009-06-29 2011-01-13 Casio Computer Co Ltd 測位装置、測位方法およびプログラム
JP4911389B2 (ja) * 2009-09-30 2012-04-04 Necビッグローブ株式会社 情報表示システム、サーバ、端末、及び方法
US8514070B2 (en) 2010-04-07 2013-08-20 Securealert, Inc. Tracking device incorporating enhanced security mounting strap
JP6314173B2 (ja) * 2016-06-23 2018-04-18 ローム株式会社 携帯機器
WO2018050566A1 (de) 2016-09-14 2018-03-22 Prothelis Gmbh Autarkes ortungssystem
WO2018050563A1 (de) 2016-09-14 2018-03-22 Prothelis Gmbh Sicherheits- und ortungsgeraet
US10332395B1 (en) 2017-12-21 2019-06-25 Denso International America, Inc. System and method for translating roadside device position data according to differential position data
CN111033423B (zh) * 2018-04-18 2023-11-21 百度时代网络技术(北京)有限公司 用于评估自动驾驶车辆的定位系统的方法
US20220325502A1 (en) * 2021-04-09 2022-10-13 Caterpilar Inc. Methods and systems for determining machine state

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4032758A (en) * 1975-11-05 1977-06-28 The Boeing Company Compensated vehicle heading system
CA1235782A (en) * 1984-05-09 1988-04-26 Kazuo Sato Apparatus for calculating position of vehicle
US4788645A (en) * 1986-03-21 1988-11-29 Etak, Incorporated Method and apparatus for measuring relative heading changes in a vehicular onboard navigation system
US4924402A (en) * 1986-07-02 1990-05-08 Pioneer Electronic Corporation Method for identifying current position of vehicle
JPS63150617A (ja) * 1986-12-15 1988-06-23 Honda Motor Co Ltd 走行経路表示装置
JP2669889B2 (ja) * 1989-04-07 1997-10-29 住友電気工業株式会社 自立航法装置に用いる角速度センサの較正装置
JPH0792388B2 (ja) * 1989-04-17 1995-10-09 住友電気工業株式会社 位置検出装置
US5087919A (en) * 1989-09-05 1992-02-11 Pioneer Electronic Corporation On-board navigation apparatus
JP2536190B2 (ja) * 1989-10-24 1996-09-18 三菱電機株式会社 移動体用ナビゲ―ション装置
JPH03279809A (ja) * 1990-03-28 1991-12-11 Sumitomo Electric Ind Ltd 方位検出装置
JPH04238221A (ja) * 1991-01-21 1992-08-26 Sumitomo Electric Ind Ltd 方位検出装置

Also Published As

Publication number Publication date
DE69209330D1 (de) 1996-05-02
US5317515A (en) 1994-05-31
EP0496538A2 (de) 1992-07-29
EP0496538B1 (de) 1996-03-27
JPH04238220A (ja) 1992-08-26
EP0496538A3 (en) 1992-12-23

Similar Documents

Publication Publication Date Title
DE69209330T2 (de) Fahrzeughaltungkorrekturvorrichtung
DE69210930T2 (de) Positionsbestimmungsverfahren
DE69204575T2 (de) Vorrichtung zur Bestimmung eines Ortes.
DE69100195T2 (de) Gerät zur Kursbestimmung.
DE69509587T2 (de) Verfahren und Vorrichtung zum Feststellen eines Fahrzeugazimuths
DE69303530T2 (de) Vorrichtung zur Bestimmung der Position eines Fahrzeuges
DE60031868T2 (de) Navigationssystem und -verfahren zum verfolgen der position eines objektes
DE69202067T2 (de) Verfahren zur Kursbestimmung.
DE69210319T2 (de) Vorrichtung für das Berechnen der Position und des Azimuths eines Fahrzeuges
DE69636482T2 (de) Verbessertes fahrzeugnavigationssystem und -verfahren mittels gps-geschwindigkeiten
DE69314219T2 (de) Vorrichtung zur Detektion des Fahrzeugkurses
DE69617269T2 (de) Nullbewegungsdetektionssystem für verbessertes fahrzeugnavigationssystem
DE4029215C2 (de)
DE69732581T2 (de) Navigationssystem, welches GPS-Daten verwendet
DE69313812T2 (de) Distanzfehlerkorrekturverfahren für Navigationsvorrichtung
DE68926610T2 (de) Fahrzeugnavigationsgerät
DE69031140T2 (de) Kalibrierungseinrichtung eines Drehgeschwindigkeitsgebers in einem selbständigen Navigationssystem
DE69107586T2 (de) Einrichtung zur Driftfehlerkorrektur eines Gierwinkelgeschwindigkeitssensors.
DE69433886T2 (de) VERFAHREN UND VORRICHTUNG ZUR BESTIMMUNG der ABSOLUTEN FAHRZEUGPOSITION IN FAHRZEUGNAVIGATIONSSYSTEMEN
DE69314218T2 (de) Vorrichtung zur Bestimmung der Position eines Fahrzeuges
DE60014848T2 (de) Geländenavigationsgerät für tiere mit beinen
DE69617268T2 (de) Verbessertes fahrzeugnavigationssystem und -verfahren
DE3905602C2 (de) Navigationsvorrichtung und -verfahren
DE69730394T2 (de) Verfahren und Gerät zur Erkennung und Kompensation des GPS Antennenhebelarms in einem integrierten GPS/Koppelnavigationssystem
DE112006003390T5 (de) Verwaltetes Durchmesssystem und Verfahren zum Erlangen von genauen Vermessungsdaten in Abwesenheit von präzisen GPS-Daten

Legal Events

Date Code Title Description
8364 No opposition during term of opposition
8320 Willingness to grant licences declared (paragraph 23)
8339 Ceased/non-payment of the annual fee