Обновить Encoder.c
Переделал код согласно замечаниям
This commit is contained in:
parent
52904681ef
commit
40c876d282
93
Encoder.c
93
Encoder.c
@ -1,43 +1,62 @@
|
||||
#define ENC_CLK 0b00000100
|
||||
#define ENC_DAT 0b00001000
|
||||
#define ENC_PIN PIND
|
||||
//----------------------------------------------------------------------
|
||||
int state;
|
||||
int old_state = 0;
|
||||
//----------------------------------------------------------------------
|
||||
int encoder()
|
||||
{
|
||||
if ( !(ENC_PIN & ENC_CLK) )
|
||||
{
|
||||
if ( ENC_PIN & ENC_DAT)
|
||||
{
|
||||
state++;
|
||||
}
|
||||
if ( !(ENC_PIN & ENC_DAT) )
|
||||
{
|
||||
state--;
|
||||
}
|
||||
while(!(ENC_PIN & ENC_CLK))
|
||||
#include <avr/io.h>
|
||||
|
||||
#define F_CPU 1000000UL
|
||||
#define PIND_MASK 0b11000011
|
||||
#define PIND_SHIFT 6
|
||||
|
||||
volatile uint8_t next_state, prev_state, state, state_1;
|
||||
int sw34; // Передача
|
||||
|
||||
void read_encoder_state()
|
||||
{
|
||||
// Читаем состояние энкодера
|
||||
next_state = (PIND & PIND_MASK) >> PIND_SHIFT;
|
||||
|
||||
// Обновляем состояние энкодера
|
||||
if (next_state != prev_state)
|
||||
{
|
||||
|
||||
switch (next_state)
|
||||
{
|
||||
case 0: // CW
|
||||
if (prev_state == 3) state++;
|
||||
else if (prev_state == 0) state--;
|
||||
break;
|
||||
case 1: // CCW
|
||||
if (prev_state == 1) state++;
|
||||
else if (prev_state == 2) state--;
|
||||
break;
|
||||
case 2: // CW
|
||||
if (prev_state == 1) state++;
|
||||
else if (prev_state == 3) state--;
|
||||
break;
|
||||
case 3: // CCW
|
||||
if (prev_state == 2) state++;
|
||||
else if (prev_state == 0) state--;
|
||||
break;
|
||||
}
|
||||
prev_state = next_state;
|
||||
}
|
||||
}
|
||||
return state;
|
||||
}
|
||||
//----------------------------------------------------------------------
|
||||
void encoder_Initialization()
|
||||
|
||||
void setup()
|
||||
{
|
||||
DDRD = 0b00000010;
|
||||
PORTD = 0b00001110;
|
||||
// Инициализация последовательного порта
|
||||
Serial.begin(9600);
|
||||
|
||||
// Настройка портов ввода-вывода
|
||||
DDRD = 0x00;
|
||||
PORTD = PIND_MASK;
|
||||
}
|
||||
//----------------------------------------------------------------------
|
||||
int get_encoder_value()
|
||||
|
||||
void loop()
|
||||
{
|
||||
encoder();
|
||||
if(old_state != state)
|
||||
{
|
||||
old_state = encoder();
|
||||
}
|
||||
return state;
|
||||
}
|
||||
//----------------------------------------------------------------------
|
||||
// Читаем состояние энкодера
|
||||
read_encoder_state();
|
||||
|
||||
// Если состояние энкодера изменилось, выводим его в последовательный порт
|
||||
if (state != sw34)
|
||||
{
|
||||
Serial.println(state);
|
||||
sw34 = state;
|
||||
}
|
||||
}
|
Loading…
Reference in New Issue
Block a user