blob: ad5a77d4448679ba60bcf785de798198bc05e3e2 (
plain) (
blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
|
#include "tpd.h"
/* #ifdef TPD_HAVE_CALIBRATION */
/* #ifndef TPD_CUSTOM_CALIBRATION */
/* #if (defined(TPD_WARP_START) && defined(TPD_WARP_END)) */
/* #define TPD_DO_WARP */
int TPD_DO_WARP = 0;
int tpd_wb_start[TPD_WARP_CNT] = { 0 };
int tpd_wb_end[TPD_WARP_CNT] = { 0 };
void tpd_warp_calibrate(int *x, int *y)
{
int wx = *x, wy = *y;
if (wx < tpd_wb_start[0] && tpd_wb_start[0] > 0) {
wx = tpd_wb_start[0] -
((tpd_wb_start[0] - wx) * (tpd_wb_start[0] -
tpd_wb_end[0]) / (tpd_wb_start[0]));
/* wx = wx*(tpd_wb_start[0]-tpd_wb_end[0])/tpd_wb_start[0]+tpd_wb_end[0]; */
} else if (wx > tpd_wb_start[2])
wx = (wx - tpd_wb_start[2]) * (tpd_wb_end[2] - tpd_wb_start[2]) / (TPD_RES_X -
tpd_wb_start[2])
+ tpd_wb_start[2];
if (wy < tpd_wb_start[1] && tpd_wb_start[1] > 0)
wy = tpd_wb_start[1] -
((tpd_wb_start[1] - wy) * (tpd_wb_start[1] -
tpd_wb_end[1]) / (tpd_wb_start[1]));
/* wy = wy*(tpd_wb_start[1]-tpd_wb_end[1])/tpd_wb_start[1]+tpd_wb_end[1]; */
else if (wy > tpd_wb_start[3] && wy <= TPD_RES_Y)
wy = (wy - tpd_wb_start[3]) * (tpd_wb_end[3] - tpd_wb_start[3]) / (TPD_RES_Y -
tpd_wb_start[3])
+ tpd_wb_start[3];
if (wy < 0)
wy = 0;
if (wx < 0)
wx = 0;
*x = wx, *y = wy;
}
/* #else */
/* #define tpd_warp_calibrate(x,y) */
/* #endif */
void tpd_calibrate(int *x, int *y)
{
int tx, i;
if (tpd_calmat[0] == 0)
for (i = 0; i < 6; i++)
tpd_calmat[i] = tpd_def_calmat[i];
/* ================ calibrating ================ */
tx = ((tpd_calmat[0] * (*x)) + (tpd_calmat[1] * (*y)) + (tpd_calmat[2])) >> 12;
*y = ((tpd_calmat[3] * (*x)) + (tpd_calmat[4] * (*y)) + (tpd_calmat[5])) >> 12;
*x = tx;
if (TPD_DO_WARP == 1)
tpd_warp_calibrate(x, y);
*x = (*x) + ((*y) * (*x) * tpd_calmat[6] / TPD_RES_X) / TPD_RES_Y;
*y = (*y) + ((*y) * (*x) * tpd_calmat[7] / TPD_RES_X) / TPD_RES_Y;
}
/* #endif */
/* #endif */
|
