Titel

Auswerten von Ortungsmessungen eines Umfeldsensors für ein Kraftfahrzeug

Die Erfindung betrifft ein Verfahren zum Auswerten von Ortungsmessungen eines Umfeldsensors für ein Kraftfahrzeug, bei dem Ortungsmessungen und zugehörige Messunsicherheiten der Ortungsmessungen von dem Umfeldsensor erhalten werden.

In Fahrerassistenzsystemen für Kraftfahrzeuge, beispielsweise in Systemen zur automatischen Abstandsregelung oder in Kollisionswarnsystemen, werden häufig Radarsensoren zur Erfassung des Verkehrsumfelds eingesetzt.

In letzter Zeit besteht zunehmendes Interesse an Radarsensoren mit immer höherer Winkelauflösung und Winkeltrennfähigkeit, die bei einem ausgedehnten Objekt je nach Größe und Abstand sehr viele Radarreflexe detektieren können.

Roos et al.,„Reliable Orientation Estimation of Vehicles in High- Resolution Radar Images“, IEEE Transactions on Microwave Theory and Techniques 64.9 (2016), 2986-2993, beschreibt einen

Clusteralgorithmus, der bei der Zuordnung von Radarmessungen zu einem Objekt unabhängig von bereits existierendem Wissen über das Objekt arbeitet. Dies kann jedoch zu Sprüngen in den Objektparametern, wie Orientierung oder Ausdehnung, führen.

Eine Zuordnung jeder einzelnen, zu einem Objekt assoziierten Messung zu einem entsprechenden Punkt eines detaillierten Objektmodells würde hingegen ein hohes Modellwissen bezüglich Objektart und Objektausdehnung

voraussetzen, was jedoch nicht immer zuverlässig vorliegt. Aufgabe der Erfindung ist es, ein Verfahren zum Auswerten von

Ortungsmessungen eines Umfeldsensors für ein Kraftfahrzeug anzugeben, das es erlaubt, eine Zustandsschätzung eines Objekts in effizienter Weise zu verbessern.

Diese Aufgabe wird erfindungsgemäß mit den in den unabhängigen Ansprüchen angegebenen Merkmalen gelöst. Vorteilhafte Weiterbildungen und

Ausgestaltungen der Erfindung sind in den Unteransprüchen angegeben. Der Umfeldsensor kann beispielsweise ein Radarsensor sein.

Das Schätzen von aktuellen Zustandsparametern des Objekts kann

insbesondere durch Anpassung der Zustandsparameter an die zu dem Objekt assoziierten Ortungsmessungen erfolgen. Das Schätzen von aktuellen

Zustandsparametern unter Berücksichtigung der Gewichtungen kann auch als gewichtete Schätzung, gewichtete Anpassung oder gewichtetes Fitten (engl.: weighted fitting) bezeichnet werden.

Der Lösungsgedanke besteht im Kern darin, dass für neue Messungen, die zu einem bereits angelegten Objekt assoziiert werden, eine jeweilige

Assoziationswahrscheinlichkeit bestimmt wird, und die

Assoziationswahrscheinlichkeiten in Gewichtungen für einen gewichteten Fit von Modellparametern (Zustandsparametern) des Objekts eingehen. Der Fit kann beispielsweise für ein Geradenstück, welches eine Kante eines Objekts beschreibt, für die Zustandsparameter Ort, Orientierung, und Minimum und Maximum eines Gültigkeitsbereichs (Endpunkte des Geradenstücks) erfolgen, und es wird somit das Geradenstück neu geschätzt.

Indem mehrere Messungen in eine Parameterschätzung von

Zustandsparametern des Objekts eingehen, kann der Datenumfang eines Objekts verringert werden, und es kann eine robustere Beschreibung einer Vielzahl von Objekten ermöglicht werden. Dabei kann zugleich eine iterative Fortschreibung von Objektzuständen von Objekten durch den Zustandsschätzer erfolgen. Gegenüber einer herkömmlichen Zuordnung einzelner Messungen zu definierten Punkten eines Modells wird somit eine größere Robustheit erreicht. Insbesondere kann durch die Gewichtung der Parameteranpassung der Zustandsparameter die Robustheit des Verfahrens gegenüber nicht im Modell enthaltenen systematischen Abweichungen zwischen Ortungsmessungen und dem Modell erhöht werden. Beispiele für derartige systematische Abweichungen sind z.B. systematische Abweichungen in der Radialgeschwindigkeit von Reflexionen an drehenden Rädern, oder z.B. Abweichungen realer

Objektkantenverläufen von einer Modellierung in Form einer geraden Strecke.

Eine Ortungsmessung kann beispielsweise Messungen des Abstands r, der Radialgeschwindigkeit vr, und/oder eines Objektwinkels phi umfassen, beispielsweise eines Azimutwinkels. Bei einem Umfeldsensor in Form eines Radarsensors entsprechen die Ortungsmessungen Radarreflexionen an einem Objekt.

Ein Objektzustand kann beispielsweise Zustandsparameter eines

Rechteckkastens (Box) oder einer Kante in einer Umgebung des Umfeldsensors umfassen, wie z.B. eine kartesische Position, Ausdehnung, und/oder

Geschwindigkeit in kartesischen Koordinaten.

Dass eine Bestimmung oder Berechnung von einer Größe abhängt, bedeutet hier, dass die Größe eine Eingangsgröße der Bestimmung oder Berechnung ist, und dass das Ergebnis der Bestimmung oder Berechnung von ihr abhängt. Insbesondere umfasst eine Eingangsgröße der Berechnung unterschiedliche Werte, für die unterschiedliche Ergebnisse erhalten werden.

Die Assoziationswahrscheinlichkeit kann insbesondere eine Wahrscheinlichkeit repräsentieren dafür, dass die Ortungsmessung eine genau Ortung eines realen Objektes darstellt, auf welches sich der geschätzte Objektzustand bezieht. Die Assoziationswahrscheinlichkeit kann beispielsweise eine Wahrscheinlichkeit dafür angeben, dass die betreffende Ortungsmessung zu dem durch den geschätzten Objektzustand beschriebenen Objekt gehört. Mit anderen Worten kann die Assoziationswahrscheinlichkeit eine Wahrscheinlichkeit dafür angeben, dass die Ortungsmessung von dem realen Objekt erhalten wurde, welches durch den geschätzten Objektzustand beschrieben wird. Bei der Bestimmung der Assoziationswahrscheinlichkeit kann beispielsweise der geschätzte Objektzustand berücksichtigt werden, wobei für zunehmende räumliche Übereinstimmungen eines gemessenen Ortes einer Ortungsmessung mit dem geschätzten Objektzustand zunehmende

Assoziationswahrscheinlichkeiten bestimmt werden, und/oder wobei für zunehmende Übereinstimmungen einer gemessenen Geschwindigkeit einer Ortungsmessung mit dem geschätzten Objektzustand zunehmende

Assoziationswahrscheinlichkeiten bestimmt werden.

Unterschiedliche Assoziationswahrscheinlichkeiten werden vorzugsweise durch unterschiedliche Gewichtungen (Gewichte) berücksichtigt. Die

Assoziationswahrscheinlichkeit wird als einer von mehreren Werten bestimmt, die mehrere Zwischenwerte zwischen einer unteren Grenze (z.B. Null) und einer oberen Grenze (z.B. Eins) umfassen. Beispielsweise kann die

Assoziationswahrscheinlichkeit aus einer Menge von diskreten Werten oder aus einem Wertebereich bestimmt werden.

Bei der Anpassung der Zustandsparameter an die zu dem Objekt assoziierten Ortungsmessungen ist für die Ortungsmessungen jeweils die Gewichtung abhängig von der bestimmten Assoziationswahrscheinlichkeit für die

Assoziierung der betreffenden Ortungsmessung zu dem Objekt. Beispielsweise können insbesondere für zunehmende Assoziationswahrscheinlichkeiten zunehmende Gewichtungen verwendet werden. Beispielsweise können die Assoziationswahrscheinlichkeiten als Gewichtungen der Ortungsmessungen bei der Anpassung der Zustandsparameter an die zum dem Objekt assoziierten Ortungsmessungen verwendet werden.

In einem oder mehreren Ausführungsformen wird bei dem Bestimmen der Assoziationswahrscheinlichkeit für die Assoziierung einer Ortungsmessung zu dem Objekt die Assoziationswahrscheinlichkeit unter Berücksichtigung der Messunsicherheit der Ortungsmessung bestimmt. Beispielsweise kann die Messunsicherheit der Ortungsmessung durch eine Verringerung der betreffenden Assoziationswahrscheinlichkeit berücksichtigt werden, wobei für zunehmende Messunsicherheiten größere Verringerungen erfolgen können. In einem oder mehreren Ausführungsformen wird bei dem Bestimmen der Assoziationswahrscheinlichkeit für die Assoziierung einer Ortungsmessung zu dem Objekt die Assoziationswahrscheinlichkeit unter Berücksichtigung einer Unsicherheit des geschätzten Objektzustands des Objekts bestimmt.

Beispielsweise kann die Unsicherheit des geschätzten Objektzustands des Objekts durch eine Verringerung der betreffenden Assoziationswahrscheinlichkeit berücksichtigt werden, wobei für zunehmende Unsicherheiten des geschätzten Objektzustands des Objekts größere Verringerungen erfolgen können.

In einem oder mehreren Ausführungsformen wird bei dem Bestimmen der Assoziationswahrscheinlichkeit für die Assoziierung einer Ortungsmessung zu dem Objekt die Assoziationswahrscheinlichkeit unter Berücksichtigung einer Modell-Unsicherheit des geschätzten Objektzustands des Objekts bestimmt. Beispielsweise kann die Modell-Unsicherheit einer erwarteten Abweichung realer Objekte von einem dem Objekt zugrundeliegenden Modell entsprechen. Die Modell-Unsicherheit kann insbesondere beispielsweise eine Form-Unsicherheit umfassen. Beispielsweise kann die Modell-Unsicherheit bei einem Objekt, dem ein geometrisches Modell zugrundeliegt, die Abweichungen vom Modell beschreiben, welche durch die von dem geometrischen Modell abweichenden realen Formen von PKW und LKW erwartet werden. Beispielsweise kann die Modell-Unsicherheit bei einem Objekt, dem ein Modell eines rechteckigen Kastens (oder einer geraden Kante) zugrundeliegt, die Abweichungen vom Modell beschreiben, welche durch die von der Kastenform (oder der Form einer geraden Kante) abweichenden realen Formen von PKW und LKW erwartet werden.

Vorzugsweise wird in dem Schritt des Assoziierens von erhaltenen

Ortungsmessungen zu dem durch einen geschätzten Objektzustand

beschriebenen Objekt eine Ortungsmessung nur dann zu dem durch den geschätzten Objektzustand beschriebenen Objekt assoziiert, wenn die

Assoziationswahrscheinlichkeit für die Assoziierung einen Mindestwert erreicht. Dies wird auch als Gating bezeichnet. Somit gehen die Ortungsmessungen, auf deren Basis das Schätzen von aktuellen Zustandsparametern des Objekts durchgeführt wird, mit jeweiligen Gewichtungen in die Schätzung ein, wobei die jeweilige Gewichtung abhängig ist von der bestimmten Assoziationswahrscheinlichkeit. Dabei werden oberhalb des Mindestwerts unterschiedliche Assoziationswahrscheinlichkeiten durch unterschiedliche Gewichtungen berücksichtigt. Es erfolgt also nicht lediglich eine Aussortierung von Ortungsmessungen und eine gleichwertige Berücksichtigung der übrigen Ortungsmessungen.

Das Assoziieren von erhaltenen Ortungsmessungen zu einem durch einen geschätzten Objektzustand beschriebenen Objekt kann ein Assoziieren von erhaltenen Ortungsmessungen zu einem oder mehreren durch einen geschätzten Objektzustand beschriebenen Teilobjekten eines Objekts umfassen. Eine Assoziierung zu einem Teilobjekt eines Objekts stellt auch eine Assoziierung zu dem Objekt dar.

Die aktuellen Zustandsparameter, die im Schritt des Schätzens von aktuellen Zustandsparametern des Objekts geschätzt werden, können beispielsweise Zustandsparameter von einem oder mehreren Teilobjekten des Objekts sein. So können beispielsweise Zustandsparameter einer Seitenkante eines

Rechteckkastens auf der Basis von zu der Seitenkante assoziierten

Ortungsmessungen geschätzt werden.

Das Verfahren umfasst vorzugsweise: Aktualisieren des geschätzten

Objektzustands des Objekts durch den Zustandssschätzer, basierend auf dem vorherigen geschätzten Objektzustand des Objekts und auf den geschätzten aktuellen Zustandsparametern des Objekts. Das Aktualisieren kann somit ein iteratives Aktualisieren sein. Besonders bevorzugt umfasst das Verfahren:

Erzeugen einer Vorhersage (Prädiktion) eines neuen Objektzustands durch den Zustandsschätzer anhand des vorherigen geschätzten Objektzustands des Objekts; und Korrigieren der Vorhersage des neuen Objektzustands durch den Zustandsschätzer anhand der geschätzten aktuellen Zustandsparameter des Objekts.

Für die iterative Aktualisierung des geschätzten Objektzustands des Objekts können außerdem Unsicherheiten der geschätzten aktuellen Zustandsparameter des Objekts berücksichtigt werden, die anhand der Messunsicherheiten der Messungen geschätzt werden. Der Zustandsschätzer ist vorzugsweise dazu eingerichtet, den geschätzten Objektzustand des Objekts zu aktualisieren, basierend auf den geschätzten aktuellen Zustandsparametern des Objekts. Mit anderen Worten ist der Zustandsschätzer dazu eingerichtet, einen neuen Objektzustands des Objekts basierend auf dem vorherigen geschätzten Objektzustand und auf den geschätzten aktuellen Zustandsparametern des Objekts zu bestimmen. Der Zustandsschätzer ist besonders bevorzugt dazu eingerichtet, anhand eines vorherigen geschätzten Objektzustands des Objekts eine Vorhersage

(Prädiktion) eines neuen Objektzustands zu erzeugen und anhand der geschätzten aktuellen Zustandsparameter des Objekts die Prädiktion zu korrigieren, um den Objektzustand zu aktualisieren. Es kann sich beispielsweise um ein Kalman Filter, Extended Kalman Filter, Unscented Kalman Filter oder andere bekannte Zustandsschätzer handeln.

Das Verfahren weist vorzugsweise die Schritte auf:

Erhalten von Messunsicherheiten der Ortungsmessungen von dem

Umfeldsensor; und

Schätzen von Unsicherheiten der geschätzten aktuellen Zustandsparameter des Objekts basierend auf den erhaltenen Messunsicherheiten der zu dem Objekt assoziierten Ortungsmessungen,

wobei die geschätzten aktuellen Zustandsparameter des Objekts und die geschätzten Unsicherheiten an den Zustandsschätzer zum Aktualisieren des geschätzten Objektzustands des Objekts übergeben werden.

Das Verfahren kann beispielsweise weiter umfassen: Aktualisieren einer geschätzten Unsicherheit des geschätzten Objektzustands des Objekts durch den Zustandsschätzer.

Gemäß einer Weiterbildung der Erfindung werden die Unsicherheiten der gefitteten Modellparameter mit Hilfe einer Unscented-Transformation (engl.: unscented transform, UT) bestimmt. Beispielsweise kann das Schätzen von Unsicherheiten der geschätzten aktuellen Zustandsparameter des Objekts mittels einer Unscented-Transformation erfolgen, umfassend die Schritte:

Berechnen von Sigma-Punkten der Unscented-Transformation, wobei ein Vektor, der die zu dem Objekt assoziierten Ortungsmessungen umfasst, als

Mittelwertschätzung für eine Verteilung der zu berechnenden Sigma-Punkte verwendet wird, und wobei eine Matrix, welche die Messunsicherheiten der zu dem Objekt assoziierten Ortungsmessungen umfasst, als Kovarianzmatrix für die Verteilung der zu berechnenden Sigma-Punkte verwendet wird;

für jeden Sigma-Punkt der Unscented-Transformation, Schätzen von aktuellen Zustandsparametern des Objekts, umfassend eine Anpassung der

Zustandsparameter an den jeweiligen Sigma-Punkt;

Bestimmen einer Varianz einer Verteilung der für die Sigma-Punkte geschätzten aktuellen Zustandsparameter des Objekts als Schätzung der Unsicherheiten der geschätzten aktuellen Zustandsparameter des Objekts.

Als Eingangsgröße der Unscented-Transformation ist somit gegeben ein Vektor der Ortungsmessungen, die zu dem Objekt assoziiert wurden, und für den die Unsicherheit durch die Messunsicherheiten der Ortungsmessungen, und ggf. auch deren Kovarianzen, angegeben werden kann. Die Sigma-Punkte werden gemäß dem Verfahren der Unscented-Transformation so gewählt, dass die Verteilung der Sigma-Punkte einen Mittelwert und eine Kovarianz aufweisen, welche einem gegebenen Mittelwert in Form des Vektors der zu dem Objekt assoziierten Ortungsmessungen und einer gegebenen Kovarianz in Form der Matrix, welche die Messunsicherheiten der zu dem Objekt assoziierten

Ortungsmessungen umfasst, entsprechen. Somit repräsentiert die Verteilung der Sigma-Punkte und ihre Kovarianz die zu dem Objekt assoziierten

Ortungsmessungen und deren Messunsicherheiten.

Die Sigma-Punkte werden transformiert, indem zu jedem Sigma-Punkt die Schätzung von aktuellen Zustandsparametern des Objekts durchgeführt wird. Ein jeweiliger Sigma-Punkte wird somit in geschätzte aktuelle Zustandsparameter des Objekts transformiert. Die (Ko-)varianz der transformierten Sigma-Punkte gibt dann eine geschätzte Unsicherheit der geschätzten aktuellen Zustandsparameter des Objekts an.

Die Unscented-Transformation ermöglicht es somit, durch Transformation der Sigma-Punkte in jeweilige Schätzungen der aktuellen Zustandsparameter des Objekts eine Schätzung der Unsicherheiten der geschätzten aktuellen

Zustandsparameter zu erhalten.

Somit kann die Unscented-Transformation es leisten, eine Schätzung der Unsicherheiten der geschätzten aktuellen Zustandsparameter des Objekts zu liefern. Dies ist besonders vorteilhaft, da die Parameteranpassung (auch als Fit bezeichnet) gewöhnlich eine nicht-lineare Abbildung darstellt, und

Messunsicherheiten durch eine nicht-lineare Abbildung verzerrt oder mit einem Bias abgebildet würden. Bereits bei einer Transformation von radial- Koordinaten von Ortungsmessungen in kartesische Modellkoordinaten eines Objekts können durch Bestimmung der Unsicherheiten mittels der Unscented-Transformation verbesserte Schätzungen der Unsicherheiten erhalten werden.

Vorzugsweise werden bei der Anpassung der Zustandsparameter an den jeweiligen Sigma-Punkt Gewichtungen für den Sigma-Punkt berücksichtigt, welche Gewichtungen von der Kovarianzmatrix abhängig sind.

Beispielsweise können bei der Anpassung der Zustandsparameter an den jeweiligen Sigma-Punkt die gleichen Gewichtungen verwendet werden wie bei der Anpassung der Zustandsparameter an die zu dem Objekt assoziierten Ortungsmessungen (in dem Schritt des Schätzen von aktuellen

Zustandsparametern des Objekts).

Gegenstand der Erfindung ist außerdem ein Sensorsystem mit einem

Umfeldsensor für Kraftfahrzeuge, in dem eines der oben beschriebenen Verfahren implementiert ist.

Im Folgenden wird ein Ausführungsbeispiel anhand der Zeichnung näher erläutert. Es zeigen:

Fig. 1 eine schematische Darstellung einer Umgebung eines Kraftfahrzeugs;

Fig. 2 eine Prinzipskizze eines Sensorsystems für ein Kraftfahrzeug mit einem Umfeldsensor; und

Fig. 3 einen schematischen Ablaufplan einer Unscented-Transformation zur Bestimmung von Unsicherheiten geschätzter aktueller Zustandsparameter eines Objekts.

Fig. 1 zeigt schematisch eine Umgebung eines Umfeldsensors eines

Kraftfahrzeugs mit mehreren, in einem Erfassungsbereich des Umfeldsensors detektierten Ortungen, die nachfolgend als Ortungsmessungen 10 bzw. 12 bezeichnet werden. Weiter dargestellt sind Objekt 14, die reale Objekte in Form von Kraftfahrzeugen repräsentieren und in Form von rechteckigen Kästen modelliert sind. Jedem Objekt ist im Modell eine Position in kartesischen

Koordinaten X, Y, eine Ausdehnung, eine Orientierung und eine Geschwindigkeit in Form eines Geschwindigkeitsvektors 16 zugeordnet. Eine einzelne

Ortungsmessung 10, 12 umfasst beispielsweise einen radialen Abstand r, eine radiale Relativgeschwindigkeit vr sowie eine Richtungswinkel in Form eines Azimutwinkels phi, jeweils bezogen auf die Eigenposition des Umfeldsensors oder des eigenen Fahrzeugs bei x = 0, y = 0.

In Fig. 1 sind Ortungsmessungen 10, die zu einem Objekt 14 assoziiert wurden, mit ausgefüllten Symbolen darstellt. Ortungsmessungen 12, die zu keinem der Objekte 14 assoziiert wurden, sind durch ein offenes Symbol dargestellt.

Fig. 2 zeigt schematisch ein Sensorsystem mit einem Umfeldsensor 20 in Form eines Radarsensors mit einem Antennensystem 22. Weiter ist schematisch eine Ortungsmessung 10 entsprechend einer georteten Radarreflexion dargestellt.

Eine Auswerteeinheit des Sensorsystems umfasst eine Assoziationseinheit 24 zum Assoziieren von Ortungsmessungen 10 zu einem Objekt 14, eine

Anpassungseinheit 26 zum Durchführen eines Fits zur Anpassung von Zustandsparametern an zu einem Objekt 14 assoziierte Ortungsmessungen 10, eine Unscented-Transformations- Einheit 28 zum Schätzen von Unsicherheiten der angepassten aktuellen Zustandsparameter, sowie einen Zustandsschätzer 30 zur iterativen Aktualisierung eines geschätzten Objektzustandes des Objekts 14.

Die Assoziations- Einheit 24 umfasst eine erste Einheit 32 zum Berechnen von Assoziationswahrscheinlichkeiten sowie eine zweite Einheit 34 zum Auswählen und Assoziieren von Ortungsmessungen 10 zu einem Objekt 14.

Von dem Umfeldsensor 20 werden Ortungsmessungen 10, 12 mit beispielsweise den Parametern r, vr, phi sowie dazugehörige Messunsicherheiten Ar, Avr, Aphi erhalten.

Anfänglich werden Objekte 14 in an sich bekannter Weise über einen

unabhängigen Mechanismus initialisiert, wie beispielsweise ein Clustern von bislang nicht zu Objekten 14 assoziierten Ortungsmessungen 10, 12 und ein entsprechendes Initialisieren von Objektzuständen der neu erzeugten Objekte 14.

Die erste Einheit 32 berechnet zu den jeweiligen Objekten 14

Assoziationswahrscheinlichkeiten p für die Assoziierung jeweiliger

Ortungsmessungen 10, 12 zu dem betreffenden Objekt 14. Die zweite Einheit 34 wählt zu jedem Objekt 14 die aufgrund ihrer Assoziationswahrscheinlichkeit p zu dem Objekt 14 zu assoziierenden Ortungsmessungen 10 aus und assoziiert diese zu dem betreffenden Objekt 14. Ortungsmessungen 12, die nur mit einer geringen Assoziationswahrscheinlichkeit unterhalb eines Mindestwertes pmin zu einem Objekt 14 zu assoziieren sind, werden aussortiert, d. h., sie werden nicht assoziiert. Dies wird auch als Gating bezeichnet. In der in Fig. 1 gezeigten Darstellung sind die zu jeweiligen Objekten 14 assoziierten Ortungsmessungen 10 mit ausgefüllten Symbolen dargestellt.

Im gezeigten Beispiel der Fig. 2 ist die Assoziation für ein Teilobjekt 36 des Objekts 14 in Form einer vorderen Kante des Objekts 14 beispielhaft dargestellt. Das Bestimmen der Assoziationswahrscheinlichkeit p für die Assoziierung einer Ortungsmessung 10 zu einem Objekt 14 (bzw. dem Teilobjekt 36) kann beispielsweise erfolgen unter Berücksichtigung:

der Messunsicherheit Ar, Avr, Aphi, etwa in Form einer Kovarianz im

Messparameterraum;

einer Vorhersageunsicherheit des Objektes 14 bezüglich der Parameter des vorhergesagten Objektzustandes des Objekts 14 wie Position, Geschwindigkeit, Ausdehnung, Orientierung; und/oder

einer Modell-Unsicherheit, bespielsweise in Form einer Form-Unsicherheit des Objektes 14.

Beispielsweise kann als Form-Unsicherheit eines Teilobjektes 36 in Form einer Kante oder Seitenkante eines Objektes 14 eine Abweichung im Bereich von +/- 30 cm einzelner Ortungsmessungen 10 von einem exakt geradlinigen Verlauf der Kante des Modells des Teilobjekts 36 berücksichtigt werden.

Basierend auf den bestimmten Assoziationswahrscheinlichkeiten p wird dann eine Parameterschätzung in Form eines gewichteter Modellfit für das Teilobjekt 36 bzw. das Objekt 14 durchgeführt. Die Anpassungseinheit 26 führt

beispielsweise einen gewichteten Geradenfit in Form eines gewichteten in Kleinste-Quadrate-Geradenfits bzw. in Form einer gewichteten

Hauptkomponentenanalyse durch. Eingangsgrößen des Fits sind in diesem Falle die Positionen der Ortungsmessungen 10. Es kann auch ein Gültigkeitsbereich der angepassten Gerade, entsprechend der Ausdehnung des Teilobjekts 36, geschätzt werden. Für eine Schätzung eines aktuellen Zustandsparameters in Form einer Geschwindigkeit vx, vy eines Objektes 14 kann ebenfalls ein gewichteter Kleinste-Quadrate-Modellfit durchgeführt werden. Beispielswiese kann die Anpassungseinheit 26 bei einer angenommenen Gierrate des Objektes 14 von Null die aktuellen Zustandsparameter vx und vy im Modell

vr = vx * cos(phi) + vy * sin(phi)

schätzen.

Die von der Anpassungseinheit 26 geschätzten aktuellen Zustandsparameter eines Objekts 14 (oder seiner Teilobjekte 36) werden an den Zustandsschätzer 30 übergeben. Um dem Zustandsschätzer 30 zugehörige Unsicherheiten zu den geschätzten aktuellen Zustandsparametern eines Objekts 14 zu liefern, werden die

Unsicherheiten wie folgt geschätzt, indem eine Unscented-Transformation durchgeführt wird. Da es sich sowohl beim Geradenfit als auch bei einem Fit mit der Geschwindigkeitsgleichung vr = vx * cos(phi) + vy * sin(phi) um einen nichtlinearen Zusammenhang handelt, wird eine Unscented Transformation verwendet.

Alle zu einem Objekt 14 assoziierten Ortungsmessungen 10 werden in einem gemeinsamen Vektor Y zusammengefasst. Dazu werden die einzelnen

Ortungsmessungen 10, die jeweils eine Messvektordimension n haben, und von denen I Ortungsmessungen 10 vorliegen, zu einem Vektor der Länge N = n * I zusammengefasst. Eine Kovarianzmatrix K des zusammengefassten

Messvektors Y wird erzeugt, indem beispielsweise die Kovarianzen der einzelnen Ortungsmessungen 10 in einer Block-Diagonalmatrix kombiniert werden. Die Kovarianzmatrix hat eine Größe N x N. Sind Kovarianzen zwischen den

Ortungsmessungen bekannt, können diese in Neben-Block-Diagonalen verzeichnet werden.

Die Durchführung der Unscented-Transformation (UT) ist in Fig. 3 in Form eines schematischen Ablaufplans dargestellt. In einem Schritt S10 werden Sigma- Punkte basierend auf dem zusammengefassten Messvektor Y und dessen zusammengefasster Kovarianz K berechnet, wie an sich für die Unscented Transformation bekannt. Bei einem Gesamt- Messvektor Y der Dimension N werden dabei 2N + 1 Sigma-Punkte berechnet. Für jeden der Sigma-Punkte wird der gewichtete Modellfit (Schritt S12) durchgeführt. Dies entspricht jeweils der von der Anpassungseinheit 26 vorgenommenen Anpassung. Die resultierenden 2N + 1 Ergebnisse der Anpassung stellen eine Verteilung dar, deren Varianz (Kovarianzmatrix) eine Schätzung der Unsicherheiten der von der

Anpassungseinheit 26 geschätzten aktuellen Zustandsparameter des Objektes 14 darstellt. Die Varianz (Kovarianzmatrix) wird dementsprechend aus der Verteilung der 2N + 1 Ergebnisse errechnet (Schritt S14). Sie wird zusammen mit den geschätzten aktuellen Zustandsparametern an den Zustandsschätzer 30 übergeben. Der Zustandsschätzer 30 aktualisiert iterativ den geschätzten Objektzustand des Objekts 14 anhand der von der Anpassungseinheit 26 übergebenen geschätzten aktuellen Zustandsparameter und der von der Unscented-Transformationseinheit 28 übergebenen, zugehörigen Schätzung der Unsicherheiten der geschätzten aktuellen Zustandsparameter des Objekts 14.

Die geschätzten aktuellen Zustandsparameter des Objekts stellen eine Pseudo- Messung P dar. Dem Zustandsschätzer 30 wird in Form der Varianz DR die Schätzung der Unsicherheiten der geschätzten aktuellen Zustandsparameter des Objekts, also der Pseudo-Messung P übergeben. Eine Berücksichtigung der Messunsicherheiten DR der Pseudo-Messung P ermöglicht es somit, die

Zuverlässigkeit der Aktualisierung des geschätzten Objektzustands durch den Zustandsschätzer 30 zu erhöhen.

Der Zustandsschätzer 30 kann zudem die Ausdehnungen des Objektes 14 mit Hilfe der geschätzten aktuellen Zustandsparameter des Objekts 14 (bzw. seiner Teilobjekte 36) schätzen und aktualisieren. Dadurch können beispielsweise schrittweise auch sehr große Objekte, wie z.B. Lastkraftwagen, gänzlich in ihrer Ausdehnung erfasst werden. Eine genauere Schätzung der Ausdehnung eines Objekts 14 kann dann wiederum in einer nächsten Iteration (entsprechend einem nächsten Messzyklus) zu einer besseren Assoziation neuer Ortungsmessungen 10 durch die Assoziationseinheit 24 führen. Entsprechend kann auch die Orientierung des Objekts 14 aktualisiert werden.

Die beschriebenen Schritte können jeweils für alle Objekte 14 und dazu assoziierten Ortungsmessungen 10 entsprechend ausgeführt werden.