172 lines
5.1 KiB
C
172 lines
5.1 KiB
C
/*
|
|
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.
|
|
*
|
|
* @defgroup Toggle Toggle
|
|
* @ingroup GINPUT
|
|
* @{
|
|
*/
|
|
#include "ch.h"
|
|
#include "hal.h"
|
|
#include "gfx.h"
|
|
|
|
#if (GFX_USE_GINPUT && GINPUT_NEED_TOGGLE) || defined(__DOXYGEN__)
|
|
|
|
#include "ginput/lld/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) {
|
|
// Win32 threads don't seem to recognise priority and/or pre-emption
|
|
// so we add a sleep here to prevent 100% polled applications from locking up.
|
|
chThdSleepMilliseconds(1);
|
|
|
|
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 /* GFX_USE_GINPUT && GINPUT_NEED_TOGGLE */
|
|
/** @} */
|