drivers/staging/nvec/nvec_kbd.c

   1 /*
   2  * nvec_kbd: keyboard driver for a NVIDIA compliant embedded controller
   3  *
   4  * Copyright (C) 2011 The AC100 Kernel Team <ac100@lists.launchpad.net>
   5  *
   6  * Authors:  Pierre-Hugues Husson <phhusson@free.fr>
   7  *           Marc Dietrich <marvin24@gmx.de>
   8  *
   9  * This file is subject to the terms and conditions of the GNU General Public
  10  * License.  See the file "COPYING" in the main directory of this archive
  11  * for more details.
  12  *
  13  */
  14
  15 #include <linux/module.h>
  16 #include <linux/slab.h>
  17 #include <linux/input.h>
  18 #include <linux/delay.h>
  19 #include <linux/platform_device.h>
  20
  21 #include "nvec-keytable.h"
  22 #include "nvec.h"
  23
  24 #define ACK_KBD_EVENT {'\x05', '\xed', '\x01'}
  25
  26 static const char led_on[3] = "\x05\xed\x07";
  27 static const char led_off[3] = "\x05\xed\x00";
  28 static unsigned char keycodes[ARRAY_SIZE(code_tab_102us)
  29                               + ARRAY_SIZE(extcode_tab_us102)];
  30
  31 struct nvec_keys {
  32         struct input_dev *input;
  33         struct notifier_block notifier;
  34         struct nvec_chip *nvec;
  35         bool caps_lock;
  36 };
  37
  38 static struct nvec_keys keys_dev;
  39
  40 static void nvec_kbd_toggle_led(void)
  41 {
  42         keys_dev.caps_lock = !keys_dev.caps_lock;
  43
  44         if (keys_dev.caps_lock)
  45                 nvec_write_async(keys_dev.nvec, led_on, sizeof(led_on));
  46         else
  47                 nvec_write_async(keys_dev.nvec, led_off, sizeof(led_off));
  48 }
  49
  50 static int nvec_keys_notifier(struct notifier_block *nb,
  51                               unsigned long event_type, void *data)
  52 {
  53         int code, state;
  54         unsigned char *msg = (unsigned char *)data;
  55
  56         if (event_type == NVEC_KB_EVT) {
  57                 int _size = (msg[0] & (3 << 5)) >> 5;
  58
  59 /* power on/off button */
  60                 if (_size == NVEC_VAR_SIZE)
  61                         return NOTIFY_STOP;
  62
  63                 if (_size == NVEC_3BYTES)
  64                         msg++;
  65
  66                 code = msg[1] & 0x7f;
  67                 state = msg[1] & 0x80;
  68
  69                 if (code_tabs[_size][code] == KEY_CAPSLOCK && state)
  70                         nvec_kbd_toggle_led();
  71
  72                 input_report_key(keys_dev.input, code_tabs[_size][code],
  73                                  !state);
  74                 input_sync(keys_dev.input);
  75
  76                 return NOTIFY_STOP;
  77         }
  78
  79         return NOTIFY_DONE;
  80 }
  81
  82 static int nvec_kbd_event(struct input_dev *dev, unsigned int type,
  83                           unsigned int code, int value)
  84 {
  85         unsigned char buf[] = ACK_KBD_EVENT;
  86         struct nvec_chip *nvec = keys_dev.nvec;
  87
  88         if (type == EV_REP)
  89                 return 0;
  90
  91         if (type != EV_LED)
  92                 return -1;
  93
  94         if (code != LED_CAPSL)
  95                 return -1;
  96
  97         buf[2] = !!value;
  98         nvec_write_async(nvec, buf, sizeof(buf));
  99
 100         return 0;
 101 }
 102
 103 static int __devinit nvec_kbd_probe(struct platform_device *pdev)
 104 {
 105         struct nvec_chip *nvec = dev_get_drvdata(pdev->dev.parent);
 106         int i, j, err;
 107         struct input_dev *idev;
 108
 109         j = 0;
 110
 111         for (i = 0; i < ARRAY_SIZE(code_tab_102us); ++i)
 112                 keycodes[j++] = code_tab_102us[i];
 113
 114         for (i = 0; i < ARRAY_SIZE(extcode_tab_us102); ++i)
 115                 keycodes[j++] = extcode_tab_us102[i];
 116
 117         idev = input_allocate_device();
 118         idev->name = "nvec keyboard";
 119         idev->phys = "nvec";
 120         idev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP) | BIT_MASK(EV_LED);
 121         idev->ledbit[0] = BIT_MASK(LED_CAPSL);
 122         idev->event = nvec_kbd_event;
 123         idev->keycode = keycodes;
 124         idev->keycodesize = sizeof(unsigned char);
 125         idev->keycodemax = ARRAY_SIZE(keycodes);
 126
 127         for (i = 0; i < ARRAY_SIZE(keycodes); ++i)
 128                 set_bit(keycodes[i], idev->keybit);
 129
 130         clear_bit(0, idev->keybit);
 131         err = input_register_device(idev);
 132         if (err)
 133                 goto fail;
 134
 135         keys_dev.input = idev;
 136         keys_dev.notifier.notifier_call = nvec_keys_notifier;
 137         keys_dev.nvec = nvec;
 138         nvec_register_notifier(nvec, &keys_dev.notifier, 0);
 139
 140         /* Enable keyboard */
 141         nvec_write_async(nvec, "\x05\xf4", 2);
 142
 143         /* keyboard reset? */
 144         nvec_write_async(nvec, "\x05\x03\x01\x01", 4);
 145         nvec_write_async(nvec, "\x05\x04\x01", 3);
 146         nvec_write_async(nvec, "\x06\x01\xff\x03", 4);
 147 /*      FIXME
 148         wait until keyboard reset is finished
 149         or until we have a sync write */
 150         mdelay(1000);
 151
 152         /* Disable caps lock LED */
 153         nvec_write_async(nvec, led_off, sizeof(led_off));
 154
 155         return 0;
 156
 157 fail:
 158         input_free_device(idev);
 159         return err;
 160 }
 161
 162 static struct platform_driver nvec_kbd_driver = {
 163         .probe  = nvec_kbd_probe,
 164         .driver = {
 165                 .name = "nvec-kbd",
 166                 .owner = THIS_MODULE,
 167         },
 168 };
 169
 170 static int __init nvec_kbd_init(void)
 171 {
 172         return platform_driver_register(&nvec_kbd_driver);
 173 }
 174
 175 module_init(nvec_kbd_init);
 176
 177 MODULE_AUTHOR("Marc Dietrich <marvin24@gmx.de>");
 178 MODULE_DESCRIPTION("NVEC keyboard driver");
 179 MODULE_LICENSE("GPL");