summaryrefslogtreecommitdiff
path: root/testprotokoll.c
diff options
context:
space:
mode:
authorPeter Osterlund <petero2@telia.com>2003-09-15 21:26:08 +0200
committerPeter Osterlund <petero2@telia.com>2006-04-09 04:01:10 +0200
commit1e01005291b312b9cc229701832991b77dbc7f79 (patch)
tree054c192d215ab91b40680d8e70087c611cd08b42 /testprotokoll.c
parent738003e9f6154b7b1bde845b030916c03080d56e (diff)
Forgot to run emacs indent before last check in.
Diffstat (limited to 'testprotokoll.c')
-rw-r--r--testprotokoll.c107
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);
}