[lcd4linux @ 2006-07-12 20:47:51 by reinelt]

indent

git-svn-id: https://ssl.bulix.org/svn/lcd4linux/trunk@668 3ae390bd-cb1e-0410-b409-cd5a39f66f1f

1 files changed, 183 insertions, 202 deletions

diff --git a/drv_G15.c b/drv_G15.c
index 73bf033..6535fc5 100644
--- a/drv_G15.c
+++ b/drv_G15.c
@@ -1,4 +1,4 @@
-/* $Id: drv_G15.c,v 1.7 2006/07/12 20:45:30 reinelt Exp $
+/* $Id: drv_G15.c,v 1.8 2006/07/12 20:47:51 reinelt Exp $
  *
  * Driver for Logitech G-15 keyboard LCD screen
  *
@@ -24,6 +24,9 @@
  *
  *
  * $Log: drv_G15.c,v $
+ * Revision 1.8  2006/07/12 20:47:51  reinelt
+ * indent
+ *
  * Revision 1.7  2006/07/12 20:45:30  reinelt
  * G15 and thread patch by Anton
  *
@@ -64,8 +67,8 @@
 
 #include <usb.h>
 #include <fcntl.h>
-#include <linux/input.h> 
-#include <linux/uinput.h> 
+#include <linux/input.h>
+#include <linux/uinput.h>
 #include <signal.h>
 
 #include "debug.h"
@@ -101,7 +104,7 @@ unsigned char l_key_states[5];
 static int uinput_fd;
 static int kb_mutex;
 static int kb_thread_pid;
-static int kb_single_keypress=0;
+static int kb_single_keypress = 0;
 
 
 /****************************************/
@@ -111,225 +114,203 @@ static int kb_single_keypress=0;
 
 void drv_G15_keyDown(unsigned char scancode)
 {
-   struct input_event event;
-	memset(&event, 0, sizeof(event));
-	
-	event.type = EV_KEY;
-	event.code = scancode;
-	event.value = 1;
-	write (uinput_fd, &event, sizeof(event));   
+    struct input_event event;
+    memset(&event, 0, sizeof(event));
+
+    event.type = EV_KEY;
+    event.code = scancode;
+    event.value = 1;
+    write(uinput_fd, &event, sizeof(event));
 }
 void drv_G15_keyUp(unsigned char scancode)
 {
-   struct input_event event;
-	memset(&event, 0, sizeof(event));
-	
-	event.type = EV_KEY;
-	event.code = scancode;
-	event.value = 0;
-	write (uinput_fd, &event, sizeof(event));   
+    struct input_event event;
+    memset(&event, 0, sizeof(event));
+
+    event.type = EV_KEY;
+    event.code = scancode;
+    event.value = 0;
+    write(uinput_fd, &event, sizeof(event));
 }
 void drv_G15_keyDownUp(unsigned char scancode)
 {
-   drv_G15_keyDown(scancode);
-   drv_G15_keyUp(scancode);
-   
+    drv_G15_keyDown(scancode);
+    drv_G15_keyUp(scancode);
+
 }
 inline unsigned char drv_G15_evalScanCode(int key)
 {
-   // first 12 G keys produce F1 - F12, thats 0x3a + key
-   if (key < 12)
-   {
-      return 0x3a + key;
-   }
-   // the other keys produce Key '1' (above letters) + key, thats 0x1e + key
-   else
-   {
-      return 0x1e + key - 12; // sigh, half an hour to find  -12 ....
-   }
+    // first 12 G keys produce F1 - F12, thats 0x3a + key
+    if (key < 12) {
+	return 0x3a + key;
+    }
+    // the other keys produce Key '1' (above letters) + key, thats 0x1e + key
+    else {
+	return 0x1e + key - 12;	// sigh, half an hour to find  -12 ....
+    }
 }
 
 void drv_G15_processKeyEvent(unsigned char *buffer)
 {
-   const int g_scancode_offset = 167;
-   const int m_scancode_offset = 187;
-   const int l_scancode_offset = 191;
-   int i;
-   int is_set;
-   unsigned char m_key_new_states[4];   
-   unsigned char l_key_new_states[5];	 
-   unsigned char orig_scancode;
+    const int g_scancode_offset = 167;
+    const int m_scancode_offset = 187;
+    const int l_scancode_offset = 191;
+    int i;
+    int is_set;
+    unsigned char m_key_new_states[4];
+    unsigned char l_key_new_states[5];
+    unsigned char orig_scancode;
 //   printf("%hhx %hhx %hhx %hhx %hhx %hhx %hhx %hhx %hhx \n\n",buffer[0],buffer[1],buffer[2],buffer[3],buffer[4],buffer[5],buffer[6],buffer[7],buffer[8]);
 //   usleep(100);
-   if (buffer[0] == 0x01)
-   {
-      DEBUG("Checking keys: ");
-
-
-      for (i=0;i<18;++i)
-      {
-         orig_scancode = drv_G15_evalScanCode(i);
-         is_set = 0;
-         
-         if (buffer[1] == orig_scancode || buffer[2] == orig_scancode || buffer[3] == orig_scancode ||
-               buffer[4] == orig_scancode || buffer[5] == orig_scancode)
-            is_set = 1;
-         
-         if (!is_set && g_key_states[i] != 0)
-         {
-            // key was pressed but is no more
-	    if (!kb_single_keypress)
-                drv_G15_keyUp( g_scancode_offset + i);
-            g_key_states[i] = 0;
-           debug("G%d going up",(i+1));	    
-         }
-         else if (is_set && g_key_states[i] == 0)
-         {
-    	    if (!kb_single_keypress)	 
-                drv_G15_keyDown ( g_scancode_offset + i);
-	    else	
-	        drv_G15_keyDownUp ( g_scancode_offset + i);	    
-
-            g_key_states[i] = 1;
-            debug("G%d going down",(i+1));	    	    
-         }
-      }
-   }
-   else
-   {
-      if (buffer[0] == 0x02)
-      {
-         memset(m_key_new_states,0,sizeof(m_key_new_states));
-         
-         if (buffer[6]&0x01)
-            m_key_new_states[0] = 1;
-         if (buffer[7]&0x02)
-            m_key_new_states[1] = 1;
-         if (buffer[8]&0x04)
-            m_key_new_states[2] = 1;
-         if (buffer[7]&0x40)
-            m_key_new_states[3] = 1;
-         
-         for (i=0;i<4;++i)
-         {
-            if (!m_key_new_states[i] && m_key_states[i] != 0)
-            {
-               // key was pressed but is no more
-	       if (!kb_single_keypress)	       
-            	drv_G15_keyUp( m_scancode_offset + i);
-               m_key_states[i] = 0;
-	       debug("M%d going up",(i+1));
-            }
-            else if (m_key_new_states[i] && m_key_states[i] == 0)
-            {
-	       if (!kb_single_keypress)	       
-                drv_G15_keyDown ( m_scancode_offset + i);
-	       else
-                drv_G15_keyDownUp ( m_scancode_offset + i);
-               m_key_states[i] = 1;
-	       debug("M%d going down",(i+1));	       
-            }
-         }
-         
-         memset(l_key_new_states,0,sizeof(l_key_new_states));
-         if (buffer[8]&0x80)
-            l_key_new_states[0] = 1;
-         if (buffer[2]&0x80)
-            l_key_new_states[1] = 1;
-         if (buffer[3]&0x80)
-            l_key_new_states[2] = 1;
-         if (buffer[4]&0x80)
-            l_key_new_states[3] = 1;
-         if (buffer[5]&0x80)
-            l_key_new_states[4] = 1;
-         
-         for (i=0;i<5;++i)
-         {
-            if (!l_key_new_states[i] && l_key_states[i] != 0)
-            {
-               // key was pressed but is no more
-	       if (!kb_single_keypress)	       	       
-                  drv_G15_keyUp( l_scancode_offset + i);
-               l_key_states[i] = 0;
-	       debug("L%d going up",(i+1));
-            }
-            else if (l_key_new_states[i] && l_key_states[i] == 0)
-            {
-	       if (!kb_single_keypress)	       
-                  drv_G15_keyDown ( l_scancode_offset + i);
-	       else
-                  drv_G15_keyDownUp ( l_scancode_offset + i);
-               l_key_states[i] = 1;
-	       debug("L%d going down",(i+1));	       
-            }
-         }                           
-         
-      }
-   }
+    if (buffer[0] == 0x01) {
+	DEBUG("Checking keys: ");
+
+
+	for (i = 0; i < 18; ++i) {
+	    orig_scancode = drv_G15_evalScanCode(i);
+	    is_set = 0;
+
+	    if (buffer[1] == orig_scancode || buffer[2] == orig_scancode || buffer[3] == orig_scancode ||
+		buffer[4] == orig_scancode || buffer[5] == orig_scancode)
+		is_set = 1;
+
+	    if (!is_set && g_key_states[i] != 0) {
+		// key was pressed but is no more
+		if (!kb_single_keypress)
+		    drv_G15_keyUp(g_scancode_offset + i);
+		g_key_states[i] = 0;
+		debug("G%d going up", (i + 1));
+	    } else if (is_set && g_key_states[i] == 0) {
+		if (!kb_single_keypress)
+		    drv_G15_keyDown(g_scancode_offset + i);
+		else
+		    drv_G15_keyDownUp(g_scancode_offset + i);
+
+		g_key_states[i] = 1;
+		debug("G%d going down", (i + 1));
+	    }
+	}
+    } else {
+	if (buffer[0] == 0x02) {
+	    memset(m_key_new_states, 0, sizeof(m_key_new_states));
+
+	    if (buffer[6] & 0x01)
+		m_key_new_states[0] = 1;
+	    if (buffer[7] & 0x02)
+		m_key_new_states[1] = 1;
+	    if (buffer[8] & 0x04)
+		m_key_new_states[2] = 1;
+	    if (buffer[7] & 0x40)
+		m_key_new_states[3] = 1;
+
+	    for (i = 0; i < 4; ++i) {
+		if (!m_key_new_states[i] && m_key_states[i] != 0) {
+		    // key was pressed but is no more
+		    if (!kb_single_keypress)
+			drv_G15_keyUp(m_scancode_offset + i);
+		    m_key_states[i] = 0;
+		    debug("M%d going up", (i + 1));
+		} else if (m_key_new_states[i] && m_key_states[i] == 0) {
+		    if (!kb_single_keypress)
+			drv_G15_keyDown(m_scancode_offset + i);
+		    else
+			drv_G15_keyDownUp(m_scancode_offset + i);
+		    m_key_states[i] = 1;
+		    debug("M%d going down", (i + 1));
+		}
+	    }
+
+	    memset(l_key_new_states, 0, sizeof(l_key_new_states));
+	    if (buffer[8] & 0x80)
+		l_key_new_states[0] = 1;
+	    if (buffer[2] & 0x80)
+		l_key_new_states[1] = 1;
+	    if (buffer[3] & 0x80)
+		l_key_new_states[2] = 1;
+	    if (buffer[4] & 0x80)
+		l_key_new_states[3] = 1;
+	    if (buffer[5] & 0x80)
+		l_key_new_states[4] = 1;
+
+	    for (i = 0; i < 5; ++i) {
+		if (!l_key_new_states[i] && l_key_states[i] != 0) {
+		    // key was pressed but is no more
+		    if (!kb_single_keypress)
+			drv_G15_keyUp(l_scancode_offset + i);
+		    l_key_states[i] = 0;
+		    debug("L%d going up", (i + 1));
+		} else if (l_key_new_states[i] && l_key_states[i] == 0) {
+		    if (!kb_single_keypress)
+			drv_G15_keyDown(l_scancode_offset + i);
+		    else
+			drv_G15_keyDownUp(l_scancode_offset + i);
+		    l_key_states[i] = 1;
+		    debug("L%d going down", (i + 1));
+		}
+	    }
+
+	}
+    }
 }
 
 void drv_G15_closeUIDevice()
 {
-   DEBUG("closing device");
-   ioctl(uinput_fd, UI_DEV_DESTROY);
-   close(uinput_fd);
+    DEBUG("closing device");
+    ioctl(uinput_fd, UI_DEV_DESTROY);
+    close(uinput_fd);
 }
 
 
 void drv_G15_initKeyHandling(char *device_filename)
 {
-   struct uinput_user_dev device;
-   int i;   
-   DEBUG("Key Handling init")
-   uinput_fd = open(device_filename, O_RDWR);
-
-   if (uinput_fd < 0)
-   {
-      info("Error, could not open the uinput device");
-      info("Compile your kernel for uinput, calling it a day now");
-      info("mknod uinput c 10 223");
-      abort();
-   }
-   memset(&device,0,sizeof(device));
-   strncpy(device.name, "G15 Keys", UINPUT_MAX_NAME_SIZE);
-   device.id.bustype = BUS_USB;
-   device.id.version = 4;
-   
-   ioctl(uinput_fd, UI_SET_EVBIT, EV_KEY);
-
-   for (i=0;i<256;++i)
-      ioctl(uinput_fd, UI_SET_KEYBIT, i);
-
-   write(uinput_fd, &device, sizeof(device));
-
-   if (ioctl(uinput_fd, UI_DEV_CREATE))
-   {
-      info("Failed to create input device");
-      abort();
-   }
+    struct uinput_user_dev device;
+    int i;
+    DEBUG("Key Handling init")
+	uinput_fd = open(device_filename, O_RDWR);
+
+    if (uinput_fd < 0) {
+	info("Error, could not open the uinput device");
+	info("Compile your kernel for uinput, calling it a day now");
+	info("mknod uinput c 10 223");
+	abort();
+    }
+    memset(&device, 0, sizeof(device));
+    strncpy(device.name, "G15 Keys", UINPUT_MAX_NAME_SIZE);
+    device.id.bustype = BUS_USB;
+    device.id.version = 4;
+
+    ioctl(uinput_fd, UI_SET_EVBIT, EV_KEY);
+
+    for (i = 0; i < 256; ++i)
+	ioctl(uinput_fd, UI_SET_KEYBIT, i);
+
+    write(uinput_fd, &device, sizeof(device));
+
+    if (ioctl(uinput_fd, UI_DEV_CREATE)) {
+	info("Failed to create input device");
+	abort();
+    }
 //   atexit(&closeDevice);
-   
-   memset(g_key_states, 0, sizeof(g_key_states));
-   memset(m_key_states, 0, sizeof(m_key_states));
-   memset(l_key_states, 0, sizeof(l_key_states));
+
+    memset(g_key_states, 0, sizeof(g_key_states));
+    memset(m_key_states, 0, sizeof(m_key_states));
+    memset(l_key_states, 0, sizeof(l_key_states));
 }
 
 
 static void drv_G15_KBThread(void __attribute__ ((unused)) * notused)
 {
     unsigned char buffer[9];
-    int ret;      
-    while (1)
-    {
+    int ret;
+    while (1) {
 	mutex_lock(kb_mutex);
-        ret = usb_bulk_read(g15_lcd, 0x81, (char*)buffer, 9, 10);
-//	ret = usb_interrupt_read(g15_lcd, 0x81, (char*)buffer, 9, 10);
-	mutex_unlock(kb_mutex);	
-        if (ret == 9)
-        {
+	ret = usb_bulk_read(g15_lcd, 0x81, (char *) buffer, 9, 10);
+//      ret = usb_interrupt_read(g15_lcd, 0x81, (char*)buffer, 9, 10);
+	mutex_unlock(kb_mutex);
+	if (ret == 9) {
 	    drv_G15_processKeyEvent(buffer);
-        }
-    }    
+	}
+    }
 }
 
 static int drv_G15_open()
@@ -505,17 +486,17 @@ static int drv_G15_start(const char *section)
        drv_G15_contrast(contrast);
        }
      */
-    s = cfg_get(section, "Uinput", "");     
-    if (s!=NULL && *s!='\0' ){
-        cfg_number(section, "SingleKeyPress", 0, 0, 1, &kb_single_keypress);        
+    s = cfg_get(section, "Uinput", "");
+    if (s != NULL && *s != '\0') {
+	cfg_number(section, "SingleKeyPress", 0, 0, 1, &kb_single_keypress);
 	drv_G15_initKeyHandling(s);
-        
-        DEBUG("creating thread for keyboard");    
-	kb_mutex=mutex_create();
-	kb_thread_pid=thread_create("G15_KBThread", drv_G15_KBThread, NULL);
 
-        DEBUG("done");
-    }    
+	DEBUG("creating thread for keyboard");
+	kb_mutex = mutex_create();
+	kb_thread_pid = thread_create("G15_KBThread", drv_G15_KBThread, NULL);
+
+	DEBUG("done");
+    }
     DEBUG("left");
 
     return 0;
@@ -547,7 +528,7 @@ int drv_G15_init(const char *section, const int quiet)
 {
     int ret;
 
-    info("%s: %s", Name, "$Revision: 1.7 $");
+    info("%s: %s", Name, "$Revision: 1.8 $");
 
     DEBUG("entered");
 
@@ -602,8 +583,8 @@ int drv_G15_quit(const int quiet)
     drv_generic_graphic_quit();
 
     mutex_destroy(kb_mutex);
-    usleep(10*1000);
-    kill(kb_thread_pid,SIGKILL);
+    usleep(10 * 1000);
+    kill(kb_thread_pid, SIGKILL);
 
     drv_G15_closeUIDevice();
     DEBUG("closing UInputDev");