DE102011055804B4 - position determination - Google Patents
position determination Download PDFInfo
- Publication number
- DE102011055804B4 DE102011055804B4 DE201110055804 DE102011055804A DE102011055804B4 DE 102011055804 B4 DE102011055804 B4 DE 102011055804B4 DE 201110055804 DE201110055804 DE 201110055804 DE 102011055804 A DE102011055804 A DE 102011055804A DE 102011055804 B4 DE102011055804 B4 DE 102011055804B4
- Authority
- DE
- Germany
- Prior art keywords
- lane
- vehicle
- hypothesis
- hypotheses
- module
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; 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
- G01C21/30—Map- or contour-matching
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
Die vorliegende Erfindung betrifft ein Verfahren zum Ermitteln einer fahrspurbezogenen Positionsinformation eines fahrspurgebundenen Fahrzeuges, das sich auf einer von mehreren möglichen Fahrspuren (F1, F2, F3) bewegt, mit a) Ermitteln von mehreren möglichen Fahrspurkandidaten (F1, F2, F3) aus einer Fahrspuren enthaltenen digitalen Karte (2) in Abhängigkeit von einer fehlerbehafteten fahrspurunabhängigen Ortsposition (P) des Fahrzeuges durch ein Fahrspurermittlungsmodul (1), und b) Ermitteln mindestens einer Positionshypothese (H1, H2, H3) über die Position des Fahrzeuges auf einer Fahrspur für jeden möglichen Fahrspurkandidaten (F1, F2, F3) durch Projektion der fehlerbehafteten fahrspurunabhängigen Ortsposition (P) auf den jeweiligen Fahrspurkandidaten (F1, F2, F3) durch ein Hypothesenermittlungsmodul (3), wobei c) Positionsfortschreiben der Positionshypothese (H1, H2, H3) jedes Fahrspurkandidaten (F1, F2, F3) auf der jeweiligen Fahrspur in Abhängigkeit von Fahrzeugbewegungsinformationen (B1, B2) durch ein Hypothesenfortschreibungsmodul (6, 7, 8), d) Bewerten jeder der fortgeschriebenen Positionshypothesen (H1, H2, H3) hinsichtlich der Wahrscheinlichkeit für die Richtigkeit der jeweiligen Positionshypothese durch ein Hypothesenbewertungsmodul (4), und e) Auswählen einer Positionshypothese (H1, H2, H3) als fahrspurbezogene Positionsinformation in Abhängigkeit von den Bewertungen der Positionshypothesen durch ein Hypothesenauswahlmodul (5).The present invention relates to a method for determining lane-related position information of a lane-bound vehicle which is moving in one of a plurality of possible lanes (F1, F2, F3), with a) determining a plurality of possible lane candidates (F1, F2, F3) from one lane contained digital map (2) depending on a faulty lane-independent location position (P) of the vehicle by a lane determination module (1), and b) determining at least one position hypothesis (H1, H2, H3) about the position of the vehicle in a lane for each possible Lane candidates (F1, F2, F3) by projecting the faulty lane-independent location position (P) onto the respective lane candidates (F1, F2, F3) by a hypothesis determination module (3), where c) updating the position hypothesis (H1, H2, H3) of each lane candidate (F1, F2, F3) on the respective lane depending on the vehicle movement information (B1, B2) by a hypothesis updating module (6, 7, 8), d) evaluating each of the updated position hypotheses (H1, H2, H3) with regard to the probability of the correctness of the respective position hypothesis by a hypothesis evaluation module (4), and e) Selection of a position hypothesis (H1, H2, H3) as lane-related position information depending on the evaluations of the position hypotheses by a hypothesis selection module (5).
Description
Die Erfindung betrifft ein Verfahren und eine Vorrichtung zum Ermitteln einer fahrspurbezogenen Positionsinformation eines fahrspurgebundenen Fahrzeuges, das sich auf einer von mehreren möglichen Fahrspuren bewegt, mit Ermitteln von mehreren möglichen Fahrspurkandidaten aus einer Fahrspuren enthaltenen digitalen Karte in Abhängigkeit von einer fehlerbehafteten fahrspurunabhängigen Ortsposition des Fahrzeuges durch ein Fahrspurermittlungsmodul und Ermitteln mindestens einer Positionshypothese über die Position des Fahrzeuges auf einer Fahrspur für jeden möglichen Fahrspurkandidaten durch Projektion der fehlerbehafteten fahrspurunabhängigen Ortsposition auf den jeweiligen Fahrspurkandidaten durch ein Hypothesenermittlungsmodul.The invention relates to a method and a device for determining a lane-related position information of a lane-bound vehicle, which moves on one of several possible lanes, with determining multiple possible lane candidates from a lanes digital map contained in response to a faulty lane-independent spatial position of the vehicle by a Lane Detection Module and determining at least one positional hypothesis about the position of the vehicle on a lane for each possible lane candidate by projecting the faulty lane independent location position on the respective lane candidate through a hypothesis determination module.
Für die Positionsbestimmung von Fahrzeugen sind im Stand der Technik vielerlei Systeme bekannt. So kann beispielsweise mit Hilfe eines Satellitennavigationssystems eine relativ genaue Ortsposition eines Fahrzeuges auf der Erde ermittelt werden, indem die Signallaufzeiten von Positionssignalen zwischen Fahrzeug und Satelliten ermittelt und aus dem Schnittpunkt, der sich aus den Signallaufzeiten ergebenen Entfernungen die Position abgeleitet wird.For determining the position of vehicles, many systems are known in the prior art. Thus, for example, with the aid of a satellite navigation system, a relatively accurate spatial position of a vehicle on the ground can be determined by determining the signal propagation times of position signals between the vehicle and the satellite, and from the intersection point, the position is derived from the signal delays.
Derartige Satellitennavigationssysteme weisen jedoch zwei gravierende Nachteile auf. Zum einen muss für die korrekte Berechnung der Ortsposition immer mindestens zu vier Satelliten Sichtkontakt bestehen, damit eine hinreichend genaue Berechnung der Ortsposition möglich ist. Bei Abschattungen, wie beispielsweise bei Durchfahrten durch einen Tunnel oder in Städten mit großen Gebäudeschluchten kann dies nicht immer gewährleistet werden, so dass es hier zu einer eingeschränkten Funktionsweise kommt. Zum anderen ist das Ortungsergebnis eines solchen Satellitennavigationssystems ohne weitere Hilfsmittel nur auf einige wenige Meter genau, so dass insbesondere bei spurgebundenen Fahrzeugen, wie beispielsweise Schienenfahrzeugen oder Straßenfahrzeugen, die tatsächlich befahrene Fahrspur sich nicht allein aus dem Ortungsergebnis des Satellitennavigationssystems ableiten lässt. Für eine spurgenaue Ortungsinformation ist es jedoch notwendig, dass neben der Ortsposition des Fahrzeuges auch die von dem Fahrzeug momentan befahrene Fahrspur ermittelbar ist.However, such satellite navigation systems have two serious disadvantages. On the one hand, there must always be at least four satellites visual contact for the correct calculation of the spatial position, so that a sufficiently accurate calculation of the spatial position is possible. In the case of shadowing, such as when passing through a tunnel or in cities with large building gullies, this can not always be guaranteed, so that it comes here to a limited functionality. On the other hand, the locating result of such a satellite navigation system is accurate to a few meters without additional aids, so that, in particular in track-bound vehicles such as rail vehicles or road vehicles, the actual traffic lane can not be derived solely from the locating result of the satellite navigation system. For a tracking information accurate to the lane, however, it is necessary that, in addition to the spatial position of the vehicle, the lane currently being traveled by the vehicle can also be determined.
Für den Fall, dass mehrere mögliche Fahrspuren an der aktuellen Ortsposition des Fahrzeuges in Frage kommen und die tatsächlich befahrene Fahrspur allein aus dem Ortungsergebnis des Satellitennavigationssystem nicht ableitbar ist, sind aus dem Stand der Technik sogenannte Map-Matching-Verfahren bekannt, mit deren Hilfe die Ortsposition aus dem Satellitennavigationssystem auf eine der Fahrspuren projiziert wird, die mit einer gewissen Wahrscheinlichkeit der tatsächlichen Fahrspur entspricht. Aus der Ortungsinformation und unter Zugrundelegung einer digitalen Karte, die entsprechende Fahrspuren enthält, werden diejenigen Fahrspurkandidaten ermittelt, die beispielsweise innerhalb des Fehlertoleranzbereiches der Ortungsinformationen liegen. Anschließend wird die Ortungsinformation bzw. Ortsposition, die mit Hilfe des Satellitennavigationssystems ermittelt wurde, auf die Fahrspurkandidaten projiziert, wobei das Projektionsergebnis anschließend bewertet und die beste Bewertung als Ergebnis des Map-Matching-Verfahrens ausgegeben wird. Anschließend werden diese Verfahrensschritte für die nächste gemessene Ortsposition aus dem Satellitennavigationssystem wiederholt.In the event that several possible lanes at the current position of the vehicle in question and the actually traveled lane alone from the tracking result of the satellite navigation system is not derivable, so-called map-matching methods are known from the prior art, with the help of the Position is projected from the satellite navigation system on one of the lanes, which corresponds with a certain probability of the actual lane. From the location information and on the basis of a digital map which contains corresponding lanes, those lane candidates are determined, which lie, for example, within the fault tolerance range of the location information. Subsequently, the location information determined by means of the satellite navigation system is projected onto the lane candidates, the projection result being subsequently evaluated and the best rating output as a result of the map matching method. Subsequently, these process steps are repeated for the next measured spatial position from the satellite navigation system.
Der Nachteil eines solchen aus dem Stand der Technik bekannten Map-Matching-Verfahrens liegt in der Tatsache begründet, dass bei jedem Zyklus die möglichen Fahrspurkandidaten ermittelt und die gemessene Ortsposition auf die möglichen Fahrspurkandidaten projiziert werden muss, was sehr rechenintensiv ist. Insbesondere bei recht leistungsschwachen mobilen Endgeräten ist somit eine spurbezogene Positionsermittlung in Echtzeit nur bedingt möglich, die jedoch Voraussetzung für das autonome Fahren ist. Denn um die richtige Lösung für die momentane Fahrspur nicht auszuschließen, müssen in jedem Zyklus alle möglichen Kandidaten bewertet werden.The disadvantage of such known from the prior art map matching method is due to the fact that each cycle determines the possible lane candidates and the measured location position must be projected onto the possible lane candidates, which is very computationally intensive. In particular, in the case of rather low-performance mobile terminals, it is therefore only possible to a certain extent to track-related position determination in real time, which however is a prerequisite for autonomous driving. Because in order not to rule out the right solution for the current lane, every possible candidate has to be evaluated in each cycle.
Ein weiterer Nachteil besteht darin, dass klassische Map-Matching-Verfahren keinen modularen Aufbau aufweisen, wodurch deren Modifikation bzw. Ersatz einzelner Prozesse erschwert wird.Another disadvantage is that classical map matching methods have no modular structure, whereby their modification or replacement of individual processes is difficult.
Aus der
Aufgabe der vorliegenden Erfindung ist es somit, ein verbessertes Verfahren und eine verbesserte Vorrichtung zur Ermittlung einer fahrspurbezogenen Positionsinformation anzugeben, was grundsätzlich echtzeitfähig ist und gegenüber den aus dem Stand der Technik bekannten Verfahren eine geringere Komplexität aufweist.It is therefore an object of the present invention to provide an improved method and an improved device for determining lane-related position information, which is fundamentally real-time capable and has lower complexity than the methods known from the prior art.
Die Aufgabe wird mit dem Verfahren der eingangs genannten Art erfindungsgemäß gelöst durch
- c) Positionsfortschreiben der Positionshypothese jedes Fahrspurkandidaten auf der jeweiligen Fahrspur in Abhängigkeit von Fahrzeugbewegungsinformationen durch ein Hypothesenfortschreibungsmodul,
- d) Bewerten jeder der fortgeschriebenen Positionshypothesen hinsichtlich der Wahrscheinlichkeit für die Richtigkeit der jeweiligen Positionshypothese durch elf Hypothesenbewertungsmodul und
- e) Auswählen einer Positionshypothese als fahrspurbezogene Positionsinformation in Abhängigkeit von den Bewertungen der Positionshypothesen durch ein Hypothesenauswahlmodul.
- c) position updating of the position hypothesis of each lane candidate on the respective traffic lane in dependence on vehicle movement information by a hypothesis updating module,
- d) Evaluate each of the updated position hypotheses with respect to the probability of the correctness of the respective position hypothesis by eleven hypothesis evaluation module and
- e) selecting a position hypothesis as lane-related position information depending on the ratings of the position hypotheses by a hypothesis selection module.
Erfindungsgemäß wird somit vorgeschlagen, dass anstelle einer zyklischen Wiederholung der Schritte des Ermittelns der möglichen Fahrspurkandidaten und der Projektion der gemessenen Ortsposition diese Schritte nur anfänglich einmal durchgeführt werden und anschließend die möglichen Positionshypothesen auf den einzelnen Fahrspuren der Fahrspurkandidaten in Abhängigkeit von Fahrzeugbewegungsinformationen fortgeschrieben werden, wobei die fortgeschriebenen Positionshypothesen dann in den Bewertungsschritt zur Bewertung der Positionshypothesen eingehen. Hierdurch kann die Komplexität der benötigten Berechnungen verringert werden, was das erfindungsgemäße Map-Matching-Verfahren grundsätzlich echtzeitfähig macht.According to the invention, it is thus proposed that, instead of a cyclical repetition of the steps of determining the possible lane candidates and the projection of the measured spatial position, these steps are only initially performed once and then the possible position hypotheses on the individual lanes of the lane candidates are updated in dependence on vehicle movement information, wherein the updated position hypotheses then enter the valuation step for the evaluation of the position hypotheses. As a result, the complexity of the required calculations can be reduced, which basically makes the map matching method according to the invention real-time capable.
Eine Positionshypothese ist dabei eine auf einer der möglichen Fahrspuren angenommene mögliche Position des Fahrzeuges, die sich aus der Projektion und/oder aus der Positionsfortschreibung auf der Fahrspur ergibt. Die am Besten bewertete Positionshypothese kann dann beispielsweise als fahrspurbezogene Positionsinformation ausgegeben werden.A position hypothesis is a possible position of the vehicle assumed on one of the possible lanes, which results from the projection and / or from the position update on the lane. The best rated position hypothesis can then be output, for example, as lane-related position information.
Das Fortschreiben der Positionshypothesen ist dabei ein Anpassen bzw. Verändern der Positionshypothesen, d. h. der angenommenen Positionen auf der Fahrspur, in Abhängigkeit von Fahrzeugbewegungsinformationen, wie beispielsweise die zurückgelegte Distanz. So lässt sich aus einem Satellitennavigationssystem oder anderen Sensorquellen die zurückgelegte Distanz des Fahrzeuges ermitteln, die dann zur Anpassung bzw. Korrektur der einzelnen Positionshypothesen der jeweiligen Fahrspurkandidaten im nächsten Zyklus herangezogen wird. Das Fortschreiben der Positionshypothesen ist dabei weniger rechenintensiv als die Auswahl der Kandidaten und das Projizieren der Ortungsinformationen auf die einzelnen Fahrspurkandidaten.The updating of the position hypotheses is an adaptation or change of the position hypotheses, ie. H. the assumed positions on the lane, in response to vehicle movement information, such as the distance traveled. Thus, the distance traveled by the vehicle can be determined from a satellite navigation system or other sensor sources, which is then used to adapt or correct the individual position hypotheses of the respective lane candidates in the next cycle. The updating of the position hypotheses is less computationally intensive than the selection of the candidates and the projecting of the location information on the individual lane candidates.
Die Schritte c) bis e) können vorteilhafterweise kontinuierlich wiederholt werden, so dass sich die Positionshypothesen zyklisch über einen gewissen Zeitraum fortschreiben lassen.The steps c) to e) can advantageously be repeated continuously so that the position hypotheses can be cyclically updated over a certain period of time.
Neben der direkten Distanz-Positionsfortschreibung, bei der die zurückgelegte Distanz des Fahrzeuges zur Aktualisierung der Positionshypothesen auf den einzelnen Fahrspurkandidaten herangezogen wird, ist alternativ oder zusätzlich auch eine korrektive Distanz-Positionsfortschreibung denkbar. Die korrektive Distanz-Positionsfortschreibung dient der Kalibrierung der Längsposition der Positionshypothesen auf den einzelnen Fahrspurkandidaten und soll verhindern, dass die Positionshypothese vom wahren Standort aufgrund von aufsummierten Fehlern abdriftet.In addition to the direct distance position update, in which the distance traveled by the vehicle is used for updating the position hypotheses on the individual lane candidates, alternatively or additionally, a corrective distance position update is conceivable. The corrective distance position update is used to calibrate the longitudinal position of the position hypotheses on the individual lane candidates and to prevent the position hypothesis from drifting away from the true location due to accumulated errors.
So ist es beispielsweise denkbar, dass mit Hilfe eines Sensorsystems, wie beispielsweise einem Inertialsystem mit Beschleunigungssensoren, der Übergang von einer geradlinigen Bewegung des Fahrzeuges in eine kreisförmige Bewegung des Fahrzeuges erkannt wird, wie er beispielsweise bei Einfahrten in Kurven oder gekrümmten Fahrspurverläufen auftritt und mit Hilfe von Beschleunigungssensoren und Gyroskopen ermittelbar ist.So it is conceivable, for example, that with the help of a sensor system, such as an inertial system with acceleration sensors, the transition from a linear movement of the vehicle is detected in a circular motion of the vehicle, such as occurs when entering curves or curved lane courses and with the help of acceleration sensors and gyroscopes can be determined.
Selbstverständlich lässt sich auch der Übergang von einer kreisförmigen Bewegung des Fahrzeuges in eine gradlinige Bewegung des Fahrzeuges auf diese Art erkennen. Die Positionshypothesen jedes Fahrspurkandidaten können nun mit Hilfe einer aus der digitalen Karte ermittelbaren Positionsinformation des Übergangs für den jeweiligen Fahrspurkandidaten korrigiert werden, so dass jede Positionshypothese beim Erkennen des Übergangs auf die in der Karte hinterlegte Position des Übergangs für die jeweilige Fahrspur korrigiert wird.Of course, the transition from a circular movement of the vehicle to a straight-line movement of the vehicle can be recognized in this way. The position hypotheses of each lane candidate can now be corrected by means of a determinable from the digital map position information of the transition for the respective lane candidate, so that each position hypothesis is corrected upon detection of the transition to the deposited in the map position of the transition for the respective lane.
Alternativ oder zusätzlich ist es für eine korrektive Distanz-Positionsfortschreibung auch denkbar, dass mit Hilfe eines derartigen Sensorsystems (beispielsweise Beschleunigungssensoren) der Krümmungsradius eines gekrümmten Fahrspurverlaufes beim Durchfahren einer Kurve ermittelt wird, wobei die Positionshypothesen jedes Fahrspurkandidaten dann in Abhängigkeit einer Korrelation des erkannten Krümmungsradius mit einer aus der digitalen Karte ermittelbaren Krümmungsinformation der jeweiligen Fahrspur für den jeweiligen Fahrspurkandidaten korrigiert werden können. Durch die Korrelation des ermittelten Krümmungsradius mit einer in der digitalen Karte hinterlegten Krümmungsinformation der einzelnen Fahrspurkandidaten lässt sich so die konkrete Position auf den einzelnen Fahrspuren ermitteln, auf denen sich das Fahrzeug befinden könnte.Alternatively or additionally, it is also conceivable for a corrective distance position update that the curvature radius of a curved lane course when driving through a curve is determined with the aid of such a sensor system (for example acceleration sensors), wherein the position hypotheses of each lane candidate then depend on a correlation of the detected radius of curvature with a can be determined from the digital map curvature information of the respective lane for the respective lane candidate. By correlating the determined radius of curvature with a curvature information of the individual lane candidates stored in the digital map, it is thus possible to determine the specific position on the individual lanes on which the vehicle could be located.
Die Aufgabe wird im Übrigen auch mit einer Vorrichtung der eingangs genannten Art erfindungsgemäß gelöst durch
- c) ein Hypothesenfortschreibungsmodul, das zur Positionsfortschreibung der Positionshypothese jedes Fahrspurkandidaten auf der jeweiligen Fahrspur in Abhängigkeit von Fahrzeugbewegungsinformationen eingerichtet ist,
- d) ein Hypothesenbewertungsmodul, das zum Bewerten jeder der fortgeschriebenen Positionshypothesen hinsichtlich der Wahrscheinlichkeit für die Richtigkeit der jeweiligen Positionshypothese eingerichtet ist, und
- e) ein Hypothesenauswahlmodul, das zum Auswählen einer Positionshypothese als fahrspurbezogene Positionsinformation in Abhängigkeit von den Bewertungen der Positionshypothesen eingerichtet ist.
- c) a hypothesis updating module adapted to position-update the position hypothesis of each lane candidate on the respective lane in response to vehicle motion information,
- d) a hypothesis evaluation module adapted to evaluate each of the updated positional hypotheses for the likelihood of the correctness of the respective position hypothesis, and
- e) a hypothesis selection module adapted to select a position hypothesis as lane-related position information depending on the scores of the position hypotheses.
Vorteilhafte Ausgestaltungen dieser Vorrichtung finden sich in den entsprechenden Unteransprüchen.Advantageous embodiments of this device can be found in the corresponding subclaims.
Die vorliegende Erfindung wird anhand der beigefügten Figuren beispielhaft näher erläutert. Es zeigen:The present invention will be explained in more detail by way of example with reference to the attached figures. Show it:
Das Fahrspurermittlungsmodul
Die möglichen Fahrspurkandidaten finden nun Eingang in das Hypothesenermittlungsmodul
Diese Positionshypothesen finden im ersten Zyklus Eingang in das Hypothesenbewertungsmodul
Die Bewertung der Positionshypothesen durch das Hypothesenbewertungsmodul
Erfindungsgemäß wird nunmehr in einem nächsten Zyklus nicht der gesamte Map-Matching-Prozess, wie vorstehend beschrieben, vollständig erneut durchgeführt, sondern die Positionshypothesen finden Eingang in ein Hypothesenfortschreibungsmodul
Somit findet in das Untermodul
So lässt sich beispielsweise unter Zugrundelegung einer angenommenen Position auf einer Fahrspur als Positionshypothese und einer zurückgelegten Strecke die neue angenommene Position auf der Fahrspur mit Hilfe der sogenannten Koppelnavigation ermitteln, was unter der direkten Distanz-Positionsfortschreibung verstanden werden kann.Thus, for example, based on an assumed position on a lane as a position hypothesis and a covered distance, the new assumed position on the lane can be determined with the aid of so-called dead-reckoning, which can be understood as the direct distance-position update.
Das Ergebnis der direkten Distanz-Positionsfortschreibung durch das Untermodul
Als Eingang in das Untermodul
Somit kann zu gegebenen Zeitpunkten an entsprechend markanten Punkten, wie beispielsweise diesen vorgenannten Übergängen, das Ergebnis der Positionshypothesen, d. h. die Position auf den einzelnen Fahrspuren, auf diese Übergänge normiert werden.Thus, at given times at correspondingly prominent points, such as these aforementioned transitions, the result of the position hypotheses, i. H. the position on the individual lanes, be normalized to these transitions.
Denkbar ist auch, dass alternativ oder zusätzlich hierzu mit Hilfe der Fahrzeugbewegungsinformationen aus dem Inertialsystem ein Krümmungsradius ermittelt wird, den das Fahrzeug gerade auf seiner Fahrspur durchfährt. Durch Korrelation des gemessenen Krümmungsradius mit einer in der digitalen Karte für die einzelnen Fahrspuren hinterlegten Krümmungsinformation kann dann ebenfalls die Positionshypothese für die jeweilige Fahrspur des Fahrspurkandidaten korrigiert werden.It is also conceivable that, alternatively or additionally, with the aid of the vehicle movement information from the inertial system, a radius of curvature is determined which the vehicle is currently driving through in its lane. By correlating the measured radius of curvature with a curvature information stored in the digital map for the individual lanes, it is then also possible to correct the position hypothesis for the respective lane of the lane candidate.
Die fortgeschriebenen Positionshypothesen, die von dem Hypothesenfortschreibungsmodul
Die fortgeschriebenen Positionshypothesen können darüber hinaus auch wieder als Eingang in das Hypothesenfortschreibungsmodul
Des Weiteren ist es besonders vorteilhaft, wenn die Bewertung der fortgeschriebenen Positionshypothesen im nächsten Zyklus ebenfalls in die erneute Bewertung der fortgeschriebenen Positionshypothesen mit einfließt, so dass das Hypothesenbewertungsmodul
Im nächsten Zyklus wird die zurückgelegte Distanz, ausgehend von der Position des vorhergehenden Zyklus, zur Positionsfortschreibung der Positionshypothesen H1 bis H3 verwendet. Es werden somit keine neuen Fahrspurkandidaten und Projektionen mehr durchgeführt, sondern die Hypothesen H1 bis H3 werden auf ihren jeweiligen Fahrspuren F1 bis F3 entsprechend der zurückgelegten Distanz fortgeschrieben, so dass sich eine neue Position der Positionshypothesen H1 bis H3 auf den jeweiligen Fahrspuren ergibt. Die Bewertung der neuerlichen Hypothesen erfolgt dann in Abhängigkeit einer weiteren gemessenen fahrspurunabhängigen Ortsposition P2.In the next cycle, the distance traveled, starting from the position of the previous cycle, is used for position updating of the position hypotheses H1 to H3. Thus, no new lane candidates and projections are carried out, but the hypotheses H1 to H3 are updated on their respective lanes F1 to F3 according to the distance traveled, so that there is a new position of the position hypotheses H1 to H3 on the respective lanes. The evaluation of the new hypotheses then takes place as a function of a further measured lane-independent spatial position P2.
Die Fortschreibung der Hypothesen kann dabei beliebig oft wiederholt werden, wobei bei häufigen Wiederholungen es zu einem Abdriften aufgrund von Summenfehlern kommen kann. Hierfür wird an markanten Punkten eine Korrektur der Distanz-Positionsfortschreibung durchgeführt.The updating of the hypotheses can be repeated as often as desired, with frequent repetitions, drifting due to cumulative errors can occur. For this purpose, a correction of the distance position update is performed at prominent points.
Es sei beispielsweise eine Hypothese H4 auf der Fahrspur F2 kurz vor Einfahrt in eine Kurve angenommen. Die Hypothese H4 befindet sich kurz vor dem Übergang UE. Tatsächlich befindet sich das Fahrzeug jedoch gerade in diesem Übergang UE, was mit Hilfe von einem Sensorsystem, beispielsweise einem Inertialsensorsystem, aufgrund der Veränderung der seitlichen Beschleunigungskräfte bzw. Rotationskräfte erkennbar ist. Aus der digitalen Karte ist darüber hinaus eine Positionsinformation bezüglich dieses Überganges ermittelbar, so dass die Positionshypothese H4 in Abhängigkeit von dieser aus der digitalen Karte ermittelten Positionsinformationen des Überganges, zum Zeitpunkt der Detektion, korrigiert werden kann. Dadurch lässt sich die Abdrift durch Aufsummieren von Kopplungsfehlern vermeiden.For example, assume a hypothesis H4 on the lane F2 just before entering a curve. The hypothesis H4 is just before the transition UE. In fact, however, the vehicle is currently in this transition UE, which can be detected by means of a sensor system, for example an inertial sensor system, due to the change in the lateral acceleration forces or rotational forces. In addition, position information relating to this transition can be determined from the digital map, so that the position hypothesis H4 can be corrected as a function of this position information of the transition, which is determined from the digital map, at the time of detection. This makes it possible to avoid the drift by summing up coupling errors.
ZusammenfassungSummary
Die vorliegende Erfindung betrifft ein Verfahren zum Ermitteln einer fahrspurbezogenen Positionsinformation eines fahrspurgebundenen Fahrzeuges, das sich auf einer von mehreren möglichen Fahrspuren (F1, F2, F3) bewegt, mit
a) Ermitteln von mehreren möglichen Fahrspurkandidaten (F1, F2, F3) aus einer Fahrspuren enthaltenen digitalen Karte (
b) Ermitteln mindestens einer Positionshypothese (H1, H2, H3) über die Position des Fahrzeuges auf einer Fahrspur für jeden möglichen Fahrspurkandidaten (F1, F2, F3) durch Projektion der fehlerbehafteten fahrspurunabhängigen Ortsposition (P) auf den jeweiligen Fahrspurkandidaten (F1, F2, F3) durch ein Hypothesenermittlungsmodul (
wobei
c) Positionsfortschreiben der Positionshypothese (H1, H2, H3) jedes Fahrspurkandidaten (F1, F2, F3) auf der jeweiligen Fahrspur in Abhängigkeit von Fahrzeugbewegungsinformationen (B1, B2) durch ein Hypothesenfortschreibungsmodul (
d) Bewerten jeder der fortgeschriebenen Positionshypothesen (H1, H2, H3) hinsichtlich der Wahrscheinlichkeit für die Richtigkeit der jeweiligen Positionshypothese durch ein Hypothesenbewertungsmodul (
e) Auswählen einer Positionshypothese (H1, H2, H3) als fahrspurbezogene Positionsinformation in Abhängigkeit von den Bewertungen der Positionshypothesen durch ein Hypothesenauswahlmodul (
a) determining a plurality of possible lane candidates (F 1 , F 2 , F 3 ) from a lane-containing digital map (
b) determining at least one position hypothesis (H 1 , H 2 , H 3 ) about the position of the vehicle on a lane for each possible lane candidate (F 1 , F 2 , F 3 ) by projecting the faulty lane-independent spatial position (P) to the respective one Lane candidates (F 1 , F 2 , F 3 ) by a hypothesis determination module (
in which
c) Position updating of the position hypothesis (H 1 , H 2 , H 3 ) of each lane candidate (F 1 , F 2 , F 3 ) on the respective lane as a function of vehicle movement information (B 1 , B 2 ) by a hypothesis update module (
d) evaluating each of the updated position hypotheses (H 1 , H 2 , H 3 ) with respect to the probability of the correctness of the respective position hypothesis by a hypothesis evaluation module (
e) selecting a position hypothesis (H 1 , H 2 , H 3 ) as lane-related position information as a function of the evaluations of the position hypotheses by a hypothesis selection module (
Claims (11)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE201110055804 DE102011055804B4 (en) | 2011-11-29 | 2011-11-29 | position determination |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE201110055804 DE102011055804B4 (en) | 2011-11-29 | 2011-11-29 | position determination |
Publications (2)
Publication Number | Publication Date |
---|---|
DE102011055804A1 DE102011055804A1 (en) | 2013-05-29 |
DE102011055804B4 true DE102011055804B4 (en) | 2014-01-02 |
Family
ID=48287700
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
DE201110055804 Expired - Fee Related DE102011055804B4 (en) | 2011-11-29 | 2011-11-29 | position determination |
Country Status (1)
Country | Link |
---|---|
DE (1) | DE102011055804B4 (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102017210129A1 (en) * | 2017-06-16 | 2018-12-20 | Siemens Aktiengesellschaft | Positioning method, in particular GPS method, computer program product for determining positions, in particular GPS positions, and track-bound vehicle, in particular rail vehicle |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102009046595A1 (en) * | 2008-11-11 | 2010-09-23 | Visteon Global Technologies, Inc., Van Buren Township | Map Assisted Positioning Sensor System |
-
2011
- 2011-11-29 DE DE201110055804 patent/DE102011055804B4/en not_active Expired - Fee Related
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102009046595A1 (en) * | 2008-11-11 | 2010-09-23 | Visteon Global Technologies, Inc., Van Buren Township | Map Assisted Positioning Sensor System |
Also Published As
Publication number | Publication date |
---|---|
DE102011055804A1 (en) | 2013-05-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
DE102005031409B4 (en) | Vehicle navigation system and computer program product | |
EP3491339B1 (en) | Method, device and computer-readable storage medium with instructions for determining the lateral position of a vehicle relative to the lanes of a road | |
DE102014221888A1 (en) | Method and device for locating a vehicle in its environment | |
EP3377858B1 (en) | Method for aggregating traffic lane information for digital map services | |
WO2018197122A1 (en) | Method for automatically producing and updating a dataset for an autonomous vehicle | |
DE102010007240A1 (en) | Method for determining a track course of a route | |
DE102013009856B4 (en) | Determining the position of a stationary traffic object using a central server arrangement | |
DE102014215570A1 (en) | Car navigation system | |
EP3475876A1 (en) | Controller, system having such a controller and method for operating such a system | |
DE102014212866A1 (en) | Method for determining a parking space from a number of measuring points | |
DE102017208509A1 (en) | Method for generating a road model during a journey of a motor vehicle and control device and motor vehicle | |
DE102017211712A1 (en) | A data generation method for generating and updating a topology map for at least one room of at least one building | |
DE102014209751A1 (en) | Display of maneuver instructions for a route | |
DE102014007794A1 (en) | Method for operating a vehicle control system | |
DE102016207181A1 (en) | Method and system for determining a position of a vehicle on a roadway | |
DE102011055804B4 (en) | position determination | |
DE102018007659A1 (en) | Method for updating an environment map for a motor vehicle | |
DE102007015227A1 (en) | Method for determining active drive lane of roadway from vehicle, involves determining active drive lane from vehicle by artificial neuronal network that has input layer, activation layer and output layer | |
DE10035626C2 (en) | Navigation device and method for position correction | |
DE102013217776A1 (en) | A method for automatically switching off a manually switched direction indicator of a motor vehicle | |
DE102022132629A1 (en) | METHOD OF PREDICTING AN INTERSECTION TRANSITION TIME ADJUSTING AN UNEVEN TURN AND SIGNAL WAIT TIME AND APPARATUS USING THIS METHOD | |
DE112018001586T5 (en) | Vehicle control device | |
DE102017222563A1 (en) | Method and device for communication between several motor vehicles | |
DE102005059284A1 (en) | Method for determining corrected current position data, in particular for determining current vehicle positions | |
WO2020148047A1 (en) | Method for training a trajectory for a vehicle, and electronic vehicle guiding system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
R012 | Request for examination validly filed | ||
R016 | Response to examination communication | ||
R018 | Grant decision by examination section/examining division | ||
R020 | Patent grant now final | ||
R020 | Patent grant now final |
Effective date: 20141003 |
|
R082 | Change of representative |
Representative=s name: GRAMM, LINS & PARTNER PATENT- UND RECHTSANWAEL, DE |
|
R119 | Application deemed withdrawn, or ip right lapsed, due to non-payment of renewal fee |