LPMStat/ButtonsReaderTask.cpp at master · a-tk-by/LPMStat · 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
#include "ButtonsReaderTask.h"

#include "Arduino.h"
#include "ExpressTask.h"
#include "StaticAllocActivator.h"
#include "Globals.h"
#include "Buttons.h"

static const int FirstTick = 1000;
static const int NextTick = 600;

TASK_BEGIN(ButtonsReaderTask, {
	byte adc;
	byte prevButtons;
	byte current;
	unsigned long nextTick;
})

Buttons::Reset(::PressedButtons);

for (;;)
{
	adc = analogRead((byte)Pins::LCD_BUTTONS) >> 2;

    /*
	None - 321

	Right - 399
	Up - 788
	Down - 500
	Left - 929
	Select - 637
	*/

    if (adc < 90)
	{
		current = Buttons::None;
	}
	else if (adc < 110)
	{
        current = Buttons::Up;// Buttons::Right;
	}
	else if (adc < 140)
	{
        current = Buttons::Right; //Buttons::Down;
	}
	else if (adc < 180)
	{
		current = Buttons::Select;
	}
	else if (adc < 220)
	{
        current = Buttons::Left;// Buttons::Up;
	}
	else
	{
        current = Buttons::Down;// Buttons::Left;
	}

	if (current != Buttons::None)
	{
		if (prevButtons != current)
		{
			Buttons::Set(::PressedButtons, current);
			nextTick = millis() + FirstTick;
		}
		else
		{
			if (millis() > nextTick)
			{
				Buttons::Set(::PressedButtons, current);
				nextTick += NextTick;
			}
		}
	}
	prevButtons = current;

	TASK_SLEEP(10);
}

TASK_END;

bool RegisterButtonsReaderTask(Scheduler& scheduler)
{
	return scheduler.Register(InstanceOnce<ButtonsReaderTask>(), TaskPriority::RealTime);
}