GÖHRLE CHRISTOPH (DE)
WO2002020318A1 | 2002-03-14 |
GB2391327A | 2004-02-04 | |||
EP0925967A2 | 1999-06-30 | |||
US5013067A | 1991-05-07 | |||
JP2009276109A | 2009-11-26 | |||
US20140309803A1 | 2014-10-16 | |||
JP2003097945A | 2003-04-03 | |||
GB2510417A | 2014-08-06 | |||
DE102006026937A1 | 2007-01-18 | |||
DE102012024984A1 | 2013-07-04 | |||
DE102012216205A1 | 2013-03-14 | |||
DE102004019928A1 | 2005-11-17 |
Patentansprüche 1. Verfahren zum Kompensieren einer Neigung eines Fahrzeugs (2) in zumindest einer Raumrichtung, - wobei das Fahrzeug (2) einen Aufbau (6) und ein aktives Fahrwerk mit mehreren Rädern (8, 10, 54, 56) aufweist, die sich mit der Fahrbahn (4) in Kontakt befinden, - wobei jedes Rad (8, 10, 54, 56) über einen in seiner Länge verstellbaren Aktor ( 2, 14, 58, 60) an einem dem Rad (8, 10) zugeordneten Aufhängepunkt (50) mit dem Aufbau (6) verbunden ist, - wobei eine Neigung des Aufbaus (6) in die zumindest eine Raumrichtung ermittelt wird, wobei für mindestens zwei Räder (8, 10, 54, 56) je ein vertikaler Abstand zu dem dem jeweiligen Rad (8, 10, 54, 56) zugeordneten Aufhängepunkt (50) des Aufbaus (6) erfasst wird, - wobei über die mindestens zwei ermittelten Abstände eine Neigung des Fahrwerks in die zumindest eine Raumrichtung durch Transformation des vertikalen Abstands der mindestens zwei Räder (8, 10, 54, 56) zu dem Aufbau (6) mit einer Transformationsmatrix berechnet wird, - wobei die Neigung der Fahrbahn (4) in die zumindest eine Raumrichtung aus einer Differenz der Neigung des Aufbaus (6) in die zumindest eine Raumrichtung und der Neigung des Fahrwerks in die zumindest eine Raumrichtung ermittelt wird, - wobei jeweils ein Wert für mindestens einen Winkel φ5, θ5, um den die Fahrbahn (4) in die zumindest eine Raumrichtung geneigt ist, ermittelt wird, - wobei jeweils ein Grenzwert (t>S(iim , 9s>iim für den Wert des mindestens einen Winkels φ5, θ5 vorgegeben wird, - wobei Übersetzungsverhältnisse iVA . *HA für einen Abstand des mindestens einen Aktors (12, 14, 58, 60) bezogen auf den Aufbau (6) und für einen Abstand des mindestens einen Rads (8, 10, 54, 56) bezogen auf den Aufbau (6) berücksichtigt werden, - wobei ein Soll-Wert für eine Änderung der Länge des mindestens einen Aktors (12, 14, 58, 60) durch: = diag vA, IVA» ΪΗΑ. ΪΗΑ)τΤ [ LflösS,'lhimmlJ bestimmt wird. 2. Verfahren nach Anspruch 1 , bei dem die Neigung des Fahrwerks in die mindestens eine Raumrichtung durch Transformation der vertikalen Abstände der mindestens zwei Räder (8, 10, 54, 56) zu einem Schwerpunkt (25) des Aufbaus (6) mit der Transformationsmatrix ermittelt wird, wobei eine eines jeweiligen vorderen Rads (8, 56) von einem Schwerpunkt (25) des Aufbaus (6) in longitudinaler Raumrichtung, eine hintere, longitudinale Strecke lh den Abstand eines jeweiligen hinteren Rads (10, 56) von dem Schwerpunkt (25) in longitudinaler Raumrichtung, eine vordere, transversale Strecke tv den Abstand des vorderen Rads (8, 54) von dem Schwerpunkt (25) in transversaler Raumrichtung und eine hintere, transversale Strecke th den Abstand des hinteren Rads (10, 56) von dem Schwerpunkt (25) in transversaler Raumrichtung beschreibt. 3. Verfahren nach Anspruch 2, bei. dem die Übersetzungsverhältnisse IVA . ΪΗΑ über einen Abstand jeweils eines Aktors (12, 14, 58, 60) von dem Schwerpunkt (25) des Aufbaus (6) und jeweils eines Rads (8,10, 54, 56) von dem Schwerpunkt (25) des Aufbaus (6) berechnet werden. 4. Verfahren nach einem der voranstehenden Ansprüche, bei dem bei Vorliegen einer Steigungsauffahrt ein negativer Nickwinkel 9S und bei Vorliegen einer Steigungsabfahrt ein positiver Nickwinkel 0S ermittelt wird. 5. Verfahren nach einem der voranstehenden Ansprüche, bei dem der jeweilige Grenzwert 0s lim für den Wert des mindestens einen Winkels φ5, θ3 durch: vorgegeben wird. 6. Verfahren nach Anspruch 5, bei dem ein Betrag von 0s min im Fall der Steigungsauffahrt größer als ein Betrag von 6s max im Fall der Steigungsabfahrt gewählt wird. 7. Verfahren nach einem der voranstehenden Ansprüche, bei dem zum Ermitteln der Neigung des Aufbaus (6) ein erstes, aufbaufestes Koordinatensystem (24) und zum Ermitteln der Neigung des Fahrwerks ein zweites fahrwerkfestes Koordinatensystem (26) verwendet wird, und wobei ein drittes, inertiales Koordinatensystem (28) als Referenz- Koordinatensystem verwendet wird, das auf die Gravitationskraft bezogen ist. 8. Verfahren nach Anspruch 7, bei dem die Neigung des Aufbaus (6) bezüglich des Referenz-Koordinatensystems über ein Quaternion beschrieben wird. 9. Verfahren nach einem der voranstehenden Ansprüche, bei dem ein Strapdown-Algorithmus verwendet wird, mit dem vorgesehen ist, dass zum Ermitteln einer korrigierten Beschleunigung des Fahrzeugs (2) eine sensorische gemessene Beschleunigung um eine Zentrifugalbeschleunigung und die Gravitationsbeschleunigung korrigiert wird und daraus eine Geschwindigkeit des Fahrzeugs (2) in einer Ebene bestimmt wird, und dass die Neigung des Aufbaus (6) berechnet wird. 10. System zum Kompensieren einer Neigung eines Fahrzeugs (2) in zumindest einer Raumrichtung, - wobei das Fahrzeug (2) einen Aufbau (6) und ein aktives Fahrwerk mit mehreren Rädern (8, 10, 54, 56) aufweist, die sich mit der Fahrbahn (4) in Kontakt befinden, wobei das System (16) mehrere Sensoren (19, 20, 22) und ein Kontrollgerät (18) aufweist, - wobei jedes Rad (8, 10, 54, 56) über einen in seiner Länge verstellbaren Aktor ( 2, 14, 58, 60) an einem dem Rad (8, 10, 54, 56) zugeordneten Aufhängepunkt (50) mit dem Aufbau (6) verbunden ist, - wobei mindestens ein erster Sensor (19) dazu ausgebildet ist, eine Neigung des Aufbaus (6) in die zumindest eine Raumrichtung zu ermitteln, wobei mindestens ein zweiter Sensor (20, 22) dazu ausgebildet ist, für mindestens zwei Räder (8, 10, 54, 56) je einen vertikalen Abstand zu dem dem jeweiligen Rad (8, 10, 54, 56) zugeordneten Aufhängepunkt (50) des Aufbaus (6) zu erfassen, - wobei das Kontrollgerät (18) dazu ausgebildet ist, über mindestens zwei ermittelte Abstände der mindestens zwei Räder (8, 10, 54 56) eine Neigung des Fahrwerks in die zumindest eine Raumrichtung durch Transformation des vertikalen Abstands der mindestens zwei Räder (8, 10, 54, 56) zu dem Aufbau (6) mit einer Transformationsmatrix zu berechnen, - wobei das Kontrollgerät (18) dazu ausgebildet ist, die Neigung der Fahrbahn (4) in die zumindest eine Raumrichtung aus einer Differenz der Neigung des Aufbaus (6) in die zumindest eine Raumrichtung und der Neigung des Fahrwerks in die zumindest eine Raumrichtung zu ermitteln, und jeweils einen Wert für mindestens einen Winkel φ5, θ5, um den die Fahrbahn (4) in die zumindest eine Raumrichtung geneigt ist, zu ermitteln, - wobei jeweils ein Grenzwert <J>s,ijm, 6s iim für den Wert des mindestens einen Winkels φ5, 0S vorgegeben ist, - wobei das Kontrollgerät (18) dazu ausgebildet ist, Übersetzungsverhältnisse iVA. ΪΗΑ für einen Abstand des mindestens einen Aktors (12, 14, 58, 60) bezogen auf den Aufbau und für einen Abstand des mindestens einen Rads (8, 10, 54, 56) bezogen auf den Aufbau zu berücksichtigen, - wobei das Kontrollgerät (18) dazu ausgebildet ist, einen Soll-Wert für eine Änderung einer Länge des mindestens einen Aktors (12, 14, 58, 60) durch: äkt = diag(ivA, iVA, ΪΗΑ. ΪΗΑ)ΤΤ [£S'LIM zu bestimmen. 11. System nach Anspruch 10, bei dem der mindestens eine zweite Sensor (20, 22) als Abstandssensor ausgebildet ist. |
Die Erfindung betrifft ein Verfahren und ein System zum Kompensieren einer Neigung eines Aufbaus eines Fahrzeugs.
Eine Lage eines Fahrzeugs ändert sich während einer Fahrt in Abhängigkeit einer Neigung bzw. Lage einer Straße, die von dem Fahrzeug befahren wird. Winkel zum Erfassen der Lage des Fahrzeugs können durch Sensoren erfasst werden.
Ein Verfahren zum Steuern eines Systems eines Fahrzeugs ist in der
Druckschrift DE 10 2006 026 937 A1 beschrieben. Dabei wird ein
Stabilitätsindex bestimmt. Außerdem werden ein erster und ein zweiter Beobachter bereitgestellt, die auf Grundlage von Betriebsgrößen des
Fahrzeugs eine Referenz-Quergeschwindigkeit sowie eine
Quergeschwindigkeit bestimmen, aus denen eine Ausgangs- Quergeschwindigkeit sowie eine Ausgangs-Längsgeschwindigkeit bestimmt werden. Ein Verfahren zum Bestimmen einer Soll-Kurvenneigung eines Fahrzeugs beim Befahren eines kurvenförmigen Fahrbahnabschnitts ist aus der
Druckschrift DE 10 2012 024 984 A1 bekannt. Hierbei wird die Soll- Kurvenneigung des Fahrzeugs in Abhängigkeit einer erfassten
Fahrbahnkrümmung bestimmt. Außerdem wird eine optische
Oberflächenbeschaffenheit des kurvenförmigen Fahrbahnabschnitts berücksichtigt.
Ein Verfahren zum Verarbeiten von Sensordaten in einem Fahrzeug ist in der Druckschrift DE 10 2012 216 205 A1 beschrieben, wobei Fahrdynamikdaten und Chassissensordaten des Fahrzeugs erfasst und gefiltert werden. Zudem ist aus der Druckschrift DE 10 2004 019 928 A1 ein Verfahren zur Erkennung einer Hang- oder Steigungssituation für ein Fahrzeug bekannt. Vor diesem Hintergrund werden ein Verfahren und ein System mit den
Merkmalen der unabhängigen Patentansprüche vorgestellt. Ausgestaltungen des Verfahrens und des Systems gehen aus den abhängigen
Patentansprüchen und der Beschreibung hervor. Das erfindungsgemäße Verfahren ist zum Kompensieren einer Neigung eines Fahrzeugs, das eine geneigte Fahrbahn befährt, in zumindest einer Raumrichtung vorgesehen. Das Fahrzeug weist einen Aufbau und ein aktives Fahrwerk mit mehreren Rädern auf, die sich mit der Fahrbahn in Kontakt befinden. Jedes Rad ist über einen in seiner Länge relativ zum Aufbau in vertikaler Richtung verstellbaren Aktor an einem dem Rad zugeordneten Aufhängepunkt mit dem Aufbau verbunden. Bei dem Verfahren wird zunächst eine Neigung des Aufbaus in die zumindest eine Raumrichtung ermittelt, wobei für mindestens zwei Räder je ein vertikaler Abstand zu dem dem jeweiligen Rad zugeordneten Aufhängepunkt des Aufbaus erfasst wird. Über die ermittelten Abstände wird eine Neigung des Fahrwerks in die zumindest eine Raumrichtung durch Transformation des vertikalen Abstands der mindestens zwei Räder zu dem Aufbau mit einer Transformationsmatrix:
berechnet. Außerdem wird die Neigung der Fahrbahn in die zumindest eine Raumrichtung aus einer Differenz der Neigung des Aufbaus in die zumindest eine Raumrichtung und der Neigung des Fahrwerks in die zumindest eine Raumrichtung ermittelt. Darauf basierend wird jeweils ein Wert für
mindestens einen Winkel φ 5 als Wankwinkel und/oder 9 S als Nickwinkel, um den die Fahrbahn in die zumindest eine Raumrichtung geneigt ist, ermittelt. Weiterhin wird jeweils ein Grenzwert <p s ,\ im , Q SiUm für den Wert des mindestens einen Winkels φ 5 , θ 5 vorgegeben. Ergänzend werden
Übersetzungsverhältnisse I V A . ΪΗΑ für einen Abstand des mindestens einen Aktors bezogen auf den Aufbau und für einen Abstand des mindestens einen Rads bezogen auf den Aufbau berücksichtigt. Ein Soll-Wert für eine
Änderung der Länge des mindestens einen Aktors zum Kompensieren der Neigung wird durch:
zakt = diag(i V A» IVA» *HA» ΪΗΑ)Τ τ [ 0 j bestimmt.
Die Neigung des Fahrwerks in die mindestens eine Raumrichtung wird durch Transformation der vertikalen Abstände der mindestens zwei Räder zu dem Aufbau mit der Transformationsmatrix:
ermittelt. Eine vordere, longitudinale Strecke l v beschreibt hierbei einen Abstand eines jeweiligen vorderen Rads von einem Schwerpunkt des
Aufbaus in longitudinaler Raumrichtung. Eine hintere, longitudinale Strecke I h beschreibt den Abstand eines jeweiligen hinteren Rads von dem
Schwerpunkt in longitudinaler Raumrichtung. Eine vordere, transversale Strecke t v beschreibt den Abstand des jeweiligen vorderen Rads von dem Schwerpunkt in transversaler Raumrichtung. Eine hintere, transversale Strecke t h beschreibt den Abstand des jeweiligen hinteren Rads von dem Schwerpunkt in transversaler Raumrichtung.
In Ausgestaltung werden die Übersetzungsverhältnisse i V A. *HA über einen üblicherweise konstanten, messbaren Abstand jeweils eines Aktors von dem Schwerpunkt des Aufbaus und jeweils eines Rads von dem Schwerpunkt des Aufbaus berechnet. Dabei sind für Abstände der Räder die Strecken l v , l h> t v und t h zu berücksichtigen.
Üblicherweise bzw. definitionsgemäß wird bei Vorliegen einer
Steigungsauffahrt ein negativer Nickwinkel 0 S und bei Vorliegen einer Steigungsabfahrt ein positiver Nickwinkel 9 S ermittelt.
Der jeweilige Grenzwert 4> Si ii m , 9 s lim für den Wert des mindestens einen Winkels φ 5 , 6 S der Neigung der Fahrbahn wird im Fall des Neigungswinkels durch: und im Fall des Nickwinkels durch:
vorgegeben.
In der Regel wird ein Betrag von e s min im Fall der Steigungsauffahrt größer als ein Betrag von Θ 5 Π13Χ im Fall der Steigungsabfahrt gewählt.
Im Rahmen des Verfahrens wird zum Ermitteln der Neigung des Aufbaus ein erstes, aufbaufestes Koordinatensystem und zum Ermitteln der Neigung des Fahrwerks ein zweites fahrwerkfestes Koordinatensystem verwendet. Ein drittes, inertiales Koordinatensystem wird als Referenz-Koordinatensystem verwendet, das auf die Gravitationskraft bezogen ist. In Ausgestaltung wird die Neigung des Aufbaus bezüglich des Referenz- Koordinatensystems über ein Quaternion beschrieben.
Außerdem ist möglich, dass ein Strapdown-Algorithmus verwendet wird, mit dem vorgesehen ist, dass zum Ermitteln einer korrigierten Beschleunigung des Fahrzeugs eine sensorisch gemessene Beschleunigung um eine
Zentrifugalbeschleunigung und die Gravitationsbeschleunigung korrigiert wird. Daraus wird eine Geschwindigkeit des Fahrzeugs in einer Ebene bestimmt und die Neigung des Aufbaus berechnet.
Das erfindungsgemäße System ist zum Kompensieren einer Neigung eines Fahrzeugs in zumindest einer Raumrichtung, das eine geneigte Fahrbahn befährt, ausgebildet. Das Fahrzeug weist einen Aufbau und ein aktives Fahrwerk mit mehreren, üblicherweise vier Rädern auf, die sich mit der Fahrbahn in Kontakt befinden. Das System weist mehrere Sensoren und ein Kontrollgerät auf. Jedes Rad ist über einen in seiner Länge verstellbaren Aktor an einem dem Rad zugeordneten Aufhängepunkt mit dem Aufbau verbunden. Mindestens ein erster Sensor ist dazu ausgebildet, eine Neigung des Aufbaus in die zumindest eine Raumrichtung zu ermitteln. Mindestens ein zweiter Sensor ist dazu ausgebildet, für mindestens zwei Räder einen vertikalen Abstand zu dem dem jeweiligen Rad zugeordneten Aufhängepunkt des Aufbaus zu erfassen. Das Kontrollgerät ist dazu ausgebildet, über ermittelte Abstände der mindestens zwei Räder eine Neigung des Fahrwerks in die zumindest eine Raumrichtung durch Transformation des vertikalen Abstands der mindestens zwei Räder zu dem Aufbau mit einer
Transformationsmatrix:
zu berechnen. Außerdem ist das Kontrollgerät dazu ausgebildet, die Neigung der Fahrbahn in die zumindest eine Raumrichtung aus einer Differenz der Neigung des Aufbaus in die zumindest eine Raumrichtung und der Neigung des
Fahrwerks in die zumindest eine Raumrichtung zu ermitteln, und jeweils einen Wert für mindestens einen Winkel φ 3 , 9 S , um den die Fahrbahn in die zumindest eine Raumrichtung geneigt ist, zu ermitteln. Zudem ist
vorgesehen, dass jeweils ein Grenzwert φ 3>Πιτ1 , 0 s lim für den Wert des mindestens einen Winkels <j> s , 0 S vorgegeben ist. Das Kontrollgerät ist zudem dazu ausgebildet, Übersetzungsverhältnisse I V A. *HA für einen Abstand des mindestens einen Aktors bezogen auf den Aufbau und für einen Abstand des mindestens einen Rads bezogen auf den Aufbau zu berücksichtigen.
Weiterhin ist das Kontrollgerät dazu ausgebildet, einen Soll-Wert für eine Änderung einer Länge des mindestens einen Aktors durch:
zakt = diag(i VA , i VA , i HA , I H A)T t fi S lim ]
Lö s ,limJ zu bestimmen.
Der mindestens eine zweite Sensor ist als Abstandssensor ausgebildet, mit dem ein Abstand eines jeweiligen Rads zu dem Aufbau zu ermitteln ist. In Ausgestaltung sind die in ihrer Länge verstellbaren Aktoren ebenfalls als Komponenten des Systems ausgebildet.
Mit dem Verfahren und dem System ist eine Kontrolle und somit eine
Regelung und/oder Steuerung der Horizöntierung bzw. der horizontalen Ausrichtung des Aufbaus des Fahrzeugs bei einer Steigungsauffahrt sowie einer Steigungsabfahrt auf einer zu befahrenden Fahrbahn aber auch bei Vorliegen einer Querneigung der Fahrbahn zu erreichen. Demnach werden Längen der Aktoren bzw. Aktuatoren des aktiven Fahrwerks des Fahrzeugs um die Soll-Werte angepasst und durch Ausrichten der Neigung des Aufbaus eine Neigung der Fahrbahn kompensiert. Dabei ist zunächst zu erkennen, ob das Fahrzeug eine Steigungsauffahrt und somit eine bergauf orientierte Fahrbahn oder eine Steigungsabfahrt und somit eine bergab orientierte Fahrbahn befährt. Darauf basierend wird eine Maßnahme zur horizontalen Ausrichtung des Aufbaus ergriffen, wobei im Fall der
Steigungsauffahrt, bei negativem Nickwinkel, eine stärkere horizontale Ausrichtung des Aufbaus als im Fall der Steigungsabfahrt, bei positivem Nickwinkel, ergriffen wird. Somit ist bei der Steigungsabfahrt die Neigung der Fahrbahn in einem geringeren Maß als im Fall der Steigungsauffahrt zu kompensieren.
Bei einer Steigungsauffahrt wird das Fahrzeug durch die Aktoren hinten angehoben und vorne abgesenkt, wodurch für Insassen des Fahrzeugs eine bessere Sicht und ein erhöhter Komfort zu erreichen sind. Dagegen wird das Fahrzeug bei einer Steigungsabfahrt durch die Aktoren vorne angehoben und hinten abgesenkt, üblicherweise jedoch im geringeren Maße als im Fall einer Steigungsauffahrt, um die Sicht der Insassen nicht zu verschlechtern und einen Bodenfreigang des Fahrzeugs bei einem Übergang der
Steigungsabfahrt bzw. einer Hangabfahrt in die waagrecht ausgerichtete Fahrbahn sicherzustellen. Die Insassen des Fahrzeugs können somit aufrechter sitzen und müssen sich bei geneigten Fahrbahnen im Innenraum des Fahrzeugs weniger stark abstützen. Üblicherweise wird die Sicht für den Fahrer deutlich verbessert.
Im Rahmen des Verfahrens wird bzw. werden der Nickwinkel und/oder der Wankwinkel des Aufbaus des Fahrzeugs bezüglich des inertialen
Koordinatensystems geschätzt. Mindestens einer dieser Winkel gibt die Neigung des Aufbaus bezüglich der Horizontalen an, die über die Achsen in den Raumrichtungen Xr e f, y re f, Zref des inertialen Koordinatensystems definiert ist. Über die Abstandssensoren, bspw. Radeinfederungssensoren, wird aus den Winkeln des Aufbaus im inertialen Koordinatensystem der Winkel der Fahrbahn in Nick- und Wankrichtung des Fahrzeugs bestimmt, üblicherweise berechnet. Anhand des Werts und Vorzeichens des jeweiligen Winkels wird erkannt, ob sich das Fahrzeug auf einer Steigung befindet und ob es sich um eine Steigungsauffahrt oder Steigungsabfahrt handelt.
Ein negativer Nickwinkel deutet eine Steigungsauffahrt an, wohingegen ein positiver Nickwinkel eine Steigungsabfahrt andeutet. Der ermittelte
Nickwinkel des Aufbaus wird in eine Vorsteuerung umgerechnet, wobei bei Vorliegen eines positives Nickwinkel die beiden vorderen Aktoren des
Fahrwerks ausgefahren und die beiden hinteren Aktoren eingefahren werden. Bei einem identifizierten negativen Nickwinkel werden dagegen die vorderen Aktoren des Fahrwerks ein- und die beiden hinteren Aktoren ausgefahren.
Um zu erreichen, dass der Aufbau bei einer Steigungsabfahrt nicht so stark horizontal ausgerichtet wird, wird der berechnete Nickwinkel im
Inertialsystem beschränkt, so dass sich für den Nickwinkel zur Korrektur bzw. Kompensation der Neigung des Aufbaus keine zu großen negativen Werte als Resultat ergeben und sich somit keine zu starke horizontale Ausrichtung bei der Steigungs- bzw. Hangabfahrt ergibt.
Die genannten Vorgehensweisen sind bei einer Vorwärtsfahrt des Fahrzeugs umzusetzen. Bei einer Rückwärtsfahrt wird entweder keine oder allenfalls eine horizontale Ausrichtung des Aufbaus oder eine bezogen auf die
Vorwärtsfahrt umgekehrte Änderung einer Länge der Aktoren bereitgestellt. Falls rückwärts eine Steigungsauffahrt durchzuführen ist, wird eine stärkere horizontale Ausrichtung umgesetzt. Falls rückwärts eine Steigungsabfahrt zu befahren ist, ist lediglich eine geringe horizontale Ausrichtung zu erreichen, um den Insassen eine gute Sicht zu ermöglichen.
Bei der horizontalen Ausrichtung des Aufbaus bei der Steigungsauffahrt, bzw. -abfahrt wird in Ausgestaltung als Ergänzung oder Alternative eine horizontale Ausrichtung bei Vorliegen einer Querneigung der Fahrbahn umgesetzt. Demnach ist zur Kompensation einer Neigung des Aufbaus bezüglich des inertialen Koordinatensystems eine Anpassung jeweiliger Längen der Aktoren unter Berücksichtigung eines Nickwinkels und
Wankwinkels zu kombinieren. Zur Kompensation einer Querneigung als Neigung hinsichtlich eines Wankwinkels ist analog wie im Fall des
Nickwinkels vorzugehen. Demnach wird aus dem Wankwinkel bezüglich des inertialen Koordinatensystems eine Vorsteuerrung für die Aktoren berechnet und somit ermittelt, wobei zwischen einer Querneigung nach links oder rechts nicht unterschieden wird. In diesem Fall ist ein Betrag von 6 s max üblicherweise genauso groß wie ein Betrag von 0 s rnin .
Unabhängig davon, welcher Winkel, d. h. Nick- und/oder Wankwinkel, in welcher Richtung berücksichtigt wird, ist mit dem aktiven Fahrwerk eine Kompensation der Neigung der Fahrbahn umzusetzen.
Bei einer möglichen Umsetzung des Verfahrens wird ein jeweiliger Winkel und somit der Nickwinkel und/oder Wankwinkel des Fahrzeugs,
üblicherweise des Aufbaus des Fahrzeugs, bezüglich des intertialen
Koordinatensystem in Nickrichtung und/oder Wankrichtung ermittelt und über das Vorzeichen des Winkels zwischen der Steigungsauffahrt und -abfahrt oder bei Vorliegen einer in Querrichtung geneigten Fahrbahn zwischen einer Neigung nach links oder rechts unterschieden. Dabei kann auch die
Nickrichtung und Wankrichtung in Kombination kompensiert werden. Eine eventuell vorliegende Neigung des Aufbaus ist bezüglich des inertialen Koordinatensystems und somit einer horizontalen Ebene, die über das Schwerefeld der Erde ausgerichtet und/oder definiert ist, zu kompensieren.
Im Rahmen des Verfahrens ist der Aufbau des Fahrzeugs, um diesen zu horizontieren bzw. horizontal auszurichten, nicht unbedingt exakt parallel zum Horizont auszurichten. Ein Maß einer vorzunehmenden horizontalen Ausrichtung ist in Ausgestaltung applizierbar festzusetzen und somit zu definieren. Ein derartiges Maß ist abhängig von einer Ausgangslage des Aufbaus parallel zum Horizont, z. B. zu 50 % zu wählen. Das Maß für die Neigung ist über die Grenzwerte cj) Sj i im , 9 s lim einstellbar.
Weitere Vorteile und Ausgestaltungen der Erfindung ergeben sich aus der Beschreibung und den beiliegenden Zeichnungen.
Es versteht sich, dass die voranstehend genannten und die nachstehend noch zu erläuternden Merkmale nicht nur in der jeweils angegebenen Kombination, sondern auch in anderen Kombinationen oder in Alleinstellung verwendbar sind, ohne den Rahmen der vorliegenden Erfindung zu verlassen.
Die Erfindung ist anhand von Ausführungsformen in den Zeichnungen schematisch dargestellt und wird unter Bezugnahme auf die Zeichnungen schematisch und ausführlich beschrieben.
Figur 1 zeigt in schematischer Darstellung ein Bespiel für ein Fahrzeug mit einer Ausführungsform des erfindungsgemäßen Systems.
Figur 2 zeigt ein Diagramm zu einer Ausführungsform des
erfindungsgemäßen Verfahrens. Figur 3 zeigt in schematischer Darstellung ein Detail des Fahrzeugs aus Figur 1.
Figur 4 zeigt das Fahrzeug aus Figur 1 bei unterschiedlichen Varianten der Ausführungsform des erfindungsgemäßen Verfahrens.
Die Figuren werden zusammenhängend und übergreifend beschrieben, gleiche Bezugsziffern bezeichnen dieselben Komponenten.
In Figur 1 sind ein als Kraftfahrzeug ausgebildetes Fahrzeug 2 und eine als Straße ausgebildete Fahrbahn 4, auf der sich das Fahrzeug 2 während einer Fahrt bewegt, schematisch dargestellt. Dabei umfasst das Fahrzeug 2 einen Aufbau 6 und vier zur Fortbewegung des Fahrzeugs 2 vorgesehene Räder 8, 10, von denen in Figur 1 lediglich ein vorderes linkes Rad 8 und ein hinteres linkes Rad 10 gezeigt sind. Jedes Rad 8, 10 ist zumindest über einen aktiven Aktor 12, 14 mit dem Aufbau 6 verbunden, wobei die Räder 8, 10 und
Aktoren 12, 14 als Komponenten eines aktiven Fahrwerks des Fahrzeugs 2 ausgebildet sind.
Die Ausführungsform des erfindungsgemäße Systems 16 umfasst als
Komponenten ein Kontrollgerät 18, mindestens einen ersten Sensor 19 zum Bestimmen der Neigung des Aufbaus 6 sowie mehrere, hier vier als
Abstandssensoren 20, 22 ausgebildete, zweite Sensoren, von denen in Figur 1 lediglich zwei dargestellt sind, wobei jedem Rad 8, 10 ein derartiger
Abstandssensor 20, 22 zugeordnet ist. Der mindestens eine erste Sensor 19 und die Abstandssensoren 20, 22 sind zugleich als Komponenten einer Sensoranordnung des Systems 16 ausgebildet. Weiterhin umfassen die Sensoranordnung und somit das System 16 nicht weiter dargestellte
Sensoren zum Bestimmen, in der Regel zum Messen, mindestens einer kinetischen Größe, üblicherweise einer Geschwindigkeit und/oder
Beschleunigung, des Fahrzeugs 2 und/oder des Aufbaus 6.
Die nachfolgend u. a. anhand des Diagramms aus Figur 2 beschriebene Ausführungsform des erfindungsgemäßen Verfahrens ist mit der in Figur 1 schematisch dargestellten Ausführungsform des erfindungsgemäßen
Systems 16 durchzuführen, wobei Schritte der Ausführungsform des
Verfahrens durch das Kontrollgerät 18 zu kontrollieren und somit zu steuern und/oder zu regeln sind.
Außerdem sind in Figur 1 drei Koordinatensysteme 24, 26, 28 sowie diverse, hier geometrische Parameter dargestellt.
Dabei ist ein erstes, aufbaufestes Koordinatensystem 24 dem Aufbau 6 des Fahrzeugs 2 zugeordnet, wobei dessen Ursprung im Schwerpunkt 25 des Aufbaus 6 liegt. Das erste Koordinatensystem 24 umfasst eine erste Achse in Raumrichtung Xg, die longitudinal zu dem Aufbau 6 sowie parallel zu einer Fahrtrichtung des Fahrzeugs 2 orientiert ist. Eine zweite Achse ist in
Raumrichtung y a , die transversal zu dem Aufbau 6 sowie parallel zu Achsen des Fahrzeugs 2, die sich zwischen jeweils zwei Rädern 8, 10 des
Fahrzeugs 2 erstrecken, orientiert. Eine dritte Achse ist in Raumrichtung z a parallel zu einer Hochachse des Aufbaus 6 orientiert. Alle drei genannten Achsen und somit Raumrichtungen Xa, y a , z a sind zueinander senkrecht orientiert. Dabei ist in Ausgestaltung vorgesehen, dass die beiden
erstgenannten Achsen und somit die Raumrichtungen Xg und y a eine horizontale Ebene des Fahrzeugs 2 aufspannen, in der der Schwerpunkt 25 liegt.
Weiterhin zeigt Figur 1 zwei Beispiele für vertikal orientierte Abstände dza.vu dz a ,HL- Ein erster Abstand dz a ,vL bezieht sich auf eine Distanz zwischen dem Rad 8 vorne links und dem Aufbau 6. Ein zweiter Abstand dza.m. bezieht sich auf eine Distanz zwischen dem Rad 10 hinten links und dem Aufbau 6. Diese Abstände dZg. L. dZg.HL sind entlang der Aktoren 12, 14 orientiert und durch die den Rädern 8, 10 zugeordneten Abstandssensoren 20, 22 zu erfassen.
Abstände der Räder 8, 10 zu dem Schwerpunkt 25 des Aufbaus 6 in einer zu der horizontalen Ebene parallelen Ebene sind hier über die Längen bzw. Seitenlängen oder Strecken t v , th, Ih, Iv zu definieren. Hierbei sind für das Rad 8 vorne links eine vordere, transversale Strecke t v , die den Abstand des Rads 8 von dem Schwerpunkt 25 in transversaler Raumrichtung beschreibt, und eine vordere, longitudinale Strecke l v , die den Abstand des Rads 8 von dem Schwerpunkt 25 in longitudinaler Raumrichtung beschreibt, zu berücksichtigen. Für das Rad 10 hinten links sind eine hintere, transversale Strecke th, die den Abstand des Rads 10 von dem Schwerpunkt 25 in transversaler Raumrichtung beschreibt, und eine hintere, longitudinale Strecke Ih, die den Abstand des Rads 10 von dem Schwerpunkt 25 in longitudinaler Raumrichtung beschreibt, zu berücksichtigen.
Ein weiterer vertikal orientierter Abstand dz a ,vR bezieht sich auf eine Distanz zwischen einem hier nicht gezeigten Rad vorne rechts und dem Aufbau 6. Ein zusätzlicher Abstand dz a ,HR in vertikaler Richtung bezieht sich auf eine Distanz zwischen einem hier nicht gezeigten Rad hinten rechts und dem Aufbau 6. Die beschriebenen Abstände dZa. L, dz a> HL, dz a ,vR, dZa.HR bzw. Distanzen zwischen den Rädern 8, 10 und dem Aufbau 6 sind in
Ausgestaltung auf die horizontale Ebene bezogen, in der der Schwerpunkt 25 liegt.
Weiterhin sind für das Rad vorne rechts die vordere, transversale Strecke t v , die den Abstand des Rads vorne rechts von dem Schwerpunkt 25 in transversaler Raumrichtung beschreibt, und die vordere, longitudinale Strecke l v , die den Abstand des Rads vorne rechts von dem Schwerpunkt 25 in longitudinaler Raumrichtung beschreibt, zu berücksichtigen. Für das Rad hinten rechts sind die hintere, transversale Strecke t h , die den Abstand dieses Rads von dem Schwerpunkt 25 in transversaler Raumrichtung beschreibt, und die hintere, longitudinale Strecke l h , die den Abstand des Rads hinten rechts von dem Schwerpunkt 25 in longitudinaler Raumrichtung beschreibt, zu berücksichtigen, wobei in Figur 1 die für das Rad hinten rechts zu berücksichtigende, hintere transversale Strecke nicht eingezeichnet ist. Ein zweites, fahrwerkfestes Koordinatensystem 26 ist der Fahrbahn 4 zugeordnet und umfasst eine erste Achse in Raumrichtung Xs parallel zu einer vorgesehenen Fahrtrichtung bzw. Längsrichtung der Fahrbahn 4, eine zweite Achse in Raumrichtung y s , die parallel zu einer Querrichtung der Fahrbahn 4 orientiert ist, und eine dritte Achse in Raumrichtung z s , wobei alle genannten Achsen zueinander senkrecht orientiert sind. Eine Neigung und somit eine Lage der Fahrbahn 4 ist hier anhand eines Querwinkels bzw. Wankwinkels s, der eine Neigung der Fahrbahn 4 in Querrichtung
beschreibt, und anhand eines Längswinkels bzw. Nickwinkels 0 S , der eine Neigung der Fahrbahn 4 in Längsrichtung und somit bspw. eine Steigung oder eine Gefälle beschreibt, zu beschreiben.
Ein drittes Koordinatensystem 28 ist als Referenz-Koordinatensystem ausgebildet und umfasst eine erste Achse in Raumrichtung Xr e f, eine zweite Achse in Raumrichtung y re f und eine dritte Achse in Raumrichtung z re f, die alle zueinander senkrecht orientiert sind.
Außerdem sind dem ersten Koordinatensystem 24 ein Wankwinkel φ 3 , der eine Drehung des Aufbaus 6 um die erste, in Raumrichtung Xg orientierte Achse beschreibt, ein Nickwinkel 6 a , der eine Drehung des Aufbaus 6 um die zweite, in Raumrichtung y a orientierte Achse beschreibt, und ein Gierwinkel ψ 3> der eine Drehung des Aufbaus 6 um die dritte, in Raumrichtung Za orientierte Achse beschreibt, gezeigt.
Das erste, aufbaufeste Koordinatensystem 24 [Xa, y a , Za] im Schwerpunkt 25 des Aufbaus 6 des Fahrzeugs 2 folgt translatorischen und rotatorischen Bewegungen des Aufbaus 6. Das dritte, inertiale Koordinatensystem 28 [Xr e f, y re f, z re f] wird als Referenz-Koordinatensystem herangezogen, wobei berücksichtigt wird, dass die Gravitationsbeschleunigung g ausschließlich in Raumrichtung z re f parallel zu einem Gravitationsvektor wirkt.
In der Ausführungsform des Verfahrens werden zur Schätzung einer Neigung bzw. Lage des Aufbaus 6 der Nickwinkel 9 a und der Wankwinkel φ 3 auf das dritte, als Referenz-Koordinatensystem ausgebildete Koordinatensystem 28 bezogen.
Die zwischen dem aufbaufesten Koordinatensystem 24 und dem
Referenzsystem bzw. inertialen Koordinatensystemen 28 eingeschlossenen Winkel [θ 3 , φ 3 , ψο] werden auch als inertialer Nickwinkel θ 3 , inertialer
Wankwinkel φ 3 und inertialer Gierwinkel ψ 3 bezeichnet. Als Neigung des Aufbaus 6 wird dessen Orientierung in Nickrichtung und Wankrichtung bezeichnet, woraus der Nickwinkel θ 3 und der Wankwinkel φ 3 bestimmt werden.
Um die Neigung bzw. Lage des Aufbaus 6 zu schätzen, werden die
Beschleunigung a = [x a , y a , z a ] T des Aufbaus 6 bzw. des Fahrzeugs 2 entlang der Raumrichtungen Xa, y a , z a und die Drehraten ω = [ψ 3 , φ 3 , 0 a ] mit der Sensoranordnung zum Bestimmen der Trägheit mit sechs
Freiheitsgraden (IMU- Inertial Measurement Unit) gemessen und somit ermittelt, wobei die Sensoranordnung auch unabhängig von der .
Durchführung des Verfahrens in dem Fahrzeug 2 eingesetzt werden kann. Zur Schätzung der Neigung des Aufbaus 6 ist zunächst zu berücksichtigen, welchen physikalischen Randbedingungen die von der Sensoranordnung bspw. durch Messen zu ermittelnden Größen a und ω ausgesetzt sind. Aus Messsignalen von Beschleunigungssensoren der Sensoranordnung werden drei unterschiedliche physikalische Größen abgeleitet:
- die von den Drehraten ω und der ebenen Geschwindigkeit v Ebene ' =
[vEbene,x> v Eb ene,y' Eb ene,z] T des Fahrzeugs 2 abhängige
Zentrifugalbeschleunigung ä^: a zf — ω x v E be
(3)
- die Änderung der bereinigten, ebenen Geschwindigkeit v Ebene ' und somit Beschleunigung des Fahrzeugs 2 und/oder des Aufbaus 6 in
Raumrichtung einer Achse eines jeweiligen Beschleunigungssensors in der horizontalen Ebene des Fahrzeugs: a vp — R v Ebene (4)
- die Gravitationsbeschleunigung = R [0, 0, -g] T (5)
In obigen Formeln ist v Eben e die Geschwindigkeit des Fahrzeugs 2 in der horizontalen Ebene und R die Eulersche Drehmatrix (6), die unter
Berücksichtigung der Eulerschen Winkel in einer Drehreihenfolge des Wankwinkels φ, des Nickwinkels Θ und des Gierwinkels ψ berechnet wird. Hierbei ist v Ebe ne,x die übliche Geschwindigkeit des Fahrzeugs v Fzg in Längsbzw. Fahrtrichtung des Fahrzeugs 2, die über eine Drehzahl der Räder 8, 10 gemessen und dem Tachometer angezeigt wird. (6) α^φείηθοοβψ + εϊηφεϊηψ o^sinOcosiJj— βϊηφοοβψ κφακθ/
Die jeweils zu bestimmenden Winkel φ, d. h. φ 3 (für den Aufbau), (für das Fahrwerk) bzw. φ δ (für die Fahrbahn), und Θ, d. h. 9 a (für den Aufbau), 6 f (für das Fahrwerk) bzw. 0 S (für die Fahrbahn), können üblicherweise über zwei unterschiedliche Berechnungsmethoden bzw. Herangehensweisen zur Berechnung ermittelt werden: - durch zeitliche Integration der durch die Sensoranordnung gemessenen Drehraten ω, oder
- durch Eliminierung der Zentrifugalbeschleunigung und der Änderung der ebenen Geschwindigkeit v Ebene und somit der Beschleunigung des Fahrzeugs 2 aus den durch die Sensoranordnung gemessenen
Beschleunigungen = a - - und Berechnung der Winkel über trigonometrische Funktionen 9 a = atan dgy,Z φ 3 = atan 3gy,Z
Wie bereits anhand von Gleichung (5) angedeutet, ist ein Vektor mit den drei Elementen [a gv ,x, a gv ,y, a gv ,z] T = [g*sin0, -g*sir^*cos9, -g * a^ * cos9] T , wohingegen die Erdbeschleunigung g = 9, 81 m/s 2 hier als ein Skalar verwendet wird, das sich je nach Neigung des Aufbaus 6, die mit der
Eulerschen Drehmatrix R (6) beschrieben wird, auf unterschiedliche
Elemente des Vektors auswirkt. Ist der Aufbau 6 nicht geneigt, so ist = [0,0, -g] T . Bei einem Wankwinkel φ 3 = 90° und einem Nickwinkel 9 a = 0° ist = [0, -g, 0] T . Ist bekannt, können der Nickwinkel 9 a und der
Wankwinkel φ 3 über die oben beschriebenen atan-Funktionen berechnet werden. Allerdings ist bei den durchzuführenden Berechnungen zu berücksichtigen, dass aufgrund von zeitlich variablen Offset-Fehlern von Drehratensensoren eine Integration der Drehraten ggf. stationär ungenau ist. Dies bedeutet, dass berechnete Winkel niederfrequent driften und nur hochfrequente Anteile von Messsignalen nutzbar sind. Bei den über Beschleunigungssensoren ermittelten Winkeln ist dagegen mit hochfrequenten Störungen zu rechnen, da schwer zu erfassende Änderungen der Geschwindigkeit, die bspw. bei der Überfahrt von Schlaglöchern auftreten, nicht aus den Messsignalen eliminiert werden können.
In der hier beschriebenen Ausführungsform wird als Filteralgorithmus ein auf Quaternionen basierender Neigungsfilter bzw. Lagefilter verwendet. Ebenso ist es möglich, einen Kaiman-Filter für die Fusion beider
Berechnungsmethoden einzusetzen. Hierdurch werden beide
voranstehenden genannten Berechnungsmethoden vereint, wodurch ein Signal bereitgestellt wird, das sowohl niederfrequent als auch hochfrequent nutzbar ist. Ein Quaternion ist ein vierdimensionaler Vektor q = [qi, q 2 , q3» 4] T . über den die Orientierung eines starren Körpers, hier des Aufbaus 6, zu
beschreiben ist. Ist ein starrer Körper bezogen auf ein Referenzsystem um den Winkel χ und die Achse r = [r x , r y , r z ] T gedreht, wobei f ein
Einheitsvektor ist, so wird diese Orientierung bezogen auf das
Referenzsystem durch das Quaternion cos , -r x sin , -r y sin-, -r z sin-| beschrieben.
[ ■
Dies wird zunächst für die zeitliche Integration der durch die
Sensoranordnung gemessenen Drehraten ω genutzt, wobei der Aufbau 6 bezogen auf das inertiale Referenzsystem im vorliegenden Fall mit der Drehrate ω = [ω χ , ω γ , ω 2 ] τ rotiert. Ausgehend von einer Ausgangslage q L des Aufbaus 6 wird die Änderung der Lage bzw. Neigung aufgrund der Drehraten durch die Gleichung (7): ή ω = - q L ®[0, ü> x , ü) y , (o z ] (7) beschrieben. Der Operator ® symbolisiert hier eine
Quaternionenmultiplikation. In einem zeitdiskreten Fall ist eine resultierende Differentialgleichung bspw. durch eine Euler-Integration (8): zu lösen, wobei At einer Schrittweite zwischen zwei Zeitpunkten k und k- 1 entspricht.
Um eine Orientierung des Aufbaus 6 aus der durch die Sensoranordnung gemessenen Beschleunigung a und resultierenden, bereinigten
Gravitationsbeschleunigung = [a^, a^y, a^] = [g * sin9 , -g * sin φ * cosQ , -g * coscj) * cos θ] τ mit Quaternionen zu beschreiben, ist nachfolgendes Optimierungsproblem (9):
m in q L e9l 4 f(ÖL» ) mit ) (9) zu lösen. Eine direkte Berechnung der Neigung ist nicht möglich, da um eine Rotationsachse, die parallel zum Gravitationsvektor orientiert ist, unendlich viele Lösungen existieren. Zur zeitdiskreten Lösung des
Optimierungsproblems kommt ein gradientenbasierter Ansatz (10): -—► _ . .. vf q L . k -i'.ä v) , i m
^-''"-' " ''Ito sI <10) mit einer einstellbaren Schrittweite μ zur Anwendung.
Um Informationen über die Neigung, die aus den gemessenen Drehraten und aus den Beschleunigungen resultiert, zu fusionieren, werden die beiden Quaternionen q^, über Gleichung (11 ) gewichtet addiert: qL,k = Yq a ,k + ( 1 - Y)qo>,k (11 ) wobei 0 < γ < 1 ein einstellbarer Parameter ist. Die Nickwinkel und
Wankwinkel werden dann mit den Gleichungen (12a), (12b): e a k = - sin-^qL ^qL ^ + q L l q 3 ) (12a)
a,k = atan I— 2 2 _— ) (1 b)
berechnet.
Zur Eliminierung der Zentrifugalbeschleunigung und der Änderung der ebenen Geschwindigkeit v Eben e aus den durch die Sensoranordnung gemessenen Beschleunigungen sind die Nick- und Wankwinkel zu
berücksichtigen, die wiederum mit Hilfe des
Gravitationsbeschleunigungsvektors berechnet werden.
Zur Durchführung der Ausführungsform des Verfahrens wird ein sogenannter Strapdown-Ansatz verwendet, der in dem Diagramm aus Figur 2 dargestellt ist. Einzelne Schritte 40, 42, 44, 46, 48 des Verfahrens werden nachfolgend näher beschrieben.
Zu Beginn des Verfahrens werden sensorisch ermittelte Werte der
Beschleunigung a und der Drehrate ω bereitgestellt. Mit diesen Werten wird in einem ersten Schritt 40 eine "Korrektur der Zentrifugalkraft" durchgeführt, wobei die durch die Sensoranordnung gemessenen Beschleunigungen um den Anteil der Zentrifugalkraft ζ = ω v Eben e korrigiert werden. Dabei wird eine erste korrigierte Beschleunigung a - bestimmt. Diese erste
korrigierte Beschleunigung a - wird unter Berücksichtigung von Werten für den Wankwinkel φ 3 und den Nickwinkel 0 a in einem zweiten Schritt 42 unter Durchführung einer "Korrektur der Gravitationskraft" mit der
Gravitationsbeschleunigung korrigiert, woraus die Beschleunigung in der horizontalen Ebene resultiert.
Im Rahmen des Verfahrens sind zwei Möglichkeiten, die ebene
Geschwindigkeit v Ebene ' zu berechnen, vorgesehen.
Eine "Bestimmung der Geschwindigkeiten" wird in einem dritten Schritt 44 unter Berücksichtigung der Beschleunigung des Fahrzeugs 2, der gemessenen Geschwindigkeit v des Fahrzeugs 2 und dessen Lenkwinkel öienk durchgeführt, wobei die erste ebene Geschwindigkeit des Fahrzeugs ϊ^ = [vi nt( x, v Int)y , v Int z ] T durch Integration (13): vmt = / a vp dt (13) der Beschleunigung des Fahrzeugs 2 berechnet und somit ermittelt wird. Diese ebene Geschwindigkeit νϊ^ wird wiederum in einem geschlossenen Regelkreis zur "Korrektur der Zentrifugalkraft" im ersten Schritt 40 verwendet. Für die Geschwindigkeit VEbene.x in Raumrichtung einer Längsachse des Fahrzeugs 2 steht hierbei die über die Raddrehzahlen gemessene
Geschwindigkeit v Fzg in Richtung Xa des Fahrzeugs 2 zur Verfügung. Unter Zuhilfenahme eines Einspurmodells ist es weiterhin möglich, aus dem
Lenkwinkel δ| βη ι< und der gemessenen Geschwindigkeit vp zg eine zur
Querachse des Kraftahrzeugs wirksame Geschwindigkeit V Y> ESM ZU
berechnen. Für die vertikale Geschwindigkeit VEbene,z steht keine weitere Mess- bzw. Berechnungsmethode zur Verfügung. Die alternativ ermittelte zweite ebene Geschwindigkeit des Fahrzeugs (14):
X
Vält = [ Fzg, y , ES M, 0] (14) und die durch Integration (13) berechnete Geschwindigkeit können durch einen geeigneten Filteralgorithmus, wie bspw. durch ein Kaiman-Filter (15), über eine Berechnungsvorschrift, die einen Gewichtungsfaktor τ umfasst: v E bene = +. (1 ~ väi mit 0 < τ < 1 (15) fusioniert werden.
In einem vierten Schritt 46 zur "Korrektur der ebenen
Geschwindigkeitsänderung" werden Werte der gemessenen Geschwindigkeit v Fz g, des Lenkwinkels 5i en k, der Winkel 6 a , φ 3 und die durch die
Zentrifugalbeschleunigung korrigierte Beschleunigung a - berücksichtigt, wobei die korrigierte Beschleunigung durch den Anteil der Änderung der ebenen Geschwindigkeit a vp a it = R korrigiert wird. Um eine negative Rückkopplung zu vermeiden, wird die Ableitung eines Vektors der Geschwindigkeit statt der laut der Berechnungsvorschrift (15) ermittelten Geschwindigkeit v Ebene ' verwendet. In einem fünften Schritt 48 werden unter Berücksichtigung der Drehrate ω und der Gravitationsbeschleunigung des Fahrzeugs 2 der Nickwinkel 0 a sowie der Wankwinkel φ 3 und somit die Neigung bzw. Lage des Aufbaus 6 des Fahrzeugs 2 mit dem voranstehend beschriebenen, auf Quaternionen basierenden Neigungsfilter berechnet. Über die voranstehend beschriebene Vorgehensweise werden der Nickwinkel 9 a und der Wankwinkel φ 3 bezogen auf das inertiale Koordinatensystem 28 bestimmt und in einem
geschlossenen Regelkreis zur "Korrektur der Gravitationskraft" im zweiten Schritt 42 sowie zur "Korrektur der eben Geschwindigkeitsänderung" im dritten Schritt 44 verwendet.
Ausgehend von der im fünften Schritt 48 ermittelten Neigung des Aufbaus 6 wird die Neigung und somit die Lage der Fahrbahn 4 ermittelt, wobei die
Abstände dz a = [dz a VL , dz a V R, dz a HL , dz a HR ] T zwischen den Rädern 8, 10 und dem Aufbau 6 als gemessene Größen hinzugezogen werden, wodurch zunächst der Nickwinkel 0 f und der Wankwinkel (fr des Fahrwerks des Fahrzeugs 2 berechnet werden, wobei eine durchzuführende Berechnung von einer Transformationsmatrix (16) abhängig ist: τ= [ί ί-ίι] < 16 > mit der eine geometrische Lage des Schwerpunkts 25 bezogen auf die Positionen der Räder 8, 10 beschrieben wird bzw. ist. Dabei beschreibt die erste Spalte den Abstand des Rads 8 vorne links, die zweite Spalte den Abstand des Rads vorne rechts, die dritte Spalte den Abstand des Rads 10 hinten links und die vierte Spalte den Abstand des Rads hinten rechts zu dem Schwerpunkt 25 innerhalb der horizontalen Ebene. Die Neigung des Fahrwerks wird dann über den vektoriellen Zusammenhang (17): bestimmt.
Durch die Subtraktion der Neigung des Fahrwerks von der Neigung des Aufbaus 6 wird die Neigung der Fahrbahn 4 im Bezug zum aufbaufesten, ersten Koordinatensystem 24 über den vektoriellen Zusammenhang (18): berechnet. Da eine Reifeneinfederung der Räder 8, 10 im Vergleich zu einem zu berücksichtigenden Abstand sehr gering ist, wird diese in obiger
Rechnung vernachlässigt.
Da die Winkel φ 3 und 9 a auf den Vektor bezogene Schätzgrößen für die Neigung des Aufbaus 6 sind und und 6 f die relativen Winkel zwischen dem Aufbau 6 und der Oberfläche der Fahrbahn 4 beschreiben, stehen mit φ δ und 0 S ebenfalls Winkel als geschätzte Größen für die Neigung der Fährbahn 4 bzw. Straße bezogen auf den Gravitationsvektor zur Verfügung.
Bei Umsetzung des Verfahrens ist dem aktiven Fahrwerk des Fahrzeugs 2 durch Korrektur einer Neigung des Aufbaus 6 eine Kompensation der Neigung der Fahrbahn 4 zu erreichen und demnach der Aufbau 6 zu horizontieren bzw. horizontal auszurichten. Diesbezüglich ist anhand von Soll-Werten für eine Änderung von Längen der Aktoren 12, 14 vorzugeben, in welchem Maß eine derartige Kompensation der Neigung bzw. eine Horizontierung des Aufbaus vorzunehmen ist. So ist durch Anpassen jeweiliger Längen der Aktoren 12, 14 an die Soll-Werte bei einer Steigungs- bzw. Bergauffahrt quantitativ eine stärkere Horizontierung als bei Steigungs- bzw. Bergabfahrt vorzusehen.
Bei einer Steigungsauffahrt wird der Aufbau 6 des Fahrzeugs 2 hinten angehoben und vorne abgesenkt, wodurch eine Sicht der Insassen zu verbessern und ein Komfort zu erhöhen ist. Bei einer Steigungsabfahrt wird der Aufbau 6 vorne angehoben und hinten abgesenkt, allerdings ist hierbei im Vergleich zur Steigungsauffahrt eine deutlich geringere Kompensation der Neigung vorzunehmen, um die Sicht der Insassen nicht zu verschlechtern und einen Bodenfreigang des Aufbaus 6 bei einem Übergang von der Steigungs- bzw. einer Hangabfahrt in die Waagrechte zu gewährleisten.
Ebenso ist denkbar, den Aufbau 6 quer zur Fahrtrichtung des Fahrzeugs 2 zu horizontieren, wobei eine Kompensation der Neigung des Aufbaus 6 in Querrichtung ebenfalls durch Vorgabe von Soll-Werten beschränkt werden kann, um beispielsweise Fahrsituationen zu vermeiden, durch die ein
Bodenfreigang eingeschränkt werden könnte.
Zur Umsetzung des Verfahrens werden die errechneten Neigungswinkel der Fahrbahn φ 5 und 9 S zunächst durch Vorgabe von Soll- bzw. Grenzwerten Φ Β ,Ι ΪΠΙ . 6 S ] im limitiert: f 4>s,max wenn φ 5 > φ 5 >,m r ax
φ 5 ,πιη = 1 Φ 5 ,πιίη wenn φ 5 < φ 5 m η in (19) φ δ sonst
Danach werden die Neigungswinkel φ 5 , 9 S auf Soll-Werte
zlkt = [zakt.vL, z ak t,vR, z akt(HL , z akt> HR] T zur Änderung von Längen der Aktoren 12, 14 des aktiven Fahrwerks, umgerechnet. Eine Umrechnung der limitierten Nick- und Wankwinkel der Fahrbahn 4 auf die Soll-Werte für Längen der Aktoren 12, 14 wird unter Zuhilfenahme der
Transformationsmatrix T und von bekannten Übersetzungsverhätnissen zwischen aktorbezogenen und radbezogenen Abständen i VA = ^ a z kt ^ = und i HA = = für die Vorderachse und die Hinterachse des
dza.HL dz a , H R
Fahrzeugs 2 durchgeführt, woraus eine Diagonalmatrix diag(i V A > WA > ΪΗΑ. J HA) gebildet wird. Hierbei wird für die aktorbezogenen Soll-Werte der
nachfolgende Zusammenhang mit der transponierten Transformationsmatrix (16) verwendet:
z a kt = diag(i VA , IVA, ΪΗΑ, ΪΗΑ)Τ τ f fl s ' 1,m ] (21 )
In obigen Formeln sind die Maximal- bzw. Minimalwinkel φ 5 ,πΐ3χ. ös.max. 4>s,min und e s>min einstellbare Abstimmparameter bzw. Soll-Werte, die abhängig von einer jeweiligen Fahrsituation verändert werden können.
In einem Anwendungsbeispiel werden nachfolgende Ausgangswerte vorgegeben: A - *HA— 1; *v— *h — u '5; I v — lh — 1»5 (22)
Daraus resultiert:
= [0,026 0,026 -0,026 -0,026] T (24)
Dies bedeutet, dass die vorderen Aktoren 12 um 2,6 cm nach oben und die hinteren Aktoren 14 um 2,6 cm nach unten bewegt werden, wobei Längen der jeweiligen Aktoren 12, 14 gemäß der hier angegebenen Strecken verändert werden.
Figur 3 zeigt in schematischer Darstellung ein Detail des Kraftfahrzeugs 2 im Bereich des vorne links angeordneten Rads 8, das hier über den diesem Rad 8 zugeordneten Aktor 12 mit einem Aufhängepunkt 50 des Aufbaus 6 des Fahrzeugs 2 verbunden ist. Außerdem zeigt Figur 3 den transversalen Abstand t v des Rads 8 zu dem Schwerpunkt 25. Ebenfalls ist hier ein transversaler Abstand t v ,akt des Aktors 12 zu dem Schwerpunkt 25 durch einen Doppelpfeil angedeutet. Ein Abstand dZa.vL des Rads 8 zu dem Aufbau 6 sowie ein Abstand Zakt L des Aktors 12 zu dem Aufhängepunkt 50 des Aufbaus 6 sind hier ebenfalls dargestellt.
Entsprechend ist für das Rad 10 hinten links dessen Abstand dz a ,HL zu dem Aufbau sowie dessen Abstand t h zu dem Schwerpunkt 25 zu berücksichtigen. Für den Aktor 14, der dem Rad 10 hinten links zugeordnet ist, sind
entsprechend ein Abstand Zakt,Hi_ zu einem Aufhängepunkt des Aufbaus 6 sowie th.akt zu dem Schwerpunkt 25 zu berücksichtigen.
Das Fahrzeug 2 ist in Figur 4a bei einer Steigungsauffahrt auf der Fahrbahn 4, in Figur 4b in einer waagrechten Ebene der Fahrbahn 4 und in Figür 4c bei einer Steigungsabfahrt schematisch dargestellt, wobei in allen drei Figuren 4a, 4b, 4c durch einen Pfeil 52 eine nach vorwärts orientierte Fahrtrichtung des Fahrzeugs 2 angedeutet ist. Außerdem sind in den Figuren 4a, 4b und 4c ein Rad 54 des Fahrzeugs 2 vorne rechts und ein Rad 56 des Fahrzeugs 2 hinten rechts dargestellt. Hier ist vorgesehen, dass das Rad 54 vorne rechts über einen Aktor 58 mit einem Aufhängepunkt des Aufbaus 6 des Fahrzeugs 2 verbunden ist, wohingegen das Rad 56 hinten rechts über einen Aktor 60 mit einem Aufhängepunkt des Aufbaus 6 verbunden ist.
In Anlehnung an die Darstellung aus Figur 1 und/oder Figur 3 weist das Rad 54 vorne rechts zu dem Aufbau 6 den Abstand dz a ,vR und zu dem
Schwerpunkt 25 den Abstand t v auf. Der dem Rad 54 vorne rechts
zugeordnete Aktor 58 weist einen Abstand z a kt, R zu dem Aufbau 6 und einen Abstand t v , a i<t zu dem Schwerpunkt 25 des Aufbaus auf. Entsprechend weist das Rad 56 hinten rechts zu einem Aufhängepunkt des Aufbaus 6 den Abstand dz a ,HR und zu dem Schwerpunkt 25 den Abstand t h auf. Der dem Rad 56 hinten rechts zugeordnete Aktor 60 weist einen Abstand z a kt,HR zu einem Aufhängepunkt des Aufbaus 6 und einen Abstand t h , a w zu dem
Schwerpunkt 25 des Aufbaus 6 auf.
Unter Berücksichtigung der voranstehend beschriebenen Schritte des erfindungsgemäßen Verfahrens werden die Aktoren 14, 60, die die hinteren Räder 10, 56 an der Hinterachse des Fahrzeugs 2 mit dessen Aufbau 6 verbinden, bei der Steigungsauffahrt (Figur 4a) im Vergleich zu den beiden Aktoren 12, 58, die die vorderen Räder 8, 54 an der Vorderachse des
Fahrzeugs 2 mit dessen Aufbau 6 verbinden, um eine größere Strecke verlängert. Bei der Fahrt auf der waagrecht orientierten Fahrbahn (Figur 4b) werden die Längen der Aktoren 12, 14, 58, 60 gleich eingestellt. Bei der anhand von Figur 4c angedeuteten Steigungsabfahrt werden die Aktoren 12, 58, die die beiden vorderen Räder 8, 54 mit dem Aufbau 6 des Fahrzeugs 2 verbinden, um eine größere Strecke als die Aktoren 14, 60, die die Räder 10, 56 der Hinterachse des Fahrzeugs 2 mit dessen Aufbau 6 verbinden, verlängert. Allerdings ist die Verlängerung der Aktoren 12, 58 an der Vorderachse gegenüber den Aktoren 14, 60 an der Hinterachse bei der Steigungsabfahrt geringer als die Verlängerung der Aktoren 14, 60 gegenüber den Aktoren 12, 58 bei der Steigungsauffahrt.