This repository has been archived by the owner on Feb 11, 2021. It is now read-only.
/
SDL_fbelo.c
463 lines (387 loc) · 10.1 KB
1
2
/*
SDL - Simple DirectMedia Layer
3
Copyright (C) 1997-2006 Sam Lantinga
4
5
This library is free software; you can redistribute it and/or
6
modify it under the terms of the GNU Lesser General Public
7
License as published by the Free Software Foundation; either
8
version 2.1 of the License, or (at your option) any later version.
9
10
11
12
This library 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
13
Lesser General Public License for more details.
14
15
16
17
You should have received a copy of the GNU Lesser General Public
License along with this library; if not, write to the Free Software
Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
18
19
Sam Lantinga
20
slouken@libsdl.org
21
*/
22
#include "SDL_config.h"
23
24
25
26
27
#include <unistd.h>
#include <sys/time.h>
#include <ctype.h>
28
#include "SDL_stdinc.h"
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
#include "SDL_fbvideo.h"
#include "SDL_fbelo.h"
/*
calibration default values
values are read from the following environment variables:
SDL_ELO_MIN_X
SDL_ELO_MAX_X
SDL_ELO_MIN_Y
SDL_ELO_MAX_Y
*/
static int ELO_MIN_X = 400;
static int ELO_MAX_X = 3670;
static int ELO_MIN_Y = 500;
static int ELO_MAX_Y = 3540;
#define ELO_SNAP_SIZE 6
48
#define ELO_TOUCH_BYTE 'T'
49
50
51
52
#define ELO_ID 'I'
#define ELO_MODE 'M'
#define ELO_PARAMETER 'P'
#define ELO_REPORT 'B'
53
#define ELO_ACK 'A'
54
55
56
#define ELO_INIT_CHECKSUM 0xAA
57
#define ELO_BTN_PRESS 0x01
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
#define ELO_STREAM 0x02
#define ELO_BTN_RELEASE 0x04
#define ELO_TOUCH_MODE 0x01
#define ELO_STREAM_MODE 0x02
#define ELO_UNTOUCH_MODE 0x04
#define ELO_RANGE_CHECK_MODE 0x40
#define ELO_TRIM_MODE 0x02
#define ELO_CALIB_MODE 0x04
#define ELO_SCALING_MODE 0x08
#define ELO_TRACKING_MODE 0x40
#define ELO_SERIAL_MASK 0xF8
#define ELO_SERIAL_IO '0'
#define ELO_MAX_TRIALS 3
#define ELO_MAX_WAIT 100000
#define ELO_UNTOUCH_DELAY 5
#define ELO_REPORT_DELAY 1
/* eloParsePacket
*/
81
int
82
eloParsePacket(unsigned char *mousebuf, int *dx, int *dy, int *button_state)
83
84
85
86
87
88
89
90
91
92
93
94
95
96
{
static int elo_button = 0;
static int last_x = 0;
static int last_y = 0;
int x, y;
/* Check if we have a touch packet */
if (mousebuf[1] != ELO_TOUCH_BYTE) {
return 0;
}
x = ((mousebuf[4] << 8) | mousebuf[3]);
y = ((mousebuf[6] << 8) | mousebuf[5]);
97
98
if ((SDL_abs(x - last_x) > ELO_SNAP_SIZE)
|| (SDL_abs(y - last_y) > ELO_SNAP_SIZE)) {
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
*dx = ((mousebuf[4] << 8) | mousebuf[3]);
*dy = ((mousebuf[6] << 8) | mousebuf[5]);
} else {
*dx = last_x;
*dy = last_y;
}
last_x = *dx;
last_y = *dy;
if ((mousebuf[2] & 0x07) == ELO_BTN_PRESS) {
elo_button = 1;
}
if ((mousebuf[2] & 0x07) == ELO_BTN_RELEASE) {
elo_button = 0;
}
*button_state = elo_button;
return 1;
118
119
120
121
122
}
/* Convert the raw coordinates from the ELO controller
to a screen position.
*/
123
void
124
eloConvertXY(_THIS, int *dx, int *dy)
125
126
127
128
129
130
131
132
133
134
{
int input_x = *dx;
int input_y = *dy;
int width = ELO_MAX_X - ELO_MIN_X;
int height = ELO_MAX_Y - ELO_MIN_Y;
*dx =
((int) cache_vinfo.xres -
((int) cache_vinfo.xres * (input_x - ELO_MIN_X)) / width);
*dy = (cache_vinfo.yres * (input_y - ELO_MIN_Y)) / height;
135
136
137
138
139
}
/* eloGetPacket
*/
140
int
141
eloGetPacket(unsigned char *buffer, int *buffer_p, int *checksum, int fd)
142
143
144
145
146
147
148
{
int num_bytes;
int ok;
if (fd == 0) {
num_bytes = ELO_PACKET_SIZE;
} else {
149
150
151
num_bytes = read(fd,
(char *) (buffer + *buffer_p),
ELO_PACKET_SIZE - *buffer_p);
152
153
154
}
if (num_bytes < 0) {
155
#ifdef DEBUG_MOUSE
156
157
fprintf(stderr,
"System error while reading from Elographics touchscreen.\n");
158
#endif
159
160
161
162
163
return 0;
}
while (num_bytes) {
if ((*buffer_p == 0) && (buffer[0] != ELO_START_BYTE)) {
164
SDL_memcpy(&buffer[0], &buffer[1], num_bytes - 1);
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
} else {
if (*buffer_p < ELO_PACKET_SIZE - 1) {
*checksum = *checksum + buffer[*buffer_p];
*checksum = *checksum % 256;
}
(*buffer_p)++;
}
num_bytes--;
}
if (*buffer_p == ELO_PACKET_SIZE) {
ok = (*checksum == buffer[ELO_PACKET_SIZE - 1]);
*checksum = ELO_INIT_CHECKSUM;
*buffer_p = 0;
if (!ok) {
return 0;
}
return 1;
} else {
return 0;
}
188
189
190
191
192
}
/* eloSendPacket
*/
193
int
194
eloSendPacket(unsigned char *packet, int fd)
195
{
196
197
int i, result;
int sum = ELO_INIT_CHECKSUM;
198
199
200
201
202
203
204
packet[0] = ELO_START_BYTE;
for (i = 0; i < ELO_PACKET_SIZE - 1; i++) {
sum += packet[i];
sum &= 0xFF;
}
packet[ELO_PACKET_SIZE - 1] = sum;
205
206
result = write(fd, packet, ELO_PACKET_SIZE);
207
208
if (result != ELO_PACKET_SIZE) {
209
#ifdef DEBUG_MOUSE
210
printf("System error while sending to Elographics touchscreen.\n");
211
#endif
212
213
214
215
return 0;
} else {
return 1;
}
216
217
218
219
220
}
/* eloWaitForInput
*/
221
int
222
eloWaitForInput(int fd, int timeout)
223
{
224
225
226
fd_set readfds;
struct timeval to;
int r;
227
228
229
FD_ZERO(&readfds);
FD_SET(fd, &readfds);
230
231
to.tv_sec = 0;
to.tv_usec = timeout;
232
233
r = select(FD_SETSIZE, &readfds, NULL, NULL, &to);
234
return r;
235
236
237
238
}
/* eloWaitReply
*/
239
int
240
eloWaitReply(unsigned char type, unsigned char *reply, int fd)
241
242
243
244
245
{
int ok;
int i, result;
int reply_p = 0;
int sum = ELO_INIT_CHECKSUM;
246
247
248
249
i = ELO_MAX_TRIALS;
do {
ok = 0;
250
251
result = eloWaitForInput(fd, ELO_MAX_WAIT);
252
253
if (result > 0) {
254
ok = eloGetPacket(reply, &reply_p, &sum, fd);
255
256
if (ok && reply[1] != type && type != ELO_PARAMETER) {
257
#ifdef DEBUG_MOUSE
258
fprintf(stderr, "Wrong reply received\n");
259
#endif
260
261
262
ok = 0;
}
} else {
263
#ifdef DEBUG_MOUSE
264
fprintf(stderr, "No input!\n");
265
#endif
266
}
267
268
269
270
271
272
if (result == 0) {
i--;
}
}
while (!ok && (i > 0));
273
274
return ok;
275
276
277
278
279
280
}
/* eloWaitAck
*/
281
int
282
eloWaitAck(int fd)
283
284
285
286
{
unsigned char packet[ELO_PACKET_SIZE];
int i, nb_errors;
287
if (eloWaitReply(ELO_ACK, packet, fd)) {
288
289
290
291
292
for (i = 0, nb_errors = 0; i < 4; i++) {
if (packet[2 + i] != '0') {
nb_errors++;
}
}
293
294
if (nb_errors != 0) {
295
#ifdef DEBUG_MOUSE
296
297
298
fprintf(stderr,
"Elographics acknowledge packet reports %d errors\n",
nb_errors);
299
#endif
300
301
302
303
304
}
return 1;
} else {
return 0;
}
305
306
307
308
309
}
/* eloSendQuery --
*/
310
int
311
eloSendQuery(unsigned char *request, unsigned char *reply, int fd)
312
313
314
{
int ok;
315
316
if (eloSendPacket(request, fd)) {
ok = eloWaitReply(toupper(request[1]), reply, fd);
317
if (ok) {
318
ok = eloWaitAck(fd);
319
320
321
322
323
}
return ok;
} else {
return 0;
}
324
325
326
327
328
}
/* eloSendControl
*/
329
int
330
eloSendControl(unsigned char *control, int fd)
331
{
332
333
if (eloSendPacket(control, fd)) {
return eloWaitAck(fd);
334
335
336
} else {
return 0;
}
337
338
339
340
}
/* eloInitController
*/
341
int
342
eloInitController(int fd)
343
344
345
346
347
348
349
350
351
{
unsigned char req[ELO_PACKET_SIZE];
unsigned char reply[ELO_PACKET_SIZE];
const char *buffer = NULL;
int result = 0;
struct termios mouse_termios;
/* try to read the calibration values */
352
buffer = SDL_getenv("SDL_ELO_MIN_X");
353
if (buffer) {
354
ELO_MIN_X = SDL_atoi(buffer);
355
}
356
buffer = SDL_getenv("SDL_ELO_MAX_X");
357
if (buffer) {
358
ELO_MAX_X = SDL_atoi(buffer);
359
}
360
buffer = SDL_getenv("SDL_ELO_MIN_Y");
361
if (buffer) {
362
ELO_MIN_Y = SDL_atoi(buffer);
363
}
364
buffer = SDL_getenv("SDL_ELO_MAX_Y");
365
if (buffer) {
366
ELO_MAX_Y = SDL_atoi(buffer);
367
}
368
#ifdef DEBUG_MOUSE
369
370
371
fprintf(stderr,
"ELO calibration values:\nmin_x: %i\nmax_x: %i\nmin_y: %i\nmax_y: %i\n",
ELO_MIN_X, ELO_MAX_X, ELO_MIN_Y, ELO_MAX_Y);
372
373
#endif
374
/* set comm params */
375
SDL_memset(&mouse_termios, 0, sizeof(mouse_termios));
376
377
mouse_termios.c_cflag = B9600 | CS8 | CREAD | CLOCAL;
mouse_termios.c_cc[VMIN] = 1;
378
result = tcsetattr(fd, TCSANOW, &mouse_termios);
379
380
if (result < 0) {
381
#ifdef DEBUG_MOUSE
382
fprintf(stderr, "Unable to configure Elographics touchscreen port\n");
383
#endif
384
385
return 0;
}
386
387
388
389
SDL_memset(req, 0, ELO_PACKET_SIZE);
req[1] = tolower(ELO_PARAMETER);
if (!eloSendQuery(req, reply, fd)) {
390
#ifdef DEBUG_MOUSE
391
392
fprintf(stderr,
"Not at the specified rate or model 2310, will continue\n");
393
#endif
394
}
395
396
397
398
SDL_memset(req, 0, ELO_PACKET_SIZE);
req[1] = tolower(ELO_ID);
if (eloSendQuery(req, reply, fd)) {
399
#ifdef DEBUG_MOUSE
400
fprintf(stderr, "Ok, controller configured!\n");
401
#endif
402
} else {
403
#ifdef DEBUG_MOUSE
404
405
fprintf(stderr,
"Unable to ask Elographics touchscreen identification\n");
406
#endif
407
408
409
return 0;
}
410
SDL_memset(req, 0, ELO_PACKET_SIZE);
411
412
413
req[1] = ELO_MODE;
req[3] = ELO_TOUCH_MODE | ELO_STREAM_MODE | ELO_UNTOUCH_MODE;
req[4] = ELO_TRACKING_MODE;
414
if (!eloSendControl(req, fd)) {
415
#ifdef DEBUG_MOUSE
416
417
fprintf(stderr,
"Unable to change Elographics touchscreen operating mode\n");
418
#endif
419
420
421
return 0;
}
422
SDL_memset(req, 0, ELO_PACKET_SIZE);
423
424
425
req[1] = ELO_REPORT;
req[2] = ELO_UNTOUCH_DELAY;
req[3] = ELO_REPORT_DELAY;
426
if (!eloSendControl(req, fd)) {
427
#ifdef DEBUG_MOUSE
428
429
fprintf(stderr,
"Unable to change Elographics touchscreen reports timings\n");
430
#endif
431
432
return 0;
}
433
434
return 1;
435
}
436
437
int
438
439
eloReadPosition(_THIS, int fd, int *x, int *y, int *button_state, int *realx,
int *realy)
440
441
442
443
{
unsigned char buffer[ELO_PACKET_SIZE];
int pointer = 0;
int checksum = ELO_INIT_CHECKSUM;
444
445
while (pointer < ELO_PACKET_SIZE) {
446
if (eloGetPacket(buffer, &pointer, &checksum, fd)) {
447
break;
448
}
449
}
450
451
if (!eloParsePacket(buffer, realx, realy, button_state)) {
452
453
454
455
456
return 0;
}
*x = *realx;
*y = *realy;
457
458
eloConvertXY(this, x, y);
459
460
return 1;
461
}
462
463
/* vi: set ts=4 sw=4 expandtab: */