upd

AlexGyver · Nov 17, 2020 · 6b8d4b6 · 6b8d4b6
1 parent 2a52d24
commit 6b8d4b6
Show file tree

Hide file tree

Showing 2 changed files with 58 additions and 47 deletions.
diff --git a/minimLibs/tachometer/Tacho.h b/minimLibs/tachometer/Tacho.h
@@ -1,50 +1,61 @@
 #pragma once
 
-// класс тахометра
+// класс тахометра v1.1
 // встроенный медианный фильтр
-// вызывай tick в прерывании по фронту
+// вызывай tick() в прерывании по фронту
+// забирай getRPM() в оборотах в минуту и getHz() - в Герцах
 
-#define _TACHO_TICKS_AMOUNT 5	// количество тиков для усреднения
-#define _TACHO_TIMEOUT 1000000	// таймаут прерываний (мкс), после которого считаем что вращение прекратилось
+#define _TACHO_TICKS_AMOUNT 10	  // количество тиков для счёта времени
+#define _TACHO_TIMEOUT 1000000	  // таймаут прерываний (мкс), после которого считаем что вращение прекратилось
 
 class Tacho {
-public:
-	void tick() {
-		ticks++;
-		if (ticks == _TACHO_TICKS_AMOUNT) {
-			ticks = 0;
-			tachoTime = micros() - tachoTimer;
-			tachoTimer += tachoTime;	//tachoTimer = micros();
-			ready = true;
-		}
-	}
-
-	int getRPM() {
-		if (ready) {	// если готовы новые данные
-			ready = false;
-			rpm = median3(60ul * _TACHO_TICKS_AMOUNT * 1000000 / tachoTime);
-		}
-		if (micros() - tachoTimer > _TACHO_TIMEOUT) rpm = 0;
-		return rpm;
-	}
-
-private:
-	// быстрая медиана
-	int median3(int value) {
-		buf[counter] = value;
-		if (++counter > 2) counter = 0;
-		if ((buf[0] <= buf[1]) && (buf[0] <= buf[2])) return (buf[1] <= buf[2]) ? buf[1] : buf[2];
-		else {
-			if ((buf[1] <= buf[0]) && (buf[1] <= buf[2])) return (buf[0] <= buf[2]) ? buf[0] : buf[2];
-			else return (buf[0] <= buf[1]) ? buf[0] : buf[1];
-		}
-	}
+  public:
+    void tick() {   // tachoTime - время в мкс каждых _TACHO_TICKS_AMOUNT тиков
+      ticks++;
+      if (ticks == _TACHO_TICKS_AMOUNT) {
+        ticks = 0;
+        tachoTime = micros() - tachoTimer;
+        tachoTimer += tachoTime;  //== tachoTimer = micros();
+        ready = true;
+      }
+    }
 
-	volatile long tachoTime = 0;
-	volatile uint32_t tachoTimer = 0;
-	volatile byte ticks = 0;
-	volatile bool ready;
-	int buf[3];
-	byte counter = 0;
-	int rpm = 0;
-};
+    uint16_t getRPM() {
+      if (ready) {	// если готовы новые данные
+        ready = false;
+        if (tachoTime != 0) rpm = 60ul * _TACHO_TICKS_AMOUNT * 1000000 / median3(tachoTime);
+      }
+      if (micros() - tachoTimer > _TACHO_TIMEOUT) rpm = 0;
+      return rpm;
+    }
+
+    float getHz() {
+      if (ready) {  // если готовы новые данные
+        ready = false;
+        if (tachoTime != 0) hz = (float)_TACHO_TICKS_AMOUNT * 1000000 / median3(tachoTime);
+      }
+      if (micros() - tachoTimer > _TACHO_TIMEOUT) hz = 0;
+      return hz;
+    }
+
+  private:
+    // быстрая медиана
+    long median3(long value) {
+      buf[counter] = value;
+      if (++counter > 2) counter = 0;
+      if ((buf[0] <= buf[1]) && (buf[0] <= buf[2])) return (buf[1] <= buf[2]) ? buf[1] : buf[2];
+      else {
+        if ((buf[1] <= buf[0]) && (buf[1] <= buf[2])) return (buf[0] <= buf[2]) ? buf[0] : buf[2];
+        else return (buf[0] <= buf[1]) ? buf[0] : buf[1];
+      }
+    }
+
+    volatile uint32_t tachoTime = 100000;   // для плавного старта значений
+    volatile uint32_t tachoTimer = micros();
+    volatile int ticks = 0;
+    volatile bool ready = false;
+    long buf[3] = {100000, 100000, 100000}; // для плавного старта значений
+    byte counter = 0;
+    int rpm = 0;
+    float hz = 0.0;
+};
diff --git a/minimLibs/tachometer/tachometer.ino b/minimLibs/tachometer/tachometer.ino
@@ -1,6 +1,6 @@
 // управляем 4 пин вентилятором и измеряем обороты
-#define PWM_PIN 3     // ШИМ пин
-#define TACH_PIN 2    // пин тахометра
+#define PWM_PIN 10    // ШИМ пин (подключать через резик 100-1000 Ом)
+#define TACH_PIN 2    // пин тахометра (желательна внешняя подтяжка 10к к VCC)
 
 #include "Tacho.h"
 Tacho tacho;
@@ -16,7 +16,7 @@ void setup() {
   attachInterrupt(0, isr, FALLING);
 
   // включаем вентиль на скорость 150 (из 255)
-  analogWrite(PWM_PIN, 150);
+  analogWrite(PWM_PIN, 190);
 }
 
 // обработчик прерывания
@@ -27,7 +27,7 @@ void isr() {
 void loop() {
   // выводим два раза в секунду
   static uint32_t tmr;
-  if (millis() - tmr > 500) {
+  if (millis() - tmr > 100) {
     tmr = millis();
     Serial.println(tacho.getRPM());
   }