From f5978b5a9701fe1ddeffa0c5f73923fcaf31129e Mon Sep 17 00:00:00 2001 From: Lars-Peter Clausen Date: Wed, 12 May 2010 14:23:43 +0200 Subject: [PATCH] Add n526 lpc driver --- drivers/misc/Kconfig | 9 ++ drivers/misc/Makefile | 1 + drivers/misc/n526-lpc.c | 237 +++++++++++++++++++++++++++++++++++++++++++++++ 3 files changed, 247 insertions(+), 0 deletions(-) create mode 100644 drivers/misc/n526-lpc.c diff --git a/drivers/misc/Kconfig b/drivers/misc/Kconfig index aacef22..0d8297a 100644 --- a/drivers/misc/Kconfig +++ b/drivers/misc/Kconfig @@ -346,6 +346,15 @@ config N516_LPC help N516 keyboard & power controller driver +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. + source "drivers/misc/c2port/Kconfig" source "drivers/misc/eeprom/Kconfig" source "drivers/misc/cb710/Kconfig" diff --git a/drivers/misc/Makefile b/drivers/misc/Makefile index 21e7394..1f866b3 100644 --- a/drivers/misc/Makefile +++ b/drivers/misc/Makefile @@ -32,3 +32,4 @@ obj-y += eeprom/ obj-y += cb710/ obj-$(CONFIG_VMWARE_BALLOON) += vmware_balloon.o obj-$(CONFIG_N516_LPC) += n516-lpc.o +obj-$(CONFIG_N526_LPC) += n526-lpc.o diff --git a/drivers/misc/n526-lpc.c b/drivers/misc/n526-lpc.c new file mode 100644 index 0000000..4ac5c79 --- /dev/null +++ b/drivers/misc/n526-lpc.c @@ -0,0 +1,237 @@ +/* + * Copyright (C) 2009, Lars-Peter Clausen + * + * 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 +#include +#include +#include +#include +#include + +#include + +#include +#include + +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"); -- 1.5.6.5