blob: 9a9850725b5b06c127d3d698c6d1f56e8d9bd12b [file] [log] [blame]
#include <linux/slab.h>
#include <linux/input.h>
#include <linux/delay.h>
#include "nvec-keytable.h"
#include "nvec.h"
#define ACK_KBD_EVENT {'\x05','\xed','\x01'}
static unsigned char keycodes[ARRAY_SIZE(code_tab_102us)
+ ARRAY_SIZE(extcode_tab_us102)];
struct nvec_keys {
struct input_dev *input;
struct notifier_block notifier;
struct nvec_chip *nvec;
};
static struct nvec_keys keys_dev;
static int nvec_keys_notifier(struct notifier_block *nb,
unsigned long event_type, void *data)
{
int code, state;
unsigned char *msg = (unsigned char *)data;
if (event_type == NVEC_KB_EVT) {
nvec_size _size = (msg[0] & (3 << 5)) >> 5;
/* power on/off button */
if(_size == NVEC_VAR_SIZE)
return NOTIFY_STOP;
if(_size == NVEC_3BYTES)
msg++;
code = msg[1] & 0x7f;
state = msg[1] & 0x80;
input_report_key(keys_dev.input, code_tabs[_size][code], !state);
input_sync(keys_dev.input);
return NOTIFY_STOP;
}
return NOTIFY_DONE;
}
static int nvec_kbd_event(struct input_dev *dev, unsigned int type,
unsigned int code, int value)
{
unsigned char buf[] = ACK_KBD_EVENT;
struct nvec_chip *nvec = keys_dev.nvec;
if(type==EV_REP)
return 0;
if(type!=EV_LED)
return -1;
if(code!=LED_CAPSL)
return -1;
buf[2] = !!value;
nvec_write_async(nvec, buf, sizeof(buf));
return 0;
}
int __init nvec_kbd_init(struct nvec_chip *nvec)
{
int i, j, err;
struct input_dev *idev;
j = 0;
for(i = 0; i < ARRAY_SIZE(code_tab_102us); ++i)
keycodes[j++] = code_tab_102us[i];
for(i = 0; i < ARRAY_SIZE(extcode_tab_us102); ++i)
keycodes[j++]=extcode_tab_us102[i];
idev = input_allocate_device();
idev->name = "Tegra nvec keyboard";
idev->phys = "i2c3_slave/nvec";
idev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REP) | BIT_MASK(EV_LED);
idev->ledbit[0] = BIT_MASK(LED_CAPSL);
idev->event = nvec_kbd_event;
idev->keycode = keycodes;
idev->keycodesize = sizeof(unsigned char);
idev->keycodemax = ARRAY_SIZE(keycodes);
for( i = 0; i < ARRAY_SIZE(keycodes); ++i)
set_bit(keycodes[i], idev->keybit);
clear_bit(0, idev->keybit);
err = input_register_device(idev);
if(err)
goto fail;
keys_dev.input = idev;
keys_dev.notifier.notifier_call = nvec_keys_notifier;
keys_dev.nvec = nvec;
nvec_register_notifier(nvec, &keys_dev.notifier, 0);
/* Enable keyboard */
nvec_write_async(nvec, "\x05\xf4", 2);
/* keyboard reset? */
nvec_write_async(nvec, "\x05\x03\x01\x01", 4);
nvec_write_async(nvec, "\x05\x04\x01", 3);
nvec_write_async(nvec, "\x06\x01\xff\x03", 4);
/* FIXME
wait until keyboard reset is finished
or until we have a sync write */
mdelay(1000);
return 0;
fail:
input_free_device(idev);
return err;
}