aboutsummaryrefslogtreecommitdiffstats
path: root/src/ginput/toggle.c
blob: 890ac1dc9c3f2ccfe929d3e09b2fb16a45ea983b (plain)
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
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
/*
    ChibiOS/GFX - Copyright (C) 2012
                 Joel Bodenmann aka Tectu <joel@unormal.org>

    This file is part of ChibiOS/GFX.

    ChibiOS/GFX 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.

    ChibiOS/GFX 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, see <http://www.gnu.org/licenses/>.
*/

/**
 * @file    src/ginput/toggle.c
 * @brief   GINPUT toggle code.
 *
 * @addtogroup GINPUT_TOGGLE
 * @{
 */
#include "ch.h"
#include "hal.h"
#include "gtimer.h"
#include "ginput.h"

#if GINPUT_NEED_TOGGLE || defined(__DOXYGEN__)

#include "lld/ginput/toggle.h"

#define GINPUT_TOGGLE_ISON		0x01
#define GINPUT_TOGGLE_INVERT	0x02

static GTIMER_DECL(ToggleTimer);
static struct GEventToggleStatus_t {
	uint8_t		status;
} ToggleStatus[GINPUT_TOGGLE_NUM_PORTS];

// Our polling function
static void TogglePoll(void *param) {
	(void) param;

	const GToggleConfig	*ptc;
	GSourceListener	*psl;
	GEventToggle	*pe;
	unsigned		i, bits, mask;
	uint8_t 		state;
	
	// Loop while there are bits to get
	for(ptc = GInputToggleConfigTable, i=0; i < GINPUT_TOGGLE_NUM_PORTS; ptc++) {
	
		// Get the next block of bits
		bits = ginput_lld_toggle_getbits(ptc) ^ ptc->invert;

		// Extract the bits of use
		for(mask = ptc->mask; i < GINPUT_TOGGLE_NUM_PORTS && mask; mask >>= 1, bits >>= 1) {
			// Ignore bits not in our mask
			if (!(mask & 1))
				continue;
		
			// Calculate our new state
			state = ToggleStatus[i].status & ~GINPUT_TOGGLE_ISON;
			if (state & GINPUT_TOGGLE_INVERT)
				bits ^= 1;
			if (bits & 1)
				state |= GINPUT_TOGGLE_ISON;

			// Has it changed?
			if ((state ^ ToggleStatus[i].status) & GINPUT_TOGGLE_ISON) {
			
				// Save the new state
				ToggleStatus[i].status = state;
				
				// Send the event to the listeners that are interested.
				psl = 0;
				while ((psl = geventGetSourceListener((GSourceHandle)(ToggleStatus+i), psl))) {
					if (!(pe = (GEventToggle *)geventGetEventBuffer(psl)))
						continue;
					if ((state & GINPUT_TOGGLE_ISON)) {
						if ((psl->listenflags & GLISTEN_TOGGLE_ON)) {
							pe->type = GEVENT_TOGGLE;
							pe->instance = i;
							pe->on = TRUE;
							geventSendEvent(psl);
						}
					} else {
						if ((psl->listenflags & GLISTEN_TOGGLE_OFF)) {
							pe->type = GEVENT_TOGGLE;
							pe->instance = i;
							pe->on = FALSE;
							geventSendEvent(psl);
						}
					}
				}
			}

			// Next toggle switch
			i++;
		}
	}
}

/* Hardware Toggle/Switch/Button Functions */
GSourceHandle ginputGetToggle(uint16_t instance) {
	const GToggleConfig	*ptc;

	if (instance >= GINPUT_TOGGLE_NUM_PORTS)
		return 0;

	// Do we need to initialise the toggle subsystem?
	if (!gtimerIsActive(&ToggleTimer)) {
		for(ptc = GInputToggleConfigTable; ptc < GInputToggleConfigTable+sizeof(GInputToggleConfigTable)/sizeof(GInputToggleConfigTable[0]); ptc++)
			ginput_lld_toggle_init(ptc);
		gtimerStart(&ToggleTimer, TogglePoll, 0, TRUE, GINPUT_TOGGLE_POLL_PERIOD);
	}
		
	// OK - return this input
	return (GSourceHandle)(ToggleStatus+instance);
}

// If invert is true, invert the on/off sense for the toggle
void ginputInvertToggle(uint16_t instance, bool_t invert) {
	if (instance >= GINPUT_TOGGLE_NUM_PORTS)
		return;
	if (invert) {
		if (!(ToggleStatus[instance].status & GINPUT_TOGGLE_INVERT)) {
			ToggleStatus[instance].status |= GINPUT_TOGGLE_INVERT;
			ToggleStatus[instance].status ^= GINPUT_TOGGLE_ISON;
		}
	} else {
		if ((ToggleStatus[instance].status & GINPUT_TOGGLE_INVERT)) {
			ToggleStatus[instance].status &= ~GINPUT_TOGGLE_INVERT;
			ToggleStatus[instance].status ^= GINPUT_TOGGLE_ISON;
		}
	}
}

/* Get the current toggle status.
 *	Returns FALSE on error (eg invalid instance)
 */
bool_t ginputGetToggleStatus(uint16_t instance, GEventToggle *ptoggle) {
	if (instance >= GINPUT_TOGGLE_NUM_PORTS)
		return FALSE;
	ptoggle->type = GEVENT_TOGGLE;
	ptoggle->instance = instance;
	ptoggle->on = (ToggleStatus[instance].status & GINPUT_TOGGLE_ISON) ? TRUE : FALSE;
	return TRUE;
}

/* Wake up the mouse driver from an interrupt service routine (there may be new readings available) */
void ginputToggleWakeup(void) {
	gtimerJab(&ToggleTimer);
}

/* Wake up the mouse driver from an interrupt service routine (there may be new readings available) */
void ginputToggleWakeupI(void) {
	gtimerJabI(&ToggleTimer);
}

#endif /* GINPUT_NEED_TOGGLE */
/** @} */