drivers/staging/nvec/nvec_ps2.c

   1 #include <linux/slab.h>
   2 #include <linux/serio.h>
   3 #include <linux/delay.h>
   4 #include "nvec.h"
   5
   6 #define START_STREAMING {'\x06','\x03','\x01'}
   7 #define STOP_STREAMING  {'\x06','\x04'}
   8 #define SEND_COMMAND    {'\x06','\x01','\xf4','\x01'}
   9
  10 struct nvec_ps2
  11 {
  12         struct serio *ser_dev;
  13         struct notifier_block notifier;
  14         struct nvec_chip *nvec;
  15 };
  16
  17 static struct nvec_ps2 ps2_dev;
  18
  19 static int ps2_startstreaming(struct serio *ser_dev)
  20 {
  21         unsigned char buf[] = START_STREAMING;
  22         nvec_write_async(ps2_dev.nvec, buf, sizeof(buf));
  23         return 0;
  24 }
  25
  26 static void ps2_stopstreaming(struct serio *ser_dev)
  27 {
  28         unsigned char buf[] = STOP_STREAMING;
  29         nvec_write_async(ps2_dev.nvec, buf, sizeof(buf));
  30 }
  31
  32 /* is this really needed?
  33 static void nvec_resp_handler(unsigned char *data) {
  34         serio_interrupt(ser_dev, data[4], 0);
  35 }
  36 */
  37
  38 static int ps2_sendcommand(struct serio *ser_dev, unsigned char cmd)
  39 {
  40         unsigned char buf[] = SEND_COMMAND;
  41
  42         buf[2] = cmd & 0xff;
  43
  44         dev_dbg(&ser_dev->dev, "Sending ps2 cmd %02x\n", cmd);
  45         nvec_write_async(ps2_dev.nvec, buf, sizeof(buf));
  46
  47         return 0;
  48 }
  49
  50 static int nvec_ps2_notifier(struct notifier_block *nb,
  51                                 unsigned long event_type, void *data)
  52 {
  53         int i;
  54         unsigned char *msg = (unsigned char *)data;
  55
  56         switch (event_type) {
  57                 case NVEC_PS2_EVT:
  58                         serio_interrupt(ps2_dev.ser_dev, msg[2], 0);
  59                         return NOTIFY_STOP;
  60
  61                 case NVEC_PS2:
  62                         if (msg[2] == 1)
  63                                 for(i = 0; i < (msg[1] - 2); i++)
  64                                         serio_interrupt(ps2_dev.ser_dev, msg[i+4], 0);
  65                         else if (msg[1] != 2) /* !ack */
  66                         {
  67                                 printk("nvec_ps2: unhandled mouse event ");
  68                                 for(i = 0; i <= (msg[1]+1); i++)
  69                                         printk("%02x ", msg[i]);
  70                                 printk(".\n");
  71                         }
  72
  73                         return NOTIFY_STOP;
  74         }
  75
  76         return NOTIFY_DONE;
  77 }
  78
  79
  80 int __init nvec_ps2(struct nvec_chip *nvec)
  81 {
  82         struct serio *ser_dev = kzalloc(sizeof(struct serio), GFP_KERNEL);
  83
  84         ser_dev->id.type=SERIO_8042;
  85         ser_dev->write=ps2_sendcommand;
  86         ser_dev->open=ps2_startstreaming;
  87         ser_dev->close=ps2_stopstreaming;
  88
  89         strlcpy(ser_dev->name, "NVEC PS2", sizeof(ser_dev->name));
  90         strlcpy(ser_dev->phys, "NVEC I2C slave", sizeof(ser_dev->phys));
  91
  92         ps2_dev.ser_dev = ser_dev;
  93         ps2_dev.notifier.notifier_call = nvec_ps2_notifier;
  94         ps2_dev.nvec = nvec;
  95         nvec_register_notifier(nvec, &ps2_dev.notifier, 0);
  96
  97         serio_register_port(ser_dev);
  98
  99         /* mouse reset */
 100         nvec_write_async(nvec, "\x06\x01\xff\x03", 4);
 101
 102         return 0;
 103 }