mirror of
git://projects.qi-hardware.com/openwrt-xburst.git
synced 2024-12-28 08:34:37 +02:00
n526: Add keyboard controller driver
This commit is contained in:
Lars-Peter Clausen
parent
3184b1152b
commit
9b67cee817
237
target/linux/xburst/files-2.6.31/drivers/i2c/chips/n526-lpc.c
Normal file
237
target/linux/xburst/files-2.6.31/drivers/i2c/chips/n526-lpc.c
Normal file
@ -0,0 +1,237 @@
|
||||
/*
|
||||
* Copyright (C) 2009, Lars-Peter Clausen <lars@metafoo.de>
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License along
|
||||
* with this program; if not, write to the Free Software Foundation, Inc.,
|
||||
* 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/interrupt.h>
|
||||
|
||||
#include <linux/workqueue.h>
|
||||
|
||||
#include <asm/mach-jz4740/irq.h>
|
||||
#include <asm/mach-jz4740/gpio.h>
|
||||
|
||||
struct n526_lpc {
|
||||
struct i2c_client *client;
|
||||
struct input_dev *input;
|
||||
|
||||
struct work_struct work;
|
||||
};
|
||||
|
||||
static const unsigned int n526_lpc_keymap[] = {
|
||||
[0x01] = KEY_PAGEUP,
|
||||
[0x02] = KEY_PAGEDOWN,
|
||||
[0x03] = KEY_VOLUMEUP,
|
||||
[0x04] = KEY_VOLUMEDOWN,
|
||||
[0x06] = KEY_1,
|
||||
[0x07] = KEY_Q,
|
||||
[0x08] = KEY_A,
|
||||
[0x09] = KEY_Z,
|
||||
[0x0a] = KEY_LEFTSHIFT,
|
||||
[0x0b] = KEY_2,
|
||||
[0x0c] = KEY_W,
|
||||
[0x0d] = KEY_S,
|
||||
[0x0e] = KEY_X,
|
||||
[0x0f] = KEY_REFRESH,
|
||||
[0x10] = KEY_3,
|
||||
[0x11] = KEY_E,
|
||||
[0x12] = KEY_D,
|
||||
[0x13] = KEY_C,
|
||||
[0x14] = KEY_DOCUMENTS,
|
||||
[0x15] = KEY_4,
|
||||
[0x16] = KEY_R,
|
||||
[0x17] = KEY_F,
|
||||
[0x18] = KEY_V,
|
||||
[0x19] = KEY_MUTE,
|
||||
[0x1a] = KEY_5,
|
||||
[0x1b] = KEY_T,
|
||||
[0x1c] = KEY_G,
|
||||
[0x1d] = KEY_B,
|
||||
[0x1e] = KEY_DELETE,
|
||||
[0x1f] = KEY_6,
|
||||
[0x20] = KEY_Y,
|
||||
[0x21] = KEY_H,
|
||||
[0x22] = KEY_N,
|
||||
[0x23] = KEY_SPACE,
|
||||
[0x24] = KEY_7,
|
||||
[0x25] = KEY_U,
|
||||
[0x26] = KEY_J,
|
||||
[0x27] = KEY_M,
|
||||
/* [0x28] = KEY_SYM, */
|
||||
[0x29] = KEY_8,
|
||||
[0x2a] = KEY_I,
|
||||
[0x2b] = KEY_K,
|
||||
[0x2c] = KEY_MENU,
|
||||
[0x2d] = KEY_LEFT,
|
||||
[0x2e] = KEY_9,
|
||||
[0x2f] = KEY_O,
|
||||
[0x30] = KEY_L,
|
||||
[0x31] = KEY_UP,
|
||||
[0x32] = KEY_DOWN,
|
||||
[0x33] = KEY_0,
|
||||
[0x34] = KEY_P,
|
||||
[0x35] = KEY_BACKSPACE,
|
||||
[0x36] = KEY_ENTER,
|
||||
[0x37] = KEY_RIGHT,
|
||||
};
|
||||
|
||||
static void n526_lpc_irq_work(struct work_struct *work)
|
||||
{
|
||||
int ret;
|
||||
struct n526_lpc *n526_lpc = container_of(work, struct n526_lpc, work);
|
||||
struct i2c_client *client = n526_lpc->client;
|
||||
unsigned char raw_msg;
|
||||
struct i2c_msg msg = {client->addr, client->flags | I2C_M_RD, 1, &raw_msg};
|
||||
unsigned char keycode;
|
||||
|
||||
|
||||
ret = i2c_transfer(client->adapter, &msg, 1);
|
||||
|
||||
if (ret != 1) {
|
||||
dev_err(&client->dev, "Failed to read lpc status\n");
|
||||
}
|
||||
|
||||
keycode = raw_msg & 0x7f;
|
||||
|
||||
if (keycode < ARRAY_SIZE(n526_lpc_keymap)) {
|
||||
input_report_key(n526_lpc->input, n526_lpc_keymap[keycode],
|
||||
!(raw_msg & 0x80));
|
||||
input_sync(n526_lpc->input);
|
||||
}
|
||||
}
|
||||
|
||||
static irqreturn_t n526_lpc_irq(int irq, void *dev_id)
|
||||
{
|
||||
struct n526_lpc *n526_lpc = dev_id;
|
||||
|
||||
schedule_work(&n526_lpc->work);
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static int __devinit n526_lpc_probe(struct i2c_client *client,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
int ret;
|
||||
size_t i;
|
||||
struct n526_lpc *n526_lpc;
|
||||
struct input_dev *input;
|
||||
|
||||
n526_lpc = kmalloc(sizeof(*n526_lpc), GFP_KERNEL);
|
||||
|
||||
if (!n526_lpc) {
|
||||
dev_err(&client->dev, "Failed to allocate device structure\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
input = input_allocate_device();
|
||||
if (!input) {
|
||||
dev_err(&client->dev, "Failed to allocate input device\n");
|
||||
ret = -ENOMEM;
|
||||
goto err_free;
|
||||
}
|
||||
|
||||
input->name = "n526-keys";
|
||||
input->phys = "n526-keys/input0";
|
||||
input->dev.parent = &client->dev;
|
||||
input->id.bustype = BUS_I2C;
|
||||
input->id.vendor = 0x0001;
|
||||
input->id.product = 0x0001;
|
||||
input->id.version = 0x0001;
|
||||
|
||||
__set_bit(EV_KEY, input->evbit);
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(n526_lpc_keymap); ++i) {
|
||||
if (n526_lpc_keymap[i] != 0)
|
||||
__set_bit(n526_lpc_keymap[i], input->keybit);
|
||||
}
|
||||
|
||||
ret = input_register_device(input);
|
||||
|
||||
if (ret) {
|
||||
dev_err(&client->dev, "Failed to register input device: %d\n", ret);
|
||||
goto err_free_input;
|
||||
}
|
||||
|
||||
n526_lpc->client = client;
|
||||
n526_lpc->input = input;
|
||||
INIT_WORK(&n526_lpc->work, n526_lpc_irq_work);
|
||||
|
||||
ret = request_irq(client->irq, n526_lpc_irq, IRQF_TRIGGER_FALLING,
|
||||
"n526-lpc", n526_lpc);
|
||||
if (ret) {
|
||||
dev_err(&client->dev, "Failed to request irq: %d\n", ret);
|
||||
goto err_unregister_input;
|
||||
}
|
||||
|
||||
i2c_set_clientdata(client, n526_lpc);
|
||||
|
||||
return 0;
|
||||
|
||||
err_unregister_input:
|
||||
input_unregister_device(input);
|
||||
err_free_input:
|
||||
input_free_device(input);
|
||||
err_free:
|
||||
kfree(n526_lpc);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int n526_lpc_remove(struct i2c_client *client)
|
||||
{
|
||||
struct n526_lpc *n526_lpc = i2c_get_clientdata(client);
|
||||
|
||||
free_irq(client->irq, n526_lpc);
|
||||
|
||||
i2c_set_clientdata(client, NULL);
|
||||
input_unregister_device(n526_lpc->input);
|
||||
input_free_device(n526_lpc->input);
|
||||
kfree(n526_lpc);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct i2c_device_id n526_lpc_id[] = {
|
||||
{ "n526-lpc", 0 },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, n526_lpc_id);
|
||||
|
||||
static struct i2c_driver n526_lpc_driver = {
|
||||
.driver = {
|
||||
.name = "n526-lpc",
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.probe = n526_lpc_probe,
|
||||
.remove = n526_lpc_remove,
|
||||
.id_table = n526_lpc_id,
|
||||
};
|
||||
|
||||
static int __init n526_lpc_init(void)
|
||||
{
|
||||
return i2c_add_driver(&n526_lpc_driver);
|
||||
}
|
||||
module_init(n526_lpc_init);
|
||||
|
||||
static void __exit n526_lpc_exit(void)
|
||||
{
|
||||
i2c_del_driver(&n526_lpc_driver);
|
||||
}
|
||||
module_exit(n526_lpc_exit);
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_AUTHOR("Lars-Peter Clausen");
|
||||
MODULE_DESCRIPTION("n526 keypad driver");
|
||||
MODULE_ALIAS("i2c:n526-keys");
|
||||
26
target/linux/xburst/patches-2.6.31/800-n526-lpc.patch
Normal file
26
target/linux/xburst/patches-2.6.31/800-n526-lpc.patch
Normal file
@ -0,0 +1,26 @@
|
||||
--- a/drivers/i2c/chips/Kconfig 2009-10-05 13:18:07.000000000 +0200
|
||||
+++ b/drivers/i2c/chips/Kconfig 2009-12-06 19:10:10.000000000 +0100
|
||||
@@ -74,4 +74,13 @@
|
||||
This driver can also be built as a module. If so, the module
|
||||
will be called tsl2550.
|
||||
|
||||
+config N526_LPC
|
||||
+ tristate "N526 LPC934 coprocessor"
|
||||
+ depends on JZ4740_N526
|
||||
+ help
|
||||
+ If you say yes here you get support for the N526s NXP LPC934 coprocessor.
|
||||
+ It is used as a keyboard controllor and for power management.
|
||||
+
|
||||
+ If you have a N526 you probably want to say Y here.
|
||||
+
|
||||
endmenu
|
||||
--- a/drivers/i2c/chips/Makefile 2009-10-05 13:18:07.000000000 +0200
|
||||
+++ b/drivers/i2c/chips/Makefile 2009-12-06 19:03:47.000000000 +0100
|
||||
@@ -15,6 +15,7 @@
|
||||
obj-$(CONFIG_SENSORS_PCF8574) += pcf8574.o
|
||||
obj-$(CONFIG_PCF8575) += pcf8575.o
|
||||
obj-$(CONFIG_SENSORS_TSL2550) += tsl2550.o
|
||||
+obj-$(CONFIG_N526_LPC) += n526-lpc.o
|
||||
|
||||
ifeq ($(CONFIG_I2C_DEBUG_CHIP),y)
|
||||
EXTRA_CFLAGS += -DDEBUG
|
||||
Loading…
Reference in New Issue
Block a user