2012-10-23 04:30:17 +00:00
|
|
|
/* ChibiOS/GFX - Copyright (C) 2012
|
2012-08-13 02:12:42 +00:00
|
|
|
Joel Bodenmann aka Tectu <joel@unormal.org>
|
|
|
|
|
2012-09-24 22:19:10 +00:00
|
|
|
This file is part of ChibiOS/GFX.
|
2012-08-13 02:12:42 +00:00
|
|
|
|
2012-09-24 22:19:10 +00:00
|
|
|
ChibiOS/GFX is free software; you can redistribute it and/or modify
|
2012-08-13 02:12:42 +00:00
|
|
|
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.
|
|
|
|
|
2012-09-24 22:19:10 +00:00
|
|
|
ChibiOS/GFX is distributed in the hope that it will be useful,
|
2012-08-13 02:12:42 +00:00
|
|
|
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"
|
|
|
|
|
2012-10-20 23:47:11 +00:00
|
|
|
#if GFX_USE_TOUCHPAD || defined(__DOXYGEN__)
|
2012-08-13 02:12:42 +00:00
|
|
|
|
2012-10-11 10:27:26 +00:00
|
|
|
#if TOUCHPAD_STORE_CALIBRATION
|
2012-10-23 04:30:17 +00:00
|
|
|
extern void tp_store_calibration_lld(struct cal_t *cal);
|
|
|
|
extern struct cal_t *tp_restore_calibration_lld(void);
|
2012-10-11 10:27:26 +00:00
|
|
|
#endif
|
|
|
|
|
2012-08-13 02:12:42 +00:00
|
|
|
/*===========================================================================*/
|
|
|
|
/* Driver local definitions. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
/*===========================================================================*/
|
|
|
|
/* Driver exported variables. */
|
|
|
|
/*===========================================================================*/
|
|
|
|
|
|
|
|
/*===========================================================================*/
|
|
|
|
/* Driver local variables. */
|
|
|
|
/*===========================================================================*/
|
2012-10-23 04:10:57 +00:00
|
|
|
static struct cal_t *cal;
|
|
|
|
|
2012-08-13 02:12:42 +00:00
|
|
|
/*===========================================================================*/
|
|
|
|
/* 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;
|
|
|
|
|
2012-08-16 09:56:03 +00:00
|
|
|
/* Median filtering is already done in LLD */
|
2012-08-13 02:12:42 +00:00
|
|
|
for(i = 0; i < CONVERSIONS; i++) {
|
|
|
|
results += tp_lld_read_x();
|
2012-08-16 09:56:03 +00:00
|
|
|
}
|
2012-08-13 02:12:42 +00:00
|
|
|
|
2012-08-16 09:56:03 +00:00
|
|
|
/* Take the average of the readings */
|
|
|
|
x = results / CONVERSIONS;
|
2012-08-13 02:12:42 +00:00
|
|
|
|
|
|
|
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;
|
|
|
|
|
2012-08-16 09:56:03 +00:00
|
|
|
/* Median filtering is already done in LLD */
|
2012-08-13 02:12:42 +00:00
|
|
|
for(i = 0; i < CONVERSIONS; i++) {
|
|
|
|
results += tp_lld_read_y();
|
2012-08-16 09:56:03 +00:00
|
|
|
}
|
2012-08-13 02:12:42 +00:00
|
|
|
|
2012-08-16 09:56:03 +00:00
|
|
|
/* Take the average of the readings */
|
|
|
|
y = results / CONVERSIONS;
|
2012-08-13 02:12:42 +00:00
|
|
|
|
|
|
|
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
|
|
|
|
*/
|
2012-10-12 23:05:20 +00:00
|
|
|
void tpInit(const TOUCHPADDriver *tp) {
|
2012-10-23 04:10:57 +00:00
|
|
|
cal = (struct cal_t*)chHeapAlloc(NULL, sizeof(struct cal_t));
|
|
|
|
if(cal == NULL)
|
|
|
|
return;
|
|
|
|
|
2012-08-13 02:12:42 +00:00
|
|
|
/* Initialise Mutex */
|
|
|
|
//MUTEX_INIT
|
|
|
|
|
|
|
|
/* Initialise driver */
|
|
|
|
//MUTEX_ENTER
|
|
|
|
tp_lld_init(tp);
|
|
|
|
//MUTEX_EXIT
|
2012-09-25 22:05:24 +00:00
|
|
|
|
|
|
|
#if TOUCHPAD_STORE_CALIBRATION
|
2012-10-23 04:30:17 +00:00
|
|
|
cal = tp_restore_calibration_lld();
|
2012-10-23 04:10:57 +00:00
|
|
|
if(cal == NULL) {
|
|
|
|
cal = (struct cal_t*)chHeapAlloc(NULL, sizeof(struct cal_t));
|
|
|
|
tpCalibrate();
|
|
|
|
}
|
2012-09-25 22:05:24 +00:00
|
|
|
#endif
|
2012-08-13 02:12:42 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @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;
|
2012-10-07 22:26:18 +00:00
|
|
|
|
|
|
|
#if TOUCHPAD_XY_INVERTED == TRUE
|
2012-10-23 04:10:57 +00:00
|
|
|
x = cal->xm * _tpReadRealY() + cal->xn;
|
|
|
|
y = cal->ym * _tpReadRealX() + cal->yn;
|
2012-10-07 20:12:09 +00:00
|
|
|
#else
|
2012-10-23 04:10:57 +00:00
|
|
|
x = cal->xm * _tpReadRealX() + cal->xn;
|
|
|
|
y = cal->ym * _tpReadRealY() + cal->yn;
|
2012-10-07 20:12:09 +00:00
|
|
|
#endif
|
2012-10-23 00:57:38 +00:00
|
|
|
|
2012-08-22 14:33:40 +00:00
|
|
|
switch(gdispGetOrientation()) {
|
2012-10-05 07:20:39 +00:00
|
|
|
case GDISP_ROTATE_0:
|
2012-08-13 02:12:42 +00:00
|
|
|
return x;
|
2012-10-05 07:20:39 +00:00
|
|
|
case GDISP_ROTATE_90:
|
2012-10-04 09:42:57 +00:00
|
|
|
return y;
|
2012-10-05 07:20:39 +00:00
|
|
|
case GDISP_ROTATE_180:
|
2012-10-10 23:41:18 +00:00
|
|
|
return GDISP_SCREEN_WIDTH - x - 1;
|
2012-10-05 07:20:39 +00:00
|
|
|
case GDISP_ROTATE_270:
|
2012-10-10 23:41:18 +00:00
|
|
|
return GDISP_SCREEN_HEIGHT - y - 1;
|
2012-09-18 20:55:02 +00:00
|
|
|
}
|
2012-09-26 18:18:18 +00:00
|
|
|
|
2012-09-18 20:55:02 +00:00
|
|
|
return 0;
|
2012-08-13 02:12:42 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* @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;
|
2012-10-07 22:26:18 +00:00
|
|
|
|
|
|
|
#if TOUCHPAD_XY_INVERTED == TRUE
|
2012-10-23 04:10:57 +00:00
|
|
|
x = cal->xm * _tpReadRealY() + cal->xn;
|
|
|
|
y = cal->ym * _tpReadRealX() + cal->yn;
|
2012-10-07 20:12:09 +00:00
|
|
|
#else
|
2012-10-23 04:10:57 +00:00
|
|
|
x = cal->xm * _tpReadRealX() + cal->xn;
|
|
|
|
y = cal->ym * _tpReadRealY() + cal->yn;
|
2012-10-07 20:12:09 +00:00
|
|
|
#endif
|
2012-10-23 00:57:38 +00:00
|
|
|
|
2012-08-22 14:33:40 +00:00
|
|
|
switch(gdispGetOrientation()) {
|
2012-10-05 07:20:39 +00:00
|
|
|
case GDISP_ROTATE_0:
|
2012-08-13 02:12:42 +00:00
|
|
|
return y;
|
2012-10-05 07:20:39 +00:00
|
|
|
case GDISP_ROTATE_90:
|
2012-10-10 23:41:18 +00:00
|
|
|
return GDISP_SCREEN_WIDTH - x - 1;
|
2012-10-05 07:20:39 +00:00
|
|
|
case GDISP_ROTATE_180:
|
2012-10-10 23:41:18 +00:00
|
|
|
return GDISP_SCREEN_HEIGHT - y - 1;
|
2012-10-05 07:20:39 +00:00
|
|
|
case GDISP_ROTATE_270:
|
2012-10-04 09:42:57 +00:00
|
|
|
return x;
|
2012-08-13 02:12:42 +00:00
|
|
|
}
|
2012-09-26 18:18:18 +00:00
|
|
|
|
2012-09-18 20:55:02 +00:00
|
|
|
return 0;
|
2012-08-13 02:12:42 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
void tpCalibrate(void) {
|
2012-09-07 20:57:35 +00:00
|
|
|
const uint16_t h = gdispGetHeight();
|
|
|
|
const uint16_t w = gdispGetWidth();
|
|
|
|
const uint16_t cross[2][2] = {{(w/8), (h/8)}, {(w-(w/8)) , (h-(h/8))}};
|
2012-08-13 02:12:42 +00:00
|
|
|
uint16_t points[2][2];
|
|
|
|
uint8_t i;
|
|
|
|
|
2012-10-23 00:34:20 +00:00
|
|
|
gdispSetOrientation(GDISP_ROTATE_0);
|
2012-09-18 20:55:02 +00:00
|
|
|
gdispClear(Red);
|
2012-08-13 02:12:42 +00:00
|
|
|
gdispFillStringBox(0, 10, gdispGetWidth(), 30, "Calibration", &fontUI2Double, White, Red, justifyCenter);
|
|
|
|
|
2012-10-07 20:12:09 +00:00
|
|
|
for(i = 0; i < 2; i++) {
|
|
|
|
_tpDrawCross(cross[i][0], cross[i][1]);
|
|
|
|
while(!tpIRQ());
|
|
|
|
points[i][0] = _tpReadRealX();
|
|
|
|
points[i][1] = _tpReadRealY();
|
2012-08-13 02:12:42 +00:00
|
|
|
chThdSleepMilliseconds(100);
|
2012-10-07 20:12:09 +00:00
|
|
|
while(tpIRQ());
|
|
|
|
gdispFillArea(cross[i][0]-15, cross[i][1]-15, 42, 42, Red);
|
2012-08-13 02:12:42 +00:00
|
|
|
}
|
2012-10-23 04:10:57 +00:00
|
|
|
|
|
|
|
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]);
|
2012-08-13 02:12:42 +00:00
|
|
|
|
2012-10-23 04:10:57 +00:00
|
|
|
cal->xn = (float)cross[0][0] - cal->xm * (float)points[0][0];
|
|
|
|
cal->yn = (float)cross[0][1] - cal->ym * (float)points[0][1];
|
|
|
|
|
2012-09-25 22:05:24 +00:00
|
|
|
#if TOUCHPAD_STORE_CALIBRATION
|
2012-10-23 04:30:17 +00:00
|
|
|
tp_store_calibration_lld(cal);
|
2012-09-25 22:05:24 +00:00
|
|
|
#endif
|
2012-08-13 02:12:42 +00:00
|
|
|
}
|
|
|
|
|
2012-09-26 18:18:18 +00:00
|
|
|
/**
|
|
|
|
* @brief returns if touchpad is pressed or not
|
|
|
|
*
|
|
|
|
* @return 1 if pressed, 0 otherwise
|
|
|
|
*
|
|
|
|
* @api
|
|
|
|
*/
|
2012-08-13 02:12:42 +00:00
|
|
|
#if TOUCHPAD_HAS_IRQ || defined(__DOXYGEN__)
|
|
|
|
uint8_t tpIRQ(void) {
|
|
|
|
return tp_lld_irq();
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2012-09-26 18:18:18 +00:00
|
|
|
/**
|
|
|
|
* @brief Get the pressure.
|
|
|
|
*
|
|
|
|
* @return The pressure.
|
|
|
|
*
|
|
|
|
* @api
|
|
|
|
*/
|
2012-08-13 02:12:42 +00:00
|
|
|
#if TOUCHPAD_HAS_PRESSURE || defined(__DOXYGEN__)
|
|
|
|
uint16_t tpReadZ(void) {
|
|
|
|
/* ToDo */
|
|
|
|
return (tp_lld_read_z());
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2012-10-20 23:47:11 +00:00
|
|
|
#endif /* GFX_USE_TOUCHPAD */
|
2012-08-13 02:12:42 +00:00
|
|
|
/** @} */
|
|
|
|
|