ArduinoDatalogger/Button.cpp at master · rihteri/ArduinoDatalogger · GitHub

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
#include "Button.h"

Button::Button() :
    _functions(NULL),
    _startMillis(-1),
    _nfunctions(0),
    _alreadyRun(false)
{ }

Button::~Button()
{
    delete _functions;
}

void Button::attachFunction(void (*callback)(), int delay)
{
    ButtonFunction* old = _functions;
    _nfunctions++;
    _functions = new ButtonFunction[_nfunctions];

    bool newFuncPlaced = false;
    for (int i = 0; i < _nfunctions; i++)
    {
        if (!newFuncPlaced)
        {
            if(i < _nfunctions - 1
               && _functions[i].delay < delay)
            {
                _functions[i] = old[i];
            }
            else
            {
                _functions[i].callback = callback;
                _functions[i].delay = delay;

                newFuncPlaced = true;
            }
        }
        else
        {
            _functions[i] = old[i-1];
        }
    }

    delete old;
}

void Button::update(char value)
{
    if (value > 0)
    {
        if (_startMillis < 0)
        {
            _startMillis = millis();
            _alreadyRun = false;
        }
        else if (_functions[_nfunctions-1].delay < millis() - _startMillis
                && !_alreadyRun)
        {
            // last press timeout reached
            _functions[_nfunctions-1].callback();
            _alreadyRun = true;
        }
    }
    else
    {
        if (_startMillis >= 0 && !_alreadyRun)
        {
            long millisNow = millis();

            void (*callback)() = NULL;
            for (int i = 0; i < _nfunctions; i++)
            {
                if (_functions[i].delay < millisNow - _startMillis)
                {
                    callback = _functions[i].callback;
                }
            }

            if (callback != NULL)
            {
                callback();
            }
        }

        _startMillis = -1;
    }
}