DE102011120814A1

DE102011120814A1 - Verfahren und Vorrichtung zur Bestimmung eines Winkels zwischen einem Zugfahrzeug und einen damit gekoppelten Anhänger

Info

Publication number: DE102011120814A1
Application number: DE102011120814A
Authority: DE
Inventors: Colette Minoche; Philipp Hüger
Original assignee: Volkswagen AG
Current assignee: Volkswagen AG
Priority date: 2011-12-10
Filing date: 2011-12-10
Publication date: 2013-06-13
Anticipated expiration: 2031-12-11
Also published as: DE102011120814B4

Abstract

Verfahren und Vorrichtung zur Bestimmung eines Winkels zwischen einem Zugfahrzeug 1 und einen damit gekoppelten Anhänger 2. Mittels einer Bilderfassungsvorrichtung 3 wird ein erstes Bild, welches eine Deichselbewegung zwischen dem Zugfahrzeug 1 und dem Anhänger 2 umfasst, erfasst. Das erfasste Bild wird von einer Bildauswertungsvorrichtung 6 ausgewertet, um daraus den Winkel zu bestimmen.

Description

Die Erfindung betrifft ein Verfahren und eine Vorrichtung zur Bestimmung eines Winkels zwischen einem Zugfahrzeug und einem damit gekoppelten Anhänger.
Im Rahmen dieser Erfindung werden unter Zugfahrzeugen Pkws, Lkws und andere Straßen- so wie Sonderfahrzeuge verstanden. Das Rückwärtsfahren und Rangieren mit einem Anhänger erfordert ein hohes Maß an fahrerischem Können, insbesondere wenn das Fahrzeug-Anhänger-Gespann sehr lang ist und es darum für den Fahrer sehr schwer ist, die Abmessungen des Gespanns richtig abzuschätzen. Bei künftigen Zugfahrzeugen ist daher eine Möglichkeit zum teilautomatisierten Rückwärtsfahren und Rangieren vorgesehen. Hierzu ist es jedoch erforderlich, dass die Lage des Anhängers bezogen auf das Zugfahrzeug bereits beim Anfahren bekannt ist. Aus der DE 10 2006 007 805 A1 ist bereits eine Lösung zur Bestimmung des Anhängerwinkels bekannt. Dabei werden Entfernungsdaten mehrere dem Anhänger zugeordneten Objektpunkte mittels eines am Heck des Zugfahrzeugs angeordneten Entfernungssensors erfasst und ausgewertet. Der Entfernungssensor vermisst den Anhänger derart, sodass erfasste Objektpunkte die Eckpunkte der Anhängerfront mit Umfassen. Anhand der Eckpunkte und demjenigen Objektpunkt des Anhängers mit dem geringsten Abstand zum Entfernungssensor sowie die Kenntnis der Position des Deichseldrehpunkts kann dann der Anhängerwinkel zwischen dem Zugfahrzeug und dem Anhänger bestimmt werden.
Die DE 10 2004 02 113 A1 zeigt ein System zur Bestimmung des Anhängerwinkels zwischen einem Zugfahrzeug und einem Anhänger. Hierzu befindet sich am Heck des Zugfahrzeugs eine Videokamera, welche auf den Heckbereich des Zugfahrzeugs sowie den Anhängerfrontbereich ausgerichtet ist. In einer Auswerteeinheit sind für beliebige Anhängertypen und unterschiedliche Anhängerwinkel jeweils ein oder mehrere Schablonen (Templates) hinterlegt, die die relative Lage von Zugfahrzeug und Anhänger beschreiben. Bei den Templates handelt es sich hierbei um auf markante Punkte oder Linien des Deichselbereichs reduzierte Templates. Im Rahmen der Auswertung werden Templates mit erfassten Bildern korreliert (Template-Matching), um den Anhängerwinkel zwischen Zugfahrzeug und Anhänger zu bestimmen.
Der Erfindung liegt die Aufgabe zu Grunde ein Verfahren und eine Vorrichtung zu schaffen, womit der Anhängerwinkel zwischen einem Zugfahrzeug und einem dazugehörigen Anhänger auf einfache und zuverlässige Weise bestimmt werden kann und somit eine aktive Fahrunterstützung ermöglicht werden kann.
Die Aufgabe wird gemäß der Erfindung durch ein Verfahren mit den Merkmalen des Patentanspruchs 1, sowie eine Vorrichtung mit den Merkmalen des Patentanspruchs 12 gelöst.
Weitere vorteilhafte Ausgestaltungen der Erfindung sind in den abhängigen Ansprüchen angegeben.
Erfindungsgemäß werden ein Verfahren und eine Vorrichtung zur Bestimmung eines Winkels zwischen einem Zugfahrzeug und einem damit gekoppelten Anhänger bereitgestellt, wobei ein Bild, welches eine Deichselbewegung zwischen dem Fahrzeug und dem Anhänger umfasst, mit Hilfe einer Bilderfassungsvorrichtung erfasst wird, wobei es sich bei der Bilderfassungsvorrichtung um eine Rückfahrkamera handeln kann, welche bereits in vielen Fahrzeugen standardisiert enthalten ist Das Verfahren und die Vorrichtung sind dadurch gekennzeichnet, dass das Auswerten des erfassten Bildes durch eine Bildauswertungsvorrichtung erfolgt, wobei Farbinformationen, welche Grauwerte umfassen können, für eine Vielzahl von Feldern des Bildes bestimmt werden. Dadurch kann der Winkel, beispielsweise ein Startwinkel, aufgrund eines einzigen Kamerabildes bestimmt werden.
Der Winkel zwischen dem Fahrzeug und dem daran gekoppelten Anhänger wird durch Auswerten des erfassten Bildes bestimmt. Dadurch sind keine besonderen Einrichtungen an dem Anhänger erforderlich, so dass das Verfahren und die Vorrichtung mit einem beliebigen Anhänger angewendet werden können. Viele Fahrzeuge verfügen über eine Bilderfassungsvorrichtung, beispielsweise eine Rückfahrkamera, die den Fahrer des Zugfahrzeugs beim Einparken oder Rangieren unterstützt. So kann das Verfahren und die Vorrichtung kostengünstig, beispielsweise in einem Steuergerät des Fahrzeugs, realisiert werden.
Das Verfahren und die Auswertung zur Winkelbestimmung können auf eine Auswertung von Winkelfeldern um einen bestimmten Bereich einer Anhängerkupplung basieren. Dabei werden mittlere Grauwertveränderungen zwischen den einzelnen Winkelfeldern ausgewertet und daraus eine Position einer Anhängerdeichsel bestimmt.
Die Erfindung wird nachfolgend anhand bevorzugter Ausführungsbeispiele unter Bezugnahme auf die Zeichnungen näher beschrieben.
1 zeigt ein Zugfahrzeug mit einem daran gekoppelten Anhänger und eine Vorrichtung zur Bestimmung des Winkels zwischen dem Zugfahrzeug und dem Anhänger gemäß einem Ausführungsbeispiels der Erfindung.
2 zeigt eine Darstellung eines erfassten Bildes mittels der Bilderfassungsvorrichtung gemäß einem weiteren Ausführungsbeispiels der Erfindung.
3 zeigt eine schematische Darstellung eines Verfahrens zur Bestimmung eines Winkels zwischen dem Zugfahrzeug und dem Anhänger gemäß einem Ausführungsbeispiel der Erfindung.
1 zeigt ein Zugfahrzeug 1, welches über eine Kupplungskugel 4 mit einem Anhänger 2 gekoppelt ist und mit einer Bilderfassungsvorrichtung 3, beispielsweise eine Rückfahrkamera, versehen ist. In vielen Fahrzeugen 1 ist bereits eine Rückfahrkamera installiert, so dass mit Hilfe der Rückfahrkamera eine Bestimmung eines Startwinkels zwischen dem Zugfahrzeug 1 und dem Anhänger 2 kostengünstig realisiert werden kann. Unter einem Startwinkel versteht man einen Winkel, welcher aufgrund eines einzelnen Bildes der Bilderfassungsvorrichtung 3 bestimmt werden kann.
Durch das Auswerten eines Bildes der Bilderfassungsvorrichtung 3 müssen an dem dazugehörigen Anhänger 2 keine speziellen Vorrichtungen vorhanden sein, so dass jeder beliebige Anhänger 2 verwendet werden kann.
Des Weitern ist das Fahrzeug 1 mit einer Bildauswertungsvorrichtung 6, welche mit der Bilderfassungsvorrichtung 3 elektronisch verbunden ist, und einem Anhängerrangierassistenten (ARA) 7, welcher mit der Bildauswertungsvorrichtung 6 elektronisch verbunden ist, ausgestattet. Der von der Bildauswertungsvorrichtung 6 bestimmte Winkel zwischen dem Fahrzeug 1 und dem Anhänger 2 wird dem Anhängerrangierassistenten 7 zur Verfügung gestellt, um somit Rangiervorgänge des Fahrzeugs 1 unterstützen zu können.
2 zeigt eine Darstellung eines erfassten Bildes, aus welchen ein Winkel, insbesondere ein Startwinkel zwischen einem Zugfahrzeug 1 und einem daran gekoppelten Anhänger 2 gemäß einem Ausführungsbeispiel der Erfindung, wie der in 1 gezeigten Vorrichtung bestimmt werden kann.
Bereits beim Einlegen eines Rückwärtsganges eines Fahrzeugs 1, an dem ein Anhänger 2 gekoppelt ist, kann durch ein erstes erfasstes Bild der Bilderfassungsvorrichtung 3 ein Winkel zwischen dem Anhänger 2 und der Fahrzeuglängsachse berechnet werden. Dieser berechnete Winkel dient als Grundlage einer sogenannten Knickwinkelverbesserung und einer Knickwinkelverfolgung.
Zur Bestimmung des Winkels, beispielsweise eines Startwinkels, d. h. ein aus nur einem erfassten Bild berechneter Winkel, wird um eine Kupplungskugel 4 ein Winkelfeld 8 aufgebaut. Insbesondere werden um einen Drehpunkt der Anhängerkupplung, beispielsweise der Kupplungskugel 4, radiale Winkelfelder 8 aufgebaut. Die kreis- oder ellipsenförmige Krümmung des gesamten Feldes ist bei dem dargestellten Ausführungsbeispiel einer Verzerrung der Bilderfassungsvorrichtung 3 angepasst.
Die Winkelfelder 8 sind einer Drehbewegung des Anhängers 2 um die Kupplungskugel 4 so angepasst, dass bei einer Verfolgung der Bewegung der Anhängerdeichsel 5 die Anhängerdeichsel 4 möglichst wenige Winkelfelder kreuzt, damit eine genaue Detektion erfolgen kann. Eine Überschneidung zwischen Anhängerdeichsel 4 und den Winkelfeldern 8 ist abhängig von der Verzerrung des Bildes der Bilderfassungsvorrichtung 3. Diese Verzerrung ist wiederum von der Art der Bilderfassungsvorrichtung 3, insbesondere von der Art der Kamera, abhängig. Des Weitern ist eine Überschneidung von der Beschaffenheit der Anhängerdeichsel 5 abhängig. Je breiter die Anhängerdeichsel, desto mehr Winkelfelder 8 werden von der Anhängerdeichsel 5 gekreuzt.
In dem von der Bilderfassungsvorrichtung 3 erfassten Bild (Box 9) sollen mindestens 80 oder mindestens 150, bevorzugt mindestens 180 Winkelfelder 8 definiert sein (Box 11), denn die Anhängerdeichsel 5 kann sich um ungefähr 180 Grad um die Kupplungskugel 4 des Anhängers 2 bewegen.
Der von der Bildauswertungsvorrichtung 6 auszuwertende Bereich des erfassten Bildes der Bilderfassungsvorrichtung 3 besteht aus einer zuvor definierten Anzahl von Winkelfeldern 8. Die Winkelfelder 8 beginnen bevorzugt so weit außerhalb der Kupplungskugel 4 des Anhängers 2, so dass abhängig von der Länge der Anhängerdeichsel 4 der Kopf der Kupplungskugel 4 mit Aufbauten ausgespart werden kann und somit beispielsweise Aufbauten an der Kupplungskugel 4 des Anhängers 2 die Auswertung nicht beeinträchtigen oder verfälschen.
Die Länge eines Winkelfeldes soll möglichst weit in Richtung eines Aufbaus des Anhängers 2 reichen. Längen der Anhängerdeichsel 4 können beispielsweise zwischen 1 m und 12 m variieren.
Eine Abtastrate bestimmt die Länge eines Winkelfeldes. In einem bevorzugten Ausführungsbeispiel können alle Pixel oder beispielsweise nur jeder zweiter Pixel betrachtet werden. Die Länge des Winkelfelds 8 wird an die Anzahl der Pixel angepasst. Um eine möglichst hohe Genauigkeit zu erreichen, können alle Pixel des Winkelfeldes 8 betrachtet werden.
Für jedes definierte Winkelfeld 8 kann ein mittlerer Grauwert bestimmt werden (Box 12). Der Grauwert wird aus einem sogenannten RGB-Bild bestimmt. Ein RGB-Bild besteht aus den Farbkomponenten rot, grün und blau. Allgemeine Rechenvorschriften für die Bestimmung eines Grauwertes sind aus dem Stand der Technik bekannt. Dabei stellt der Grauwert im Bereich der Bildverarbeitung einen Helligkeits- oder Intensitätswert eines einzelnen Bildpunktes dar. Bei dem RGB-Farbwert kann mit der Formel Grauwert = 0,299·Rotanteil + 4,587·Grünanteil + 0,114·Blauanteil der Grauwert errechnet werden. Das Ergebnis ist ein Wert, der unabhängig von den Farben die Helligkeit des Bildpunktes wiedergibt.
Um eine Abgrenzung der Anhängerdeichsel 5 von einem Untergrund für jeden einzelnen Mittelwert der Grauwerte der einzelnen Winkelfelder 8 vornehmen zu können, können sukzessive Varianzen bestimmt werden (Box 13). Dafür werden die Grauwerte des Untergrunds und die der Anhängerdeichsel 5 ausgewertet. An der Stelle, an der die Anhängerdeichsel 5 auf den Untergrund trifft, entsteht eine Kante. Diese Kante entspricht einem Sprung in den Mittelwerten der Winkelfelder 8 und kann durch die Varianz zwischen den Mittelwerten der Grauwerte detektiert werden.
An den Stellen, an denen die Varianz hoch ist, also der oben erläuterte Sprung einem vorgegebenen Wert entspricht oder diesen übersteigt, ist eine Wahrscheinlichkeit sich just in diesem Moment auf der Deichsel zu befinden. Die Bestimmung derartiger hoher Varianzen ist von einem Schwellenwert abhängig. Ein Verfahren zur Berechnung des Schwellenwertes ist die Bildung des Mittelwerts der oben erwähnten Varianzen und eine Verdopplung dieses Wertes. Somit werden wenige hohe Varianzen ermittelt, welche diesen Schwellenwert übersteigen und eine Anhängerdeichsel 5 kennzeichnen. Bei geringer Anzahl von so ermittelten hohen Varianzen nach Ermittlung des Schwellenwertes wird der Schwellenwert so lange um einen vorgegeben Faktor, beispielsweise um einen Faktor ¼, verkleinert, bis eine vorgegebene Anzahl von hohen Varianzen ermittelt werden kann und zur Auswertung herangezogen werden kann.
Die Anzahl der ausreichenden Varianzen soll bevorzugt einen vorgegebenen Wert nicht unterschreiten, denn sonst kann ein Bildrauschen als Anhängerdeichsel 5 zugehörig ausgewählt werden.
Aus den bestimmten relevanten Varianzen kann ermittelt werden, wo diese im Winkelfeld anzuordnen sind. Dies kann als Varianz-Bereich definiert werden. Die Position des Startwinkels zwischen dem Zugfahrzeug 1 und dem damit gekoppelten Anhänger 2 wird dann durch die Mitte des Varianz-Bereichs gekennzeichnet (Box 14).
ZITATE ENTHALTEN IN DER BESCHREIBUNG
Diese Liste der vom Anmelder aufgeführten Dokumente wurde automatisiert erzeugt und ist ausschließlich zur besseren Information des Lesers aufgenommen. Die Liste ist nicht Bestandteil der deutschen Patent- bzw. Gebrauchsmusteranmeldung. Das DPMA übernimmt keinerlei Haftung für etwaige Fehler oder Auslassungen.
Zitierte Patentliteratur

DE 102006007805 A1 [0002]
DE 10200402113 A1 [0003]

Claims

Verfahren zur Bestimmung eines Winkels zwischen einem Zugfahrzeug (1) und einem damit gekoppelten Anhänger (2), umfassend: Erfassen eines Bildes, welches eine Deichselbewegung zwischen dem Fahrzeug (1) und dem Anhänger (2) umfasst, gekennzeichnet durch, Bestimmen von Farbinformationen für eine Vielzahl von Feldern (8) des Bildes, und Bestimmen des Winkels zwischen dem Zugfahrzeug (1) und dem Anhänger (2) in Abhängigkeit von den Farbinformationen
Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass die Farbinformationen Grauwerte innerhalb eines Feldes (8) sind.
Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass die Bilderfassungsvorrichtung (3) eine Rückfahrkamera des Fahrzeugs umfasst.
Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass der Winkel ein Winkel im Ruhezustand des Fahrzeugs (1) und dem dazugehörigen Anhängers (2) ist.
Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass die Felder (8) radiale Winkelfelder sind.
Verfahren nach Anspruch 4, dadurch gekennzeichnet, dass die zumindest ein Teil der um einen Drehpunkt einer Kupplungskugel (4) des Anhängers (2) definierten Winkelfelder (8) eine kreis- oder ellipsenförmige Krümmung aufweisen, wobei die Krümmung einer Verzerrung der Bilderfassungsvorrichtung (3) angepasst ist.
Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass eine Form der Winkelfelder (8) bezüglich der kreis- oder ellipsenförmigen Krümmung derart gewählt ist, dass bei einer Drehbewegung des Anhängers (2) um den Kupplungspunkt (4) einer Anhängerdeichsel (5) eine geringe Anzahl von Winkelfeldern (8) kreuzt.
Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass in dem Bild mindestens 80 Felder (8) definiert sind.
Verfahren nach Anspruch einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass für jedes Winkelfeld (8) ein Mittlerer Grauwert bestimmt wird und zwischen den mittleren Grauwerten Varianzen bestimmt werden und die bestimmten Varianzen mit einem Schwellenwert verglichen werden.
Verfahren nach Anspruch 9, dadurch gekennzeichnet, dass bei geringer Anzahl von Varianzen nach Ermittlung des Schwellenwertes der Schwellenwert solange um einen vorgegebenen Faktor verkleinert wird, bis eine vorgegebene Anzahl von Varianzen ermittelt werden kann.
Verfahren nach Anspruch 9 oder 10, dadurch gekennzeichnet, dass eine Position des Winkels zwischen dem Zugfahrzeug (1) und dem Anhänger (2) entsprechend einer Mitte eines Varianz-Bereichs bestimmt wird.
Vorrichtung zur Bestimmung eines Winkels zwischen einem Zugfahrzeug (1) und einem damit gekoppelten Anhänger (2), umfassend: eine Bilderfassungsvorrichtung (3) zum Erfassen eines Bildes einer Bewegung einer Anhängerdeichsel (5) zwischen dem Zugfahrzeug (1) und dem Anhänger (2), gekennzeichnet durch eine Bildauswertungsvorrichtung (6), welche mit der Bilderfassungsvorrichtung (3) gekoppelt ist, zum Auswerten des erfassten Bildes mittels Bestimmen von Farbinformationen für eine Vielzahl von Feldern (8) des Bildes und Bestimmen des Winkels zwischen dem Zugfahrzeug (1) und dem Anhänger (2) in Abhängigkeit von den Farbinformationen.
Vorrichtung nach Anspruch 12, dadurch gekennzeichnet, dass die Vorrichtung zur Durchführung des Verfahrens nach einem der Ansprüche 1–11 ausgestaltet ist.
Fahrzeug (1) mit einer Vorrichtung zur Bestimmung eines Winkels zwischen dem Fahrzeug (1) und dem damit gekoppelten Anhänger (2) nach Anspruch 12 oder Anspruch 13.
Fahrzeug (1) nach Anspruch 14, wobei die Vorrichtung zur Bestimmung des Startwinkels mit einem Assistenten (7) gekoppelt ist.