DE4116255C2 - Verfahren und Vorrichtung zur automatischen Steuerung der Lenkung eines Kraftfahrzeugs - Google Patents
Verfahren und Vorrichtung zur automatischen Steuerung der Lenkung eines KraftfahrzeugsInfo
- Publication number
- DE4116255C2 DE4116255C2 DE4116255A DE4116255A DE4116255C2 DE 4116255 C2 DE4116255 C2 DE 4116255C2 DE 4116255 A DE4116255 A DE 4116255A DE 4116255 A DE4116255 A DE 4116255A DE 4116255 C2 DE4116255 C2 DE 4116255C2
- Authority
- DE
- Germany
- Prior art keywords
- camera
- distance
- point
- optical axis
- white line
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims description 14
- 230000003287 optical effect Effects 0.000 claims description 38
- 108090000623 proteins and genes Proteins 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims 5
- 238000001514 detection method Methods 0.000 claims 4
- 238000006073 displacement reaction Methods 0.000 claims 3
- 230000006978 adaptation Effects 0.000 claims 2
- 230000015572 biosynthetic process Effects 0.000 claims 1
- 238000006243 chemical reaction Methods 0.000 claims 1
- 238000007796 conventional method Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 1
- 230000001131 transforming effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
Description
Die vorliegende Erfindung betrifft ein Verfahren zur automatischen
Steuerung der Lenkung eines Kraftfahrzeugs gemäß dem Oberbegriff des Anspru
ches 1 und eine Vorrichtung zur automatischen Steuerung der Lenkung
eines Kraftfahrzeugs gemäß dem Oberbegriff des Anspruches 6.
Eine automatische Steuerung der Lenkung eines Kraftfahrzeugs wird
im Stand der Technik beispielsweise gemäß JP 1-37 12 A
dadurch erzielt, daß eine auf einer Straße gezo
gene weiße Linie erfaßt wird und die Lenkung des Kraftfahrzeugs au
tomatisch so gesteuert wird, daß das Kraftfahrzeug dieser weißen Linie
folgt.
Bei einem in Fig. 6 gezeigten herkömmlichen Verfahren zur automati
schen Steuerung der Lenkung eines Kraftfahrzeugs wird ein Abstand
AA′ zwischen einem Punkt A, der sich auf der optischen Achse AX ei
ner an einem Kraftfahrzeug 100 montierten und in Richtung der mitti
gen Fahrzeuglängsachse orientierten Kamera CA befindet, und einem
Punkt A′, der sich auf einer auf einer Straße gezogenen weißen Linie
SW befindet und in dem eine zur optischen Achse AX im Punkt A
senkrechte Linie SA die weiße Linie SW schneidet, berechnet; anhand
dieses berechneten Abstandes AA′ wird ein Lenkwinkel berechnet.
Dabei wird die Berechnung des Lenkwinkels Φ unter Verwendung einer
sogenannten Regressionsgleichung ausgeführt. Mit dieser Regressions
gleichung wird der Lenkwinkel Φ aus drei Abständen AA′(i-2), AA′(i-
1) und AA′(i), die in aufeinanderfolgenden Zeitpunkten i-2, i-1 und i
nacheinander erfaßt werden, gemäß der folgenden Gleichung (1) be
rechnet:
Φ = aiAA′(i) + ai-1 AA′(i-1) + ai-2AA′(i-2) + a₀ (1)
wobei ai, ai-1, ai-2 und a₀ Konstanten sind.
Zur Erweiterung des Blickwinkels der Kamera CA kann diese mit einer
weiteren Kamera CB funktional verbunden werden, die ebenfalls am
Kraftfahrzeug 100 mit einer zur mittigen Fahrzeuglängsachse um einen
Winkel Θ zur Vorderseite des Kraftfahrzeugs 100 geneigten Richtung
montiert ist. In diesem Fall wird ein Abstand BB′ zwischen einem
Punkt B, der sich auf der optischen Achse BX der Kamera CB befin
det, und einem Punkt B′, der sich auf der auf der Straße gezogenen
weißen Linie SW befindet und in dem eine zur optischen Achse BX im
Punkt B senkrechte Linie SB die weiße Linie SW schneidet, berechnet;
anhand dieses berechneten Abstandes BB′ wird unter Verwendung der
Regressionsgleichung für die Kamera CB, die eine zur Gleichung (1)
für die Kamera CA ähnliche Form besitzt, ein Lenkwinkel berechnet.
Bei diesem herkömmlichen Verfahren zur automatischen Steuerung der
Lenkung eines Kraftfahrzeugs, in dem eine Mehrzahl von in verschie
denen Richtungen orientierten und in einer Folgeschaltung angeordne
ten Kameras verwendet werden, um einen größeren Blickwinkel der
Kamera zu erzielen, ist es erforderlich, Regressionsgleichungen in ei
ner der Anzahl der vorhandenen Kameras entsprechenden Anzahl vor
zusehen, was dieses Verfahren schwerfällig macht.
Ferner besteht hierbei das Problem, daß es bei der Ersetzung der
Mehrzahl der Kameras durch eine einzige Kamera, deren Orientierung
durch Drehung verändert werden kann, erforderlich ist, unendlich viele
Regressionsgleichungen vorzusehen, was unpraktisch ist.
Es ist daher die Aufgabe der vorliegenden Erfindung, ein Verfahren
und eine Vorrichtung der eingangs genannten Art
zur automatischen Steuerung der Lenkung eines
Kraftfahrzeugs zu schaffen, mit denen die automatische Steuerung un
ter Verwendung einer einzigen Regressionsgleichung zur Berechnung
eines Lenkwinkels effizient ausgeführt werden kann.
Diese Aufgabe wird bei einem Verfahren der gattungsgemäßen Art er
findungsgemäß durch die Merkmale im kennzeichnenden Teil des An
spruches 1 und bei einer Vorrichtung der gattungsgemäßen Art erfin
dungsgemäß durch die Merkmale im kennzeichnenden Teil des An
spruches 6 gelöst.
Weitere Ausgestaltungen der Erfindung sind in den
Unteransprüchen, die sich auf besondere Ausführungsformen der vor
liegenden Erfindung beziehen, angegeben.
Die Erfindung wird im folgenden anhand bevorzugter Aus
führungsformen mit Bezug auf die Zeichnungen näher erläutert; es zei
gen:
Fig. 1 ein schematisches Blockschaltbild einer Ausführungsform der
erfindungsgemäßen Vorrichtung zur automatischen Lenk
steuerung;
Fig. 2 eine Darstellung zur Erläuterung eines Verfahrens zur auto
matischen Steuerung der Lenkung eines Kraftfahrzeugs, das
von der in Fig. 1 gezeigten Vorrichtung zur automatischen
Lenksteuerung ausgeführt wird;
Fig. 3 eine weitere Darstellung zur Erläuterung eines Verfahrens
zur automatischen Steuerung der Lenkung eines Kraftfahr
zeugs, das von der in Fig. 1 gezeigten Vorrichtung zur auto
matischen Lenksteuerung ausgeführt wird;
Fig. 4 ein Flußdiagramm zur Erläuterung eines Verfahrens zur au
tomatischen Steuerung der Lenkung eines Kraftfahrzeugs, das
von der in Fig. 1 gezeigten Vorrichtung zur automatischen
Lenksteuerung ausgeführt wird;
Fig. 5 eine Darstellung zur Erläuterung eines alternativen Verfah
rens zur automatischen Steuerung der Lenkung eines Kraft
fahrzeugs, das von der in Fig. 1 gezeigten Vorrichtung zur
automatischen Lenksteuerung ausgeführt wird; und
Fig. 6 eine Darstellung zur Erläuterung eines herkömmlichen Ver
fahrens zur automatischen Steuerung der Lenkung eines
Kraftfahrzeugs.
Nun wird mit Bezug auf Fig. 1 eine Ausführungsform der erfindungs
gemäßen Vorrichtung zur automatischen Steuerung der Lenkung eines
Kraftfahrzeugs im einzelnen beschrieben.
Die Vorrichtung zur automatischen Lenksteuerung umfaßt eine Mehr
zahl (in Fig. 1: drei) von Kameras 1, 2 und 3, deren optische Achsen in
unterschiedlichen, um die Vorwärtsrichtung des Kraftfahrzeugs ver
teilten Orientierungen ausgerichtet sind, wobei die Kamera 2 längs ei
ner mittigen Fahrzeuglängsachse orientiert ist, die Kamera 1 längs ei
ner zur mittigen Fahrzeuglängsachse nach rechts geneigten Richtung
und die Kamera 3 längs einer zur mittigen Fahrzeuglängsachse nach
links geneigten Richtung orientiert ist. Ferner umfaßt die erfindungs
gemäße Vorrichtung zur automatischen Lenksteuerung eine Bildverar
beitungseinheit 5 für den Empfang von Bildsignalen von den Kameras
1, 2 und 3 und zur Berechnung des Abstandes zu einer weißen Linie
auf der Straße entsprechend den von jeder der Kameras 1, 2 und 3
empfangenen Bildsignalen, eine Aufnahmepunkt-Berechnungseinheit 7
zum Umformen der von der Bildverarbeitungseinheit 5 entsprechend
den Bildsignalen von den Kameras 1 und 3 berechneten Abstände in
umgeformte Abstände, die auf die Koordinaten der optischen Achse der
Kamera bezogen sind, und eine Lenk-Steuereinheit 9 zur Berechnung
der Lenkung oder des Lenkwinkels des Kraftfahrzeugs unter Verwen
dung der von der Aufnahmepunkt-Berechnungseinheit 7 erhaltenen um
geformten Abstände und zur Steuerung der Lenkung des Kraftfahr
zeugs entsprechend dem erhaltenen Lenkwinkel.
Nun wird mit Bezug auf die Fig. 2 und 3 die Operation einer erfin
dungsgemäßen Vorrichtung zur automatischen Lenksteuerung beschrie
ben.
In Fig. 2 besitzt ein vorgegebener Punkt A auf der optischen Achse AX
der auf der mittigen Längsachse des Kraftfahrzeugs 100 befindlichen
Kamera 2 die Koordinate L₀, während ein beliebiger Punkt B auf der
optischen Achse BX der Kamera 3 die Koordinate L′ besitzt. Die opti
sche Achse BX der Kamera 3 besitzt gegenüber der optischen Achse
AX der Kamera 2 einen Neigungswinkel Θ, wobei die Kameras 2 und 3
im Kraftfahrzeug 100 durch einen Abstand D getrennt sind.
Eine zur optischen Achse BX der Kamera 3 im Punkt B senkrechte Li
nie schneidet die weiße Linie SW auf der Straße im Punkt B′, während
eine zur optischen Achse AX der Kamera 2 im Punkt A senkrechte Li
nie die weiße Linie SW auf der Straße im Punkt A′ schneidet. Der
Punkt B′ wird entlang einer zur optischen Achse AX senkrechten
Richtung auf eine Projektionskoordinate L auf der optischen Achse AX
der Kamera 2 projiziert.
Dann gilt die durch die folgende Gleichung (2) gegebene geometrische
Beziehung:
L = L′·cosΘ-BB′·sinΘ (2)
Wenn der Punkt B auf der optischen Achse BX der Kamera 3 längs der
optischen Achse BX allmählich verschoben wird, bis die Projektions
koordinate L mit der Koordinate L₀ im Punkt A übereinstimmt, wie
dies in Fig. 3 gezeigt ist, entspricht der von der Kamera 3 beobachtete
Abstand BB′ dem vom Aufnahmepunkt A der Kamera 2 beobachteten
Abstand AA′. In diesem Fall ist der Abstand AA′ durch die folgende
Gleichung (3) gegeben:
AA′ =L₀·tanΘ+D+BB′/cosΘ (3)
Dieser Abstand AA′, der durch die Beobachtung des Abstandes BB′
mit der Kamera 3 in einem Fall, in dem die obige Gleichung (3) gilt,
und durch die Umformung des beobachteten Abstands BB′ in den ent
sprechenden Abstand AA′ gemäß der obigen Gleichung (3) erhalten
wird, kann zur Berechnung eines Lenkwinkels Φ der oben für eine
herkömmliche Vorrichtung zur automatischen Lenksteuerung beschrie
benen Regressionsgleichung (1), die für die Kamera 2 geeignet ist,
verwendet werden.
Um mit dieser Vorrichtung zur automatischen Lenksteuerung den
obenbeschriebenen Fall zu erreichen, in dem die obige Gleichung (3)
gilt, wird der Punkt B auf der optischen Achse BX der Kamera 3 all
mählich entlang der optischen Achse BX so verschoben, wie im fol
genden durch die Koordinate L′ des Punktes B ausgedrückt wird:
- (i) L′ =L′-ΔL, wenn L L₀ und
- (ii) L′ = L′ + ΔL, wenn L < L₀, wobei ΔL eine kleine Verschiebung ist.
Nun wird der Betrieb dieser Vorrichtung zur automatischen Lenksteue
rung mit Bezug auf das Flußdiagramm in Fig. 4 beschrieben.
Zunächst wird im Schritt 110 auf der optischen Achse BX der Kamera
3 ein beliebiger Punkt B mit der Koordinate L′ gesetzt.
Dann wird im Schritt 120 von der Bildverarbeitungseinheit 5 der Ab
stand BB′ zwischen dem Punkt B und dem Punkt B′, in dem eine zur
optischen Achse BX im Punkt B senkrechte Linie die weiße Linie SW
auf der Straße schneidet, erhalten.
Anschließend wird im Schritt 130 die Projektionskoordinate L des
Punkts B′ auf der optischen Achse AX der Kamera 2 in einer zur opti
schen Achse AX senkrechten Richtung gemäß der obenbeschriebenen
Gleichung (2) aus dem Abstand BB′ erhalten.
Dann wird im Schritt 140 die berechnete Projektionskoordinate L mit
der Koordinate L₀ des Punkts A verglichen. Wenn L L₀ ist, wird
die Koordinate L′ des Punktes B im Schritt 150 gemäß der Gleichung
L′ = L′ - ΔL verkleinert, während im Fall, daß L < L₀ gilt, die Ko
ordinate L′ des Punktes B im Schritt 160 gemäß der Gleichung L′ =
L′ + ΔL vergrößert wird.
Anschließend wird im Schritt 170 geprüft, ob sich die Koordinaten L
und L₀ nur innerhalb einer vorgegebenen Toleranz ε unterscheiden,
d. h. ob gilt: |L - L₀| ε. Wenn sich L und L₀ nicht nur innerhalb
einer vorgeschriebenen Toleranz ε unterscheiden, kehrt die Verarbei
tung zum Schritt 120 zurück, um die Anpassung der Koordinate L′ des
Punktes B zu wiederholen. Wenn sich andererseits L und L₀ nur inner
halb der vorgeschriebenen Toleranz ε unterscheiden, wird im Schritt
180 der dem im Schritt 120 erhaltenen Abstand BB′ entsprechende Ab
stand AA′ von der Aufnahmepunkt-Berechnungseinheit 7 gemäß der
obenerwähnten Gleichung (3) berechnet.
Dann wird im Schritt 190 von der Lenk-Steuereinheit 9 unter Verwen
dung der obenerwähnten Regressionsgleichung (1) anhand des Abstan
des AA′, der im Schritt 180 berechnet worden ist, und den zwei
vorhergehenden Werten für die Abstände AA′ der Lenkwinkel berech
net, so daß die Lenkung des Kraftfahrzeugs 100 von der Lenk
steuereinheit 9 gemäß dem auf diese Weise erhaltenen Lenkwinkel Θ
gesteuert werden kann.
Die Kamera 1 wird auf die gleiche Weise, wie oben in bezug auf die
Kamera 3 beschrieben, betrieben.
Somit können in der erfindungsgemäßen Vorrichtung zur
automatischen Lenksteuerung die Abstände, die von den entlang den
von der mittigen Längsachse des Kraftfahrzeugs verschiedenen
Richtungen orientierten Kameras 1 und 3 erhalten werden, in
entsprechende Abstände für die entlang der mittigen Längsachse des
Kraftfahrzeugs orientierte Kamera umgeformt werden, so daß über eine
Mehrzahl von Kameras, die in unterschiedlichen Richtungen orientiert
sind, lediglich eine Regressionsgleichung erforderlich ist.
Es wird darauf hingewiesen, daß die Mehrzahl der Kameras, die in der
obigen Ausführungsform verwendet werden und in verschiedenen
Richtungen orientiert sind, durch eine einzige Kamera ersetzt werden
können, die durch Drehung ihre Orientierung ändern kann. In diesem
Fall entspricht die in Fig. 2 gezeigte Situation für die obenbeschriebene
Ausführungsform der in Fig. 5 gezeigten Situation, wobei der Abstand
D, in dem sich die Kameras in Fig. 2 befinden, den Wert Null besitzt.
Somit kann in diesem Fall der Abstand AA′ mittels der obenbeschrie
benen Gleichung (3) berechnet werden, wobei D = 0 gesetzt wird.
Claims (11)
1. Verfahren zur automatischen Steuerung der Lenkung eines
Kraftfahrzeuges (100) mit den Schritten
- a) Erfassen einer auf einer Straße gezogenen weißen Linie (SW) durch eine Kameraeinrichtung (1, 2, 3) und
- b) Bestimmen eines ersten Abstandes (BB′) der im Erfassungs schritt erfaßten weißen Linie (SW) in bezug auf eine erste optische Achse (BX) einer ersten Kamera (1; 3) wobei dieser Abstand (B, B′) als Abstand zwischen einem ersten Punkt (B) auf der ersten optischen Achse (BX) der ersten Kamera (1; 3) und einem ersten Schnittpunkt (B′) mit einer im ersten Punkt (B) zur optischen Achse (BX) der ersten Kamera (1; 3) senkrechten Linie mit der weißen Linie (SW) bestimmt wird,
- c) Berechnen eines Lenkwinkels (Φ) unter Verwendung einer Regressionsgleichung aus mehreren ersten Abständen (B, B′), die in auf einanderfolgenden Zeitpunkten erfaßt wurden und
- d) Steuern der Lenkung des Kraftfahrzeuges (100) gemäß dem er mittelten Lenkwinkel Φ, derart, daß das Kraftfahrzeug der weißen Linie (SW) folgt,
dadurch gekennzeichnet, daß
- e) in einem Umwandlungsschritt der erste Abstand (B, B′) in einen einem zweiten Abstand (A, A′) entsprechenden Abstand durch Koordinatentransformation und -verschiebung umgewandelt wird, wobei der zweite Abstand (A, A′) definiert ist durch einen beliebigen zweiten Punkt (A), der sich auf der opti schen Achse (AX) einer in Fahrzeuglängsrichtung orientier ten zweiten Kamera (2) befindet und durch einen zweiten Schnittpunkt (A′), der sich auf der weißen Linie (SW) befin det und in dem eine zur optischen Achse (AX) im zweiten Punkt (A) senkrechte Linie die weiße Linie (SW) schneidet, wobei
- f) in einem Transformationsschritt die Koordinatentransforma tion und -verschiebung des ersten Abstandes (B, B′) in der Art erfolgt daß die Koordinaten des ersten Schnittpunktes (B′) mit den Koordinaten des zweiten Schnittpunktes (A′) und die Projektionskoordinate (L) des ersten Schnittpunktes (B′) auf die optische Achse (AX) der zweiten Kamera (2) mit der Koordinate (L₀) des zweiten Punktes (A) übereinstimmt.
2. Verfahren gemäß Anspruch 1, dadurch gekennzeichnet, daß
durch die Kameraeinrichtung (1, 2, 3) mehrere Kameras (1; 2; 3)
verwendet werden, dies untereinander in verschiedenen Richtun
gen orientiert sind; und im Erfassungsschritt die weiße Linie
(SW) zu einem bestimmten Zeitpunkt von einerKamera (1; 3) der Kame
raeinrichtung (1, 2, 3) erfaßt wird.
3. Verfahren gemäß Anspruch 1 dadurch gekennzeichnet, daß
durch die Kameraeinrichtung (1, 2, 3) eine einzige Kamera (2)
verwendet wird, deren Orientierung geändert werden kann; und
im Erfassungsschritt die weiße Linie (SW) zu einem bestimmten
Zeitpunkt bei einer bestimmten Orientierung der einzigen Ka
mera (2) erfaßt wird.
4. Verfahren gemäß Anspruch 1, dadurch gekennzeichnet, daß
im Anpassungsschritt eine Koordinate (L) der Projektion des
Schnittpunktes (B′) anhand einer Koordinate (L′) des Punktes
(B) auf der optischen Achse (BX) der Kamera (1;
3) und anhand dem im Bestimmungsschritt bestimmten Abstand
(BB′) der weißen Linie (SW) bezüglich der optischen Achse (BX)
der Kamera (1; 3) bestimmt wird.
5. Verfahren gemäß Anspruch 1, dadurch gekennzeichnet, daß im
Umformungsschritt der im Bestimmungsschritt bestimmte Abstand
(BB′) entsprechend einer Koordinate (L₀) des vorgegebenen
Punktes (A) auf der mittigen Längsachse (AX) des Kraftfahr
zeuges (100) in einen Abstand (AA′) der weißen Linie (SW) be
züglich der mittigen Längsachse (AX) des Kraftfahrzeuges
(100) umgeformt wird.
6. Vorrichtung zur automatischen Steuerung der Lenkung eines
Kraftfahrzeuges (100) mit:
einer Kameraeinrichtung (1, 2, 3) zur Erfassung einer auf einer Straße gezogenen weißen Linie (SW)
einer Bestimmungseinrichtung (3) zur Bestimmung eines ersten Abstandes (BB′) der im Erfassungsschritt erfaßten weißen Li nie (SW) in Bezug auf eine erste optische Achse (BX) einer ersten Kamera (1; 3), wobei dieser Abstand (B, B′) als Abstand zwischen einem ersten Punkt (B) auf der ersten optischen Ach se (BX) der ersten Kamera (1; 3) und einem ersten Schnittpunkt (B′) mit einer im ersten Punkt (B) zur optischen Achse (BX) der ersten Kamera (1; 3) senkrechten Linie mit der weißen Li nie (SW) bestimmt wird,
einer Einrichtung zur Berechnung eines Lenkwinkels (Φ) unter Verwendung einer Regressionsgleichung aus mehreren ersten Ab ständen (B, B′), die in aufeinanderfolgenden Zeitpunkten er faßt wurden und
einer Einrichtung zur Steuerung der Lenkung des Kraftfahr zeuges (100) gemäß dem ermittelten Lenkwinkel Φ, derart, daß das Kraftfahrzeug der weißen Linie (SW) folgt, dadurch gekennzeichnet,
daß eine Umformungseinrichtung (7) vorgesehen ist zur Umwandlung des ersten Abstandes (B, B′) in einen einem zweiten Abstand (A, A′) entsprechenden Abstand durch Koordinationstransformation und -verschiebung′ wobei der zweite Abstand (A, A′) definiert ist durch einen beliebi gen zweiten Punkt (A), der sich auf der optischen Achse (AX) einer in Fahrzeuglängsrichtung orientierten zweiten Kamera (2) befindet und durch einen zweiten Schnittpunkt (A′), der sich auf der weißen Linie (SW) befindet, und in dem eine zur optischen Achse (AX) im zweiten Punkt (A) senkrechte Linie die weiße Linie (SW) schneidet, wobei in einem Transformati onsschritt die Koordinationsformation und -verschiebung des ersten Abstandes (B,B′) in der Art erfolgt, daß die Koordina ten des ersten Schnittpunktes (B′) mit den Koordinaten des zweiten Schnittpunktes (A′) und die Projektionskoordinate (L) des ersten Schnittpunktes (B′) auf die optische Achse (AX) der zweiten Kamera (2) mit der Koordinate (L₀) des zweiten Punktes (A) übereinstimmt.
einer Kameraeinrichtung (1, 2, 3) zur Erfassung einer auf einer Straße gezogenen weißen Linie (SW)
einer Bestimmungseinrichtung (3) zur Bestimmung eines ersten Abstandes (BB′) der im Erfassungsschritt erfaßten weißen Li nie (SW) in Bezug auf eine erste optische Achse (BX) einer ersten Kamera (1; 3), wobei dieser Abstand (B, B′) als Abstand zwischen einem ersten Punkt (B) auf der ersten optischen Ach se (BX) der ersten Kamera (1; 3) und einem ersten Schnittpunkt (B′) mit einer im ersten Punkt (B) zur optischen Achse (BX) der ersten Kamera (1; 3) senkrechten Linie mit der weißen Li nie (SW) bestimmt wird,
einer Einrichtung zur Berechnung eines Lenkwinkels (Φ) unter Verwendung einer Regressionsgleichung aus mehreren ersten Ab ständen (B, B′), die in aufeinanderfolgenden Zeitpunkten er faßt wurden und
einer Einrichtung zur Steuerung der Lenkung des Kraftfahr zeuges (100) gemäß dem ermittelten Lenkwinkel Φ, derart, daß das Kraftfahrzeug der weißen Linie (SW) folgt, dadurch gekennzeichnet,
daß eine Umformungseinrichtung (7) vorgesehen ist zur Umwandlung des ersten Abstandes (B, B′) in einen einem zweiten Abstand (A, A′) entsprechenden Abstand durch Koordinationstransformation und -verschiebung′ wobei der zweite Abstand (A, A′) definiert ist durch einen beliebi gen zweiten Punkt (A), der sich auf der optischen Achse (AX) einer in Fahrzeuglängsrichtung orientierten zweiten Kamera (2) befindet und durch einen zweiten Schnittpunkt (A′), der sich auf der weißen Linie (SW) befindet, und in dem eine zur optischen Achse (AX) im zweiten Punkt (A) senkrechte Linie die weiße Linie (SW) schneidet, wobei in einem Transformati onsschritt die Koordinationsformation und -verschiebung des ersten Abstandes (B,B′) in der Art erfolgt, daß die Koordina ten des ersten Schnittpunktes (B′) mit den Koordinaten des zweiten Schnittpunktes (A′) und die Projektionskoordinate (L) des ersten Schnittpunktes (B′) auf die optische Achse (AX) der zweiten Kamera (2) mit der Koordinate (L₀) des zweiten Punktes (A) übereinstimmt.
7. Vorrichtung gemäß Anspruch 6, dadurch gekennzeichnet,
daß die Kameraeinrichtung (1, 2, 3) eine Mehrzahl von Kameras
(1; 2; 3) umfaßt, die in untereinander verschiedenen
Richtungen orientiert sind; und
die weiße Linie (SW) zu einem bestimmten Zeitpunkt von einer (1; 3) der Kameras (1; 2; 3) erfaßt wird.
die weiße Linie (SW) zu einem bestimmten Zeitpunkt von einer (1; 3) der Kameras (1; 2; 3) erfaßt wird.
8. Vorrichtung gemäß Anspruch 6, dadurch gekennzeichnet, daß
die Kameraeinrichtung (1, 2, 3) eine einzige Kamera (2) umfaßt,
deren Orientierung veränderbar ist, und
die weiße Linie (SW) zu einem bestimmten Zeitpunkt bei einer bestimmten Orientierung der einzigen Kamera (2) erfaßt wird.
die weiße Linie (SW) zu einem bestimmten Zeitpunkt bei einer bestimmten Orientierung der einzigen Kamera (2) erfaßt wird.
9. Vorrichtung gemäß Anspruch 6, dadurch gekennzeichnet,
daß die Anpassungseinrichtung anhand einer Koordinate (L′)
des Punktes (B) auf der optischen Achse (BX) der
Kameraeinrichtung (1; 3) und anhand dem von der
Bestimmungseinrichtung (5) bestimmten Abstand (BB′) der
weißen Linie (SW) bezüglich der optischen Achse (BX) der
Kamera (1; 3) eine Koordinate (L) der Projektion
des Schnittpunkts (B) bestimmt.
10. Vorrichtung gemäß Anspruch 6, dadurch gekennzeichnet,
daß die Umformungseinrichtung (7) den von der
Bestimmungseinrichtung (5) bestimmten Abstand (BB′) gemäß
einer Koordinate (L₀) des vorgegebenen Punktes (A) auf der
mittigen Längsachse (AX) des Kraftfahrzeugs (100) in einen
Abstand (AA′) der weißen Linie (SW) bezüglich der mittigen
Längsachse (AX) des Kraftfahrzeugs (100) umformt.
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2126884A JP2583641B2 (ja) | 1990-05-18 | 1990-05-18 | 走行制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
DE4116255A1 DE4116255A1 (de) | 1991-12-12 |
DE4116255C2 true DE4116255C2 (de) | 1996-07-11 |
Family
ID=14946233
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
DE4116255A Expired - Fee Related DE4116255C2 (de) | 1990-05-18 | 1991-05-17 | Verfahren und Vorrichtung zur automatischen Steuerung der Lenkung eines Kraftfahrzeugs |
Country Status (3)
Country | Link |
---|---|
US (1) | US5163002A (de) |
JP (1) | JP2583641B2 (de) |
DE (1) | DE4116255C2 (de) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19508941A1 (de) * | 1995-03-13 | 1996-09-19 | Claas Ohg | Ortungsvorrichtung |
DE19508942A1 (de) * | 1995-03-13 | 1996-09-19 | Claas Ohg | Reflex-Ortungsvorrichtung |
EP1840627B1 (de) * | 2000-10-07 | 2012-12-12 | metaio GmbH | Vorrichtung und Verfahren zur Bestimmung der Orientierung eines Auges |
US8593521B2 (en) | 2004-04-15 | 2013-11-26 | Magna Electronics Inc. | Imaging system for vehicle |
US8599001B2 (en) | 1993-02-26 | 2013-12-03 | Magna Electronics Inc. | Vehicular vision system |
US8637801B2 (en) | 1996-03-25 | 2014-01-28 | Magna Electronics Inc. | Driver assistance system for a vehicle |
US8636393B2 (en) | 2006-08-11 | 2014-01-28 | Magna Electronics Inc. | Driver assistance system for vehicle |
US8665079B2 (en) | 2002-05-03 | 2014-03-04 | Magna Electronics Inc. | Vision system for vehicle |
US8842176B2 (en) | 1996-05-22 | 2014-09-23 | Donnelly Corporation | Automatic vehicle exterior light control |
US9436880B2 (en) | 1999-08-12 | 2016-09-06 | Magna Electronics Inc. | Vehicle vision system |
Families Citing this family (37)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2844240B2 (ja) * | 1990-03-15 | 1999-01-06 | 本田技研工業株式会社 | 自動走行装置 |
JP2835764B2 (ja) * | 1990-03-15 | 1998-12-14 | 本田技研工業株式会社 | 自動走行装置 |
US5414625A (en) * | 1991-04-01 | 1995-05-09 | Nissan Motor Co., Ltd. | System and method for providing steering control for autonomous vehicle |
JP3014823B2 (ja) * | 1991-09-19 | 2000-02-28 | マツダ株式会社 | 車両の総合制御装置 |
JP3110095B2 (ja) * | 1991-09-20 | 2000-11-20 | 富士通株式会社 | 測距方法及び測距装置 |
US5586063A (en) * | 1993-09-01 | 1996-12-17 | Hardin; Larry C. | Optical range and speed detection system |
DE4332836C1 (de) * | 1993-09-27 | 1994-09-15 | Daimler Benz Ag | Vorrichtung zur spurhaltungsgeregelten Lenkung eines Fahrzeugs |
US5661650A (en) * | 1994-02-23 | 1997-08-26 | Honda Giken Kogyo Kabushiki Kaisha | System for controlling a vehicle relative to a judged shape of a travel road |
DE4413694C2 (de) * | 1994-04-20 | 1997-05-22 | Claas Ohg | Ankuppelhilfsvorrichtung |
DE4437297A1 (de) * | 1994-10-19 | 1996-04-25 | Gerhard Cammann | Lastkraftfahrzeug mit Markeur |
CA2209610C (en) * | 1995-01-18 | 2001-03-27 | Lawrence V. Nash | Optical range and speed detection system |
DE19509320A1 (de) * | 1995-03-15 | 1996-09-19 | Technologietransfer Anstalt Te | Folgesteuerung für ein selbstfahrendes Fahrzeug |
DE29507429U1 (de) * | 1995-05-04 | 1995-09-28 | Birle Sigmund | Automatischer Lenksensor |
US5600435A (en) * | 1995-05-24 | 1997-02-04 | Fori Automation, Inc. | Intelligent sensor method and apparatus for an optical wheel alignment machine |
US5684697A (en) * | 1995-06-26 | 1997-11-04 | Mullen; Charles H. | Driver emulative vehicle control system |
DE19526702C2 (de) * | 1995-07-24 | 2001-08-02 | Horst J Roos | Verfahren zum Rückwärtsrangieren eines lenkbaren Straßenfahrzeugs und Vorrichtung zur Durchführung des Verfahrens |
DE29519245U1 (de) * | 1995-12-05 | 1998-01-02 | Birle Sigmund | Führerloses Transportsystem |
KR100270523B1 (ko) * | 1995-12-27 | 2000-11-01 | 정몽규 | 도로 조건에 따른 카메라 제어기능을 구비한 무인 자동차 시스템 |
JP3140961B2 (ja) * | 1996-04-12 | 2001-03-05 | 三菱電機株式会社 | 車両の周辺監視装置 |
DE19632929C1 (de) * | 1996-08-16 | 1997-11-27 | Daimler Benz Ag | Vorrichtung zur selbsttätigen Fahrzeugquerführung längs einer Fahrspur |
DE19748239A1 (de) * | 1996-10-31 | 1998-05-20 | Fori Automation Inc | Verfahren und Vorrichtung zur berührungslosen Bestimmung von Sturz und Vorlauf eines Fahrzeugrads |
DE19738163A1 (de) * | 1997-09-01 | 1999-03-11 | Siemens Ag | Verfahren zur Andockpositionierung einer autonomen mobilen Einheit unter Verwendung eines Leitstrahles |
US7366595B1 (en) * | 1999-06-25 | 2008-04-29 | Seiko Epson Corporation | Vehicle drive assist system |
US6490539B1 (en) | 2000-02-28 | 2002-12-03 | Case Corporation | Region of interest selection for varying distances between crop rows for a vision guidance system |
US6686951B1 (en) | 2000-02-28 | 2004-02-03 | Case, Llc | Crop row segmentation by K-means clustering for a vision guidance system |
US6278918B1 (en) | 2000-02-28 | 2001-08-21 | Case Corporation | Region of interest selection for a vision guidance system |
US6285930B1 (en) | 2000-02-28 | 2001-09-04 | Case Corporation | Tracking improvement for a vision guidance system |
US6385515B1 (en) | 2000-06-15 | 2002-05-07 | Case Corporation | Trajectory path planner for a vision guidance system |
US6445983B1 (en) | 2000-07-07 | 2002-09-03 | Case Corporation | Sensor-fusion navigator for automated guidance of off-road vehicles |
US8113657B2 (en) * | 2000-10-07 | 2012-02-14 | Metaio Gmbh | Device and method for determining the orientation of an eye |
AU2002221662A1 (en) | 2000-10-07 | 2002-04-29 | Physoptics Opto-Electronic Gmbh | Information system and method for providing information using a holographic element |
US20070233361A1 (en) * | 2006-03-30 | 2007-10-04 | Ford Global Technologies, Llc | Centralized Image Processing For An Automobile With A Navigation System |
US8589014B2 (en) * | 2011-06-01 | 2013-11-19 | Google Inc. | Sensor field selection |
US9381916B1 (en) | 2012-02-06 | 2016-07-05 | Google Inc. | System and method for predicting behaviors of detected objects through environment representation |
CN106950972B (zh) * | 2017-05-15 | 2020-09-08 | 上海音锋机器人股份有限公司 | 一种无人搬运车agv及其路线纠偏方法 |
CN107525510B (zh) * | 2017-08-30 | 2021-07-27 | 广州市井源机电设备有限公司 | 一种视觉导航型agv小车的控制系统及方法 |
CN109032125B (zh) * | 2018-05-31 | 2021-09-10 | 上海工程技术大学 | 一种视觉agv的导航方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4307791A (en) * | 1978-12-06 | 1981-12-29 | Bell & Howell Company | Line follower vehicle with scanning head |
US4630109A (en) * | 1985-02-28 | 1986-12-16 | Standard Telephones & Cables Public Limited Company | Vehicle tracking system |
EP0273976B1 (de) * | 1986-05-21 | 1993-08-11 | Kabushiki Kaisha Komatsu Seisakusho | Lenkvorrichtung für sich unbemannt bewegende körper |
US4819169A (en) * | 1986-09-24 | 1989-04-04 | Nissan Motor Company, Limited | System and method for calculating movement direction and position of an unmanned vehicle |
JPS63314618A (ja) * | 1987-06-17 | 1988-12-22 | Nissan Motor Co Ltd | 自律走行車両制御装置 |
JP2570315B2 (ja) * | 1987-09-01 | 1997-01-08 | アイシン精機株式会社 | 車上距離検出装置 |
US4858132A (en) * | 1987-09-11 | 1989-08-15 | Ndc Technologies, Inc. | Optical navigation system for an automatic guided vehicle, and method |
US4970653A (en) * | 1989-04-06 | 1990-11-13 | General Motors Corporation | Vision method of detecting lane boundaries and obstacles |
-
1990
- 1990-05-18 JP JP2126884A patent/JP2583641B2/ja not_active Expired - Fee Related
-
1991
- 1991-05-16 US US07/700,707 patent/US5163002A/en not_active Expired - Lifetime
- 1991-05-17 DE DE4116255A patent/DE4116255C2/de not_active Expired - Fee Related
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8599001B2 (en) | 1993-02-26 | 2013-12-03 | Magna Electronics Inc. | Vehicular vision system |
US8917169B2 (en) | 1993-02-26 | 2014-12-23 | Magna Electronics Inc. | Vehicular vision system |
DE19508942A1 (de) * | 1995-03-13 | 1996-09-19 | Claas Ohg | Reflex-Ortungsvorrichtung |
DE19508941A1 (de) * | 1995-03-13 | 1996-09-19 | Claas Ohg | Ortungsvorrichtung |
US8637801B2 (en) | 1996-03-25 | 2014-01-28 | Magna Electronics Inc. | Driver assistance system for a vehicle |
US8993951B2 (en) | 1996-03-25 | 2015-03-31 | Magna Electronics Inc. | Driver assistance system for a vehicle |
US8842176B2 (en) | 1996-05-22 | 2014-09-23 | Donnelly Corporation | Automatic vehicle exterior light control |
US9436880B2 (en) | 1999-08-12 | 2016-09-06 | Magna Electronics Inc. | Vehicle vision system |
EP1840627B1 (de) * | 2000-10-07 | 2012-12-12 | metaio GmbH | Vorrichtung und Verfahren zur Bestimmung der Orientierung eines Auges |
US9171217B2 (en) | 2002-05-03 | 2015-10-27 | Magna Electronics Inc. | Vision system for vehicle |
US9555803B2 (en) | 2002-05-03 | 2017-01-31 | Magna Electronics Inc. | Driver assistance system for vehicle |
US8665079B2 (en) | 2002-05-03 | 2014-03-04 | Magna Electronics Inc. | Vision system for vehicle |
US8818042B2 (en) | 2004-04-15 | 2014-08-26 | Magna Electronics Inc. | Driver assistance system for vehicle |
US9008369B2 (en) | 2004-04-15 | 2015-04-14 | Magna Electronics Inc. | Vision system for vehicle |
US9191634B2 (en) | 2004-04-15 | 2015-11-17 | Magna Electronics Inc. | Vision system for vehicle |
US9428192B2 (en) | 2004-04-15 | 2016-08-30 | Magna Electronics Inc. | Vision system for vehicle |
US8593521B2 (en) | 2004-04-15 | 2013-11-26 | Magna Electronics Inc. | Imaging system for vehicle |
US8636393B2 (en) | 2006-08-11 | 2014-01-28 | Magna Electronics Inc. | Driver assistance system for vehicle |
Also Published As
Publication number | Publication date |
---|---|
JP2583641B2 (ja) | 1997-02-19 |
US5163002A (en) | 1992-11-10 |
DE4116255A1 (de) | 1991-12-12 |
JPH0423107A (ja) | 1992-01-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
DE4116255C2 (de) | Verfahren und Vorrichtung zur automatischen Steuerung der Lenkung eines Kraftfahrzeugs | |
DE102014116140B4 (de) | Einparkhilfsvorrichtung und Einparkhilfsverfahren für ein Fahrzeug | |
DE60020919T2 (de) | Stereoskopisches Kamerasystem in einem Fahrzeug | |
DE4235619C2 (de) | Entfernungsbestimmungseinrichtung für Automobile | |
DE19505244C2 (de) | Vorrichtung zur Bestimmung des Abstandes zwischen Fahrzeugen | |
DE60117348T2 (de) | Fahrspur-Erkennungsvorrichtung für Fahrzeuge | |
DE19710234B4 (de) | Automatische Fahrvorrichtung für Fahrzeuge | |
DE4040401A1 (de) | Steuersystem fuer reisesteuerung | |
DE4410064C2 (de) | Verfahren und Vorrichtung zur Abstandserkennung | |
DE4130010C2 (de) | Vorrichtung zur laufenden Beobachtung eines Fahrzeuges und zur Messung seines Abstandes | |
DE102009005860B4 (de) | Umgebungs-Erkennungssystem | |
DE102018111778A1 (de) | Verfahren, Vorrichtung und System zur Steuerung eines Fahrzeugs, das eine Kreuzung passiert. | |
DE102015011914A1 (de) | Konturlinienmessvorrichtung und Robotersystem | |
DE4412669A1 (de) | Fahrzeugnavigations-Steuersystem | |
DE102009005861A1 (de) | Fahrzeugumgebungs-Erkennungssystem | |
EP2189349A2 (de) | Verfahren und Vorrichtung zur Kompensation eines Rollwinkels | |
DE102010035813A1 (de) | Strassenmarkierungslinien-Erkennungsvorrichtung für Fahrzeuge | |
DE19525561C2 (de) | 3D-Meßvorrichtung | |
DE102005011688A1 (de) | Vorrichtung zur Erfassung des Bewegungszustandes eines Kraftfahrzeugs | |
DE4138270C2 (de) | Verfahren zur Navigation eines selbstfahrenden Landfahrzeugs | |
DE69829091T2 (de) | Messungsgerät | |
DE3049397C2 (de) | Automatische Scharfeinstellvorrichtung für eine Kamera | |
DE4328902C2 (de) | Optische Entfernungsmessvorrichtung zur Bestimmung einer Entfernung zu symmetrischen Objekten | |
DE19953063A1 (de) | Verfahren zur dreidimensionalen optischen Vermessung von Objektoberflächen | |
DE112020000909T5 (de) | Objektpositionsdetektionsvorrichtung, fahrsteuersystem und fahrsteuerverfahren |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
OP8 | Request for examination as to paragraph 44 patent law | ||
D2 | Grant after examination | ||
8364 | No opposition during term of opposition | ||
8320 | Willingness to grant licences declared (paragraph 23) | ||
8339 | Ceased/non-payment of the annual fee |