Logo Search packages:      
Sourcecode: linux version File versions  Download package

jornada680_kbd.c

/*
 * drivers/input/keyboard/jornada680_kbd.c
 *
 * HP Jornada 620/660/680/690 scan keyboard platform driver
 *  Copyright (C) 2007  Kristoffer Ericson <Kristoffer.Ericson@gmail.com>
 *
 * Based on hp680_keyb.c
 *  Copyright (C) 2006 Paul Mundt
 *  Copyright (C) 2005 Andriy Skulysh
 * Split from drivers/input/keyboard/hp600_keyb.c
 *  Copyright (C) 2000 Yaegashi Takeshi (hp6xx kbd scan routine and translation table)
 *  Copyright (C) 2000 Niibe Yutaka (HP620 Keyb translation table)
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/init.h>
#include <linux/input.h>
#include <linux/input-polldev.h>
#include <linux/interrupt.h>
#include <linux/jiffies.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/platform_device.h>

#include <asm/delay.h>
#include <asm/io.h>

#define PCCR 0xa4000104
#define PDCR 0xa4000106
#define PECR 0xa4000108
#define PFCR 0xa400010a
#define PCDR 0xa4000124
#define PDDR 0xa4000126
#define PEDR 0xa4000128
#define PFDR 0xa400012a
#define PGDR 0xa400012c
#define PHDR 0xa400012e
#define PJDR 0xa4000130
#define PKDR 0xa4000132
#define PLDR 0xa4000134

static const unsigned short jornada_scancodes[] = {
/* PTD1 */  KEY_CAPSLOCK, KEY_MACRO, KEY_LEFTCTRL, 0, KEY_ESC, KEY_KP5, 0, 0,             /*  1  -> 8   */
            KEY_F1, KEY_F2, KEY_F3, KEY_F8, KEY_F7, KEY_F6, KEY_F4, KEY_F5,                     /*  9  -> 16  */
/* PTD5 */  KEY_SLASH, KEY_APOSTROPHE, KEY_ENTER, 0, KEY_Z, 0, 0, 0,                      /*  17 -> 24  */
            KEY_X, KEY_C, KEY_V, KEY_DOT, KEY_COMMA, KEY_M, KEY_B, KEY_N,                       /*  25 -> 32  */
/* PTD7 */  KEY_KP2, KEY_KP6, KEY_KP3, 0, 0, 0, 0, 0,                               /*  33 -> 40  */
            KEY_F10, KEY_RO, KEY_F9, KEY_KP4, KEY_NUMLOCK, KEY_SCROLLLOCK, KEY_LEFTALT, KEY_HANJA,    /*  41 -> 48  */
/* PTE0 */  KEY_KATAKANA, KEY_KP0, KEY_GRAVE, 0, KEY_FINANCE, 0, 0, 0,                    /*  49 -> 56  */
            KEY_KPMINUS, KEY_HIRAGANA, KEY_SPACE, KEY_KPDOT, KEY_VOLUMEUP, 249, 0, 0,           /*  57 -> 64  */
/* PTE1 */  KEY_SEMICOLON, KEY_RIGHTBRACE, KEY_BACKSLASH, 0, KEY_A, 0, 0, 0,              /*  65 -> 72  */
            KEY_S, KEY_D, KEY_F, KEY_L, KEY_K, KEY_J, KEY_G, KEY_H,                             /*  73 -> 80  */
/* PTE3 */  KEY_KP8, KEY_LEFTMETA, KEY_RIGHTSHIFT, 0, KEY_TAB, 0, 0, 0,                   /*  81 -> 88  */
            0, KEY_LEFTSHIFT, KEY_KP7, KEY_KP9, KEY_KP1, KEY_F11, KEY_KPPLUS, KEY_KPASTERISK,   /*  89 -> 96  */
/* PTE6 */  KEY_P, KEY_LEFTBRACE, KEY_BACKSPACE, 0, KEY_Q, 0, 0, 0,                             /*  97 -> 104 */
            KEY_W, KEY_E, KEY_R, KEY_O, KEY_I, KEY_U, KEY_T, KEY_Y,                             /* 105 -> 112 */
/* PTE7 */  KEY_0, KEY_MINUS, KEY_EQUAL, 0, KEY_1, 0, 0, 0,                               /* 113 -> 120 */
            KEY_2, KEY_3, KEY_4, KEY_9, KEY_8, KEY_7, KEY_5, KEY_6,                             /* 121 -> 128 */
/* **** */  0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
            0, 0, 0, 0, 0
};

#define JORNADA_SCAN_SIZE     18

struct jornadakbd {
      struct input_polled_dev *poll_dev;
      unsigned short keymap[ARRAY_SIZE(jornada_scancodes)];
      unsigned char length;
      unsigned char old_scan[JORNADA_SCAN_SIZE];
      unsigned char new_scan[JORNADA_SCAN_SIZE];
};

static void jornada_parse_kbd(struct jornadakbd *jornadakbd)
{
      struct input_dev *input_dev = jornadakbd->poll_dev->input;
      unsigned short *keymap = jornadakbd->keymap;
      unsigned int sync_me = 0;
      unsigned int i, j;

      for (i = 0; i < JORNADA_SCAN_SIZE; i++) {
            unsigned char new = jornadakbd->new_scan[i];
            unsigned char old = jornadakbd->old_scan[i];
            unsigned int xor = new ^ old;

            if (xor == 0)
                  continue;

            for (j = 0; j < 8; j++) {
                  unsigned int bit = 1 << j;
                  if (xor & bit) {
                        unsigned int scancode = (i << 3) + j;
                        input_event(input_dev,
                                  EV_MSC, MSC_SCAN, scancode);
                        input_report_key(input_dev,
                                     keymap[scancode],
                                     !(new & bit));
                        sync_me = 1;
                  }
            }
      }

      if (sync_me)
          input_sync(input_dev);
}

static void jornada_scan_keyb(unsigned char *s)
{
      int i;
      unsigned short ec_static, dc_static; /* = UINT16_t */
      unsigned char matrix_switch[] = {
            0xfd, 0xff,   /* PTD1 PD(1) */
            0xdf, 0xff,   /* PTD5 PD(5) */
            0x7f, 0xff,   /* PTD7 PD(7) */
            0xff, 0xfe,   /* PTE0 PE(0) */
            0xff, 0xfd,   /* PTE1 PE(1) */
            0xff, 0xf7,   /* PTE3 PE(3) */
            0xff, 0xbf,   /* PTE6 PE(6) */
            0xff, 0x7f,   /* PTE7 PE(7) */
      }, *t = matrix_switch;
      /* PD(x) :
      1.   0xcc0c & (1~(1 << (2*(x)+1)))))
      2.   (0xf0cf & 0xfffff) */
      /* PE(x) :
      1.   0xcc0c & 0xffff
      2.   0xf0cf & (1~(1 << (2*(x)+1))))) */
      unsigned short matrix_PDE[] = {
            0xcc04, 0xf0cf,  /* PD(1) */
            0xc40c, 0xf0cf,    /* PD(5) */
            0x4c0c, 0xf0cf,  /* PD(7) */
            0xcc0c, 0xf0cd,  /* PE(0) */
            0xcc0c, 0xf0c7,    /* PE(1) */
            0xcc0c, 0xf04f,  /* PE(3) */
            0xcc0c, 0xd0cf,    /* PE(6) */
            0xcc0c, 0x70cf,    /* PE(7) */
      }, *y = matrix_PDE;

      /* Save these control reg bits */
      dc_static = (ctrl_inw(PDCR) & (~0xcc0c));
      ec_static = (ctrl_inw(PECR) & (~0xf0cf));

      for (i = 0; i < 8; i++) {
            /* disable output for all but the one we want to scan */
            ctrl_outw((dc_static | *y++), PDCR);
            ctrl_outw((ec_static | *y++), PECR);
            udelay(5);

            /* Get scanline row */
            ctrl_outb(*t++, PDDR);
            ctrl_outb(*t++, PEDR);
            udelay(50);

            /* Read data */
            *s++ = ctrl_inb(PCDR);
            *s++ = ctrl_inb(PFDR);
      }
      /* Scan no lines */
      ctrl_outb(0xff, PDDR);
      ctrl_outb(0xff, PEDR);

      /* Enable all scanlines */
      ctrl_outw((dc_static | (0x5555 & 0xcc0c)),PDCR);
      ctrl_outw((ec_static | (0x5555 & 0xf0cf)),PECR);

      /* Ignore extra keys and events */
      *s++ = ctrl_inb(PGDR);
      *s++ = ctrl_inb(PHDR);
}

static void jornadakbd680_poll(struct input_polled_dev *dev)
{
      struct jornadakbd *jornadakbd = dev->private;

      jornada_scan_keyb(jornadakbd->new_scan);
      jornada_parse_kbd(jornadakbd);
      memcpy(jornadakbd->old_scan, jornadakbd->new_scan, JORNADA_SCAN_SIZE);
}

static int __devinit jornada680kbd_probe(struct platform_device *pdev)
{
      struct jornadakbd *jornadakbd;
      struct input_polled_dev *poll_dev;
      struct input_dev *input_dev;
      int i, error;

      jornadakbd = kzalloc(sizeof(struct jornadakbd), GFP_KERNEL);
      if (!jornadakbd)
            return -ENOMEM;

      poll_dev = input_allocate_polled_device();
      if (!poll_dev) {
            error = -ENOMEM;
            goto failed;
      }

      platform_set_drvdata(pdev, jornadakbd);

      jornadakbd->poll_dev = poll_dev;

      memcpy(jornadakbd->keymap, jornada_scancodes,
            sizeof(jornadakbd->keymap));

      poll_dev->private = jornadakbd;
      poll_dev->poll = jornadakbd680_poll;
      poll_dev->poll_interval = 50; /* msec */

      input_dev = poll_dev->input;
      input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP);
      input_dev->name = "HP Jornada 680 keyboard";
      input_dev->phys = "jornadakbd/input0";
      input_dev->keycode = jornadakbd->keymap;
      input_dev->keycodesize = sizeof(unsigned short);
      input_dev->keycodemax = ARRAY_SIZE(jornada_scancodes);
      input_dev->dev.parent = &pdev->dev;
      input_dev->id.bustype = BUS_HOST;

      for (i = 0; i < 128; i++)
            if (jornadakbd->keymap[i])
                  __set_bit(jornadakbd->keymap[i], input_dev->keybit);
      __clear_bit(KEY_RESERVED, input_dev->keybit);

      input_set_capability(input_dev, EV_MSC, MSC_SCAN);

      error = input_register_polled_device(jornadakbd->poll_dev);
      if (error)
            goto failed;

      return 0;

 failed:
      printk(KERN_ERR "Jornadakbd: failed to register driver, error: %d\n",
            error);
      platform_set_drvdata(pdev, NULL);
      input_free_polled_device(poll_dev);
      kfree(jornadakbd);
      return error;

}

static int __devexit jornada680kbd_remove(struct platform_device *pdev)
{
      struct jornadakbd *jornadakbd = platform_get_drvdata(pdev);

      platform_set_drvdata(pdev, NULL);
      input_unregister_polled_device(jornadakbd->poll_dev);
      input_free_polled_device(jornadakbd->poll_dev);
      kfree(jornadakbd);

      return 0;
}

static struct platform_driver jornada680kbd_driver = {
      .driver     = {
            .name = "jornada680_kbd",
      },
      .probe      = jornada680kbd_probe,
      .remove     = __devexit_p(jornada680kbd_remove),
};

static int __init jornada680kbd_init(void)
{
      return platform_driver_register(&jornada680kbd_driver);
}

static void __exit jornada680kbd_exit(void)
{
      platform_driver_unregister(&jornada680kbd_driver);
}

module_init(jornada680kbd_init);
module_exit(jornada680kbd_exit);

MODULE_AUTHOR("Kristoffer Ericson <kristoffer.ericson@gmail.com>");
MODULE_DESCRIPTION("HP Jornada 620/660/680/690 Keyboard Driver");
MODULE_LICENSE("GPLv2");

Generated by  Doxygen 1.6.0   Back to index