ugfx/touchpad.c

148 lines
3.1 KiB
C
Raw Normal View History

2012-06-01 08:33:08 +00:00
#include "touchpad.h"
2012-06-01 09:46:30 +00:00
#include "glcd.h"
2012-06-01 08:33:08 +00:00
2012-06-11 12:34:17 +00:00
volatile static struct cal cal = {
2012-06-07 22:10:57 +00:00
1, 1, 0, 0
};
2012-06-03 15:52:02 +00:00
2012-06-01 08:33:08 +00:00
static const SPIConfig spicfg = {
NULL,
GPIOC,
TP_CS,
SPI_CR1_SPE | SPI_CR1_BR_2 | SPI_CR1_BR_1 | SPI_CR1_BR_0,
};
2012-06-11 11:07:44 +00:00
void tpInit(SPIDriver *spip) {
spiStart(spip, &spicfg);
2012-06-01 08:33:08 +00:00
}
2012-06-01 11:50:42 +00:00
static __inline uint16_t readX(void) {
2012-06-11 16:37:38 +00:00
return lld_readX();
2012-06-01 08:33:08 +00:00
}
2012-06-01 11:50:42 +00:00
static __inline uint16_t readY(void) {
2012-06-11 16:37:38 +00:00
return lld_readY();
2012-06-01 10:44:48 +00:00
}
2012-06-04 19:11:19 +00:00
uint8_t tpIRQ(void) {
2012-06-03 15:52:02 +00:00
return (!palReadPad(TP_PORT, TP_IRQ));
}
2012-06-07 21:57:15 +00:00
static uint16_t tpReadRealX(void) {
2012-06-03 15:52:02 +00:00
uint32_t results = 0;
2012-06-01 10:44:48 +00:00
uint16_t i, x;
for(i=0; i<CONVERSIONS; i++) {
2012-06-01 11:50:42 +00:00
readX();
2012-06-01 10:44:48 +00:00
results += readX();
}
x = (((SCREEN_WIDTH-1) * (results/CONVERSIONS)) / 2048);
2012-06-01 10:44:48 +00:00
2012-06-04 07:06:55 +00:00
return x;
2012-06-01 10:44:48 +00:00
}
2012-06-07 21:57:15 +00:00
static uint16_t tpReadRealY(void) {
2012-06-03 15:52:02 +00:00
uint32_t results = 0;
2012-06-01 10:44:48 +00:00
uint16_t i, y;
2012-06-01 11:50:42 +00:00
for(i=0; i<CONVERSIONS; i++) {
readY();
2012-06-01 10:44:48 +00:00
results += readY();
2012-06-01 11:50:42 +00:00
}
2012-06-01 10:44:48 +00:00
y = (((SCREEN_HEIGHT-1) * (results/CONVERSIONS)) / 2048);
2012-06-01 09:46:30 +00:00
2012-06-04 07:06:55 +00:00
return y;
}
uint16_t tpReadX(void) {
uint16_t x, y;
x = cal.xm * tpReadRealX() + cal.xn;
y = cal.ym * tpReadRealY() + cal.yn;
switch(lcdGetOrientation()) {
case portrait:
return x;
case landscape:
return SCREEN_HEIGHT - y;
case portraitInv:
return SCREEN_WIDTH - x;
case landscapeInv:
return y;
}
2012-06-11 10:45:20 +00:00
return x;
2012-06-04 07:06:55 +00:00
}
uint16_t tpReadY(void) {
uint16_t x, y;
x = cal.xm * tpReadRealX() + cal.xn;
y = cal.ym * tpReadRealY() + cal.yn;
switch(lcdGetOrientation()) {
case portrait:
return y;
case landscape:
return x;
case portraitInv:
return SCREEN_HEIGHT - y;
case landscapeInv:
return SCREEN_WIDTH - x;
}
2012-06-11 10:45:20 +00:00
return y;
2012-06-03 15:52:02 +00:00
}
2012-06-15 08:18:52 +00:00
uint16_t tpReadZ(void) {
return lld_readZ();
}
2012-06-07 22:07:43 +00:00
static void tpDrawCross(uint16_t x, uint16_t y) {
2012-06-04 19:04:18 +00:00
lcdDrawLine(x-15, y, x-2, y, 0xffff);
lcdDrawLine(x+2, y, x+15, y, 0xffff);
lcdDrawLine(x, y-15, x, y-2, 0xffff);
lcdDrawLine(x, y+2, x, y+15, 0xffff);
2012-06-03 15:52:02 +00:00
2012-06-11 10:43:52 +00:00
lcdDrawLine(x-15, y+15, x-7, y+15, RGB565CONVERT(184,158,131));
lcdDrawLine(x-15, y+7, x-15, y+15, RGB565CONVERT(184,158,131));
2012-06-03 15:52:02 +00:00
2012-06-11 10:43:52 +00:00
lcdDrawLine(x-15, y-15, x-7, y-15, RGB565CONVERT(184,158,131));
lcdDrawLine(x-15, y-7, x-15, y-15, RGB565CONVERT(184,158,131));
2012-06-03 15:52:02 +00:00
2012-06-11 10:43:52 +00:00
lcdDrawLine(x+7, y+15, x+15, y+15, RGB565CONVERT(184,158,131));
lcdDrawLine(x+15, y+7, x+15, y+15, RGB565CONVERT(184,158,131));
2012-06-03 15:52:02 +00:00
2012-06-11 10:43:52 +00:00
lcdDrawLine(x+7, y-15, x+15, y-15, RGB565CONVERT(184,158,131));
lcdDrawLine(x+15, y-15, x+15, y-7, RGB565CONVERT(184,158,131));
2012-06-01 08:33:08 +00:00
}
2012-06-03 15:52:02 +00:00
void tpCalibrate(void) {
2012-06-04 19:04:18 +00:00
uint16_t cross[2][2] = {{40,40}, {200, 280}};
uint16_t points[2][2];
2012-06-04 07:06:55 +00:00
uint8_t i;
lcdSetOrientation(portrait);
2012-06-04 07:06:55 +00:00
lcdClear(Red);
cx=40; cy=10;
lcdDrawString(40, 10, "Touchpad Calibration", White, Red);
2012-06-04 07:06:55 +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();
while(tpIRQ());
lcdFillArea(cross[i][0]-15, cross[i][1]-15, cross[i][0]+16, cross[i][1]+16, Red);
}
2012-06-04 14:40:38 +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-06-04 07:06:55 +00:00
2012-06-04 14:40:38 +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-06-04 07:06:55 +00:00
}