diff options
author | Peter Osterlund <petero2@telia.com> | 2003-09-15 21:26:08 +0200 |
---|---|---|
committer | Peter Osterlund <petero2@telia.com> | 2006-04-09 04:01:10 +0200 |
commit | 1e01005291b312b9cc229701832991b77dbc7f79 (patch) | |
tree | 054c192d215ab91b40680d8e70087c611cd08b42 /testprotokoll.c | |
parent | 738003e9f6154b7b1bde845b030916c03080d56e (diff) |
Forgot to run emacs indent before last check in.
Diffstat (limited to 'testprotokoll.c')
-rw-r--r-- | testprotokoll.c | 107 |
1 files changed, 55 insertions, 52 deletions
diff --git a/testprotokoll.c b/testprotokoll.c index 7cd0483..51758be 100644 --- a/testprotokoll.c +++ b/testprotokoll.c @@ -4,75 +4,78 @@ #include <stdio.h> #include <unistd.h> -int outputformat = 0; +static int outputformat = 0; void SynapticsReadPacket(int fd) { - int count = 0; - int inSync = 0; - unsigned char pBuf[7], u; + int count = 0; + int inSync = 0; + unsigned char pBuf[7], u; - while (read(fd,&u, 1) == 1) { - pBuf[count++] = 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 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; - } + /* 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; - } - } + 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; + int fd; - if (argc > 1) - outputformat = atoi(argv[1]); + if (argc > 1) + outputformat = atoi(argv[1]); - fd=open("/dev/psaux", O_RDONLY); - if (fd == -1) { - printf("Error opening /dev/psaux\n"); - exit(1); - } + fd = open("/dev/psaux", O_RDONLY); + if (fd == -1) { + printf("Error opening /dev/psaux\n"); + exit(1); + } - SynapticsReadPacket(fd); + SynapticsReadPacket(fd); - close(fd); + close(fd); - exit(0); + exit(0); } |