-
Notifications
You must be signed in to change notification settings - Fork 0
/
joystick.cpp
71 lines (58 loc) · 2.13 KB
/
joystick.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
/*****************************************************************************
* joystick.h
*
* Joystick handler
*
* ---------------------------------------------------------------------------
* ardccino - Arduino dual PWM/DCC controller
* (C) 2013-2015 Gerardo García Peña <killabytenow@gmail.com>
*
* 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
* for more details.
*
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
*
*****************************************************************************/
#include "joystick.h"
#ifdef JOY_ENABLED
#ifdef SIMULATOR
int sim_joystick_status;
# define analogRead(x) ((x) & sim_joystick_status)
#endif
uint8_t Joystick::now = 0;
uint8_t Joystick::old = 0;
void Joystick::read(void)
{
int v;
// reset joystick status
old = Joystick::now;
Joystick::now = 0;
// update X axis
v = analogRead(JOY_PIN_AXIS_X);
if (v < (JOY_RANGE_AXIS_X >> 2)) Joystick::now |= JOY_LEFT;
else if(v > (JOY_RANGE_AXIS_X >> 1) + (JOY_RANGE_AXIS_X >> 2)) Joystick::now |= JOY_RIGHT;
// update Y axis
v = analogRead(JOY_PIN_AXIS_Y);
if (v < (JOY_RANGE_AXIS_Y >> 2)) Joystick::now |= JOY_UP;
else if(v > (JOY_RANGE_AXIS_Y >> 1) + (JOY_RANGE_AXIS_Y >> 2)) Joystick::now |= JOY_DOWN;
// update button
if(analogRead(JOY_PIN_BUTTON) == 0) Joystick::now |= JOY_BUTTON;
}
bool Joystick::move(uint8_t flag)
{
return (old & Joystick::now & flag) == flag;
}
bool Joystick::pressed(uint8_t flag)
{
return (~old & Joystick::now & flag) == flag;
}
#endif