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
65
66
67
68
69
70
71
72
73
74
75
76
77
78
|
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <stdio.h>
#include <unistd.h>
int outputformat = 0;
void
SynapticsReadPacket(int fd)
{
int count = 0;
int inSync = 0;
unsigned char pBuf[7], u;
while (read(fd,&u, 1) == 1) {
pBuf[count++] = u;
/* check first byte */
if ((count == 1) && ((u & 0xC8) != 0x80)) {
inSync = 0;
count = 0;
printf("Synaptics driver lost sync at 1st byte\n");
continue;
}
/* check 4th byte */
if ((count == 4) && ((u & 0xc8) != 0xc0)) {
inSync = 0;
count = 0;
printf("Synaptics driver lost sync at 4th byte\n");
continue;
}
if (count >= 6) { /* Full packet received */
if (!inSync) {
inSync = 1;
printf("Synaptics driver resynced.\n");
}
count = 0;
switch (outputformat) {
case 1: printf("Paket:%02X-%02X-%02X-%02X-%02X-%02X\n",
pBuf[0], pBuf[1], pBuf[2], pBuf[3], pBuf[4], pBuf[5]);
break;
case 2: printf("x = %i, y = %i, z = %i, w = %i, l = %i, r = %i\n",
((pBuf[3] & 0x10) << 8) | ((pBuf[1] & 0x0f) << 8) | pBuf[4],
((pBuf[3] & 0x20) << 7) | ((pBuf[1] & 0xf0) << 4) | pBuf[5],
((pBuf[0] & 0x30) >> 2) | ((pBuf[0] & 0x04) >> 1) | ((pBuf[3] & 0x04) >> 2),
((pBuf[0] & 0x30) >> 2) | ((pBuf[0] & 0x04) >> 1) | ((pBuf[3] & 0x04) >> 2),
(pBuf[0] & 0x01) ? 1 : 0,
(pBuf[0] & 0x2) ? 1 : 0);
break;
default: break;
}
}
}
}
int main(int argc, char* argv[])
{
int fd;
if (argc > 1)
outputformat = atoi(argv[1]);
fd=open("/dev/psaux", O_RDONLY);
if (fd == -1) {
printf("Error opening /dev/psaux\n");
exit(1);
}
SynapticsReadPacket(fd);
close(fd);
exit(0);
}
|
