-
Die Erfindung betrifft ein Verfahren zum Objekt-Tracking in einem Ortungssystem und ein Ortungssystem.
-
Stand der Technik
-
Es ist bekannt, in Fahrerassistenzsystemen für Fahrzeuge, insbesondere Kraftfahrzeuge, Ortungssysteme, insbesondere Radarsysteme zur Erfassung des Verkehrsumfelds einzusetzen, beispielsweise zur Ortung von vorausfahrenden Fahrzeugen und potenziellen Hindernissen im Vorfeld des eigenen Fahrzeugs. Ein weiteres typisches Anwendungsbeispiel ist ein so genanntes ACC-System (Adaptive Cruise Control) zur automatischen Regelung des Abstands zu einem vorausfahrenden Fahrzeug.
-
Solche Fahrerassistenzsysteme weisen typischerweise einen langreichweitigen Radarsensor (LRR, Long Range Radar) auf, der insbesondere derart gebildet ist, Objekte in einem Abstandsbereich zwischen etwa 2 m und 100 m zu orten. Hierbei werden insbesondere Abstände, Geschwindigkeiten und Winkel (in Azimut und Elevation) von Objekten im Umfeld des Fahrzeugs durch Auswertung der Signallaufzeit und Dopplerverschiebung elektromagnetischer Wellen im Hochfrequenzbereich gemessen. Bekannte Radarsensoren sind beispielsweise aus der
DE 10 2005 029 833 A1 und aus der
DE 10 2006 057 276 A1 bekannt.
-
Für praktische Anwendungen, beispielsweise in einem ACC-System, ist es generell erforderlich, die gemessenen Abstände, Geschwindigkeiten und Winkel der verschiedenen Objekte über einen längeren Zeitraum verfolgen zu können. In einer Prozedur, die als „Tracking“ bezeichnet wird, müssen deshalb die in einem Messzyklus gemessenen Objekte mit den in einem vorangegangenen Messzyklus gemessenen Objekten identifiziert werden. Diese Tracking-Prozedur basiert auf dem Kriterium, dass die zu verschiedenen Zeiten gemessenen Abstände und Relativgeschwindigkeiten für jedes Objekt eine plausible und insbesondere physikalisch mögliche Bewegung des Objekts ergeben müssen.
-
In den bekannten Radarsystemen, insbesondere in den Radarsystemen aus den oben genannten Dokumenten, wird zum Tracking ein adaptiver, diskreter Kalmanfilter eingesetzt. Hierbei wird ein Bewegungsmodell in kartesischen Sensorkoordinaten verwendet. Nachteilig hieran ist aber, dass dieses Bewegungsmodell nur bei kleinen Winkeländerungen des Objektes zuverlässige Werte liefert. Somit ist es zwar ermöglicht, Objekte zu tracken bzw. zu verfolgen, welche sich vor dem Fahrzeug befinden, nicht aber Objekte zu verfolgen, welche beispielsweise an dem Fahrzeug vorbeifahren, da sich hier der Winkel des vorbeifahrenden Objekts im Nahbereich sehr schnell ändert und somit auch die relative Geschwindigkeit, Beschleunigung und Ruck. Werden diese Winkeländerungen nicht im Bewegungsmodell berücksichtigt, so kommt es zu großen Unterschieden zwischen gemessenen und geschätzten bzw. präzidierten Größen.
-
Die Offenlegungsschrift
WO 2006/034886 A1 offenbart ein Verfahren zur Abstands- und Geschwindigkeitsregelung.
-
Die Offenlegungsschrift
DE 196 01 121 A1 offenbart ein Verfahren zur Bestimmung des Abstands und/oder der Differenzgeschwindigkeit zwischen einem Radarsensor und einem oder mehreren Objekten.
-
Offenbarung der Erfindung
-
Die der Erfindung zugrunde liegende Aufgabe kann daher darin gesehen werden, ein Verfahren zum Objekt-Tracking in einem Ortungssystem und ein Ortungssystem anzugeben, welche die bekannten Nachteile überwinden und insbesondere eine zuverlässige Ortung auch von vorbeifahrenden Objekten ermöglichen.
-
Die Aufgabe wird gelöst mittels des Verfahrens nach Anspruch 1 und mittels des Ortungssystems nach Anspruch 5. Vorteilhafte Ausgestaltungen der Erfindung sind Gegenstand von jeweils abhängigen Unteransprüchen.
-
Die Erfindung umfasst den Gedanken, ein Verfahren zum Objekt-Tracking bzw. zur Verfolgung eines Objekts in einem Ortungssystem anzugeben. Hierbei umfasst das Ortungssystem einen Wellenemitter und einen Wellensensor. Der Wellenemitter ist vorzugsweise derart gebildet, Wellen, insbesondere physikalische Wellen, zu emittieren. Der Wellensensor ist insbesondere derart gebildet, Wellen, insbesondere physikalische Wellen zu detektieren. Bei den Wellen kann es sich um longitudinale Wellen und/oder um transversale Wellen handeln. Vorzugsweise werden Ultraschall- und/oder Radarwellen emittiert bzw. detektiert. Vorzugsweise kann das Ortungssystem Objekte in einem Abstand zwischen 0m und 250m orten, vorzugsweise zwischen 0m und 160m, insbesondere zwischen 0m und 80m.
-
In einer beispielshaften Ausgestaltung kann vorgesehen sein, dass das Ortungssystem ein Radarsystem ist. Vorzugsweise umfasst der Wellenemitter einen Radaremitter. Beispielsweise umfasst der Wellensensor einen Radarsensor. Es können insbesondere auch mehrere Radarsensoren und/oder Radaremitter vorgesehen sein. Es kann insbesondere vorgesehen sein, dass der Radarsensor ein Long-Range-Radarsensor (LRR) ist. In einer anderen beispielhaften Ausgestaltung kann der Radarsensor auch ein MRR (Midrange-Radarsensor)-Radarsensor sein.
-
In einer anderen bevorzugten Ausgestaltung kann der Wellenemitter einen Ultraschallemitter umfassen. Bevorzugterweise umfasst der Wellensensor einen Ultraschallsensor. Das Ortungssystem kann insofern vorzugsweise ein Ultraschall-Ortungssystem sein. Insbesondere sind mehrere Ultraschallsensoren und/oder mehrere Ultraschallemitter vorgesehen.
-
In noch einer weiteren beispielhaften Ausführungsform umfasst der Wellenemitter einen oder mehrere Radaremitter und einen oder mehrere Ultraschallemitter, so dass in vorteilhafter Weise sowohl Ultraschallwellen als auch Radarwellen emittiert werden können. In einer anderen bevorzugten Ausführungsform umfasst der Wellensensor einen oder mehrere Radarsensoren und einen oder mehrere Ultraschallsensoren, so dass in vorteilhafter Weise sowohl Radarwellen als auch Ultraschallwellen detektiert werden können.
-
In einem ersten Messzyklus werden zunächst ein erster Abstand und eine erste Geschwindigkeit eines Objektes gemessen, insbesondere ein relativer Abstand und eine relative Geschwindigkeit bezüglich zum Ortungssystem. Vorzugsweise wird ein Radialabstand und/oder eine Radialgeschwindigkeit gemessen. Hierbei werden mittels des Wellenemitters Wellen ausgesandt und die von einem Objekt reflektieren Wellen werden dann mittels des Wellensensors detektiert. Beispielsweise kann hier vorgesehen sein, dass für die Messung eine Sequenz von mehreren sich linear ändernden Frequenzrampen ausgesandt werden. Durch Vergleich der gemessenen Frequenzen mehrerer Rampen der Sequenz mit den emittierten Frequenzen können dann die Entfernung, die Geschwindigkeit und/oder der Winkel (in Azimut und Elevation) zum reflektierenden Objekt gemessen werden.
-
Es wird dann ein präzidierter Abstand und eine präzidierte Geschwindigkeit des Objektes für einen zweiten Messzyklus berechnet. Es wird also vorausberechnet bzw. geschätzt, welche Geschwindigkeit und welchen Abstand das Objekt in einem zweiten Messzyklus aufweist. Dieser Präzidierungsschritt bzw. diese Schätzung wird mittels einer Kalmanfilterung durchgeführt, welche als Eingangsgrößen die gemessene erste Geschwindigkeit und den gemessenen ersten Abstand, insbesondere die Relativgeschwindigkeit und den Relativabstand, vorzugsweise einen Radialabstand und eine Radialgeschwindigkeit, zugeführt bekommt. Erfindungsgemäß wird für die Kalmanfilterung ein Bewegungsmodell in sphärischen Sensorkoordinaten verwendet. Weiterhin wird erfindungsgemäß eine Hilfsvariable eingeführt. Sphärische Sensorkoordinaten im Sinne der Erfindung werden als relativ zum Wellensensor, insbesondere zum Radarsensor oder Ultraschallsensor, definiert. Die Hilfsvariable kann beispielsweise der quadrierte Abstand, insbesondere der quadrierte Radialabstand, sein.
-
In einer beispielhaften Ausgestaltung der Erfindung kann dann basierend auf dem berechneten präzidierten Abstand und der berechneten präzidierten Geschwindigkeit ein Abstandssuchbereich und/oder ein Geschwindigkeitssuchbereich in einem zweiten Messzyklus definiert werden. Wenn dann in dem zweiten Messzyklus Wellen, vorzugsweise Radarwellen und/oder Ultraschallwellen, emittiert bzw. ausgesandt und daraufhin reflektierte Wellen detektiert werden, so werden diese detektierten Wellen dem Objekt zugeordnet, wenn ein aus den detektierten Wellen berechneter zweiter Abstand und/oder eine aus den detektierten Wellen berechnete zweite Geschwindigkeit innerhalb des Abstandssuchbereichs bzw. des Geschwindigkeitssuchbereichs liegen. Beispielsweise kann in dem ersten Messzyklus gemessen worden sein, dass das Objekt 10 m entfernt ist und eine Relativgeschwindigkeit von 10 km/h aufweist. Mittels des erfindungsgemäßen Verfahrens wird dann für einen zweiten Messzyklus präzidiert, dass das Objekt einen Abstand von 8 m und eine Geschwindigkeit von 12 km/h haben müsste. Ein Abstandssuchbereich bzw. ein Geschwindigkeitssuchbereich kann dann ± 2 m bzw. ± 2 km/h betragen. Wenn dann in dem zweiten Messzyklus ein Objekt detektiert wird, was eine Geschwindigkeit und einen Abstand aufweist, welche außerhalb dieser Suchbereiche liegen, so wird dieses Objekt nicht mit dem aus dem ersten Messzyklus georteten Objekt assoziiert.
-
Die Erfindung bietet insbesondere den Vorteil, dass es nun möglich ist, auch vorbeifahrende Fahrzeuge sicher zu orten und über mehrere Messzyklen zu verfolgen bzw. zu tracken, so dass auch die entsprechenden Wellenemitter und Wellensensoren seitlich an dem Fahrzeug eingebaut werden können. Insbesondere kann es sich bei dem Fahrzeug um ein Kraftfahrzeug, ein Wasserfahrzeug oder ein Luftfahrzeug, insbesondere ein Hubschrauber, ein Flugzeug oder ein Luftschiff, handeln.
-
Die Erfindung wird im Folgenden anhand von bevorzugten Ausführungsformen unter Bezugnahme auf Figuren näher erläutert. Hierbei zeigen
- 1 ein Radarsystem,
- 2 ein Fahrzeug mit einem Radarsystem,
- 3A ein Tracking der vom Radarsystem gemessenen Ortungen im Nahbereich nach einem bekannten Verfahren und
- 3B und 3C ein Tracking der vom Radarsystem gemessenen Ortungen im Nahbereich nach dem erfindungsgemäßen Verfahren.
-
Im Folgenden wird als ein bevorzugtes Ausführungsbeispiel für das erfindungsgemäße Ortungssystem ein Radarsystem angegeben. Die Erfindung ist aber hierauf nicht beschränkt. Beispielsweise kann das Ortungssystem auch ein Ultraschall-Ortungssystem sein. Das erfindungsgemäße Verfahren kann auf beliebigen Ortungssystemen ausgeführt werden, solange das Ortungssystem eine Geschwindigkeit und einen Abstand, insbesondere eine Radialgeschwindigkeit und einen Radialabstand, eines Objekts relativ zu dem Ortungssystem messen kann.
-
1 zeigt schematisch ein Radarsystem 101 nach einer bevorzugten Ausgestaltung der Erfindung. Das Radarsystem 101 umfasst einen Radaremitter 103 und eine Radarsensor 105. Der Radaremitter 103 ist insbesondere derart gebildet, Radarwellen zu emittieren und der Radarsensor 105 ist insbesondere derart gebildet, Radarwellen zu detektieren. Sowohl der Radaremitter 103 als auch der Radarsensor 105 sind mit einer Verarbeitungseinrichtung 107 verbunden. Hierbei kann die Verarbeitungseinrichtung 107 vorzugsweise derart gebildet sein, den Radaremitter 103 und den Radarsensor 105 zu steuern. Insbesondere werden die von dem Radarsensor 105 detektierten Radarwellen in der Verarbeitungseinrichtung 107 verarbeitet, so dass ein Abstand und eine Geschwindigkeit, insbesondere eine Relativgeschwindigkeit und ein Relativabstand bezüglich des Radarsystems, eines Objekts berechnet werden können. Vorzugsweise steuert die Verarbeitungseinrichtung 107 den Radaremitter 103 derart, dass für einen Messzyklus eine Sequenz von mehreren sich linear ändernden Frequenzrampen ausgesandt wird. Vorzugsweise kann die Verarbeitungseinrichtung 107 aus den detektierten Radarwellen auch einen Winkel, insbesondere in Azimut und in Elevation, des Objektes berechnen.
-
Die Verarbeitungseinrichtung 107 umfasst weiterhin ein Kalmanfilter-Modul 109. In dem in 1 gezeigten Ausführungsbeispiel ist das Kalmanfilter-Modul 109 in der Verarbeitungseinrichtung 107 integriert. In einem nicht gezeigten Ausführungsbeispiel kann vorgesehen sein, dass das Kalmanfilter-Modul 109 mit der Verarbeitungseinrichtung 107 verbunden ist, d.h. das Kalmanfilter-Modul kann auch separat von der Verarbeitungseinrichtung 107 gebildet sein. Das Kalmanfilter-Modul 109 ist insbesondere derart eingerichtet, dass es eine Kalmanfilterung durchführen kann, welche auf einem mittels der Verarbeitungseinrichtung berechneten Abstand und auf einer mittels der Verarbeitungseinrichtung berechneten Geschwindigkeit basiert. Erfindungsgemäß ist in dem Kalmanfilter-Modul 109 ein Bewegungsmodell in sphärischen Sensorkoordinaten und eine Hilfsvariable für die Kalmanfilterung abgespeichert. Somit ist es ermöglicht, dass die Kalmanfilterung basierend auf diesem Bewegungsmodell und dieser Hilfsvariable durchgeführt werden kann. D.h., dass bei der Berechnung, wo sich das Objekt in einem zweiten Messzyklus befindet bzw. wie schnell das Objekt sein soll, das erfindungsgemäße Bewegungsmodell in sphärischen Sensorkoordinaten und die erfindungsgemäße Hilfsvariable verwendet werden. Beispielsweise kann vorgesehen sein, dass das Kalmanfilter-Modul 109 in Software realisiert wird.
-
Das Radarsystem 101 umfasst weiterhin ein Fahrerassistenzsystem 111, welches mit der Verarbeitungseinrichtung 107 verbunden ist. In einer anderen nicht gezeigten Ausführungsform der Erfindung kann vorgesehen sein, dass das Fahrerassistenzsystem 111 extern von dem Radarsystem 101 angeordnet ist und mit diesem verbunden ist. Das Radarsystem 101 kann sozusagen insbesondere modular in einem Fahrzeug angeordnet sein und ist somit kompatibel mit bereits vorhandenen Fahrerassistenzsystemen.
-
2 zeigt ein Auto 201, welches an einer linken und einer rechten Seite jeweils einen Radaremitter 203 und einen Radarsensor 205 aufweist. Die Radaremitter 203 und die Radarsensoren 205 sind mit einer Verarbeitungseinrichtung 207 verbunden. Die Verarbeitungseinrichtung 207 umfasst ein Kalmanfilter-Modul 209 und ein Fahrerassistenzsystem 211. Vorzugsweise emittieren die Radaremitter 203 90° Grad zur Seite. Es kann in einer anderen nicht gezeigten Ausführungsform vorgesehen sein, dass das Auto 201 noch weitere Radarsensoren und/oder Radaremitter aufweist, beispielsweise in einem vorderen und/oder hinteren Bereich des Autos 201, so dass Radarwellen nach vorne und nach hinten emittiert und detektiert werden können. Es kann insbesondere vorgesehen sein, dass beispielsweise mittels der hinteren Radaremitter und Radarsensoren zunächst ein sich von hinten näherndes Objekt erfasst wird, wobei dann das Tracking mittels der seitlichen Radaremitter bzw. Radarsensoren übernommen wird, wenn das Objekt zum Überholen des Autos 201 ansetzt.
-
An der rechten Seite des Autos 201 fährt im Nahbereich ein weiteres Auto 213 vorbei. Die Bewegungsrichtungen beider Autos 201 und 213 sind schematisch mit einem Pfeil gekennzeichnet. Der an der rechten Seite angeordnete Radaremitter 203 emittiert Radarwellen, welche von dem weiteren Auto 213 reflektiert werden. Der Radarsensor 205 an der rechten Seite des Autos 201 detektiert diese reflektierten Radarwellen. Die Verarbeitungseinrichtung 207 kann dann hieraus in einem ersten Messzyklus einen Abstand und eine Geschwindigkeit, insbesondere einen relativen Abstand und eine relative Geschwindigkeit, des weiteren Autos 213 berechnen. Mittels des erfindungsgemäßen Verfahrens werden dann für einen zweiten Messzyklus ein präzidierter Abstand und eine präzidierte Geschwindigkeit des weiteren Autos 213 berechnet. Das hierfür verwendete Bewegungsmodell in sphärischen Sensorkoordinaten und die hierfür verwendete Hilfsvariable werden im Folgenden näher erläutert.
-
Das bekannte Bewegungsmodell in kartesischen Sensorkoordinaten lautet:
- x: Abstandsvektor im kartesischen Sensorkoordinatensystem
- v: Relativgeschwindigkeitsvektor im kartesischen Sensorkoordinatensystem
- a: Relativbeschleunigungsvektor im kartesischen Sensorkoordinatensystem
- j: Relativruckvektor im kartesischen Sensorkoordinatensystem
- t0: Entwicklungs-Zeitpunkt
- x0: Abstandsvektor zum Zeitpunkt t0
- v0: Relativgeschwindigkeitsvektor zum Zeitpunkt t0
- a0: Relativbeschleunigungsvektor zum Zeitpunkt t0
- j0: Relativruckvektor zum Zeitpunkt t0
-
Um ein Bewegungsmodell im sphärischen Sensorkoordinatensystem formulieren zu können, werden die Geschwindigkeiten, Beschleunigungen und Rucke in Kugelkoordinaten formuliert:
- r: Radialer Abstand im sphärischen Sensorkoordinatensystem
- vr: Radiale Relativgeschwindigkeit im sphärischen Sensorkoordinatensystem
- ar: Radiale Relativbeschleunigung im sphärischen Sensorkoordinatensystem
- jr: Radialer Relativruck im sphärischen Sensorkoordinatensystem
-
Setzt man das relativ einfache Bewegungsmodell in kartesischen Sensorkoordinaten aus Gl. (1) und Gl. (2) ein, sieht man, dass die Ausdrücke nicht mehr durch einfache Taylorreihenentwicklung darstellbar sind. Insbesondere sind die Terme
kritisch, da sie eine sehr große Dynamik besitzen, wenn die radialen Abstände große bis sehr kleine Werte durchlaufen, was z.B. bei einer Vorbeifahrt eines Objekts am Sensor der Fall ist.
Wenn man die Radialgeschwindigkeit von Gl. (2) betrachtet, stellt man fest, dass der Ausdruck r·v
r = x·v wesentlich gutmütiger wäre. Eine Darstellung als Taylorreihenentwicklung wäre immer möglich, wenn x, v als Taylorreihe darstellbar wäre, was laut Gl. (1) der Fall ist. Bildet man das Integral dieses Ausdruckes, erhält man:
Es ist daher sinnvoll, folgende Größe für das Bewegungsmodell zu verwenden, wobei s eine Hilfsvariable ist:
-
Das Bewegungsmodell lautet dann:
-
Der Prediktionsschritt für das Bewegungsmodell aus (4) wird mittels eines Kalman-Filters, insbesondere mittels eines extended Kalman-Filters, für radiale Bewegung berechnet und lautet:
- x: Zustandsvektor, 5-dim. Spaltenvektor
- u: Steuervektor, 1-dim. Spaltenvektor
- A : Transformationsmatrix vom Zustand k-1 zu k, 5x5-Matrix
- B: Transformationsmatrix vom Steuervektor u zum Zustand x, 5x1-Matrix
- P: Kovarianz-Matrix des Zustandes τ, 5x5-Matrix
- Q: Prozess-Rauschen-Kovarianzmatrix, 5x5-Matrix
-
Die Filterung findet im folgenden Schritt statt:
mit
- K: Kalman-Filter-Matrix, Gain-Matrix, 5x2-Matrix
- I: Einheitsmatrix, 5x5-Matrix
- R: Kovarianzmatrix des Messvektors
- z: Messvektor
-
Der Vektor h und die Matrix H in Gl. (6) dienen zur Umrechung des prädizierten Zustandsvektors in den Messvektor und wird mit folgender Gl. (7) berechnet:
mit
-
Da die radialen Größen r, vr mittels des Radarsensors am zuverlässigsten gemessen werden können, wird die Assoziation von Messwerten zu prädizierten Ortungen bevorzugterweise mit Hilfe dieser radialen Größen durchgeführt.
-
Eine beispielhafte Alternative zu der Beschreibung in Gl. (7) ist die Anpassung des Messvektors, wobei der Zustandsvektor x = s wie in Gl. (7) bleibt:
-
Hier wird der Messvektor z insbesondere durch den „virtuellen“ Messvektor g (z) ersetzt und die Messkovarianzmatrix R wird insbesondere entsprechend durch G · R · GT ersetzt. Vorzugsweise bei Distanzen im Nahbereich, beispielsweise kleiner als 10m, liefert diese Alternative besonders genaue Werte.
-
Eine weitere beispielhafte Alternative ist es, den Zustandsvektor x = r zu verwenden und nur den Prädiktionsschritt der Matrix A anzupassen:
mit
-
Hierbei entspricht der Zustandsvektor in vorteilhafter Weise insbesondere einem um die Radialbeschleunigung erweiterten Messvektor.
-
Nachfolgend soll mittels der 3A, 3B und 3C beispielhaft das Trackingverfahren nach dem bekannten Verfahren und nach dem neuen Verfahren, insbesondere nach dem neuen Trackingalgorithmus, anhand der in 2 gezeigten Vorbeifahrszene des weiteren Autos 213 an dem Auto 201 gegenübergestellt werden. Dabei überholt das weitere Auto 213, welches auf einer Nachbarspur (nicht gezeigt) fährt, das Auto 201 beispielsweise mit einer Radialgeschwindigkeit von minus 10m/s. Der Querabstand beträgt hier beispielhaft 2m.
-
3A zeigt ein Tracking der von einem bekannten Radarsystem mit einem LRR-Radarsensor gemessenen Ortungen im Nahbereich nach dem bekannten Trackingverfahren basierend auf einem Bewegungsmodell in kartesischen Sensorkoordinaten und ohne eine Hilfsvariable. Gezeigt sind zwei Graphen: der obere Graph zeigt die Distanz in m zwischen dem Objekt und dem Radarsystem über die Messzyklen. Der untere Graph zeigt die Geschwindigkeit in m/s des Objekts über die Messzyklen. Eine durchzogene Linie kennzeichnet jeweils die tatsächlichen Ortungen, also die realen Abstände und die realen Geschwindigkeiten. Die geschätzten bzw. präzidierten Abstände und die präzidierten Geschwindigkeiten sind mittels voneinander getrennter kurzer Striche gekennzeichnet. Es ist zu erkennen, dass bis zu einer Distanz von ca. 17 m, also bis etwa zum Messzyklus 140, die geschätzten Geschwindigkeitswerte gut mit den gemessenen Geschwindigkeitswerten übereinstimmen. Dann aber kommt das zu ortende Objekt in den Nahbereich, d.h. es befindet sich weniger als 10 m von dem Radarsystem. Hier zeigt sich nun, dass mittels des bekannten Kalmanfilters die geschätzten Geschwindigkeitswerte deutlich von den gemessenen und damit tatsächlichen Geschwindigkeitswerten divergieren. Hier wurde der Nahbereich als ein Umkreis von 10 m um das Radarsystem definiert. Es kann allerdings auch ein weiterer Nachbereich, beispielsweise kleiner als 15 m, oder ein engerer Nahbereich, beispielsweise kleiner als 5 m, definiert werden.
-
Demgegenüber zeigen die 3B und 3C ein Tracking bzw. eine Ortung nach dem erfindungsgemäßen Verfahren. Aufgetragen ist auch hier jeweils eine Distanz in m über die Messzyklen bzw. eine Geschwindigkeit in m/s über die Messzyklen. Eine durchzogene Linie kennzeichnet analog zu 3A die tatsächliche Ortung, also die realen Abstände und die realen Geschwindigkeiten. Die geschätzten bzw. präzidierten Abstände und die präzidierten Geschwindigkeiten sind mittels voneinander getrennter kurzer Striche gekennzeichnet. Deutlich zu sehen ist, dass, auch wenn das Objekt in den Nahbereich kommt, die geschätzten Werte mit den gemessenen Werten übereinstimmen. Somit ist auch in einem Nahbereich eine zuverlässige Ortung und Zuordnung des Objekts ermöglicht. Die Erfindung ermöglicht hier insbesondere eine genauere Schätzung, insbesondere für große Winkelgeschwindigkeiten, der Abstände, der Geschwindigkeiten und der Winkel (in Azimut und Elevation) von Objekten im Umfeld des Fahrzeugs bei großer Winkeldynamik im Nahbereich. Die Erfindung ermöglicht hier weiterhin in vorteilhafter Weise, dass die Ortung bzw. der Track weitergeführt werden kann. Hier konnte eine Ortung nach dem bekannten Verfahren in 3A nicht über den Messzyklus 150 zuverlässig fortgeführt werden. Hingegen kann mittels des erfindungsgemäßen Verfahrens auch über den Messzyklus 150 eine zuverlässige Ortung des Objekts durchgeführt werden (siehe 3C).
-
Zusammenfassend wird mittels der Erfindung eine neue Formulierung des Bewegungsmodells in sphärischen Sensorkoordinaten, d.h. aus Sicht des Sensors, formuliert. Weiterhin wird erfindungsgemäß eine Hilfsvariable eingeführt, die erlaubt, dass die Bewegungsgleichungen durch einfache Taylor-Reihenentwicklung darstellbar sind. Die Erfindung bietet hier insbesondere auch den Vorteil, dass keine Winkelgrößen in Azimut oder Elevation benötigt werden. Dies ist besonders vorteilhaft, wenn eine gute Schätzung von dem Abstand und der radialen Relativgeschwindigkeit erforderlich ist. Außerdem können systematische Winkelfehler diese radialen Größen nicht negativ beeinflussen. Die Erfindung verbessert also die Schätzung der gemessenen Größen. Dabei kann das erfindungsgemäße Verfahren auch bei kleinen Winkelgeschwindigkeiten angewendet werden.