DE102008027590A1 - Driving assistance system for vehicles - Google Patents

Driving assistance system for vehicles Download PDF

Info

Publication number
DE102008027590A1
DE102008027590A1 DE102008027590A DE102008027590A DE102008027590A1 DE 102008027590 A1 DE102008027590 A1 DE 102008027590A1 DE 102008027590 A DE102008027590 A DE 102008027590A DE 102008027590 A DE102008027590 A DE 102008027590A DE 102008027590 A1 DE102008027590 A1 DE 102008027590A1
Authority
DE
Germany
Prior art keywords
risk
vehicle
obstacle
support system
driving support
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.)
Granted
Application number
DE102008027590A
Other languages
German (de)
Other versions
DE102008027590B4 (en
Inventor
Toyokazu Ogasawara
Yuichiro Tsukasaki
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Subaru Corp
Original Assignee
Fuji Jukogyo KK
Fuji Heavy Industries Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Fuji Jukogyo KK, Fuji Heavy Industries Ltd filed Critical Fuji Jukogyo KK
Publication of DE102008027590A1 publication Critical patent/DE102008027590A1/en
Application granted granted Critical
Publication of DE102008027590B4 publication Critical patent/DE102008027590B4/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T8/00Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force
    • B60T8/17Using electrical or electronic regulation means to control braking
    • B60T8/1755Brake regulation specially adapted to control the stability of the vehicle, e.g. taking into account yaw rate or transverse acceleration in a curve
    • B60T8/17558Brake regulation specially adapted to control the stability of the vehicle, e.g. taking into account yaw rate or transverse acceleration in a curve specially adapted for collision avoidance or collision mitigation
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D15/00Steering not otherwise provided for
    • B62D15/02Steering position indicators ; Steering position determination; Steering aids
    • B62D15/025Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
    • B62D15/0265Automatic obstacle avoidance by steering
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control 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
    • G05D1/0248Control 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 in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control 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
    • G05D1/0251Control 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 extracting 3D information from a plurality of images taken from different locations, e.g. stereo vision

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Traffic Control Systems (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Regulating Braking Force (AREA)

Abstract

Eine Steuereinheit (5) gibt eine aktuelle Gesamtrisikofunktion jeweils für Markierungslinien, Absperrungen, Seitenbegrenzungen und dreidimensionale Objekte vor, die um ein Fahrzeug herum vorhanden sind, schätzt eine zeitliche Veränderung bei der Position jedes Objektes ab und berechnet ein Minimum der Gesamtrisikofunktion an der Fahrzeugposition für den jeweiligen Zeitpunkt. Eine Zielfunktion wird für den Zeitpunkt generiert, und ein Umfahrungssteuerbetrag, der die Zielfunktion zu dem Zeitpunkt minimiert, wird als Umfahrungssteuerbetrag des Fahrzeugs berechnet. Risikofunktionen, die bei Bewegung des Fahrzeugs um den Umfahrungssteuerbetrag bereitgestellt werden, werden für die jeweiligen Routen vorgegeben. Eine abschließende Ausweichroute wird aus den Risikofunktionen der Routen ausgewählt, und ein Lenkvorgang und ein Bremsvorgang werden entsprechend gesteuert.A Control unit (5) gives a current overall risk function respectively for marking lines, barriers, page boundaries and three-dimensional objects that are present around a vehicle, estimates a temporal change in the position each object and calculates a minimum of the total risk function at the vehicle position for the respective time. A Target function is generated for the time, and a Bypass control amount that minimizes the objective function at the time is calculated as the deflection control amount of the vehicle. Risk functions, provided upon movement of the vehicle to the Umfahrungssteuerbetrag are specified for the respective routes. A final evasive route becomes the risk functions the routes selected, and a steering operation and a braking operation are controlled accordingly.

Figure 00000001
Figure 00000001

Description

HINTERGRUND DER ERFINDUNGBACKGROUND OF THE INVENTION

1. Gebiet der Erfindung1. Field of the invention

Die vorliegende Erfindung bezieht sich auf ein Fahrunterstützungssystem für Fahrzeuge, das Risiken im Hinblick auf weiße Linien bzw. Markierungslinien und dreidimensionale Gegenstände einschätzt, die um ein Fahrzeug herum vorhanden sind und beispielsweise mit einer Stereokamera, einer einäugigen Kamera oder einem Millimeterwellen-Radar erfaßt werden, und das einen Lenkvorgang oder Bremsvorgang derart steuert, daß das Fahrzeug eine optimale Route nehmen kann.The The present invention relates to a driving assistance system for vehicles, the risks with regard to white Lines or marking lines and three-dimensional objects assesses that are present around a vehicle and for example, with a stereo camera, a one-eyed Camera or a millimeter-wave radar, and controls a steering operation or braking such that the Vehicle can take an optimal route.

2. Beschreibung des einschlägigen Standes der Technik2. Description of the relevant State of the art

In den letzten Jahren sind verschiedene Technologien zum Verbessern der Sicherheit eines Fahrzeugs entwickelt und in der Praxis eingesetzt worden. Bei diesen Technologien wird eine Fahrumgebung vor dem Fahrzeug beispielsweise mit einer Kamera oder einem Laser-Radar erfaßt, die bzw. das in dem Fahrzeug angebracht ist. Auf der Basis der Daten über die Fahrumgebung werden Hindernisse und ein vorausfahrendes Fahrzeug erkannt, und es werden ein Alarmvorgang, ein automatischer Bremsvorgang und ein automatischer Lenkvorgang ausgeführt.In In recent years, various technologies have been improved The safety of a vehicle has been developed and used in practice. These technologies create a driving environment in front of the vehicle detected for example with a camera or a laser radar, which is mounted in the vehicle. Based on the data about the driving environment becomes obstacles and a vehicle ahead detected, and there will be an alarm process, an automatic braking process and executed an automatic steering operation.

Zum Beispiel wird bei einer Technologie, wie sie in der JP-A-2004-110346 offenbart ist, ein um ein Fahrzeug herum vorhandenes Hindernis detektiert, und das derzeitige Risikopotential des Fahrzeugs im Hinblick auf das Hindernis wird berechnet. Auf der Basis des Risikopotentials wird die Arbeitsweise von Einrichtungen in dem Fahrzeug gesteuert, um den Fahrer zu veranlassen, einen Fahrvorgang hinsichtlich der Bewegung des Fahrzeugs in Vorwärts/Rückwärts-Richtung und Rechts/Links-Richtung auszuführen. Die Betätigung der Einrichtungen in dem Fahrzeug wird in nur einer von der Vorwärts/Rückwärts-Richtung und der Rechts/Links-Richtung gesteuert.For example, in a technology as used in the JP-A-2004-110346 discloses an obstacle existing around a vehicle, and the current risk potential of the vehicle with respect to the obstacle is calculated. On the basis of the risk potential, the operation of devices in the vehicle is controlled to cause the driver to perform a driving operation with respect to the movement of the vehicle in the front / rear direction and the right / left direction. The operation of the devices in the vehicle is controlled in only one of the forward / backward direction and the right / left direction.

Die in der vorstehend genannten Veröffentlichung offenbarte Steuerung wird jedoch strikt in Abhängigkeit von dem derzeitigen Risikopotential ausgeführt und kann somit nicht in effektiver Weise auf ein Risiko ansprechen, das sich mit den Bewegungen des Fahrzeugs und des Hindernisses ändert. Mit anderen Worten heißt das, daß selbst bei einem derzeit als optimal erachteten Fahrweg das Risiko in der Zukunft häufig ansteigt.The disclosed in the aforementioned publication However, control becomes strictly dependent on the current one Risk potential and thus can not be effective To address a risk associated with the movements of the person Vehicle and obstacle changes. In other words Does that mean that even at one time it is considered optimal the roadway often rises in the future.

KURZBESCHREIBUNG DER ERFINDUNGBRIEF DESCRIPTION OF THE INVENTION

Die vorliegende Erfindung ist in Anbetracht der vorstehend geschilderten Umstände erfolgt, und ein Ziel der Erfindung besteht in der Angabe eines Fahrunterstützungssystems für Fahrzeuge, das das aktuelle Risiko und das zukünftige Risiko unter genauer Berücksichtigung der Relativbewegung zwischen einem Fahrzeug und einem Hindernis einschätzt und das eine derartige Steuerung ausführt, daß das Fahrzeug in natürlicherer Weise entlang einer optimalen Route fahren kann und dadurch die Sicherheit verbessert werden kann.The The present invention is in view of the above Circumstances occur, and an object of the invention is in the indication of a driving support system for Vehicles, the current risk and the future risk taking into account the relative movement between assesses a vehicle and an obstacle and the one performs such control that the vehicle drive in a more natural way along an optimal route and thereby the safety can be improved.

Ein Fahrunterstützungssystem für Fahrzeuge gemäß einem ersten Aspekt der vorliegenden Erfindung weist eine Umgebungs-Erkennungseinrichtung zum Erkennen einer äußeren Umgebung eines Fahrzeugs folgendes auf:
eine Risikovorgabeeinrichtung zum Vorgeben des aktuellen Risikos von einem Objekt in der erkannten äußeren Umgebung;
eine Risikoänderungs-Vorhersageeinrichtung zum Vorhersagen einer zeitlichen Veränderung in dem korrigierten Risiko durch Vorhersagen einer zeitlichen Veränderung bei einer Position des Objekts;
eine Minimum-Berechnungseinrichtung zum Berechnen des Minimums des Risikos bei einer Position des Fahrzeugs zu einem jeweiligen Zeitpunkt auf der Basis der vorhergesagten zeitlichen Veränderung bei dem Risiko;
eine Umfahrungssteuerbetrag-Berechnungseinrichtung zum Berechnen eines Umfahrungssteuerbetrags des Fahrzeugs auf der Basis von zumindest dem Minimum; und
eine Ausweichrouten-Bestimmungseinrichtung zum Bestimmen einer abschließenden Ausweichroute durch Generieren einer Ausweichroute des Fahrzeugs auf der Basis des Umfahrungssteuerbetrages.
A driving support system for vehicles according to a first aspect of the present invention includes an environment recognizing device for detecting an external environment of a vehicle:
a risk provisioning device for specifying the current risk of an object in the detected external environment;
a risk change predictor for predicting a temporal change in the corrected risk by predicting a time change in a position of the object;
a minimum calculating means for calculating the minimum of the risk at a position of the vehicle at a respective time based on the predicted time change in the risk;
a turn-around control amount calculating means for calculating a turn-around control amount of the vehicle on the basis of at least the minimum; and
an avoidance route determining means for determining a final avoidance route by generating an avoidance route of the vehicle on the basis of the avoidance control amount.

Ein zweiter Aspekt der vorliegenden Erfindung beinhaltet ferner zumindest eine Einrichtung aus:
einer Lenksteuereinrichtung zum Steuern eines Lenkvorgangs auf der Basis des Umfahrungssteuerbetrages des Fahrzeugs auf der abschließenden Ausweichroute; und
einer Bremssteuereinrichtung zum Steuern eines Bremsvorgangs auf der Basis des Risikos auf der abschließenden Ausweichroute.
A second aspect of the present invention further includes at least one device of
a steering control means for controlling a steering operation based on the turning amount of the vehicle on the final avoidance route; and
a brake control device for controlling a braking operation based on the risk on the final avoidance route.

Gemäß einem dritten Aspekt der vorliegenden Erfindung bildet die Umfahrungssteuerbetrag-Berechnungseinrichtung eine Zielfunktion zu einem jeweiligen Zeitpunkt auf der Basis einer Abweichung zwischen einer lateralen Position des Fahrzeugs und dem Minimum sowie dem Umfahrungssteuerbetrag zu dem Zeitpunkt und berechnet als Umfahrungssteuerbetrag des Fahrzeugs einen Umfahrungssteuerbetrag, der die Zielfunktion zu dem Zeitpunkt minimiert.According to a third aspect of the present invention, the turning-around control amount calculating means forms a target function at a respective time based on a deviation between a lateral position of the vehicle and the minimum and the turning-around control amount at the time, and calculates a turning-around control amount of the target function as the turning-around control amount of the vehicle to that Time minimized.

Gemäß einem vierten Aspekt der vorliegenden Erfindung berechnet die Minimumberechnungseinrichtung das Minimum des Risikos durch partielle Differenzierung in der Breitenrichtung des Fahrzeugs.According to one Fourth aspect of the present invention calculates the minimum calculator the minimum of risk by partial differentiation in the width direction of the vehicle.

Gemäß einem fünften Aspekt der vorliegenden Erfindung gibt die Risikovorgabeeinrichtung dann, wenn es sich bei dem Objekt um eine weiße Linie bzw. Markierungslinie handelt, das Risiko derart vor, daß dieses etwa von dem Zentrum einer Fahrspur in Richtung auf die Markierungslinie ansteigt.According to one fifth aspect of the present invention then provides the risk provisioning device if the object is a white line or marker line the risk is such that it is approximately of the Center of a lane in the direction of the marker line increases.

Gemäß einem sechsten Aspekt der vorliegenden Erfindung gibt die Risikovorgabeeinrichtung dann, wenn es sich bei dem Objekt um ein dreidimensionales Objekt handelt, das Risiko in einer Wahrscheinlichkeitsverteilung vor.According to one sixth aspect of the present invention then provides the risk provisioning device if the object is a three-dimensional object, the risk in a probability distribution.

Ein siebter Aspekt der vorliegenden Erfindung beinhaltet ferner eine Risikokorrektureinrichtung zum Korrigieren des von der Risikovorgabeeinrichtung vorgegebenen aktuellen Risikos in Abhängigkeit von mindestens einem Parameter von einer relativen Geschwindigkeit und einer relativen Beschleunigung zwischen dem Objekt und dem Fahrzeug.One Seventh aspect of the present invention further includes a Risk correcting facility for correcting the risk provisioning facility given current risk depending on at least a parameter of relative speed and relative Acceleration between the object and the vehicle.

Gemäß einem achten Aspekt der vorliegenden Erfindung korrigiert die Risikokorrektureinrichtung das von der Risikovorgabeeinrichtung vorgegebene aktuelle Risiko in Abhängigkeit von der relativen Beschleunigung zwischen dem Objekt und dem Fahrzeug, so daß das aktuelle Risiko mit zunehmender relativer Beschleunigung in einer Richtung, in der sich das Objekt dem Fahrzeug nähert, zunimmt.According to one eighth aspect of the present invention corrects the risk correcting device the current risk given by the risk provisioning facility depending on the relative acceleration between the object and the vehicle, so that the current risk with increasing relative acceleration in a direction in which the object approaches the vehicle increases.

Bei dem Fahrunterstützungssystem für Fahrzeuge gemäß der vorliegenden Erfindung ist es möglich, nicht nur das aktuelle Risiko, sondern auch zukünftige Risiken vorzugeben. Dies erlaubt eine Steuerung des Fahrzeugs in einer derartigen Weise, daß dieses mit höherer Sicherheit eine optimale Route nimmt.at the driving support system for vehicles according to present invention, it is possible not only the current Risk, but also to specify future risks. This allows control of the vehicle in such a way that this with higher security an optimal Route takes.

KURZBESCHREIBUNG DER ZEICHNUNGENBRIEF DESCRIPTION OF THE DRAWINGS

In den Zeichnungen zeigen:In show the drawings:

1 eine schematische Darstellung zur Erläuterung der Konfiguration eines Fahrunterstützungssystems, das in einem Fahrzeug installiert ist; 1 a schematic diagram for explaining the configuration of a driving support system that is installed in a vehicle;

2 ein Flußdiagramm zur Erläuterung eines Fahrunterstützungs-Steuerprogramms; 2 a flowchart for explaining a driving assistance control program;

3 ein Flußdiagramm, in dem eine Fortsetzung des in 2 gezeigten Fahrunterstützungs-Steuerprogramms dargestellt ist; 3 a flowchart in which a continuation of the in 2 shown driving assistance control program is shown;

4 eine Ansicht zur Erläuterung einer Risikofunktions-Korrekturroutine; 4 a view for explaining a risk function correction routine;

5 eine Ansicht zur Erläuterung eines Beispiels einer Risikofunktion, die vor einem Fahrzeug vorhanden ist; 5 a view for explaining an example of a risk function that is present in front of a vehicle;

6A und 6B Kennliniendarstellungen zur Erläuterung von Beispielen für Korrekturkoeffizienten gemäß der relativen Geschwindigkeit und der relativen Beschleunigung; und 6A and 6B Characteristic maps for explaining examples of correction coefficients according to the relative velocity and the relative acceleration; and

7A und 7B Ansichten zur Erläuterung von Beispielen für eine generierte Ausweichroute und einen Umfahrungssteuerbetrag. 7A and 7B Views illustrating examples of a generated evasive route and a detour control amount.

BESCHREIBUNG DES BEVORZUGTEN AUSFÜHRUNGSBEISPIELSDESCRIPTION OF THE PREFERRED EMBODIMENT

Ein Ausführungsbeispiel der vorliegenden Erfindung wird im folgenden unter Bezugnahme auf die 1 bis 7 beschrieben.An embodiment of the present invention will be described below with reference to FIGS 1 to 7 described.

Wie unter Bezugnahme auf 1 ersichtlich, ist ein Fahrunterstützungssystem 2 in einem Fahrzeug (einem eigenen Fahrzeug eines Fahrers) 1, wie zum Beispiel in einem Kraftfahrzeug, installiert. Das Fahrunterstützungssystem 2 weist in erster Linie eine Stereokamera 3, eine Stereobild-Erkennungsvorrichtung 4 und eine Steuereinheit 5 auf.As with reference to 1 It can be seen, is a driving support system 2 in a vehicle (a driver's own vehicle) 1 , such as in a motor vehicle, installed. The driving support system 2 primarily has a stereo camera 3 , a stereo image recognition device 4 and a control unit 5 on.

Das Fahrzeug 1 ist ferner mit einem Fahrzeuggeschwindigkeitssensor 11 zum Erfassen der Fahrzeuggeschwindigkeit V, einem Gierratensensor 12 zum Erfassen der Gierrate (dϕ/dt) sowie mit einem Hauptschalter 13 ausgestattet, mit dem ein EIN/AUS-Signal für eine Fahrunterstützungssteuerung eingegeben wird. Die Fahrzeuggeschwindigkeit V wird in die Stereobild-Erkennungsvorrichtung 4 und in die Steuereinheit 5 eingegeben. Die Steuerrate (dϕ/dt) und das EIN/AUS-Signal für die Fahrunterstützungssteuerung werden in die Steuereinheit 5 eingegeben.The vehicle 1 is further provided with a vehicle speed sensor 11 for detecting the vehicle speed V, a yaw rate sensor 12 for detecting the yaw rate (dφ / dt) and with a main switch 13 equipped with an ON / OFF signal for a driving assistance control is input. The vehicle speed V is in the stereo image recognition device 4 and in the control unit 5 entered. The control rate (dφ / dt) and the drive assist control ON / OFF signal are input to the control unit 5 entered.

Die Stereokamera 3 dient als stereooptisches System und beinhaltet ein Paar (eine rechte und eine linke) CCD-Kameras, von denen jede einen Festkörper-Bildsensor, wie zum Beispiel eine ladungsgekoppelte Vorrichtung (CCD), verwendet. Die rechte und die linke CCD-Kamera sind im vorderen Bereich einer Decke im Fahrzeuginnenraum in einer derartigen Weise angebracht, daß sie mit einer vorbestimmten Beabstandung zwischeneinander angeordnet sind. Die CCD-Kameras nehmen Stereobilder von äußeren Objekten von unterschiedlichen Betrachtungspunkten auf und geben Daten über die Bilder in die Stereobild-Erkennungsvorrichtung ein.The stereo camera 3 serves as a stereo optical system and includes a pair (right and left) CCD cameras, each of which uses a solid-state image sensor such as a charge-coupled device (CCD). The right and left CCD cameras are mounted in the front portion of a ceiling in the vehicle interior in such a manner as to be interposed with a predetermined spacing. The CCD cameras capture stereo images of outer objects from different viewpoints and input data about the images into the stereo image recognition device.

Beispielsweise werden Bilder von der Stereokamera 3 in der Stereobild-Erkennungsvorrichtung 4 in der folgenden Weise verarbeitet. Zuerst wird eine Distanzinformation aus dem Betrag der Fehlausrichtung zwischen den entsprechenden Positionen bei einem Paar von Stereobildern berechnet, die von der Stereokamera 3 in Vorwärtsrichtung von dem Fahrzeug 1 aufgenommen werden, und ein Distanzbild wird auf der Basis der Distanzinformation erzeugt.For example, pictures are taken from the stereo camera 3 in the stereo image recognition device 4 processed in the following way. First, distance information is calculated from the amount of misalignment between the corresponding positions in a pair of stereo images taken by the stereo camera 3 in the forward direction of the vehicle 1 are picked up, and a distance image is generated on the basis of the distance information.

Diese Bilddaten werden einer bekannten Gruppierung unterzogen und mit Fenstern von vorab gespeicherten dreidimensionalen Daten verglichen, wie zum Beispiel Straßenformdaten, Seitenwanddaten sowie dreidimensionalen Objektdaten. Als Resultat des Vergleichs werden Daten über Markierungslinien und Seitenwanddaten hinsichtlich Abgrenzungen und Bordkanten extrahiert, die sich entlang der Straße erstrecken, und dreidimensionale Objekte werden in Klassen von Zweirad-Fahrzeugen, Fahrzeugen mit Standardgröße, Fahrzeugen mit Überlänge, Fußgängern, elektrischen Strommasten sowie anderen dreidimensionalen Objekten extrahiert.These Image data is subjected to a known grouping and with Compared windows of pre-stored three-dimensional data, such as for example, road shape data, sidewall data, and three-dimensional Object data. As a result of the comparison, data about Marking lines and sidewall data regarding demarcations and curbs extracted along the road extend and three-dimensional objects are used in classes of two-wheeled vehicles, Standard size vehicles, over-length vehicles, Pedestrians, electric pylons and others extracted from three-dimensional objects.

Bei den vorstehend geschilderten erkannten Daten werden die Positionen von Objekten in einem Koordinatensystem berechnet, bei dem die Position des Fahrzeugs 1 der Ausgangspunkt ist, die X-Achse die Vorwärts/Rückwärts-Richtung des Fahrzeugs 1 darstellt und die Y-Achse die Breitenrichtung des Fahrzeugs 1 darstellt. Insbesondere werden die in Vorwärts/Rückwärts-Richtung vorhandenen Längen eines Zweirad-Fahrzeugs, eines Fahrzeugs mit Standardgröße sowie eines Fahrzeugs mit Überlänge vorab zum Beispiel mit 3 m, 4,5 m bzw. 10 m geschätzt.In the above-mentioned detected data, the positions of objects are calculated in a coordinate system in which the position of the vehicle 1 the starting point is the x-axis the forward / backward direction of the vehicle 1 represents and the Y-axis the width direction of the vehicle 1 represents. Specifically, the forward / reverse direction lengths of a two-wheeled vehicle, a standard size vehicle, and an excess length vehicle are estimated in advance, for example, at 3 m, 4.5 m, and 10 m, respectively.

Ferner wird die derzeitige, in Breitenrichtung vorhandene zentrale Position des Fahrzeugs aus der zentralen Position der erfaßten Breite berechnet und in Form von Koordinaten dargestellt (xHindernis, yHindernis). Wenn die Länge des Fahrzeugs in Vorwärts/Rückwärts-Richtung genau erfaßt werden kann, beispielsweise durch eine Kommunikation von Fahrzeug zu Fahrzeug, kann die vorstehend beschriebene zentrale Position aus den Daten über die Länge in Vorwärts/Rückwärts-Richtung berechnet werden.Further, the present central widthwise position of the vehicle is calculated from the central position of the detected width and represented in the form of coordinates (x obstacle , y obstacle ). If the length of the vehicle can be accurately detected in the fore / aft direction, for example, by vehicle-to-vehicle communication, the above-described central position can be calculated from the data on the length in the fore / aft direction.

Bei den dreidimensionalen Objektdaten wird die relative Geschwindigkeit Vs in bezug auf das Fahrzeug 1 auf der Basis von Veränderungen bei der Distanz von dem Fahrzeug 1 in der X-Achsen-Richtung und der Y-Achsen-Richtung berechnet. Unter Verwendung der relativen Geschwindigkeit Vs und der Fahrzeuggeschwindigkeit V des Fahrzeugs unter Berücksichtigung der Vektorgröße werden die Geschwindigkeit in X-Achsen-Richtung und die Geschwindigkeit in Y-Achsen-Richtung (v xHindernis, v yHindernis) des dreidimensionalen Objekts berechnet.In the three-dimensional object data, the relative velocity Vs with respect to the vehicle becomes 1 based on changes in the distance from the vehicle 1 calculated in the X-axis direction and the Y-axis direction. Using the relative velocity Vs and the vehicle speed V of the vehicle considering the vector size, the velocity in the X-axis direction and the velocity in the Y-axis direction (vx obstacle , vy obstacle ) of the three-dimensional object are calculated.

Die auf diese Weise ermittelte Information, d. h. Daten über Markierungslinien, Seitenbegrenzungsdaten hinsichtlich Abgrenzungen und Bordkanten, die entlang der Straße verlaufen, sowie dreidimensionalen Objektdaten (Typ, Distanz von dem Fahrzeug 1, zentrale Position (xHindernis, yHindernis), Geschwindigkeit (v xHindernis, v yHindernis) und relative Geschwindigkeit Vs in bezug auf das Fahrzeug 1), werden in die Steuereinheit 5 eingegeben. Auf diese Weise sind die Stereokamera 3 und die Stereobild-Erkennungsvorrichtung 4 bei dem vorliegenden Ausführungsbeispiel als Erkennungseinrichtung zum Erkennen der äußeren Umgebung vorgesehen.The information thus obtained, that is, data about marker lines, boundary delineation data regarding boundaries and curbs running along the road, and three-dimensional object data (type, distance from the vehicle 1 , central position (x obstacle , y obstacle ), speed (vx obstacle , vy obstacle ) and relative speed Vs with respect to the vehicle 1 ), are in the control unit 5 entered. This is the stereo camera 3 and the stereo image recognition device 4 provided in the present embodiment as a detection device for detecting the external environment.

Die Steuereinheit 5 empfangt die Fahrzeuggeschwindigkeit V von dem Fahrzeuggeschwindigkeitssensor 11, die Gierrate (dϕ/dt) von dem Gierratensensor 12 sowie Markierungsliniendaten, Seitenbegrenzungsdaten über Abgrenzungen und Bordkanten, die entlang der Straße verlaufen, und dreidimensionale Objektdaten (Typ, Distanz von dem Fahrzeug 1, zentrale Position (xHindernis, yHindernis), Geschwindigkeit (v xHindernis, v yHindernis) und relative Geschwindigkeit Vs in bezug auf das Fahrzeug 1) von der Stereobild-Erkennungsvorrichtung 4.The control unit 5 receives the vehicle speed V from the vehicle speed sensor 11 , the yaw rate (dφ / dt) from the yaw rate sensor 12 and marker line data, boundary data about boundaries and curbs running along the road, and three-dimensional object data (type, distance from the vehicle 1 , central position (x obstacle , y obstacle ), speed (vx obstacle , vy obstacle ) and relative speed Vs with respect to the vehicle 1 ) from the stereo image recognition device 4 ,

Auf der Basis der vorstehend beschriebenen Eingabedatensignale schätzt die Steuereinheit 5 als Risikofunktion oder RHindernis das aktuelle Risiko für jedes der vor dem Fahrzeug 1 vorhandenen Objekte ein, wie zum Beispiel Markierungslinien, Abgrenzungen, Seitenbegrenzungen und dreidimensionale Objekte, und zwar in Abhängigkeit von einem Fahrunterstützungs-Steuerprogramm, das im folgenden beschrieben wird.On the basis of the input data signals described above, the control unit estimates 5 as a risk function or R obstacle the current risk for each of the front of the vehicle 1 existing objects, such as marker lines, boundaries, page boundaries and three-dimensional objects, in response to a driving assistance control program, which will be described below.

Hierbei wird das aktuelle Risiko RHindernis für ein dreidimensionales Objekt derart korrigiert, daß es mit Zunahme der relativen Geschwindigkeit Vs in einer Richtung, in der sich das dreidimensionale Objekt dem Fahrzeug 1 nähert, zunimmt und somit bei einem Ansteigen der relativen Beschleunigung (dVs/dt) in der Richtung, in der sich das dreidimensionale Objekt dem Fahrzeug 1 nähert, zunimmt.Here, the current risk R obstacle for a three-dimensional object is corrected so that it increases with the relative velocity Vs in a direction in which the three-dimensional object is the vehicle 1 is approaching, increasing and thus increasing in relative acceleration (dVs / dt) in the direction in which the three-dimensional object approaches the vehicle 1 approaching, increasing.

Auf der Basis dieser Risikofunktionen RLinie und RHindernis (korrigierte Werte) wird die derzeitige Gesamtrisikofunktion R vorgegeben. Im Anschluß daran wird eine zeitliche Veränderung bei der Position jedes Objekts bei vorgegebener Gesamtrisikofunktion R vorhergesagt, und auf diese Weise wird eine zeitliche Veränderung bei der Gesamtrisikofunktion R vorhergesagt. Auf der Basis der zeitlichen Veränderung bei der Gesamtrisikofunktion R werden Mindestwerte ymin(x, t) in der Y-Achsen-Richtung an dem Fahrzeug zu den Zeitpunkten berechnet.On the basis of these risk functions R line and R obstacle (corrected values) the current total risk function R is given. Thereafter, a temporal change in the position of each object is predicted at a given total risk function R, and thus a temporal change in the overall risk function R is predicted. On the basis of the temporal change in the total risk function R, minimum values ymin (x, t) in the Y-axis direction on the vehicle at the times are calculated.

Ferner werden Zielfunktionen J zu den Zeitpunkten anhand von Abweichungen zwischen den lateralen Positionen des Fahrzeugs 1 und den Mindestwerten bzw. Minima ymin(x, t) und Umfahrungssteuerbeträgen u(t) ermittelt. Ein Umfahrungssteuerbetrag u(t), der die Zielfunktion J minimiert, wird als Umfahrungssteuerbetrag u(t) des Fahrzeugs 1 zu denn Zeitpunkt berechnet. Risikofunktionen R(t), die bei Bewegung des Fahrzeugs 1 um den Umfahrungssteuerbetrag u(1) bereitgestellt werden, werden für die jeweiligen Routen vorgegeben, und eine abschließende Ausweichroute R(t)f wird aus den Risikofunktionen R(t) der Routen ausgewählt.Further, objective functions J at the time points are determined by deviations between the lateral positions of the vehicle 1 and the minimum or minima y min (x, t) and deflection control amounts u (t) determined. A turning-around control amount u (t) that minimizes the objective function J is used as the turning-over control amount u (t) of the vehicle 1 calculated at the time. Risk functions R (t), when moving the vehicle 1 are provided for the respective routes, and a final alternate route R (t) f is selected from the risk functions R (t) of the routes.

Auf der Basis des Umfahrungssteuerbetrages u(t) auf der abschließenden Ausweichroute R(t)f wird ein Steuersignal an eine automatische Lenksteuervorrichtung 23 ausgegeben, die als Lenksteuereinrichtung dient, um dadurch eine Lenksteuerung auszuführen. Ferner wird auf der Basis der abschließenden Ausweichroute R(t)f ein Signal an eine als Bremssteuereinrichtung dienende automatische Bremssteuervorrichtung 22 ausgegeben, um dadurch eine Bremssteuerung vorzunehmen. Wenn die Signale an die automatische Bremssteuervorrichtung 22 und die automatische Lenksteuervorrichtung 23 ausgegeben werden, werden sie auf einer Anzeige 21 visuell angezeigt, um dadurch den Fahrer zu informieren.On the basis of the bypass control amount u (t) on the final alternate route R (t) f, a control signal is sent to an automatic steering control device 23 which serves as a steering control means to thereby execute a steering control. Further, based on the final alternate route R (t) f, a signal is sent to an automatic brake control device serving as a brake control device 22 outputted to thereby perform a brake control. When the signals to the automatic brake control device 22 and the automatic steering control device 23 they are displayed on a display 21 visually displayed, thereby informing the driver.

Mit anderen Worten, es hat die Steuereinheit 5 die Funktion einer Risikovorgabeeinrichtung, einer Risikokorrektureinrichtung, einer Risikoänderungs-Vorhersageeinrichtung, einer Minimum-Berechnungseinrichtung, einer Umfahrungssteuerbetrag-Berechnungseinrichtung sowie einer Ausweichrouten-Bestimmungseinrichtung.In other words, it has the control unit 5 the function of a risk provisioning means, a risk correcting means, a risk change predicting means, a minimum calculating means, a turn-around control amount calculating means and an avoidance-route determining means.

Im folgenden wird ein von dem Fahrunterstützungssystem 2 ausgeführtes Fahrunterstützungs-Steuerprogramm unter Bezugnahme auf die 2 und 3 beschrieben, die Flußdiagramme darstellen.The following is one of the driving support system 2 executed driving support control program with reference to the 2 and 3 described representing flow charts.

Zuerst werden in einem Schritt (der im folgenden auch kurz als "S" bezeichnet wird) 101 erforderliche Parameter gelesen, wobei es sich insbesondere um Markierungsliniendaten, Seitenbegrenzungsdaten hinsichtlich Abgrenzungen und Bordkanten, die entlang der Straße verlaufen, sowie dreidimensionale Objektdaten (Typ, Distanz von dem Fahrzeug 1, zentrale Position (xHindernis, yHindernis), Geschwindigkeit (v xHindernis, v yHindernis), und die relative Geschwindigkeit Vs in bezug auf das Fahrzeug 1) handelt.First, in a step (hereinafter also referred to as "S" for short) 101 required parameters are read, in particular, mark line data, boundary delineation data regarding boundaries and curbs running along the road, and three-dimensional object data (type, distance from the vehicle 1 , In a central position (x obstacle, obstacle y), velocity (vx obstacle, vy obstacle), and the relative velocity Vs with respect to the vehicle 1 ).

In einem Schritt S102 wird die aktuelle Risikofunktion RLinie für Markierungslinien (wobei Bordkanten und Seitenbegrenzungen gleich behandelt werden) mit der nachfolgenden Formel (1) berechnet: RLinie = KLinie·y2 (1). In a step S102, the current risk function R line for marking lines (where curbs and side boundaries are treated the same) is calculated by the following formula (1): R line = K line · y 2 (1).

Dabei stellt RLinie eine vorbestimmte Verstärkung dar. Das heißt, die aktuelle Risikofunktion RLinie für Markierungslinien wird als quadratische Funktion angegeben, die eine zentrale Achse im Zentrum einer Fahrspur darstellt, die durch eine rechte und eine linke Markierungslinie definiert ist (wobei Abgrenzungen und Seitenbegrenzungen gleich behandelt werden), wie dies in 5 gezeigt ist.Here, R line represents a predetermined gain. That is, the current risk function R line for marker lines is given as a quadratic function representing a central axis in the center of a lane defined by right and left marker lines (where boundaries and page boundaries treated the same), as in 5 is shown.

Während die Risikofunktion RLinie bei dem vorliegenden Ausführungsbeispiel eine quadratische Funktion ist, kann es sich auch um eine beliebige Funktion handeln, die eine Zunahme des Risikos von dem Zentrum der Fahrspur in Richtung auf die Markierungslinien zuläßt. Beispielsweise kann es sich bei der Risikofunktion RLinie um eine Funktion vierten Grades oder sechsten Grades handeln.While the risk function R line is a quadratic function in the present embodiment, it may be any function that allows an increase in the risk from the center of the lane toward the marker lines. For example, the risk function R line may be a fourth degree or sixth degree function.

Während bei dem vorliegenden Ausführungsbeispiel eine Abgrenzung und eine Seitenbegrenzung gleich behandelt werden und mit einer Risikofunktion RLinie zweiten Grades vorgesehen sind, kann auch eine andere Funktion als die Risikofunktion RLinie für Markierungslinien für Abgrenzungen und Seitenbegrenzungen vorgesehen sein, um dadurch ein höheres Risiko als das Risiko für Markierungslinien abzuleiten.While in the present embodiment, a boundary and a side boundary are treated the same and are provided with a risk function R second-degree line , also a function other than the risk function R line for delineation lines and side boundaries may be provided, thereby taking a higher risk than that Derive risk for marking lines.

Wenn zum Beispiel die Risikofunktion RLinie für die rechte und die linke Markierungslinie als Funktion zweiten Grades angegeben wird, kann die Funktion für die Abgrenzungen und Seitenbegrenzungen auf eine Funktion vierten Grades oder sechsten Grades geändert werden. Selbst wenn eine Funktion zweiten Grades in ähnlicher Weise verwendet wird, kann die Verstärkung KLinie auf einen höheren Wert geändert werden.For example, if the risk function R line for the right and left marker lines is specified as a second degree function, the function for the boundaries and page boundaries may be changed to a fourth degree or sixth degree function. Even if a second-degree function is similarly used, the gain K line can be changed to a higher value.

Darüber hinaus ist die Risikofunktion RLinie für Markierungslinien nicht auf eine Funktion begrenzt, die eine zentrale Achse im Zentrum der Fahrspur aufweist, und der Risikowert kann durch Versetzen der zentralen Achse für die linke und die rechte Linie unterschiedlich gewählt werden.Moreover, the risk function R line for marking lines is not limited to a function having a central axis in the center of the lane, and the risk value can be set differently by offsetting the central axis for the left and right lines.

In einem Schritt S103 wird die aktuelle Risikofunktion RHindernis für dreidimensionale Objekte (ein Zweiradfahrzeug, ein Fahrzeug mit Standardgröße, ein Fahrzeug mit Überlänge, einen Fußgänger, einen elektrischen Strommasten sowie weitere dreidimensionale Objekte) anhand der nachfolgenden Formel (2) berechnet: RHindernis = KHindernis·exp(-((xHindernis – x)2/(2·σ xHindernis 2)) – ((yHindernis – y)2/(2·σ yHindernis 2))) (2). In a step S103, the current risk function R obstacle for three-dimensional objects (a two-wheeled vehicle, a standard-size vehicle, an over-length vehicle, a pedestrian, an electricity pylon, and other three-dimensional objects) is calculated by the following formula (2). R obstacle = K obstacle * Exp (- ((x obstacle - x) 2 / (2 · σ x obstacle 2 )) - ((y obstacle - y) 2 / (2 · σ y obstacle 2 ))) (2).

Dabei haben die Bezeichnungen folgende Bedeutung: KHindernis eine vorbestimmte Verstärkung,
σ xHindernis eine vorbestimmte Streuung des Objekts in der X-Achsen-Richtung und
yHindernis eine vorbestimmte Streuung des Objekts in der Y-Achsen-Richtung. Diese Streuungen σ xHindernis und σ yHindernis können derart vorgegeben werden, daß sie mit abnehmender Erkennungsgenauigkeit der Stereokamera 3 zunehmen.
The terms have the following meaning: K obstacle a predetermined gain,
σ x obstacle a predetermined scattering of the object in the X-axis direction and
y obstacle a predetermined scattering of the object in the Y-axis direction. These scattering σ x obstacle and σ y obstacle can be specified such that they with decreasing recognition accuracy of the stereo camera 3 increase.

Ferner können die Streuungen σ xHindernis und σ yHindernis derart vorgegeben werden, daß sie den Standard bilden, wenn es sich bei dem Objekt um ein Fahrzeug mit Standardgröße oder um ein Fahrzeug mit Übergröße handelt, daß sie hoch sind, wenn es sich bei dem Objekt um einen Fußgänger oder ein Zweiradfahrzeug handelt, und daß sie gering sind, wenn es sich bei dem Objekt um ein weiteres dreidimensionales Objekt handelt.Further, the scatters σ x obstacle and σ y obstacle may be set to be the standard, when the object is a standard size vehicle or an oversized vehicle, that they are high when the vehicle is of a standard size Object is a pedestrian or a two-wheeled vehicle, and that they are small, if the object is another three-dimensional object.

Alternativ hierzu können die Streuungen σ xHindernis und σ yHindernis in Abhängigkeit von der Überlappungsrate in der Breitenrichtung zwischen dem Fahrzeug 1 und dem dreidimensionalen Zielobjekt vorgegeben werden. In 5 stellen ein dreidimensionales Objekt A1 und ein dreidimensionales Objekt A2 Beispiele von aktuellen Risikofunktionen RHindernis für dreidimensionale Objekte dar, die anhand der vorstehend genannten Formel (2) berechnet werden.Alternatively, the scatters σ x obstacle and σ y obstacle may be dependent on the overlap rate in the width direction between the vehicle 1 and the three-dimensional target object. In 5 represent a three-dimensional object A1 and a three-dimensional object A2 examples of current risk functions R obstacle for three-dimensional objects, which are calculated on the basis of the above-mentioned formula (2).

In einem Schritt S104 wird die in dem Schritt S103 berechnete aktuelle Risikofunktion RHindernis in Abhängigkeit von einer in 4 dargestellten Risikofunktion-(RHindernis-)Korrekturroutine korrigiert.In a step S104, the current risk function R calculated in the step S103 becomes the obstacle depending on an in 4 corrected risk function (R obstacle ) correction routine corrected.

Bei der Risikofunktion-(RHindernis-)Korrekturroutine wird zuerst in einem Schritt S201 eine relative Geschwindigkeit Vs des dreidimensionalen Zielobjekts in bezug auf das Fahrzeug 1 gelesen, und eine erste Korrekturverstärkung Ks1 wird in bezug auf ein vorbestimmtes Kennfeld (zum Beispiel ein Vs-Ks1-Kennfeld, wie in 6A dargestellt) in einem Schritt S202 vorgegeben.In the risk function (R obstacle ) correction routine, first, in a step S201, a relative velocity Vs of the three-dimensional target object with respect to the vehicle 1 A first correction gain K s1 is read with respect to a predetermined map (for example, a Vs-K s1 map as in FIG 6A shown) in a step S202.

In einem Schritt S203 wird eine relative Beschleunigung (dVs/dt) aus der relativen Geschwindigkeit Vs berechnet. In einem Schritt S204 wird eine zweite Korrekturverstärkung Ks2 in bezug auf ein vorbestimmtes Kennfeld (zum Beispiel ein (dVs/dt)-Ks2-Kennfeld, wie es in 6B gezeigt ist) vorgegeben.In a step S203, a relative acceleration (dVs / dt) is calculated from the relative velocity Vs. In a step S204, a second correction gain K s2 with respect to a predetermined map (for example, a (dVs / dt) -K s2 map as shown in FIG 6B shown).

In einem Schritt S204 wird die Risikofunktion RHindernis mittels der nachfolgenden Formel (3) korrigiert und ausgegeben: RHindernis = Ks1·Ks2·RHindernis (3).Danach verläßt das Programm die Routine.In a step S204, the risk function R obstacle is corrected and output by the following formula (3): R obstacle = K s1 · K s2 · R obstacle (3). Then the program leaves the routine.

In dem in 6A dargestellten Kennfeld Vs-Ks1 ist die erste Korrekturverstärkung Ks1 derart vorgegeben, daß sie mit steigender Relativgeschwindigkeit Vs zunimmt. Insbesondere sei angenommen, daß die erste Korrekturverstärkung Ks1 den Wert 1,0 besitzt, wenn die relative Geschwindigkeit Vs den Wert 0 besitzt und sich das Zielobjekt mit der gleichen Geschwindigkeit wie der Geschwindigkeit des Fahrzeugs 1 bewegt, während dann, wenn die relative Geschwindigkeit Vs den Wert 0 übersteigt und sich das Objekt dem Fahrzeug 1 annähert, die erste Korrekturverstärkung Ks1 den Wert 1,0 überschreitet. Somit wird die Risikofunktion RHindernis auf einen höheren Wert korrigiert, wie dies aus der vorstehend beschriebenen Formel (3) erkennbar ist.In the in 6A shown map Vs-K s1 , the first correction gain K s1 is set such that it increases with increasing relative speed Vs. Specifically, let it be assumed that the first correction gain K s1 is 1.0 when the relative speed Vs is 0, and the target object is at the same speed as the speed of the vehicle 1 moves, while when the relative velocity Vs exceeds 0 and the object is the vehicle 1 approaches, the first correction gain K s1 exceeds 1.0. Thus, the risk function R obstacle is corrected to a higher value, as can be seen from the above-described formula (3).

Während der Fahrer das Gefühl einer Gefahr hinsichtlich eines sich dem Fahrzeug 1 nähernden Hindernisses hat, besitzt der Fahrer oder die Fahrerin möglicherweise kein starkes Gefühl einer Gefahr im Hinblick auf ein sich von dem Fahrzeug 1 weg bewegendes Hindernis. In Anbetracht dieser Tatsache wird die vorstehend beschriebene Einstellung vorgenommen. Diese Einstellung erlaubt eine natürlichere Vorgabe der Risikofunktion RHindernis.While the driver is feeling a danger with respect to the vehicle 1 approaching obstacle, the driver may not have a strong sense of danger to himself from the vehicle 1 away moving obstacle. In view of this fact, the adjustment described above is made. This setting allows a more natural specification of the risk function R obstacle .

Bei dem (dVs/dt)-Ks2-Kennfeld, wie es die 6B zeigt, ist die zweite Korrekturverstärkung Ks2 derart vorgegeben, daß sie mit zunehmender relativer Beschleunigung (dVs/dt) zunimmt. Insbesondere unter der Annahme, daß die zweite Korrekturverstärkung Ks2 den Wert 1,0 besitzt, wenn die relative Beschleunigung (dVs/dt) 0 ist und das Zielobjekt keine Beschleunigung relativ zu dem Fahrzeug 1 aufweist, übersteigt dann, wenn die relative Beschleunigung (dVs/dt) den Wert 0 übersteigt und das Objekt langsamer wird oder rasch langsamer wird, die zweite Korrekturverstärkung Ks2 den Wert 1,0. Infolgedessen wird die Risikofunktion SHindernis auf einen höheren Wert korrigiert, wie dies aus der vorstehend beschriebenen Formel (3) erkennbar ist.For the (dVs / dt) -K s2 map, like the 6B shows, the second correction gain K s2 is set such that it increases with increasing relative acceleration (dVs / dt). More specifically, assuming that the second correction gain K s2 is 1.0 when the relative acceleration (dVs / dt) is 0 and the target object is not acceleration relative to the vehicle 1 If the relative acceleration (dVs / dt) exceeds 0 and the object slows down or slows down rapidly, then the second correction gain K s2 exceeds 1.0. As a result, the risk function S hindrance is corrected to a higher value, as can be seen from the above-described formula (3).

Während der Fahrer das Gefühl einer Gefahr im Hinblick auf ein sich dem Fahrzeug 1 näherndes Hindernis hat, während dieses langsamer wird oder schnell langsamer wird, hat der Fahrer oder die Fahrerin kein starkes Gefühl einer Gefahr im Hinblick auf ein Hindernis, das schneller wird und sich von dem Fahrzeug 1 weg bewegt. In Anbetracht dieser Tatsache wird die vorstehend beschriebene Einstellung vorgenommen. Diese Einstellung erlaubt eine natürlichere Vorgabe der Risikofunktion RHindernis. Wie unter erneuter Bezugnahme auf 2 ersichtlich, wird in einem Schritt S105 die aktuelle Gesamtrisikofunktion R durch die nachfolgende Formel (4) berechnet: R = RLinie + RHindernis (4). While the driver is feeling a danger with respect to the vehicle 1 approaching obstacle, as it slows down or decelerates rapidly, the driver does not have a strong sense of danger with respect to an obstacle that is getting faster and moving away from the vehicle 1 moved away. In view of this fact, the adjustment described above is made. This setting allows a more natural specification of the risk function R obstacle . As with renewed reference to 2 3, in a step S105, the current total risk function R is calculated by the following formula (4): R = R line + R obstacle (4).

In einem Schritt S106 wird eine Position (xHindernis(t), yHindernis(t)) des dreidimensionalen Objekts, die nach t Sekunden erfaßt wird, anhand der nachfolgenden Formel (5) abgeschätzt: (xHindernis(t), yHindernis(t)) = (xHindernis + v xHindernis·t, yHindernis + v yHindernis·t)(5). In a step S106, a position (x obstacle (t), y obstacle (t)) of the three-dimensional object detected after t seconds is estimated by the following formula (5): (x obstacle (t), y obstacle (t)) = (x obstacle + vx obstacle · T, y obstacle + v y obstacle · T) (5).

In einem Schritt S107 wird die Position (xHindernis(t), xHindernis(t)) des dreidimensionalen Objekts, die nach t Sekunden erfaßt wird und die in dem Schritt S106 abgeschätzt wird, für x und y in der in dem Schritt S105 berechneten Gesamtrisikofunktion R substituiert, um dadurch eine Gesamtrisikofunktion R(xHindernis(t), yHindernis(t)) nach t Sekunden vorzugeben.In a step S107, the position (x obstacle (t), x obstacle (t)) of the three-dimensional object detected after t seconds estimated at the step S106 for x and y in the step S105 is calculated Total risk function R substituted to thereby give an overall risk function R (x obstacle (t), y obstacle (t)) after t seconds.

In einem Schritt S108 wird die Gesamtrisikofunktion R(xHindernis(t), yHindernis(t)) nach t Sekunden, die in dem Schritt S107 berechnet wird, partiell in der Breitenrichtung (y-Richtung) differenziert. Ausgehend von einem Punkt, an dem der ermittelte Wert 0 beträgt, wird ein Minimum ymin(x, t) in der Breitenrichtung (y-Richtung) berechnet. Mit anderen Worten, es wird bei dem Minimum folgende Bedingung erfüllt: δR(xHindernis(t), yHindernis(t))/δy = 0 (6). In step S108, the total risk function R (x obstacle (t), y obstacle (t)) after t seconds calculated in step S107 is partially differentiated in the width direction (y direction). Starting from a point where the detected value is 0, a minimum y min (x, t) in the width direction (y direction) is calculated. In other words, at the minimum, the following condition is met: .delta..sub.R (x obstacle (t), y obstacle (t)) / δy = 0 (6).

In einem Schritt S109 wird eine Fahrzeugposition (X(t), Y(t)) nach t Sekunden anhand der nachfolgenden Formel (7) abgeschätzt: (X(t), Y(t)) = (V·t, V·∫sinϕ(τ)dτ; ganzzahliger Bereich 0 ≤ τ ≤ t) (7). In a step S109, a vehicle position (X (t), Y (t)) after t seconds is estimated by the following formula (7): (X (t), Y (t)) = (V · t, V · ∫sinφ (τ) dτ; integer range 0 ≦ τ ≦ t) (7).

Dabei stellt ϕ(t) die Gierrate des Fahrzeugs 1 dar. Die Gierrate ergibt sich durch die nachfolgende Formel (8): ϕ(t) = (dϕ/dt)·t + (1/2)·((d2ϕ/dt2) + (u(t)/Iz))·t2 (8). Here, φ (t) represents the yaw rate of the vehicle 1 The yaw rate is given by the following formula (8): φ (t) = (dφ / dt) · t + (1/2) · ((d 2 φ / dt 2 ) + (u (t) / Iz)) · t 2 (8th).

Dabei bezeichnet Iz das Gier-Trägheitsmoment, und u(t) stellt den vorstehend beschriebenen Umfahrungssteuerbetrag dar, der als zusätzliches Giermoment dient.there Iz denotes the yaw moment of inertia, and u (t) represents the above-described Umfahrungssteuerbetrag, as additional yaw moment is used.

In einem Schritt S110 wird die vorstehend beschriebene Fahrzeugposition (X(t), Y(t)), die in dem Schritt S109 abgeschätzt worden ist, für das in dem Schritt S108 berechnete Minimum ymin(x, t) in der y-Richtung substituiert, um dadurch ein Minimum ymin(X(t) an der Fahrzeugposition X(t) zu berechnen.In a step S110, the above-described vehicle position (X (t), Y (t)) estimated in step S109 is calculated for the minimum y min (x, t) calculated in step S108 in the y direction to thereby calculate a minimum y min (X (t) at the vehicle position X (t).

In einem Schritt S111 wird eine Zielfunktion J anhand einer Abweichung zwischen der lateralen Position Y(t) des Fahrzeugs 1 und dem Minimum ymin(X(t), t) und dem Umfahrungssteuerbetrag u(t) zu jedem Zeitpunkt ermittelt. Danach wird zu jedem Zeitpunkt ein Umfahrungssteuerbetrag u(t) festgestellt, der die Zielfunktion J minimiert.In a step S111, a target function J is determined based on a deviation between the lateral position Y (t) of the vehicle 1 and the minimum y min (X (t), t) and the bypass control amount u (t) at each time point. Thereafter, a round trip control amount u (t) which minimizes the objective function J is detected at each time.

Wie zum Beispiel in den 7A und 7B dargestellt ist, sei angenommen, daß ein Bereich, in dem sich das Fahrzeug 1 von einem Zeitpunkt 0 (aktueller Zeitpunkt) bis Δt bewegt, als Zielsteuerbereich bezeichnet wird und die Periode von dem Zeitpunkt 0 bis Δt durch dt in 1dt, 2dt, 3dt, ..., mdt, ..., (n – 2)dt, (n – 1)dt, sowie ndt (= Δt) unterteilt ist.Like in the 7A and 7B is assumed that an area in which the vehicle 1 from time 0 (current time) to Δt, referred to as target control range, and the period from time 0 to Δt by dt in 1dt, 2dt, 3dt, ..., mdt, ..., (n-2) dt , (n - 1) dt, and ndt (= Δt) is divided.

Während einer Periode von dem Zeitpunkt 0 bis 1dt wird zum Beispiel eine Zielfunktion J0~1dt durch die nachfolgende Formel (9) vorgegeben, und ein Umfahrungssteuer betrag u(0), der die Zielfunktion J0~1dt minimiert, wird mittels einer bekannten Optimierungsberechnung ermittelt: J0~1dt = Wy·(ymin(X(1dt), 1dt) – Y(1dt))2 + Wu·u(0)2 (9). For example, during a period from time 0 to 1dt, a target function J0 ~ 1dt is given by the following formula (9), and a roundabout tax amount u (0) that minimizes the target function J0 ~ 1dt is determined by a known optimization calculation: J0 ~ 1dt = Wy · (y min (X (1dt), 1dt) - Y (1dt)) 2 + Wu · u (0) 2 (9).

Dabei bezeichnen Wy und Wu vorbestimmte Wichtungswerte.there Wy and Wu denote predetermined weighting values.

Während einer Periode von 1dt bis 2dt zum Beispiel wird eine Zielfunktion J1d~2dt durch die im folgenden genannte Formel (10) vorgegeben, und ein Umfahrungssteuerbetrag u(1dt), der die Zielfunktion J1dt~2dt minimiert, wird anhand einer bekannten Optimierungsberechnung festgestellt: J1dt~2dt = Wy·(ymin(X(2dt), 2dt) – Y(2dt))2 + Wu·u(1dt)2 (10). For example, during a period from 1dt to 2dt, a target function J1d ~ 2dt is given by the following formula (10), and a roundabout control amount u (1dt) that minimizes the target function J1dt ~ 2dt is determined from a known optimization computation: J1dt ~ 2dt = Wy · (y min (X (2dt), 2dt) - Y (2dt)) 2 + Wu · u (1dt) 2 (10).

Während einer Periode von 2dt bis 3dt zum Beispiel wird eine Zielfunktion J2dt~3dt anhand der nachfolgenden Formel (11) vorgegeben, und ein Umfahrungssteuerbetrag u(2dt), der die Zielfunktion J2dt~3dt minimiert, wird anhand einer bekannten Optimierungsberechnung festgestellt: J2dt~3dt = Wy·(ymin(X(3dt), 3dt) – Y(3dt))2 + Wu·u(2dt)2 (11). For example, during a period from 2dt to 3dt, an objective function J2dt ~ 3dt is given by the following formula (11), and a deflection control amount u (2dt) that minimizes the objective function J2dt ~ 3dt is determined from a known optimization calculation: J2dt ~ 3 dt = Wy · (y min (X (3dt), 3dt) - Y (3dt)) 2 + Wu · u (2dt) 2 (11).

Da es zu dem Zeitpunkt 3dt zwei Minima gibt, erhält man zwei Umfahrungssteuerbeträge u(2dt).There if there are two minima at time 3dt, you get two Bypass control amounts u (2dt).

Während der Perioden nach dem Zeitpunkt 3dt werden ähnliche Zielfunktionen vorgegeben und Umfahrungssteuerbeträge festgestellt. Während einer Periode von (n – 1)dt bis ndt zum Beispiel wird eine Zielfunktion J(n – 1)dt~ndt durch die nachfolgende Formel (12) vorgegeben, und ein Umfahrungssteuerbetrag u((n – 1)dt), der die Zielfunktion J(n – 1)dt~ndt minimiert, wird durch eine bekannte Optimierungsberechnung ermittelt: J(n – 1)dt~ndt = Wy·(ymin(X(ndt), ndt) – Y(ndt))2 + Wu·u((n – 1)dt)2 (12). During the periods after time 3dt, similar objective functions are specified and detour control amounts are determined. During a period of (n - 1) dt to ndt, for example, is an objective function J (n - 1) dt ~ ndt by the following formula (12) is predetermined, and a bypass control amount u ((n - 1) dt) of the Target function J (n - 1) dt - ndt minimized, is determined by a known optimization computation: J (n - 1) dt ~ ndt = Wy · (y min (X (ndt), ndt) - Y (ndt)) 2 + Wu · u ((n - 1) dt) 2 (12).

Anschließend wird in einem Schritt S112 eine Risikofunktion R(t) jeder Route, die bei Bewegung des Fahrzeugs 1 um den Umfahrungssteuerbetrag u(t) vorgesehen wird, anhand der nachfolgenden Formel (13) vorgegeben: R(t) = RLinie + RHindernis (13). Subsequently, in step S112, a risk function R (t) of each route is determined when the vehicle is moving 1 is provided to the bypass control amount u (t), given by the following formula (13): R (t) = R line + R obstacle (13).

Hierbei handelt es sich bei RLinie und bei RHindernis um mit den vorstehend genannten Ausdrücken (1) und (2) vorgesehene Werte, wenn sich das Fahrzeug 1 um den Umfahrungssteuerbetrag u(t) bewegt. Diese Werte ergeben sich durch die folgenden Ausdrücke: RLinie = KLinieY(t)2 (14) RHindernis = KHindernis·exp(–(xHindernis(t) – x(t))2/2·δxHindernis 2))((yHindernis(t) – Y(t))2/2·σ yHindernis 2)) (15). These are R line and R Hin to values provided with the above expressions (1) and (2) when the vehicle 1 is moved by the deflection control amount u (t). These values are given by the following expressions: R line = K line Y (t) 2 (14) R obstacle = K obstacle * Exp (- (x obstacle (t) - x (t)) 2 / 2 * Ax obstacle 2 )) ((Y obstacle (t) - Y (t)) 2 / 2 · σ y obstacle 2 )) (15).

In einem Schritt S113 wird eine abschließende Ausweichroute R(t)f aus den in dem Schritt S112 vorgegebenen Risikofunktionen (R(t) der Routen ausgewählt. Insbesondere wird für jede der in dem Schritt S112 vorgegebenen Routen der maximale Wert Rmax festgestellt. Der maximale Wert Rmax wird folgendermaßen ausgedrückt: Rmax = max(R(t)) (0 ≤ t ≤ Δt) (16). In a step S113, a final alternate route R (t) f is selected from the risk functions (R (t) of the routes given in step S112 In particular, for each of the routes specified in step S112, the maximum value Rmax is determined Rmax is expressed as follows: Rmax = max (R (t)) (0≤t≤Δt) (16).

Eine Route, bei der der maximale Wert Rmax am geringsten ist, wird als abschließende Ausweichroute R(t)f ausgewählt.A Route where the maximum value Rmax is lowest is called final alternate route R (t) f is selected.

Kumulierte Risikowerte Rsum (= ∫R(t)dt; ganzzahliger Bereich 0 ≤ t ≤ Δt) lassen sich für die Routen auffinden, und eine Route, bei der der Wert am geringsten ist, kann als abschließende Ausweichroute R(t)f ausgewählt werden.cumulative Risk values Rsum (= ∫R (t) dt; integer range 0 ≤ t ≤ Δt) can be found for the routes, and a route, at the value is the lowest, can be considered final Alternative route R (t) f are selected.

Wenn in dem Schritt S112 nur eine Route vorgegeben wird, so wird die Route in dem Schritt S113 als abschließende Ausweichroute R(t)f vorgegeben.If If only one route is specified in step S112, then Route in the step S113 as the final alternative route R (t) f specified.

Bei dem in 7A dargestellten Beispiel werden in dem Schritt S112 eine mit durchgezogener Linie dargestellte Route 1 sowie eine mit unterbrochener Linie dargestellte Route 2 vorgegeben, und eine der Routen 1 und 2, bei der der Maximalwert Rmax kleiner ist oder der kumulierte Risikowert Rsum kleiner ist, wird in dem Schritt S113 als abschließende Ausweichroute R(t)f ausgewählt. Die Umfahrungssteuerbeträge u(t) der Routen 1 und 2 sind in 7B dargestellt.At the in 7A 1, a route 1 shown by a solid line and a route 2 shown by a broken line are set in step S112, and one of the routes 1 and 2 where the maximum value Rmax is smaller or the cumulative risk value Rsum is smaller is set in FIG Step S113 is selected as the final alternate route R (t) f. The deflection control amounts u (t) of the routes 1 and 2 are in 7B shown.

In einem Schritt S114 wird festgestellt, ob ein Bereich mit einem Wert vorhanden ist, der größer oder gleich einem vorgegebenen maximal zulässigen Risikowert Rlim (R(t)f ≥ Rlim) in der abschließenden Ausweichroute R(t)f ist. Wenn ein solcher Bereich nicht vorhanden ist, wird ein Lenksteuerbefehl, der auf dem Umfahrungssteuerbetrag u(t) der abschließenden Ausweichroute R(t)f basiert, in einem Schritt S117 an die automatische Lenksteuervorrichtung 23 ausgegeben, und das Programm endet.In step S114, it is determined whether or not there is an area having a value greater than or equal to a predetermined maximum allowable risk value Rlim (R (t) f ≥ Rlim) in the final alternate route R (t) f. If such a range is not present, a steering control command based on the mileage control amount u (t) of the final avoidance route R (t) f becomes the automatic steering control device in a step S117 23 and the program ends.

Wenn in dem Schritt S114 festgestellt ist, daß ein Bereich vorhanden ist, in dem R(t)f ≥ Rlim ist, werden in einem Schritt S115 ein Bremsstartpunkt Xbremsen und eine Bremssteuerzeit Tbremsen auf der Basis des frühesten Zeitpunkts berechnet, zu dem R(t)f ≥ Rlim ist.If in step S114, it is determined that an area exists is, in which R (t) f ≥ Rlim, in a step S115 a brake start point Xbrake and a brake control time Tbrake on the Based on the earliest time at which R (t) f ≥ Rlim is.

Unter der Annahme, daß der früheste Zeitpunkt, zu dem R(t)f ≥ Rlim beträgt, Tm ist, ergibt sich der Bremsstartpunkt Xbremsen anhand der nachfolgenden Formel (17): Xbremsen = X(Tm) – Bx (17). Assuming that the earliest time at which R (t) f ≥ Rlim is Tm, the brake starting point Xbraking is given by the following formula (17). Xbrakes = X (Tm) - Bx (17).

Dabei stellt Bx einen durch eine vorbestimmte Verzögerung G vorgegebenen Bremsweg dar. Der Bremsweg Bx ergibt sich durch die nachfolgende Formel (18): Bx = (V2/(2·G)) + Bx0 (18). Here, Bx represents a predetermined by a predetermined deceleration G braking distance. The braking distance Bx is given by the following formula (18): Bx = (V 2 / (2 · G)) + Bx0 (18).

Dabei stellt Bx0 eine vorbestimmte Distanz bis zu einem Hindernis beim Stoppen dar und beträgt zum Beispiel ca. 2 m.there Bx0 sets a predetermined distance up to an obstacle Stop and is for example about 2 m.

Der Bremsstartzeitpunkt Tbremsen wird durch umgekehrte Berechnung ausgehend von dem vorstehend beschriebenen Bremsstartpunkt Xbremsen festgestellt.Of the Brake start time T braking is started by reverse calculation from the above-described brake start point Xbrake detected.

In einem Schritt S116 wird ein Bremssteuerbefehl, der auf dem Steuerstartpunkt Xbremsen und der Bremsstartzeit Tbremsen basiert, an die automatische Bremssteuervorrichtung 22 ausgegeben.In a step S116, a brake control command based on the control start point Xbrake and the brake start time Tbrake is sent to the automatic brake control device 22 output.

In einem Schritt S117 wird ein Lenksteuerbefehl auf der Basis des Umfahrungssteuerbetrages u(t) der abschließenden Ausweichroute R(t)f an die automatische Lenksteuervorrichtung 23 ausgegeben, und das Programm endet.In a step S117, a steering control command is issued to the automatic steering control apparatus on the basis of the turning control amount u (t) of the final avoidance route R (t) f 23 and the program ends.

Wie vorstehend beschrieben, wird gemäß dem Ausführungsbeispiel der vorliegenden Erfindung die aktuelle Gesamtrisikofunktion R für jedes der vor dem Fahrzeug vorhandenen Zielobjekte, wie zum Beispiel weiße Linien bzw. Markierungslinien, Abgrenzungen, Seitenbegrenzungen und dreidimensionale Objekte, vorgegeben. Eine zeitliche Veränderung bei der Gesamtrisikofunktion R wird durch Vorhersagen einer zeitlichen Veränderung bei der Position des Zielobjekts vorhergesagt.As described above, according to the embodiment the present invention, the current overall risk function R for each of the target objects present in front of the vehicle, such as white lines or marking lines, boundaries, page boundaries and three-dimensional objects, given. A temporal change in the overall risk function R is determined by predicting a temporal Change in the position of the target predicted.

Auf der Basis der zeitlichen Veränderung bei der Gesamtrisikofunktion R wird ein Minimum ymin(x, t) in der y-Achsen-Richtung an der Position des Fahrzeugs für jeden Zeitpunkt berechnet. Es wird eine Zielfunktion J zu dem Zeitpunkt ermittelt, und ein Umfahrungssteuerbetrag u(t), der die Zielfunktion J minimiert, wird als Umfahrungssteuerbetrag u(t) des Fahrzeugs 1 berechnet. Anschließend wird eine Risikofunktion R(t), die bei Bewegung des Fahrzeugs 1 um den Umfahrungssteuerbetrag u(t) bereitgestellt wird, für jede Route vorgegeben.Based on the temporal change in the total risk function R, a minimum y min (x, t) in the y-axis direction is calculated at the position of the vehicle for each time point. An objective function J at the time is determined, and a bypass control amount u (t) that minimizes the objective function J is used as the vehicle's deflection control amount u (t) 1 calculated. Subsequently, a risk function R (t) is generated during movement of the vehicle 1 is provided for the roundabout control amount u (t) for each route.

Eine abschließende Ausweichroute R(t)f wird aus den Risikofunktionen R(t) der Routen ausgewählt. Der Lenkvorgang wird auf der Basis des Umfahrungssteuerbetrages u(t) der abschließenden Ausweichroute R(t)f gesteuert, und ein Bremsvorgang wird auf der Basis der Werte der abschließenden Ausweichroute R(t)f gesteuert. Aus diesem Grund läßt sich eine Kollisionsvermeidungssteuerung erzielen, bei der nicht nur ein unmittelbares Risiko, sondern auch zukünftige Risiken berücksichtigt werden.A final alternate route R (t) f becomes the risk functions R (t) of the routes selected. The steering process is on the Base of the diversion control amount u (t) of the final alternative route R (t) f is controlled, and a braking operation is based on the values the final alternate route R (t) f controlled. For this reason a collision avoidance control can be achieved achieve not only an immediate risk, but also future risks are taken into account.

Wenn die aktuellen Gesamtrisikofunktionen R für Markierungslinien, Abgrenzungen, Seitenbegrenzungen und dreidimensionale Objekte vorgegeben sind, die vor dem Fahrzeug vorhanden sind, werden die aktuellen Risiken für die Zielobjekte als Risikofunktionen RLinie und RHindernis festgestellt. Das aktuelle Risiko RHindernis für ein dreidimensionales Objekt wird derart korrigiert, daß es mit steigender Relativgeschwindigkeit Vs in der Richtung, in der sich das dreidimensionale Objekt dem Fahrzeug 1 nähert, zunimmt, und somit mit zunehmender Beschleunigung (dVs/dt) in der Richtung, in der sich das dreidimensionale Objekt dem Fahrzeug 1 nähert, zunimmt.Given the current overall risk R functions for mark lines, boundaries, side boundaries, and three-dimensional objects that exist in front of the vehicle, the current risks to the target objects are identified as risk functions R line and R obstacle . The current risk R obstacle for a three-dimensional object is corrected such that it increases with increasing relative speed Vs in the direction in which the three-dimensional object is the vehicle 1 approaches, and thus with increasing acceleration (dVs / dt) in the direction in which the three-dimensional object the vehicle 1 approaching, increasing.

Aus diesem Grund ist es möglich, das Fahrzeug 1 derart zu steuern, daß dieses in natürlicherer Weise eine optimale Route nimmt und dadurch die Sicherheit verbessert werden kann, während ferner die relative Bewegung zwischen dem Fahrzeug 1 und dem Hindernis exakt berücksichtigt wird.For this reason it is possible to use the vehicle 1 to control such that it more naturally takes an optimal route and thereby the safety can be improved, while also the relative movement between the vehicle 1 and the obstacle is exactly considered.

Während bei dem vorliegenden Ausführungsbeispiel sowohl eine Bremssteuerung als auch eine Lenksteuerung auf der Basis der abschließenden Ausweichroute R(t)f ausgeführt werden können, kann auch entweder nur eine Bremssteuerung oder eine Lenksteuerung vorgenommen werden.While in the present embodiment both a brake control as well as a steering control based on the final Alternative route R (t) f can be executed also made either only a brake control or a steering control become.

Die bei dem vorliegenden Ausführungsbeispiel verwendete Bremssteuerung dient lediglich der Erläuterung. Eine weitere Bremssteuerung, bei der zum Beispiel die Benzinzufuhr gedrosselt wird und bei einem Automatikgetriebe auf niedrigere Gänge geschaltet wird, kann in Kombination vorgenommen werden.The Brake control used in the present embodiment is for explanation only. Another brake control, in which, for example, the gasoline supply is throttled and at a Automatic transmission is switched to lower gears, can be done in combination.

Während bei dem vorliegenden Ausführungsbeispiel eine äußere Umgebung auf der Basis des von der Stereokamera 3 aufgenommenen Bildes erkannt wird, kann diese auch mit einer einäugigen Kamera, einem Millimeterwellen-Radar oder dergleichen erfaßt werden.While in the present embodiment, an external environment based on that of the stereo camera 3 recorded image is detected with a one-eyed camera, a millimeter-wave radar or the like.

Während die aktuelle Gesamtrisikofunktion R für jede der Markierungslinien, dreidimensionalen Objekte und dergleichen vorgegeben wird, die vor dem Fahrzeug 1 vorhanden ist, und ferner bei dem vorliegenden Ausführungsbeispiel eine zeitliche Veränderung bei der Gesamtrisikofunktion R vorhergesagt wird, können das Vorgeben der Gesamtrisikofunktion R und das Vorhersagen der zeitlichen Veränderung von dieser auch für dreidimensionale Objekte ausgeführt werden, die seitlich neben sowie rückseitig von dem Fahrzeug 1 vorhanden sind.While the current overall risk function R is set for each of the marker lines, three-dimensional objects, and the like, in front of the vehicle 1 Furthermore, in the present embodiment, a temporal change in the total risk function R is predicted, the prediction of the overall risk function R and the prediction of the time variation thereof can also be performed for three-dimensional objects laterally beside and rear of the vehicle 1 available.

Während bei dem vorliegenden Ausführungsbeispiel eine Ausweichroute während der Vorwärtsbewegung des Fahrzeugs 1 generiert wird, kann diese auch bei einer Rückwärtsfahrt des Fahrzeugs 1 generiert werden, indem eine rückseitig von dem Fahrzeug 1 vorhandene Umgebung ausgewertet wird.While in the present embodiment, an escape route during the forward movement of the vehicle 1 This can also be generated during a reverse drive of the vehicle 1 be generated by a back of the vehicle 1 existing environment is evaluated.

Während bei dem vorliegenden Ausführungsbeispiel das aktuelle Risiko RHindernis für ein dreidimensionales Objekt in Abhängigkeit von der relativen Geschwindigkeit Vs und der relativen Beschleunigung (dVs/dt) in bezug auf das Fahrzeug 1 korrigiert wird, kann auch eine Korrektur in Abhängigkeit nur von der relativen Geschwindigkeit Vs oder nur von der relativen Beschleunigung (dVs/dt) erfolgen.In the present embodiment, while the current risk R obstructs a three-dimensional object depending on the relative velocity Vs and the relative acceleration (dVs / dt) with respect to the vehicle 1 is corrected, a correction can be made depending only on the relative speed Vs or only on the relative acceleration (dVs / dt).

11
Fahrzeugvehicle
22
FahrunterstützungssystemDriving assistance system
33
Stereokamerastereo camera
44
Stereobild-ErkennungsvorrichtungStereo image recognition device
55
Steuereinheitcontrol unit
1111
FahrzeuggeschwindigkeitssensorVehicle speed sensor
1212
GierratensensorYaw rate sensor
1313
Hauptschaltermain switch
2121
Anzeigedisplay
2222
automatische Bremssteuervorrichtungautomatic Brake control device
2323
automatische Lenksteuervorrichtungautomatic Steering control device

ZITATE ENTHALTEN IN DER BESCHREIBUNGQUOTES INCLUDE IN THE DESCRIPTION

Diese Liste der vom Anmelder aufgeführten Dokumente wurde automatisiert erzeugt und ist ausschließlich zur besseren Information des Lesers aufgenommen. Die Liste ist nicht Bestandteil der deutschen Patent- bzw. Gebrauchsmusteranmeldung. Das DPMA übernimmt keinerlei Haftung für etwaige Fehler oder Auslassungen.This list The documents listed by the applicant have been automated generated and is solely for better information recorded by the reader. The list is not part of the German Patent or utility model application. The DPMA takes over no liability for any errors or omissions.

Zitierte PatentliteraturCited patent literature

  • - JP 2004-110346 A [0003] - JP 2004-110346 A [0003]

Claims (9)

Fahrunterstützungssystem für Fahrzeuge, wobei das Fahrunterstützungssystem folgendes aufweist: eine Umgebungserkennungseinrichtung (4) zum Erkennen einer äußeren Umgebung eines Fahrzeugs; eine Risikovorgabeeinrichtung (5) zum Vorgeben eines aktuellen Risikos für ein Objekt in der erkannten äußeren Umgebung; eine Risikoänderungs-Vorhersageeinrichtung zum Vorhersagen einer zeitlichen Veränderung bei dem korrigierten Risiko unter Vorhersage einer zeitlichen Veränderung in der Position des Objekts; eine Minimum-Berechnungseinrichtung (5) zum Berechnen eines Minimums des Risikos bei einer Position des Fahrzeugs zu einem jeweiligen Zeitpunkt auf der Basis der vorhergesagten zeitlichen Veränderung bei dem Risiko; eine Umfahrungssteuerbetrag-Berechnungseinrichtung (5) zum Berechnen eines Umfahrungssteuerbetrags des Fahrzeugs auf der Basis von zumindest dem Minimum; und eine Ausweichrouten-Bestimmungseinrichtung (5) zum Bestimmen einer abschließenden Ausweichroute durch Generieren einer Ausweichroute des Fahrzeugs auf der Basis des Umfahrungssteuerbetrages.A driving support system for vehicles, the driving support system comprising: an environment recognition device ( 4 ) for recognizing an external environment of a vehicle; a risk provision facility ( 5 ) for specifying a current risk for an object in the detected external environment; a risk change predictor for predicting a time change in the corrected risk while predicting a temporal change in the position of the object; a minimum calculation device ( 5 ) for calculating a minimum of the risk at a position of the vehicle at a respective time based on the predicted time change in the risk; a bypass control amount calculating means ( 5 ) for calculating a turning-around control amount of the vehicle based on at least the minimum; and an alternative route determining device ( 5 ) for determining a final alternate route by generating an alternate route of the vehicle based on the bypass control amount. Fahrunterstützungssystem nach Anspruch 1, bei dem mindestens eine Einrichtung vorhanden ist von: einer Lenksteuereinrichtung (23) zum Steuern des Lenkvorgangs auf der Basis des Umfahrungssteuerbetrages des Fahrzeugs auf der abschließenden Ausweichroute; und einer Bremssteuereinrichtung (22) zum Steuern des Bremsvorgangs auf der Basis des Risikos in der abschließenden Ausweichroute.A driving support system according to claim 1, wherein at least one means is provided by: a steering control device ( 23 ) for controlling the steering operation based on the turning amount of the vehicle on the final avoidance route; and a brake control device ( 22 ) for controlling the braking operation based on the risk in the final evasive route. Fahrunterstützungssystem nach Anspruch 1 oder 2, dadurch gekennzeichnet, daß die Umfahrungssteuerbetrag-Berechnungseinrichtung (5) eine Zielfunktion zu einem jeweiligen Zeitpunkt auf der Basis einer Abweichung zwischen einer late ralen Position des Fahrzeugs und dem Minimum sowie dem Umfahrungssteuerbetrag zu dem Zeitpunkt bildet und als Umfahrungssteuerbetrag des Fahrzeugs einen Umfahrungssteuerbetrag berechnet, bei dem die Zielfunktion zu dem Zeitpunkt minimiert ist.Driving support system according to claim 1 or 2, characterized in that said bypass control amount calculating means (16) 5 ) forms an objective function at a respective time on the basis of a deviation between a lateral position of the vehicle and the minimum and the deflection control amount at the time, and calculates a deflection control amount as the deflection control amount of the vehicle at which the objective function at the time is minimized. Fahrunterstützungssystem nach einem der Ansprüche 1 bis 3, dadurch gekennzeichnet, daß die Minimum-Berechnungseinrichtung das Minimum des Risikos durch partielle Differenzierung in einer Breitenrichtung des Fahrzeugs berechnet.Driving support system according to one of the claims 1 to 3, characterized in that the minimum calculating means the minimum of risk through partial differentiation in one Width direction of the vehicle calculated. Fahrunterstützungssystem nach einem der Ansprüche 1 bis 4, dadurch gekennzeichnet, daß dann, wenn es sich bei dem Objekt um eine Markierungslinie handelt, die Risikovorgabeeinrichtung (5) das Risiko derart vorgibt, daß dieses etwa von dem Zentrum einer Fahrspur in Richtung auf die Markierungslinie zunimmt.Driving support system according to one of claims 1 to 4, characterized in that, when the object is a marking line, the risk provisioning device ( 5 ) sets the risk such that it increases approximately from the center of a lane toward the marker line. Fahrunterstützungssystem nach einem der Ansprüche 1 bis 5, dadurch gekennzeichnet, daß dann, wenn es sich bei dem Objekt um ein dreidimensionales Objekt handelt, die Risikovorgabeeinrichtung (5) das Risiko in einer Wahrscheinlichkeitsverteilung vorgibt.Driving support system according to one of claims 1 to 5, characterized in that, when the object is a three-dimensional object, the risk provisioning device ( 5 ) specifies the risk in a probability distribution. Fahrunterstützungssystem nach einem der Ansprüche 1 bis 6, dadurch gekennzeichnet, daß es ferner eine Risikokorrektureinrichtung (5) aufweist zum Korrigieren des von der Risikovorgabeeinrichtung (5) vorgegebenen aktuellen Risikos in Abhängigkeit von mindestens einem Parameter von einer relativen Geschwindigkeit und einer relativen Beschleunigung zwischen dem Objekt und dem Fahrzeug.Driving support system according to one of claims 1 to 6, characterized in that it further comprises a risk correction device ( 5 ) for correcting the risk provisioning facility ( 5 ) given current risk as a function of at least one parameter of a relative speed and a relative acceleration between the object and the vehicle. Fahrunterstützungssystem nach Anspruch 7, dadurch gekennzeichnet, daß die Risikokorrektureinrichtung (5) das von der Risikovorgabeeinrichtung (5) vorgegebene aktuelle Risiko in Abhängigkeit von der relativen Geschwindigkeit zwischen dem Objekt und dem Fahrzeug korrigiert, so daß das aktuelle Risiko mit zunehmender relativer Geschwindigkeit in einer Richtung, in der sich das Objekt dem Fahrzeug nähert, zunimmt.Driving support system according to claim 7, characterized in that the risk-correcting device ( 5 ) from the risk provisioning institution ( 5 ) corrected current risk in dependence on the relative speed between the object and the vehicle, so that the current risk increases with increasing relative speed in a direction in which the object approaches the vehicle. Fahrunterstützungssystem nach Anspruch 7, dadurch gekennzeichnet, daß die Risikokorrektureinrichtung (5) das von der Risikovorgabeeinrichtung (5) vorgegebene aktuelle Risiko in Abhängigkeit von der relativen Beschleunigung zwischen dem Objekt und dem Fahrzeug korrigiert, so daß das aktuelle Risiko mit steigender relativer Beschleunigung in einer Richtung, in der sich das Objekt dem Fahrzeug nähert, zunimmt.Driving support system according to claim 7, characterized in that the risk-correcting device ( 5 ) from the risk provisioning institution ( 5 ) corrected current risk in dependence on the relative acceleration between the object and the vehicle, so that the current risk increases with increasing relative acceleration in a direction in which the object approaches the vehicle.
DE102008027590.5A 2007-06-12 2008-06-10 Driving assistance system for vehicles Active DE102008027590B4 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2007155635A JP4970156B2 (en) 2007-06-12 2007-06-12 Vehicle driving support device
JP2007-155635 2007-06-12

Publications (2)

Publication Number Publication Date
DE102008027590A1 true DE102008027590A1 (en) 2009-01-08
DE102008027590B4 DE102008027590B4 (en) 2019-11-14

Family

ID=40092707

Family Applications (1)

Application Number Title Priority Date Filing Date
DE102008027590.5A Active DE102008027590B4 (en) 2007-06-12 2008-06-10 Driving assistance system for vehicles

Country Status (2)

Country Link
JP (1) JP4970156B2 (en)
DE (1) DE102008027590B4 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018072908A1 (en) * 2016-10-17 2018-04-26 Connaught Electronics Ltd. Controlling a vehicle for human transport with a surround view camera system
US10733892B2 (en) 2012-09-04 2020-08-04 Magna Electronics Inc. Driver assistant system using influence mapping for conflict avoidance path determination
US20220017086A1 (en) * 2020-07-15 2022-01-20 Toyota Research Institute, Inc. Systems and methods for using r-functions and semi-analytic geometry for lane keeping in trajectory planning

Families Citing this family (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5065151B2 (en) * 2008-05-19 2012-10-31 株式会社アドヴィックス Vehicle motion control apparatus and vehicle motion control method
JP5282590B2 (en) * 2009-01-30 2013-09-04 日産自動車株式会社 Vehicle driving support device and vehicle driving support method
KR101154277B1 (en) 2009-04-21 2012-06-13 주식회사 피엘케이 테크놀로지 Perceiving the direction indication Device and method for vehicle
JP5287746B2 (en) * 2009-05-21 2013-09-11 日産自動車株式会社 Driving support device and driving support method
JP5824968B2 (en) * 2011-08-24 2015-12-02 日産自動車株式会社 Travel control device
JP5527382B2 (en) * 2012-10-12 2014-06-18 トヨタ自動車株式会社 Driving support system and control device
DE102013225057A1 (en) * 2013-12-05 2015-06-11 Fraunhofer-Gesellschaft zur Förderung der angewandten Forschung e.V. METHOD FOR CONTROLLING A VEHICLE, DEVICE FOR PRODUCING CONTROL SIGNALS FOR A VEHICLE AND VEHICLE
JP2016001170A (en) * 2014-05-19 2016-01-07 株式会社リコー Processing unit, processing program and processing method
KR101678089B1 (en) 2015-03-19 2016-11-23 현대자동차주식회사 Vehicle and controlling method thereof
US9771071B2 (en) 2015-11-19 2017-09-26 Ford Global Technologies, Llc Dynamic lane positioning for improved biker safety
JP6688656B2 (en) * 2016-03-31 2020-04-28 株式会社Subaru Surrounding risk display device
JP6638556B2 (en) * 2016-05-20 2020-01-29 アイシン・エィ・ダブリュ株式会社 Automatic driving support device and computer program
JP6580087B2 (en) * 2017-06-02 2019-09-25 本田技研工業株式会社 Traveling track determination device and automatic driving device
JP6859902B2 (en) 2017-08-31 2021-04-14 トヨタ自動車株式会社 Vehicle control unit
US11360442B2 (en) * 2019-01-31 2022-06-14 Morgan Stanley Services Group Inc. Exposure minimization response by artificial intelligence
JP7388238B2 (en) * 2020-02-21 2023-11-29 トヨタ自動車株式会社 driving assistance system
JP7268629B2 (en) * 2020-03-23 2023-05-08 トヨタ自動車株式会社 driving support system
CN113467438B (en) * 2020-03-31 2023-07-18 华为技术有限公司 Path planning method, device, controller and moving object
US20230152791A1 (en) * 2021-11-12 2023-05-18 Nec Laboratories America, Inc. Multi-modality data analysis engine for defect detection

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004110346A (en) 2002-09-18 2004-04-08 Nissan Motor Co Ltd Vehicle driving operation assist device, vehicle driving operation assist method, and vehicle applying the method

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE3830790A1 (en) * 1988-09-09 1990-03-15 Freund Eckhard METHOD AND DEVICE FOR AUTOMATIC COLLISION AVOIDANCE FOR AUTOMATICALLY DRIVABLE VEHICLES
DE3830747A1 (en) * 1988-09-09 1990-03-22 Freund Eckhard METHOD AND DEVICE FOR AUTOMATICALLY GUIDING THE LONGITUDINAL AND LATERAL MOVEMENTS OF A VEHICLE
JP3210121B2 (en) * 1992-02-10 2001-09-17 本田技研工業株式会社 Obstacle avoidance route search method for moving objects
DE10036276A1 (en) * 2000-07-26 2002-02-07 Daimler Chrysler Ag Automatic braking and steering system for a vehicle
JP3885716B2 (en) * 2002-11-21 2007-02-28 日産自動車株式会社 Recommended operation amount generator for vehicles
JP4604683B2 (en) * 2004-11-25 2011-01-05 日産自動車株式会社 Hazardous situation warning device
WO2006070865A1 (en) * 2004-12-28 2006-07-06 Kabushiki Kaisha Toyota Chuo Kenkyusho Vehicle motion control device
US8355842B2 (en) * 2005-09-15 2013-01-15 Continental Teves Ag & Co. Ohg Method and device for steering a motor vehicle
JP5130638B2 (en) * 2006-03-22 2013-01-30 日産自動車株式会社 Avoidance operation calculation device, avoidance control device, vehicle including each device, avoidance operation calculation method, and avoidance control method

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004110346A (en) 2002-09-18 2004-04-08 Nissan Motor Co Ltd Vehicle driving operation assist device, vehicle driving operation assist method, and vehicle applying the method

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10733892B2 (en) 2012-09-04 2020-08-04 Magna Electronics Inc. Driver assistant system using influence mapping for conflict avoidance path determination
US11663917B2 (en) 2012-09-04 2023-05-30 Magna Electronics Inc. Vehicular control system using influence mapping for conflict avoidance path determination
WO2018072908A1 (en) * 2016-10-17 2018-04-26 Connaught Electronics Ltd. Controlling a vehicle for human transport with a surround view camera system
US20220017086A1 (en) * 2020-07-15 2022-01-20 Toyota Research Institute, Inc. Systems and methods for using r-functions and semi-analytic geometry for lane keeping in trajectory planning
US11584371B2 (en) * 2020-07-15 2023-02-21 Toyota Research Institute, Inc. Systems and methods for using R-functions and semi-analytic geometry for lane keeping in trajectory planning

Also Published As

Publication number Publication date
DE102008027590B4 (en) 2019-11-14
JP4970156B2 (en) 2012-07-04
JP2008307951A (en) 2008-12-25

Similar Documents

Publication Publication Date Title
DE102008027590B4 (en) Driving assistance system for vehicles
EP3160813B1 (en) Method for producing a model of the surroundings of a vehicle
DE102009043458B4 (en) Driving assistance system for vehicles
EP3281830A1 (en) Control system and control method for determining a trajectory and for generating associated signals or control commands
DE102018129197B4 (en) Traffic signal detection device and system for autonomous driving
DE112010003874B4 (en) vehicle control
EP3281831A1 (en) Control system and control method for determining a likelihood of a lane change by a preceding vehicle
DE102017100633B4 (en) PREVENTION SAFETY DEVICE FOR CHANGING THE PRICE OF A SMALL VEHICLE
DE102009017431B4 (en) Driving assistance system for vehicles
DE102012104766B4 (en) Lane detection using lane mark identification for lane centering / tracking
DE602004000990T2 (en) Driver assistance system for vehicles
EP2883769B2 (en) Method and device for the lateral guidance of a motor vehicle, in particular for assisting evasive action
DE102018111778A1 (en) Method, apparatus and system for controlling a vehicle passing an intersection.
DE112017001198T5 (en) CHANGE CONTROL DEVICE AND CHANGE CONTROL METHOD
DE102010038097A1 (en) Vehicle driving support control device
DE102013017212A1 (en) Motor vehicle and method for controlling a motor vehicle
EP2676857A2 (en) Method and apparatus for generating a control parameter for a gap assistance system of a vehicle
DE102010061829A1 (en) Method and distance control device for avoiding collisions of a motor vehicle in a driving situation with a small side clearance
DE102009014587A1 (en) Drive assist system for a vehicle
DE102013200132A1 (en) Lane keeping system with active rear wheel steering
DE102017212607A1 (en) Method and device for environment-based adaptation of driver assistance system functions
DE102010050167A1 (en) Method and device for determining a plausible lane for guiding a vehicle and motor vehicles
WO2015000882A1 (en) Assistance system and assistance method for support when controlling a motor vehicle
DE102013205882A1 (en) Method and device for guiding a vehicle around an object
DE102016115405B4 (en) CONTROL DEVICE FOR DRIVING A VEHICLE

Legal Events

Date Code Title Description
8110 Request for examination paragraph 44
R016 Response to examination communication
R081 Change of applicant/patentee

Owner name: SUBARU CORPORATION, JP

Free format text: FORMER OWNER: FUJI JUKOGYO K.K., TOKIO/TOKYO, JP

R082 Change of representative

Representative=s name: MEISSNER BOLTE PATENTANWAELTE RECHTSANWAELTE P, DE

R016 Response to examination communication
R018 Grant decision by examination section/examining division
R020 Patent grant now final
R079 Amendment of ipc main class

Free format text: PREVIOUS MAIN CLASS: G05D0001020000

Ipc: G05D0001430000