53 lines
1.2 KiB
C++
53 lines
1.2 KiB
C++
#include <TimerOne.h>
|
|
|
|
const byte IN1 = 6;
|
|
const byte IN2 = 7;
|
|
const byte ENABLE = 5;
|
|
const byte ENCO_B = 4;
|
|
const byte ENCO_A = 2;
|
|
|
|
int count = 0;
|
|
const unsigned long RESET_COUNT_PERIOD_IN_US = 50000;
|
|
const int EDGES_PER_CYCLE = 13;
|
|
const int REDUCTION_RATIO = 20;
|
|
|
|
void setup() {
|
|
pinMode(IN1, OUTPUT);
|
|
pinMode(IN2, OUTPUT);
|
|
pinMode(ENABLE, OUTPUT);
|
|
pinMode(A0, INPUT);
|
|
pinMode(A1, INPUT);
|
|
digitalWrite(IN1, HIGH);
|
|
digitalWrite(IN2, LOW);
|
|
pinMode(ENCO_B, INPUT);
|
|
pinMode(ENCO_A, INPUT);
|
|
Serial.begin(115200);
|
|
Timer1.initialize();
|
|
Timer1.setPeriod(RESET_COUNT_PERIOD_IN_US);
|
|
Timer1.attachInterrupt(resetCountAndPrint);
|
|
attachInterrupt(digitalPinToInterrupt(ENCO_A), onEncoAFalling, FALLING);
|
|
analogWrite(ENABLE, 100);
|
|
}
|
|
|
|
void loop() {
|
|
// Serial.print(digitalRead(2));
|
|
// Serial.print(" ");
|
|
// Serial.println(digitalRead(4));
|
|
// delay(100);
|
|
}
|
|
|
|
void resetCountAndPrint() {
|
|
Serial.print("Rpm: ");
|
|
Serial.println((double)count * 60 * 1000 * 1000 / EDGES_PER_CYCLE / REDUCTION_RATIO / RESET_COUNT_PERIOD_IN_US);
|
|
count = 0;
|
|
}
|
|
|
|
void onEncoAFalling() {
|
|
// Serial.println("In!");
|
|
if (digitalRead(ENCO_B) == LOW) {
|
|
count++;
|
|
}
|
|
else {
|
|
count--;
|
|
}
|
|
} |