diff options
Diffstat (limited to 'drivers/ginput/dial/GADC/ginput_lld_dial.c')
-rw-r--r-- | drivers/ginput/dial/GADC/ginput_lld_dial.c | 101 |
1 files changed, 101 insertions, 0 deletions
diff --git a/drivers/ginput/dial/GADC/ginput_lld_dial.c b/drivers/ginput/dial/GADC/ginput_lld_dial.c new file mode 100644 index 00000000..ced71a27 --- /dev/null +++ b/drivers/ginput/dial/GADC/ginput_lld_dial.c @@ -0,0 +1,101 @@ +/* + ChibiOS/GFX - Copyright (C) 2012, 2013 + 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 drivers/ginput/dial/GADC/ginput_lld_dial.c + * @brief GINPUT Dial low level driver source for GADC hardware. + * + * @defgroup Dial Dial + * @ingroup GINPUT + * @{ + */ + +#include "ch.h" +#include "hal.h" +#include "gfx.h" + +#if GFX_USE_GINPUT && GINPUT_NEED_DIAL + +#include "ginput/lld/dial.h" + +#if GINPUT_DIAL_NUM_PORTS >= 5 + #error "GINPUT: Dial - GADC driver currently only supports 4 devices" +#endif + +static adcsample_t samplebuf[GINPUT_DIAL_NUM_PORTS]; + +#if GINPUT_DIAL_CYCLE_POLL + static uint16_t cycle; +#endif + +static void GADCCallback(adcsample_t *buffer, void *param) { + ((DialCallbackFn)param)(buffer-samplebuf, buffer[0]); +} + +void ginput_lld_dial_init(void) { + #if GINPUT_DIAL_CYCLE_POLL + cycle = 0; + #endif +} + +void ginput_lld_dial_poll(DialCallbackFn fn) { + #if GINPUT_DIAL_CYCLE_POLL + switch(cycle++) { + #if GINPUT_DIAL_NUM_PORTS >= 1 + case 0: + gadcLowSpeedStart(GINPUT_DIAL_DEVICE0, samplebuf+0, GADCCallback, (void *)fn); + break; + #endif + #if GINPUT_DIAL_NUM_PORTS >= 2 + case 1: + gadcLowSpeedStart(GINPUT_DIAL_DEVICE1, samplebuf+1, GADCCallback, (void *)fn); + break; + #endif + #if GINPUT_DIAL_NUM_PORTS >= 3 + case 2: + gadcLowSpeedStart(GINPUT_DIAL_DEVICE2, samplebuf+2, GADCCallback, (void *)fn); + break; + #endif + #if GINPUT_DIAL_NUM_PORTS >= 4 + case 3: + gadcLowSpeedStart(GINPUT_DIAL_DEVICE3, samplebuf+3, GADCCallback, (void *)fn); + break; + #endif + } + if (cycle >= GINPUT_DIAL_NUM_PORTS) + cycle = 0; + #else + #if GINPUT_DIAL_NUM_PORTS >= 1 + gadcLowSpeedStart(GINPUT_DIAL_DEVICE0, samplebuf+0, GADCCallback, (void *)fn); + #endif + #if GINPUT_DIAL_NUM_PORTS >= 2 + gadcLowSpeedStart(GINPUT_DIAL_DEVICE1, samplebuf+1, GADCCallback, (void *)fn); + #endif + #if GINPUT_DIAL_NUM_PORTS >= 3 + gadcLowSpeedStart(GINPUT_DIAL_DEVICE2, samplebuf+2, GADCCallback, (void *)fn); + #endif + #if GINPUT_DIAL_NUM_PORTS >= 4 + gadcLowSpeedStart(GINPUT_DIAL_DEVICE3, samplebuf+3, GADCCallback, (void *)fn); + #endif + #endif +} + +#endif /* GFX_USE_GINPUT && GINPUT_NEED_DIAL */ +/** @} */ |