DE102015010167B4 - Berechnung einer Solltrajektorie - Google Patents
Berechnung einer Solltrajektorie Download PDFInfo
- Publication number
- DE102015010167B4 DE102015010167B4 DE102015010167.6A DE102015010167A DE102015010167B4 DE 102015010167 B4 DE102015010167 B4 DE 102015010167B4 DE 102015010167 A DE102015010167 A DE 102015010167A DE 102015010167 B4 DE102015010167 B4 DE 102015010167B4
- Authority
- DE
- Germany
- Prior art keywords
- mass
- vehicle
- spring
- points
- point
- 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.)
- Active
Links
- 238000004364 calculation method Methods 0.000 title claims description 10
- 238000000034 method Methods 0.000 claims abstract description 24
- 238000004088 simulation Methods 0.000 claims description 8
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000000284 resting effect Effects 0.000 claims description 3
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000010485 coping Effects 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 230000006735 deficit Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 238000007781 pre-processing Methods 0.000 description 1
- 230000003313 weakening effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
- B60W30/10—Path keeping
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0019—Control system elements or transfer functions
- B60W2050/0028—Mathematical models, e.g. for simulation
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0019—Control system elements or transfer functions
- B60W2050/0028—Mathematical models, e.g. for simulation
- B60W2050/0031—Mathematical model of the vehicle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo or light sensitive means, e.g. infrared sensors
- B60W2420/403—Image sensing, e.g. optical camera
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18145—Cornering
Abstract
Verfahren zur Berechnung einer Solltrajektorie (S) für ein Fahrzeug (F), wobei sich das Fahrzeug (F) an einer Position (xF) auf einer von zwei Fahrbahnrändern (FR1, FR2) begrenzten Fahrbahn (FA) befindet, wobei die Fahrbahnränder zumindest in einem Bereich um die Position (xF) des Fahrzeugs (F) bekannt sind, dadurch gekennzeichnet, dass – ein Feder-Masse-Modell (FMM) eingeführt wird, – wobei das Feder-Masse-Modell (FFM) mindestens drei Massepunkte (M1–M5) aufweist, – wobei jeder Massepunkt (M1–M5) eine Position auf der Fahrbahn (F) aufweist, – wobei die Positionen der Massepunkte (M1–M5) Stützstellen der Solltrajektorie (S) darstellen, – wobei jeder Massepunkt (M1–M5) entlang einer Führungsschiene (F1–F5) beweglich ist, – wobei jede Führungsschiene (F1–F5) senkrecht zu einer mittig zwischen den Fahrbahnrändern (FR1, FR2) verlaufenden Fahrbahnmittellinie (L) ausgerichtet ist und von dem einen Fahrbahnrand (FR1) bis zu dem anderen Fahrbahnrand (FR2) reicht, – wobei die Führungsschienen (F1–F5) entlang der Fahrbahnmittellinie (L) zueinander vorgegebene Abstände aufweisen, – wobei die Führungsschienen (F1–F5) entlang der Fahrbahnmittellinie jeweils einen vorgegebenen Abstand zu einer durch die Position (xF) des Fahrzeugs (F) und senkrecht zur Fahrbahnmittellinie (L) verlaufenden Geraden aufweisen, – wobei jeweils zwei unmittelbar benachbarte Massepunkte (M1–M5) durch ein translatorisches Längsfederelement (LF) mit einer in Richtung einer die beiden Massepunkte (M1–M5) verbindenden Geraden wirkenden attraktiven Federkraft (KL) verbunden sind, – wobei jeweils drei unmittelbar aufeinanderfolgende Massepunkte eine Einheit (E) aus einem vorausgehenden Massepunkt (M2), einem mittleren Massepunkt (M3) und einem nachfolgenden Massepunkt (M4) bilden, – wobei die Massepunkte (M2–M4) jeder Einheit (E) durch ein rotatorisches Längsfederelement (RF) mit einer ein Drehmoment bewirkenden Federkraft (KR) verbunden sind, – wobei ein Drehpunkt (D) des rotatorischen Federelements (RF) mit der Position des mittleren Massepunkts (M3) zusammenfällt, – wobei die Federkraft (KR) des rotatorischen Federelements (RF) von einem Winkel (β) zwischen einer den mittleren Massepunkt (M3) mit dem vorausgehenden Massepunkt (M2) verbindenden ersten Geraden und einer den mittleren Massepunkt mit dem nachfolgenden ...
Description
- Die Erfindung betrifft ein Verfahren zur Berechnung einer Solltrajektorie eines Fahrzeugs.
- Algorithmen zur automatischen Lenkung von Fahrzeugen werden in unterschiedlichen Bereichen der automotiven Industrie eingesetzt, beispielsweise zur Lenkung autonomer Fahrzeuge oder im Rahmen von Simulationen bei der Softwareentwicklung für Fahrzeugsteuergeräte. Derartige Algorithmen beinhalten Regelalgorithmen, um die Fahrtrajektorie des Fahrzeugs an eine Solltrajektorie anzupassen.
- Aus „A springs and masses model for determining the lowest risk path in a threat environment” von M. P. Rowe et al., ANZIAM 3. 50, Seiten C1066–C1079, 2010, ist ein Verfahren bekannt, welches eine Trajektorie durch ein Gefahrengebiet mit einem minimierten Risiko mittels eines Feder-Masse-Modells berechnet. Hierfür werden ein Startpunkt und ein Zielpunkt durch eine Kette aus mehreren aufeinanderfolgenden, mit translatorischen Federelementen verbundenen Massepunkten gebildet und die Gefahrenorte als abstoßende Kräfte auf die Massepunkte berücksichtigt.
- Aus „Race driver model” von F. Braghin et al., Computers and Structures, Vol. 86, Seiten 1503–1516, 2008, ist das Berechnen einer zeitoptimierten Trajektorie für einen vorab bekannten Fahrbahnverlauf bekannt. Die finale zeitoptimierte Trajektorie ergibt sich aus einer Gewichtung einer hinsichtlich der Krümmung minimierten Trajektorie, die möglichst hohe Geschwindigkeiten erlaubt, und einer hinsichtlich der Länge minimierten Trajektorie für eine möglichst kurze Gesamtstrecke.
- Vor diesem Hintergrund besteht die Aufgabe der Erfindung darin, ein Verfahren anzugeben, das den Stand der Technik weiterbildet.
- Die Aufgabe wird durch ein Verfahren mit den Merkmalen des Patentanspruchs 1 gelöst. Vorteilhafte Ausgestaltungen der Erfindung sind Gegenstand von Unteransprüchen.
- Gemäß dem Gegenstand der Erfindung sieht ein Verfahren zur Berechnung einer Solltrajektorie eines Fahrzeugs vor, ein Feder-Masse-Modell einzuführen und zur Berechnung der Solltrajektorie zu verwenden, wobei Positionen von Massepunkten des Feder-Masse-Modells für einen Ruhezustand des Feder-Masse-Modells berechnet werden, wobei die berechneten Positionen der Massepunkte als Stützstellen für die Berechnung einer oder zumindest einen Teil der Massepunkte verbindenden Kurve verwendet werden und wobei die Kurve die Solltrajektorie darstellt. Es versteht sich, dass das Fahrzeug sich an einer Position auf einer von zwei Fahrbahnrändern begrenzten Fahrbahn befindet, wobei die Fahrbahnränder zumindest in einem Bereich um die Position des Fahrzeugs bekannt sind. Das Feder-Masse-Modell weist mindestens drei Massepunkte auf, wobei jeder Massepunkt eine Position auf der Fahrbahn aufweist und die Positionen der Massepunkte Stützstellen der Solltrajektorie darstellen, und wobei jeder Massepunkt entlang einer Führungsschiene beweglich ist, und wobei jede Führungsschiene senkrecht zu einer mittig zwischen den Fahrbahnrändern verlaufenden Fahrbahnmittellinie ausgerichtet ist und von dem einen Fahrbahnrand bis zu dem anderen Fahrbahnrand reicht, wobei die Führungsschienen entlang der Fahrbahnmittellinie zueinander vorgegebene Abstände aufweisen, wobei die Führungsschienen entlang der Fahrbahnmittellinie jeweils einen vorgegebenen Abstand zu einer durch die Position des Fahrzeugs und senkrecht zur Fahrbahnmittellinie verlaufenden Geraden aufweisen, wobei jeweils zwei unmittelbar benachbarte Massepunkte durch ein translatorisches Längsfederelement mit einer in Richtung einer die beiden Massepunkte verbindenden Geraden wirkenden attraktiven Federkraft verbunden sind, wobei jeweils drei unmittelbar aufeinanderfolgende Massepunkte eine Einheit aus einem vorausgehenden Massepunkt, einem mittleren Massepunkt und einem nachfolgenden Massepunkt bilden, wobei die Massepunkte jeder Einheit durch ein rotatorisches Federelement mit einer ein Drehmoment bewirkenden Federkraft verbunden sind, wobei ein Drehpunkt des rotatorischen Federelements mit der Position des mittleren Massepunkts zusammenfällt, wobei die Federkraft des rotatorischen Federelements von einem Winkel zwischen einer den mittleren Massepunkt mit dem vorausgehenden Massepunkt verbindenden ersten Geraden und einer den mittleren Massepunkt mit dem nachfolgenden Massepunkt verbindenden zweiten Geraden abhängt und eine Nullstelle für einen Wert des Winkels von 180° aufweist und wobei das Feder-Masse-Modell einen Ruhezustand bei einer Geschwindigkeit vM = 0 und einer Beschleunigung aM = 0 für alle Massepunkte aufweist wobei das Feder-Masse-Modell für die Berechnung der Solltrajektorie verwendet wird, und wobei die Positionen der Massepunkte für den Ruhezustand des Feder-Masse-Modells berechnet werden, und wobei die berechneten Positionen der zumindest eines Teils der Massepunkte als Stützstellen für die Berechnung einer die Massepunkte verbindenden Kurve verwendet werden, und wobei die Kurve die Solltrajektorie darstellt.
- Es versteht sich, dass mit dem Begriff Fahrbahn bzw. Rand der Fahrbahn auch eine Fahrspur mit Rändern zu verstehen ist. Vorzugsweise umfasst eine Fahrbahn auch eine Fahrspur oder mehrere Fahrspuren, wobei sich in die Fahrspuren auch entgegengesetzt befahren lassen.
- Es sei angemerkt, dass die Solltrajektorie einen für eine zeitoptimierte Bewältigung eines Streckenabschnitts der Fahrbahn die idealerweise abzufahrende Linie angibt. Durch die Kopplung benachbarter Massepunkte mittels translatorischer Längsfederelemente wird ein streckenminimierter Verlauf der Trajektorie angestrebt, während durch die Kopplung mittels rotatorischer Federelemente auf einen krümmungsminimierten Verlauf gezielt wird. Eine Gewichtung zwischen Streckenminimierung und Krümmungsminimierung wird durch das Verhältnis der Steifigkeiten, d. h. der Größe der Federkonstanten der translatorischen Längsfederelemente im Verhältnis zu den Steifigkeiten, d. h. in dem Verhältnis der Größe der Federkonstanten der rotatorischen Federelemente erreicht.
- Mittels der Wahl bzw. Kombination der Steifigkeiten der translatorischen Längsfederelemente und der rotatorischen Federelemente können unterschiedliche Fahrertypen bzw. die von unterschiedlichen Fahrertypen angestrebten Trajektorien als Solltrajektorie erreicht werden. Beispielsweise wird durch steife Drehfedern und steife Längsfedern eine die Kurven schneidende Solltrajektorie erreicht, die einem offensiven Fahrstil entspricht. Ein professioneller, allein auf Zeitoptimierung ausgelegter Fahrstil bzw. eine diesem entsprechende Solltrajektorie wird durch eine Kombination aus steifen Drehfedern und schwächeren Längsfedern erreicht.
- Ein Vorteil des erfindungsgemäßen Verfahrens ist es, dass die Solltrajektorie nicht im Rahmen eines Pre-Processings vor einer Simulation, sondern während der Laufzeit der Simulation selbst berechnet wird. Die Berechnung der Solltrajektorie in Echtzeit ist insbesondere dadurch möglich, dass jeweils nur ein lokaler Streckenverlauf im Bereich der Position des Fahrzeugs berücksichtigt wird. Ferner ist es möglich, Streckenänderungen zu berücksichtigen bzw. eine vorab nicht bekannte Strecke abzufahren. Eine Kenntnis des gesamten Streckenverlaufs im Vorhinein ist nicht notwendig.
- In einer Weiterbildung wird für ein sich bewegendes Fahrzeug zu verschiedenen Zeitpunkten die Position des Fahrzeugs ermittelt und jeweils die Solltrajektorie berechnet. In einer bevorzugten Weiterbildung wird die Position des Fahrzeugs in zeitlichen Abständen kleiner oder gleich 1 ms ermittelt und jeweils die Solltrajektorie berechnet. So wird das Feder-Masse-Modell mit dem Fahrzeug mitbewegt und sichergestellt, dass die Solltrajektorie immer die aktuelle Position des Fahrzeugs bzw. den vor der aktuellen Position liegenden Streckenabschnitt der Fahrbahn berücksichtigt. Ferner wird sichergestellt, dass Änderungen der Fahrbahn in Echtzeit berücksichtigt werden.
- Gemäß einer Weiterbildung werden die zu einem ersten Zeitpunkt berechneten Positionen der Massepunkte als Anfangswerte für die Berechnung der Positionen der Massepunkte zu einem zweiten Zeitpunkt verwendet.
- Gemäß einer anderen Weiterbildung ist ein Anteil der Massepunkte, insbesondere eine Mehrheit der Massenpunkte, hinsichtlich einer Fahrtrichtung vor der Position des Fahrzeugs angeordnet, wobei die restlichen Massepunkte hinsichtlich der Fahrtrichtung nach der Position des Fahrzeugs angeordnet sind. Während die in Fahrtrichtung vor dem Fahrzeug liegenden Massepunkte die idealerweise abzufahrende Strecke anzeigen, helfen die in Fahrtrichtung hinter dem Fahrzeug liegenden Massepunkte den Verlauf der zumindest einen Teil der Massepunkte verbindenden Kurve zeitlich zu stabilisieren.
- In einer alternativen Weiterbildung wird der Ruhezustand mittels numerischen Verfahrens zu Nullstellensuche, beispielsweise eines Newton-Verfahrens oder einer Intervallschachtelung, ermittelt.
- In einer weiteren alternativen Ausführungsform ist jeder Massepunkt mittels mindestens eines translatorischen Querfederelements mit einer senkrecht zur Fahrbahnmittellinie wirkenden Federkraft mit einem der Fahrbahnränder oder einer parallel zu einem Fahrbahnrand oder zur Fahrbahnmittellinie verlaufenden Linie verbunden. Die zusätzlichen Kopplungen der einzelnen Massepunkte mit dem Fahrbahnrand mittels weiterer translatorischen Federn, d. h. den Querfederelementen, stellt sicher, dass der optimierte Streckenverlauf, also die Solltrajektorie, einen ausreichenden Abstand zum Fahrbahnrand einhält. Durch eine große Federkraft der Querfederelemente lässt sich eine Trajektorie eines vorsichtigen Fahrers simulieren, wobei der Fahrer es anstrebt, möglichst in der Mitte der Fahrbahn zu fahren. Eine schwache Federkraft der Querfederelemente oder eine erst bei sehr geringen Abständen zu den Fahrbahnrändern wirkende Federkraft sichert den Verbleib des Fahrzeugs auf der Fahrbahn und lässt gleichzeitig einen deutlich aggressiveren oder auf Zeitoptimierung ausgelegten Fahrstil zu.
- Gemäß einer Weiterbildung weist die Federkraft des translatorischen Querfederelements eine nichtlineare Kennlinie auf. Um einen ausreichenden Abstand von den Fahrbahnrändern einerseits und eine geringe Beeinträchtigung der Bewegung der Massepunkte innerhalb eines Zentralen Bereichs der Fahrbahn andererseits zu gewährleisten, wird die Kennlinie der Federkraft so ausgelegt, dass die Federkraft erst nach dem Unterschreiten eines Mindestabstands zu den Fahrbahnrändern signifikant ansteigt.
- In einer Ausführungsform ist es bevorzugt, dass das Fahrzeug und die Fahrbahn virtuell sind. In einer alternativen Ausführungsform ist das Fahrzeug real und die Fahrbahnränder werden mittels eines Kamerasystems ermittelt.
- Gemäß einer Weiterbildung ist der Abstand zwischen jeweils zwei unmittelbar aufeinanderfolgenden Führungsschienen entlang der Fahrbahnmittellinie eine Funktion der Geschwindigkeit des Fahrzeugs. In einer bevorzugten Weiterbildung ist zusätzlich die Größe der Federkraft, d. h. die Steifigkeit der translatorischen Längsfederelemente umgekehrt proportional zu dem Abstand zwischen zwei unmittelbar aufeinanderfolgenden Führungsschienen. Durch einen zunehmenden Abstand der Führungsschienen wird eine Gesamtlänge der Solltrajektorie vergrößert. Eine Abschwächung der Federkraft gleicht die durch die Abstandsvergrößerung hervorgerufene wachsende Auslenkung der translatorischen Längsfederelemente aus.
- In einer weiteren Ausführungsform wird die Solltrajektorie im Rahmen einer Hardware-in-the-Loop-Simulation berechnet. Unter einer Hardware-in-the-Loop-Simulation ist in Zusammenhang mit der Erfindung insbesondere zu verstehen, dass ein eingebettetes System, beispielsweise ein elektronisches Steuergerät oder eine mechatronische Komponente, über seine Dateneingänge und Datenausgänge mit einem Simulationsrechner verbunden ist, wobei der Simulationsrechner eingerichtet ist, um die reale Umgebung des eingebetteten Systems in harter Echtzeit zu simulieren. Unter harter Echtzeit wird insbesondere verstanden, dass die Berechnungen für die Solltrajektorie unterhalb einer Zeitdauer von 1 ms abgeschlossen sind.
- Die zumindest einen Teil der Massepunkte verbindende Kurve wird in einer Ausführungsform in Form eines stetigen analytischen Ausdrucks, insbesondere eines Polygonzugs oder eines die Massepunkte interpolierenden Polynoms, definiert, in einer anderen Ausführungsform als eine Folge diskreter Punkte, wobei die diskreten Punkte zwischen den Massepunkten angeordnet sind oder deckungsgleich mit zumindest einem Teil der Massepunkte sind.
- Die Erfindung wird nachfolgend unter Bezugnahme auf die Zeichnungen näher erläutert. Hierbei werden gleichartige Teile mit identischen Bezeichnungen beschriftet. Die dargestellten Ausführungsformen sind stark schematisiert, d. h. die Abstände und die lateralen und die vertikalen Erstreckungen sind nicht maßstäblich und weisen, sofern nicht anders angegeben, auch keine ableitbaren geometrischen Relationen zueinander auf. Darin zeigt:
-
1 eine erste schematische Ansicht auf eine erste erfindungsgemäße Ausführungsform eines Feder-Masse-Modells, -
2 eine schematische Ansicht auf eine Einheit von drei Massepunkten des Feder-Masse-Modells der1 , -
3 eine schematische Ansicht einer hinsichtlich der Strecke minimierten Solltrajektorie, -
4 eine schematische Ansicht einer hinsichtlich der Krümmung minimierten Solltrajektorie und -
5 eine schematische Ansicht auf eine zweite erfindungsgemäße Ausführungsform eines Feder-Masse-Modells. - Die Abbildung der
1 zeigt eine schematische Darstellung einer ersten erfindungsgemäßen Ausführungsform eines Feder-Masse-Modells FMM. Das Feder-Masse-Modell FMM ist auf einer Fahrbahn FA angeordnet, wobei die Fahrbahn FA einen ersten Fahrbahnrand FR1, einen zweiten Fahrbahnrand FR2 und eine mittig zwischen dem ersten Fahrbahnrand FR1 und dem zweiten Fahrbahnrand FR2 verlaufende Fahrbahnmittellinie L aufweist. - Das Feder-Masse-Modell weist fünf Massepunkte M1–M5 auf. Jeder Massepunkt M1–M5 ist auf einer Führungsschiene F1–F5 angeordnet, entlang derer er sich bewegen kann. Die Führungsschienen F1–F5 weisen entlang der Fahrbahnmittellinie L vorgegebene Abstände zueinander auf und verlaufen jeweils senkrecht zur Fahrbahnmittellinie L von dem ersten Fahrbahnrand FR1 bis zu dem zweiten Fahrbahnrand FR2, so dass die Massepunkte M1–M5 jeweils nur innerhalb der Fahrbahn FA und nur senkrecht zur Fahrbahnmittellinie L beweglich sind.
- Jeweils zwei unmittelbar benachbarte Massepunkte M1–M5 sind durch ein translatorisches Längsfederelement LF miteinander verbunden, wobei das translatorische Längsfederelement LF eine Federkraft KL in Richtung einer die jeweils benachbarten Massepunkte M1–M5 verbindenden Geraden ausübt.
- Jeweils drei unmittelbar aufeinanderfolgende Massepunkten M2–M4, also ein vorausgehender Massepunkt M2, ein mittlerer Massepunkt M3 und ein nachfolgender Massepunkt M4 bilden eine Einheit E. Die Massepunkte M2–M4 jeder Einheit E sind durch ein rotatorisches Federelement RF (
2 ) mit einer ein Drehmoment bewirkenden Federkraft KR (1 ) verbunden. Das rotatorische Federelement RF weist einen Drehpunkt D auf, der jeweils mit einer Position des mittleren Massepunkts M3 der Einheit E zusammenfällt. Die Federkraft KR des rotatorischen Federelements RF hängt von einem Winkel β (1 ) zwischen einer ersten und einer zweiten Geraden (nicht dargestellt) ab, wobei die erste Gerade jeweils einen mittleren Massepunkt M3 der Einheit E mit dem vorausgehenden Massepunkt M2 der Einheit E verbindet und die zweite Gerade jeweils den mittleren Massepunkt M3 der Einheit E mit dem nachfolgenden Massepunkt M4 verbindet. Die Federkraft KR weist eine Nullstelle für einen Wert des Winkels β von 180° auf. - Für die Massepunkte M1–M5 wird ein Differentialgleichungssystem aufgestellt, wobei das Feder-Masse-Modell FMM keine Dämpfung aufweist. Das Differentialgleichungssystem wird für einen Ruhezustand gelöst, wobei der Ruhezustand sich dadurch auszeichnet, dass alle Massepunkte M1–M5 in Ruhe sind, also eine Geschwindigkeit vM = 0 und eine Beschleunigung aM = 0 aufweisen. Die sich als Lösung ergebenden Positionen der Massepunkte oder eines Teils der Massepunkte dienen als Stützstellen der Solltrajektorie S. Die gesuchte Solltrajektorie ist eine die Massepunkte oder einen Teil der Massepunkte verbindende Kurve, insbesondere ein Polygonzug oder ein die Massepunkte interpolierendes Polynom. Die Kurve ist entweder in Form eines stetigen analytischen Ausdrucks hinterlegt oder in Form einer Folge diskreter Punkte, wobei die Punkte deckungsgleich mit zumindest einem Teil der Massepunkte oder zwischen den Massepunkten angeordnet sind. Um die Solltrajektorie S eines Fahrzeugs F zu berechnen, das sich an einer Position xF auf der Fahrbahn FA befindet, weisen die Führungsschienen F1–F5 jeweils einen vorgegebenen Abstand zu einer durch die Position xF verlaufenden und zur Fahrbahnmittellinie L senkrechten Geraden auf (
1 ). Bewegt sich das Fahrzeug F mit einer Geschwindigkeit vF, so wird das Feder-Masse-Modell FMM mit dem Fahrzeug F mitbewegt. Die Solltrajektorie S wird hierfür zu unterschiedlichen Zeitpunkte, beispielsweise in zeitlichen Abständen dt, für eine aktuelle Position x + dx des Fahrzeugs F neu berechnet. - In der Abbildung der
3 ist eine Wirkung der translatorischen Längsfederelemente LF des Feder-Masse-Modells FMM skizziert. Dargestellt sind eine Solltrajektorie S und Massepunkte M1–M8 eines um die rotatorischen Federelemente RF reduzierten und ansonsten dem Feder-Masse-Modell FMM der1 und2 entsprechenden zweiten Feder-Masse-Modells. Durch die Federkraft KL der translatorischen Längsfederelemente LF (in3 nicht dargestellt) werden Abstände zwischen den Massepunkten M1–M8 reduziert. Die translatorischen Längsfederelemente LF bewirken dadurch eine Minimierung einer Gesamtlänge der Solltrajektorie S. Ein Verlauf der Solltrajektorie S in3 zeichnet sich durch das „Schneiden” von Kurven aus. - In der Abbildung der
4 ist eine Wirkung der rotatorischen Federelemente RF des Feder-Masse-Modells FMM skizziert. Dargestellt sind eine Solltrajektorie S und Massepunkte M1–M8 eines um die translatorischen Längsfederelemente LF reduzierten und ansonsten dem Feder-Masse-Modell FMM der1 und2 entsprechenden dritten Feder-Masse-Modells. Durch die Federkraft KR der rotatorischen Federelemente RF wird eine Krümmung der für das dritte Feder-Masse-Modell errechneten Solltrajektorie S minimiert. Eine Krümmungsminimierung der Solltrajektorie S ermöglicht es dem Fahrzeug F, die Solltrajektorie S mit einer hohen Geschwindigkeit vF abzufahren. - Eine hinsichtlich der Zeit optimierte Solltrajektorie S wird durch eine Gewichtung aus Streckenminimierung und Krümmungsminimierung erreicht. Erfindungsgemäß erfolgt die Gewichtung mittels der Federkräfte KL der translatorischen Längsfederelemente LF einerseits und der Federkraft KR der rotatorischen Federelemente RF andererseits.
- In der Abbildung der
5 ist eine weitere Ausführungsform eines erfindungsgemäßen Feder-Masse-Modells FMM dargestellt. Im Folgenden werden nur die Unterschiede zu den Abbildungen der1 und2 erläutert. Um einen Abstand einer Solltrajektorie S zu den Fahrbahnrändern FR1, FR2 zu gewährleisten, ist jeder Massepunkt M1–M5 durch eine erste translatorische Querfeder QF1 mit dem ersten Fahrbahnrand FR1 und durch eine zweite translatorische Querfeder QF2 mit dem Fahrbahnrand FR2 verbunden. Die Querfedern QF1, QF2 weisen jeweils eine Federkraft KQ auf, die senkrecht zu der Fahrbahnmittellinie L und damit parallel zu der jeweiligen Führungsschiene F1–F5 wirkt.
Claims (14)
- Verfahren zur Berechnung einer Solltrajektorie (S) für ein Fahrzeug (F), wobei sich das Fahrzeug (F) an einer Position (xF) auf einer von zwei Fahrbahnrändern (FR1, FR2) begrenzten Fahrbahn (FA) befindet, wobei die Fahrbahnränder zumindest in einem Bereich um die Position (xF) des Fahrzeugs (F) bekannt sind, dadurch gekennzeichnet, dass – ein Feder-Masse-Modell (FMM) eingeführt wird, – wobei das Feder-Masse-Modell (FFM) mindestens drei Massepunkte (M1–M5) aufweist, – wobei jeder Massepunkt (M1–M5) eine Position auf der Fahrbahn (F) aufweist, – wobei die Positionen der Massepunkte (M1–M5) Stützstellen der Solltrajektorie (S) darstellen, – wobei jeder Massepunkt (M1–M5) entlang einer Führungsschiene (F1–F5) beweglich ist, – wobei jede Führungsschiene (F1–F5) senkrecht zu einer mittig zwischen den Fahrbahnrändern (FR1, FR2) verlaufenden Fahrbahnmittellinie (L) ausgerichtet ist und von dem einen Fahrbahnrand (FR1) bis zu dem anderen Fahrbahnrand (FR2) reicht, – wobei die Führungsschienen (F1–F5) entlang der Fahrbahnmittellinie (L) zueinander vorgegebene Abstände aufweisen, – wobei die Führungsschienen (F1–F5) entlang der Fahrbahnmittellinie jeweils einen vorgegebenen Abstand zu einer durch die Position (xF) des Fahrzeugs (F) und senkrecht zur Fahrbahnmittellinie (L) verlaufenden Geraden aufweisen, – wobei jeweils zwei unmittelbar benachbarte Massepunkte (M1–M5) durch ein translatorisches Längsfederelement (LF) mit einer in Richtung einer die beiden Massepunkte (M1–M5) verbindenden Geraden wirkenden attraktiven Federkraft (KL) verbunden sind, – wobei jeweils drei unmittelbar aufeinanderfolgende Massepunkte eine Einheit (E) aus einem vorausgehenden Massepunkt (M2), einem mittleren Massepunkt (M3) und einem nachfolgenden Massepunkt (M4) bilden, – wobei die Massepunkte (M2–M4) jeder Einheit (E) durch ein rotatorisches Längsfederelement (RF) mit einer ein Drehmoment bewirkenden Federkraft (KR) verbunden sind, – wobei ein Drehpunkt (D) des rotatorischen Federelements (RF) mit der Position des mittleren Massepunkts (M3) zusammenfällt, – wobei die Federkraft (KR) des rotatorischen Federelements (RF) von einem Winkel (β) zwischen einer den mittleren Massepunkt (M3) mit dem vorausgehenden Massepunkt (M2) verbindenden ersten Geraden und einer den mittleren Massepunkt mit dem nachfolgenden Massepunkt (M4) verbindenden zweiten Geraden abhängt und eine Nullstelle für einen Wert des Winkels (β) von 180° aufweist, – wobei das Feder-Masse-Modell (FMM) einen Ruhezustand bei einer Geschwindigkeit vM = 0 und einer Beschleunigung aM = 0 für alle Massepunkte (M1–M5) aufweist, – wobei das Feder-Masse-Modell (FMM) zur Berechnung der Solltrajektorie (S) verwendet wird, und, – wobei bei der Berechnung der Streckenverlauf im Bereich der Position des Fahrzeugs berücksichtigt wird, und – wobei die Positionen der Massepunkte (M1–M5) für den Ruhezustand des Feder-Masse-Modells (FMM) berechnet werden, und – wobei die berechneten Positionen der zumindest eines Teils der Massepunkte (M1–M5) als Stützstellen für die Berechnung einer die Massepunkte (M1–M5) verbindenden Kurve verwendet werden, und – wobei die Kurve die Solltrajektorie (S) darstellt.
- Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass für ein sich bewegendes Fahrzeug (F) zu verschiedenen Zeitpunkten die Position (xF + dx) des Fahrzeugs (F) ermittelt und jeweils die Solltrajektorie (
5 ) berechnet wird. - Verfahren nach Anspruch 2, dadurch gekennzeichnet, dass die Position (xF + dx) des Fahrzeugs (F) in zeitlichen Abstände (dt) kleiner oder gleich 1 ms ermittelt und jeweils die Solltrajektorie berechnet wird.
- Verfahren nach einem der Ansprüche 2 oder 3, dadurch gekennzeichnet, dass zu einem ersten Zeitpunkt (t1) berechnete Positionen der Massepunkte (M1–M5) als Anfangswerte für die Berechnung von Positionen der Massepunkte (M1–M5) zu einem zweiten Zeitpunkt (t1 + dt) verwendet werden.
- Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass ein Anteil, insbesondere eine Mehrheit, der Massepunkte (M1–M5) hinsichtlich einer Fahrtrichtung vor der Position (xF) des Fahrzeugs (F) angeordnet sind, wobei die restlichen Massepunkte (M1–M5) hinsichtlich der Fahrtrichtung nach der Position (xF) des Fahrzeugs (F) angeordnet sind.
- Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass der Ruhezustand des Feder-Masse-Modells (FMM) mittels eines numerischen Verfahrens zur Nullstellensuche ermittelt wird.
- Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass jeder Massepunkt (M1–M5) mittels mindestens eines translatorischen Querfederelements (QF) mit einer senkrecht zur Fahrbahnmittellinie (L) wirkenden Federkraft (KQ) mit einem der Fahrbahnränder (FR1, FR2) oder einer parallel zu einem Fahrbahnrand (FR1, FR2) oder zur Fahrbahnmittellinie (L) verlaufenden Linie verbunden ist.
- Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass die Federkraft (KQ) des translatorischen Querfederelements (QF) eine nichtlineare Kennlinie aufweist.
- Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass das Fahrzeug (F) und die Fahrbahn (FA) virtuell sind.
- Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass das Fahrzeug (F) real ist und dass die Fahrbahnränder (FR1, FR2) mittels eines Kamerasystems ermittelt werden.
- Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass der Abstand zwischen jeweils zwei unmittelbar aufeinanderfolgenden Führungsschienen (F1–F5) entlang der eine Funktion der Geschwindigkeit (vF) des Fahrzeugs (F) ist.
- Verfahren nach einem der Ansprüche 1 bis 11, dadurch gekennzeichnet, dass die Federkraft (KL) der translatorischen Längsfederelemente (LF) umgekehrt proportional zu dem Abstand zwischen zwei unmittelbar aufeinanderfolgenden Führungsschienen (F1–F5) des Fahrzeugs (F) ist.
- Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass die Solltrajektorie (S) im Rahmen einer Hardware-in-the-Loop-Simulation berechnet wird.
- Verfahren nach Anspruch 1, wobei die Kurve entweder in Form eines stetigen analytischen Ausdrucks, insbesondere eines Polygonzugs oder eines Polynoms, oder in Form einer Folge diskreter Punkte definiert wird.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102015010167.6A DE102015010167B4 (de) | 2015-08-11 | 2015-08-11 | Berechnung einer Solltrajektorie |
US15/234,403 US10204190B2 (en) | 2015-08-11 | 2016-08-11 | Calculating a desired trajectory |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102015010167.6A DE102015010167B4 (de) | 2015-08-11 | 2015-08-11 | Berechnung einer Solltrajektorie |
Publications (2)
Publication Number | Publication Date |
---|---|
DE102015010167A1 DE102015010167A1 (de) | 2017-02-16 |
DE102015010167B4 true DE102015010167B4 (de) | 2017-12-07 |
Family
ID=57907802
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
DE102015010167.6A Active DE102015010167B4 (de) | 2015-08-11 | 2015-08-11 | Berechnung einer Solltrajektorie |
Country Status (2)
Country | Link |
---|---|
US (1) | US10204190B2 (de) |
DE (1) | DE102015010167B4 (de) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102015119201A1 (de) * | 2015-05-11 | 2016-11-17 | Dspace Digital Signal Processing And Control Engineering Gmbh | Verfahren zum Konfigurieren einer Schnittstelleneinheit eines Computersystems |
DE102017120016A1 (de) * | 2017-08-31 | 2019-02-28 | Dspace Digital Signal Processing And Control Engineering Gmbh | Verfahren zur Konfiguration eines zum Testen eines elektronischen Steuergeräts eingerichteten Testgeräts sowie Konfigurationssystem |
CN107767487B (zh) * | 2017-09-05 | 2020-08-04 | 百度在线网络技术(北京)有限公司 | 一种确定数据采集路线的方法与装置 |
US10831636B2 (en) * | 2018-01-08 | 2020-11-10 | Waymo Llc | Software validation for autonomous vehicles |
DE102019123899B3 (de) * | 2019-09-05 | 2020-11-12 | Dr. Ing. H.C. F. Porsche Aktiengesellschaft | Verfahren für autonomes Fahren eines Fahrzeugs |
DE102019123900B3 (de) * | 2019-09-05 | 2020-11-12 | Dr. Ing. H.C. F. Porsche Aktiengesellschaft | Verfahren für optimiertes autonomes Fahren eines Fahrzeugs |
CN112327826B (zh) * | 2020-09-27 | 2023-12-12 | 一汽解放汽车有限公司 | 一种路径规划方法、装置、设备和介质 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7165016B2 (en) * | 2004-06-03 | 2007-01-16 | Canon Kabushiki Kaisha | Simulation apparatus, simulation method therefor, and program for implementing the simulation method |
US10346562B2 (en) * | 2014-08-21 | 2019-07-09 | Dassault Systèmes Canada Inc. | Automated curvature modeling of polygonal lines |
-
2015
- 2015-08-11 DE DE102015010167.6A patent/DE102015010167B4/de active Active
-
2016
- 2016-08-11 US US15/234,403 patent/US10204190B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
US10204190B2 (en) | 2019-02-12 |
US20170045418A1 (en) | 2017-02-16 |
DE102015010167A1 (de) | 2017-02-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
DE102015010167B4 (de) | Berechnung einer Solltrajektorie | |
EP3432203B1 (de) | Prädiktive streckenführung eines fahrzeugs | |
DE102015208790A1 (de) | Bestimmen einer Trajektorie für ein Fahrzeug | |
DE102018215448B3 (de) | Verfahren zur Schätzung der Geometrie eines Bewegungsweges | |
EP3611303B1 (de) | Selbstfahrende baumaschine und verfahren zum steuern einer selbstfahrenden baumaschine | |
WO2017144382A1 (de) | VORRICHTUNG UND VERFAHREN ZUR QUERFÜHRUNGSUNTERSTÜTZUNG FÜR EIN STRAßENGEBUNDENES FAHRZEUG | |
DE102018216082A1 (de) | Verfahren zur kooperativen Manöverabstimmung | |
DE102013207658A1 (de) | Verfahren zum Bestimmen eines Fahrspurverlaufes einer Fahrspur | |
DE112018006899T5 (de) | Vorrichtung zum Erzeugen von Daten eines Fahrweges innerhalb einer Kreuzung, Programm zum Erzeugen von Daten eines Fahrweges innerhalb einer Kreuzung, und Speichermedium | |
DE102018213971A1 (de) | Verfahren und Vorrichtung zur Auswahl eines Fahrmanövers | |
DE102015209066A1 (de) | Aufwandsreduzierte Trajektorienplanung für ein Fahrzeug | |
DE102015015302A1 (de) | Verfahren zum teil- oder vollautonomen Betrieb eines Fahrzeugs und Fahrerassistenzvorrichtung | |
DE102017205040A1 (de) | Verfahren zur Planung von kombinierter Längs- und Querbewegung für Fahrzeuge | |
DE102018204101A1 (de) | Verfahren und Vorrichtung zur Planung einer Trajektorie für die Längs- und/oder Querführung eines Fahrzeugs | |
WO2020002100A1 (de) | Verfahren zum betreiben eines wenigstens teilweise automatisierten fahrzeugs | |
DE102012010553B4 (de) | Verfahren zur Steuerung eines aktiven Fahrwerks | |
DE102013201941A1 (de) | Verfahren und Vorrichtung zum Ermitteln eines Fahrbahnverlaufs | |
EP2871115B1 (de) | Verfahren zum ermitteln einer fahrkurve, steueranordnung zum durchführen des verfahrens und fahrzeug mit einer derartigen steueranordnung | |
EP3627108A1 (de) | Verfahren zur trajektorienplanung eines beweglichen objektes | |
EP3201710B1 (de) | Ein trajektorien-planungsverfahren zur ermittlung eines steuerprofils für ein kraftfahrzeug | |
DE102017124951A1 (de) | Verfahren zum Betrieb eines selbstfahrenden Kraftfahrzeugs und selbstfahrendes Kraftfahrzeug | |
WO2023057014A1 (de) | Verfahren zur planung einer trajektorie eines fahrmanövers eines kraftfahrzeugs, computerprogrammprodukt, computerlesbares speichermedium sowie fahrzeug | |
DE102017220486B4 (de) | Verfahren zur Adaption einer vorbestimmten Referenzlinie für ein Kraftfahrzeug und Vorrichtung | |
WO2021001576A1 (de) | Vorrichtung zum navigieren eines ist-fahrzeugs durch zumindest einen abschnitt einer soll-trajektorie, verfahren und verwendung | |
WO2018041426A1 (de) | Verfahren, vorrichtung, computerprogramm und computerprogrammprodukt zur detektion einer verengung eines fahrwegs eines fahrzeugs |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
R012 | Request for examination validly filed | ||
R016 | Response to examination communication | ||
R018 | Grant decision by examination section/examining division | ||
R020 | Patent grant now final | ||
R081 | Change of applicant/patentee |
Owner name: DSPACE GMBH, DE Free format text: FORMER OWNER: DSPACE DIGITAL SIGNAL PROCESSING AND CONTROL ENGINEERING GMBH, 33102 PADERBORN, DE |
|
R079 | Amendment of ipc main class |
Free format text: PREVIOUS MAIN CLASS: G05D0001020000 Ipc: G05D0001430000 |