patch-2.4.0-test2 linux/drivers/char/scan_keyb.c

• Lines: 128
• Date: Mon Jun 19 17:59:40 2000
• Orig file: v2.4.0-test1/linux/drivers/char/scan_keyb.c
• Orig date: Wed Dec 31 16:00:00 1969

diff -u --recursive --new-file v2.4.0-test1/linux/drivers/char/scan_keyb.c linux/drivers/char/scan_keyb.c
@@ -0,0 +1,127 @@
+/*
+ *	$Id: scan_keyb.c,v 1.1 2000/06/10 21:45:30 yaegashi Exp $ 
+ *	Copyright (C) 2000 YAEGASHI Takeshi
+ *	Generic scan keyboard driver
+ */
+
+#include <linux/spinlock.h>
+#include <linux/sched.h>
+#include <linux/interrupt.h>
+#include <linux/tty.h>
+#include <linux/mm.h>
+#include <linux/signal.h>
+#include <linux/init.h>
+#include <linux/kbd_ll.h>
+#include <linux/delay.h>
+#include <linux/random.h>
+#include <linux/poll.h>
+#include <linux/miscdevice.h>
+#include <linux/malloc.h>
+#include <linux/kbd_kern.h>
+
+struct scan_keyboard {
+	struct scan_keyboard *next;
+	void (*scan)(unsigned char *buffer);
+	const unsigned char *table;
+	unsigned char *s0, *s1;
+	int length;
+};
+		     
+static struct scan_keyboard *keyboards=NULL;
+static struct tq_struct task_scan_kbd;	
+
+static void check_kbd(const unsigned char *table,
+		      unsigned char *new, unsigned char *old, int length)
+{
+	int need_tasklet_schedule=0;
+	unsigned char xor, bit;
+	
+	while(length-->0) {
+		if((xor=*new^*old)==0) {
+			table+=8;
+		}
+		else {
+			for(bit=0x80; bit!=0; bit>>=1) {
+				if(xor&bit) {
+					handle_scancode(*table, !(*new&bit));
+					need_tasklet_schedule=1;
+				}
+				table++;
+			}
+		}
+		new++; old++;
+	}
+
+	if(need_tasklet_schedule)
+		tasklet_schedule(&keyboard_tasklet);
+}
+
+
+static void scan_kbd(void *dummy)
+{
+	struct scan_keyboard *kbd;
+
+	for(kbd=keyboards; kbd!=NULL; kbd=kbd->next) {
+		if(jiffies&1) {
+			kbd->scan(kbd->s0);
+			check_kbd(kbd->table, kbd->s0, kbd->s1, kbd->length);
+		}
+		else {
+			kbd->scan(kbd->s1);
+			check_kbd(kbd->table, kbd->s1, kbd->s0, kbd->length);
+		}
+		
+	}
+	queue_task(&task_scan_kbd, &tq_timer);
+}
+
+
+int register_scan_keyboard(void (*scan)(unsigned char *buffer),
+			   const unsigned char *table,
+			   int length)
+{
+	struct scan_keyboard *kbd;
+
+	if((kbd=kmalloc(sizeof(struct scan_keyboard), GFP_KERNEL))==NULL)
+		goto error_out;
+
+	kbd->scan=scan;
+	kbd->table=table;
+	kbd->length=length;
+
+	kbd->s0=kbd->s1=NULL;
+	if((kbd->s0=kmalloc(length, GFP_KERNEL))==NULL)
+		goto error_out;
+	if((kbd->s1=kmalloc(length, GFP_KERNEL))==NULL)
+		goto error_out;
+
+	kbd->scan(kbd->s0);
+	kbd->scan(kbd->s1);
+	
+	kbd->next=keyboards;
+	keyboards=kbd;
+
+	return 0;
+
+ error_mem_free:
+	if(kbd->s0)
+		kfree(kbd->s0);
+	if(kbd->s1)
+		kfree(kbd->s1);
+	kfree(kbd);
+
+ error_out:
+	return -ENOMEM;
+}
+			      
+			      
+void __init scan_kbd_init(void)
+{
+
+	task_scan_kbd.next=NULL;
+	task_scan_kbd.sync=0;
+	task_scan_kbd.routine=scan_kbd;
+	task_scan_kbd.data=NULL;
+	queue_task(&task_scan_kbd, &tq_timer);
+	printk(KERN_INFO "Generic scan keyboard driver initialized\n");
+}