254 lines
6.6 KiB
C
254 lines
6.6 KiB
C
/*
|
|
ChibiOS-LCD-Driver - Copyright (C) 2012
|
|
Joel Bodenmann aka Tectu <joel@unormal.org>
|
|
|
|
This file is part of ChibiOS-LCD-Driver.
|
|
|
|
ChibiOS-LCD-Driver 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-LCD-Driver 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 touchpad.c
|
|
* @brief Touchpad Driver code.
|
|
*
|
|
* @addgroup TOUCHPAD
|
|
* @{
|
|
*/
|
|
#include "ch.h"
|
|
#include "hal.h"
|
|
#include "gdisp.h"
|
|
#include "touchpad.h"
|
|
|
|
#if HAL_USE_TOUCHPAD || defined(__DOXYGEN__)
|
|
|
|
/*===========================================================================*/
|
|
/* Driver local definitions. */
|
|
/*===========================================================================*/
|
|
|
|
#ifdef UNUSED
|
|
#elif defined(__GNUC__)
|
|
# define UNUSED(x) UNUSED_ ## x __attribute__((unused))
|
|
#elif defined(__LCLINT__)
|
|
# define UNUSED(x) /*@unused@*/ x
|
|
#else
|
|
# define UNUSED(x) x
|
|
#endif
|
|
|
|
/*===========================================================================*/
|
|
/* Driver exported variables. */
|
|
/*===========================================================================*/
|
|
|
|
/*===========================================================================*/
|
|
/* Driver local variables. */
|
|
/*===========================================================================*/
|
|
volatile static struct cal cal = {
|
|
1, 1, 0, 0
|
|
};
|
|
|
|
/*===========================================================================*/
|
|
/* Driver local functions. */
|
|
/*===========================================================================*/
|
|
|
|
/**
|
|
* @brief returns the uncalibrated readout of the X direction from the controller
|
|
*
|
|
* @noapi
|
|
*/
|
|
static uint16_t _tpReadRealX(void) {
|
|
uint32_t results = 0;
|
|
uint16_t i, x;
|
|
|
|
/* Median filtering is already done in LLD */
|
|
for(i = 0; i < CONVERSIONS; i++) {
|
|
results += tp_lld_read_x();
|
|
}
|
|
|
|
/* Take the average of the readings */
|
|
x = results / CONVERSIONS;
|
|
|
|
return x;
|
|
}
|
|
|
|
/**
|
|
* @brief return the uncalibrated readout of the Y-direction from the controller
|
|
*
|
|
* @noapi
|
|
*/
|
|
static uint16_t _tpReadRealY(void) {
|
|
uint32_t results = 0;
|
|
uint16_t i, y;
|
|
|
|
/* Median filtering is already done in LLD */
|
|
for(i = 0; i < CONVERSIONS; i++) {
|
|
results += tp_lld_read_y();
|
|
}
|
|
|
|
/* Take the average of the readings */
|
|
y = results / CONVERSIONS;
|
|
|
|
return y;
|
|
}
|
|
|
|
/**
|
|
* @brief draws a cross. Used for calibration.
|
|
*
|
|
* @noapi
|
|
*/
|
|
static void _tpDrawCross(uint16_t x, uint16_t y) {
|
|
gdispDrawLine(x-15, y, x-2, y, 0xffff);
|
|
gdispDrawLine(x+2, y, x+15, y, 0xffff);
|
|
gdispDrawLine(x, y-15, x, y-2, 0xffff);
|
|
gdispDrawLine(x, y+2, x, y+15, 0xffff);
|
|
|
|
gdispDrawLine(x-15, y+15, x-7, y+15, RGB565CONVERT(184,158,131));
|
|
gdispDrawLine(x-15, y+7, x-15, y+15, RGB565CONVERT(184,158,131));
|
|
|
|
gdispDrawLine(x-15, y-15, x-7, y-15, RGB565CONVERT(184,158,131));
|
|
gdispDrawLine(x-15, y-7, x-15, y-15, RGB565CONVERT(184,158,131));
|
|
|
|
gdispDrawLine(x+7, y+15, x+15, y+15, RGB565CONVERT(184,158,131));
|
|
gdispDrawLine(x+15, y+7, x+15, y+15, RGB565CONVERT(184,158,131));
|
|
|
|
gdispDrawLine(x+7, y-15, x+15, y-15, RGB565CONVERT(184,158,131));
|
|
gdispDrawLine(x+15, y-15, x+15, y-7, RGB565CONVERT(184,158,131));
|
|
}
|
|
|
|
/*===========================================================================*/
|
|
/* Driver exported functions. */
|
|
/*===========================================================================*/
|
|
|
|
/**
|
|
* @brief Touchpad Driver initialization.
|
|
* @note This function is NOT currently implicitly invoked by @p halInit().
|
|
* It must be called manually.
|
|
*
|
|
* @api
|
|
*/
|
|
void tpInit(const TOUCHPADDriver *tp) {
|
|
/* Initialise Mutex */
|
|
//MUTEX_INIT
|
|
|
|
/* Initialise driver */
|
|
//MUTEX_ENTER
|
|
tp_lld_init(tp);
|
|
//MUTEX_EXIT
|
|
}
|
|
|
|
/**
|
|
* @brief Get the X-Coordinate, relative to screen zero point.
|
|
*
|
|
* @return The X position in pixels.
|
|
*
|
|
* @api
|
|
*/
|
|
uint16_t tpReadX(void) {
|
|
uint16_t x, y;
|
|
|
|
x = cal.xm * _tpReadRealX() + cal.xn;
|
|
y = cal.ym * _tpReadRealY() + cal.yn;
|
|
|
|
switch(gdispGetOrientation()) {
|
|
case portrait:
|
|
return x;
|
|
case landscape:
|
|
return SCREEN_HEIGHT - y;
|
|
case portraitInv:
|
|
return SCREEN_WIDTH - x;
|
|
case landscapeInv:
|
|
return y;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @brief Get the X-Coordinate, relative to screen zero point.
|
|
*
|
|
* @return The Y position in pixels.
|
|
*
|
|
* @api
|
|
*/
|
|
uint16_t tpReadY(void) {
|
|
uint16_t x, y;
|
|
|
|
x = cal.xm * _tpReadRealX() + cal.xn;
|
|
y = cal.ym * _tpReadRealY() + cal.yn;
|
|
|
|
switch(gdispGetOrientation()) {
|
|
case portrait:
|
|
return y;
|
|
case landscape:
|
|
return x;
|
|
case portraitInv:
|
|
return SCREEN_HEIGHT - y;
|
|
case landscapeInv:
|
|
return SCREEN_WIDTH - x;
|
|
}
|
|
}
|
|
|
|
void tpCalibrate(void) {
|
|
uint16_t cross[2][2] = {{40,50}, {200, 280}};
|
|
uint16_t points[2][2];
|
|
uint8_t i;
|
|
|
|
//gdispSetOrientation(portrait);
|
|
gdispClear(Red);
|
|
gdispFillStringBox(0, 10, gdispGetWidth(), 30, "Calibration", &fontUI2Double, White, Red, justifyCenter);
|
|
|
|
for(i = 0; i < 2; i++) {
|
|
_tpDrawCross(cross[i][0], cross[i][1]);
|
|
while(!tpIRQ());
|
|
points[i][0] = _tpReadRealX();
|
|
points[i][1] = _tpReadRealY();
|
|
chThdSleepMilliseconds(100);
|
|
while(tpIRQ());
|
|
gdispFillArea(cross[i][0]-15, cross[i][1]-15, 42, 42, Red);
|
|
}
|
|
|
|
cal.xm = ((float)cross[1][0] - (float)cross[0][0]) / ((float)points[1][0] - (float)points[0][0]);
|
|
cal.ym = ((float)cross[1][1] - (float)cross[0][1]) / ((float)points[1][1] - (float)points[0][1]);
|
|
|
|
cal.xn = (float)cross[0][0] - cal.xm * (float)points[0][0];
|
|
cal.yn = (float)cross[0][1] - cal.ym * (float)points[0][1];
|
|
}
|
|
|
|
#if TOUCHPAD_HAS_IRQ || defined(__DOXYGEN__)
|
|
/**
|
|
* @brief returns if touchpad is pressed or not
|
|
*
|
|
* @return 1 if pressed, 0 otherwise
|
|
*
|
|
* @api
|
|
*/
|
|
uint8_t tpIRQ(void) {
|
|
return tp_lld_irq();
|
|
}
|
|
#endif
|
|
|
|
#if TOUCHPAD_HAS_PRESSURE || defined(__DOXYGEN__)
|
|
/**
|
|
* @brief Get the pressure.
|
|
*
|
|
* @return The pressure.
|
|
*
|
|
* @api
|
|
*/
|
|
uint16_t tpReadZ(void) {
|
|
/* ToDo */
|
|
return (tp_lld_read_z());
|
|
}
|
|
#endif
|
|
|
|
#endif /* HAL_USE_TOUCHPAD */
|
|
/** @} */
|
|
|