From 09f4fd5003b3430c2a46b8494c19ca184c94157d Mon Sep 17 00:00:00 2001 From: reinelt Date: Wed, 12 Jul 2006 20:47:51 +0000 Subject: [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 --- drv_G15.c | 385 +++++++++++++++++++++++++++++--------------------------------- 1 file changed, 183 insertions(+), 202 deletions(-) (limited to 'drv_G15.c') 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 #include -#include -#include +#include +#include #include #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"); -- cgit v1.2.3