drivers/input/serio/parkbd.c

   1 /*
   2  * $Id: parkbd.c,v 1.10 2002/03/13 10:09:20 vojtech Exp $
   3  *
   4  *  Copyright (c) 1999-2001 Vojtech Pavlik
   5  */
   6
   7 /*
   8  *  Parallel port to Keyboard port adapter driver for Linux
   9  */
  10
  11 /*
  12  * This program is free software; you can redistribute it and/or modify
  13  * it under the terms of the GNU General Public License as published by
  14  * the Free Software Foundation; either version 2 of the License, or
  15  * (at your option) any later version.
  16  *
  17  * This program is distributed in the hope that it will be useful,
  18  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  20  * GNU General Public License for more details.
  21  *
  22  * You should have received a copy of the GNU General Public License
  23  * along with this program; if not, write to the Free Software
  24  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  25  *
  26  * Should you need to contact me, the author, you can do so either by
  27  * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail:
  28  * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic
  29  */
  30
  31 #include <linux/module.h>
  32 #include <linux/parport.h>
  33 #include <linux/init.h>
  34 #include <linux/serio.h>
  35
  36 MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
  37 MODULE_DESCRIPTION("Parallel port to Keyboard port adapter driver");
  38 MODULE_LICENSE("GPL");
  39
  40 MODULE_PARM(parkbd, "1i");
  41 MODULE_PARM(parkbd_mode, "1i");
  42
  43 #define PARKBD_CLOCK    0x01    /* Strobe & Ack */
  44 #define PARKBD_DATA     0x02    /* AutoFd & Busy */
  45
  46 static int parkbd;
  47 static int parkbd_mode = SERIO_8042;
  48
  49 static int parkbd_buffer;
  50 static int parkbd_counter;
  51 static unsigned long parkbd_last;
  52 static int parkbd_writing;
  53 static unsigned long parkbd_start;
  54
  55 static struct pardevice *parkbd_dev;
  56
  57 static char parkbd_name[] = "PARKBD AT/XT keyboard adapter";
  58 static char parkbd_phys[32];
  59
  60 static int parkbd_readlines(void)
  61 {
  62         return (parport_read_status(parkbd_dev->port) >> 6) ^ 2;
  63 }
  64
  65 static void parkbd_writelines(int data)
  66 {
  67         parport_write_control(parkbd_dev->port, (~data & 3) | 0x10);
  68 }
  69
  70 static int parkbd_write(struct serio *port, unsigned char c)
  71 {
  72         unsigned char p;
  73
  74         if (!parkbd_mode) return -1;
  75
  76         p = c ^ (c >> 4);
  77         p = p ^ (p >> 2);
  78         p = p ^ (p >> 1);
  79
  80         parkbd_counter = 0;
  81         parkbd_writing = 1;
  82         parkbd_buffer = c | (((int) (~p & 1)) << 8) | 0x600;
  83
  84         parkbd_writelines(2);
  85
  86         return 0;
  87 }
  88
  89 static int parkbd_open(struct serio *port)
  90 {
  91         return 0;
  92 }
  93
  94 static void parkbd_close(struct serio *port)
  95 {
  96 }
  97
  98 static struct serio parkbd_port =
  99 {
 100         .write  = parkbd_write,
 101         .open   = parkbd_open,
 102         .close  = parkbd_close,
 103         .name   = parkbd_name,
 104         .phys   = parkbd_phys,
 105 };
 106
 107 static void parkbd_interrupt(int irq, void *dev_id, struct pt_regs *regs)
 108 {
 109
 110         if (parkbd_writing) {
 111
 112                 if (parkbd_counter && ((parkbd_counter == 11) || time_after(jiffies, parkbd_last + HZ/100))) {
 113                         parkbd_counter = 0;
 114                         parkbd_buffer = 0;
 115                         parkbd_writing = 0;
 116                         parkbd_writelines(3);
 117                         return;
 118                 }
 119
 120                 parkbd_writelines(((parkbd_buffer >> parkbd_counter++) & 1) | 2);
 121
 122                 if (parkbd_counter == 11) {
 123                         parkbd_counter = 0;
 124                         parkbd_buffer = 0;
 125                         parkbd_writing = 0;
 126                         parkbd_writelines(3);
 127                 }
 128
 129         } else {
 130
 131                 if ((parkbd_counter == parkbd_mode + 10) || time_after(jiffies, parkbd_last + HZ/100)) {
 132                         parkbd_counter = 0;
 133                         parkbd_buffer = 0;
 134                 }
 135
 136                 parkbd_buffer |= (parkbd_readlines() >> 1) << parkbd_counter++;
 137
 138                 if (parkbd_counter == parkbd_mode + 10)
 139                         serio_interrupt(&parkbd_port, (parkbd_buffer >> (2 - parkbd_mode)) & 0xff, 0, regs);
 140         }
 141
 142         parkbd_last = jiffies;
 143 }
 144
 145 static int parkbd_getport(void)
 146 {
 147         struct parport *pp;
 148
 149         if (parkbd < 0) {
 150                 printk(KERN_ERR "parkbd: no port specified\n");
 151                 return -ENODEV;
 152         }
 153
 154         pp = parport_find_number(parkbd);
 155
 156         if (pp == NULL) {
 157                 printk(KERN_ERR "parkbd: no such parport\n");
 158                 return -ENODEV;
 159         }
 160
 161         parkbd_dev = parport_register_device(pp, "parkbd", NULL, NULL, parkbd_interrupt, PARPORT_DEV_EXCL, NULL);
 162         parport_put_port(pp);
 163
 164         if (!parkbd_dev)
 165                 return -ENODEV;
 166
 167         if (parport_claim(parkbd_dev)) {
 168                 parport_unregister_device(parkbd_dev);
 169                 return -EBUSY;
 170         }
 171
 172         parkbd_start = jiffies;
 173
 174         return 0;
 175 }
 176
 177
 178 int __init parkbd_init(void)
 179 {
 180         if (parkbd_getport()) return -1;
 181         parkbd_writelines(3);
 182         parkbd_port.type = parkbd_mode;
 183
 184         sprintf(parkbd_phys, "%s/serio0", parkbd_dev->port->name);
 185
 186         serio_register_port(&parkbd_port);
 187
 188         printk(KERN_INFO "serio: PARKBD %s adapter on %s\n",
 189                         parkbd_mode ? "AT" : "XT", parkbd_dev->port->name);
 190
 191         return 0;
 192 }
 193
 194 void __exit parkbd_exit(void)
 195 {
 196         parport_release(parkbd_dev);
 197         serio_unregister_port(&parkbd_port);
 198         parport_unregister_device(parkbd_dev);
 199 }
 200
 201 module_init(parkbd_init);
 202 module_exit(parkbd_exit);