b8435f5446
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@21312 a1c6a512-1295-4272-9138-f99709370657
142 lines
4.3 KiB
C
Executable file
142 lines
4.3 KiB
C
Executable file
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Copyright (C) 2008 by Maurus Cuelenaere
|
|
*
|
|
* This program 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 2
|
|
* of the License, or (at your option) any later version.
|
|
*
|
|
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
|
* KIND, either express or implied.
|
|
*
|
|
****************************************************************************/
|
|
|
|
#include "config.h"
|
|
#include "button.h"
|
|
#include "button-target.h"
|
|
#include "touchscreen.h"
|
|
#include "string.h"
|
|
#include "logf.h"
|
|
|
|
static enum touchscreen_mode current_mode = TOUCHSCREEN_POINT;
|
|
static const int touchscreen_buttons[3][3] =
|
|
{
|
|
{BUTTON_TOPLEFT, BUTTON_TOPMIDDLE, BUTTON_TOPRIGHT},
|
|
{BUTTON_MIDLEFT, BUTTON_CENTER, BUTTON_MIDRIGHT},
|
|
{BUTTON_BOTTOMLEFT, BUTTON_BOTTOMMIDDLE, BUTTON_BOTTOMRIGHT}
|
|
};
|
|
|
|
#ifndef DEFAULT_TOUCHSCREEN_CALIBRATION
|
|
#define DEFAULT_TOUCHSCREEN_CALIBRATION { .A=1, .B=0, .C=0, \
|
|
.D=0, .E=1, .F=0, \
|
|
.divider=1 }
|
|
#endif
|
|
|
|
struct touchscreen_parameter calibration_parameters
|
|
= DEFAULT_TOUCHSCREEN_CALIBRATION;
|
|
const struct touchscreen_parameter default_calibration_parameters
|
|
= DEFAULT_TOUCHSCREEN_CALIBRATION;
|
|
|
|
void touchscreen_disable_mapping(void)
|
|
{
|
|
#define C(x) calibration_parameters.x
|
|
C(A) = C(E) = 1;
|
|
C(B) = C(C) = C(D) = C(F) = 0;
|
|
C(divider) = 1;
|
|
#undef C
|
|
}
|
|
|
|
void touchscreen_reset_mapping(void)
|
|
{
|
|
memcpy(&calibration_parameters, &default_calibration_parameters,
|
|
sizeof(struct touchscreen_parameter));
|
|
}
|
|
|
|
int touchscreen_calibrate(struct touchscreen_calibration *cal)
|
|
{
|
|
#define C(x) calibration_parameters.x /* Calibration */
|
|
#define S(i,j) cal->i[j][0] /* Screen */
|
|
#define D(i,j) cal->i[j][1] /* Display */
|
|
long divider = (S(x,0) - S(x,2)) * (S(y,1) - S(y,2)) -
|
|
(S(x,1) - S(x,2)) * (S(y,0) - S(y,2));
|
|
|
|
if(divider == 0)
|
|
return -1;
|
|
else
|
|
C(divider) = divider;
|
|
|
|
C(A) = (D(x,0) - D(x,2)) * (S(y,1) - S(y,2)) -
|
|
(D(x,1) - D(x,2)) * (S(y,0) - S(y,2));
|
|
|
|
C(B) = (S(x,0) - S(x,2)) * (D(x,1) - D(x,2)) -
|
|
(D(x,0) - D(x,2)) * (S(x,1) - S(x,2));
|
|
|
|
C(C) = S(y,0) * (S(x,2) * D(x,1) - S(x,1) * D(x,2)) +
|
|
S(y,1) * (S(x,0) * D(x,2) - S(x,2) * D(x,0)) +
|
|
S(y,2) * (S(x,1) * D(x,0) - S(x,0) * D(x,1));
|
|
|
|
C(D) = (D(y,0) - D(y,2)) * (S(y,1) - S(y,2)) -
|
|
(D(y,1) - D(y,2)) * (S(y,0) - S(y,2));
|
|
|
|
C(E) = (S(x,0) - S(x,2)) * (D(y,1) - D(y,2)) -
|
|
(D(y,0) - D(y,2)) * (S(x,1) - S(x,2));
|
|
|
|
C(F) = S(y,0) * (S(x,2) * D(y,1) - S(x,1) * D(y,2)) +
|
|
S(y,1) * (S(x,0) * D(y,2) - S(x,2) * D(y,0)) +
|
|
S(y,2) * (S(x,1) * D(y,0) - S(x,0) * D(y,1));
|
|
|
|
logf("A: %lX B: %lX C: %lX", C(A), C(B), C(C));
|
|
logf("D: %lX E: %lX F: %lX", C(D), C(E), C(F));
|
|
logf("divider: %lX", C(divider));
|
|
|
|
return 0;
|
|
#undef C
|
|
#undef S
|
|
#undef D
|
|
}
|
|
|
|
static void map_pixels(int *x, int *y)
|
|
{
|
|
#define C(x) calibration_parameters.x
|
|
int _x = *x, _y = *y;
|
|
|
|
*x = (C(A) * _x + C(B) * _y + C(C)) / C(divider);
|
|
*y = (C(D) * _x + C(E) * _y + C(F)) / C(divider);
|
|
#undef C
|
|
}
|
|
|
|
/* TODO: add jitter (and others) filter */
|
|
int touchscreen_to_pixels(int x, int y, int *data)
|
|
{
|
|
x &= 0xFFFF;
|
|
y &= 0xFFFF;
|
|
|
|
map_pixels(&x, &y);
|
|
|
|
if(current_mode == TOUCHSCREEN_BUTTON)
|
|
return touchscreen_buttons[y / (LCD_HEIGHT/3)]
|
|
[x / (LCD_WIDTH/3) ];
|
|
else
|
|
{
|
|
*data = (x << 16 | y);
|
|
return BUTTON_TOUCHSCREEN;
|
|
}
|
|
}
|
|
|
|
void touchscreen_set_mode(enum touchscreen_mode mode)
|
|
{
|
|
current_mode = mode;
|
|
}
|
|
|
|
enum touchscreen_mode touchscreen_get_mode(void)
|
|
{
|
|
return current_mode;
|
|
}
|