Próbowałem dziś sprawdzić, jak zlicza impulsy enkoder inkrementalny, który niedawno zakupiłem. Po napisaniu kodu programu i testowaniu okazuje się, że przy szybszych ruchach ręką w celu obrotu enkodera i powrotu do pozycji początkowej enkoder nie wskazuje 0-era, a wartości np. 5-6 większe/mniejsze. Prosiłbym więc was o pomoc w tej sprawie, w jaki sposób mógłbym usprawnić działanie programu, aby nie występowało zjawisko pomijania/gubienia impulsów.
Enkoder użyty do zliczania:
http://sklep.cncprofi.com/enkoder-profi ... b-z-z.html
Podłączenie do Arduino : 5V-Vcc,GND-GND, Sygnały A i B odpowiednio do pinów 2 i 4 wraz z rezystorami 10k Ohm
Kod programu:
[syntax=c][code]
#define PhaseA 2
#define PhaseB 4
#define clockwise 1
#define counterclockwise 2
volatile long encposition= 0;
short encdirection = clockwise;
long lastposition = 0;
void setup()
{
pinMode(PhaseA, INPUT);
pinMode(PhaseB, INPUT);
attachInterrupt(digitalPinToInterrupt(2), isr, RISING);
Serial.begin (19200);
}
void loop()
{
if (encposition != lastposition )
{
Serial.print(encposition, DEC);
Serial.print(encdirection == clockwise ? "clockwise" : "counterclockwise");
lastposition = encposition;
}
}
void isr()
{
int a = digitalRead(PhaseA);
int b = digitalRead(PhaseB);
if (a == b)
{
encposition--;
encdirection = counterclockwise;
}
else
{
encposition++;
encdirection = clockwise ;
}
}
[/code][/syntax]
Dołączona specyfikacja
PS: Enkoder ma oznaczenie ZL3806-360-5-24L jeśli jest to istotne.
Dziękuję i pozdrawiam
Statystyki: Napisane przez Pretas — 2 maja 2017, o 20:43
]]>