-
TECHNISCHES GEBIET
-
Die vorliegende Erfindung betrifft eine Fahrzeugfahrspursteuervorrichtung und insbesondere eine Fahrzeugfahrspursteuervorrichtung zum Steuern einer Fahrzeugfahrt entlang einer Zielspur (Zielfahrlinie) durch Steuern eines gelenkten Winkels von gelenkten Rädern, so dass dieser mit einem gelenkten Sollwinkel übereinstimmt.
-
STAND DER TECHNIK
-
Es sind Fahrzeugfahrsteuervorrichtungen bereits bekannt, die eine Fahrzeugfahrt durch Steuern eines gelenkten Winkels von gelenkten Rädern steuern, so dass dieser mit einem gelenkten Sollwinkel in einem Fahrzeug übereinstimmt, das eine Lenkwinkeländerungsvorrichtung aufweist, die eine Beziehung eines gelenkten Winkels von gelenkten Rädern zu einer Lenkposition einer Lenkeingangseinrichtung wie einem Lenkrad ändern kann. Als Arten von Fahrzeugfahrsteuervorrichtungen wurden verschiedene Fahrzeugfahrspursteuervorrichtungen vorgeschlagen, die einen gelenkten Sollwinkel von gelenkten Rädern für das Fahrzeug zum Fahren entlang einer Sollfahrlinie berechnen und den gelenkten Winkel der gelenkten Räder steuern, so dass dieser mit dem gelenkten Sollwinkel übereinstimmt.
-
In der
JP 2002-109694 A wird beispielsweise eine Fahrzeugfahrspursteuervorrichtung beschrieben, die ausgelegt ist, auf der Grundlage von in Vorwärtsrichtung aufgenommenen Bildinformationen, die von einer Kamera gesendet werden, die ein Vorwärtsbild vor dem Fahrzeug aufnimmt, und auf der Grundlage von Karteninformationen, die von einem Navigationssystem gesendet werden, zu bestimmen, ob ein Fahrzeug eine Fahrspur verlässt.
-
Bei einer derartigen herkömmlichen Fahrzeugfahrspursteuervorrichtung, wie sie in der obigen Patentoffenlegungsschrift beschrieben ist, wird eine Fahrspur vor dem Fahrzeug auf der Grundlage von aufgenommenen Vorwärtsbildinformationen bestimmt, die von einer Kamera erhalten werden, die ein Vorwärtsbild vor dem Fahrzeug aufnimmt. Wie es in 23 gezeigt ist, ist jedoch der Bereich 104 der Fahrspur, den eine Kamera aufnehmen kann, begrenzt, wenn ein Fahrzeug 100 entlang einer Fahrspur 102, die einen kleinen Krümmungsradius aufweist, beispielsweise einer stark gekrümmten Straße oder einer sich windenden Straße, fährt. Dementsprechend ist es unmöglich, ausreichende Vorwärtsinformationen vor dem Fahrzeug zu erhalten, um benötigte Informationen in Bezug auf die Fahrspur zu erlangen und die Fahrzeugfahrspursteuerung geeignet auszuführen. Aus diesem Grund kann eine Verschlechterung der Genauigkeit der Fahrzeugfahrspursteuerung nicht vermieden werden, wenn der Krümmungsradius der Fahrspur klein ist, und es kann nicht vermieden werden, dass die Fahrzeugfahrspursteuerung beendet wird, wenn der Bereich der Fahrspur, den die Kamera normalerweise aufnehmen kann, unnötig begrenzt wird.
-
Selbstverständlich ist das obige Problem nicht auf einen Fall beschränkt, in dem der Krümmungsradius einer Fahrspur klein ist, sondern gilt auf ähnliche Weise für einen Fall, in dem eine Kamera ein Bild vor einem Fahrzeug in Situationen wie beispielsweise Regen und Sprühregen, einer schnellen Änderung der Helligkeit um ein Fahrzeug wie beispielsweise bei einer Einfahrt in einen Tunnel und einem großen Fahrzeug vor dem Fahrzeug nicht geeignet aufnehmen kann.
-
Die
JP 2008-250904 A beschreibt eine Fahrzeugfahrspursteuervorrichtung, die eine Bildaufnahmeeinrichtung, die ein Bild um ein Fahrzeug aufnimmt und eine Aufnahmerichtung und/oder einen Aufnahmebereich ändern kann, und eine Rechen-Steuer-Einheit aufweist, die einen Lenkwinkel von gelenkten Rädern auf der Grundlage der aufgenommenen Bildinformationen, die von der Bildaufnahmeeinrichtung gesendet werden, derart steuert, dass das Fahrzeug entlang einer Fahrspur fährt, wobei in einer Situation, in der ein gelenkter Sollwinkel von gelenkten Rädern auf der Grundlage der aufgenommenen Vorwärtsbildinformationen vor dem Fahrzeug nicht richtig berechnet werden kann, die Rechen-Steuer-Einheit bewirkt, dass die Bildaufnahmeeinrichtung ein Bild auf einer Seite des Fahrzeugs aufnimmt, Seitenabstände des Fahrzeugs in Bezug auf die Fahrspur an den Außenspiegeln auf der Grundlage der aufgenommenen Seitenbildinformationen schätzt, einen Gierwinkel des Fahrzeugs in Bezug auf die Fahrspur an vorederen und hinteren Bezugspositionen schätzt, und den Lenkwinkel der gelenkten Räder auf der Grundlage zumindest der Seitenabstände des Fahrzeug berechnet.
-
Die
DE 10 2007 054 067 A1 beschreibt ein Verfahren zum Verhindern einer Fahrspurabweichung zum Gebrauch mit einem Fahrzeug. Das Verfahren legt fest, ob sich das Fahrzeug aus seiner Fahrspur bewegt, indem Fahrspurmarkierungen aus einem Bild extrahiert werden, das unter Verwendung von auf beiden Seitenspiegeln abgebrachten Rückseitenkameras eingegeben wird, ein Fahrspurabweichungsabstand aus dem Richtungswinkel und einen Seitenabstand, die durch dreidimensionales Mapping der extrahierten Fahrspurmarkierungen errechnet werden, berechnet wird, und eine Fahrspurabweichungszeit durch den errechneten Fahrspurabweichungsabstand und eine von einem Fahrzeuggeschwindigkeitssensor erfasste Fahrzeuggeschwindigkeit abgeschätzt wird.
Die
DE 10 2007 025 147 A1 beschreibt ein System zur Spurverlassenswarnung und/oder Spurhaltefunktion in einem Kraftfahrzeug. Das System umfasst eine seitlich an dem Kraftfahrzeug angeordnete und zur seitlich des Kraftfahrzeugs liegenden Fahrbahnoberfläche hin ausgerichtete Kamera zur Erkennung zumindest einer auf der Fahrbahnoberfläche angeordneten Fahrspurmarkierung.
-
BESCHREIBUNG DER ERFINDUNG
-
Es ist eine Hauptaufgabe der vorliegenden Erfindung, eine Fahrzeugfahrspursteuerung fortzusetzen, wobei eine Verschlechterung der Genauigkeit verhindert wird und eine Situation bewältigt wird, bei der keine Vorwärtsinformationen vor einem Fahrzeug, die ausreichend sind, Fahrspurinformationen zu bestimmen, von einer Kamera, die ein Bild vor dem Fahrzeug aufnimmt, erhalten werden können.
-
Die Aufgabe wird durch eine Fahrzeugfahrspursteuervorrichtung mit den Merkmalen des Anspruchs 1 gelöst. Die abhängigen Ansprüche sind auf bevorzugte Ausführungsformen der Erfindung gerichtet.
-
Erfindungsgemäß kann sogar in einer Situation, in der der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage der aufgenommenen Vorwärtsbildinformationen vor dem Fahrzeug nicht richtig berechnet werden kann, der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage aufgenommener Bildinformationen berechnet werden, die durch Ändern einer Aufnahmerichtung und/oder eines Aufnahmebereichs der Bildaufnahmeeinrichtung erhalten werden. Dementsprechend kann im Vergleich zu einem Fall, in dem weder die Aufnahmerichtung noch der Aufnahmebereich der Bildaufnahmeeinrichtung geändert wird, die Möglichkeit erhöht werden, dass der gelenkte Sollwinkel der gelenkten Räder genau berechnet werden kann, was es möglich macht, die Fahrspursteuerung fortzusetzen, während eine Verschlechterung der Genauigkeit so weit wie möglich vermieden wird.
-
Erfindungsgemäß kann außerdem sogar in einer Situation, in der der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage der aufgenommenen Vorwärtsbildinformationen vor dem Fahrzeug nicht richtig berechnet werden kann, der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage zumindest der aufgenommenen Seitenbildinformationen berechnet werden. Dementsprechend kann im Vergleich zu einem Fall, in dem ein Seitenbild auf der Seite des Fahrzeugs nicht aufgenommen wird, die Möglichkeit erhöht werden, dass der gelenkte Sollwinkel der gelenkten Räder genau berechnet werden kann, was es möglich macht, die Fahrspursteuerung fortzusetzen, während eine Verschlechterung der Genauigkeit so weit wie möglich vermieden wird.
-
Die obige Konfiguration kann derart ausgebildet sein, dass die Bildaufnahmeeinrichtung eine Vorwärtsbildaufnahmevorrichtung, die ein Vorwärtsbild vor einem Fahrzeug aufnimmt, und eine Seitenbildaufnahmevorrichtung, die ein Seitenbild auf einer linken und/oder rechten Seite des Fahrzeugs aufnimmt, enthält; wobei die Rechen-Steuer-Einheit den gelenkten Sollwinkel der gelenkten Räder auf der Grundlage der aufgenommenen Vorwärtsbildinformationen, die von der Vorwärtsbildaufnahmevorrichtung gesendet werden, in einer Situation berechnet, in der der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage der aufgenommenen Vorwärtsbildinformationen vor dem Fahrzeug richtig berechnet werden kann, und den gelenkten Sollwinkel der gelenkten Räder auf der Grundlage zumindest der aufgenommenen Seitenbildinformationen, die von der Seitenbildaufnahmevorrichtung gesendet werden, in einer Situation berechnet, in der der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage der aufgenommenen Vorwärtsbildinformationen vor dem Fahrzeug nicht richtig berechnet werden kann.
-
Gemäß dieser Konfiguration kann der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage der aufgenommenen Vorwärtsbildinformationen, die von der Vorwärtsbildaufnahmevorrichtung gesendet werden, in einer Situation berechnet werden, in der der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage der aufgenommenen Vorwärtsbildinformationen vor dem Fahrzeug richtig berechnet werden kann. Der gelenkte Sollwinkel der gelenkten Räder kann auf der Grundlage zumindest der aufgenommenen Seitenbildinformationen, die von der Seitenbildaufnahmevorrichtung gesendet werden, in einer Situation berechnet werden, in der der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage der aufgenommenen Vorwärtsbildinformationen vor dem Fahrzeug nicht richtig berechnet werden kann.
-
Erfindungsgemäß werden Seitenabstände des Fahrzeugs und eine Sollseitendifferenz des Fahrzeugs berechnet, was es möglich macht, den gelenkten Sollwinkel der gelenkten Räder auf der Grundlage zumindest der Seitenabstände des Fahrzeugs und der Sollseitendifferenz des Fahrzeugs zu berechnen.
-
Die obige Konfiguration kann derart ausgebildet sein, dass die Rechen-Steuer-Einheit einen Krümmungsradius der Fahrspur auf der Grundlage der aufgenommenen Seitenbildinformationen schätzt, einen Sollgierwinkel des Fahrzeugs in Bezug auf die Fahrspur auf der Grundlage des Krümmungsradius der Fahrspur berechnet und den gelenkten Sollwinkel der gelenkten Räder auf der Grundlage einer Differenz zwischen der Seitendifferenz des Fahrzeugs und der Sollseitendifferenz des Fahrzeugs, einer Differenz zwischen dem Gierwinkel des Fahrzeugs und dem Sollgierwinkel des Fahrzeugs und des Krümmungsradius der Fahrspur berechnet.
-
Gemäß dieser Konfiguration kann der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage der Differenz zwischen der Seitendifferenz des Fahrzeugs und der Sollseitendifferenz des Fahrzeugs, der Differenz zwischen dem Gierwinkel des Fahrzeugs und dem Sollgierwinkel des Fahrzeugs und des Krümmungsradius der Fahrspur berechnet werden.
-
Gemäß der Konfiguration nach Anspruch 3 kann der gelenkte Sollwinkel der gelenkten Räder zum Ausführen der Fahrzeugfahrspursteuerung auf der Grundlage einer Differenz zwischen der Seitendifferenz des Fahrzeugs und der Sollseitendifferenz des Fahrzeugs zu dem dritten Zeitpunkt, einer Differenz zwischen dem Gierwinkel des Fahrzeugs und dem Sollgierwinkel des Fahrzeugs zu dem dritten Zeitpunkt und des Krümmungsradius der Fahrspur berechnet werden.
-
Die obige Konfiguration kann derart ausgebildet sein, dass die Rechen-Steuer-Einheit eine Seitendifferenz des Fahrzeugs in Bezug auf eine Fahrspur an einer Bezugsposition des Fahrzeugs auf der Grundlage der aufgenommenen Seitenbildinformationen schätzt, eine Sollseitendifferenz des Fahrzeugs in Bezug auf die Fahrspur auf der Grundlage zumindest der Seitendifferenz des Fahrzeugs und Breiteninformationen der Fahrspur berechnet und den gelenkten Sollwinkel der gelenkten Räder auf der Grundlage der Seitendifferenz des Fahrzeugs und der Sollseitendifferenz des Fahrzeugs berechnet.
-
Gemäß dieser Konfiguration kann der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage der Seitendifferenz des Fahrzeugs und der Sollseitendifferenz des Fahrzeugs berechnet werden, ohne den Krümmungsradius der Fahrspur, den Gierwinkel des Fahrzeugs und den Sollgierwinkel des Fahrzeugs zu berechnen.
-
Die obige Konfiguration kann derart ausgebildet sein, dass die Seitenbildaufnahmevorrichtung eine Linksseitenbildaufnahmevorrichtung, die ein linkes Seitenbild auf einer linken Seite des Fahrzeugs aufnimmt, und eine Rechtsseitenbildaufnahmevorrichtung, die ein rechtes Seitenbild auf einer rechten Seite des Fahrzeugs aufnimmt, enthält und die Rechen-Steuer-Einheit Seitendifferenzen des Fahrzeugs in Bezug auf eine Fahrspur auf linken und rechten Seite des Fahrzeugs auf der Grundlage der aufgenommenen Links- und Rechtsseitenbildinformationen schätzt und eine Sollseitendifferenz des Fahrzeugs in Bezug auf die Fahrspur auf der Grundlage der Seitendifferenzen des Fahrzeugs in Bezug auf die Fahrspur auf der linken und rechten Seite des Fahrzeugs berechnet.
-
Gemäß dieser Konfiguration kann die Sollseitendifferenz des Fahrzeugs in Bezug auf die Fahrspur auf der Grundlage der Seitendifferenzen des Fahrzeugs in Bezug auf die Fahrspur auf der linken und rechten Seite des Fahrzeugs berechnet werden.
-
Die obige Konfiguration kann derart ausgebildet sein, dass die Seitenbildaufnahmevorrichtung ein Seitenbild auf einer linken und/oder rechten Seite des Fahrzeugs aufnimmt und die Rechen-Steuer-Einheit Seitendifferenzen des Fahrzeugs in Bezug auf eine Fahrspur an vorderen und hinteren Bezugspositionen, die in der Längsrichtung des Fahrzeugs zueinander beabstandet sind, auf der Grundlage der aufgenommenen Seitenbildinformationen schätzt, einen Gierwinkel des Fahrzeugs in Bezug auf die Fahrspur auf der Grundlage der Seitendifferenzen des Fahrzeugs in Bezug auf die Fahrspur an den vorderen und hinteren Bezugspositionen schätzt, einen Krümmungsradius der Fahrspur auf der Grundlage der Seitendifferenzen des Fahrzeugs berechnet, einen Sollgierwinkel des Fahrzeugs auf der Grundlage des Krümmungsradius der Fahrspur berechnet und den gelenkten Sollwinkel der gelenkten Räder auf der Grundlage einer Differenz zwischen der Seitendifferenz des Fahrzeugs und der Sollseitendifferenz des Fahrzeugs und einer Differenz zwischen dem Gierwinkel des Fahrzeugs und dem Sollgierwinkel des Fahrzeugs berechnet, wobei die Sollseitendifferenz des Fahrzeugs ein Wert ist, der änderbar auf der Grundlage einer Breite der Fahrspur eingestellt wird, oder ein vorbestimmter Wert ist.
-
Gemäß dieser Konfiguration kann der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage einer Differenz zwischen der Seitendifferenz des Fahrzeugs und der Sollseitendifferenz des Fahrzeugs und einer Differenz zwischen dem Gierwinkel des Fahrzeugs und dem Sollgierwinkel des Fahrzeugs berechnet werden, wobei die Sollseitendifferenz des Fahrzeugs ein Wert ist, der änderbar auf der Grundlage einer Breite der Fahrspur eingestellt wird, oder ein vorbestimmter Wert ist.
-
Die obige Konfiguration kann derart ausgebildet sein, dass die Rechen-Steuer-Einheit graduell den gelenkten Sollwinkel der gelenkten Räder ändert, wenn die Fahrzeugfahrspursteuerung zwischen einem Modus, in dem der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage der aufgenommenen Vorwärtsbildinformationen berechnet wird, und einem Modus, in dem der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage zumindest der aufgenommenen Seitenbildinformationen berechnet wird, wechselt.
-
Gemäß dieser Konfiguration kann verhindert werden, dass sich der gelenkte Sollwinkel der gelenkten Räder schnell ändert und sich die Fahrzeugfahrbedingung schnell ändert, wenn zwischen den Modi der Fahrzeugfahrspursteuerung gewechselt wird, da der gelenkte Sollwinkel der gelenkten Räder graduell geändert wird, wenn zwischen den Modi der Fahrzeugfahrspursteuerung gewechselt wird.
-
Die obige Konfiguration kann derart ausgebildet sein, dass in einer Situation, in der der Krümmungsradius der Fahrzeugfahrspur nicht größer als der Bezugswert ist, die Rechen-Steuer-Einheit einen ersten gelenkten Sollwinkel der gelenkten Räder auf der Grundlage der aufgenommenen Vorwärtsbildinformationen, die von der Vorwärtsbildaufnahmevorrichtung gesendet werden, und einen zweiten gelenkten Sollwinkel der gelenkten Räder auf der Grundlage der aufgenommenen Seitenbildinformationen, die von der Seitenbildaufnahmevorrichtung gesendet werden, berechnet, einen Vorwärtsbeobachtungsabstand eines Fahrers auf der Grundlage einer Fahrzeuggeschwindigkeit und des Krümmungsradius der Fahrzeugfahrspur schätzt, einen Beitrag des zweiten gelenkten Sollwinkels änderbar derart einstellt, dass sich der Beitrag erhöht, wenn der Bildaufnahmeabstand der Vorwärtsbildaufnahmevorrichtung in Bezug auf den Vorwärtsbeobachtungsabstand kürzer ist, im Vergleich zu einem Fall, in dem der Bildaufnahmeabstand der Vorwärtsbildaufnahmevorrichtung in Bezug auf den Vorwärtsbeobachtungsabstand länger ist, und den gelenkten Sollwinkel der gelenkten Räder auf der Grundlage des ersten gelenkten Sollwinkels, des zweiten gelenkten Sollwinkels und des Beitrags berechnet.
-
Gemäß dieser Konfiguration kann der Beitrag des zweiten gelenkten Sollwinkels änderbar entsprechend der Beziehung zwischen dem Vorwärtsbeobachtungsabstand und dem Bildaufnahmeabstand der Vorwärtsbildaufnahmevorrichtung eingestellt werden, und es kann der gelenkte Sollwinkel der gelenkten Räder auf der Grundlage des ersten gelenkten Sollwinkels der gelenkten Räder, des zweiten gelenkten Sollwinkels der gelenkten Räder und des Beitrags berechnet werden. Dementsprechend kann der gelenkten Sollwinkel der gelenkten Räder durch Verringern des Beitrags des zweiten gelenkten Sollwinkels, wenn der Bildaufnahmeabstand der Vorwärtsbildaufnahmevorrichtung in Bezug auf den Vorwärtsbeobachtungsabstand länger ist, und durch Erhöhen des Beitrags des zweiten gelenkten Sollwinkels, wenn der Bildaufnahmeabstand der Vorwärtsbildaufnahmevorrichtung in Bezug auf den Vorwärtsbeobachtungsabstand kürzer ist, berechnet werden.
-
Die obige Konfiguration kann derart ausgebildet sein, dass die Rechen-Steuer-Einheit eine Fahrzeuggeschwindigkeit, um die Fahrzeugfahrspursteuerung fortzusetzen, in einem Fall, in dem das Risiko besteht, dass das Fahrzeug von der Fahrspur abweicht, oder in dem Fall, in dem das Leistungsvermögen der Bildaufnahmeeinrichtung sich hinsichtlich der Bildaufnahmegenauigkeit verschlechtert, verringert.
-
Gemäß dieser Konfiguration wird die Fahrzeuggeschwindigkeit, um die Fahrzeugfahrspursteuerung fortzusetzen, in einem Fall, in dem das Risiko besteht, dass das Fahrzeug von der Fahrspur abweicht, oder in dem Fall, in dem das Leistungsvermögen der Bildaufnahmeeinrichtung sich hinsichtlich der Bildaufnahmegenauigkeit verschlechtert, verringert. Dementsprechend ist es im Vergleich zu einem Fall, in dem die Fahrzeuggeschwindigkeit nicht verringert wird, möglich, das Risiko zu verringern, dass das Fahrzeug aufgrund einer relativen Verzögerung beim Steuern des gelenkten Winkels der gelenkten Räder mittels der Fahrzeugfahrspursteuerung nicht entlang einer Fahrspur fährt.
-
Figurenliste
-
- 1 ist eine schematische Ansicht, die eine erste Ausführungsform einer Fahrzeugfahrspursteuervorrichtung gemäß der vorliegenden Erfindung zeigt.
- 2 ist eine erläuternde Darstellung aus der Sicht der Rückseite des Fahrzeugs, die die Bildaufnahme mittels der Rechtsseiten-CCD-Kamera und die Art des Erlangens von Weißlinieninformationen zeigt.
- 3 ist eine erläuternde Darstellung aus der Sicht oberhalb des Fahrzeugs, die die Bildaufnahme mittels der Rechtsseiten-CCD-Kamera und die Art des Erlangens von Weißlinieninformationen zeigt.
- 4 ist eine erläuternde Darstellung aus der Sicht oberhalb des Fahrzeugs, die die Art zeigt, wie Weißlinieninformationen, die durch die Bildaufnahme mittels der Vorwärts-CCD-Kamera erhalten werden, durch Weißlinieninformationen ergänzt werden, die durch die Bildaufnahme mittels der Rechtsseiten-CCD-Kamera erhalten werden.
- 5 ist ein Flussdiagramm, das eine Hauptroutine der Fahrzeugfahrspursteuerung gemäß der ersten Ausführungsform zeigt.
- 6 ist ein Flussdiagramm, das eine Routine zum Berechnen einer Sollseitenbeschleunigung Gyt auf der Grundlage von aufgenommenen Seitenbildinformationen zeigt, die in Schritt 300 der 5 durchgeführt wird.
- 7 ist ein Flussdiagramm, das eine Routine zum Berechnen einer Sollseitenbeschleunigung Gyt auf der Grundlage von aufgenommenen Vorderbildinformationen zeigt, die in Schritt 400 der 5 durchgeführt wird.
- 8 ist ein Flussdiagramm, das eine Routine zum Berechnen einer Sollseitenbeschleunigung Gyt auf der Grundlage von aufgenommenen Vorder- und Seitenbildinformationen zeigt, die in Schritt 600 der 5 durchgeführt wird.
- 9 ist ein Flussdiagramm, das eine Routine zum Berechnen eines gelenkten Sollwinkels δt und zum Steuern eines gelenkten Winkels zeigt, die in Schritt 900 der 5 durchgeführt wird.
- 10 ist ein Flussdiagramm, das eine Routine zum Berechnen einer Sollseitenbeschleunigung Gyt auf der Grundlage von aufgenommenen Seitenbildinformationen gemäß einer zweiten Ausführungsform zeigt.
- 11 ist ein Flussdiagramm, das eine Routine zum Berechnen einer Sollseitenbeschleunigung Gyt auf der Grundlage von aufgenommenen Seitenbildinformationen gemäß einer dritten Ausführungsform zeigt.
- 12 ist ein Flussdiagramm, das eine Routine zum Berechnen einer Sollseitenbeschleunigung Gyt auf der Grundlage von aufgenommenen Seitenbildinformationen gemäß einer vierten Ausführungsform zeigt.
- 13 ist ein Flussdiagramm, das einen wesentlichen Teil einer Hauptroutine einer Fahrzeugfahrspursteuerung gemäß einer fünften Ausführungsform zeigt.
- 14 ist ein Flussdiagramm, das eine Routine zum Berechnen einer Sollseitenbeschleunigung Gyts auf der Grundlage von aufgenommenen Seitenbildinformationen zeigt, die in Schritt 300 der 13 durchgeführt wird.
- 15 ist ein Diagramm, das ein Kennlinienfeld bzw. Kennlinien zum Berechnen von Korrekturkoeffizienten Kf und Ks auf der Grundlage der verstrichenen Zeit tfs zeigt.
- 16 ist ein Diagramm, das ein Kennlinienfeld bzw. Kennlinien zum Berechnen von Korrekturkoeffizienten Kf und Ks auf der Grundlage der verstrichenen Zeit tfs zeigt.
- 17 ist ein Diagramm, das ein Kennlinienfeld bzw. Kennlinien zum Berechnen eines gelenkten Sollwinkels θlkt der Fahrzeugfahrspursteuerung auf der Grundlage einer Sollseitenbeschleunigung Gyt des Fahrzeugs und einer Fahrzeuggeschwindigkeit V zeigt.
- 18 ist ein Diagramm, das ein Kennlinienfeld bzw. Kennlinien zum Berechnen eines Korrekturkoeffizienten Kv auf der Grundlage einer Fahrzeuggeschwindigkeit V zeigt.
- 19 ist eine erläuternde Darstellung, die die Art zum Berechnen von Abständen Dr1 und Dr2 in seitlicher Richtung bzw. Querrichtung des Fahrzeugs zwischen Seitenkanten auf vorderen und hinteren Enden des Fahrzeugs und einer rechtseitigen weißen Linie gemäß der ersten Ausführungsform zeigt.
- 20 ist eine erläuternde Darstellung gemäß der ersten Ausführungsform, die die Art zeigt, wie linke und rechte weiße Linien durch weiße Linien ergänzt werden, die eine benötigte Länge von Lsl und Lsr aufweisen.
- 21 ist eine erläuternde Darstellung, die die Art zum Festlegen von rechteckigen Koordinaten und zum Berechnen eines Krümmungsradius einer Fahrspur gemäß der zweiten Ausführungsform zeigt.
- 22 ist eine erläuternde Darstellung, die die Art zum Berechnen von Abständen zwischen einer Seitenkante an einem vorderen Ende des Fahrzeugs und einer linksseitigen und rechtsseitigen Kante der Fahrspur gemäß der dritten Ausführungsform zeigt.
- 23 ist eine erläuternde Darstellung, die eine Situation zeigt, in der das Fahrzeug entlang einer Fahrspur fährt, die einen kleinen Krümmungsradius aufweist, und in der der Bereich, von dem die Kamera ein Bild aufnehmen kann, begrenzt ist.
-
BESCHREIBUNG DER AUSFÜHRUNGSFORMEN
-
Im Folgenden werden einige bevorzugte Ausführungsformen der vorliegenden Erfindung genauer mit Bezug auf die zugehörigen Zeichnungen beschrieben.
-
Erste Ausführungsform
-
1 ist eine schematische Ansicht, die eine erste Ausführungsform einer Fahrzeugfahrspursteuervorrichtung gemäß der vorliegenden Erfindung zeigt.
-
Gemäß 1 ist eine Fahrzeugfahrspursteuervorrichtung 10 in einem Fahrzeug 12 installiert und enthält eine Vorderradlenksteuervorrichtung 14. Die Vorderradlenksteuervorrichtung 14 dient als eine Lenksteuereinrichtung, die in der Lage ist, Vorderräder unabhängig von einer Lenktätigkeit eines Fahrers zu lenken. Das Fahrzeug 12 ist mit einer Bremskraftsteuervorrichtung 16 ausgerüstet, die in der Lage ist, die Bremskräfte der jeweiligen Räder unabhängig von einer Bremstätigkeit des Fahrers individuell zu steuern.
-
In 1 bezeichnen die Bezugszeichen 18FL und 18FR jeweils ein linkes und rechtes Vorderrad, die lenkbare Räder sind, und 18RL und 18RR bezeichnen jeweils ein linkes und rechtes Hinterrad. Die rechten und linken Vorderräder 18FR, 18FL, die lenkbare Räder sind, werden von einer Servolenkeinheit 22 vom Zahnstangentyp über eine Zahnstange 24 und jeweilige Zugstangen 26L und 26R gelenkt. Die Servolenkeinheit 22 wird als Reaktion auf eine Lenktätigkeit eines Lenkrads 20 eines Fahrers angetrieben.
-
Das Lenkrad 20 ist mit einer Ritzelwelle 36 der Servolenkeinheit 22 über eine obere Lenkwelle 28, eine Lenkwinkeländerungseinheit 30, eine untere Lenkwelle 32 und ein Universalgelenk 34 antreibbar verbunden. In der ersten Ausführungsform, die in der Figur gezeigt ist, enthält die Lenkwinkeländerungseinheit 30 einen Elektromotor 38 zum ergänzenden Lenkantrieb. Der Elektromotor 38 weist ein Gehäuse 30A, das mit einem unteren Ende der oberen Lenkwelle 28 verbunden ist, und einen Rotor 30B, der mit einem oberen Ende der unteren Lenkwelle 32 verbunden ist, auf.
-
Wie es aus Obigem ersichtlich ist, dreht die Lenkwinkeländerungseinheit 30 die untere Lenkwelle 32 in Bezug auf die obere Lenkwelle 28, um die linken und rechten Vorderräder 18FL und 18FR in Bezug auf das Lenkrad 20 zur ergänzenden Lenkung anzutreiben. Die Lenkwinkeländerungseinheit 30 wird von einem Lenksteuerabschnitt einer elektronischen Steuereinheit 40 gesteuert.
-
Die elektrische Servolenkeinheit 22 ist eine elektrische Servolenkeinheit, die konzentrisch zu der Zahnstange angeordnet ist. Die Servolenkeinheit 22 enthält einen Elektromotor 42 und einen Mechanismus, der das Drehmoment des Elektromotors 42 in eine Kraft in einer Hin- und Herrichtung der Zahnstange 24 umwandelt, beispielsweise ein Umwandlungsmechanismus 44 mit Kugelgewinde. Die Servolenkeinheit 22 wird von einem Lenkunterstützungsmomentsteuerabschnitt der elektronischen Steuereinheit 40 gesteuert und erzeugt ein Lenkunterstützungsmoment zum Antreiben der Zahnstange 24 in Bezug auf ein Gehäuse 46. Das Lenkunterstützungsmoment verringert eine Lenklast des Fahrers und unterstützt nach Bedarf eine Lenktätigkeit der linken und rechten Vorderräder mittels der Lenkwinkeländerungseinheit 30.
-
Wie es aus Obigem ersichtlich ist, bildet die Lenkwinkeländerungseinheit 30 einen Hauptteil der Vorderradlenksteuervorrichtung 14, die mit der Servolenkeinheit 22 kooperiert, um die Beziehung des gelenkten Winkels der linken und rechten Vorderräder zu dem Lenkrad zu ändern, und die Vorderräder unabhängig von einer Lenktätigkeit des Fahrers lenkt.
-
Man beachte, dass, da die Konfigurationen der Servolenkeinheit 22 und der Lenkwinkeländerungseinheit 30 kein spezieller Gegenstand der vorliegenden Erfindung sind, diese Vorrichtungen eine beliebige bekannte Konfiguration aufweisen können, solange sie die obigen Funktionen erfüllen.
-
Die Bremskraftsteuervorrichtung 16 enthält eine Bremseinheit 50. Es werden Bremskräfte der Räder mittels Steuern der Innendrücke Pi (i = fl, fr, rl, rr) jeweiliger Radzylinder 54FL, 54FR, 54RL, 54RR, d. h. Bremsdrücke, von einer Hydraulikschaltung 52 der Bremseinheit 50 gesteuert. Auch wenn es in 1 nicht gezeigt ist, enthält die Hydraulikschaltung 52 ein Reservoir, eine Ölpumpe, verschiedene Ventileinheiten und Ähnliches. Der Bremsdruck in jedem Radzylinder wird gewöhnlich mittels eines Drucks in einem Hauptzylinder 58 gesteuert, der durch eine Fahrertätigkeit des Niederdrückens eines Bremspedals 56 angetrieben wird. Der Bremsdruck in jedem Radzylinder wird ebenfalls individuell nach Bedarf von der Hydraulikschaltung gesteuert, die von einem Bremskraftsteuerabschnitt der elektronischen Steuereinheit 40 gesteuert wird. Somit ist die Bremseinheit 50 in der Lage, die Bremskraft jedes Rads unabhängig von einer Bremstätigkeit des Fahrers individuell zu steuern, und dient als eine Hauptvorrichtung der Bremskraftsteuervorrichtung 16.
-
Die obere Lenkwelle 28 ist mit einem Lenkwinkelsensor 62, der einen Drehwinkel der oberen Lenkwelle 28 als einen Lenkwinkel θ erfasst, und einem Lenkmomentsensor 64, der ein Lenkmoment Ts erfasst, ausgerüstet. Signale, die den Lenkwinkel θ und das Lenkmoment Ts angeben, werden in die elektronische Steuereinheit 40 eingegeben. Die elektronische Steuereinheit 40 empfängt ein Signal, das einen relativen Drehwinkel θre der Lenkwinkeländerungseinheit 30 angibt, der von einem Drehwinkelsensor 66 erfasst wird und ein Drehwinkel der unteren Lenkwelle 32 in Bezug auf die obere Lenkwelle 28 ist.
-
Bei der in der Figur gezeigten Ausführungsform ist eine Vorwärts-CCD-Kamera 68, die ein Vorwärtsbild vor dem Fahrzeug 12 aufnimmt, an einem vorderen Teil des Abteils des Fahrzeugs 12 angeordnet, und es wird ein Signal, das die Vorwärtsbildinformationen vor dem Fahrzeug 12 angibt, von der CCD-Kamera 68 in die elektronische Steuereinheit 40 eingegeben. Eine Linksseiten-CCD-Kamera 70 und eine Rechtsseiten-CCD-Kamera 72, die Seitenbilder auf den linken und rechten Seiten des Fahrzeugs 12 aufnehmen, sind jeweils an linken und rechten Seitenteilen des Fahrzeugs 12 angeordnet, und es werden Signale, die Seitenbildinformationen auf den linken und rechten Seiten des Fahrzeugs 12 angeben, von den CCD-Kameras 70 und 72 in die elektronische Steuereinheit eingegeben.
-
Die elektronische Steuereinheit 40 empfängt außerdem ein Signal, das eine Fahrzeuggeschwindigkeit V angibt, die von dem Fahrzeuggeschwindigkeitssensor 74 erfasst wird, ein Signal, das eine Seitenbeschleunigung (Querbeschleunigung) Gy angibt, die von einem Seitenbeschleunigungssensor (Querbeschleunigungssensor) 76 erfasst wird, und ein Signal, das eine tatsächliche Gierrate γ angibt, die von einem Gierratensensor 78 erfasst wird. Die elektronische Steuereinheit 40 empfängt außerdem Signale, die einen Hauptzylinderdruck Pm, der von einem Drucksensor, der in 1 nicht gezeigt ist, erfasst wird, und Ähnliches angeben.
-
Die individuellen Abschnitte der elektronischen Steuereinheit 40 können Mikrocomputer aufweisen, und jeder Mikrocomputer kann eine CPU, einen ROM, einen RAM und einen Eingangs-/Ausgangsport aufweisen, die über einen bidirektionalen gemeinsamen Bus miteinander verbunden sind. Der Lenkwinkelsensor 62, der Lenkmomentsensor 64 und der Drehwinkelsensor 66 erfassen einen Lenkwinkel θ, ein Lenkmoment Ts und einen relativen Drehwinkel θre, wobei die erfassten Variablen einen positiven Wert aufweisen, wenn ein Lenken oder Drehen des Fahrzeugs nach links durchgeführt wird.
-
In einer normalen Situation führt der Lenksteuerabschnitt der elektronischen Steuereinheit 40 eine Fahrspursteuerung, die auch als Fahrspurhalteunterstützungssteuerung (LKA-Steuerung) bezeichnet wird, auf der Grundlage der Vorwärtsbildinformationen vor dem Fahrzeug 12, die von der Vorwärts-CCD-Kamera 68 erlangt werden, aus. Das heißt, der Lenksteuerabschnitt bestimmt eine Fahrspur auf der Grundlage der Vorwärtsbildinformationen vor dem Fahrzeug 12, die von der Vorwärts-CCD-Kamera 68 erlangt werden, berechnet einen gelenkten Sollwinkel δt der Vorderräder, damit das Fahrzeug 12 entlang der Fahrspur fährt, und steuert die Lenkwinkeländerungseinheit 30, so dass der gelenkte Winkel δ der Vorderräder mit dem gelenkten Sollwinkel δt übereinstimmt.
-
Im Gegensatz dazu führt der Lenksteuerabschnitt eine alternative Fahrspursteuerung in einer Situation aus, in der der Lenksteuerabschnitt der elektronischen Steuereinheit 40 die Fahrspursteuerung auf der Grundlage der Vorwärtsbildinformationen vor dem Fahrzeug 12, die von der Vorwärts-CCD-Kamera 68 erlangt werden, nicht richtig ausführen kann. Bei der alternativen Fahrspursteuerung bestimmt der Lenksteuerabschnitt eine Fahrspur auf der Grundlage der Seitenbildinformationen auf der jeweiligen Seite des Fahrzeugs 12, die von der Linksseiten-CCD-Kamera 70 oder der Rechtsseiten-CCD-Kamera 72 erlangt werden. Der Lenksteuerabschnitt berechnet einen Sollritzelwinkel φpt entsprechend einem gelenkten Sollwinkel δt der Vorderräder, so dass das Fahrzeug 12 entlang der Fahrspur fährt, und steuert die Lenkwinkeländerungseinheit 30 derart, dass der Winkel φ der Ritzelwelle 36 mit dem Sollritzelwinkel φpt übereinstimmt.
-
In der normalen und der alternativen Fahrspursteuerung schätzt der Lenksteuerabschnitt der elektronischen Steuereinheit 40 eine Seitendifferenz des Fahrzeugs in Bezug auf die Fahrspur, einen Gierwinkel des Fahrzeugs in Bezug auf die Fahrspur und einen Krümmungsradius der Fahrspur und berechnet den gelenkten Sollwinkel der gelenkten Räder auf der Grundlage der geschätzten Parameter.
-
2 ist eine erläuternde Darstellung aus der Sicht der Rückseite des Fahrzeugs, die die Bildaufnahme mittels der Rechtsseiten-CCD-Kamera 72 und die Art des Erlangens von Weißlinieninformationen zeigt.
-
Wie es in
2 gezeigt ist, wird eine Höhe der Rechtsseiten-CCD-Kamera
72 in Bezug auf eine Fahrspur
102 mit H angegeben, und ein horizontaler Abstand zwischen der rechten Seitenkante des Fahrzeugs
12 und einer weißen Linie
106 wird mit D angegeben. Ein Abstand zwischen einer Linse der Rechtsseiten-CCD-Kamera
72 und einer Bildaufnahmeebene
108 wird mit
Dc angegeben, und ein Abstand zwischen einer Lichtachse
110 der Rechtsseiten-CCD-Kamera
72 und einem Bild
112 der weißen Linie
106 in der Bildaufnahmeebene
108 wird mit
Hc angegeben. Die folgende Formel 1 gilt auf der Grundlage der Beziehung ähnlicher Figuren, die die Abstände enthalten.
-
Da die folgende Formel 2 aus der obigen Formel 1 hergeleitet wird, kann der horizontale Abstand
D zwischen der rechten Seitenkante des Fahrzeugs
12 und einer weißen Linie
106 entsprechend der folgenden Formel 2 berechnet werden. Selbstverständlich kann ein horizontaler Abstand zwischen der linken Seitenkante des Fahrzeugs
12 und einer weißen Linie auf ähnliche Weise berechnet werden.
-
Wie es in 3 gezeigt ist, kann, wenn die Rechtsseiten-CCD-Kamera 72 einen Sichtwinkel aufweist, der in Bezug auf den horizontalen Abstand D zwischen der rechten Seitenkante des Fahrzeugs 12 und einer weißen Linie 106 ausreichend ist, diese die weiße Linie 106 in dem Bereich jenseits der Länge des Fahrzeugs 12 aufnehmen und bestimmen. Insbesondere können horizontale Abstände Dr1 und Dr2 zwischen den rechten Seitenkanten an den vorderen und hinteren Enden des Fahrzeugs 12 und einer weißen Linie 106 berechnet werden. Horizontale Abstände Dl1 und Dl2 zwischen den linken Seitenkanten an den vorderen und hinteren Enden des Fahrzeugs 12 und einer weißen Linie 106 können auf ähnliche Weise berechnet werden.
-
Wie es in 4 gezeigt ist, wird eine weiße Linie, die auf der Grundlage der Bildinformationen, die von der Vorwärts-CCD-Kamera 68 aufgenommen werden, bestimmt wird, mit 106f bezeichnet. Sogar in einem Fall, in dem die Länge der weißen Linie 106f kürzer als diejenige ist, die benötigt wird, um einen Krümmungsradius und Ähnliches einer Fahrspur zu bestimmen, können die Informationen einer weißen Linie durch Informationen einer weißen Ergänzungslinie 106s ergänzt werden, die auf der Grundlage der Bildinformationen bestimmt wird, die von der Rechtsseiten-CCD-Kamera 72 aufgenommen werden, und es kann eine benötigte Länge der weißen Linie gewährleistet werden.
-
Im Folgenden wird mit Bezug auf das Flussdiagramm der 5 eine Hauptroutine der Fahrzeugfahrspursteuerung gemäß der ersten Ausführungsform beschrieben. Man beachte, dass die Steuerung gemäß dem Flussdiagramm der 5 gestartet wird, wenn ein nicht gezeigter Zündschalter eingeschaltet wird, und wiederholt in vorbestimmten Intervallen ausgeführt wird.
-
Zunächst wird in Schritt 100 bestimmt, ob die Fahrzeuggeschwindigkeit zu verringern ist, um die Ausführung der Fahrzeugfahrspursteuerung zu gewährleisten. Wenn das Ergebnis der Bestimmung negativ ist, schreitet die Steuerung zu Schritt 200, während, wenn das Ergebnis der Bestimmung positiv ist, die Steuerung zu Schritt 150 schreitet. Wenn das Risiko besteht, dass das Fahrzeug von einer Fahrspur abweicht oder sich die Genauigkeit der Bildaufnahme der CCD-Kamera verschlechtert, kann bestimmt werden, dass die Fahrzeuggeschwindigkeit zu verringern ist, um die Ausführung der Fahrzeugfahrspursteuerung zu gewährleisten.
-
In Schritt 150 wird die Fahrzeuggeschwindigkeit V mittels Verringern eines in 1 nicht gezeigten Motorausgangs um ΔV verringert, und es wird nach Bedarf die Bremsvorrichtung betätigt. Man beachte, dass der Verringerungsbetrag ΔV der Fahrzeuggeschwindigkeit entsprechend der Fahrzeuggeschwindigkeit änderbar eingestellt wird, so dass sich der Verringerungsbetrag erhöht, wenn sich die Fahrzeuggeschwindigkeit V erhöht. Außerdem kann der Verringerungsbetrag ΔV der Fahrzeuggeschwindigkeit änderbar derart eingestellt werden, dass sich der Betrag erhöht, wenn sich das Risiko, dass das Fahrzeug von der Fahrspur abweicht, erhöht oder wenn sich der Verschlechterungsgrad der Bildaufnahmegenauigkeit der CCD-Kamera erhöht.
-
In Schritt 200 wird bestimmt, ob ein Radius Rv der Fahrspur nicht größer als ein vorbestimmter Bezugswert ist, wobei die Größe des Krümmungsradius R der Fahrspur, der im vorherigen Zyklus berechnet wurde, als Radius Rv der Fahrspur ausgedrückt wird. Wenn das Ergebnis der Bestimmung positiv ist, wird in Schritt 300 eine Sollseitenbeschleunigung (Sollquerbeschleunigung) Gyt des Fahrzeugs auf der Grundlage der aufgenommenen Seitenbildinformationen entsprechend dem Flussdiagramm, das in 6 gezeigt ist, berechnet, während, wenn das Ergebnis der Bestimmung negativ ist, die Steuerung zu Schritt 350 schreitet. Wenn das Fahrzeug mit einem Navigationssystem ausgerüstet ist, kann der Drehradius Rv selbstverständlich aus Fahrspurinformationen von dem Navigationssystem hergeleitet werden.
-
In Schritt 350 wird bestimmt, ob eine alternative Fahrspursteuerung benötigt wird, bei der eine Sollseitenbeschleunigung Gyt des Fahrzeugs auf der Grundlage der aufgenommenen Seitenbildinformationen berechnet wird. Wenn das Ergebnis der Bestimmung negativ ist, wird in Schritt 400 eine Sollseitenbeschleunigung Gyt des Fahrzeugs auf der Grundlage der aufgenommenen Vorwärtsbildinformationen entsprechend dem Flussdiagramm, das in 7 gezeigt ist, berechnet, während, wenn das Ergebnis der Bestimmung positiv ist, die Steuerung zu Schritt 500 schreitet.
-
In Schritt 500 wird auf der Grundlage der aufgenommenen Vorwärtsbildinformationen bestimmt, ob eine weiße Linie der Fahrspur mit einer Länge bestimmt werden kann, die nicht kleiner als eine vorbestimmte minimale Bezugslänge ist. Wenn das Ergebnis der Bestimmung negativ ist, wird in Schritt 550 eine Sollseitenbeschleunigung Gyt des Fahrzeugs auf 0 eingestellt, während, wenn das Ergebnis der Bestimmung positiv ist, die Steuerung zu Schritt 600 schreitet. Selbstverständlich kann eine Modifikation derart durchgeführt werden, dass auf der Grundlage der aufgenommenen Seitenbildinformationen bestimmt wird, ob eine weiße Linie der Fahrspur mit einer Länge bestimmt werden kann, die nicht kleiner als eine vorbestimmte minimale Bezugslänge ist, und wenn das Ergebnis der Bestimmung negativ ist, kann die Steuerung zu Schritt 550 schreiten.
-
In Schritt 600 wird eine Sollseitenbeschleunigung Gyt des Fahrzeugs auf der Grundlage der aufgenommenen Vorwärts- und Seitenbildinformationen entsprechend dem Flussdiagramm, das in 8 gezeigt ist, berechnet.
-
Nach der Beendigung der Schritte 300, 400, 550 oder 600 schreitet die Steuerung zu Schritt 900. In Schritt 900 wird ein gelenkter Sollwinkel δt der Vorderräder entsprechend dem Flussdiagramm, das in 9 gezeigt ist, berechnet, und es wird der gelenkte Winkel der Vorderräder entsprechend dem gelenkten Sollwinkel δt gesteuert.
-
Im Folgenden wird mit Bezug auf das Flussdiagramm der 6 eine Routine zum Berechnen der Sollseitenbeschleunigung Gyt auf der Grundlage der aufgenommenen Seitenbildinformationen erläutert, die in dem obigen Schritt 300 durchgeführt wird.
-
In Schritt 310 werden weiße Linien der Fahrspur auf der Grundlage der aufgenommenen Vorwärts- und Seitenbildinformationen bestimmt, und es werden Krümmungsradien Rsl und Rsr der linken und rechten weißen Linien auf der Grundlage der bestimmten weißen Linien berechnet. Außerdem wird der Krümmungsradius Rs der Fahrspur als ein Mittelwert der Krümmungsradien Rsl und Rsr berechnet. Man beachte, dass der Krümmungsradius Rs der Fahrspur auf der Grundlage nur des Krümmungsradius Rsl oder Rsr berechnet werden kann.
-
In Schritt 315 werden Abstände Dr1 und Dr2 zwischen Seitenkanten an den vorderen und hinteren Enden des Fahrzeugs 12 und einer weißen Linie 80R auf der rechten Seite berechnet, wobei vordere und hintere Bezugspositionen des Fahrzeugs auf vordere und hintere Enden des Fahrzeugs eingestellt werden, wie es in 19 gezeigt ist.
-
In Schritt
320 wird der Gierwinkel φs des Fahrzeugs in Bezug auf die Fahrspur auf der Grundlage der Abstände
Dr1 und
Dr2 auf der rechten Seite entsprechend der folgenden Formel 3 berechnet, wobei ein Abstand zwischen den vorderen und hinteren Enden des Fahrzeugs mit
L angegeben wird.
-
Der Gierwinkel φs des Fahrzeugs kann auf der Grundlage der Abstände
Dl1 und
Dl2 auf der linken Seite entsprechend der folgenden Formel 4 berechnet werden, und es kann ein einfacher Mittelwert oder ein gewichteter Mittelwert der Werte, die entsprechend den Formeln 3 und 4 berechnet werden, verwendet werden.
-
In Schritt
325 wird eine Sollseitendifferenz (Sollquerdifferenz) Dst in Bezug auf die Mitte der Fahrspur auf der Grundlage der Abstände
Dr1,
Dl1 auf der rechten Seite und des Gierwinkels φs des Fahrzeugs entsprechend der folgenden Formel 5 berechnet, wobei die Breite des Fahrzeugs mit
W angegeben wird. Nach dem Schritt
325 schreitet die Steuerung zu Schritt
360. Die Sollseitendifferenz
Dst ist ein Sollabstand zwischen der rechten Seitenkante des Fahrzeugs und der rechten Seitenkante der Fahrspur (rechtsseitige weiße Linie) oder zwischen der linken Seitenkante des Fahrzeugs und der linken Seitenkante des Fahrspur (linksseitige weiße Linie), der benötigt wird, damit die Mitte des Fahrzeugs entlang der Mitte der Fahrspur verläuft.
-
In Schritt 360 wird ein Sollgierwinkel φst des Fahrzeugs zu einem sehr kleinen Wert berechnet, der dasselbe Vorzeichen wie der Krümmungsradius Rs der Fahrspur, der in Schritt 310 berechnet wurde, aufweist, und dessen Größe wird erhöht, wenn sich die Größe des Radius Rs erhöht.
-
In Schritt
365 wird eine tatsächliche rechte Seitendifferenz Ds des Fahrzeugs in Bezug auf die Mitte der Fahrspur auf der Grundlage der rechten Seitendifferenzen
Dr1 und
Dr2 als berechnet, und eine Sollseitenbeschleunigung Gyts des Fahrzeugs wird auf der Grundlage der aufgenommenen Seitenbildinformationen entsprechend der folgenden Formel 6 berechnet, in der
Ksr,
Ksy und
Ksh vorbestimmte positive Koeffizienten sind.
-
In Schritt 370 wird bestimmt, ob ein Korrekturkoeffizient Ks gleich 1 ist, das heißt, ob der Berechnungsmodus von dem Modus, in dem die Sollseitenbeschleunigung Gytf des Fahrzeugs auf der Grundlage der aufgenommenen Vorwärtsbildinformationen berechnet wird, in den Modus, in dem die Sollseitenbeschleunigung Gyts des Fahrzeugs auf der Grundlage der aufgenommenen Seitenbildinformationen berechnet wird, gewechselt hat. Wenn das Ergebnis der Bestimmung positiv ist, wird in Schritt 375 die Sollseitenbeschleunigung Gyt des Fahrzeugs auf der Grundlage der aufgenommenen Seitenbildinformationen auf die Sollseitenbeschleunigung Gyts des Fahrzeugs eingestellt, während, wenn das Ergebnis der Bestimmung negativ ist, die Steuerung zu Schritt 380 schreitet.
-
In Schritt 380 wird die Sollseitenbeschleunigung Gytf des Fahrzeugs auf der Grundlage der aufgenommenen Vorwärtsbildinformationen berechnet. Wie in den Schritten 310-365 werden ein Krümmungsradius der Fahrspur, eine Seitendifferenz des Fahrzeugs, ein Gierwinkel des Fahrzeugs, eine Sollseitendifferenz des Fahrzeugs und ein Sollgierwinkel des Fahrzeugs berechnet, und es wird die Sollseitenbeschleunigung Gytf auf der Grundlage dieser Werte berechnet. Die Sollseitenbeschleunigung Gytf kann auf eine andere Weise berechnet werden.
-
In Schritt 385 werden Korrekturkoeffizienten Kf und Ks anhand des Kennlinienfelds, das in 15 gezeigt ist, auf der Grundlage der Zeit tfs, die seit dem Zeitpunkt verstrichen ist, zu dem das Ergebnis der Bestimmung in Schritt 200 von negativ nach positiv gewechselt hat, berechnet. Wie es in 15 gezeigt ist, verringert sich der Korrekturkoeffizient Kf von 1 auf 0, wenn die verstrichene Zeit tfs länger wird, wohingegen sich der Korrekturkoeffizient Ks von 0 auf 1 erhöht, wenn die verstrichene Zeit tfs länger wird. Die Summe der Korrekturkoeffizienten Kf und Ks ist unabhängig von der verstrichenen Zeit tfs gleich 1.
-
In Schritt
390 wird die Sollseitenbeschleunigung Gyt des Fahrzeugs entsprechend der folgenden Formel 7 berechnet.
-
Im Folgenden wird mit Bezug auf das Flussdiagramm der 7 eine Routine zum Berechnen der Sollseitenbeschleunigung Gyt auf der Grundlage der aufgenommenen Vorwärtsbildinformationen erläutert, die in dem obigen Schritt 400 durchgeführt wird.
-
In Schritt 410 wird wie in Schritt 380 die Sollseitenbeschleunigung Gytf des Fahrzeugs auf der Grundlage der aufgenommenen Vorwärtsbildinformationen berechnet.
-
In Schritt 415 wird bestimmt, ob der Korrekturkoeffizient Kf gleich 1 ist, das heißt, ob der Berechnungsmodus von dem Modus, in dem die Sollseitenbeschleunigung Gyts des Fahrzeugs auf der Grundlage der aufgenommenen Seitenbildinformationen berechnet wird, in den Modus, in dem die Sollseitenbeschleunigung Gytf des Fahrzeugs auf der Grundlage der aufgenommenen Vorwärtsbildinformationen berechnet wird, gewechselt hat. Wenn das Ergebnis der Bestimmung positiv ist, wird in Schritt 420 die Sollseitenbeschleunigung Gyt des Fahrzeugs auf der Grundlage der aufgenommenen Vorwärtsbildinformationen auf die Sollseitenbeschleunigung Gytf des Fahrzeugs eingestellt, während, wenn das Ergebnis der Bestimmung negativ ist, die Steuerung zu Schritt 425 schreitet.
-
In Schritt 425 wird wie in den Schritten 310-365 die Sollseitenbeschleunigung Gyts des Fahrzeugs auf der Grundlage der aufgenommenen Seitenbildinformationen berechnet.
-
In Schritt 430d werden die Korrekturkoeffizienten Kf und Ks anhand des Kennlinienfelds, das in 16 gezeigt ist, auf der Grundlage der Zeit tsf, die seit dem Zeitpunkt verstrichen ist, seit dem das Ergebnis der Bestimmung in Schritt 200 von positiv nach negativ gewechselt hat, berechnet. Wie es in 16 gezeigt ist, erhöht sich der Korrekturkoeffizient Kf von 0 auf 1, wenn die verstrichene Zeit tsf länger wird, wohingegen sich der Korrekturkoeffizient Ks von 1 auf 0 verringert, wenn die verstrichene Zeit tsf länger wird. Die Summe der Korrekturkoeffizienten Kf und Ks ist unabhängig von der verstrichenen Zeit tsf gleich 1.
-
In Schritt 435 wird wie in Schritt 390 die Sollseitenbeschleunigung Gyt des Fahrzeugs entsprechend der Formel 7 berechnet.
-
Im Folgenden wird mit Bezug auf das Flussdiagramm der 8 eine Routine zum Berechnen der Sollseitenbeschleunigung Gyt auf der Grundlage der aufgenommenen Vorwärts- und Seitenbildinformationen beschrieben, die in dem obigen Schritt 600 durchgeführt wird.
-
In Schritt 610 wird bestimmt, ob eine Länge Lfl der linksseitigen weißen Linie, die auf der Grundlage der aufgenommenen Vorwärtsbildinformationen bestimmt wird, kleiner als eine Länge Lmin ist, die eine minimale Länge ist, die benötigt wird, um die Fahrspursteuerung des Fahrzeugs auszuführen. Wenn das Ergebnis der Bestimmung negativ ist, wird in Schritt 615 eine Ergänzungslänge Lsl auf 0 eingestellt, die eine Länge ist, durch die die linksseitige weiße Linie zu ergänzen ist und die auf der Grundlage der aufgenommenen Seitenbildinformationen bestimmt wird, während, wenn das Ergebnis der Bestimmung positiv ist, in Schritt 620 die Ergänzungslänge Lsl auf Lmin-Lfl eingestellt wird.
-
In Schritt 625 wird bestimmt, ob die Ergänzungslänge Lsl kleiner als Lsla ist, wobei Lsla eine Länge der linksseitigen weißen Linie, die auf der Grundlage der aufgenommenen Seitenbildinformationen bestimmt wird, darstellt. Wenn das Ergebnis der Bestimmung positiv ist, schreitet die Steuerung zu Schritt 640, während, wenn das Ergebnis der Bestimmung negativ ist, in Schritt 630 die Ergänzungslänge Ls1 auf Lsla eingestellt wird.
-
Auf ähnliche Weise wird in Schritt 640 bestimmt, ob eine Länge Lfr der rechtsseitigen weißen Linie, die auf der Grundlage der aufgenommenen Vorwärtsbildinformationen bestimmt wird, kleiner als die minimale Länge Lmin ist. Wenn das Ergebnis der Bestimmung negativ ist, wird in Schritt 645 eine Ergänzungslänge Lsr auf 0 eingestellt, die eine Länge ist, durch die die rechtsseitige weiße Linie zu ergänzen ist und die auf der Grundlage der aufgenommenen Seitenbildinformationen bestimmt wird, während, wenn das Ergebnis der Bestimmung positiv ist, in Schritt 650 die Ergänzungslänge Lsr auf Lmin - Lfr eingestellt wird.
-
In Schritt 655 wird bestimmt, ob die Ergänzungslänge Lsr kleiner als Lsra ist, wobei Lsra die Länge der rechtsseitigen weißen Linie, die auf der Grundlage der aufgenommenen Seitenbildinformationen bestimmt wird, darstellt. Wenn das Ergebnis der Bestimmung positiv ist, schreitet die Steuerung zu Schritt 665, während, wenn das Ergebnis der Bestimmung negativ ist, in Schritt 660 die Ergänzungslänge Lsr auf Lsra eingestellt wird.
-
In Schritt 665 werden linksseitige und rechtsseitige weiße Linien durch jeweilige weiße Linien mit der Ergänzungslänge Lsl und Lsr ergänzt. In Schritt 670 wird die Sollseitenbeschleunigung Gyt des Fahrzeugs auf der Grundlage der ergänzten linksseitigen und rechtsseitigen weißen Linien ähnlich wie in Schritt 410 berechnet, wobei die Sollseitenbeschleunigung Gytf berechnet wird.
-
Im Folgenden werden mit Bezug auf das Flussdiagramm der 9 Routinen zum Berechnen eines Sollritzelwinkels φpt und zum Steuern des gelenkten Winkels der Vorderräder entsprechend dem Sollritzelwinkel φpt erläutert, die in dem obigen Schritt 900 durchgeführt werden.
-
In Schritt 910 wird der gelenkte Sollwinkel θlkt der Fahrspursteuerung anhand des Kennlinienfelds, das in 17 gezeigt ist, auf der Grundlage der Seitenbeschleunigung Gyt des Fahrzeugs und der Fahrzeuggeschwindigkeit V berechnet.
-
In Schritt 920 wird ein Korrekturkoeffizient Kv auf der Grundlage der Fahrzeuggeschwindigkeit anhand der Kennlinie, die durch die durchgezogene Linie in 18 angegeben ist, auf der Grundlage der Fahrzeuggeschwindigkeit V berechnet. Man beachte, dass in 18 die gestrichelte Linie einen Korrekturkoeffizienten Kv auf der Grundlage der Fahrzeuggeschwindigkeit für einen Fall zeigt, in dem die Fahrspursteuerung nicht durchgeführt wird.
-
In Schritt
930 wird der Sollritzelwinkel φpt auf der Grundlage des gelenkten Winkels, der mit dem gelenkten Sollwinkel θklt korrigiert wird, d. h. θ - θklt, entsprechend der folgenden Formel 8 berechnet. Der Sollritzelwinkel φpt ist ein Sollwinkel des Ritzels
36 entsprechend dem gelenkten Sollwinkel δt der Vorderräder.
-
In Schritt 940 wird die Lenkwinkeländerungseinheit 30 derart gesteuert, dass der Ritzelwinkel φp mit einem endgültigen Sollritzelwinkel φpt + Δφpt übereinstimmt, und der gelenkte Winkel δ der Vorderräder wird auf einen Solllenkwinkel δt entsprechend dem Sollritzelwinkel φpt gesteuert, wobei Δφpt als ein Parameter zum Verhindern, dass die Lenkwinkeländerungseinheit 30 die Vorderräder übermäßig lenkt, wenn eine Lenkeingabe erfolgt, angenommen wird.
-
Somit kann gemäß der ersten Ausführungsform sogar in einer Situation, in der die Fahrspursteuerung auf der Grundlage der aufgenommenen Vorwärtsbildinformationen nicht richtig durchgeführt werden kann, die Steuerung auf der Grundlage der aufgenommenen Seitenbildinformationen, die von der Seiten-CCD-Kamera 70 oder 72 erhalten werden, fortgesetzt werden. Daher kann die Möglichkeit einer richtigen Ausführung der Fahrspursteuerung im Vergleich zu einem Fall erhöht werden, in dem kein Bild auf der Seite des Fahrzeugs aufgenommen wird, was es möglich macht, die Fahrspursteuerung fortzusetzen, während eine Verschlechterung der Genauigkeit so weit wie möglich verhindert wird.
-
Wenn die Fahrspursteuerung, die auf der Grundlage der aufgenommenen Vorwärtsbildinformationen richtig ausgeführt wird, in einer Situation wiederhergestellt werden kann, in der die Fahrspursteuerung auf der Grundlage der aufgenommenen Seitenbildinformationen ausgeführt wird, sind die Ergebnisse der Bestimmungen in den Schritten 200 und 350 negativ, und die Steuerung schreitet zu Schritt 400. Daher ist es möglich zu verhindern, dass die Fahrspursteuerung auf der Grundlage der aufgenommenen Seitenbildinformationen trotz der Tatsache, dass die Fahrspursteuerung auf der Grundlage der aufgenommene Vorwärtsbildinformationen richtig ausgeführt werden kann, unnötig ausgeführt wird.
-
Eine Länge einer Fahrspur vor dem Fahrzeug, die bei der Fahrspursteuerung auf der Grundlage der aufgenommenen Seitenbildinformationen bestimmt werden kann, ist kürzer als diejenige, die bei der Fahrspursteuerung auf der Grundlage der aufgenommenen Vorwärtsbildinformationen bestimmt werden kann. Die Möglichkeit, dass das Fahrzeug entlang einer Fahrspur fehlerfrei fährt, kann jedoch im Vergleich zu einem Fall erhöht werden, in dem die Fahrspursteuerung auf der Grundlage der aufgenommenen Vorwärtsbildinformationen beendet wird.
-
Gemäß der ersten Ausführungsform ist es möglich, eine schnelle Änderung der Sollseitenbeschleunigung Gyt des Fahrzeugs mittels der Korrekturkoeffizienten Kf und Ks zu verhindern, wenn ein Wechsel zwischen dem Steuermodus, in dem die Sollseitenbeschleunigung Gyt des Fahrzeugs auf der Grundlage der aufgenommenen Vorwärtsbildinformationen berechnet wird, und dem Steuermodus, in dem die Sollseitenbeschleunigung auf der Grundlage der aufgenommene Seitenbildinformationen berechnet wird, durchgeführt wird. Dementsprechend ist es ebenfalls möglich zu verhindern, dass sich die Fahrzeugfahrbedingung aufgrund einer schnellen Änderung der Sollseitenbeschleunigung Gyt, die mit der Änderung des Steuermodus einhergeht, abrupt ändert. Man beachte, dass diese Wirkung ebenso in den weiteren später beschriebenen Ausführungsformen erzielt werden kann.
-
Insbesondere wenn gemäß der ersten Ausführungsform das Ergebnis der Bestimmung in Schritt 350 positiv ist, wird die Bestimmung in Schritt 500 durchgeführt. Wenn auf der Grundlage der aufgenommenen Vorwärtsbildinformationen bestimmt wird, dass eine weiße Linie vor dem Fahrzeug mit einer Länge bestimmt werden kann, die nicht kleiner als die vorbestimmte minimale Bezugslänge ist, wird der Schritt 600 durchgeführt.
-
20 zeigt eine Situation, bei der ein Hindernis 110 wie beispielsweise Nebel oder Ähnliches vor dem Fahrzeug vorhanden ist und die Aufnahme mittels der Vorwärts-CCD-Kamera 68 beeinträchtigt und nur Teile der linken und rechten weißen Linien 106l und 106r von der Vorwärts-CCD-Kamera 68 aufgenommen werden können. In 20 bezeichnen 106fl und 106fr weiße Linien, die von der Vorwärts-CCD-Kamera 68 aufgenommen werden können, und 106sl und 106sr bezeichnen weiße Linien, die von den Seiten-CCD-Kameras 70 und 72 aufgenommen werden können.
-
Die linksseitigen und rechtsseitigen weißen Linien werden durch weiße Linien, die jeweils eine benötigte Länge von Lsl und Lsr aufweisen, mittels der Steuerung in Schritt 600 ergänzt. Das heißt, die linksseitigen und rechtsseitigen weißen Linien werden durch weiße Linien 106sls und 106srs, die die jeweiligen benötigten Längen Lsl und Lsr aufweisen, ergänzt, die in der Figur nicht gezeigt sind und Teile der weißen Linien 106l und 106r sind. Daher kann sogar in einer Situation, in der ein Hindernis 110 vorhanden ist, das die Aufnahme mittels der Vorwärts-CCD-Kamera 68 beeinträchtigt, die Fahrspursteuerung fortgesetzt werden, ohne dass sie beendet wird. Man beachte, dass diese Wirkung ebenfalls in den später beschriebenen zweiten bis vierten Ausführungsformen erzielt werden kann.
-
In einer Situation, in der ein Hindernis 110 vorhanden ist, das die Aufnahme mittels der Vorwärts-CCD-Kamera 68 verhindert, und die alternative Fahrspursteuerung benötigt wird, wird, wenn das Ergebnis der Bestimmung in Schritt 500 negativ ist, die Fahrspursteuerung beendet, ohne Schritt 600 durchzuführen. Wenn dementsprechend eine Länge der weißen Linie, die auf der Grundlage der aufgenommenen Vorwärtsbildinformationen bestimmt wird, kleiner als die benötigte Länge Lmin ist, wird die Fahrspursteuerung beendet. Daher kann verhindert werden, dass die Fahrspursteuerung in einer Situation fortgesetzt wird, in der die Ergänzung von weißen Linien durch die aufgenommenen Informationen, die von den Seiten-CCD-Kameras 70 und 72 erhalten werden, keine geeignete Fortsetzung der Fahrspursteuerung ermöglichen kann. Man beachte, dass diese Wirkung ebenso in den zweiten bis vierten Ausführungsformen, die später beschrieben werden, erzielt werden kann.
-
Gemäß der ersten Ausführungsform werden in Schritt 300 in Bezug auf die Fahrspur, die auf der Grundlage der aufgenommenen Seitenbildinformationen bestimmt wird, ein Krümmungsradius Rs der Fahrspur, eine Seitendifferenz Ds des Fahrzeugs, ein Gierwinkel φs des Fahrzeugs, eine Sollseitendifferenz Dst des Fahrzeugs und ein Sollgierwinkel φst des Fahrzeugs berechnet, und es wird die Sollseitenbeschleunigung Gyt auf der Grundlage dieser Werte berechnet. Daher ist es möglich, das Fahrzeug noch geeigneter entlang einer Fahrspur fahren zu lassen, während die Lage des Fahrzeugs beispielsweise im Vergleich zu einem Fall geeignet aufrechterhalten wird, in dem ein Krümmungsradius Rs der Fahrspur nicht berücksichtigt wird oder die Sollseitenbeschleunigung Gyt auf der Grundlage der Seitendifferenz Ds des Fahrzeugs und der Sollseitendifferenz Dst des Fahrzeugs berechnet wird. Man beachte, dass diese Wirkung ebenso gemäß der später beschriebenen zweiten Ausführungsform erzielt werden kann.
-
Zweite Ausführungsform
-
10 ist ein Flussdiagramm, das eine Routine zum Berechnen einer Sollseitenbeschleunigung Gyt auf der Grundlage von aufgenommenen Seitenbildinformationen gemäß der zweiten Ausführungsform der Fahrzeugfahrspursteuervorrichtung gemäß der vorliegenden Erfindung zeigt. In 10 werden dieselben Schritte wie in 6 mit denselben Nummern bezeichnet. Dasselbe gilt für die folgenden Ausführungsformen.
-
Bei der zweiten Ausführungsform werden, während die Schritte 330 bis 345 anders als in der oben beschriebenen ersten Ausführungsform durchgeführt werden, die Schritte 360 bis 390 auf dieselbe Weise wie in der oben beschriebenen ersten Ausführungsform durchgeführt.
-
Insbesondere werden in Schritt 330, wie es in 21 gezeigt ist, in Bezug auf den derzeitigen Zeitpunkt t = t ein Abstand Dr(t) zwischen der rechten Kante an dem vorderen Ende des Fahrzeugs und der rechten Kante einer Fahrspur und ein Abstand Dl(t) zwischen der linken Kante an dem vorderen Ende des Fahrzeugs und der linken Kante der Fahrspur in seitlicher Richtung des Fahrzeugs berechnet.
-
In Schritt 335 werden in Bezug auf anschließende drei Zeitpunkte t = 0, t - n, t (n ist konstant), die aufeinander folgen, wie es in 21 gezeigt ist, Koordinaten eines Punkts P in rechteckigen Koordinaten berechnet. Die rechteckigen Koordinaten werden derart festgelegt, dass eine vordere Bezugsposition des Fahrzeugs der Ursprung ist, die seitliche Richtung des Fahrzeugs auf die X-Achse festgelegt wird und die Vorwärtsrichtung des Fahrzeugs auf die Y-Achse festgelegt wird, wenn das Fahrzeug die Fahrt startet oder der Fahrzustand des Fahrzeugs von einer Geradeausfahrt in eine Kurvenfahrt übergeht.
-
Wenn beispielsweise ein Schlupfwinkel des Fahrzeugs mit
β bezeichnet wird und Koordinaten der vorderen Bezugsposition des Fahrzeugs (in der Mitte in der Breitenrichtung des Fahrzeugs angeordnet) zu einem Zeitpunkt des Starts der Berechnungen mit (
X0,
Y0) bezeichnet werden, werden die Koordinaten (
Xt,
Yt) der vorderen Bezugsposition des Fahrzeugs zu jeder Zeit entsprechend den folgenden Formeln 9 und 10 berechnet. Außerdem wird ein Neigungswinkel φint einer Längslinie
112 des Fahrzeugs
12 in den rechteckigen Koordinaten des derzeitigen Zeitpunkts t = t entsprechend der folgenden Formel 11 berechnet, wobei ein Neigungswinkel der Längslinie
112 des Fahrzeugs
12 in den rechteckigen Koordinaten zu dem Zeitpunkt des Starts der Berechnungen mit φin0 bezeichnet wird.
-
Der Schlupfwinkel β des Fahrzeugs kann beispielsweise wie folgt berechnet werden. Zunächst wird eine Seitenschlupfbeschleunigung (Querschlupfbeschleunigung) der Fahrzeugkarosserie aus der Seitenbeschleunigung Gy, der Fahrzeuggeschwindigkeit V und der Gierrate γ als Vyd = Gy - V*γ berechnet. Die Seitenschlupfbeschleunigung Vyd, die somit erhalten wird, wird integriert, um die Seitenschlupfgeschwindigkeit (Querschlupfgeschwindigkeit) Vy der Fahrzeugkarosserie zu erhalten. Dann wird der Schlupfwinkel β der Fahrzeugkarosserie als ein Verhältnis Vy/Vx der Seitenschlupfgeschwindigkeit Vy zu der Längsgeschwindigkeit Vx der Fahrzeugkarosserie (= Fahrzeuggeschwindigkeit V) berechnet.
-
Anschließend werden, wie es in 21 gezeigt ist, in Bezug auf die drei Zeitpunkte, die aufeinander folgen, Koordinaten eines Punkts P auf der rechten Kante einer Fahrspur auf der Grundlage der Koordinaten (Xt, Yt) der vorderen Bezugsposition des Fahrzeugs (in der Mitte in der Breitenrichtung des Fahrzeugs angeordnet), des Neigungswinkels φint und der Abstände Dr(0), Dr(t - n) und Dr(t) zwischen der rechten Kante an dem vorderen Ende des Fahrzeugs und dem Punkt P berechnet.
-
Außerdem werden gleichzeitige Gleichungen mittels der Werte der Koordinaten
(Xp(0), Yp(0)),
(Xp(t - n),
Yp(t - n)) und
(Xp(t), Yp(t)) des Punkts
P zu den drei Zeitpunkten in die folgende Formel 12 eingesetzt. Ein Krümmungsradius
Rs der Fahrspur wird durch Lösen der gleichzeitigen Gleichungen berechnet.
-
In Schritt 340 wird eine Tangentiallinie 114 bestimmt, die den Punkt P zu dem derzeitigen Zeitpunkt t = t passiert, der sich auf der rechtsseitigen weißen Linie 80R befindet, und es wird ein Gierwinkel φs(t) des Fahrzeugs berechnet, der ein Winkel ist, der zwischen der Längslinie 112 und der Tangentiallinie 114 ausgebildet wird, d. h. die Differenz zwischen den Neigungen der Linien in den rechteckigen Koordinaten.
-
Man beachte, dass, wenn die Gierwinkel des Fahrzeugs zu den drei Zeitpunkten t = 0, t - n, t durch
φs(0),
φs(t - n) und
φs(t) dargestellt werden, die oben genannten drei Koordinaten
(Xp(0),
Yp(0)),
(Xp(t - n),
Yp(t - n)) und
(Xp(t),
Yp(t)) des Punkts P zu den drei Zeitpunkten t = 0, t - n, t durch die folgenden Formeln 13 bis 18 ausgedrückt werden.
-
In Schritt
345 wird in Bezug auf den derzeitigen Zeitpunkt t = t ein Abstand Dl(t) zwischen der linken Kante an dem vorderen Ende des Fahrzeugs und der linken Kante der Fahrspur in seitlicher Richtung (Querrichtung) des Fahrzeugs berechnet. Eine Sollseitendifferenz (Sollquerdifferenz)
Dst in Bezug auf die Mitte der Fahrspur wird auf der Grundlage des Gierwinkels φs(t) des Fahrzeugs und der linken und rechten Seitenabstände (Querabstände)
Dl(t) und
Dr(t) entsprechend der folgenden Formel 19 berechnet.
-
Somit kann gemäß der zweiten Ausführungsform sogar in einer Situation, in der die Fahrspursteuerung auf der Grundlage der aufgenommenen Vorwärtsbildinformationen nicht richtig ausgeführt werden kann, die Steuerung auf der Grundlage der aufgenommenen Seitenbildinformationen, die von der Seiten-CCD-Kamera 70 oder 72 erhalten werden, fortgesetzt werden.
-
Insbesondere können gemäß der zweiten Ausführungsform die Seitenabstände Dl(t) und Dr(t) Seitenabstände an nur einer vorderen Bezugsposition des Fahrzeugs sein, und dementsprechend besteht keine Notwendigkeit, Seitenabstände an den vorderen und hinteren Bezugspositionen des Fahrzeugs zu erhalten.
-
In der oben beschriebenen zweiten Ausführungsform werden gleichzeitige Gleichungen mittels der Werte der Koordinaten (Xp(0), Yp(0)), (Xp(t - n), Yp(t - n)) und (Xp(t), Yp(t)) des Punkts P zu den drei Zeitpunkten, die in die Formel 12 eingesetzt werden, festgelegt, und es wird ein Krümmungsradius Rs der Fahrspur durch Lösen der gleichzeitigen Gleichungen berechnet. Es kann jedoch ein Krümmungsradius Rs der Fahrspur auf der Grundlage von drei Koordinaten eines Punkts Q, der sich auf der linksseitigen weißen Linie 80L befindet, berechnet werden. Alternativ kann ein Krümmungsradius Rs der Fahrspur als ein einfacher Mittelwert oder ein gewichteter Mittelwert des Krümmungsradius Rsr der Fahrspur auf der Grundlage der obigen drei Koordinaten des Punkts P und eines Krümmungsradius Rsl der Fahrspur auf der Grundlage der drei Koordinaten des Punkts Q berechnet werden.
-
In der obigen zweiten Ausführungsform wird eine Tangentiallinie 114 bestimmt, die den Punkt P passiert, der sich auf der rechtsseitigen weißen Linie 80R befindet, und es wird ein Gierwinkel φs(t) des Fahrzeugs berechnet, der ein Winkel ist, der zwischen der Längslinie 112 und der Tangentiallinie 114 ausgebildet wird. Es kann jedoch eine Tangentiallinie 116 bestimmt werden, die den Punkt Q passiert, der sich auf der linksseitigen weißen Linie 80L befindet, und es kann ein Gierwinkel φs(t) des Fahrzeugs berechnet werden, der ein Winkel ist, der zwischen der Längslinie 112 und der Tangentiallinie 116 ausgebildet wird. Es kann ein Gierwinkel φs(t) des Fahrzeugs als ein einfacher Mittelwert oder ein gewichteter Mittelwert des Gierwinkels φs(t)r des Fahrzeugs auf der Grundlage der Tangentiallinie 114 und des Gierwinkels φs(t)1 des Fahrzeugs auf der Grundlage der Tangentiallinie 116 berechnet werden.
-
Dritte Ausführungsform
-
11 ist ein Flussdiagramm, das eine Routine zum Berechnen einer Sollseitenbeschleunigung Gyt auf der Grundlage von aufgenommenen Seitenbildinformationen gemäß der dritten Ausführungsform der Fahrzeugfahrspursteuervorrichtung gemäß der vorliegenden Erfindung zeigt. In 11 werden dieselben Schritte wie in 10 mit denselben Nummern bezeichnet.
-
In der dritten Ausführungsform werden die Schritte 330 und 340 auf dieselbe Weise wie in der obigen zweiten Ausführungsform durchgeführt, und die Schritte 350 und 365a werden anstelle der Schritte 345 und 365 durchgeführt. Die Schritte 370 bis 390 werden auf dieselbe Weise wie in der obigen ersten Ausführungsform durchgeführt.
-
In Schritt 350 wird, wie es in 22 gezeigt ist, in Bezug auf den derzeitigen Zeitpunkt t = t ein Abstand Dl(t) zwischen der linken Kante an dem vorderen Ende des Fahrzeugs und der linken Kante der Fahrspur in seitlicher Richtung des Fahrzeugs berechnet. Es werden Sollseitendifferenzen Drst und Dlst in Bezug auf die Mitte der Fahrspur auf der Grundlage des Gierwinkels cps(t) des Fahrzeugs und der linken und rechten Seitenabstände Dl(t) und Dr(t) entsprechend denselben Formeln wie die Formel 19 berechnet.
-
In Schritt 365a wird eine tatsächliche Sollseitendifferenz
Ds in Bezug auf die Mitte der Fahrspur auf der Grundlage der linken und rechten Seitenabstände
Dl(t) und
Dr(t) berechnet und eine Sollseitenbeschleunigung Gyts des Fahrzeugs wird auf der Grundlage der aufgenommenen Seitenbildinformationen entsprechend der folgenden Formel 20 berechnet.
-
Somit kann gemäß der dritten Ausführungsform sogar in einer Situation, in der die Fahrspursteuerung auf der Grundlage der aufgenommenen Vorwärtsbildinformationen nicht richtig ausgeführt werden kann, die Steuerung auf der Grundlage der aufgenommenen Seitenbildinformationen fortgesetzt werden, ohne den Krümmungsradius Rs der Fahrspur zu berechnen.
-
In der obigen dritten Ausführungsform wird eine Sollseitenbeschleunigung Gyts des Fahrzeugs ohne Berücksichtigung eines Gierwinkels des Fahrzeugs berechnet. Es kann jedoch wie in der im Folgenden beschriebenen vierten Ausführungsform eine Sollseitenbeschleunigung Gyts des Fahrzeugs entsprechend der unten angegebenen Formel 24 berechnet werden.
-
Vierte Ausführungsform
-
12 ist ein Flussdiagramm, das eine Routine zum Berechnen einer Sollseitenbeschleunigung Gyt auf der Grundlage von aufgenommenen Seitenbildinformationen gemäß der vierten Ausführungsform der Fahrzeugfahrspursteuervorrichtung gemäß der vorliegenden Erfindung zeigt.
-
Gemäß der vierten Ausführungsform wird der Schritt 310 nicht durchgeführt, und die Schritte 355 und 365b werden anstelle der Schritte 325 und 365 durchgeführt. Die Schritte 360 und 370 bis 390 werden auf dieselbe Weise wie in der obigen ersten Ausführungsform durchgeführt.
-
In Schritt
355 wird in einer Situation, in der die Linksseiten-CCD-Kamera
70 und die Rechtsseiten-CCD-Kamera
72 verwendet werden, eine Sollseitendifferenz Dst in Bezug auf die Mitte der Fahrspur entsprechend derselben Formel wie die Formel 19 der zweiten Ausführungsform berechnet. In einer Situation, in der nur die Rechtsseiten-CCD-Kamera
72 verwendet wird, wird eine Sollseitendifferenz
Dst entsprechend der folgenden Formel 22 berechnet, in der
ΔXr durch die folgende Formel 21 angegeben wird. In der Formel 22 ist
Xr eine Breite der Fahrspur, die aus dem Vorwärtsbild, das von der Vorwärts-CCD-Kamera
68 erlangt wird, geschätzt werden kann.
-
In Schritt
365b wird eine Sollseitenbeschleunigung Gyts des Fahrzeugs auf der Grundlage der aufgenommenen Seitenbildinformationen entsprechend der folgenden Formel 23 berechnet.
-
Somit kann gemäß der vierten Ausführungsform wie in der dritten Ausführungsform sogar in einer Situation, in der die Fahrspursteuerung auf der Grundlage der aufgenommenen Vorwärtsbildinformationen nicht richtig ausgeführt werden kann, die Steuerung auf der Grundlage der aufgenommenen Seitenbildinformationen fortgesetzt werden, ohne den Krümmungsradius Rs der Fahrspur zu berechnen.
-
Insbesondere kann gemäß der oben beschriebenen vierten Ausführungsform die Fahrspursteuerung sogar in einer Situation, in der die Linksseiten-CCD-Kamera 70 oder die Rechtsseiten-CCD-Kamera 72 nicht in der Lage ist, ein Bild aufzunehmen, fortgesetzt werden, da aufgenommene Seitenbildinformationen Links- oder Rechtsseitenbildinformationen sein können.
-
Fünfte Ausführungsform
-
13 ist ein Flussdiagramm, das eine Routine zum Berechnen einer Sollseitenbeschleunigung Gyt auf der Grundlage von aufgenommenen Seitenbildinformationen gemäß der fünften Ausführungsform der Fahrzeugfahrspursteuervorrichtung gemäß der vorliegenden Erfindung zeigt.
-
In der fünften Ausführungsform werden die Schritte 100 bis 550 auf dieselbe Weise wie in der oben beschriebenen ersten Ausführungsform durchgeführt, und wenn das Ergebnis der Bestimmung in Schritt 500 positiv ist, schreitet die Steuerung zu Schritt 700.
-
In Schritt 700 wird eine Sollseitenbeschleunigung Gytf des Fahrzeugs auf der Grundlage der aufgenommenen Vorwärtsbildinformationen wie in Schritt 380 des Flussdiagramms der 6 und in Schritt 410 des Flussdiagramms der 7 berechnet.
-
In Schritt 750 wird eine Sollseitenbeschleunigung Gyts des Fahrzeugs auf der Grundlage der aufgenommenen Seitenbildinformationen entsprechend dem Flussdiagramm der 14 berechnet. Man beachte, dass die Schritte 310 bis 365 in dem Flussdiagramm der 14 dieselben wie die Schritte 310 bis 365 in dem Flussdiagramm der 6 der ersten Ausführungsform sind.
-
In Schritt 800 wird ein Vorwärtsbeobachtungsabstand Lv des Fahrers auf der Grundlage der Fahrzeuggeschwindigkeit V, des Krümmungsradius Rs der Fahrspur und einer Neigung der Fahrspur geschätzt, und es wird eine Länge Lfd der weißen Linie vor dem Fahrzeug, die die Vorwärts-CCD-Kamera erkennen kann, bestimmt. Es wird ein Korrekturkoeffizient Kd als ein Wert berechnet, der größer als 0 und kleiner als 1 ist, so dass sich der Koeffizient erhöht, wenn die Länge Lfd in Bezug auf den Vorwärtsbeobachtungsabstand Lv kürzer wird, und sich verringert, wenn die Länge Lfd in Bezug auf den Vorwärtsbeobachtungsabstand Lv länger wird.
-
In Schritt
850 wird eine Sollseitenbeschleunigung Gyt des Fahrzeugs als eine lineare Summe der Sollseitenbeschleunigungen Gytf und Gyts auf der Grundlage des Korrekturkoeffizienten Kd entsprechend der folgenden Formel 24 berechnet.
-
Somit kann gemäß der fünften Ausführungsform sogar in einer Situation, in der die Fahrspursteuerung auf der Grundlage der aufgenommenen Vorwärtsbildinformationen nicht richtig ausgeführt werden kann, die Steuerung fortgesetzt werden, solange sie auf der Grundlage der aufgenommenen Vorwärts- und Seitenbildinformationen ausgeführt werden kann.
-
Insbesondere wird gemäß der oben beschriebenen fünften Ausführungsform in Schritt 800 der Korrekturkoeffizient Kd berechnet, und es wird die Sollseitenbeschleunigung Gyt des Fahrzeugs als eine lineare Summe der Sollseitenbeschleunigungen Gytf und Gyts auf der Grundlage des Korrekturkoeffizienten Kd entsprechend der Formel 24 berechnet. Der Korrekturkoeffizient Kd wird änderbar berechnet, so dass er sich erhöht, wenn die Länge Lfd in Bezug auf den Vorwärtsbeobachtungsabstand Lv kürzer wird, und sich verringert, wenn die Länge Lfd in Bezug auf den Vorwärtsbeobachtungsabstand Lv länger wird.
-
Dementsprechend kann die Fahrspursteuerung durch Erhöhen eines Beitrags der aufgenommenen Vorwärtsbildinformationen in einer Situation, in der die Länge Lfd in Bezug auf den Vorwärtsbeobachtungsabstand Lv länger ist, und durch Erhöhen eines Beitrags der aufgenommenen Seitenbildinformationen in einer Situation, in der die Länge Lfd in Bezug auf den Vorwärtsbeobachtungsabstand Lv kürzer ist, fortgesetzt werden. Daher kann im Vergleich zu einem Fall, in dem der Korrekturkoeffizient Kd nicht änderbar eingestellt wird, die Fahrspursteuerung entsprechend der Größenkorrelation zwischen dem Vorwärtsbeobachtungsabstand Lv und der Länge Lfd geeignet fortgesetzt werden.
-
Während die vorliegende Erfindung mit Bezug auf die obigen Ausführungsformen beschrieben wurde, ist es für den Fachmann offensichtlich, dass die vorliegende Erfindung nicht darauf beschränkt ist, sondern auf verschiedene andere Formen ausgeführt sein kann, ohne von dem Bereich der Erfindung abzuweichen.
-
In den oben beschriebenen Ausführungsformen enthält die Bildaufnahmeeinrichtung beispielsweise die Vorwärts-CCD-Kamera 68, die Linksseiten-CCD-Kamera 70 und die Rechtsseiten-CCD-Kamera 72. Die Bildaufnahmeeinrichtung kann jedoch eine Bildaufnahmevorrichtung oder zwei Bildaufnahmevorrichtungen sein, die eine Aufnahmerichtung und/oder einen Aufnahmewinkel ändern können.
-
In den oben beschriebenen Ausführungsformen sind die vorderen und hinteren Bezugspositionen vordere und hintere Enden eines Fahrzeugs. Es kann jedoch mindestens eine der vorderen und hinteren Bezugspositionen eine Position sein, die zwischen vorderen und hinteren Enden eines Fahrzeugs angeordnet ist. Alternativ kann die vordere Bezugsposition auf eine Position festgelegt werden, die vor einem vorderen Ende eines Fahrzeugs angeordnet ist, oder die hintere Bezugsposition kann auf eine Position festgelegt werden, die hinter einem hinteren Ende eines Fahrzeugs angeordnet ist.
-
In den oben beschriebenen Ausführungsformen schreitet die Steuerung zu Schritt 500 und die Fahrspursteuerung wird beendet, wenn das Ergebnis der Bestimmung in Schritt 500 negativ ist. Wenn das Ergebnis der Bestimmung in Schritt 500 in einer Situation, in der das Fahrzeug bei Nacht oder bei Nebel fährt, negativ ist, kann jedoch eine Projektionsrichtung der vorderen Scheinwerfer und/oder Nebelscheinwerfer geändert werden, und die Bestimmung in Schritt 500 kann erneut durchgeführt werden.
-
Während in den oben beschriebenen ersten bis dritten Ausführungsformen der Bezug der Sollseitendifferenz des Fahrzeugs eine Mitte einer Fahrspur ist, kann dieser eine rechte oder linke Seitenkante einer Fahrspur sein. Alternativ kann der Bezug änderbar entsprechend der Kurvenrichtung einer Fahrspur eingestellt werden, so dass dieser beispielsweise auf eine Seitenkante auf einer Kurveninnenseite eingestellt wird.
-
In den oben beschriebenen ersten bis vierten Ausführungsformen können die Schritte 500 und 600 weggelassen werden.