Merged some stuff from version 0.11.3.

1 files changed, 85 insertions, 0 deletions

diff --git a/testprotokoll.c b/testprotokoll.c
new file mode 100644
index 0000000..76d03bd
--- /dev/null
+++ b/testprotokoll.c
@@ -0,0 +1,85 @@
+#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);
+}