Aus RN-Wissen.de
Version vom 11. Januar 2011, 02:13 Uhr von E6axis (Diskussion | Beiträge) (Kapitel zur Drehrichtungserkennung hinzugefügt)

Wechseln zu: Navigation, Suche
Rasenmaehroboter Test


Beispiele zum Messen der Drehzahl in Abhängigkeit einer zurückgelegten Strecke oder einer Abgelaufenen Zeit

  • Messen der Drehzahl nach jedem Impuls, also in Abhängigkeit einer zurückgelegten Strecke.
  • Messen der Drehzahl durch Zählen der Impulse nach Ablauf einer bestimmten Zeit.
  • Messen der Drehzahl und Drehrichtung durch Auswertung von Doppellichtschranke
Dieser Artikel ist noch lange nicht vollständig. Der Auto/Initiator hofft das sich weitere User am Ausbau des Artikels beteiligen.

Das Ergänzen ist also ausdrücklich gewünscht! Besonders folgende Dinge würden noch fehlen:

Mehr Grundlagen und vor allem mal praktische Programmbeispiele / Algorithmen etc.


Messen der Drehzahl nach jedem Impuls

Dieser Teil beschäftigt sich mit der Optischen Drehzahlmessung mit Hilfe einer Lochscheibe und Gabellichtschranke berechnet über die Periodendauer ohne Drehrichtungserkennung.

Testaufbau mit einer 32er Lochscheibe
GP1S23 Gabellichtschranke Bild: Conrad Electronic


Einführung

Die Winkelgeschwindigkeit ist die Winkeländerung pro Zeiteinheit. Mit der Lichtschranke und den geometrischen Daten der Lochscheibe kann man nun relativ einfach die Zeit für eine bestimmte Winkeländerung messen. Die Lochscheibe gibt uns die Winkeländerung bei einer Periode vor, bei einer 32er Lochscheibe wären das 11,25° pro Periode , wie in den Bildern vom Oszilloskop zu sehen ändert sich natürlich bei Änderung der Drehzahl die Periodendauer, die Winkeländerung pro Periode ist aber konstant da diese durch die Lochscheibe vor gegeben ist.

Um die Periodendauer zu messen verwende ich den ICP1 (Input Capture Pin) eines Atmega8 der bei steigender Flanke den Timer1 ausliest und in das ICR1 Register schreibt. Läuft der Mikrocontroller auf 8Mhz und wir stellen den Vorteiler des Timers auf 8 so bekommen wir die Periodendauer in µs als Wert.

Auslegen der Lochscheibe

In den meisten fällen definiert der mechanische Aufbau den Durchmesser der Lochscheibe und die Drehzahl die Anzahl der Löcher, der µC muss und die Gabellichtschranke müssen die Impulse auch erfassen können. Wenn man das Drehzahlband abschätzen kann ist es hilfreich sich schon Gedanken um die Programmierung zu machen, denn bei hohen Drehzahlen springt der µC jedes mal in die Interrupt Service Routine rein wenn man es so programmiert wie im Beispiel. Bei hohen Drehzahlen sollte die Auflösung somit gröber sein, bei niedriger feiner.

Lochscheibe abgerollt mit idealisiertem Signal

Berechnungen

Hier folgt nun die Berechnung über die Periodendauer, beachten sollte man das im Bogenmaß gerechnet wird, ein Winkel mit dem Bogenmaß 1 rad hat ein Gradmaß von ca. 57,3°. 11.25° sind also ca. 0,196 rad, das führt später natürlich zu unschönen Rechenoperationen im µC, Stichwort Festkommaarithmetik.

Nach dem umstellen kommt man aber auf eine recht handliche Formel [math]n = \frac{\varphi }{dt \cdot 360}[/math]

Es ist auch eine Überlegung wert ob man die Drehzahl nicht umrechnet sondern mit der Periodendauer arbeitet, das ist zwar nicht so geläufig aber das stört den µC nicht. Mit einem Kalkulationsprogramm hat man sich schnell ein Tool gemacht was die Umrechnung vornimmt.




Messen der Drehzahl durch zählen der Impulse

Dieser Teil beschäftigt sich mit der Optischen Drehzahlmessung mit Hilfe einer Lochscheibe und Gabellichtschranke berechnet über die die Anzahl der Impulse in einer gewissen Zeit.

Einführung

Berechnung

Messen der Drehzahl und Ermitteln der Drehrichtung

Einführung

Für kontrollierte Bewegungen ist mitunter wichtig, auch die Drehrichtung/Richtungswechsel auszuwerten. Eine Lochscheibe mit einer Gabellichtschranke liefert lediglich Rechteckimpulse, egal wie rum sich die Lochscheibe bewegt. Bringt man eine zweite Gabellichtschranke an der gleichen Lochscheibe leicht versetzt an, bekommt man auch die Drehrichtung mit. Diese Methode ist altbekannt, simpel und leicht nachzubauen. Interessierte nehmen dazu mal eine PC-Maus mit Kugelantrieb zur Hand. Darin findet man zwei kleine Lochscheiben, die für die X- und Y-Richtung die Impulse erzeugen. Durch spezielle Gabellichtschranken mit 2 phasenversetzten Ausgängen wird auch die Drehrichtung erkannt. Aber es geht natürlich noch einfacher...

Zwei Lichtschranken liefern vier Informationen

Man nimmt 2 normale Gabellichtschranken und bringt sie so an, das sie im 1,5 fachen Lochabstand die Lochscheibe durchleuchten. Wenn sich Lichtschranke A in der Mitte des Lichtstreifens befindet, ist also Lichtschranke B schon an der Grenze zum Schattenstreifen und tritt aus dem Lichtstreifen heraus. Wichtig ist hierbei, das die Lochscheibe in gleich breite Licht- und Schattensegmente eingeteilt ist und die Lichtschranke einen möglichst haarfeinen Lichtstrahl besitzt. (Skizze folgt)

Es ergeben sich nun folgende Kombinationen:

  • Zustand 1: LSA = hell und LSB = hell
  • Zustand 2: LSA = hell und LSB = dunkel
  • Zustand 3: LSA = dunkel und LSB = dunkel
  • Zustand 4: LSA = dunkel und LSB = hell
2 Lichtschranken (LSA und LSB) liefern phasenversetzte Rechtecksignale. In Vorwärts- und Rückwärtsrichtung ergeben sich unterschiedliche Zustandsfolgen


Dreht man die Lochscheibe weiter, wiederholt sich der Vorgang. Die Zustandsfolge ist 1 > 2 > 3 > 4 > 1 > 2 > 3 > 4 > usw.

Bei entgegengesetzter Drehrichtung ändert sich aber diese Reihenfolge. Betrachtet man wieder vom Zustand 1 ausgehend die Gegenrichtung, ergeben sich nun diese Kombinationen:

  • Zustand 1: LSA = hell und LSB = hell
  • Zustand 4: LSA = dunkel und LSB = hell
  • Zustand 3: LSA = dunkel und LSB = dunkel
  • Zustand 2: LSA = hell und LSB = dunkel

Die Zustandsfolge in Gegenrichtung lautet dann: 1 < 4 < 3 < 2 < 1 < 4 < 3 < 2 < usw.

Mit diesem Wissen ist es nun ein Kinderspiel, auch die Änderung der Drehrichtung festzustellen. Dazu muss der letzte Zustand in einer Variable gespeichert und mit dem neu erkannten Zustand verglichen werden. Folgt nach Zustand 1 der Zustand 2 so ist es eine Vorwärtsbewegung, folgt dem Zustand 1 der Zustand 4 so ist es eine Rückwärtsbewegung.

Insgesamt müssen demzufolge 8 Bedingungen geprüft und ein Zähler entsprechend inkrementiert oder dekrementiert werden und schon hat man eine exakte Streckeninformation. In Worte gefasst ergibt sich folgende Programmlogik:

Ausgangszustand: Beide Lichtschranken = 0 und Zustand =1









Vor und Nachteile der Messmethoden


LiFePO4 Speicher Test