126 lines
2.3 KiB
C
126 lines
2.3 KiB
C
|
/**
|
||
|
|
* Rotary encoder routines
|
||
|
|
*
|
||
|
|
* @copyright 2012 Institute Automation of Complex Power Systems (ACS), RWTH Aachen University
|
||
|
|
* @license http://www.gnu.org/licenses/gpl.txt GNU Public License
|
||
|
|
* @author Steffen Vogel <info@steffenvogel.de>
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "rotary.h"
|
||
|
|
|
||
|
|
/**
|
||
|
|
* Drehgeber initialisieren
|
||
|
|
*/
|
||
|
|
void dgb_init() {
|
||
|
|
// DDR auf input setzen
|
||
|
|
SW_DDR &= ~(1<<SW_PIN_GRUEN);
|
||
|
|
SW_DDR &= ~(1<<SW_PIN_BLAU);
|
||
|
|
DGB_DDR &= ~(1<<DGB_PIN_A);
|
||
|
|
DGB_DDR &= ~(1<<DGB_PIN_B);
|
||
|
|
DGB_DDR &= ~(1<<DGB_PIN_SW);
|
||
|
|
|
||
|
|
// PullUps einschalten
|
||
|
|
SW_PORT |= (1<<SW_PIN_GRUEN);
|
||
|
|
SW_PORT |= (1<<SW_PIN_BLAU);
|
||
|
|
DGB_PORT |= (1<<DGB_PIN_A);
|
||
|
|
DGB_PORT |= (1<<DGB_PIN_B);
|
||
|
|
DGB_PORT |= (1<<DGB_PIN_SW);
|
||
|
|
}
|
||
|
|
|
||
|
|
/**
|
||
|
|
* Drehgeber auslesen
|
||
|
|
*
|
||
|
|
* Diese Funktion sollte periodisch aufgerufen werden (Polling)
|
||
|
|
*/
|
||
|
|
uint8_t dgb_read() {
|
||
|
|
// Debouncing
|
||
|
|
volatile static uint8_t lastA;
|
||
|
|
volatile static uint8_t lastSW;
|
||
|
|
volatile static uint8_t lastSW_Gruen;
|
||
|
|
volatile static uint8_t lastSW_Blau;
|
||
|
|
|
||
|
|
volatile static bool trigger;
|
||
|
|
volatile static bool ready;
|
||
|
|
volatile static bool ignore;
|
||
|
|
|
||
|
|
enum taster eingabe = 0;
|
||
|
|
|
||
|
|
// Drehgeber Trigger finden
|
||
|
|
if ((!(DGB_PIN & (1<<DGB_PIN_A))) && !trigger) {
|
||
|
|
if(lastA < 3) {
|
||
|
|
lastA++;
|
||
|
|
}
|
||
|
|
else {
|
||
|
|
trigger = true;
|
||
|
|
lastA = 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
// Richtung auswerten
|
||
|
|
if (trigger && !ready) {
|
||
|
|
if (!(DGB_PIN & (1<<DGB_PIN_B))) {
|
||
|
|
eingabe = DGB_CCW;
|
||
|
|
ready = true;
|
||
|
|
}
|
||
|
|
else {
|
||
|
|
eingabe = DGB_CW;
|
||
|
|
ready = true;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if(ready && (DGB_PIN & (1<<DGB_PIN_A))) {
|
||
|
|
ready = false;
|
||
|
|
trigger = false;
|
||
|
|
}
|
||
|
|
|
||
|
|
// Schalter des Drehgebers auswerten
|
||
|
|
if (!(DGB_PIN & (1<<DGB_PIN_SW))) {
|
||
|
|
if (lastSW < 255) lastSW++;
|
||
|
|
}
|
||
|
|
else if (lastSW == 255) {
|
||
|
|
lastSW = 0;
|
||
|
|
if (ignore) {
|
||
|
|
ignore = false;
|
||
|
|
}
|
||
|
|
else {
|
||
|
|
eingabe = DGB_SW;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
// zusätzliche Schalter auswerten
|
||
|
|
if (!(SW_PIN & (1<<SW_PIN_GRUEN))) {
|
||
|
|
if(lastSW_Gruen < 255) {
|
||
|
|
lastSW_Gruen++;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
else if (lastSW_Gruen == 255) {
|
||
|
|
lastSW_Gruen = 0;
|
||
|
|
|
||
|
|
if (ignore) {
|
||
|
|
ignore = false;
|
||
|
|
}
|
||
|
|
else {
|
||
|
|
eingabe = SW_GRUEN;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
if (!(SW_PIN & (1<<SW_PIN_BLAU))) {
|
||
|
|
if (lastSW_Blau < 255) {
|
||
|
|
lastSW_Blau++;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
else if (lastSW_Blau == 255) {
|
||
|
|
lastSW_Blau = 0;
|
||
|
|
|
||
|
|
if (ignore) {
|
||
|
|
ignore = false;
|
||
|
|
}
|
||
|
|
else {
|
||
|
|
eingabe = SW_BLAU;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return eingabe;
|
||
|
|
}
|