Merge pull request #3 from Tectu/master

Get latest updates

1 files changed, 261 insertions, 0 deletions

diff --git a/src/touchpad.c b/src/touchpad.c
new file mode 100644
index 00000000..a18930da
--- /dev/null
+++ b/src/touchpad.c
@@ -0,0 +1,261 @@
+/*
+    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()) { // implement gdispGetOrientation()  
+		case portrait:
+			return x;
+		case landscape:
+			return SCREEN_HEIGHT - y;
+		case portraitInv:
+			return SCREEN_WIDTH - x;
+		case landscapeInv:
+			return y;
+	}   
+	*/
+
+	return x;
+}
+	
+/**
+ * @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()) { // implement gdispGetOrientation()
+		case portrait:
+			return y;
+		case landscape:
+			return x;
+		case portraitInv:
+			return SCREEN_HEIGHT - y;
+		case landscapeInv:
+			return SCREEN_WIDTH - x;
+	}
+	*/
+
+	return y;
+}
+
+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 */
+/** @} */
+