Zweiphasiger Drehencoder

[Mike M. (mikeii)]

Hab hier schnell mal was für einen zweiphasigen Drehencoder 
zusammengebastelt.

Gilt für Drehencoder mit folgender Sequenz 00->01->11->00

#include <util/delay.h>
#include <avr/io.h>
#define PHASE_A  (PINC & 1<<PA0)
#define PHASE_B  (PINC & 1<<PA1)
#define ROTARY_ENC  (1<<0) | (1<<1)


void wait(uint16_t ms){
  while(ms){
    ms--;
    _delay_ms(1);
  }
}

uint8_t rotary(void)
{
    static uint8_t gray_old = 0;
    uint8_t gray;
    uint8_t ret;

    ///Hier sollte eine richtige Timerroutine eingebaut werden
    wait(1);

    //Graycode Umrechnen
    gray = 0;
    if( PHASE_A )
        gray = 3;
    if( PHASE_B )
        gray ^= 1;

    //Ist die Diff -1 oder 2 -> Drehung nach rechts
    //Ist die Diff 1 oder -2 -> Drehung nach links
    //Ist die Diff 0         -> Keine Drehung
    switch(gray_old - gray)
    {
    case -1:ret = 1;break;
    case  2:ret = 1;break;
    case  1:ret = 2;break;
    case -2:ret = 2;break;
    case  0:ret = 0;break;
    }
    gray_old = gray;
    //1 bedeutet rechts
    //2 bedeutet links
    //0 bedeutet keine Drehung
    return ret;
}


main()

    //Pullups
    PORTC |= (1<<PA0) | (1<<PA1);
    uint8_t richtung;
    //Einmalig aufrufen um Werte zu initialisieren
    rotary();

    while(1)
    {
        richtung = rotary();
    }
}

Es ist nicht gerade der sauberste Stil, aber wer es brauchen kann, soll 
es benutzen.