Verfahren und Vorrichtung zur robusten und effizienten Bestimmung von Drehrichtung und/oder Drehgeschwindigkeit eines Rades oder einer Welle

Technisches Gebiet

Die Erfindung betrifft ein Verfahren zur robusten und effizienten Bestimmung von Drehrichtung und/oder Drehgeschwindigkeit eines Rades oder einer Welle. Ferner betrifft die Erfindung eine Vorrichtung zum Ausführen eines Verfahrens zur robusten und effizienten Bestimmung von Drehrichtung und/oder Drehgeschwindigkeit eines Rades oder einer Welle.

Stand der Technik

Bei vielen Systemen, insbesondre im Kfz-Bereich, ist eine sehr genaue und sichere Bestimmung einer Drehrichtung und/oder Drehgeschwindigkeit, wie z.B. bei Rädern oder Wellen, notwendig. Hierzu werten die Systeme zur Bestimmung der Drehrichtung und/oder Drehgeschwindigkeit je ein sinus- und cosinus-förmiges Beschleunigungssignal in der Form

x = cosφ y = sinφ

aus. Dabei ist der Winkel φ der Momentanwert des (Dreh-)Winkels des Rades bzw. der Welle. Die Sensoren sind dabei an unterschiedlichen Positionen an der Felge des Rades bzw. an der Welle montiert oder besitzen eine Sensitivität in unterschiedliche Richtungen. In der Regel weisen die beiden Signale x und y eine Phasenverschiebung zueinander von 90° auf.

Aus dem Stand der Technik sind Verfahren bekannt, welche die Signale x und y beobachten und aus der Abfolge der Minima und Maxima der beiden Signale die Drehrichtung des Rades bzw. der Welle bestimmen. Es ist zum Beispiel möglich, das Signal x zu beobachten und den Zeitpunkt zu erfassen, an dem das Signal x den ersten Nulldurch-

D -3 -I ωQ -I π onri7no-i o

gang nach einem Maximum hat. Weist nun das Signal y zu diesem Zeitpunkt ein Maximum auf, so dreht sich das Rad bzw. die Welle in positiver Richtung von φ. Weist das Signal y zu diesem Zeitpunkt hingegen ein Minimum auf, so dreht sich das Rad bzw. die Welle in negativer Richtung von φ.

Diese Verfahren weisen jedoch gewisse Nachteile auf. Im Allgemeinen sind die erfassten Signale mit Offsets, d.h. mit einem Gleichanteil behaftet oder sonst wie gestört, wodurch sich die während des gesamten Beobachtungszeitraums nötige Erfassung der Minima, Maxima und Nulldurchgänge als problematisch darstellt. Aufgrund des langen Beobachtungszeitraums hat die verwendete Auswerteschaltung einen erhöhten Leistungsverbrauch, da sie dauerhaft bestromt werden muss. Ferner liefern die oben erwähnten Verfahren nur Informationen über die Drehrichtung, nicht jedoch noch weitere Informationen wie z.B. die Drehfrequenz etc.

Es besteht daher der Bedarf nach einem verbesserten Verfahren zur effizienten Bestimmung von Drehrichtung und/oder Drehgeschwindigkeit eines drehbaren Körpers.

Es ist daher die Aufgabe der vorliegenden Erfindung, ein Verfahren zur effizienten Bestimmung von Drehrichtung und/oder Drehgeschwindigkeit eines drehbaren Körpers zu schaffen, welche die vorgenannten Nachteile umgeht. Gelöst wird diese Aufgabe durch den Gegenstand des Anspruchs 1.

Eine weitere Aufgabe der Erfindung ist es, eine Vorrichtung zur effizienten Bestimmung von Drehrichtung und/oder Drehgeschwindigkeit eines drehbaren Körpers zu schaffen. Diese Aufgabe wird durch den Gegenstand von Anspruch 8 gelöst.

Ferner stellt sich die Erfindung die Aufgabe, eine Computerprogramm, das alle Schritte des erfindungsgemäßen Verfahrens ausführt, wenn es auf einem Rechengerät abläuft zur Verfügung zu stellen. Diese Aufgabe wird durch den Gegenstand von Anspruch 9 gelöst.

Ein Computerprogrammprodukt mit Programmcode, der auf einem maschinenlesbaren Träger gespeichert ist, zur Durchführung des erfindungsgemäßen Verfahrens, wenn das Programm auf einem Computer oder Steuergerät ausgeführt wird ist Gegenstand des Anspruchs 10.

Bevorzugte Ausführungsformen und Weiterbildungen sowie Verfahrensergänzungen sind Gegenstand der Unteransprüche.

Das erfindungsgemäße Verfahren zur Bestimmung der Drehrichtung und/oder Drehgeschwindigkeit ω eines drehbaren Körpers auf Grundlage eines der Drehrichtung und/oder Drehgeschwindigkeit des drehbaren Körpers zuordenbaren, von einem Sensor abgegebenen Sinussignals (y) und Cosinussignals (x), weist dabei mindestens einen der folgenden Schritte auf: Aufnehmen eines der Drehrichtung und/oder Drehgeschwindigkeit zuordenbaren Sinussignals (yo) und Cosinussignals (xo) zu einem Zeitpunkt t ₀ ; Bestimmen eines Phasenwertes φo aus dem Sinussignal (yo) und Cosinussignal (xo); Aufnehmen der Drehrichtung und/oder Drehgeschwindigkeit zuordenbaren Sinussignalen (y,) und Cosinussignalen (x,) zu Zeitpunkten t,; Bestimmen von Phasenwerten φ, aus den entsprechenden Sinussignalen (y,) und Cosinussignalen (x,); Bilden von Phasendifferenzen δφ, aus den Phasenwerten φ, und dem Phasenwert φ ₀ ; und/oder Bestimmen der Drehrichtung und/oder Drehgeschwindigkeit ω aus den Phasendifferenzen δφ, auf Grundlage eines Nonius-Verfahrens.

Als Sensoren können AMR- oder GMR-Sensoren (AMR: Anisotropie Magneto Resistance, GMR: Giant Magneto Resistance) eingesetzt werden. Diese Sensoren erzeugen jeweils ein Sinussignal und ein Cosinussignal, aus denen in der weiteren Verarbeitung der zu messende Winkel errechnet werden kann. Weitere gattungsgemäße Sensoren sind beispielsweise Hallsensoren, sowie optische oder mikromechanische Geber.

Die der Drehrichtung und/oder Drehgeschwindigkeit des drehbaren Körpers zuordenbaren Sinussignale (y) und Cosinussignale (x) können von einem einzelnen Sensor oder von mehreren Sensoren stammen. Wird nur ein Sensor verwendet, liefert dieser jeweils ein der Drehrichtung und/oder Drehgeschwindigkeit des drehbaren Körpers zuordenba- res Sinussignal und Cosinussignal. Werden mehrere Sensoren verwendet kann ein Sensor ein der Drehrichtung und/oder Drehgeschwindigkeit des drehbaren Körpers zuorden- bares Sinussignal ausgeben und ein anderer Sensor ein entsprechendes Cosinussignal.

Die Sensorsignale können kontinuierliche Signale und/oder diskrete Signale sein.

Unter Anwendung geeigneter Verfahren, insbesondere des in der der Bosch R. 319810 beschriebenen Verfahren zur effizienten Offset-Kompensation bei Winkel- oder Phasensignalen, können die von einem Sensor abgegebenen Sinussignale (y) und Cosinus-

Signale (x) von etwaigen Signal-Offsets befreit werden. Dieses Kompensationsverfahren wird im Folgenden kurz beschrieben:

Ein Winkel α von Winkelsensoren kann auf Grundlage eines dem Winkel zuordenbaren Sinussignals und eines dem Winkel zuordenbaren Cosinussignals, mit folgenden Schritten bestimmt werden: Aufnehmen eines ersten Wertepaars So, mit einem ersten Sinussignal (yo) und einem ersten Cosinussignal (xo); Aufnehmen eines zweiten Wertepaars S, mit einem zweiten Sinussignal (y) und einem zweiten Cosinussignal (x); Bilden eines dritten Wertepaars S' aus der Differenz des zweiten Wertepaars S und des ersten Wertepaars So; und/oder Bestimmen des Winkels α auf Grundlage des dritten Wertepaars S'.

Durch die Bestimmung des Winkels α auf Grundlage der Differenz zwischen dem ersten und zweiten Wertepaar, müssen die Offsets der aufgenommenen Cosinussignale bzw. Sinussignale weder bestimmt, noch mit berücksichtigt werden.

Aufgrund der oben beschriebenen Offset-Kompensation bzw. den gebildeten Phasendifferenzen δφ; ist es möglich, ohne Kenntnis der Signal-Offsets, die Drehrichtung und die Drehgeschwindigkeit des drehbaren Körpers zu bestimmen.

In einer weiteren erfindungsgemäßen Ausgestaltung können die Phasenwerte φ aus dem Sinussignal (y) und Cosinussignal (x) mit Hilfe eines CORDIC-Verfahrens (COordi- nate Rotation pjgital Computer) oder einer Reihenentwicklung ermittelt werden.

In einer weiteren erfindungsgemäßen Ausgestaltung sind die Zeitpunkte t _t = t _o + n - At mit n,At& N . n wird dabei als Periodenzahl und At a\s Granularität bezeichnet.

Die Periodenzahl n kann beispielsweise zwischen 5 - 50, vorzugsweise zwischen 10 - 35, weiter vorzugsweise zwischen 15 - 20 liegen. Die Periodenzahl n kann an die Art des Sensors angepasst werden. Je höher die Periodenzahl, desto größer ist die Genauigkeit des Verfahrens.

Die Granularität At kann beispielsweise im Bereich von 1 - 50 ms liegen, vorzugsweise zwischen 5 - 30 ms, weiter vorzugsweise zwischen 10 - 15 ms. Die Granularität At kann an die Art des Sensors angepasst werden. Die Wahl der Granularität ergibt den Eindeu-

tigkeitsbereich der Drehfrequenzbestimmung. Bei einer Granularität At = 10 ms ergibt sich ein Eindeutigkeitsbereich von ±50 Hz, was einem Geschwindigkeitsbereich von ±300 km/h entspricht. Insbesondre kann die Granularität bzw. die Abtastzeitpunkte so gewählt werden, dass sowohl Motion Detection als auch Drehrichtungserkennung möglich ist.

Gemäß einer weiteren Ausbildung der Erfindung entsprechen die Phasendifferenzen δφ, folgenden Ausdruck: δφ _; =GW _! mod2π , wobei ω der Drehrichtung und/oder Drehgeschwindigkeit und t, dem Messzeitpunkt entspricht.

Erfindungsgemäß kann die Drehrichtung und/oder Drehgeschwindigkeit ω aus den Phasendifferenzen δφ, auf Grundlage eines Nonius-Verfahrens bestimmt werden. Das Noni- us-Verfahren kann ein mehrdimensionales Nonius-Verfahren, ein klassisches Nonius- Verfahren, ein modifiziertes Nonius-Verfahren oder ein kaskadiertes, modifiziertes Nonius-Verfahren sein, wie beispielsweise in der DE 101 42 449 A1 der Anmelderin beschrieben.

Die Verwendung eines mehrdimensionalen Nonius-Verfahrens hat die folgenden Vorteile: Die Robustheit des Auswertesystems ist sehr hoch. Die schaltungstechnische Realisierung ist in Bezug auf Schaltungsaufwand, Rechenaufwand und Stromverbrauch gegenüber herkömmlichen Lösungen äußerst effizient zu gestalten. Es sind keinerlei Informationen über Signal-Offsets und Drehfrequenz erforderlich. Im Sensorsystem müssen keine Speichermöglichkeiten für Offsets vorgehalten werden. Die Offsets müssen nicht in einem separaten Schritt am Bandende oder im Betrieb ermittelt werden, wenn beispielsweise das oben beschriebene Verfahren zur effizienten Offset-Kompensation bei Winkeloder Phasensignalen zur Anwendung kommt.

Im Sinne der Erfindung kann der drehbare Körper ein Rad oder eine Welle sein.

Besonders geeignet ist das erfindungsgemäße Verfahren / die erfindungsgemäße Vorrichtung zur Auswertung von Beschleunigungssensoren (mikromechanisch oder piezoelektrisch) in Reifendruck-überwachungssystemen (Tire Pressure Monitoring System - TPMS / Reifen-Druck-Kontroll-System - RDKS); Motion Detection und/oder Auto- Location.

Bei der erfindungsgemäßen Vorrichtung können in verschiedenen Ausgestaltungen weitere Schaltungsteile in einem Multiplex- Verfahren kombiniert werden. Auch ist es möglich, die Vorrichtung analog, digital oder aus einer Mischung von Analogtechnik und Digitaltechnik aufzubauen.

Zeichnungen

Die Erfindung wird nachstehend anhand der beigefügten Zeichnungen beispielhaft näher erläutert. Es zeigen:

Fig. 1 eine schematische Darstellung eines Rades mit zwei Beschleunigungssensoren;

Fig. 2 eine zweidimensionale Darstellung der Signale x und y;

Fig. 3 den Verlauf des Winkels φ bei Drehbewegung;

Fig. 4 ein Flussdiagramm der Auswerteschaltung;

Fig. 5 den Verlauf der Phasendifferenz und aus den Messwerten gebildete Differenz- werte;

Fig. 6 einen Signalflussgraph zur Nonius-Berechnung; und

Fig. 7 ein Blockschaltbild einer Schaltungsanordnung.

In Fig. 1 ist schematisch ein Rad 1 1 dargestellt das auf einem Untergrund 14 abrollt. An dem Rad 1 1 sind zwei Beschleunigungssensoren 12, 13 an zwei unterschiedlichen Positionen angebracht. Auf das Rad 1 1 und die Beschleunigungssensoren 12, 13 wirkt die Erdbeschleunigung g. Zwischen den beiden Beschleunigungssensoren liegt ein Winkel von 90° bzw. π/2. Die Pfeile 12a, 13a geben die Detektionsrichtung des jeweiligen Beschleunigungssensors 12, 13 an. Dabei gibt der Beschleunigungssensor 12 ein Signal in der Form x = cosφ und der Beschleunigungssensor 13 ein Signal in der Form j = sinφ aus.

Fig. 2 ist eine zweidimensionale Darstellung der Signale x = cosφ und y = sinφ . Wie man erkennt liegen die Messpunkte 23, 24, 25, 26, 27 in Form M(x, y) auf einem Kreis 21 um den Ursprung 22, wobei der Winkel φ zwischen dem Vektor vom Ursprung 22 zum Messpunkt M und der horizontalen Achse x gemessen wird.

Der in Fig. 3 dargestellte Verlauf entspricht dem Verlauf des Winkels φ bei mehreren Umdrehungen des Rades 1 1. Dabei stellt eine Periode von 0 bis 2π eine volle Umdrehung dar.

Fig. 4 stellt ein Flussdiagramm des erfindungsgemäßen Auswerteverfahrens dar. Wenn die Signale x = cosφ und j = sinφ der Beschleunigungssensor 12, 13 mit einem Offset behaftet sind, wird dieser im Block 41 kompensiert. Anschließend wird aus den offset- kompensierten Signalen im Block 42 mittels einer atan2 Berechnung ein Phasenwert φ, ermittelt. Im Block 43 wird anschließend aus dem Phasenwert φ, und dem Phasenwert φ ₀ ein Phasendifferenzwert δφ, berechnet. Im Block 44 wird aus dem Phasendifferenzwert δφ, eine vorzeichenbehaftete Drehrichtung und/oder Drehgeschwindigkeit ω bestimmt. Diese Schritte werden für die Phasenwerte φ-i, ς> ₂ , 93...φ, wiederholt. Erfindungsgemäß erfolgt dies auf Grundlage eines Nonius-Verfahrens.

In Fig. 5 ist der Verlauf des Phasendifferenzwerts δφ zusammen mit den Differenzwerten δφ-i, δφ ₂ , δφ ₃ dargestellt. Dabei stellt eine Periode von 0 bis 2π eine volle Umdrehung des Rades 1 1 dar.

Fig. 6 zeigt einen Signalflussgraph zur Nonius-Berechnung. Im Block 61 werden N Pha- sendifferenzwerte δφ in /V- 7 abgebildete Werte S durch lineare Transformation transformiert. Im Block 62 werden die /V- 7 abgebildeten Werte S in /V- 7 Werte W durch Quantisierung überführt. Anschließend werden die /V- 7 quantisierten Werte W im Block 63 durch lineare Transformation auf N Werte Z abgebildet. Zu den N transformierten Werten Z werden im Block 64 N gewichtete Phasendifferenzwerte δφ hinzuaddiert. Im Block 65 wird anschließend die Summe aus den N gewichteten Phasendifferenzwerten δφ und den N Werten Z korrigiert, was schließlich zu Drehrichtung und/oder Drehgeschwindigkeit ω führt.

In Fig. 7 ist ein Blockschaltbild der erfindungsgemäßen Schaltungsanordnung gezeigt, wie sie im Zusammenhang mit Motion Detection (MSI) zur Anwendung kommt. Die Sen-

soren 71 , 72 nehmen die Beschleunigung des Rades 1 1 in der Form x = cosφ und j = sinφ auf. Diese Signale werden anschließend in den Abtasteinrichtungen 73, 74 abgetastet, d.h. aus den kontinuierlichen Werten werden diskrete Werte erzeugt. Diese diskreten Werte werden anschließend mittels eines Analog-Digital-Wandlers (A/D- Wandler) 75 digitalisiert. Die so digitalisierten Werte werden dann in einem digitalen Signalprozessor (DSP) 76 weiter verarbeitet, um so eine horizontale und/oder vertikale Bewegung, die Drehrichtung und/oder die Drehgeschwindigkeit des Rades 11 zu bestimmen. Die Abtasteinrichtung 73, der A/D-Wandler 75 und der DSP 76 können dabei zu einer Motion Detection (MSI) Einrichtung 77 zusammengefasst werden.