Vorteile der
Erfindung
Die
Erfindung mit den in Anspruch 1 angegebenen Merkmalen ermöglicht es,
Ein- und Ausschervorgänge
anderer Fahrzeuge bereits im Ansatz zu erkennen, so daß das Assistenzsystem
frühzeitiger und
angemessener reagieren kann.
Zu
diesem Zweck weist erfindungsgemäß die Erkennungseinrichtung
für die
Ein- und Ausschervorgänge
einen Zustandsautomaten auf. Darunter versteht man ein Datenver arbeitungssystem, das
einer Anzahl von Objekten, in diesem Fall den georteten Fahrzeugen,
jeweils einen von mehreren Zuständen
zuweist, wobei ein System von Regeln für jeden Zustand bestimmt, in
welche anderen Zustände
das Objekt aus dem aktuellen Zustand wechseln kann und unter welchen
Bedingungen ein solcher Wechsel erfolgt. Die vordefinierten Zustände beziehen
sich bei dem erfindungsgemäßen System
auf die aktuelle oder voraussichtliche Position des Objekts in Bezug
auf die Fahrspuren der Fahrbahn. Die Bedingungen für einen
Zustandswechsel beinhalten Kriterien, die sich auf die Ortungsdaten
des betreffenden Objekts beziehen, insbesondere dessen Querposition
und/oder die zeitliche Änderung
der Querposition. Die Zustände
der Objekte werden jeweils anhand der neuesten Ortungsdaten aktualisiert.
Mindestens einer der vorliegenden Zustände ist ein Übergangszustand,
der einen Ein- oder
Ausschervorgang kennzeichnet, also ein Zustand, in dem das Objekt
im Begriff ist, in den Fahrschlauch einzutreten bzw. den Fahrschlauch
zu verlassen.
Der
besondere Vorteil dieses Systems besteht darin, daß sämtliche
Objekte, auch die Objekte, die sich derzeit noch auf Nebenspuren
befinden, fortlaufend im Hinblick darauf überwacht werden, ob ein Spurwechsel
bevorsteht oder stattfindet. Ein Ein- oder Ausschervorgang wird
nicht erst dann erkannt, wenn das betreffende Objekt in den eigenen
Fahrschlauch eingetreten ist oder diesen verlassen hat, sondern
bereits dann, wenn das Objekt in den Übergangszustand eingetreten
ist, der diesem Ereignis vorausgeht.
Vorteilhafte
Weiterbildungen und Ausgestaltungen der Erfindung ergeben sich aus
den Unteransprüchen.
Die
Bedingungen für
den Wechsel eines Objekts in einen Übergangszustand schließen bevorzugt
ein Kriterium ein, das sich auf eine Prädiktion, also einen Vorhersagewert,
für die
Querposition y des Objekts bezieht. Diese Prädiktion beruht auf einer Extrapolation
der Querbewegung des Objekts in die Zukunft. Zu diesem Zweck kann
beispielsweise eine Prädiktionsweite
definiert werden, die vorzugsweise in Abhängigkeit von der Geschwindigkeit
des eigenen Fahrzeugs variabel ist. Die Prädiktion gibt dann an, welche
Querposition y das Objekt voraussichtlich haben wird, nachdem es
längs der
Fahrbahn einen der Prädiktionsweite
entsprechenden Weg zurückgelegt
hat. Im einfachsten Fall ist die Prädiktion eine lineare Extrapolation
der Querbewegung, proportional zur ersten zeitlichen Ableitung der
Querposition. Es ist jedoch auch eine nichtlineare Extrapolation
unter Berücksichtigung
höherer
zeitlicher Ableitungen der Querposition möglich.
Bevorzugt
beruht das Kriterium für
den Eintritt in einen Übergangszustand
auch auf einer Prädiktion
für den
Verlauf der Fahrspuren, so daß auch einem
gekrümmten
Fahrbahnverlauf Rechnung getragen werden kann.
Der
Fahrschlauch ist definiert durch die linken und rechten Grenzen
der eigenen Fahrspur. Im einfachsten Fall werden diese Grenzen bestimmt,
indem für
die Breite der Fahrspur ein Standardwert zugrunde gelegt wird und
angenommen wird, daß sich das
eigene Fahrzeug auf der Mitte der Fahrspur befindet. Sofern ein
Bildverarbeitungssystem vorhanden ist, können die Grenzen des Fahrschlauches auch
anhand der Fahrbahnmarkierungen bestimmt werden. Eine weitere Möglichkeit
ist die statistische Auswertung der Querpositionen von Fahrzeugen
auf den linken und rechten Nebenspuren unter der Annahme, daß der statistische
Mittelwert der Querpositionen für
die Fahrzeuge auf einer Nebenspur annähernd der Mitte dieser Nebenspur
entspricht.
Es
sind auch bereits verschiedene Verfahren zur Prädiktion der Krümmung des
Fahrschlauches bekannt. Eines dieser Verfahren beruht auf der Auswertung
von fahrdynamischen Daten des eigenen Fahrzeugs, beispielsweise
der Querbeschleunigung oder der Giergeschwindigkeit in Verbindung
mit der Absolutgeschwindigkeit. Andere Verfahren beruhen wieder
auf der statistischen Auswertung der Querpositionen und der Änderungen
der Querpositionen vorausfahrender Fahrzeuge. Im Fall eines Radar-Ortungssystems
ist es auch möglich,
die Signale von stationären
Radarzielen am Fahrbahnrand, beispielsweise von Leitplankenpfosten
oder dergleichen, zur Bestimmung der Krümmung des Fahrschlauches heranzuziehen.
Sofern
das Ortungssystem die Möglichkeit bietet
auch die Objektbreite zu messen, beispielsweise im Fall eines Bildverarbeitungssystems,
ist es bevorzugt, daß in
die Kriterien für
Zustandswechsel auch die Breite des jeweiligen Objekts eingeht.
Sofern
keine Breiteninformation über
die Objekte zur Verfügung
steht, werden die Kriterien für
Zustandswechsel vorzugsweise so definiert, daß immer der ungünstigste
Fall angenommen wird, d. h., daß sich
das Radar-Reflexionszentrum des Objekts auf der fahrbahnäußeren Seite
befindet. Die fehlende Breiteninformation kann zumindest teilweise
dadurch ausgeglichen werden, daß die
Querposition und/oder Quergeschwindigkeit des Objekt über einen längeren Zeitraum
verfolgt wird, so daß sich
Fehler, die aus der unbestimmten Lage des Reflexionszentrums resultieren,
mit der Zeit herausmitteln.
Die
vordefinierten Zustände
der Objekt umfassen vorzugsweise eine Anzahl von Basiszuständen, die – ohne Prädiktion
in die Zukunft – die
aktuelle Position des Objekts angeben. Neben den Basiszuständen und
den Übergangszuständen kann
es weitere Zustände
geben, in denen die Zuordnung eines Objekts zu der Fahrspur weniger
gewiß ist,
ohne daß es
bereits eindeutige Indizien für
einen Spurwechsel gibt. Bevorzugt ist jeder Zustand durch einen Zustandsparameter
gekennzeichnet, dessen Vorzeichen die Lage des Objekts rechts oder
links von der Mitte der eigenen Fahrspur angibt und dessen Absolutbetrag
als Relevanzparameter dienen kann, der angibt, mit welcher Wahrscheinlichkeit
das betreffende Objekt im nach geschaltetem Assistenzsystem als ein
relevantes Objekt behandelt werden muß.
Gemäß einer
Ausführungsform
erfolgt nur bei Erkennung eines neuen Objektes eine einmalige Zuordnung
zu einem der Basiszustände.
Danach ist ein Wechsel in einen der anderen Zustände nur nach Maßgabe der
geltenden Regeln in Abhängigkeit
von den neuen Ortungsdaten für
das Objekt möglich.
In
einer anderen Ausführungsform
erfolgt in jedem Taktzyklus des Zustandsautomaten eine Neubestimmung
des Basiszustands anhand der aktuellen Ortungsdaten. Danach erfolgt
dann in demselben Zyklus gegebenenfalls ein Wechsel in einen der
anderen Zustände.
Diese Ausführungsform
hat den Vorteil einer größeren Robustheit,
insbesondere gegenüber
Spurwechseln des eigenen Fahrzeugs.
Zeichnung
Ausführungsbeispiele
der Erfindung sind in den Zeichnungen dargestellt und in der nachfolgenden
Beschreibung näher
erläutert.
Es
zeigen:
1 ein
Blockdiagramm eines erfindungsgemäßen Ortungssystems;
2 und 3 Diagramme
zur Erläuterung
der Arbeits weise des Ortungssystems;
4 ein
Diagramm eines Zustandsautomaten gemäß einer ersten Ausführungsform
der Erfindung;
5 ein
Diagramm eines Zustandsautomaten gemäß einer zweiten Ausführungsform;
6 eine
Abwandlung des Zustandsautomaten gemäß 5; und
7 ein
Diagramm eines Zustandsautomaten gemäß einer weiteren Ausführungsform.
Das
in 1 gezeigte Ortungssystem 30 umfaßt als Sensorkomponenten
einen Radarsensor 32 und eine Videokamera 34,
die so in ein Fahrzeug 36 (2) eingebaut
sind, daß sie
das Vorfeld des Fahrzeugs beobachten. Eine Auswerteeinheit 38 des Ortungssystems
hält eine
Datenaufbereitungseinheit 40 für die Daten des Radarsensors 32,
eine Bildverarbeitungseinheit 42 für die von der Videokamera 34 aufgenommenen
Bilder, ein Tracking-Modul 44 und einen Zustandsautomaten 46,
der als Erkennungseinrichtung für
Ein- und Ausschervorgänge
dient. Die Datenaufbereitseinheit 30 berechnet anhand der vom
Radarsensor 32 gelieferten Signale die Ortungsdaten der
vom Radarsensor georteten Objekte, insbesondere die vorausfahrender
Fahrzeuge. Bei diesen Ortungsdaten handelt es sich um die Abstände und
Relativgeschwindigkeiten der Objekte sowie die Azimutwinkel, unter
denen die Objekte in bezug auf die Längsachse des Fahrzeugs erscheinen.
Diese Ortungsdaten werden periodisch, mit einem vorbestimmten Taktzyklus,
an das Tracking-Modul 44 übermittelt. Die Bildverarbeitungseinheit 42 extrahiert
aus den Bilddaten zusätzliche
Information, die sich auf die Geometrie der georteten Objekte sowie
auf die Fahrbahngeometrie beziehen. Die objektbezogenen Daten werden
an das Tracking-Modul 44 übermittelt, während die
Fahrbahndaten an den Zustandsautomaten 46 übermittelt
werden.
Das
Tracking-Modul 44 ist dazu ausgebildet, nach einem bekannten
Algorithmus die im aktuellen Meßzyklus
erhaltenen Ortungsdaten mit den Daten aus vorangegangenen Zyklen
zu vergleichen und die im aktuellen Zyklus georteten Objekte mit
den früher georteten
Objekten zu identifizieren, so daß die Objekte über einen
längeren
Zeitraum verfolgt werden können.
In diesem Zusammenhang erstellt das Tracking-Modul eine Liste aller
georteten Objekte, und diese Liste wird auch an den Zustandsautomaten 46 übergeben.
Der
Zustandsautomat 46 dient dazu, die georteten Objekte den
verschiedenen Fahrspuren der Fahrbahn zuzuordnen und insbesondere
Ein- und Ausschervorgänge
zu erkennen. Die vom Tracking-Modul und vom Zustandsautomaten 46 bereitgestellten
Informationen werden dann zur weiteren Auswertung an ein Fahrerassistenzsystem 48 übermittelt,
beispielsweise ein ACC-System (Adaptive Cruise Control) zur automatischen
Abstandsregelung.
In 2 sind
das mit dem Ortungssystem 30 ausgerüstete Fahrzeug 36 und
ein weiteres Fahrzeug 50 schematisch in einem x-y-Koordinatensystem
dargestellt. Die x-Achse verläuft
in Fahrtrichtung, also in Richtung der Längsachse des Fahrzeugs 16, und
die y-Achse verläuft
rechtwinklig dazu. Weiterhin sind in 2 die Fahrbahnmarkierungen 52, 54 eingezeichnet,
die die linken und rechten Grenzen des Fahrschlauches, d. h., der
von dem Fahrzeug 36 befahrenen Fahrspur angeben.
Der
Radarsensor 32 empfängt
ein Radarecho von der Rückfront
des Fahrzeugs 50, aus dem sich mit der Abstand x und die
Relativgeschwindigkeit (in x-Richtung) sowie der Azimutwinkel des
Fahrzeugs 50, genauer, eines nicht näher bekannten Reflexionszentrums
an der Rückfront
dieses Fahrzeugs berechnen lassen. Aus dem Abstand und dem Azimutwinkel
läßt sich
auch ein ungefährer
Wert für
die Querposition, d. h. die y-Koordinate des Fahrzeugs 50 berechnen.
Die
Bildverarbeitungseinheit 42 liefert genauere Werte kante_l
und kante_r für
die y-Koordinaten der linken und rechten Kanten des Fahrzeugs 50. Außerdem wird
durch Bildverarbeitung der Verlauf der Fahrbahnmarkierungen 52, 54 jeweils
als Funktion y(x) berechnet.
Größen spur_l
und spur_r geben die Lage der Fahrbahnmarkierungen 52, 54,
d. h., der Grenzen des Fahrschlauches am Ort des Fahrzeugs 50 an.
Im Zustandsautomaten 46 werden diese Größen mit kante_l und kante_r
verglichen, um zu entscheiden, auf welcher Spur der Fahrbahn sich
das Fahrzeug 50 befindet.
Für eine Erkennung
von Ein- und Ausschervorgängen,
beispielsweise eines Einscherens des Fahrzeugs 50 in den
Fahrschlauch zwischen den Fahrbahnmarkierungen 52 und 54,
ist außerdem
die voraussichtliche Beziehung zwischen kante_l und kante_r einerseits
und spur_l und spur_r andererseits zu einem bestimmten Zeitpunkt
in der Zukunft von Interesse. Zu diesem Zweck wird eine Prädiktionsweite
pw definiert, vorzugsweise in Abhängigkeit von der Eigengeschwindigkeit
des Fahrzeugs 36. Weiterhin wird für die Prädiktion die vektorielle Absolutgeschwindigkeit
V2 des Fahrzeugs 50 bestimmt. Addition der vom Radarsensor
gemessenen Relativgeschwindigkeit mit der Eigengeschwindigkeit des Fahrzeugs 36 liefert
die x-Komponente Vx des Fahrzeugs 50. Die y-Komponente
Vy erhält
man durch Differenziation von kante_l und/oder kante_r nach der
Zeit. Vektorielle Addition dieser Geschwindigkeitskomponenten Vx
und Vy liefert den gesuchten Geschwindigkeitsvektor V.
In 3 sind
die linke Fahrbahnmarkierung 52 und eine Gerade 56 eingezeichnet.
Die Gerade 56 ist eine Tangente an die Fahrbahnmarkierung 52 am Ort
des Fahrzeugs 50.
Der
Geschwindigkeitsvektor V ist hier so eingezeichnet, daß sein Ursprung
im Berührungspunkt der
Fahrbahnmarkierung 52 und der Geraden 56 liegt.
Der Geschwindigkeitsvektor V bildet mit der Geraden 56 einen
Winkel α,
der sich rechnerisch bestimmen läßt. Im gezeigten
Beispiel gibt der Winkel α an,
daß sich
das Fahrzeug 50 auf die Fahrbahnmarkierung 52 und
damit auf den Fahrschlauch des Fahrzeugs 36 zu bewegt.
Für eine Prädiktion
der Verhältnisse
zu einem späteren
Zeitpunkt, wenn das Fahrzeug 50 eine der Prädiktionsweite
pw entsprechende Strecke zurückgelegt
hat, wird ein Abbild der Fahrbahnmarkierung 52 an die rechte
Kante des Fahrzeugs 50 angelegt, wie in 2 durch
eine Kurve 58 veranschaulicht wird. Die Kurve 58 wird
dann um den oben erwähnten
Winkel α gedreht.
Man erhält
so eine Kurve 60, die die voraussichtliche Änderung
der Größe kante_r
angibt. Man erkennt, daß die
Kurve 60 die Fahrbahnmarkierung 52 schneidet,
d. h., daß das Fahrzeug 50 voraussichtlich
in den Fahrschlauch eintreten wird. Die Größe präd_spur_l gibt die y-Koordinate
der Fahrbahnmarkierung 52 bei der x-Koordinate an, die
um pw vor dem Fahrzeug 50 liegt. Entsprechend gibt die
Größe präd_kante_r
die y-Koordinate der Kurve 60 an diesem Ort an. Ein Vergleich dieser
beiden Größen liefert
im gezeigten Beispiel die Vorhersage, daß das Fahrzeug 50 in
den Fahrschlauch des Fahrzeugs 36 eintreten wird.
In
der oben beschriebenen Weise werden durch den Zustandsautomaten 46 periodisch
die Ortungsdaten aller georteten Objekte (Fahrzeuge) ausgewertet.
Der Auswertezyklus des Zustandsautomaten 46 kann vom Meßzyklus
der Datenaufbereitungseinheit 40 und der Bildverarbeitungseinheit 42 verschieden
sein, kann jedoch auch damit syn chronisiert sein, so daß die Auswertung
im Zustandsautomaten 46 immer dann erfolgt, wenn neue Ortungsdaten
vorliegen.
Die
Arbeitsweise des Zustandsautomaten 46 soll nun anhand des
in 4 gezeigten Zustandsdiagramms näher erläutert werden.
Im
Zustandsgenerator sind im gezeigten Beispiel dreizehn verschiedene
Zustände
definiert, die jedes geortete Objekt annehmen kann. Diese Zustände sind
gekennzeichnet durch Zustandsparameter ±20, ±17, ±13, ±10, ±7, ±3 und 0. Ein positives Vorzeichen
des Zustandsparameters gibt an, daß sich das betreffende Objekt
auf der linken Seite der Fahrschlauchmitte befindet, und ein negatives
Vorzeichen kennzeichnet Zustände
rechts von der Fahrschlauchmitte. In 4 sind lediglich
die positiven Zustände
für die
linke Fahrspur gezeigt. Für
die nicht gezeigten Zustände
für die
rechte Fahrspur gelten die nachstehenden Erörterungen analog.
Die
Zustände ±20, ±10 und
0 sind Basiszustände,
die angeben, wo sich das Objekt befindet, ohne daß eine Prädiktion
für die
Zukunft berücksichtigt
wird. Beispielsweise ist der Zustand 20 gekennzeichnet
durch die Bedingung kante_r > spur_l,
d. h., das Objekt befindet sich links vom Fahrschlauch auf der linken
Nebenspur. Im Zustand 0 gelten die Bedingungen kante_l > spur_l und kante_r > spur_r, d. h., das
Objekt befindet sich im Fahrschlauch. Im Zustand 10 gilt
die Bedingung kante_r < spur_l
und kante_l > spur_l,
d. h., das Objekt befindet sich auf der linken Fahrschlauchgrenze.
Wenn
ein Objekt erstmals vom Ortungssystem geortet wird, so wird es in
einen der Basiszustände
eingeordnet. Im weiteren Verlauf der Tracking-Prozedur wird das
Objekt dann verfolgt, und gegebenenfalls wird der Zustand anhand
der neuen Ortungsdaten geändert.
Dabei sind jedoch nur solche Zustandsänderungen zulässig, die
in 4 durch Pfeile symbolisiert sind. Zum Beispiel
ist aus dem Zustand 20 nur ein Wechsel in den Zustand 17 möglich, nämlich dann,
wenn die Bedingung gilt: präd_kante_r < präd_spur_l.
Der Zustand 17 kennzeichnet somit eine Situation, in der
sich das Objekt zwar noch auf der linken Nebenspur befindet, aber sich
dem eigenen Fahrschlauch annähert.
Wenn das Fahrzeug sich wieder von der Fahrbahnmarkierung entfernt
(präd_kante_r > präd_spur_l), kehrt das Objekt
wieder in den Zustand 20 zurück. Nähert sich das Objekt dagegen
weiter der Fahrbahnmarkierung an, wird schließlich die Bedingung kante_r < spur_l erfüllt, und
das Objekt geht in den Zustand 10 über.
Wenn
im Zustand 10 die Bedingung präd_kante_l < präd_spur_l
erfüllt
wird, so wechselt das Objekt in den Zustand 7. Das Objekt
befindet sich dann auf der linken Fahrspurmarkierung 52 und bewegt
sich weiter in den eigenen Fahrschlauch hinein. Der Zustand 7 ist
deshalb ein Übergangszustand,
der ein Einscheren des Objekts in den eigenen Fahrschlauch kennzeichnet.
Dieses Einscheren wird an das Assistenzsystem 48 gemeldet
und veranlaßt dieses
System beispielsweise, die Geschwindigkeit des Fahrzeugs 36 zu
reduzieren, um einen ausreichenden Sicherheitsabstand zu dem einscherenden Fahrzeug
aufzubauen.
Der Übergangszustand 7 kann
nur auf zwei Wegen wieder verlassen werden, nämlich entweder in den Zustand 0,
wenn das Objekt tatsächlich
eingeschert ist, oder zurück
in den Zustand 10, wenn das Objekt sich wieder auf die
linke Nebenspur zu bewegt (präd-kante_l > präd_spur_l).
Aus
dem Basiszustand 0 ist nur ein Wechsel in den Zustand 3 oder -3 möglich. Der
Wechsel in den Zustand 3 erfolgt, wenn sich das Fahrzeug
wieder der linken Spurgrenze annähert
(präd_kante_l > präd-spur_l). Kehrt das Objekt
dann wieder zur Mitte des Fahrschlauches zurück, so wechselt der Zustand wieder
zu 0. Andernfalls wird der Zustand 10 erreicht, wenn
die linke Kante des Objekts die Fahrbahnmarkierung überquert.
Wenn
sich das Objekt im Zustand 10 befindet und sich weiter
in Richtung auf die linke Nebenspur bewegt (präd_kante_r > präd_spur_l),
so wechselt das Objekt in den Zustand 13, der wieder ein Übergangszustand
ist, diesmal für
das Ausscheren des Objekts aus dem Fahrschlauch. Der Zustand 13 wird
verlassen entweder in Richtung auf den Zustand 10 (präd_kante-r < präd_spur_l)
oder in Richtung auf den Zustand 20 (kante_r > spur_l).
Wenn
sich ein Objekt in dem Übergangszustand 13 befindet,
erhält
das Fahrerassistenzsystem 48 die Meldung, daß dieses
Objekt voraussichtlich demnächst
nicht mehr bei der Abstandsregelung berücksichtigt zu werden braucht,
so daß das
Fahrzeug 36 wieder auf die Fahrer gewählte Wunschgeschwindigkeit
beschleunigt werden kann. Für
die in 4 nicht berücksichtigte
rechte Nebenspur sind die Übergangszustände die
Zustände -7 für das Einscheren
und -13 für
das Ausscheren.
Die
Zustandsparameter sind im gezeigten Beispiel so gewählt, daß sie im
nachgeschalteten Fahrerassistenzsystem 48 als Relevanzparameter für das betreffende
Objekt benutzt werden können. Je
kleiner der Absolutbetrag des Zustandsparameters ist, desto relevanter
ist das Objekt für
das Verkehrsgeschehen im Fahrschlauch des Fahrzeugs 36.
5 zeigt
ein Diagramm analog zu 4 für ein abgewandeltes Ausführungsbeispiel.
Der wesentliche Unterschied zu dem Beispiel nach 4 besteht
in 5 darin, daß in
jedem Auswertezyklus des Zustandsautomaten 46 zunächst eine
Neubestimmung des Basiszustands für jedes Objekt stattfindet.
Jedes Objekt kann deshalb in jedem Zyklus jeden der fünf Basiszustände (mittlere
Spalte in 5) erreichen, unabhängig davon,
in welchem Zustand es sich vorher befunden hat. Wenn das Objekt
auf diese Weise einen der Basiszustände erreicht hat, beispielsweise
den Zustand 10, werden noch im selben Auswertezyklus die
Kriterien (präd_kante_l < präd_spur_l
oder präd_kante_r > präd_spur_l) für den Wechsel in einen der
zugeordneten Zustände
(7 oder 13) geprüft, und je nach Ergebnis wechselt
das Objekt in einen der Zustände 7, 13 oder
es bleibt im Zustand 10.
6 illustriert
eine Weiterbildung der Ausführungsform
nach 5, bei der zusätzliche
Zustände
und Übergangskriterien
definiert sind. Wenn ein Objekt beispielsweise in einen bestimmten
Auswertezyklus in den Basiszustand 20 gelangt ist und dann
aufgrund der Bedingung präd_kante_r < präd-spur_l
in den Zustand 17 übergeht,
so kann es aus diesem Zustand weiter in den Zustand 15 übergehen,
wenn auch die Bedingung präd_kante_l < präd-spur_l
erfüllt
ist. In diesem Zustand 15 befindet sich das Objekt zwar
immer noch außerhalb
des Fahrschlauches, aber es nähert
sich der Fahrschlauchgrenze noch nachdrücklicher als im Zustand 17,
da hier eine strengere Bedingung erfüllt ist. Der Zustand 15 hat
deshalb für
das Fahrerassistenzsystem 48 eine höhere Relevanz.
Auf
analoge Weise lassen sich zusätzliche Zustände und
Kriterien auch für
die übrigen
Basiszustände
definieren.
Es
sollte an dieser Stelle bemerkt werden, daß sich die Kriterien für Zustandswechsel
nicht auf die Auswertung von Ortungsdaten für das betreffende Objekt beschränken müssen. Als
ergänzendes Kriterium
käme beispielsweise
auch das Setzen des Fahrtrichtungsanzeigers (Blinker links oder
rechts) in Betracht, das von der Bildverarbeitungseinheit 42 erkannt
werden kann. Dieses Kriterium kann z. B. Berücksichtigung finden, indem
zusätzliche
Zustände definiert
werden oder indem in Abhängigkeit
von diesem Kriterium die Prädiktionsweite
pw für
das betreffende Objekt variiert wird. Eine größere Prädiktionsweite hat z. B. zur
Folge, daß das
System empfindlicher auf Querbewegungen des Objekts reagiert.
Weiterhin
ist es denkbar, als zusätzliche
Kriterien für
Zustandswechsel auch die Beziehungen zwischen Bewegungsdaten verschiedener
Objekt heranzuziehen. Als Beispiel kann der Fall betrachtet werden,
daß das
eigene Fahrzeug 36 gerade ein langsameres Fahrzeug A auf
der rechten Nebenspur überholt,
und daß vor
diesem Fahrzeug A auf der rechten Nebenspur ein noch langsameres
Fahrzeug B fährt.
Es ist dann wahrscheinlich, daß das
Fahrzeug A auf die Überholspur,
also den Fahrschlauch des Fahrzeugs 36, einschert, um das
Fahrzeug B zu überholen.
Dies gilt natürlich
erst recht, wenn der Radarsensor 32 gleichzeitig erkennt,
daß das
Fahrzeug A beschleunigt. Andererseits spricht eine Verzögerung des
Fahrzeugs A dafür,
daß dieses
Fahrzeug doch nicht einscheren wird.
Bei
den bisher beschriebenen Ausführungsbeispielen
wurde davon ausgegangen, daß die
Größen kante_l
und kante_r durch das Ortungssystem erfaßbar sind und somit implizit
auch eine Information über
die Breite des Objekts vorliegt. 7 zeigt
ein Ausführungsbeispiel,
das an Ortungssysteme angepaßt
ist, die keine Breiteninformation liefern, aber beispielsweise an
Systeme, die als Sensorkomponente lediglich den Radarsensor 32 enthalten.
Speziell
illustriert 7 eine Variante, bei der ähnlich wie
in 4 eine Erstbestimmung des Basiszustands nur einmal,
nämlich
bei der ersten Erkennung eines neuen Objekts erfolgt. Auch hier
sind wieder nur die Zustände
mit positivem Zustandsparameter dargestellt, also Zustände, die
sich auf die linke Nebenspur beziehen.
Da
keine Breiteninformation vorliegt, wird die Querposition eines Objekts
hier nur durch eine einzige Meßgröße y gekennzeichnet,
die die y-Koordinate des Reflexionszentrums des Objekts angibt.
Als Basiszustände
treten hier nur die Zustände ±20 und
0 auf.
Wenn
y größer ist
als spur_l, wird das Objekt in den Basiszustand 20 eingeordnet.
In diesem Zustand wird ein Spurwechselparameter sw auf 0 gesetzt.
Aus dem Zustand 20 ist nur ein Wechsel in den Zustand 10 möglich, nämlich dann,
wenn y kleiner wird als spur_l. Bei Eintritt in den Zustand 10 wird
der Spurwechselparameter sw um 1 erhöht. Wenn im nächsten Auswertezyklus
des Zustandsautomaten 46 immer noch die Bedingung y < spur_l erfüllt ist, wird
der Spurwechselparameter sw wiederum um 1 erhöht. Dieser
Vorgang wiederholt sich, bis der Spurwechselparameter einen bestimmten
Schwellenwert th (beispielsweise 2) überschreitet. Dann erfolgt
ein Übergang
von dem Zustand 10 in den Zustand 7, der das Einscheren
in den Fahrschlauch kennzeichnet.
Vom
Zustand 7 erfolgt dann unmittelbar ein Übergang in den Basiszustand 0.
Dadurch, daß der Übergangszustand 7 nicht
sofort erreicht wird, wenn y erstmals unter spur_l sinkt, wird dem
Umstand Rechnung getragen, daß bei
diesem Ortungssystem die Messung der y-xoordinate mit einer erheblichen Unsicherheit
behaftet ist.
Der
Zustandsautomat bleibt so lange im Zustand 0, wie die Bedingungen
y < spur_l und
y > spur_r erfüllt sind.
Ebenso wird ein Objekt in den Basiszustand 0 eingeordnet,
wenn diese Bedingungen bei der erstmaligen Ortung des Objekts erfüllt sind.
Der
Spurwechselparameter sw wird im Zustand 0 wieder auf 0 gesetzt.
Der
Zustand 0 wird in Richtung auf den Zustand 3 verlassen,
wenn die Bedingung y > spur_l
erfüllt
ist (oder in Richtung auf den nicht gezeigten Zustand -3,
wenn die Bedingung y < spur_r
erfüllt
ist). Im Zustand 3 wird der Spurwechselparameter schrittweise
verringert, solange die Bedingung y > spur_l weiterhin erfüllt ist, bis der Spurwechselparameter den
Schwellenwert -th unterschreitet. Bei Unterschreitung des Schwellenwertes
erfolgt ein Wechsel in den Übergangszustand 13,
der ein Ausscheren kennzeichnet. Auf den Zustand 13 erfolgt
dann wieder ein unmittelbarer Übergang
in den Zustand 20.
In
den Zuständen 10 und 3 wird
außerdem ein
Prädiktionswert
präd überprüft, der
analog zu den Größen präd_kante_l
und präd_kante_r
definiert ist, nur mit dem Unterschied, daß die Kurve 60 (2) nun
an die mit Hilfe des Radarsensors bestimmte y-Koordinate des Objekts
angelegt wird. Wenn im Zustand 10 die Bedingung präd > spur_l erfüllt ist,
d. h., wenn sich das Objekt vom eigenen Fahrschlauch weg bewegt,
so wird der Zustand 10 in Richtung auf einen neuen Zustand 8 verlassen,
in dem der Spurwechselparameter sw wieder auf 0 zurückgesetzt wird.
Wenn das Objekt wieder die Fahrbahnmarkierung 52 überschreitet(y > spur_l), erfolgt ein Übergang
in den Zustand 3. Führt
dagegen das Objekt eine erneute Richtungsänderung aus, so daß wieder präd < spur_l gilt, so
kehrt das System in Zustand 10 zurück und der Spurwechselparameter,
der im Zustand 8 auf 0 zurückgesetzt wurde, wird wieder schrittweise
erhöht.
Entsprechend
wird, wenn im Zustand 3 die Bedingung präd < spur_l festgestellt
wird, d. h., wenn sich das Objekt wieder dem Fahrschlauch annähert, ein
Zustand 5 erreicht, in dem der Spurwechselparameter auf
0 zurückgesetzt
wird. Von hier ist ein Übergang
in den Zustand 10 möglich,
wenn die Bedingung y < spur_l
erfüllt
ist, oder eine Rückkehr
in den Zustand 3, wenn wieder die Bedingung präd > spur_l erfüllt ist.