blob: abf7c277ec5aa44633e03cf85daa6098c758f4f7 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
|
#include "Counter.h"
#include <Arduino.h>
void Counter::init (unsigned long startDelay, unsigned long rpmCount, unsigned long signalsPerRPM)
{
this->startDelay = startDelay;
this->rpmCount = rpmCount;
this->signalsPerRPM = signalsPerRPM;
reset();
}
void Counter::setStartDelay (unsigned long val)
{
startDelay = val;
}
void Counter::setRPMCount (unsigned long val)
{
rpmCount = val;
}
void Counter::setSignalsPerRPM (unsigned long val)
{
signalsPerRPM = val;
}
void Counter::start (unsigned long startTime)
{
if (state == READY)
{
this->startTime = startTime;
state = WAITING_FOR_TIMEOUT;
}
}
void Counter::reset ()
{
state = READY;
}
void Counter::update (unsigned long t, int rpmSignal)
{
switch (state)
{
case WAITING_FOR_TIMEOUT:
{
if (t - startTime >= startDelay)
{
startTime = t; // Update start time for counting state
signals = 0;
state = COUNTING;
}
break;
}
case COUNTING:
{
// Count signals in 1 second intervals
if (lastRpmSignal != rpmSignal && rpmSignal == HIGH)
{
signals++;
}
// 1 second interval reached
if (t - startTime >= 1000)
{
float rpm = ((float) signals / (float) signalsPerRPM) * 60.0f;
if (rpm <= rpmCount)
{
startTime = t; // Update start time for signaling state
state = SIGNALING;
}
else
{
// RPM threshold not reached.
// Count signals per second from scratch.
//Serial.print("rpm: \r\n"); Serial.print(rpm); Serial.print("\r\n");
startTime = t;
signals = 0;
}
}
break;
}
case SIGNALING:
{
if (t - startTime >= 3000)
{
state = READY;
}
}
default: break;
}
lastRpmSignal = rpmSignal;
}
Counter::State Counter::getState () const
{
return state;
}
|