-
Notifications
You must be signed in to change notification settings - Fork 1
/
tap_tempo.c
71 lines (59 loc) · 1.43 KB
/
tap_tempo.c
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
/*
* tap_tempo.c
*
* Created on: May 6, 2014
* Author: Rob
*/
#include "tap_tempo.h"
#include "timing.h"
#include "subsys.h"
#include "task.h"
#include "buffer_printf.h"
tint_t last_taps[MAX_TAPS];
void RegisterTap(void) {
tint_t last_tap;
int i;
// if buffer is empty, set to now
if (last_taps[0] == 0) {
last_taps[0] = TimeNow();
return;
}
// find the last tap time in buffer
for (i = 0; i < MAX_TAPS; i++) {
if (last_taps[i] != 0) last_tap = last_taps[i];
else break;
}
// if the last tap was over 2 seconds ago, clear the buffer and set first tap to now
if (TimeSince(last_tap) > 1999) {
for (i = 0; i < MAX_TAPS; i++) {
last_taps[i] = 0;
}
last_taps[0] = TimeNow();
return;
}
// if we have filled the buffer, shift all taps down and add TimeNow() to the last slot
// This may not be the most efficient way to do this (especially if MAX_TAPS is big)
if (i == MAX_TAPS) {
int j;
for (j = 0; j < MAX_TAPS - 1; j++) {
last_taps[j] = last_taps[j + 1];
}
last_taps[--i] = TimeNow();
} else { // if we haven't filled the buffer, add TimeNow() to the end
last_taps[i] = TimeNow();
}
}
tint_t GetTempo(void)
{
tint_t last_tap;
int i;
for (i = 0; i < MAX_TAPS; i++) {
if (last_taps[i] != 0) last_tap = last_taps[i];
else break;
}
return (last_tap - last_taps[0]) / i;
}
tint_t GetTap(int i)
{
return last_taps[i];
}