-
Notifications
You must be signed in to change notification settings - Fork 4
/
FreqPeriodCounter.cpp
88 lines (72 loc) · 3.42 KB
/
FreqPeriodCounter.cpp
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
/*
FreqPeriodCounter
Copyright (C) 2012 Albert van Dalen http://www.avdweb.nl
This program is free software: you can redistribute it and/or modify it under the terms of the GNU General Public License
as published by the Free Software Foundation, either version 3 of the License, or (at your option) any later version.
This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty
of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License at http://www.gnu.org/licenses .
AUTHOR: Albert van Dalen
WEBSITE: http://www.avdweb.nl/arduino/libraries/frequency-period-counter.html
HISTORY:
1.0.0 17-12-2011 timeFunctionPtr to select millis or micros instead of bool variable
1.0.1 17-12-2011 New function ready()
1.0.2 22-04-2012 poll() counts all transients instead of low-high transients
1.0.3 5-5-2013 if(transientCount >= 2) // the first 2 measurements are invalid
1.0.4 28-5-2013 measurements are valid from start, added synchronize()
1.0.5 7-2-2017 Versatile by omitting the input pin, added poll(bool _level) and added constructor
<------------- period ------------>
pulseWidth
_____________ ______________
|| || || ||
|| || pulseWidthLow || || |
______________|| ||__________________|| ||______________|
transientCount 1 2 1 2 1
transientTime ^ ^ ^ ^
level 1 0 1 0
debounceTime <--> <--> <--> <-->
<- elapsedTime ->
*/
#include "FreqPeriodCounter.h"
FreqPeriodCounter::FreqPeriodCounter(byte pin, unsigned long (*timeFunctionPtr)(), unsigned debounceTime):
pin(pin), debounceTime(debounceTime), timeFunctionPtr(timeFunctionPtr)
{ synchronize();
}
FreqPeriodCounter::FreqPeriodCounter(unsigned long (*timeFunctionPtr)(), unsigned debounceTime):
debounceTime(debounceTime), timeFunctionPtr(timeFunctionPtr)
{ synchronize();
}
bool FreqPeriodCounter::poll(bool _level)
{ level = _level;
time = timeFunctionPtr();
elapsedTime = time - transientTime;
bool returnVal = false;
if((level != lastLevel) && (elapsedTime > debounceTime)) // if transient
{ transientCount++;
lastLevel = level;
transientTime = time;
if(level == HIGH) pulseWidthLow = elapsedTime;
else pulseWidth = elapsedTime;
if(transientCount >= 2)
{ period = pulseWidth + pulseWidthLow;
transientCount = 0;
readyVal = true;
returnVal = true; // return true if a complete period is measured
}
}
return returnVal;
}
bool FreqPeriodCounter::poll() // input pin
{ return poll(digitalRead(pin));
}
bool FreqPeriodCounter::ready()
{ bool returnVal = readyVal;
readyVal = false; // reset after read
return returnVal;
}
unsigned long FreqPeriodCounter::hertz(unsigned int precision)
{ if (timeFunctionPtr == micros) return (unsigned long)precision*1000000/period;
else return (unsigned long)precision*1000/period;
}
void FreqPeriodCounter::synchronize()
{ transientCount = -2; // skip first two invalid measurements
}